Bluetooth: A2MP: Process A2MP Get AMP Assoc Request
Example trace when receiving AMP Assoc Request with wrong AMP id. ... > ACL data: handle 11 flags 0x02 dlen 13 A2MP: Get AMP Assoc req: id 238 < ACL data: handle 11 flags 0x00 dlen 14 A2MP: Get AMP Assoc rsp: id 238 status (1) Invalid Controller ID assoc data: ... Signed-off-by: Andrei Emeltchenko <andrei.emeltchenko@intel.com> Signed-off-by: Gustavo Padovan <gustavo.padovan@collabora.co.uk>
This commit is contained in:
parent
47f2d97d38
commit
a28381dc9c
1 changed files with 35 additions and 0 deletions
|
@ -211,6 +211,38 @@ static int a2mp_getinfo_req(struct amp_mgr *mgr, struct sk_buff *skb,
|
||||||
return 0;
|
return 0;
|
||||||
}
|
}
|
||||||
|
|
||||||
|
static int a2mp_getampassoc_req(struct amp_mgr *mgr, struct sk_buff *skb,
|
||||||
|
struct a2mp_cmd *hdr)
|
||||||
|
{
|
||||||
|
struct a2mp_amp_assoc_req *req = (void *) skb->data;
|
||||||
|
struct hci_dev *hdev;
|
||||||
|
|
||||||
|
if (le16_to_cpu(hdr->len) < sizeof(*req))
|
||||||
|
return -EINVAL;
|
||||||
|
|
||||||
|
BT_DBG("id %d", req->id);
|
||||||
|
|
||||||
|
hdev = hci_dev_get(req->id);
|
||||||
|
if (!hdev || hdev->amp_type == HCI_BREDR) {
|
||||||
|
struct a2mp_amp_assoc_rsp rsp;
|
||||||
|
rsp.id = req->id;
|
||||||
|
rsp.status = A2MP_STATUS_INVALID_CTRL_ID;
|
||||||
|
|
||||||
|
a2mp_send(mgr, A2MP_GETAMPASSOC_RSP, hdr->ident, sizeof(rsp),
|
||||||
|
&rsp);
|
||||||
|
goto clean;
|
||||||
|
}
|
||||||
|
|
||||||
|
/* Placeholder for HCI Read AMP Assoc */
|
||||||
|
|
||||||
|
clean:
|
||||||
|
if (hdev)
|
||||||
|
hci_dev_put(hdev);
|
||||||
|
|
||||||
|
skb_pull(skb, sizeof(*req));
|
||||||
|
return 0;
|
||||||
|
}
|
||||||
|
|
||||||
/* Handle A2MP signalling */
|
/* Handle A2MP signalling */
|
||||||
static int a2mp_chan_recv_cb(struct l2cap_chan *chan, struct sk_buff *skb)
|
static int a2mp_chan_recv_cb(struct l2cap_chan *chan, struct sk_buff *skb)
|
||||||
{
|
{
|
||||||
|
@ -253,6 +285,9 @@ static int a2mp_chan_recv_cb(struct l2cap_chan *chan, struct sk_buff *skb)
|
||||||
break;
|
break;
|
||||||
|
|
||||||
case A2MP_GETAMPASSOC_REQ:
|
case A2MP_GETAMPASSOC_REQ:
|
||||||
|
err = a2mp_getampassoc_req(mgr, skb, hdr);
|
||||||
|
break;
|
||||||
|
|
||||||
case A2MP_CREATEPHYSLINK_REQ:
|
case A2MP_CREATEPHYSLINK_REQ:
|
||||||
case A2MP_DISCONNPHYSLINK_REQ:
|
case A2MP_DISCONNPHYSLINK_REQ:
|
||||||
case A2MP_CHANGE_RSP:
|
case A2MP_CHANGE_RSP:
|
||||||
|
|
Loading…
Reference in a new issue