Bluetooth: Fix handling of discoverable setting with timeout

The current handling of the discoverable timeout was missing the proper
handling of the timeout when the mode was already set. Now the command
can be used to expire or retrigger the timeout.

Signed-off-by: Marcel Holtmann <marcel@holtmann.org>
Signed-off-by: Johan Hedberg <johan.hedberg@intel.com>

1 files changed, 11 insertions, 0 deletions

diff --git a/net/bluetooth/mgmt.c b/net/bluetooth/mgmt.c
index 6df4af6e99c..f7e111f3043 100644
--- a/net/bluetooth/mgmt.c
+++ b/net/bluetooth/mgmt.c
@@ -900,6 +900,17 @@ static int set_discoverable(struct sock *sk, u16 index, void *data, u16 len)
         }
 
         if (!!cp->val == test_bit(HCI_DISCOVERABLE, &hdev->dev_flags)) {
+                if (hdev->discov_timeout > 0) {
+                        cancel_delayed_work(&hdev->discov_off);
+                        hdev->discov_timeout = 0;
+                }
+
+                if (cp->val && timeout > 0) {
+                        hdev->discov_timeout = timeout;
+                        queue_delayed_work(hdev->workqueue, &hdev->discov_off,
+                                msecs_to_jiffies(hdev->discov_timeout * 1000));
+                }
+
                 err = send_settings_rsp(sk, MGMT_OP_SET_DISCOVERABLE, hdev);
                 goto failed;
         }