Bluetooth: mgmt: multi adv for enable_advertising()

Previously enable_advertising() would rely on
get_adv_instance_scan_rsp_len() which checked for a hard coded instance
identifier. This is being changed to check for the current advertising
instance's scan response length instead. The function is renamed
accordingly.

Signed-off-by: Florian Grandel <fgrandel@gmail.com>
Signed-off-by: Marcel Holtmann <marcel@holtmann.org>

1 files changed, 12 insertions, 5 deletions

diff --git a/net/bluetooth/mgmt.c b/net/bluetooth/mgmt.c
index 47fa16bffbe2..76aee8a3acf0 100644
--- a/net/bluetooth/mgmt.c
+++ b/net/bluetooth/mgmt.c
@@ -986,16 +986,23 @@ static u32 get_adv_instance_flags(struct hci_dev *hdev, u8 instance)
         return adv_instance->flags;
 }
 
-static u8 get_adv_instance_scan_rsp_len(struct hci_dev *hdev, u8 instance)
+static u8 get_cur_adv_instance_scan_rsp_len(struct hci_dev *hdev)
 {
-        /* Ignore instance 0 and other unsupported instances */
-        if (instance != 0x01)
+        u8 instance = get_current_adv_instance(hdev);
+        struct adv_info *adv_instance;
+
+        /* Ignore instance 0 */
+        if (instance == 0x00)
+                return 0;
+
+        adv_instance = hci_find_adv_instance(hdev, instance);
+        if (!adv_instance)
                 return 0;
 
         /* TODO: Take into account the "appearance" and "local-name" flags here.
          * These are currently being ignored as they are not supported.
          */
-        return hdev->adv_instance.scan_rsp_len;
+        return adv_instance->scan_rsp_len;
 }
 
 static u8 create_instance_adv_data(struct hci_dev *hdev, u8 instance, u8 *ptr)
@@ -1266,7 +1273,7 @@ static void enable_advertising(struct hci_request *req)
 
         if (connectable)
                 cp.type = LE_ADV_IND;
-        else if (get_adv_instance_scan_rsp_len(hdev, instance))
+        else if (get_cur_adv_instance_scan_rsp_len(hdev))
                 cp.type = LE_ADV_SCAN_IND;
         else
                 cp.type = LE_ADV_NONCONN_IND;