Commit 6113f84f authored by Andrei Emeltchenko's avatar Andrei Emeltchenko Committed by Johan Hedberg
Browse files

Bluetooth: A2MP: Process A2MP Disc Physlink Request 



Placeholder for A2MP Disconnect Physlink Request.

Signed-off-by: default avatarAndrei Emeltchenko <andrei.emeltchenko@intel.com>
Signed-off-by: default avatarGustavo Padovan <gustavo.padovan@collabora.co.uk>
parent e072f5da

net/bluetooth/a2mp.c

+36 −0
Original line number Diff line number Diff line
@@ -280,6 +280,39 @@ static int a2mp_createphyslink_req(struct amp_mgr *mgr, struct sk_buff *skb, 
	return 0;

}



static int a2mp_discphyslink_req(struct amp_mgr *mgr, struct sk_buff *skb,

				 struct a2mp_cmd *hdr)

{

	struct a2mp_physlink_req *req = (void *) skb->data;

	struct a2mp_physlink_rsp rsp;

	struct hci_dev *hdev;



	if (le16_to_cpu(hdr->len) < sizeof(*req))

		return -EINVAL;



	BT_DBG("local_id %d remote_id %d", req->local_id, req->remote_id);



	rsp.local_id = req->remote_id;

	rsp.remote_id = req->local_id;

	rsp.status = A2MP_STATUS_SUCCESS;



	hdev = hci_dev_get(req->local_id);

	if (!hdev) {

		rsp.status = A2MP_STATUS_INVALID_CTRL_ID;

		goto send_rsp;

	}



	/* TODO Disconnect Phys Link here */



	hci_dev_put(hdev);



send_rsp:

	a2mp_send(mgr, A2MP_DISCONNPHYSLINK_RSP, hdr->ident, sizeof(rsp), &rsp);



	skb_pull(skb, sizeof(*req));

	return 0;

}



/* Handle A2MP signalling */

static int a2mp_chan_recv_cb(struct l2cap_chan *chan, struct sk_buff *skb)

{
@@ -330,6 +363,9 @@ static int a2mp_chan_recv_cb(struct l2cap_chan *chan, struct sk_buff *skb) 
			break;



		case A2MP_DISCONNPHYSLINK_REQ:

			err = a2mp_discphyslink_req(mgr, skb, hdr);

			break;



		case A2MP_CHANGE_RSP:

		case A2MP_DISCOVER_RSP:

		case A2MP_GETINFO_RSP: