This patch adds some helper functions to perform LE scan according to the general discovery procedure recommendations. Signed-off-by: Andre Guedes <andre.guedes@xxxxxxxxxxxxx> --- include/net/bluetooth/hci.h | 9 +++++++ net/bluetooth/mgmt.c | 51 +++++++++++++++++++++++++++++++++++++++++++ 2 files changed, 60 insertions(+), 0 deletions(-) diff --git a/include/net/bluetooth/hci.h b/include/net/bluetooth/hci.h index 653daec..fb40388 100644 --- a/include/net/bluetooth/hci.h +++ b/include/net/bluetooth/hci.h @@ -729,6 +729,15 @@ struct hci_rp_le_read_buffer_size { __u8 le_max_pkt; } __packed; +#define HCI_OP_LE_SET_SCAN_PARAM 0x200b +struct hci_cp_le_set_scan_param { + __u8 type; + __le16 interval; + __le16 window; + __u8 own_address_type; + __u8 filter_policy; +} __packed; + #define HCI_OP_LE_SET_SCAN_ENABLE 0x200c struct hci_cp_le_set_scan_enable { __u8 enable; diff --git a/net/bluetooth/mgmt.c b/net/bluetooth/mgmt.c index c0d3321..c805377 100644 --- a/net/bluetooth/mgmt.c +++ b/net/bluetooth/mgmt.c @@ -1637,6 +1637,50 @@ static int do_inquiry(struct hci_dev *hdev, __u8 inq_length) return hci_send_cmd(hdev, HCI_OP_INQUIRY, sizeof(cp), &cp); } +static int set_le_scan_param(struct hci_dev *hdev) +{ + struct hci_cp_le_set_scan_param cp; + + /* + * These values are set according to LE General Discovery Procedure + * specification. + */ + cp.type = 0x01; /* Active scanning */ + cp.interval = cpu_to_le16(0x0012); /* TGAP(gen_disc_scan_int) */ + cp.window = cpu_to_le16(0x0012); /* TGAP(gen_disc_scan_wind) */ + cp.own_address_type = 0x00; /* Public */ + cp.filter_policy = 0x00; /* Accept all advertisement packets */ + + return hci_send_cmd(hdev, HCI_OP_LE_SET_SCAN_PARAM, sizeof(cp), &cp); +} + +static int enable_le_scan(struct hci_dev *hdev, __u8 enable) +{ + struct hci_cp_le_set_scan_enable cp; + + memset(&cp, 0, sizeof(cp)); + cp.enable = enable; + + return hci_send_cmd(hdev, HCI_OP_LE_SET_SCAN_ENABLE, sizeof(cp), &cp); +} + +static int do_le_scan(struct hci_dev *hdev, int timeout) +{ + int err; + + err = set_le_scan_param(hdev); + if (err < 0) + return err; + + err = enable_le_scan(hdev, 1); + if (err < 0) + return err; + + mod_timer(&hdev->le_scan_timer, jiffies + msecs_to_jiffies(timeout)); + + return 0; +} + static int get_device_type(struct hci_dev *hdev) { if (lmp_bredr_capable(hdev) && lmp_host_le_capable(hdev)) @@ -1705,6 +1749,13 @@ static int cancel_inquiry(struct hci_dev *hdev) return hci_send_cmd(hdev, HCI_OP_INQUIRY_CANCEL, 0, NULL); } +static int cancel_le_scan(struct hci_dev *hdev) +{ + del_timer(&hdev->le_scan_timer); + + return enable_le_scan(hdev, 0); +} + int mgmt_cancel_discovery(u16 index) { struct hci_dev *hdev; -- 1.7.4.1 -- To unsubscribe from this list: send the line "unsubscribe linux-bluetooth" in the body of a message to majordomo@xxxxxxxxxxxxxxx More majordomo info at http://vger.kernel.org/majordomo-info.html