Bluetooth: MGMT start discovery LE-Only support

This patch adds LE-Only discovery procedure support to MGMT Start
Discovery command.

Signed-off-by: Andre Guedes <andre.guedes@openbossa.org>
Acked-by: Marcel Holtmann <marcel@holtmann.org>
Signed-off-by: Johan Hedberg <johan.hedberg@intel.com>

1 files changed, 19 insertions, 1 deletions

diff --git a/net/bluetooth/mgmt.c b/net/bluetooth/mgmt.c
index 9e5dead1dbe..8c9de58779c 100644
--- a/net/bluetooth/mgmt.c
+++ b/net/bluetooth/mgmt.c
@@ -35,6 +35,15 @@
 #define MGMT_VERSION    0
 #define MGMT_REVISION   1
 
+/*
+ * These LE scan and inquiry parameters were chosen according to LE General
+ * Discovery Procedure specification.
+ */
+#define LE_SCAN_TYPE                    0x01
+#define LE_SCAN_WIN                     0x12
+#define LE_SCAN_INT                     0x12
+#define LE_SCAN_TIMEOUT_LE_ONLY         10240   /* TGAP(gen_disc_scan_min) */
+
 #define INQUIRY_LEN_BREDR 0x08 /* TGAP(100) */
 
 #define SERVICE_CACHE_TIMEOUT (5 * 1000)
@@ -1916,6 +1925,7 @@ static int start_discovery(struct sock *sk, u16 index,
                                                 void *data, u16 len)
 {
         struct mgmt_cp_start_discovery *cp = data;
+        unsigned long discov_type = cp->type;
         struct pending_cmd *cmd;
         struct hci_dev *hdev;
         int err;
@@ -1951,7 +1961,15 @@ static int start_discovery(struct sock *sk, u16 index,
                 goto failed;
         }
 
-        err = hci_do_inquiry(hdev, INQUIRY_LEN_BREDR);
+        if (test_bit(MGMT_ADDR_BREDR, &discov_type))
+                err = hci_do_inquiry(hdev, INQUIRY_LEN_BREDR);
+        else if (test_bit(MGMT_ADDR_LE_PUBLIC, &discov_type) &&
+                                test_bit(MGMT_ADDR_LE_RANDOM, &discov_type))
+                err = hci_le_scan(hdev, LE_SCAN_TYPE, LE_SCAN_INT,
+                                        LE_SCAN_WIN, LE_SCAN_TIMEOUT_LE_ONLY);
+        else
+                err = -EINVAL;
+
         if (err < 0)
                 mgmt_pending_remove(cmd);
         else