a2mp.c revision 6b44d9b8d96b37f72ccd7335b32f386a67b7f1f4
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 666b44d9b8d96b37f72ccd7335b32f386a67b7f1f4Andrei Emeltchenko/* Handle A2MP signalling */ 676b44d9b8d96b37f72ccd7335b32f386a67b7f1f4Andrei Emeltchenkostatic int a2mp_chan_recv_cb(struct l2cap_chan *chan, struct sk_buff *skb) 686b44d9b8d96b37f72ccd7335b32f386a67b7f1f4Andrei Emeltchenko{ 696b44d9b8d96b37f72ccd7335b32f386a67b7f1f4Andrei Emeltchenko struct a2mp_cmd *hdr = (void *) skb->data; 706b44d9b8d96b37f72ccd7335b32f386a67b7f1f4Andrei Emeltchenko struct amp_mgr *mgr = chan->data; 716b44d9b8d96b37f72ccd7335b32f386a67b7f1f4Andrei Emeltchenko int err = 0; 726b44d9b8d96b37f72ccd7335b32f386a67b7f1f4Andrei Emeltchenko 736b44d9b8d96b37f72ccd7335b32f386a67b7f1f4Andrei Emeltchenko amp_mgr_get(mgr); 746b44d9b8d96b37f72ccd7335b32f386a67b7f1f4Andrei Emeltchenko 756b44d9b8d96b37f72ccd7335b32f386a67b7f1f4Andrei Emeltchenko while (skb->len >= sizeof(*hdr)) { 766b44d9b8d96b37f72ccd7335b32f386a67b7f1f4Andrei Emeltchenko struct a2mp_cmd *hdr = (void *) skb->data; 776b44d9b8d96b37f72ccd7335b32f386a67b7f1f4Andrei Emeltchenko u16 len = le16_to_cpu(hdr->len); 786b44d9b8d96b37f72ccd7335b32f386a67b7f1f4Andrei Emeltchenko 796b44d9b8d96b37f72ccd7335b32f386a67b7f1f4Andrei Emeltchenko BT_DBG("code 0x%02x id %d len %d", hdr->code, hdr->ident, len); 806b44d9b8d96b37f72ccd7335b32f386a67b7f1f4Andrei Emeltchenko 816b44d9b8d96b37f72ccd7335b32f386a67b7f1f4Andrei Emeltchenko skb_pull(skb, sizeof(*hdr)); 826b44d9b8d96b37f72ccd7335b32f386a67b7f1f4Andrei Emeltchenko 836b44d9b8d96b37f72ccd7335b32f386a67b7f1f4Andrei Emeltchenko if (len > skb->len || !hdr->ident) { 846b44d9b8d96b37f72ccd7335b32f386a67b7f1f4Andrei Emeltchenko err = -EINVAL; 856b44d9b8d96b37f72ccd7335b32f386a67b7f1f4Andrei Emeltchenko break; 866b44d9b8d96b37f72ccd7335b32f386a67b7f1f4Andrei Emeltchenko } 876b44d9b8d96b37f72ccd7335b32f386a67b7f1f4Andrei Emeltchenko 886b44d9b8d96b37f72ccd7335b32f386a67b7f1f4Andrei Emeltchenko mgr->ident = hdr->ident; 896b44d9b8d96b37f72ccd7335b32f386a67b7f1f4Andrei Emeltchenko 906b44d9b8d96b37f72ccd7335b32f386a67b7f1f4Andrei Emeltchenko switch (hdr->code) { 916b44d9b8d96b37f72ccd7335b32f386a67b7f1f4Andrei Emeltchenko case A2MP_COMMAND_REJ: 926b44d9b8d96b37f72ccd7335b32f386a67b7f1f4Andrei Emeltchenko case A2MP_DISCOVER_REQ: 936b44d9b8d96b37f72ccd7335b32f386a67b7f1f4Andrei Emeltchenko case A2MP_CHANGE_NOTIFY: 946b44d9b8d96b37f72ccd7335b32f386a67b7f1f4Andrei Emeltchenko case A2MP_GETINFO_REQ: 956b44d9b8d96b37f72ccd7335b32f386a67b7f1f4Andrei Emeltchenko case A2MP_GETAMPASSOC_REQ: 966b44d9b8d96b37f72ccd7335b32f386a67b7f1f4Andrei Emeltchenko case A2MP_CREATEPHYSLINK_REQ: 976b44d9b8d96b37f72ccd7335b32f386a67b7f1f4Andrei Emeltchenko case A2MP_DISCONNPHYSLINK_REQ: 986b44d9b8d96b37f72ccd7335b32f386a67b7f1f4Andrei Emeltchenko case A2MP_CHANGE_RSP: 996b44d9b8d96b37f72ccd7335b32f386a67b7f1f4Andrei Emeltchenko case A2MP_DISCOVER_RSP: 1006b44d9b8d96b37f72ccd7335b32f386a67b7f1f4Andrei Emeltchenko case A2MP_GETINFO_RSP: 1016b44d9b8d96b37f72ccd7335b32f386a67b7f1f4Andrei Emeltchenko case A2MP_GETAMPASSOC_RSP: 1026b44d9b8d96b37f72ccd7335b32f386a67b7f1f4Andrei Emeltchenko case A2MP_CREATEPHYSLINK_RSP: 1036b44d9b8d96b37f72ccd7335b32f386a67b7f1f4Andrei Emeltchenko case A2MP_DISCONNPHYSLINK_RSP: 1046b44d9b8d96b37f72ccd7335b32f386a67b7f1f4Andrei Emeltchenko default: 1056b44d9b8d96b37f72ccd7335b32f386a67b7f1f4Andrei Emeltchenko BT_ERR("Unknown A2MP sig cmd 0x%2.2x", hdr->code); 1066b44d9b8d96b37f72ccd7335b32f386a67b7f1f4Andrei Emeltchenko err = -EINVAL; 1076b44d9b8d96b37f72ccd7335b32f386a67b7f1f4Andrei Emeltchenko break; 1086b44d9b8d96b37f72ccd7335b32f386a67b7f1f4Andrei Emeltchenko } 1096b44d9b8d96b37f72ccd7335b32f386a67b7f1f4Andrei Emeltchenko } 1106b44d9b8d96b37f72ccd7335b32f386a67b7f1f4Andrei Emeltchenko 1116b44d9b8d96b37f72ccd7335b32f386a67b7f1f4Andrei Emeltchenko if (err) { 1126b44d9b8d96b37f72ccd7335b32f386a67b7f1f4Andrei Emeltchenko struct a2mp_cmd_rej rej; 1136b44d9b8d96b37f72ccd7335b32f386a67b7f1f4Andrei Emeltchenko rej.reason = __constant_cpu_to_le16(0); 1146b44d9b8d96b37f72ccd7335b32f386a67b7f1f4Andrei Emeltchenko 1156b44d9b8d96b37f72ccd7335b32f386a67b7f1f4Andrei Emeltchenko BT_DBG("Send A2MP Rej: cmd 0x%2.2x err %d", hdr->code, err); 1166b44d9b8d96b37f72ccd7335b32f386a67b7f1f4Andrei Emeltchenko 1176b44d9b8d96b37f72ccd7335b32f386a67b7f1f4Andrei Emeltchenko a2mp_send(mgr, A2MP_COMMAND_REJ, hdr->ident, sizeof(rej), 1186b44d9b8d96b37f72ccd7335b32f386a67b7f1f4Andrei Emeltchenko &rej); 1196b44d9b8d96b37f72ccd7335b32f386a67b7f1f4Andrei Emeltchenko } 1206b44d9b8d96b37f72ccd7335b32f386a67b7f1f4Andrei Emeltchenko 1216b44d9b8d96b37f72ccd7335b32f386a67b7f1f4Andrei Emeltchenko /* Always free skb and return success error code to prevent 1226b44d9b8d96b37f72ccd7335b32f386a67b7f1f4Andrei Emeltchenko from sending L2CAP Disconnect over A2MP channel */ 1236b44d9b8d96b37f72ccd7335b32f386a67b7f1f4Andrei Emeltchenko kfree_skb(skb); 1246b44d9b8d96b37f72ccd7335b32f386a67b7f1f4Andrei Emeltchenko 1256b44d9b8d96b37f72ccd7335b32f386a67b7f1f4Andrei Emeltchenko amp_mgr_put(mgr); 1266b44d9b8d96b37f72ccd7335b32f386a67b7f1f4Andrei Emeltchenko 1276b44d9b8d96b37f72ccd7335b32f386a67b7f1f4Andrei Emeltchenko return 0; 1286b44d9b8d96b37f72ccd7335b32f386a67b7f1f4Andrei Emeltchenko} 1296b44d9b8d96b37f72ccd7335b32f386a67b7f1f4Andrei Emeltchenko 13046d5c9088fbcc8a570bc271f77940973d9cae074Andrei Emeltchenkostatic void a2mp_chan_close_cb(struct l2cap_chan *chan) 13146d5c9088fbcc8a570bc271f77940973d9cae074Andrei Emeltchenko{ 13246d5c9088fbcc8a570bc271f77940973d9cae074Andrei Emeltchenko l2cap_chan_destroy(chan); 13346d5c9088fbcc8a570bc271f77940973d9cae074Andrei Emeltchenko} 13446d5c9088fbcc8a570bc271f77940973d9cae074Andrei Emeltchenko 13546d5c9088fbcc8a570bc271f77940973d9cae074Andrei Emeltchenkostatic void a2mp_chan_state_change_cb(struct l2cap_chan *chan, int state) 13646d5c9088fbcc8a570bc271f77940973d9cae074Andrei Emeltchenko{ 13746d5c9088fbcc8a570bc271f77940973d9cae074Andrei Emeltchenko struct amp_mgr *mgr = chan->data; 13846d5c9088fbcc8a570bc271f77940973d9cae074Andrei Emeltchenko 13946d5c9088fbcc8a570bc271f77940973d9cae074Andrei Emeltchenko if (!mgr) 14046d5c9088fbcc8a570bc271f77940973d9cae074Andrei Emeltchenko return; 14146d5c9088fbcc8a570bc271f77940973d9cae074Andrei Emeltchenko 14246d5c9088fbcc8a570bc271f77940973d9cae074Andrei Emeltchenko BT_DBG("chan %p state %s", chan, state_to_string(state)); 14346d5c9088fbcc8a570bc271f77940973d9cae074Andrei Emeltchenko 14446d5c9088fbcc8a570bc271f77940973d9cae074Andrei Emeltchenko chan->state = state; 14546d5c9088fbcc8a570bc271f77940973d9cae074Andrei Emeltchenko 14646d5c9088fbcc8a570bc271f77940973d9cae074Andrei Emeltchenko switch (state) { 14746d5c9088fbcc8a570bc271f77940973d9cae074Andrei Emeltchenko case BT_CLOSED: 14846d5c9088fbcc8a570bc271f77940973d9cae074Andrei Emeltchenko if (mgr) 14946d5c9088fbcc8a570bc271f77940973d9cae074Andrei Emeltchenko amp_mgr_put(mgr); 15046d5c9088fbcc8a570bc271f77940973d9cae074Andrei Emeltchenko break; 15146d5c9088fbcc8a570bc271f77940973d9cae074Andrei Emeltchenko } 15246d5c9088fbcc8a570bc271f77940973d9cae074Andrei Emeltchenko} 15346d5c9088fbcc8a570bc271f77940973d9cae074Andrei Emeltchenko 15446d5c9088fbcc8a570bc271f77940973d9cae074Andrei Emeltchenkostatic struct sk_buff *a2mp_chan_alloc_skb_cb(struct l2cap_chan *chan, 15546d5c9088fbcc8a570bc271f77940973d9cae074Andrei Emeltchenko unsigned long len, int nb) 15646d5c9088fbcc8a570bc271f77940973d9cae074Andrei Emeltchenko{ 15746d5c9088fbcc8a570bc271f77940973d9cae074Andrei Emeltchenko return bt_skb_alloc(len, GFP_KERNEL); 15846d5c9088fbcc8a570bc271f77940973d9cae074Andrei Emeltchenko} 15946d5c9088fbcc8a570bc271f77940973d9cae074Andrei Emeltchenko 16046d5c9088fbcc8a570bc271f77940973d9cae074Andrei Emeltchenkostatic struct l2cap_chan *a2mp_chan_no_new_conn_cb(struct l2cap_chan *chan) 16146d5c9088fbcc8a570bc271f77940973d9cae074Andrei Emeltchenko{ 16246d5c9088fbcc8a570bc271f77940973d9cae074Andrei Emeltchenko BT_ERR("new_connection for chan %p not implemented", chan); 16346d5c9088fbcc8a570bc271f77940973d9cae074Andrei Emeltchenko 16446d5c9088fbcc8a570bc271f77940973d9cae074Andrei Emeltchenko return NULL; 16546d5c9088fbcc8a570bc271f77940973d9cae074Andrei Emeltchenko} 16646d5c9088fbcc8a570bc271f77940973d9cae074Andrei Emeltchenko 16746d5c9088fbcc8a570bc271f77940973d9cae074Andrei Emeltchenkostatic void a2mp_chan_no_teardown_cb(struct l2cap_chan *chan, int err) 16846d5c9088fbcc8a570bc271f77940973d9cae074Andrei Emeltchenko{ 16946d5c9088fbcc8a570bc271f77940973d9cae074Andrei Emeltchenko BT_ERR("teardown for chan %p not implemented", chan); 17046d5c9088fbcc8a570bc271f77940973d9cae074Andrei Emeltchenko} 17146d5c9088fbcc8a570bc271f77940973d9cae074Andrei Emeltchenko 17246d5c9088fbcc8a570bc271f77940973d9cae074Andrei Emeltchenkostatic void a2mp_chan_no_ready(struct l2cap_chan *chan) 17346d5c9088fbcc8a570bc271f77940973d9cae074Andrei Emeltchenko{ 17446d5c9088fbcc8a570bc271f77940973d9cae074Andrei Emeltchenko BT_ERR("ready for chan %p not implemented", chan); 17546d5c9088fbcc8a570bc271f77940973d9cae074Andrei Emeltchenko} 17646d5c9088fbcc8a570bc271f77940973d9cae074Andrei Emeltchenko 177466f8004f364e9cb46d9124109972489eccfb404Andrei Emeltchenkostatic struct l2cap_ops a2mp_chan_ops = { 178466f8004f364e9cb46d9124109972489eccfb404Andrei Emeltchenko .name = "L2CAP A2MP channel", 1796b44d9b8d96b37f72ccd7335b32f386a67b7f1f4Andrei Emeltchenko .recv = a2mp_chan_recv_cb, 18046d5c9088fbcc8a570bc271f77940973d9cae074Andrei Emeltchenko .close = a2mp_chan_close_cb, 18146d5c9088fbcc8a570bc271f77940973d9cae074Andrei Emeltchenko .state_change = a2mp_chan_state_change_cb, 18246d5c9088fbcc8a570bc271f77940973d9cae074Andrei Emeltchenko .alloc_skb = a2mp_chan_alloc_skb_cb, 18346d5c9088fbcc8a570bc271f77940973d9cae074Andrei Emeltchenko 18446d5c9088fbcc8a570bc271f77940973d9cae074Andrei Emeltchenko /* Not implemented for A2MP */ 18546d5c9088fbcc8a570bc271f77940973d9cae074Andrei Emeltchenko .new_connection = a2mp_chan_no_new_conn_cb, 18646d5c9088fbcc8a570bc271f77940973d9cae074Andrei Emeltchenko .teardown = a2mp_chan_no_teardown_cb, 18746d5c9088fbcc8a570bc271f77940973d9cae074Andrei Emeltchenko .ready = a2mp_chan_no_ready, 188466f8004f364e9cb46d9124109972489eccfb404Andrei Emeltchenko}; 189466f8004f364e9cb46d9124109972489eccfb404Andrei Emeltchenko 190466f8004f364e9cb46d9124109972489eccfb404Andrei Emeltchenkostatic struct l2cap_chan *a2mp_chan_open(struct l2cap_conn *conn) 191466f8004f364e9cb46d9124109972489eccfb404Andrei Emeltchenko{ 192466f8004f364e9cb46d9124109972489eccfb404Andrei Emeltchenko struct l2cap_chan *chan; 193466f8004f364e9cb46d9124109972489eccfb404Andrei Emeltchenko int err; 194466f8004f364e9cb46d9124109972489eccfb404Andrei Emeltchenko 195466f8004f364e9cb46d9124109972489eccfb404Andrei Emeltchenko chan = l2cap_chan_create(); 196466f8004f364e9cb46d9124109972489eccfb404Andrei Emeltchenko if (!chan) 197466f8004f364e9cb46d9124109972489eccfb404Andrei Emeltchenko return NULL; 198466f8004f364e9cb46d9124109972489eccfb404Andrei Emeltchenko 199466f8004f364e9cb46d9124109972489eccfb404Andrei Emeltchenko BT_DBG("chan %p", chan); 200466f8004f364e9cb46d9124109972489eccfb404Andrei Emeltchenko 201466f8004f364e9cb46d9124109972489eccfb404Andrei Emeltchenko hci_conn_hold(conn->hcon); 202466f8004f364e9cb46d9124109972489eccfb404Andrei Emeltchenko 203466f8004f364e9cb46d9124109972489eccfb404Andrei Emeltchenko chan->omtu = L2CAP_A2MP_DEFAULT_MTU; 204466f8004f364e9cb46d9124109972489eccfb404Andrei Emeltchenko chan->imtu = L2CAP_A2MP_DEFAULT_MTU; 205466f8004f364e9cb46d9124109972489eccfb404Andrei Emeltchenko chan->flush_to = L2CAP_DEFAULT_FLUSH_TO; 206466f8004f364e9cb46d9124109972489eccfb404Andrei Emeltchenko 207466f8004f364e9cb46d9124109972489eccfb404Andrei Emeltchenko chan->ops = &a2mp_chan_ops; 208466f8004f364e9cb46d9124109972489eccfb404Andrei Emeltchenko 209466f8004f364e9cb46d9124109972489eccfb404Andrei Emeltchenko l2cap_chan_set_defaults(chan); 210466f8004f364e9cb46d9124109972489eccfb404Andrei Emeltchenko chan->remote_max_tx = chan->max_tx; 211466f8004f364e9cb46d9124109972489eccfb404Andrei Emeltchenko chan->remote_tx_win = chan->tx_win; 212466f8004f364e9cb46d9124109972489eccfb404Andrei Emeltchenko 213466f8004f364e9cb46d9124109972489eccfb404Andrei Emeltchenko chan->retrans_timeout = L2CAP_DEFAULT_RETRANS_TO; 214466f8004f364e9cb46d9124109972489eccfb404Andrei Emeltchenko chan->monitor_timeout = L2CAP_DEFAULT_MONITOR_TO; 215466f8004f364e9cb46d9124109972489eccfb404Andrei Emeltchenko 216466f8004f364e9cb46d9124109972489eccfb404Andrei Emeltchenko skb_queue_head_init(&chan->tx_q); 217466f8004f364e9cb46d9124109972489eccfb404Andrei Emeltchenko 218466f8004f364e9cb46d9124109972489eccfb404Andrei Emeltchenko chan->mode = L2CAP_MODE_ERTM; 219466f8004f364e9cb46d9124109972489eccfb404Andrei Emeltchenko 220466f8004f364e9cb46d9124109972489eccfb404Andrei Emeltchenko err = l2cap_ertm_init(chan); 221466f8004f364e9cb46d9124109972489eccfb404Andrei Emeltchenko if (err < 0) { 222466f8004f364e9cb46d9124109972489eccfb404Andrei Emeltchenko l2cap_chan_del(chan, 0); 223466f8004f364e9cb46d9124109972489eccfb404Andrei Emeltchenko return NULL; 224466f8004f364e9cb46d9124109972489eccfb404Andrei Emeltchenko } 225466f8004f364e9cb46d9124109972489eccfb404Andrei Emeltchenko 226466f8004f364e9cb46d9124109972489eccfb404Andrei Emeltchenko chan->conf_state = 0; 227466f8004f364e9cb46d9124109972489eccfb404Andrei Emeltchenko 228466f8004f364e9cb46d9124109972489eccfb404Andrei Emeltchenko l2cap_chan_add(conn, chan); 229466f8004f364e9cb46d9124109972489eccfb404Andrei Emeltchenko 230466f8004f364e9cb46d9124109972489eccfb404Andrei Emeltchenko chan->remote_mps = chan->omtu; 231466f8004f364e9cb46d9124109972489eccfb404Andrei Emeltchenko chan->mps = chan->omtu; 232466f8004f364e9cb46d9124109972489eccfb404Andrei Emeltchenko 233466f8004f364e9cb46d9124109972489eccfb404Andrei Emeltchenko chan->state = BT_CONNECTED; 234466f8004f364e9cb46d9124109972489eccfb404Andrei Emeltchenko 235466f8004f364e9cb46d9124109972489eccfb404Andrei Emeltchenko return chan; 236466f8004f364e9cb46d9124109972489eccfb404Andrei Emeltchenko} 2379740e49d17e55f3832661fd99a8e0a17e921a82eAndrei Emeltchenko 2389740e49d17e55f3832661fd99a8e0a17e921a82eAndrei Emeltchenko/* AMP Manager functions */ 2399740e49d17e55f3832661fd99a8e0a17e921a82eAndrei Emeltchenkovoid amp_mgr_get(struct amp_mgr *mgr) 2409740e49d17e55f3832661fd99a8e0a17e921a82eAndrei Emeltchenko{ 2419740e49d17e55f3832661fd99a8e0a17e921a82eAndrei Emeltchenko BT_DBG("mgr %p", mgr); 2429740e49d17e55f3832661fd99a8e0a17e921a82eAndrei Emeltchenko 2439740e49d17e55f3832661fd99a8e0a17e921a82eAndrei Emeltchenko kref_get(&mgr->kref); 2449740e49d17e55f3832661fd99a8e0a17e921a82eAndrei Emeltchenko} 2459740e49d17e55f3832661fd99a8e0a17e921a82eAndrei Emeltchenko 2469740e49d17e55f3832661fd99a8e0a17e921a82eAndrei Emeltchenkostatic void amp_mgr_destroy(struct kref *kref) 2479740e49d17e55f3832661fd99a8e0a17e921a82eAndrei Emeltchenko{ 2489740e49d17e55f3832661fd99a8e0a17e921a82eAndrei Emeltchenko struct amp_mgr *mgr = container_of(kref, struct amp_mgr, kref); 2499740e49d17e55f3832661fd99a8e0a17e921a82eAndrei Emeltchenko 2509740e49d17e55f3832661fd99a8e0a17e921a82eAndrei Emeltchenko BT_DBG("mgr %p", mgr); 2519740e49d17e55f3832661fd99a8e0a17e921a82eAndrei Emeltchenko 2529740e49d17e55f3832661fd99a8e0a17e921a82eAndrei Emeltchenko kfree(mgr); 2539740e49d17e55f3832661fd99a8e0a17e921a82eAndrei Emeltchenko} 2549740e49d17e55f3832661fd99a8e0a17e921a82eAndrei Emeltchenko 2559740e49d17e55f3832661fd99a8e0a17e921a82eAndrei Emeltchenkoint amp_mgr_put(struct amp_mgr *mgr) 2569740e49d17e55f3832661fd99a8e0a17e921a82eAndrei Emeltchenko{ 2579740e49d17e55f3832661fd99a8e0a17e921a82eAndrei Emeltchenko BT_DBG("mgr %p", mgr); 2589740e49d17e55f3832661fd99a8e0a17e921a82eAndrei Emeltchenko 2599740e49d17e55f3832661fd99a8e0a17e921a82eAndrei Emeltchenko return kref_put(&mgr->kref, &_mgr_destroy); 2609740e49d17e55f3832661fd99a8e0a17e921a82eAndrei Emeltchenko} 2619740e49d17e55f3832661fd99a8e0a17e921a82eAndrei Emeltchenko 2629740e49d17e55f3832661fd99a8e0a17e921a82eAndrei Emeltchenkostatic struct amp_mgr *amp_mgr_create(struct l2cap_conn *conn) 2639740e49d17e55f3832661fd99a8e0a17e921a82eAndrei Emeltchenko{ 2649740e49d17e55f3832661fd99a8e0a17e921a82eAndrei Emeltchenko struct amp_mgr *mgr; 2659740e49d17e55f3832661fd99a8e0a17e921a82eAndrei Emeltchenko struct l2cap_chan *chan; 2669740e49d17e55f3832661fd99a8e0a17e921a82eAndrei Emeltchenko 2679740e49d17e55f3832661fd99a8e0a17e921a82eAndrei Emeltchenko mgr = kzalloc(sizeof(*mgr), GFP_KERNEL); 2689740e49d17e55f3832661fd99a8e0a17e921a82eAndrei Emeltchenko if (!mgr) 2699740e49d17e55f3832661fd99a8e0a17e921a82eAndrei Emeltchenko return NULL; 2709740e49d17e55f3832661fd99a8e0a17e921a82eAndrei Emeltchenko 2719740e49d17e55f3832661fd99a8e0a17e921a82eAndrei Emeltchenko BT_DBG("conn %p mgr %p", conn, mgr); 2729740e49d17e55f3832661fd99a8e0a17e921a82eAndrei Emeltchenko 2739740e49d17e55f3832661fd99a8e0a17e921a82eAndrei Emeltchenko mgr->l2cap_conn = conn; 2749740e49d17e55f3832661fd99a8e0a17e921a82eAndrei Emeltchenko 2759740e49d17e55f3832661fd99a8e0a17e921a82eAndrei Emeltchenko chan = a2mp_chan_open(conn); 2769740e49d17e55f3832661fd99a8e0a17e921a82eAndrei Emeltchenko if (!chan) { 2779740e49d17e55f3832661fd99a8e0a17e921a82eAndrei Emeltchenko kfree(mgr); 2789740e49d17e55f3832661fd99a8e0a17e921a82eAndrei Emeltchenko return NULL; 2799740e49d17e55f3832661fd99a8e0a17e921a82eAndrei Emeltchenko } 2809740e49d17e55f3832661fd99a8e0a17e921a82eAndrei Emeltchenko 2819740e49d17e55f3832661fd99a8e0a17e921a82eAndrei Emeltchenko mgr->a2mp_chan = chan; 2829740e49d17e55f3832661fd99a8e0a17e921a82eAndrei Emeltchenko chan->data = mgr; 2839740e49d17e55f3832661fd99a8e0a17e921a82eAndrei Emeltchenko 2849740e49d17e55f3832661fd99a8e0a17e921a82eAndrei Emeltchenko conn->hcon->amp_mgr = mgr; 2859740e49d17e55f3832661fd99a8e0a17e921a82eAndrei Emeltchenko 2869740e49d17e55f3832661fd99a8e0a17e921a82eAndrei Emeltchenko kref_init(&mgr->kref); 2879740e49d17e55f3832661fd99a8e0a17e921a82eAndrei Emeltchenko 2889740e49d17e55f3832661fd99a8e0a17e921a82eAndrei Emeltchenko return mgr; 2899740e49d17e55f3832661fd99a8e0a17e921a82eAndrei Emeltchenko} 290