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_STANDARD 0x00
|
||||||
#define PAGE_SCAN_TYPE_INTERLACED 0x01
|
#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
|
#define HCI_OP_READ_LOCAL_AMP_INFO 0x1409
|
||||||
struct hci_rp_read_local_amp_info {
|
struct hci_rp_read_local_amp_info {
|
||||||
__u8 status;
|
__u8 status;
|
||||||
|
@ -374,6 +374,7 @@ struct hci_conn {
|
|||||||
__u16 setting;
|
__u16 setting;
|
||||||
__u16 le_conn_min_interval;
|
__u16 le_conn_min_interval;
|
||||||
__u16 le_conn_max_interval;
|
__u16 le_conn_max_interval;
|
||||||
|
__s8 rssi;
|
||||||
unsigned long flags;
|
unsigned long flags;
|
||||||
|
|
||||||
__u8 remote_cap;
|
__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);
|
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)
|
static void hci_cs_inquiry(struct hci_dev *hdev, __u8 status)
|
||||||
{
|
{
|
||||||
BT_DBG("%s status 0x%2.2x", hdev->name, 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);
|
hci_cc_write_remote_amp_assoc(hdev, skb);
|
||||||
break;
|
break;
|
||||||
|
|
||||||
|
case HCI_OP_READ_RSSI:
|
||||||
|
hci_cc_read_rssi(hdev, skb);
|
||||||
|
break;
|
||||||
|
|
||||||
default:
|
default:
|
||||||
BT_DBG("%s opcode 0x%4.4x", hdev->name, opcode);
|
BT_DBG("%s opcode 0x%4.4x", hdev->name, opcode);
|
||||||
break;
|
break;
|
||||||
|
Loading…
x
Reference in New Issue
Block a user