Commit 5ae76a94 authored by Andrzej Kaczmarek's avatar Andrzej Kaczmarek Committed by Marcel Holtmann
Browse files

Bluetooth: Store RSSI for connection 



This patch adds support to store RSSI for connection when reply for
HCI_Read_RSSI is received.

Signed-off-by: default avatarAndrzej Kaczmarek <andrzej.kaczmarek@tieto.com>
Signed-off-by: default avatarMarcel Holtmann <marcel@holtmann.org>
parent 38e4a915

include/net/bluetooth/hci.h

+10 −0
Original line number Diff line number Diff line
@@ -1064,6 +1064,16 @@ struct hci_rp_read_page_scan_type { 
	#define PAGE_SCAN_TYPE_STANDARD		0x00

	#define PAGE_SCAN_TYPE_INTERLACED	0x01



#define HCI_OP_READ_RSSI		0x1405

struct hci_cp_read_rssi {

	__le16   handle;

} __packed;

struct hci_rp_read_rssi {

	__u8     status;

	__le16   handle;

	__s8     rssi;

} __packed;



#define HCI_OP_READ_LOCAL_AMP_INFO	0x1409

struct hci_rp_read_local_amp_info {

	__u8     status;

include/net/bluetooth/hci_core.h

+1 −0
Original line number Diff line number Diff line
@@ -374,6 +374,7 @@ struct hci_conn { 
	__u16		setting;

	__u16		le_conn_min_interval;

	__u16		le_conn_max_interval;

	__s8		rssi;

	unsigned long	flags;



	__u8		remote_cap;

net/bluetooth/hci_event.c

+23 −0
Original line number Diff line number Diff line
@@ -1245,6 +1245,25 @@ static void hci_cc_write_remote_amp_assoc(struct hci_dev *hdev, 
	amp_write_rem_assoc_continue(hdev, rp->phy_handle);

}



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

{

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

	struct hci_conn *conn;



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



	if (rp->status)

		return;



	hci_dev_lock(hdev);



	conn = hci_conn_hash_lookup_handle(hdev, __le16_to_cpu(rp->handle));

	if (conn)

		conn->rssi = rp->rssi;



	hci_dev_unlock(hdev);

}



static void hci_cs_inquiry(struct hci_dev *hdev, __u8 status)

{

	BT_DBG("%s status 0x%2.2x", hdev->name, status);
@@ -2637,6 +2656,10 @@ static void hci_cmd_complete_evt(struct hci_dev *hdev, struct sk_buff *skb) 
		hci_cc_write_remote_amp_assoc(hdev, skb);

		break;



	case HCI_OP_READ_RSSI:

		hci_cc_read_rssi(hdev, skb);

		break;



	default:

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

		break;