a2mp.c revision 46d5c9088fbcc8a570bc271f77940973d9cae074
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 6646d5c9088fbcc8a570bc271f77940973d9cae074Andrei Emeltchenkostatic void a2mp_chan_close_cb(struct l2cap_chan *chan) 6746d5c9088fbcc8a570bc271f77940973d9cae074Andrei Emeltchenko{ 6846d5c9088fbcc8a570bc271f77940973d9cae074Andrei Emeltchenko l2cap_chan_destroy(chan); 6946d5c9088fbcc8a570bc271f77940973d9cae074Andrei Emeltchenko} 7046d5c9088fbcc8a570bc271f77940973d9cae074Andrei Emeltchenko 7146d5c9088fbcc8a570bc271f77940973d9cae074Andrei Emeltchenkostatic void a2mp_chan_state_change_cb(struct l2cap_chan *chan, int state) 7246d5c9088fbcc8a570bc271f77940973d9cae074Andrei Emeltchenko{ 7346d5c9088fbcc8a570bc271f77940973d9cae074Andrei Emeltchenko struct amp_mgr *mgr = chan->data; 7446d5c9088fbcc8a570bc271f77940973d9cae074Andrei Emeltchenko 7546d5c9088fbcc8a570bc271f77940973d9cae074Andrei Emeltchenko if (!mgr) 7646d5c9088fbcc8a570bc271f77940973d9cae074Andrei Emeltchenko return; 7746d5c9088fbcc8a570bc271f77940973d9cae074Andrei Emeltchenko 7846d5c9088fbcc8a570bc271f77940973d9cae074Andrei Emeltchenko BT_DBG("chan %p state %s", chan, state_to_string(state)); 7946d5c9088fbcc8a570bc271f77940973d9cae074Andrei Emeltchenko 8046d5c9088fbcc8a570bc271f77940973d9cae074Andrei Emeltchenko chan->state = state; 8146d5c9088fbcc8a570bc271f77940973d9cae074Andrei Emeltchenko 8246d5c9088fbcc8a570bc271f77940973d9cae074Andrei Emeltchenko switch (state) { 8346d5c9088fbcc8a570bc271f77940973d9cae074Andrei Emeltchenko case BT_CLOSED: 8446d5c9088fbcc8a570bc271f77940973d9cae074Andrei Emeltchenko if (mgr) 8546d5c9088fbcc8a570bc271f77940973d9cae074Andrei Emeltchenko amp_mgr_put(mgr); 8646d5c9088fbcc8a570bc271f77940973d9cae074Andrei Emeltchenko break; 8746d5c9088fbcc8a570bc271f77940973d9cae074Andrei Emeltchenko } 8846d5c9088fbcc8a570bc271f77940973d9cae074Andrei Emeltchenko} 8946d5c9088fbcc8a570bc271f77940973d9cae074Andrei Emeltchenko 9046d5c9088fbcc8a570bc271f77940973d9cae074Andrei Emeltchenkostatic struct sk_buff *a2mp_chan_alloc_skb_cb(struct l2cap_chan *chan, 9146d5c9088fbcc8a570bc271f77940973d9cae074Andrei Emeltchenko unsigned long len, int nb) 9246d5c9088fbcc8a570bc271f77940973d9cae074Andrei Emeltchenko{ 9346d5c9088fbcc8a570bc271f77940973d9cae074Andrei Emeltchenko return bt_skb_alloc(len, GFP_KERNEL); 9446d5c9088fbcc8a570bc271f77940973d9cae074Andrei Emeltchenko} 9546d5c9088fbcc8a570bc271f77940973d9cae074Andrei Emeltchenko 9646d5c9088fbcc8a570bc271f77940973d9cae074Andrei Emeltchenkostatic struct l2cap_chan *a2mp_chan_no_new_conn_cb(struct l2cap_chan *chan) 9746d5c9088fbcc8a570bc271f77940973d9cae074Andrei Emeltchenko{ 9846d5c9088fbcc8a570bc271f77940973d9cae074Andrei Emeltchenko BT_ERR("new_connection for chan %p not implemented", chan); 9946d5c9088fbcc8a570bc271f77940973d9cae074Andrei Emeltchenko 10046d5c9088fbcc8a570bc271f77940973d9cae074Andrei Emeltchenko return NULL; 10146d5c9088fbcc8a570bc271f77940973d9cae074Andrei Emeltchenko} 10246d5c9088fbcc8a570bc271f77940973d9cae074Andrei Emeltchenko 10346d5c9088fbcc8a570bc271f77940973d9cae074Andrei Emeltchenkostatic void a2mp_chan_no_teardown_cb(struct l2cap_chan *chan, int err) 10446d5c9088fbcc8a570bc271f77940973d9cae074Andrei Emeltchenko{ 10546d5c9088fbcc8a570bc271f77940973d9cae074Andrei Emeltchenko BT_ERR("teardown for chan %p not implemented", chan); 10646d5c9088fbcc8a570bc271f77940973d9cae074Andrei Emeltchenko} 10746d5c9088fbcc8a570bc271f77940973d9cae074Andrei Emeltchenko 10846d5c9088fbcc8a570bc271f77940973d9cae074Andrei Emeltchenkostatic void a2mp_chan_no_ready(struct l2cap_chan *chan) 10946d5c9088fbcc8a570bc271f77940973d9cae074Andrei Emeltchenko{ 11046d5c9088fbcc8a570bc271f77940973d9cae074Andrei Emeltchenko BT_ERR("ready for chan %p not implemented", chan); 11146d5c9088fbcc8a570bc271f77940973d9cae074Andrei Emeltchenko} 11246d5c9088fbcc8a570bc271f77940973d9cae074Andrei Emeltchenko 113466f8004f364e9cb46d9124109972489eccfb404Andrei Emeltchenkostatic struct l2cap_ops a2mp_chan_ops = { 114466f8004f364e9cb46d9124109972489eccfb404Andrei Emeltchenko .name = "L2CAP A2MP channel", 11546d5c9088fbcc8a570bc271f77940973d9cae074Andrei Emeltchenko .close = a2mp_chan_close_cb, 11646d5c9088fbcc8a570bc271f77940973d9cae074Andrei Emeltchenko .state_change = a2mp_chan_state_change_cb, 11746d5c9088fbcc8a570bc271f77940973d9cae074Andrei Emeltchenko .alloc_skb = a2mp_chan_alloc_skb_cb, 11846d5c9088fbcc8a570bc271f77940973d9cae074Andrei Emeltchenko 11946d5c9088fbcc8a570bc271f77940973d9cae074Andrei Emeltchenko /* Not implemented for A2MP */ 12046d5c9088fbcc8a570bc271f77940973d9cae074Andrei Emeltchenko .new_connection = a2mp_chan_no_new_conn_cb, 12146d5c9088fbcc8a570bc271f77940973d9cae074Andrei Emeltchenko .teardown = a2mp_chan_no_teardown_cb, 12246d5c9088fbcc8a570bc271f77940973d9cae074Andrei Emeltchenko .ready = a2mp_chan_no_ready, 123466f8004f364e9cb46d9124109972489eccfb404Andrei Emeltchenko}; 124466f8004f364e9cb46d9124109972489eccfb404Andrei Emeltchenko 125466f8004f364e9cb46d9124109972489eccfb404Andrei Emeltchenkostatic struct l2cap_chan *a2mp_chan_open(struct l2cap_conn *conn) 126466f8004f364e9cb46d9124109972489eccfb404Andrei Emeltchenko{ 127466f8004f364e9cb46d9124109972489eccfb404Andrei Emeltchenko struct l2cap_chan *chan; 128466f8004f364e9cb46d9124109972489eccfb404Andrei Emeltchenko int err; 129466f8004f364e9cb46d9124109972489eccfb404Andrei Emeltchenko 130466f8004f364e9cb46d9124109972489eccfb404Andrei Emeltchenko chan = l2cap_chan_create(); 131466f8004f364e9cb46d9124109972489eccfb404Andrei Emeltchenko if (!chan) 132466f8004f364e9cb46d9124109972489eccfb404Andrei Emeltchenko return NULL; 133466f8004f364e9cb46d9124109972489eccfb404Andrei Emeltchenko 134466f8004f364e9cb46d9124109972489eccfb404Andrei Emeltchenko BT_DBG("chan %p", chan); 135466f8004f364e9cb46d9124109972489eccfb404Andrei Emeltchenko 136466f8004f364e9cb46d9124109972489eccfb404Andrei Emeltchenko hci_conn_hold(conn->hcon); 137466f8004f364e9cb46d9124109972489eccfb404Andrei Emeltchenko 138466f8004f364e9cb46d9124109972489eccfb404Andrei Emeltchenko chan->omtu = L2CAP_A2MP_DEFAULT_MTU; 139466f8004f364e9cb46d9124109972489eccfb404Andrei Emeltchenko chan->imtu = L2CAP_A2MP_DEFAULT_MTU; 140466f8004f364e9cb46d9124109972489eccfb404Andrei Emeltchenko chan->flush_to = L2CAP_DEFAULT_FLUSH_TO; 141466f8004f364e9cb46d9124109972489eccfb404Andrei Emeltchenko 142466f8004f364e9cb46d9124109972489eccfb404Andrei Emeltchenko chan->ops = &a2mp_chan_ops; 143466f8004f364e9cb46d9124109972489eccfb404Andrei Emeltchenko 144466f8004f364e9cb46d9124109972489eccfb404Andrei Emeltchenko l2cap_chan_set_defaults(chan); 145466f8004f364e9cb46d9124109972489eccfb404Andrei Emeltchenko chan->remote_max_tx = chan->max_tx; 146466f8004f364e9cb46d9124109972489eccfb404Andrei Emeltchenko chan->remote_tx_win = chan->tx_win; 147466f8004f364e9cb46d9124109972489eccfb404Andrei Emeltchenko 148466f8004f364e9cb46d9124109972489eccfb404Andrei Emeltchenko chan->retrans_timeout = L2CAP_DEFAULT_RETRANS_TO; 149466f8004f364e9cb46d9124109972489eccfb404Andrei Emeltchenko chan->monitor_timeout = L2CAP_DEFAULT_MONITOR_TO; 150466f8004f364e9cb46d9124109972489eccfb404Andrei Emeltchenko 151466f8004f364e9cb46d9124109972489eccfb404Andrei Emeltchenko skb_queue_head_init(&chan->tx_q); 152466f8004f364e9cb46d9124109972489eccfb404Andrei Emeltchenko 153466f8004f364e9cb46d9124109972489eccfb404Andrei Emeltchenko chan->mode = L2CAP_MODE_ERTM; 154466f8004f364e9cb46d9124109972489eccfb404Andrei Emeltchenko 155466f8004f364e9cb46d9124109972489eccfb404Andrei Emeltchenko err = l2cap_ertm_init(chan); 156466f8004f364e9cb46d9124109972489eccfb404Andrei Emeltchenko if (err < 0) { 157466f8004f364e9cb46d9124109972489eccfb404Andrei Emeltchenko l2cap_chan_del(chan, 0); 158466f8004f364e9cb46d9124109972489eccfb404Andrei Emeltchenko return NULL; 159466f8004f364e9cb46d9124109972489eccfb404Andrei Emeltchenko } 160466f8004f364e9cb46d9124109972489eccfb404Andrei Emeltchenko 161466f8004f364e9cb46d9124109972489eccfb404Andrei Emeltchenko chan->conf_state = 0; 162466f8004f364e9cb46d9124109972489eccfb404Andrei Emeltchenko 163466f8004f364e9cb46d9124109972489eccfb404Andrei Emeltchenko l2cap_chan_add(conn, chan); 164466f8004f364e9cb46d9124109972489eccfb404Andrei Emeltchenko 165466f8004f364e9cb46d9124109972489eccfb404Andrei Emeltchenko chan->remote_mps = chan->omtu; 166466f8004f364e9cb46d9124109972489eccfb404Andrei Emeltchenko chan->mps = chan->omtu; 167466f8004f364e9cb46d9124109972489eccfb404Andrei Emeltchenko 168466f8004f364e9cb46d9124109972489eccfb404Andrei Emeltchenko chan->state = BT_CONNECTED; 169466f8004f364e9cb46d9124109972489eccfb404Andrei Emeltchenko 170466f8004f364e9cb46d9124109972489eccfb404Andrei Emeltchenko return chan; 171466f8004f364e9cb46d9124109972489eccfb404Andrei Emeltchenko} 1729740e49d17e55f3832661fd99a8e0a17e921a82eAndrei Emeltchenko 1739740e49d17e55f3832661fd99a8e0a17e921a82eAndrei Emeltchenko/* AMP Manager functions */ 1749740e49d17e55f3832661fd99a8e0a17e921a82eAndrei Emeltchenkovoid amp_mgr_get(struct amp_mgr *mgr) 1759740e49d17e55f3832661fd99a8e0a17e921a82eAndrei Emeltchenko{ 1769740e49d17e55f3832661fd99a8e0a17e921a82eAndrei Emeltchenko BT_DBG("mgr %p", mgr); 1779740e49d17e55f3832661fd99a8e0a17e921a82eAndrei Emeltchenko 1789740e49d17e55f3832661fd99a8e0a17e921a82eAndrei Emeltchenko kref_get(&mgr->kref); 1799740e49d17e55f3832661fd99a8e0a17e921a82eAndrei Emeltchenko} 1809740e49d17e55f3832661fd99a8e0a17e921a82eAndrei Emeltchenko 1819740e49d17e55f3832661fd99a8e0a17e921a82eAndrei Emeltchenkostatic void amp_mgr_destroy(struct kref *kref) 1829740e49d17e55f3832661fd99a8e0a17e921a82eAndrei Emeltchenko{ 1839740e49d17e55f3832661fd99a8e0a17e921a82eAndrei Emeltchenko struct amp_mgr *mgr = container_of(kref, struct amp_mgr, kref); 1849740e49d17e55f3832661fd99a8e0a17e921a82eAndrei Emeltchenko 1859740e49d17e55f3832661fd99a8e0a17e921a82eAndrei Emeltchenko BT_DBG("mgr %p", mgr); 1869740e49d17e55f3832661fd99a8e0a17e921a82eAndrei Emeltchenko 1879740e49d17e55f3832661fd99a8e0a17e921a82eAndrei Emeltchenko kfree(mgr); 1889740e49d17e55f3832661fd99a8e0a17e921a82eAndrei Emeltchenko} 1899740e49d17e55f3832661fd99a8e0a17e921a82eAndrei Emeltchenko 1909740e49d17e55f3832661fd99a8e0a17e921a82eAndrei Emeltchenkoint amp_mgr_put(struct amp_mgr *mgr) 1919740e49d17e55f3832661fd99a8e0a17e921a82eAndrei Emeltchenko{ 1929740e49d17e55f3832661fd99a8e0a17e921a82eAndrei Emeltchenko BT_DBG("mgr %p", mgr); 1939740e49d17e55f3832661fd99a8e0a17e921a82eAndrei Emeltchenko 1949740e49d17e55f3832661fd99a8e0a17e921a82eAndrei Emeltchenko return kref_put(&mgr->kref, &_mgr_destroy); 1959740e49d17e55f3832661fd99a8e0a17e921a82eAndrei Emeltchenko} 1969740e49d17e55f3832661fd99a8e0a17e921a82eAndrei Emeltchenko 1979740e49d17e55f3832661fd99a8e0a17e921a82eAndrei Emeltchenkostatic struct amp_mgr *amp_mgr_create(struct l2cap_conn *conn) 1989740e49d17e55f3832661fd99a8e0a17e921a82eAndrei Emeltchenko{ 1999740e49d17e55f3832661fd99a8e0a17e921a82eAndrei Emeltchenko struct amp_mgr *mgr; 2009740e49d17e55f3832661fd99a8e0a17e921a82eAndrei Emeltchenko struct l2cap_chan *chan; 2019740e49d17e55f3832661fd99a8e0a17e921a82eAndrei Emeltchenko 2029740e49d17e55f3832661fd99a8e0a17e921a82eAndrei Emeltchenko mgr = kzalloc(sizeof(*mgr), GFP_KERNEL); 2039740e49d17e55f3832661fd99a8e0a17e921a82eAndrei Emeltchenko if (!mgr) 2049740e49d17e55f3832661fd99a8e0a17e921a82eAndrei Emeltchenko return NULL; 2059740e49d17e55f3832661fd99a8e0a17e921a82eAndrei Emeltchenko 2069740e49d17e55f3832661fd99a8e0a17e921a82eAndrei Emeltchenko BT_DBG("conn %p mgr %p", conn, mgr); 2079740e49d17e55f3832661fd99a8e0a17e921a82eAndrei Emeltchenko 2089740e49d17e55f3832661fd99a8e0a17e921a82eAndrei Emeltchenko mgr->l2cap_conn = conn; 2099740e49d17e55f3832661fd99a8e0a17e921a82eAndrei Emeltchenko 2109740e49d17e55f3832661fd99a8e0a17e921a82eAndrei Emeltchenko chan = a2mp_chan_open(conn); 2119740e49d17e55f3832661fd99a8e0a17e921a82eAndrei Emeltchenko if (!chan) { 2129740e49d17e55f3832661fd99a8e0a17e921a82eAndrei Emeltchenko kfree(mgr); 2139740e49d17e55f3832661fd99a8e0a17e921a82eAndrei Emeltchenko return NULL; 2149740e49d17e55f3832661fd99a8e0a17e921a82eAndrei Emeltchenko } 2159740e49d17e55f3832661fd99a8e0a17e921a82eAndrei Emeltchenko 2169740e49d17e55f3832661fd99a8e0a17e921a82eAndrei Emeltchenko mgr->a2mp_chan = chan; 2179740e49d17e55f3832661fd99a8e0a17e921a82eAndrei Emeltchenko chan->data = mgr; 2189740e49d17e55f3832661fd99a8e0a17e921a82eAndrei Emeltchenko 2199740e49d17e55f3832661fd99a8e0a17e921a82eAndrei Emeltchenko conn->hcon->amp_mgr = mgr; 2209740e49d17e55f3832661fd99a8e0a17e921a82eAndrei Emeltchenko 2219740e49d17e55f3832661fd99a8e0a17e921a82eAndrei Emeltchenko kref_init(&mgr->kref); 2229740e49d17e55f3832661fd99a8e0a17e921a82eAndrei Emeltchenko 2239740e49d17e55f3832661fd99a8e0a17e921a82eAndrei Emeltchenko return mgr; 2249740e49d17e55f3832661fd99a8e0a17e921a82eAndrei Emeltchenko} 225