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, &amp_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