Commit 333140b5 authored by Marcel Holtmann's avatar Marcel Holtmann
Browse files

[Bluetooth] Track status of Simple Pairing mode 



The Simple Pairing feature is optional and needs to be enabled by the
host stack first. The Linux kernel relies on the Bluetooth daemon to
either enable or disable it, but at any time it needs to know the
current state of the Simple Pairing mode. So track any changes made
by external entities and store the current mode in the HCI device
structure.

Signed-off-by: default avatarMarcel Holtmann <marcel@holtmann.org>
parent 0493684e

include/net/bluetooth/hci.h

+11 −0
Original line number Diff line number Diff line
@@ -514,6 +514,17 @@ struct hci_cp_host_buffer_size { 
	__le16   sco_max_pkt;

} __attribute__ ((packed));



#define HCI_OP_READ_SSP_MODE		0x0c55

struct hci_rp_read_ssp_mode {

	__u8     status;

	__u8     mode;

} __attribute__ ((packed));



#define HCI_OP_WRITE_SSP_MODE		0x0c56

struct hci_cp_write_ssp_mode {

	__u8     mode;

} __attribute__ ((packed));



#define HCI_OP_READ_LOCAL_VERSION	0x1001

struct hci_rp_read_local_version {

	__u8     status;

include/net/bluetooth/hci_core.h

+1 −0
Original line number Diff line number Diff line
@@ -75,6 +75,7 @@ struct hci_dev { 
	__u8		dev_class[3];

	__u8		features[8];

	__u8		commands[64];

	__u8		ssp_mode;

	__u8		hci_ver;

	__u16		hci_rev;

	__u16		manufacturer;

net/bluetooth/hci_event.c

+37 −0
Original line number Diff line number Diff line
@@ -391,6 +391,35 @@ static void hci_cc_host_buffer_size(struct hci_dev *hdev, struct sk_buff *skb) 
	hci_req_complete(hdev, status);

}



static void hci_cc_read_ssp_mode(struct hci_dev *hdev, struct sk_buff *skb)

{

	struct hci_rp_read_ssp_mode *rp = (void *) skb->data;



	BT_DBG("%s status 0x%x", hdev->name, rp->status);



	if (rp->status)

		return;



	hdev->ssp_mode = rp->mode;

}



static void hci_cc_write_ssp_mode(struct hci_dev *hdev, struct sk_buff *skb)

{

	__u8 status = *((__u8 *) skb->data);

	void *sent;



	BT_DBG("%s status 0x%x", hdev->name, status);



	if (status)

		return;



	sent = hci_sent_cmd_data(hdev, HCI_OP_WRITE_SSP_MODE);

	if (!sent)

		return;



	hdev->ssp_mode = *((__u8 *) sent);

}



static void hci_cc_read_local_version(struct hci_dev *hdev, struct sk_buff *skb)

{

	struct hci_rp_read_local_version *rp = (void *) skb->data;
@@ -1084,6 +1113,14 @@ static inline void hci_cmd_complete_evt(struct hci_dev *hdev, struct sk_buff *sk 
		hci_cc_host_buffer_size(hdev, skb);

		break;



	case HCI_OP_READ_SSP_MODE:

		hci_cc_read_ssp_mode(hdev, skb);

		break;



	case HCI_OP_WRITE_SSP_MODE:

		hci_cc_write_ssp_mode(hdev, skb);

		break;



	case HCI_OP_READ_LOCAL_VERSION:

		hci_cc_read_local_version(hdev, skb);

		break;

CRA Git | Maintained and supported by SUSTech CRA and CCSE