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: Andrzej Kaczmarek <andrzej.kaczmarek@tieto.com> Signed-off-by: Marcel Holtmann <marcel@holtmann.org>
This commit is contained in:
parent
38e4a91566
commit
5ae76a9415
|
@ -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;
|
||||
|
|
|
@ -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;
|
||||
|
|
|
@ -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;
|
||||
|
|
Loading…
Reference in a new issue