a2mp.c revision f6d3c6e783b0e9f75b18232f8ff8cd5dbc3f7301
1466f8004f364e9cb46d9124109972489eccfb404Andrei Emeltchenko/* 2466f8004f364e9cb46d9124109972489eccfb404Andrei Emeltchenko Copyright (c) 2010,2011 Code Aurora Forum. All rights reserved. 3466f8004f364e9cb46d9124109972489eccfb404Andrei Emeltchenko Copyright (c) 2011,2012 Intel Corp. 4466f8004f364e9cb46d9124109972489eccfb404Andrei Emeltchenko 5466f8004f364e9cb46d9124109972489eccfb404Andrei Emeltchenko This program is free software; you can redistribute it and/or modify 6466f8004f364e9cb46d9124109972489eccfb404Andrei Emeltchenko it under the terms of the GNU General Public License version 2 and 7466f8004f364e9cb46d9124109972489eccfb404Andrei Emeltchenko only version 2 as published by the Free Software Foundation. 8466f8004f364e9cb46d9124109972489eccfb404Andrei Emeltchenko 9466f8004f364e9cb46d9124109972489eccfb404Andrei Emeltchenko This program is distributed in the hope that it will be useful, 10466f8004f364e9cb46d9124109972489eccfb404Andrei Emeltchenko but WITHOUT ANY WARRANTY; without even the implied warranty of 11466f8004f364e9cb46d9124109972489eccfb404Andrei Emeltchenko MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE. See the 12466f8004f364e9cb46d9124109972489eccfb404Andrei Emeltchenko GNU General Public License for more details. 13466f8004f364e9cb46d9124109972489eccfb404Andrei Emeltchenko*/ 14466f8004f364e9cb46d9124109972489eccfb404Andrei Emeltchenko 15466f8004f364e9cb46d9124109972489eccfb404Andrei Emeltchenko#include <net/bluetooth/bluetooth.h> 16466f8004f364e9cb46d9124109972489eccfb404Andrei Emeltchenko#include <net/bluetooth/hci_core.h> 17466f8004f364e9cb46d9124109972489eccfb404Andrei Emeltchenko#include <net/bluetooth/l2cap.h> 189740e49d17e55f3832661fd99a8e0a17e921a82eAndrei Emeltchenko#include <net/bluetooth/a2mp.h> 19466f8004f364e9cb46d9124109972489eccfb404Andrei Emeltchenko 20f6d3c6e783b0e9f75b18232f8ff8cd5dbc3f7301Andrei Emeltchenko/* A2MP build & send command helper functions */ 21f6d3c6e783b0e9f75b18232f8ff8cd5dbc3f7301Andrei Emeltchenkostatic struct a2mp_cmd *__a2mp_build(u8 code, u8 ident, u16 len, void *data) 22f6d3c6e783b0e9f75b18232f8ff8cd5dbc3f7301Andrei Emeltchenko{ 23f6d3c6e783b0e9f75b18232f8ff8cd5dbc3f7301Andrei Emeltchenko struct a2mp_cmd *cmd; 24f6d3c6e783b0e9f75b18232f8ff8cd5dbc3f7301Andrei Emeltchenko int plen; 25f6d3c6e783b0e9f75b18232f8ff8cd5dbc3f7301Andrei Emeltchenko 26f6d3c6e783b0e9f75b18232f8ff8cd5dbc3f7301Andrei Emeltchenko plen = sizeof(*cmd) + len; 27f6d3c6e783b0e9f75b18232f8ff8cd5dbc3f7301Andrei Emeltchenko cmd = kzalloc(plen, GFP_KERNEL); 28f6d3c6e783b0e9f75b18232f8ff8cd5dbc3f7301Andrei Emeltchenko if (!cmd) 29f6d3c6e783b0e9f75b18232f8ff8cd5dbc3f7301Andrei Emeltchenko return NULL; 30f6d3c6e783b0e9f75b18232f8ff8cd5dbc3f7301Andrei Emeltchenko 31f6d3c6e783b0e9f75b18232f8ff8cd5dbc3f7301Andrei Emeltchenko cmd->code = code; 32f6d3c6e783b0e9f75b18232f8ff8cd5dbc3f7301Andrei Emeltchenko cmd->ident = ident; 33f6d3c6e783b0e9f75b18232f8ff8cd5dbc3f7301Andrei Emeltchenko cmd->len = cpu_to_le16(len); 34f6d3c6e783b0e9f75b18232f8ff8cd5dbc3f7301Andrei Emeltchenko 35f6d3c6e783b0e9f75b18232f8ff8cd5dbc3f7301Andrei Emeltchenko memcpy(cmd->data, data, len); 36f6d3c6e783b0e9f75b18232f8ff8cd5dbc3f7301Andrei Emeltchenko 37f6d3c6e783b0e9f75b18232f8ff8cd5dbc3f7301Andrei Emeltchenko return cmd; 38f6d3c6e783b0e9f75b18232f8ff8cd5dbc3f7301Andrei Emeltchenko} 39f6d3c6e783b0e9f75b18232f8ff8cd5dbc3f7301Andrei Emeltchenko 40f6d3c6e783b0e9f75b18232f8ff8cd5dbc3f7301Andrei Emeltchenkostatic void a2mp_send(struct amp_mgr *mgr, u8 code, u8 ident, u16 len, 41f6d3c6e783b0e9f75b18232f8ff8cd5dbc3f7301Andrei Emeltchenko void *data) 42f6d3c6e783b0e9f75b18232f8ff8cd5dbc3f7301Andrei Emeltchenko{ 43f6d3c6e783b0e9f75b18232f8ff8cd5dbc3f7301Andrei Emeltchenko struct l2cap_chan *chan = mgr->a2mp_chan; 44f6d3c6e783b0e9f75b18232f8ff8cd5dbc3f7301Andrei Emeltchenko struct a2mp_cmd *cmd; 45f6d3c6e783b0e9f75b18232f8ff8cd5dbc3f7301Andrei Emeltchenko u16 total_len = len + sizeof(*cmd); 46f6d3c6e783b0e9f75b18232f8ff8cd5dbc3f7301Andrei Emeltchenko struct kvec iv; 47f6d3c6e783b0e9f75b18232f8ff8cd5dbc3f7301Andrei Emeltchenko struct msghdr msg; 48f6d3c6e783b0e9f75b18232f8ff8cd5dbc3f7301Andrei Emeltchenko 49f6d3c6e783b0e9f75b18232f8ff8cd5dbc3f7301Andrei Emeltchenko cmd = __a2mp_build(code, ident, len, data); 50f6d3c6e783b0e9f75b18232f8ff8cd5dbc3f7301Andrei Emeltchenko if (!cmd) 51f6d3c6e783b0e9f75b18232f8ff8cd5dbc3f7301Andrei Emeltchenko return; 52f6d3c6e783b0e9f75b18232f8ff8cd5dbc3f7301Andrei Emeltchenko 53f6d3c6e783b0e9f75b18232f8ff8cd5dbc3f7301Andrei Emeltchenko iv.iov_base = cmd; 54f6d3c6e783b0e9f75b18232f8ff8cd5dbc3f7301Andrei Emeltchenko iv.iov_len = total_len; 55f6d3c6e783b0e9f75b18232f8ff8cd5dbc3f7301Andrei Emeltchenko 56f6d3c6e783b0e9f75b18232f8ff8cd5dbc3f7301Andrei Emeltchenko memset(&msg, 0, sizeof(msg)); 57f6d3c6e783b0e9f75b18232f8ff8cd5dbc3f7301Andrei Emeltchenko 58f6d3c6e783b0e9f75b18232f8ff8cd5dbc3f7301Andrei Emeltchenko msg.msg_iov = (struct iovec *) &iv; 59f6d3c6e783b0e9f75b18232f8ff8cd5dbc3f7301Andrei Emeltchenko msg.msg_iovlen = 1; 60f6d3c6e783b0e9f75b18232f8ff8cd5dbc3f7301Andrei Emeltchenko 61f6d3c6e783b0e9f75b18232f8ff8cd5dbc3f7301Andrei Emeltchenko l2cap_chan_send(chan, &msg, total_len, 0); 62f6d3c6e783b0e9f75b18232f8ff8cd5dbc3f7301Andrei Emeltchenko 63f6d3c6e783b0e9f75b18232f8ff8cd5dbc3f7301Andrei Emeltchenko kfree(cmd); 64f6d3c6e783b0e9f75b18232f8ff8cd5dbc3f7301Andrei Emeltchenko} 65f6d3c6e783b0e9f75b18232f8ff8cd5dbc3f7301Andrei Emeltchenko 66466f8004f364e9cb46d9124109972489eccfb404Andrei Emeltchenkostatic struct l2cap_ops a2mp_chan_ops = { 67466f8004f364e9cb46d9124109972489eccfb404Andrei Emeltchenko .name = "L2CAP A2MP channel", 68466f8004f364e9cb46d9124109972489eccfb404Andrei Emeltchenko}; 69466f8004f364e9cb46d9124109972489eccfb404Andrei Emeltchenko 70466f8004f364e9cb46d9124109972489eccfb404Andrei Emeltchenkostatic struct l2cap_chan *a2mp_chan_open(struct l2cap_conn *conn) 71466f8004f364e9cb46d9124109972489eccfb404Andrei Emeltchenko{ 72466f8004f364e9cb46d9124109972489eccfb404Andrei Emeltchenko struct l2cap_chan *chan; 73466f8004f364e9cb46d9124109972489eccfb404Andrei Emeltchenko int err; 74466f8004f364e9cb46d9124109972489eccfb404Andrei Emeltchenko 75466f8004f364e9cb46d9124109972489eccfb404Andrei Emeltchenko chan = l2cap_chan_create(); 76466f8004f364e9cb46d9124109972489eccfb404Andrei Emeltchenko if (!chan) 77466f8004f364e9cb46d9124109972489eccfb404Andrei Emeltchenko return NULL; 78466f8004f364e9cb46d9124109972489eccfb404Andrei Emeltchenko 79466f8004f364e9cb46d9124109972489eccfb404Andrei Emeltchenko BT_DBG("chan %p", chan); 80466f8004f364e9cb46d9124109972489eccfb404Andrei Emeltchenko 81466f8004f364e9cb46d9124109972489eccfb404Andrei Emeltchenko hci_conn_hold(conn->hcon); 82466f8004f364e9cb46d9124109972489eccfb404Andrei Emeltchenko 83466f8004f364e9cb46d9124109972489eccfb404Andrei Emeltchenko chan->omtu = L2CAP_A2MP_DEFAULT_MTU; 84466f8004f364e9cb46d9124109972489eccfb404Andrei Emeltchenko chan->imtu = L2CAP_A2MP_DEFAULT_MTU; 85466f8004f364e9cb46d9124109972489eccfb404Andrei Emeltchenko chan->flush_to = L2CAP_DEFAULT_FLUSH_TO; 86466f8004f364e9cb46d9124109972489eccfb404Andrei Emeltchenko 87466f8004f364e9cb46d9124109972489eccfb404Andrei Emeltchenko chan->ops = &a2mp_chan_ops; 88466f8004f364e9cb46d9124109972489eccfb404Andrei Emeltchenko 89466f8004f364e9cb46d9124109972489eccfb404Andrei Emeltchenko l2cap_chan_set_defaults(chan); 90466f8004f364e9cb46d9124109972489eccfb404Andrei Emeltchenko chan->remote_max_tx = chan->max_tx; 91466f8004f364e9cb46d9124109972489eccfb404Andrei Emeltchenko chan->remote_tx_win = chan->tx_win; 92466f8004f364e9cb46d9124109972489eccfb404Andrei Emeltchenko 93466f8004f364e9cb46d9124109972489eccfb404Andrei Emeltchenko chan->retrans_timeout = L2CAP_DEFAULT_RETRANS_TO; 94466f8004f364e9cb46d9124109972489eccfb404Andrei Emeltchenko chan->monitor_timeout = L2CAP_DEFAULT_MONITOR_TO; 95466f8004f364e9cb46d9124109972489eccfb404Andrei Emeltchenko 96466f8004f364e9cb46d9124109972489eccfb404Andrei Emeltchenko skb_queue_head_init(&chan->tx_q); 97466f8004f364e9cb46d9124109972489eccfb404Andrei Emeltchenko 98466f8004f364e9cb46d9124109972489eccfb404Andrei Emeltchenko chan->mode = L2CAP_MODE_ERTM; 99466f8004f364e9cb46d9124109972489eccfb404Andrei Emeltchenko 100466f8004f364e9cb46d9124109972489eccfb404Andrei Emeltchenko err = l2cap_ertm_init(chan); 101466f8004f364e9cb46d9124109972489eccfb404Andrei Emeltchenko if (err < 0) { 102466f8004f364e9cb46d9124109972489eccfb404Andrei Emeltchenko l2cap_chan_del(chan, 0); 103466f8004f364e9cb46d9124109972489eccfb404Andrei Emeltchenko return NULL; 104466f8004f364e9cb46d9124109972489eccfb404Andrei Emeltchenko } 105466f8004f364e9cb46d9124109972489eccfb404Andrei Emeltchenko 106466f8004f364e9cb46d9124109972489eccfb404Andrei Emeltchenko chan->conf_state = 0; 107466f8004f364e9cb46d9124109972489eccfb404Andrei Emeltchenko 108466f8004f364e9cb46d9124109972489eccfb404Andrei Emeltchenko l2cap_chan_add(conn, chan); 109466f8004f364e9cb46d9124109972489eccfb404Andrei Emeltchenko 110466f8004f364e9cb46d9124109972489eccfb404Andrei Emeltchenko chan->remote_mps = chan->omtu; 111466f8004f364e9cb46d9124109972489eccfb404Andrei Emeltchenko chan->mps = chan->omtu; 112466f8004f364e9cb46d9124109972489eccfb404Andrei Emeltchenko 113466f8004f364e9cb46d9124109972489eccfb404Andrei Emeltchenko chan->state = BT_CONNECTED; 114466f8004f364e9cb46d9124109972489eccfb404Andrei Emeltchenko 115466f8004f364e9cb46d9124109972489eccfb404Andrei Emeltchenko return chan; 116466f8004f364e9cb46d9124109972489eccfb404Andrei Emeltchenko} 1179740e49d17e55f3832661fd99a8e0a17e921a82eAndrei Emeltchenko 1189740e49d17e55f3832661fd99a8e0a17e921a82eAndrei Emeltchenko/* AMP Manager functions */ 1199740e49d17e55f3832661fd99a8e0a17e921a82eAndrei Emeltchenkovoid amp_mgr_get(struct amp_mgr *mgr) 1209740e49d17e55f3832661fd99a8e0a17e921a82eAndrei Emeltchenko{ 1219740e49d17e55f3832661fd99a8e0a17e921a82eAndrei Emeltchenko BT_DBG("mgr %p", mgr); 1229740e49d17e55f3832661fd99a8e0a17e921a82eAndrei Emeltchenko 1239740e49d17e55f3832661fd99a8e0a17e921a82eAndrei Emeltchenko kref_get(&mgr->kref); 1249740e49d17e55f3832661fd99a8e0a17e921a82eAndrei Emeltchenko} 1259740e49d17e55f3832661fd99a8e0a17e921a82eAndrei Emeltchenko 1269740e49d17e55f3832661fd99a8e0a17e921a82eAndrei Emeltchenkostatic void amp_mgr_destroy(struct kref *kref) 1279740e49d17e55f3832661fd99a8e0a17e921a82eAndrei Emeltchenko{ 1289740e49d17e55f3832661fd99a8e0a17e921a82eAndrei Emeltchenko struct amp_mgr *mgr = container_of(kref, struct amp_mgr, kref); 1299740e49d17e55f3832661fd99a8e0a17e921a82eAndrei Emeltchenko 1309740e49d17e55f3832661fd99a8e0a17e921a82eAndrei Emeltchenko BT_DBG("mgr %p", mgr); 1319740e49d17e55f3832661fd99a8e0a17e921a82eAndrei Emeltchenko 1329740e49d17e55f3832661fd99a8e0a17e921a82eAndrei Emeltchenko kfree(mgr); 1339740e49d17e55f3832661fd99a8e0a17e921a82eAndrei Emeltchenko} 1349740e49d17e55f3832661fd99a8e0a17e921a82eAndrei Emeltchenko 1359740e49d17e55f3832661fd99a8e0a17e921a82eAndrei Emeltchenkoint amp_mgr_put(struct amp_mgr *mgr) 1369740e49d17e55f3832661fd99a8e0a17e921a82eAndrei Emeltchenko{ 1379740e49d17e55f3832661fd99a8e0a17e921a82eAndrei Emeltchenko BT_DBG("mgr %p", mgr); 1389740e49d17e55f3832661fd99a8e0a17e921a82eAndrei Emeltchenko 1399740e49d17e55f3832661fd99a8e0a17e921a82eAndrei Emeltchenko return kref_put(&mgr->kref, &_mgr_destroy); 1409740e49d17e55f3832661fd99a8e0a17e921a82eAndrei Emeltchenko} 1419740e49d17e55f3832661fd99a8e0a17e921a82eAndrei Emeltchenko 1429740e49d17e55f3832661fd99a8e0a17e921a82eAndrei Emeltchenkostatic struct amp_mgr *amp_mgr_create(struct l2cap_conn *conn) 1439740e49d17e55f3832661fd99a8e0a17e921a82eAndrei Emeltchenko{ 1449740e49d17e55f3832661fd99a8e0a17e921a82eAndrei Emeltchenko struct amp_mgr *mgr; 1459740e49d17e55f3832661fd99a8e0a17e921a82eAndrei Emeltchenko struct l2cap_chan *chan; 1469740e49d17e55f3832661fd99a8e0a17e921a82eAndrei Emeltchenko 1479740e49d17e55f3832661fd99a8e0a17e921a82eAndrei Emeltchenko mgr = kzalloc(sizeof(*mgr), GFP_KERNEL); 1489740e49d17e55f3832661fd99a8e0a17e921a82eAndrei Emeltchenko if (!mgr) 1499740e49d17e55f3832661fd99a8e0a17e921a82eAndrei Emeltchenko return NULL; 1509740e49d17e55f3832661fd99a8e0a17e921a82eAndrei Emeltchenko 1519740e49d17e55f3832661fd99a8e0a17e921a82eAndrei Emeltchenko BT_DBG("conn %p mgr %p", conn, mgr); 1529740e49d17e55f3832661fd99a8e0a17e921a82eAndrei Emeltchenko 1539740e49d17e55f3832661fd99a8e0a17e921a82eAndrei Emeltchenko mgr->l2cap_conn = conn; 1549740e49d17e55f3832661fd99a8e0a17e921a82eAndrei Emeltchenko 1559740e49d17e55f3832661fd99a8e0a17e921a82eAndrei Emeltchenko chan = a2mp_chan_open(conn); 1569740e49d17e55f3832661fd99a8e0a17e921a82eAndrei Emeltchenko if (!chan) { 1579740e49d17e55f3832661fd99a8e0a17e921a82eAndrei Emeltchenko kfree(mgr); 1589740e49d17e55f3832661fd99a8e0a17e921a82eAndrei Emeltchenko return NULL; 1599740e49d17e55f3832661fd99a8e0a17e921a82eAndrei Emeltchenko } 1609740e49d17e55f3832661fd99a8e0a17e921a82eAndrei Emeltchenko 1619740e49d17e55f3832661fd99a8e0a17e921a82eAndrei Emeltchenko mgr->a2mp_chan = chan; 1629740e49d17e55f3832661fd99a8e0a17e921a82eAndrei Emeltchenko chan->data = mgr; 1639740e49d17e55f3832661fd99a8e0a17e921a82eAndrei Emeltchenko 1649740e49d17e55f3832661fd99a8e0a17e921a82eAndrei Emeltchenko conn->hcon->amp_mgr = mgr; 1659740e49d17e55f3832661fd99a8e0a17e921a82eAndrei Emeltchenko 1669740e49d17e55f3832661fd99a8e0a17e921a82eAndrei Emeltchenko kref_init(&mgr->kref); 1679740e49d17e55f3832661fd99a8e0a17e921a82eAndrei Emeltchenko 1689740e49d17e55f3832661fd99a8e0a17e921a82eAndrei Emeltchenko return mgr; 1699740e49d17e55f3832661fd99a8e0a17e921a82eAndrei Emeltchenko} 170