a2mp.c revision 21dbd2ce35f6d2b4aa5363be6c839cdb50644e11
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 6621dbd2ce35f6d2b4aa5363be6c839cdb50644e11Andrei Emeltchenko/* Processing A2MP messages */ 6721dbd2ce35f6d2b4aa5363be6c839cdb50644e11Andrei Emeltchenkostatic int a2mp_command_rej(struct amp_mgr *mgr, struct sk_buff *skb, 6821dbd2ce35f6d2b4aa5363be6c839cdb50644e11Andrei Emeltchenko struct a2mp_cmd *hdr) 6921dbd2ce35f6d2b4aa5363be6c839cdb50644e11Andrei Emeltchenko{ 7021dbd2ce35f6d2b4aa5363be6c839cdb50644e11Andrei Emeltchenko struct a2mp_cmd_rej *rej = (void *) skb->data; 7121dbd2ce35f6d2b4aa5363be6c839cdb50644e11Andrei Emeltchenko 7221dbd2ce35f6d2b4aa5363be6c839cdb50644e11Andrei Emeltchenko if (le16_to_cpu(hdr->len) < sizeof(*rej)) 7321dbd2ce35f6d2b4aa5363be6c839cdb50644e11Andrei Emeltchenko return -EINVAL; 7421dbd2ce35f6d2b4aa5363be6c839cdb50644e11Andrei Emeltchenko 7521dbd2ce35f6d2b4aa5363be6c839cdb50644e11Andrei Emeltchenko BT_DBG("ident %d reason %d", hdr->ident, le16_to_cpu(rej->reason)); 7621dbd2ce35f6d2b4aa5363be6c839cdb50644e11Andrei Emeltchenko 7721dbd2ce35f6d2b4aa5363be6c839cdb50644e11Andrei Emeltchenko skb_pull(skb, sizeof(*rej)); 7821dbd2ce35f6d2b4aa5363be6c839cdb50644e11Andrei Emeltchenko 7921dbd2ce35f6d2b4aa5363be6c839cdb50644e11Andrei Emeltchenko return 0; 8021dbd2ce35f6d2b4aa5363be6c839cdb50644e11Andrei Emeltchenko} 8121dbd2ce35f6d2b4aa5363be6c839cdb50644e11Andrei Emeltchenko 826b44d9b8d96b37f72ccd7335b32f386a67b7f1f4Andrei Emeltchenko/* Handle A2MP signalling */ 836b44d9b8d96b37f72ccd7335b32f386a67b7f1f4Andrei Emeltchenkostatic int a2mp_chan_recv_cb(struct l2cap_chan *chan, struct sk_buff *skb) 846b44d9b8d96b37f72ccd7335b32f386a67b7f1f4Andrei Emeltchenko{ 856b44d9b8d96b37f72ccd7335b32f386a67b7f1f4Andrei Emeltchenko struct a2mp_cmd *hdr = (void *) skb->data; 866b44d9b8d96b37f72ccd7335b32f386a67b7f1f4Andrei Emeltchenko struct amp_mgr *mgr = chan->data; 876b44d9b8d96b37f72ccd7335b32f386a67b7f1f4Andrei Emeltchenko int err = 0; 886b44d9b8d96b37f72ccd7335b32f386a67b7f1f4Andrei Emeltchenko 896b44d9b8d96b37f72ccd7335b32f386a67b7f1f4Andrei Emeltchenko amp_mgr_get(mgr); 906b44d9b8d96b37f72ccd7335b32f386a67b7f1f4Andrei Emeltchenko 916b44d9b8d96b37f72ccd7335b32f386a67b7f1f4Andrei Emeltchenko while (skb->len >= sizeof(*hdr)) { 926b44d9b8d96b37f72ccd7335b32f386a67b7f1f4Andrei Emeltchenko struct a2mp_cmd *hdr = (void *) skb->data; 936b44d9b8d96b37f72ccd7335b32f386a67b7f1f4Andrei Emeltchenko u16 len = le16_to_cpu(hdr->len); 946b44d9b8d96b37f72ccd7335b32f386a67b7f1f4Andrei Emeltchenko 956b44d9b8d96b37f72ccd7335b32f386a67b7f1f4Andrei Emeltchenko BT_DBG("code 0x%02x id %d len %d", hdr->code, hdr->ident, len); 966b44d9b8d96b37f72ccd7335b32f386a67b7f1f4Andrei Emeltchenko 976b44d9b8d96b37f72ccd7335b32f386a67b7f1f4Andrei Emeltchenko skb_pull(skb, sizeof(*hdr)); 986b44d9b8d96b37f72ccd7335b32f386a67b7f1f4Andrei Emeltchenko 996b44d9b8d96b37f72ccd7335b32f386a67b7f1f4Andrei Emeltchenko if (len > skb->len || !hdr->ident) { 1006b44d9b8d96b37f72ccd7335b32f386a67b7f1f4Andrei Emeltchenko err = -EINVAL; 1016b44d9b8d96b37f72ccd7335b32f386a67b7f1f4Andrei Emeltchenko break; 1026b44d9b8d96b37f72ccd7335b32f386a67b7f1f4Andrei Emeltchenko } 1036b44d9b8d96b37f72ccd7335b32f386a67b7f1f4Andrei Emeltchenko 1046b44d9b8d96b37f72ccd7335b32f386a67b7f1f4Andrei Emeltchenko mgr->ident = hdr->ident; 1056b44d9b8d96b37f72ccd7335b32f386a67b7f1f4Andrei Emeltchenko 1066b44d9b8d96b37f72ccd7335b32f386a67b7f1f4Andrei Emeltchenko switch (hdr->code) { 1076b44d9b8d96b37f72ccd7335b32f386a67b7f1f4Andrei Emeltchenko case A2MP_COMMAND_REJ: 10821dbd2ce35f6d2b4aa5363be6c839cdb50644e11Andrei Emeltchenko a2mp_command_rej(mgr, skb, hdr); 10921dbd2ce35f6d2b4aa5363be6c839cdb50644e11Andrei Emeltchenko break; 11021dbd2ce35f6d2b4aa5363be6c839cdb50644e11Andrei Emeltchenko 1116b44d9b8d96b37f72ccd7335b32f386a67b7f1f4Andrei Emeltchenko case A2MP_DISCOVER_REQ: 1126b44d9b8d96b37f72ccd7335b32f386a67b7f1f4Andrei Emeltchenko case A2MP_CHANGE_NOTIFY: 1136b44d9b8d96b37f72ccd7335b32f386a67b7f1f4Andrei Emeltchenko case A2MP_GETINFO_REQ: 1146b44d9b8d96b37f72ccd7335b32f386a67b7f1f4Andrei Emeltchenko case A2MP_GETAMPASSOC_REQ: 1156b44d9b8d96b37f72ccd7335b32f386a67b7f1f4Andrei Emeltchenko case A2MP_CREATEPHYSLINK_REQ: 1166b44d9b8d96b37f72ccd7335b32f386a67b7f1f4Andrei Emeltchenko case A2MP_DISCONNPHYSLINK_REQ: 1176b44d9b8d96b37f72ccd7335b32f386a67b7f1f4Andrei Emeltchenko case A2MP_CHANGE_RSP: 1186b44d9b8d96b37f72ccd7335b32f386a67b7f1f4Andrei Emeltchenko case A2MP_DISCOVER_RSP: 1196b44d9b8d96b37f72ccd7335b32f386a67b7f1f4Andrei Emeltchenko case A2MP_GETINFO_RSP: 1206b44d9b8d96b37f72ccd7335b32f386a67b7f1f4Andrei Emeltchenko case A2MP_GETAMPASSOC_RSP: 1216b44d9b8d96b37f72ccd7335b32f386a67b7f1f4Andrei Emeltchenko case A2MP_CREATEPHYSLINK_RSP: 1226b44d9b8d96b37f72ccd7335b32f386a67b7f1f4Andrei Emeltchenko case A2MP_DISCONNPHYSLINK_RSP: 1236b44d9b8d96b37f72ccd7335b32f386a67b7f1f4Andrei Emeltchenko default: 1246b44d9b8d96b37f72ccd7335b32f386a67b7f1f4Andrei Emeltchenko BT_ERR("Unknown A2MP sig cmd 0x%2.2x", hdr->code); 1256b44d9b8d96b37f72ccd7335b32f386a67b7f1f4Andrei Emeltchenko err = -EINVAL; 1266b44d9b8d96b37f72ccd7335b32f386a67b7f1f4Andrei Emeltchenko break; 1276b44d9b8d96b37f72ccd7335b32f386a67b7f1f4Andrei Emeltchenko } 1286b44d9b8d96b37f72ccd7335b32f386a67b7f1f4Andrei Emeltchenko } 1296b44d9b8d96b37f72ccd7335b32f386a67b7f1f4Andrei Emeltchenko 1306b44d9b8d96b37f72ccd7335b32f386a67b7f1f4Andrei Emeltchenko if (err) { 1316b44d9b8d96b37f72ccd7335b32f386a67b7f1f4Andrei Emeltchenko struct a2mp_cmd_rej rej; 1326b44d9b8d96b37f72ccd7335b32f386a67b7f1f4Andrei Emeltchenko rej.reason = __constant_cpu_to_le16(0); 1336b44d9b8d96b37f72ccd7335b32f386a67b7f1f4Andrei Emeltchenko 1346b44d9b8d96b37f72ccd7335b32f386a67b7f1f4Andrei Emeltchenko BT_DBG("Send A2MP Rej: cmd 0x%2.2x err %d", hdr->code, err); 1356b44d9b8d96b37f72ccd7335b32f386a67b7f1f4Andrei Emeltchenko 1366b44d9b8d96b37f72ccd7335b32f386a67b7f1f4Andrei Emeltchenko a2mp_send(mgr, A2MP_COMMAND_REJ, hdr->ident, sizeof(rej), 1376b44d9b8d96b37f72ccd7335b32f386a67b7f1f4Andrei Emeltchenko &rej); 1386b44d9b8d96b37f72ccd7335b32f386a67b7f1f4Andrei Emeltchenko } 1396b44d9b8d96b37f72ccd7335b32f386a67b7f1f4Andrei Emeltchenko 1406b44d9b8d96b37f72ccd7335b32f386a67b7f1f4Andrei Emeltchenko /* Always free skb and return success error code to prevent 1416b44d9b8d96b37f72ccd7335b32f386a67b7f1f4Andrei Emeltchenko from sending L2CAP Disconnect over A2MP channel */ 1426b44d9b8d96b37f72ccd7335b32f386a67b7f1f4Andrei Emeltchenko kfree_skb(skb); 1436b44d9b8d96b37f72ccd7335b32f386a67b7f1f4Andrei Emeltchenko 1446b44d9b8d96b37f72ccd7335b32f386a67b7f1f4Andrei Emeltchenko amp_mgr_put(mgr); 1456b44d9b8d96b37f72ccd7335b32f386a67b7f1f4Andrei Emeltchenko 1466b44d9b8d96b37f72ccd7335b32f386a67b7f1f4Andrei Emeltchenko return 0; 1476b44d9b8d96b37f72ccd7335b32f386a67b7f1f4Andrei Emeltchenko} 1486b44d9b8d96b37f72ccd7335b32f386a67b7f1f4Andrei Emeltchenko 14946d5c9088fbcc8a570bc271f77940973d9cae074Andrei Emeltchenkostatic void a2mp_chan_close_cb(struct l2cap_chan *chan) 15046d5c9088fbcc8a570bc271f77940973d9cae074Andrei Emeltchenko{ 15146d5c9088fbcc8a570bc271f77940973d9cae074Andrei Emeltchenko l2cap_chan_destroy(chan); 15246d5c9088fbcc8a570bc271f77940973d9cae074Andrei Emeltchenko} 15346d5c9088fbcc8a570bc271f77940973d9cae074Andrei Emeltchenko 15446d5c9088fbcc8a570bc271f77940973d9cae074Andrei Emeltchenkostatic void a2mp_chan_state_change_cb(struct l2cap_chan *chan, int state) 15546d5c9088fbcc8a570bc271f77940973d9cae074Andrei Emeltchenko{ 15646d5c9088fbcc8a570bc271f77940973d9cae074Andrei Emeltchenko struct amp_mgr *mgr = chan->data; 15746d5c9088fbcc8a570bc271f77940973d9cae074Andrei Emeltchenko 15846d5c9088fbcc8a570bc271f77940973d9cae074Andrei Emeltchenko if (!mgr) 15946d5c9088fbcc8a570bc271f77940973d9cae074Andrei Emeltchenko return; 16046d5c9088fbcc8a570bc271f77940973d9cae074Andrei Emeltchenko 16146d5c9088fbcc8a570bc271f77940973d9cae074Andrei Emeltchenko BT_DBG("chan %p state %s", chan, state_to_string(state)); 16246d5c9088fbcc8a570bc271f77940973d9cae074Andrei Emeltchenko 16346d5c9088fbcc8a570bc271f77940973d9cae074Andrei Emeltchenko chan->state = state; 16446d5c9088fbcc8a570bc271f77940973d9cae074Andrei Emeltchenko 16546d5c9088fbcc8a570bc271f77940973d9cae074Andrei Emeltchenko switch (state) { 16646d5c9088fbcc8a570bc271f77940973d9cae074Andrei Emeltchenko case BT_CLOSED: 16746d5c9088fbcc8a570bc271f77940973d9cae074Andrei Emeltchenko if (mgr) 16846d5c9088fbcc8a570bc271f77940973d9cae074Andrei Emeltchenko amp_mgr_put(mgr); 16946d5c9088fbcc8a570bc271f77940973d9cae074Andrei Emeltchenko break; 17046d5c9088fbcc8a570bc271f77940973d9cae074Andrei Emeltchenko } 17146d5c9088fbcc8a570bc271f77940973d9cae074Andrei Emeltchenko} 17246d5c9088fbcc8a570bc271f77940973d9cae074Andrei Emeltchenko 17346d5c9088fbcc8a570bc271f77940973d9cae074Andrei Emeltchenkostatic struct sk_buff *a2mp_chan_alloc_skb_cb(struct l2cap_chan *chan, 17446d5c9088fbcc8a570bc271f77940973d9cae074Andrei Emeltchenko unsigned long len, int nb) 17546d5c9088fbcc8a570bc271f77940973d9cae074Andrei Emeltchenko{ 17646d5c9088fbcc8a570bc271f77940973d9cae074Andrei Emeltchenko return bt_skb_alloc(len, GFP_KERNEL); 17746d5c9088fbcc8a570bc271f77940973d9cae074Andrei Emeltchenko} 17846d5c9088fbcc8a570bc271f77940973d9cae074Andrei Emeltchenko 17946d5c9088fbcc8a570bc271f77940973d9cae074Andrei Emeltchenkostatic struct l2cap_chan *a2mp_chan_no_new_conn_cb(struct l2cap_chan *chan) 18046d5c9088fbcc8a570bc271f77940973d9cae074Andrei Emeltchenko{ 18146d5c9088fbcc8a570bc271f77940973d9cae074Andrei Emeltchenko BT_ERR("new_connection for chan %p not implemented", chan); 18246d5c9088fbcc8a570bc271f77940973d9cae074Andrei Emeltchenko 18346d5c9088fbcc8a570bc271f77940973d9cae074Andrei Emeltchenko return NULL; 18446d5c9088fbcc8a570bc271f77940973d9cae074Andrei Emeltchenko} 18546d5c9088fbcc8a570bc271f77940973d9cae074Andrei Emeltchenko 18646d5c9088fbcc8a570bc271f77940973d9cae074Andrei Emeltchenkostatic void a2mp_chan_no_teardown_cb(struct l2cap_chan *chan, int err) 18746d5c9088fbcc8a570bc271f77940973d9cae074Andrei Emeltchenko{ 18846d5c9088fbcc8a570bc271f77940973d9cae074Andrei Emeltchenko BT_ERR("teardown for chan %p not implemented", chan); 18946d5c9088fbcc8a570bc271f77940973d9cae074Andrei Emeltchenko} 19046d5c9088fbcc8a570bc271f77940973d9cae074Andrei Emeltchenko 19146d5c9088fbcc8a570bc271f77940973d9cae074Andrei Emeltchenkostatic void a2mp_chan_no_ready(struct l2cap_chan *chan) 19246d5c9088fbcc8a570bc271f77940973d9cae074Andrei Emeltchenko{ 19346d5c9088fbcc8a570bc271f77940973d9cae074Andrei Emeltchenko BT_ERR("ready for chan %p not implemented", chan); 19446d5c9088fbcc8a570bc271f77940973d9cae074Andrei Emeltchenko} 19546d5c9088fbcc8a570bc271f77940973d9cae074Andrei Emeltchenko 196466f8004f364e9cb46d9124109972489eccfb404Andrei Emeltchenkostatic struct l2cap_ops a2mp_chan_ops = { 197466f8004f364e9cb46d9124109972489eccfb404Andrei Emeltchenko .name = "L2CAP A2MP channel", 1986b44d9b8d96b37f72ccd7335b32f386a67b7f1f4Andrei Emeltchenko .recv = a2mp_chan_recv_cb, 19946d5c9088fbcc8a570bc271f77940973d9cae074Andrei Emeltchenko .close = a2mp_chan_close_cb, 20046d5c9088fbcc8a570bc271f77940973d9cae074Andrei Emeltchenko .state_change = a2mp_chan_state_change_cb, 20146d5c9088fbcc8a570bc271f77940973d9cae074Andrei Emeltchenko .alloc_skb = a2mp_chan_alloc_skb_cb, 20246d5c9088fbcc8a570bc271f77940973d9cae074Andrei Emeltchenko 20346d5c9088fbcc8a570bc271f77940973d9cae074Andrei Emeltchenko /* Not implemented for A2MP */ 20446d5c9088fbcc8a570bc271f77940973d9cae074Andrei Emeltchenko .new_connection = a2mp_chan_no_new_conn_cb, 20546d5c9088fbcc8a570bc271f77940973d9cae074Andrei Emeltchenko .teardown = a2mp_chan_no_teardown_cb, 20646d5c9088fbcc8a570bc271f77940973d9cae074Andrei Emeltchenko .ready = a2mp_chan_no_ready, 207466f8004f364e9cb46d9124109972489eccfb404Andrei Emeltchenko}; 208466f8004f364e9cb46d9124109972489eccfb404Andrei Emeltchenko 209466f8004f364e9cb46d9124109972489eccfb404Andrei Emeltchenkostatic struct l2cap_chan *a2mp_chan_open(struct l2cap_conn *conn) 210466f8004f364e9cb46d9124109972489eccfb404Andrei Emeltchenko{ 211466f8004f364e9cb46d9124109972489eccfb404Andrei Emeltchenko struct l2cap_chan *chan; 212466f8004f364e9cb46d9124109972489eccfb404Andrei Emeltchenko int err; 213466f8004f364e9cb46d9124109972489eccfb404Andrei Emeltchenko 214466f8004f364e9cb46d9124109972489eccfb404Andrei Emeltchenko chan = l2cap_chan_create(); 215466f8004f364e9cb46d9124109972489eccfb404Andrei Emeltchenko if (!chan) 216466f8004f364e9cb46d9124109972489eccfb404Andrei Emeltchenko return NULL; 217466f8004f364e9cb46d9124109972489eccfb404Andrei Emeltchenko 218466f8004f364e9cb46d9124109972489eccfb404Andrei Emeltchenko BT_DBG("chan %p", chan); 219466f8004f364e9cb46d9124109972489eccfb404Andrei Emeltchenko 220466f8004f364e9cb46d9124109972489eccfb404Andrei Emeltchenko hci_conn_hold(conn->hcon); 221466f8004f364e9cb46d9124109972489eccfb404Andrei Emeltchenko 222466f8004f364e9cb46d9124109972489eccfb404Andrei Emeltchenko chan->omtu = L2CAP_A2MP_DEFAULT_MTU; 223466f8004f364e9cb46d9124109972489eccfb404Andrei Emeltchenko chan->imtu = L2CAP_A2MP_DEFAULT_MTU; 224466f8004f364e9cb46d9124109972489eccfb404Andrei Emeltchenko chan->flush_to = L2CAP_DEFAULT_FLUSH_TO; 225466f8004f364e9cb46d9124109972489eccfb404Andrei Emeltchenko 226466f8004f364e9cb46d9124109972489eccfb404Andrei Emeltchenko chan->ops = &a2mp_chan_ops; 227466f8004f364e9cb46d9124109972489eccfb404Andrei Emeltchenko 228466f8004f364e9cb46d9124109972489eccfb404Andrei Emeltchenko l2cap_chan_set_defaults(chan); 229466f8004f364e9cb46d9124109972489eccfb404Andrei Emeltchenko chan->remote_max_tx = chan->max_tx; 230466f8004f364e9cb46d9124109972489eccfb404Andrei Emeltchenko chan->remote_tx_win = chan->tx_win; 231466f8004f364e9cb46d9124109972489eccfb404Andrei Emeltchenko 232466f8004f364e9cb46d9124109972489eccfb404Andrei Emeltchenko chan->retrans_timeout = L2CAP_DEFAULT_RETRANS_TO; 233466f8004f364e9cb46d9124109972489eccfb404Andrei Emeltchenko chan->monitor_timeout = L2CAP_DEFAULT_MONITOR_TO; 234466f8004f364e9cb46d9124109972489eccfb404Andrei Emeltchenko 235466f8004f364e9cb46d9124109972489eccfb404Andrei Emeltchenko skb_queue_head_init(&chan->tx_q); 236466f8004f364e9cb46d9124109972489eccfb404Andrei Emeltchenko 237466f8004f364e9cb46d9124109972489eccfb404Andrei Emeltchenko chan->mode = L2CAP_MODE_ERTM; 238466f8004f364e9cb46d9124109972489eccfb404Andrei Emeltchenko 239466f8004f364e9cb46d9124109972489eccfb404Andrei Emeltchenko err = l2cap_ertm_init(chan); 240466f8004f364e9cb46d9124109972489eccfb404Andrei Emeltchenko if (err < 0) { 241466f8004f364e9cb46d9124109972489eccfb404Andrei Emeltchenko l2cap_chan_del(chan, 0); 242466f8004f364e9cb46d9124109972489eccfb404Andrei Emeltchenko return NULL; 243466f8004f364e9cb46d9124109972489eccfb404Andrei Emeltchenko } 244466f8004f364e9cb46d9124109972489eccfb404Andrei Emeltchenko 245466f8004f364e9cb46d9124109972489eccfb404Andrei Emeltchenko chan->conf_state = 0; 246466f8004f364e9cb46d9124109972489eccfb404Andrei Emeltchenko 247466f8004f364e9cb46d9124109972489eccfb404Andrei Emeltchenko l2cap_chan_add(conn, chan); 248466f8004f364e9cb46d9124109972489eccfb404Andrei Emeltchenko 249466f8004f364e9cb46d9124109972489eccfb404Andrei Emeltchenko chan->remote_mps = chan->omtu; 250466f8004f364e9cb46d9124109972489eccfb404Andrei Emeltchenko chan->mps = chan->omtu; 251466f8004f364e9cb46d9124109972489eccfb404Andrei Emeltchenko 252466f8004f364e9cb46d9124109972489eccfb404Andrei Emeltchenko chan->state = BT_CONNECTED; 253466f8004f364e9cb46d9124109972489eccfb404Andrei Emeltchenko 254466f8004f364e9cb46d9124109972489eccfb404Andrei Emeltchenko return chan; 255466f8004f364e9cb46d9124109972489eccfb404Andrei Emeltchenko} 2569740e49d17e55f3832661fd99a8e0a17e921a82eAndrei Emeltchenko 2579740e49d17e55f3832661fd99a8e0a17e921a82eAndrei Emeltchenko/* AMP Manager functions */ 2589740e49d17e55f3832661fd99a8e0a17e921a82eAndrei Emeltchenkovoid amp_mgr_get(struct amp_mgr *mgr) 2599740e49d17e55f3832661fd99a8e0a17e921a82eAndrei Emeltchenko{ 2609740e49d17e55f3832661fd99a8e0a17e921a82eAndrei Emeltchenko BT_DBG("mgr %p", mgr); 2619740e49d17e55f3832661fd99a8e0a17e921a82eAndrei Emeltchenko 2629740e49d17e55f3832661fd99a8e0a17e921a82eAndrei Emeltchenko kref_get(&mgr->kref); 2639740e49d17e55f3832661fd99a8e0a17e921a82eAndrei Emeltchenko} 2649740e49d17e55f3832661fd99a8e0a17e921a82eAndrei Emeltchenko 2659740e49d17e55f3832661fd99a8e0a17e921a82eAndrei Emeltchenkostatic void amp_mgr_destroy(struct kref *kref) 2669740e49d17e55f3832661fd99a8e0a17e921a82eAndrei Emeltchenko{ 2679740e49d17e55f3832661fd99a8e0a17e921a82eAndrei Emeltchenko struct amp_mgr *mgr = container_of(kref, struct amp_mgr, kref); 2689740e49d17e55f3832661fd99a8e0a17e921a82eAndrei Emeltchenko 2699740e49d17e55f3832661fd99a8e0a17e921a82eAndrei Emeltchenko BT_DBG("mgr %p", mgr); 2709740e49d17e55f3832661fd99a8e0a17e921a82eAndrei Emeltchenko 2719740e49d17e55f3832661fd99a8e0a17e921a82eAndrei Emeltchenko kfree(mgr); 2729740e49d17e55f3832661fd99a8e0a17e921a82eAndrei Emeltchenko} 2739740e49d17e55f3832661fd99a8e0a17e921a82eAndrei Emeltchenko 2749740e49d17e55f3832661fd99a8e0a17e921a82eAndrei Emeltchenkoint amp_mgr_put(struct amp_mgr *mgr) 2759740e49d17e55f3832661fd99a8e0a17e921a82eAndrei Emeltchenko{ 2769740e49d17e55f3832661fd99a8e0a17e921a82eAndrei Emeltchenko BT_DBG("mgr %p", mgr); 2779740e49d17e55f3832661fd99a8e0a17e921a82eAndrei Emeltchenko 2789740e49d17e55f3832661fd99a8e0a17e921a82eAndrei Emeltchenko return kref_put(&mgr->kref, &_mgr_destroy); 2799740e49d17e55f3832661fd99a8e0a17e921a82eAndrei Emeltchenko} 2809740e49d17e55f3832661fd99a8e0a17e921a82eAndrei Emeltchenko 2819740e49d17e55f3832661fd99a8e0a17e921a82eAndrei Emeltchenkostatic struct amp_mgr *amp_mgr_create(struct l2cap_conn *conn) 2829740e49d17e55f3832661fd99a8e0a17e921a82eAndrei Emeltchenko{ 2839740e49d17e55f3832661fd99a8e0a17e921a82eAndrei Emeltchenko struct amp_mgr *mgr; 2849740e49d17e55f3832661fd99a8e0a17e921a82eAndrei Emeltchenko struct l2cap_chan *chan; 2859740e49d17e55f3832661fd99a8e0a17e921a82eAndrei Emeltchenko 2869740e49d17e55f3832661fd99a8e0a17e921a82eAndrei Emeltchenko mgr = kzalloc(sizeof(*mgr), GFP_KERNEL); 2879740e49d17e55f3832661fd99a8e0a17e921a82eAndrei Emeltchenko if (!mgr) 2889740e49d17e55f3832661fd99a8e0a17e921a82eAndrei Emeltchenko return NULL; 2899740e49d17e55f3832661fd99a8e0a17e921a82eAndrei Emeltchenko 2909740e49d17e55f3832661fd99a8e0a17e921a82eAndrei Emeltchenko BT_DBG("conn %p mgr %p", conn, mgr); 2919740e49d17e55f3832661fd99a8e0a17e921a82eAndrei Emeltchenko 2929740e49d17e55f3832661fd99a8e0a17e921a82eAndrei Emeltchenko mgr->l2cap_conn = conn; 2939740e49d17e55f3832661fd99a8e0a17e921a82eAndrei Emeltchenko 2949740e49d17e55f3832661fd99a8e0a17e921a82eAndrei Emeltchenko chan = a2mp_chan_open(conn); 2959740e49d17e55f3832661fd99a8e0a17e921a82eAndrei Emeltchenko if (!chan) { 2969740e49d17e55f3832661fd99a8e0a17e921a82eAndrei Emeltchenko kfree(mgr); 2979740e49d17e55f3832661fd99a8e0a17e921a82eAndrei Emeltchenko return NULL; 2989740e49d17e55f3832661fd99a8e0a17e921a82eAndrei Emeltchenko } 2999740e49d17e55f3832661fd99a8e0a17e921a82eAndrei Emeltchenko 3009740e49d17e55f3832661fd99a8e0a17e921a82eAndrei Emeltchenko mgr->a2mp_chan = chan; 3019740e49d17e55f3832661fd99a8e0a17e921a82eAndrei Emeltchenko chan->data = mgr; 3029740e49d17e55f3832661fd99a8e0a17e921a82eAndrei Emeltchenko 3039740e49d17e55f3832661fd99a8e0a17e921a82eAndrei Emeltchenko conn->hcon->amp_mgr = mgr; 3049740e49d17e55f3832661fd99a8e0a17e921a82eAndrei Emeltchenko 3059740e49d17e55f3832661fd99a8e0a17e921a82eAndrei Emeltchenko kref_init(&mgr->kref); 3069740e49d17e55f3832661fd99a8e0a17e921a82eAndrei Emeltchenko 3079740e49d17e55f3832661fd99a8e0a17e921a82eAndrei Emeltchenko return mgr; 3089740e49d17e55f3832661fd99a8e0a17e921a82eAndrei Emeltchenko} 309