Donate to e Foundation | Murena handsets with /e/OS | Own a part of Murena! Learn more

Commit dffa3871 authored by Andrei Emeltchenko's avatar Andrei Emeltchenko Committed by Gustavo Padovan
Browse files

Bluetooth: AMP: Accept Physical Link 



When receiving A2MP Create Physical Link message execute HCI
Accept Physical Link command to AMP controller.

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

include/net/bluetooth/amp.h

+2 −0
Original line number Original line Diff line number Diff line
@@ -41,6 +41,8 @@ void amp_read_loc_assoc_final_data(struct hci_dev *hdev, 
				   struct hci_conn *hcon);

				   struct hci_conn *hcon);

void amp_create_phylink(struct hci_dev *hdev, struct amp_mgr *mgr,

void amp_create_phylink(struct hci_dev *hdev, struct amp_mgr *mgr,

			struct hci_conn *hcon);

			struct hci_conn *hcon);

void amp_accept_phylink(struct hci_dev *hdev, struct amp_mgr *mgr,

			struct hci_conn *hcon);

void amp_write_remote_assoc(struct hci_dev *hdev, u8 handle);

void amp_write_remote_assoc(struct hci_dev *hdev, u8 handle);

void amp_write_rem_assoc_continue(struct hci_dev *hdev, u8 handle);

void amp_write_rem_assoc_continue(struct hci_dev *hdev, u8 handle);

net/bluetooth/a2mp.c

+1 −4
Original line number Original line Diff line number Diff line
@@ -453,12 +453,9 @@ static int a2mp_createphyslink_req(struct amp_mgr *mgr, struct sk_buff *skb, 
		goto send_rsp;

		goto send_rsp;

	}

	}





	/* TODO process physlink create */



	hcon = phylink_add(hdev, mgr, req->local_id);

	hcon = phylink_add(hdev, mgr, req->local_id);

	if (hcon) {

	if (hcon) {

		BT_DBG("hcon %p", hcon);

		amp_accept_phylink(hdev, mgr, hcon);



		rsp.status = A2MP_STATUS_SUCCESS;

		rsp.status = A2MP_STATUS_SUCCESS;

	} else {

	} else {

		rsp.status = A2MP_STATUS_UNABLE_START_LINK_CREATION;

		rsp.status = A2MP_STATUS_UNABLE_START_LINK_CREATION;

net/bluetooth/amp.c

+19 −0
Original line number Original line Diff line number Diff line
@@ -346,3 +346,22 @@ void amp_create_phylink(struct hci_dev *hdev, struct amp_mgr *mgr, 




	hci_send_cmd(hdev, HCI_OP_CREATE_PHY_LINK, sizeof(cp), &cp);

	hci_send_cmd(hdev, HCI_OP_CREATE_PHY_LINK, sizeof(cp), &cp);

}

}



void amp_accept_phylink(struct hci_dev *hdev, struct amp_mgr *mgr,

			struct hci_conn *hcon)

{

	struct hci_cp_accept_phy_link cp;



	cp.phy_handle = hcon->handle;



	BT_DBG("%s hcon %p phy handle 0x%2.2x", hdev->name, hcon,

	       hcon->handle);



	if (phylink_gen_key(mgr->l2cap_conn->hcon, cp.key, &cp.key_len,

			    &cp.key_type)) {

		BT_DBG("Cannot create link key");

		return;

	}



	hci_send_cmd(hdev, HCI_OP_ACCEPT_PHY_LINK, sizeof(cp), &cp);

}