16a98e383SMarcel Holtmann // SPDX-License-Identifier: GPL-2.0 26a98e383SMarcel Holtmann /* 36a98e383SMarcel Holtmann * BlueZ - Bluetooth protocol stack for Linux 46a98e383SMarcel Holtmann * 56a98e383SMarcel Holtmann * Copyright (C) 2021 Intel Corporation 66a42e9bfSIulia Tanasescu * Copyright 2023 NXP 76a98e383SMarcel Holtmann */ 86a98e383SMarcel Holtmann 9d0b13706SLuiz Augusto von Dentz #include <linux/property.h> 10d0b13706SLuiz Augusto von Dentz 116a98e383SMarcel Holtmann #include <net/bluetooth/bluetooth.h> 126a98e383SMarcel Holtmann #include <net/bluetooth/hci_core.h> 136a98e383SMarcel Holtmann #include <net/bluetooth/mgmt.h> 146a98e383SMarcel Holtmann 156a98e383SMarcel Holtmann #include "hci_request.h" 16828cea2bSChethan T N #include "hci_codec.h" 17d0b13706SLuiz Augusto von Dentz #include "hci_debugfs.h" 186a98e383SMarcel Holtmann #include "smp.h" 19161510ccSLuiz Augusto von Dentz #include "eir.h" 20d0b13706SLuiz Augusto von Dentz #include "msft.h" 21d0b13706SLuiz Augusto von Dentz #include "aosp.h" 22d0b13706SLuiz Augusto von Dentz #include "leds.h" 236a98e383SMarcel Holtmann 246a98e383SMarcel Holtmann static void hci_cmd_sync_complete(struct hci_dev *hdev, u8 result, u16 opcode, 256a98e383SMarcel Holtmann struct sk_buff *skb) 266a98e383SMarcel Holtmann { 276a98e383SMarcel Holtmann bt_dev_dbg(hdev, "result 0x%2.2x", result); 286a98e383SMarcel Holtmann 296a98e383SMarcel Holtmann if (hdev->req_status != HCI_REQ_PEND) 306a98e383SMarcel Holtmann return; 316a98e383SMarcel Holtmann 326a98e383SMarcel Holtmann hdev->req_result = result; 336a98e383SMarcel Holtmann hdev->req_status = HCI_REQ_DONE; 346a98e383SMarcel Holtmann 352af7aa66SLuiz Augusto von Dentz /* Free the request command so it is not used as response */ 362af7aa66SLuiz Augusto von Dentz kfree_skb(hdev->req_skb); 372af7aa66SLuiz Augusto von Dentz hdev->req_skb = NULL; 382af7aa66SLuiz Augusto von Dentz 39cba6b758SLuiz Augusto von Dentz if (skb) { 40cba6b758SLuiz Augusto von Dentz struct sock *sk = hci_skb_sk(skb); 41cba6b758SLuiz Augusto von Dentz 42cba6b758SLuiz Augusto von Dentz /* Drop sk reference if set */ 43cba6b758SLuiz Augusto von Dentz if (sk) 44cba6b758SLuiz Augusto von Dentz sock_put(sk); 45cba6b758SLuiz Augusto von Dentz 462af7aa66SLuiz Augusto von Dentz hdev->req_rsp = skb_get(skb); 47cba6b758SLuiz Augusto von Dentz } 48cba6b758SLuiz Augusto von Dentz 496a98e383SMarcel Holtmann wake_up_interruptible(&hdev->req_wait_q); 506a98e383SMarcel Holtmann } 516a98e383SMarcel Holtmann 526a98e383SMarcel Holtmann static struct sk_buff *hci_cmd_sync_alloc(struct hci_dev *hdev, u16 opcode, 536a98e383SMarcel Holtmann u32 plen, const void *param, 546a98e383SMarcel Holtmann struct sock *sk) 556a98e383SMarcel Holtmann { 566a98e383SMarcel Holtmann int len = HCI_COMMAND_HDR_SIZE + plen; 576a98e383SMarcel Holtmann struct hci_command_hdr *hdr; 586a98e383SMarcel Holtmann struct sk_buff *skb; 596a98e383SMarcel Holtmann 606a98e383SMarcel Holtmann skb = bt_skb_alloc(len, GFP_ATOMIC); 616a98e383SMarcel Holtmann if (!skb) 626a98e383SMarcel Holtmann return NULL; 636a98e383SMarcel Holtmann 646a98e383SMarcel Holtmann hdr = skb_put(skb, HCI_COMMAND_HDR_SIZE); 656a98e383SMarcel Holtmann hdr->opcode = cpu_to_le16(opcode); 666a98e383SMarcel Holtmann hdr->plen = plen; 676a98e383SMarcel Holtmann 686a98e383SMarcel Holtmann if (plen) 696a98e383SMarcel Holtmann skb_put_data(skb, param, plen); 706a98e383SMarcel Holtmann 716a98e383SMarcel Holtmann bt_dev_dbg(hdev, "skb len %d", skb->len); 726a98e383SMarcel Holtmann 736a98e383SMarcel Holtmann hci_skb_pkt_type(skb) = HCI_COMMAND_PKT; 746a98e383SMarcel Holtmann hci_skb_opcode(skb) = opcode; 756a98e383SMarcel Holtmann 76cba6b758SLuiz Augusto von Dentz /* Grab a reference if command needs to be associated with a sock (e.g. 77cba6b758SLuiz Augusto von Dentz * likely mgmt socket that initiated the command). 78cba6b758SLuiz Augusto von Dentz */ 79cba6b758SLuiz Augusto von Dentz if (sk) { 80cba6b758SLuiz Augusto von Dentz hci_skb_sk(skb) = sk; 81cba6b758SLuiz Augusto von Dentz sock_hold(sk); 82cba6b758SLuiz Augusto von Dentz } 83cba6b758SLuiz Augusto von Dentz 846a98e383SMarcel Holtmann return skb; 856a98e383SMarcel Holtmann } 866a98e383SMarcel Holtmann 876a98e383SMarcel Holtmann static void hci_cmd_sync_add(struct hci_request *req, u16 opcode, u32 plen, 886a98e383SMarcel Holtmann const void *param, u8 event, struct sock *sk) 896a98e383SMarcel Holtmann { 906a98e383SMarcel Holtmann struct hci_dev *hdev = req->hdev; 916a98e383SMarcel Holtmann struct sk_buff *skb; 926a98e383SMarcel Holtmann 936a98e383SMarcel Holtmann bt_dev_dbg(hdev, "opcode 0x%4.4x plen %d", opcode, plen); 946a98e383SMarcel Holtmann 956a98e383SMarcel Holtmann /* If an error occurred during request building, there is no point in 966a98e383SMarcel Holtmann * queueing the HCI command. We can simply return. 976a98e383SMarcel Holtmann */ 986a98e383SMarcel Holtmann if (req->err) 996a98e383SMarcel Holtmann return; 1006a98e383SMarcel Holtmann 1016a98e383SMarcel Holtmann skb = hci_cmd_sync_alloc(hdev, opcode, plen, param, sk); 1026a98e383SMarcel Holtmann if (!skb) { 1036a98e383SMarcel Holtmann bt_dev_err(hdev, "no memory for command (opcode 0x%4.4x)", 1046a98e383SMarcel Holtmann opcode); 1056a98e383SMarcel Holtmann req->err = -ENOMEM; 1066a98e383SMarcel Holtmann return; 1076a98e383SMarcel Holtmann } 1086a98e383SMarcel Holtmann 1096a98e383SMarcel Holtmann if (skb_queue_empty(&req->cmd_q)) 1106a98e383SMarcel Holtmann bt_cb(skb)->hci.req_flags |= HCI_REQ_START; 1116a98e383SMarcel Holtmann 11285b56857SLuiz Augusto von Dentz hci_skb_event(skb) = event; 1136a98e383SMarcel Holtmann 1146a98e383SMarcel Holtmann skb_queue_tail(&req->cmd_q, skb); 1156a98e383SMarcel Holtmann } 1166a98e383SMarcel Holtmann 1176a98e383SMarcel Holtmann static int hci_cmd_sync_run(struct hci_request *req) 1186a98e383SMarcel Holtmann { 1196a98e383SMarcel Holtmann struct hci_dev *hdev = req->hdev; 1206a98e383SMarcel Holtmann struct sk_buff *skb; 1216a98e383SMarcel Holtmann unsigned long flags; 1226a98e383SMarcel Holtmann 1236a98e383SMarcel Holtmann bt_dev_dbg(hdev, "length %u", skb_queue_len(&req->cmd_q)); 1246a98e383SMarcel Holtmann 1256a98e383SMarcel Holtmann /* If an error occurred during request building, remove all HCI 1266a98e383SMarcel Holtmann * commands queued on the HCI request queue. 1276a98e383SMarcel Holtmann */ 1286a98e383SMarcel Holtmann if (req->err) { 1296a98e383SMarcel Holtmann skb_queue_purge(&req->cmd_q); 1306a98e383SMarcel Holtmann return req->err; 1316a98e383SMarcel Holtmann } 1326a98e383SMarcel Holtmann 1336a98e383SMarcel Holtmann /* Do not allow empty requests */ 1346a98e383SMarcel Holtmann if (skb_queue_empty(&req->cmd_q)) 1356a98e383SMarcel Holtmann return -ENODATA; 1366a98e383SMarcel Holtmann 1376a98e383SMarcel Holtmann skb = skb_peek_tail(&req->cmd_q); 1386a98e383SMarcel Holtmann bt_cb(skb)->hci.req_complete_skb = hci_cmd_sync_complete; 1396a98e383SMarcel Holtmann bt_cb(skb)->hci.req_flags |= HCI_REQ_SKB; 1406a98e383SMarcel Holtmann 1416a98e383SMarcel Holtmann spin_lock_irqsave(&hdev->cmd_q.lock, flags); 1426a98e383SMarcel Holtmann skb_queue_splice_tail(&req->cmd_q, &hdev->cmd_q); 1436a98e383SMarcel Holtmann spin_unlock_irqrestore(&hdev->cmd_q.lock, flags); 1446a98e383SMarcel Holtmann 1456a98e383SMarcel Holtmann queue_work(hdev->workqueue, &hdev->cmd_work); 1466a98e383SMarcel Holtmann 1476a98e383SMarcel Holtmann return 0; 1486a98e383SMarcel Holtmann } 1496a98e383SMarcel Holtmann 1506a98e383SMarcel Holtmann /* This function requires the caller holds hdev->req_lock. */ 1516a98e383SMarcel Holtmann struct sk_buff *__hci_cmd_sync_sk(struct hci_dev *hdev, u16 opcode, u32 plen, 1526a98e383SMarcel Holtmann const void *param, u8 event, u32 timeout, 1536a98e383SMarcel Holtmann struct sock *sk) 1546a98e383SMarcel Holtmann { 1556a98e383SMarcel Holtmann struct hci_request req; 1566a98e383SMarcel Holtmann struct sk_buff *skb; 1576a98e383SMarcel Holtmann int err = 0; 1586a98e383SMarcel Holtmann 159d4b8c082SMarcel Ziswiler bt_dev_dbg(hdev, "Opcode 0x%4.4x", opcode); 1606a98e383SMarcel Holtmann 1616a98e383SMarcel Holtmann hci_req_init(&req, hdev); 1626a98e383SMarcel Holtmann 1636a98e383SMarcel Holtmann hci_cmd_sync_add(&req, opcode, plen, param, event, sk); 1646a98e383SMarcel Holtmann 1656a98e383SMarcel Holtmann hdev->req_status = HCI_REQ_PEND; 1666a98e383SMarcel Holtmann 1676a98e383SMarcel Holtmann err = hci_cmd_sync_run(&req); 1686a98e383SMarcel Holtmann if (err < 0) 1696a98e383SMarcel Holtmann return ERR_PTR(err); 1706a98e383SMarcel Holtmann 1716a98e383SMarcel Holtmann err = wait_event_interruptible_timeout(hdev->req_wait_q, 1726a98e383SMarcel Holtmann hdev->req_status != HCI_REQ_PEND, 1736a98e383SMarcel Holtmann timeout); 1746a98e383SMarcel Holtmann 1756a98e383SMarcel Holtmann if (err == -ERESTARTSYS) 1766a98e383SMarcel Holtmann return ERR_PTR(-EINTR); 1776a98e383SMarcel Holtmann 1786a98e383SMarcel Holtmann switch (hdev->req_status) { 1796a98e383SMarcel Holtmann case HCI_REQ_DONE: 1806a98e383SMarcel Holtmann err = -bt_to_errno(hdev->req_result); 1816a98e383SMarcel Holtmann break; 1826a98e383SMarcel Holtmann 1836a98e383SMarcel Holtmann case HCI_REQ_CANCELED: 1846a98e383SMarcel Holtmann err = -hdev->req_result; 1856a98e383SMarcel Holtmann break; 1866a98e383SMarcel Holtmann 1876a98e383SMarcel Holtmann default: 1886a98e383SMarcel Holtmann err = -ETIMEDOUT; 1896a98e383SMarcel Holtmann break; 1906a98e383SMarcel Holtmann } 1916a98e383SMarcel Holtmann 1926a98e383SMarcel Holtmann hdev->req_status = 0; 1936a98e383SMarcel Holtmann hdev->req_result = 0; 1942af7aa66SLuiz Augusto von Dentz skb = hdev->req_rsp; 1952af7aa66SLuiz Augusto von Dentz hdev->req_rsp = NULL; 1966a98e383SMarcel Holtmann 1976a98e383SMarcel Holtmann bt_dev_dbg(hdev, "end: err %d", err); 1986a98e383SMarcel Holtmann 1996a98e383SMarcel Holtmann if (err < 0) { 2006a98e383SMarcel Holtmann kfree_skb(skb); 2016a98e383SMarcel Holtmann return ERR_PTR(err); 2026a98e383SMarcel Holtmann } 2036a98e383SMarcel Holtmann 2046a98e383SMarcel Holtmann return skb; 2056a98e383SMarcel Holtmann } 2066a98e383SMarcel Holtmann EXPORT_SYMBOL(__hci_cmd_sync_sk); 2076a98e383SMarcel Holtmann 2086a98e383SMarcel Holtmann /* This function requires the caller holds hdev->req_lock. */ 2096a98e383SMarcel Holtmann struct sk_buff *__hci_cmd_sync(struct hci_dev *hdev, u16 opcode, u32 plen, 2106a98e383SMarcel Holtmann const void *param, u32 timeout) 2116a98e383SMarcel Holtmann { 2126a98e383SMarcel Holtmann return __hci_cmd_sync_sk(hdev, opcode, plen, param, 0, timeout, NULL); 2136a98e383SMarcel Holtmann } 2146a98e383SMarcel Holtmann EXPORT_SYMBOL(__hci_cmd_sync); 2156a98e383SMarcel Holtmann 2166a98e383SMarcel Holtmann /* Send HCI command and wait for command complete event */ 2176a98e383SMarcel Holtmann struct sk_buff *hci_cmd_sync(struct hci_dev *hdev, u16 opcode, u32 plen, 2186a98e383SMarcel Holtmann const void *param, u32 timeout) 2196a98e383SMarcel Holtmann { 2206a98e383SMarcel Holtmann struct sk_buff *skb; 2216a98e383SMarcel Holtmann 2226a98e383SMarcel Holtmann if (!test_bit(HCI_UP, &hdev->flags)) 2236a98e383SMarcel Holtmann return ERR_PTR(-ENETDOWN); 2246a98e383SMarcel Holtmann 2256a98e383SMarcel Holtmann bt_dev_dbg(hdev, "opcode 0x%4.4x plen %d", opcode, plen); 2266a98e383SMarcel Holtmann 2276a98e383SMarcel Holtmann hci_req_sync_lock(hdev); 2286a98e383SMarcel Holtmann skb = __hci_cmd_sync(hdev, opcode, plen, param, timeout); 2296a98e383SMarcel Holtmann hci_req_sync_unlock(hdev); 2306a98e383SMarcel Holtmann 2316a98e383SMarcel Holtmann return skb; 2326a98e383SMarcel Holtmann } 2336a98e383SMarcel Holtmann EXPORT_SYMBOL(hci_cmd_sync); 2346a98e383SMarcel Holtmann 2356a98e383SMarcel Holtmann /* This function requires the caller holds hdev->req_lock. */ 2366a98e383SMarcel Holtmann struct sk_buff *__hci_cmd_sync_ev(struct hci_dev *hdev, u16 opcode, u32 plen, 2376a98e383SMarcel Holtmann const void *param, u8 event, u32 timeout) 2386a98e383SMarcel Holtmann { 2396a98e383SMarcel Holtmann return __hci_cmd_sync_sk(hdev, opcode, plen, param, event, timeout, 2406a98e383SMarcel Holtmann NULL); 2416a98e383SMarcel Holtmann } 2426a98e383SMarcel Holtmann EXPORT_SYMBOL(__hci_cmd_sync_ev); 2436a98e383SMarcel Holtmann 2446a98e383SMarcel Holtmann /* This function requires the caller holds hdev->req_lock. */ 2456a98e383SMarcel Holtmann int __hci_cmd_sync_status_sk(struct hci_dev *hdev, u16 opcode, u32 plen, 2466a98e383SMarcel Holtmann const void *param, u8 event, u32 timeout, 2476a98e383SMarcel Holtmann struct sock *sk) 2486a98e383SMarcel Holtmann { 2496a98e383SMarcel Holtmann struct sk_buff *skb; 2506a98e383SMarcel Holtmann u8 status; 2516a98e383SMarcel Holtmann 2526a98e383SMarcel Holtmann skb = __hci_cmd_sync_sk(hdev, opcode, plen, param, event, timeout, sk); 253abfeea47SLuiz Augusto von Dentz if (IS_ERR(skb)) { 254b62e7220SLuiz Augusto von Dentz if (!event) 255d4b8c082SMarcel Ziswiler bt_dev_err(hdev, "Opcode 0x%4.4x failed: %ld", opcode, 2566a98e383SMarcel Holtmann PTR_ERR(skb)); 2576a98e383SMarcel Holtmann return PTR_ERR(skb); 2586a98e383SMarcel Holtmann } 2596a98e383SMarcel Holtmann 260abfeea47SLuiz Augusto von Dentz /* If command return a status event skb will be set to NULL as there are 261abfeea47SLuiz Augusto von Dentz * no parameters, in case of failure IS_ERR(skb) would have be set to 262abfeea47SLuiz Augusto von Dentz * the actual error would be found with PTR_ERR(skb). 263abfeea47SLuiz Augusto von Dentz */ 264abfeea47SLuiz Augusto von Dentz if (!skb) 265abfeea47SLuiz Augusto von Dentz return 0; 266abfeea47SLuiz Augusto von Dentz 2676a98e383SMarcel Holtmann status = skb->data[0]; 2686a98e383SMarcel Holtmann 2696a98e383SMarcel Holtmann kfree_skb(skb); 2706a98e383SMarcel Holtmann 2716a98e383SMarcel Holtmann return status; 2726a98e383SMarcel Holtmann } 2736a98e383SMarcel Holtmann EXPORT_SYMBOL(__hci_cmd_sync_status_sk); 2746a98e383SMarcel Holtmann 2756a98e383SMarcel Holtmann int __hci_cmd_sync_status(struct hci_dev *hdev, u16 opcode, u32 plen, 2766a98e383SMarcel Holtmann const void *param, u32 timeout) 2776a98e383SMarcel Holtmann { 2786a98e383SMarcel Holtmann return __hci_cmd_sync_status_sk(hdev, opcode, plen, param, 0, timeout, 2796a98e383SMarcel Holtmann NULL); 2806a98e383SMarcel Holtmann } 2816a98e383SMarcel Holtmann EXPORT_SYMBOL(__hci_cmd_sync_status); 2826a98e383SMarcel Holtmann 283b0fc1bd2SLuiz Augusto von Dentz int hci_cmd_sync_status(struct hci_dev *hdev, u16 opcode, u32 plen, 284b0fc1bd2SLuiz Augusto von Dentz const void *param, u32 timeout) 285b0fc1bd2SLuiz Augusto von Dentz { 286b0fc1bd2SLuiz Augusto von Dentz int err; 287b0fc1bd2SLuiz Augusto von Dentz 288b0fc1bd2SLuiz Augusto von Dentz hci_req_sync_lock(hdev); 289b0fc1bd2SLuiz Augusto von Dentz err = __hci_cmd_sync_status(hdev, opcode, plen, param, timeout); 290b0fc1bd2SLuiz Augusto von Dentz hci_req_sync_unlock(hdev); 291b0fc1bd2SLuiz Augusto von Dentz 292b0fc1bd2SLuiz Augusto von Dentz return err; 293b0fc1bd2SLuiz Augusto von Dentz } 294b0fc1bd2SLuiz Augusto von Dentz EXPORT_SYMBOL(hci_cmd_sync_status); 295b0fc1bd2SLuiz Augusto von Dentz 2966a98e383SMarcel Holtmann static void hci_cmd_sync_work(struct work_struct *work) 2976a98e383SMarcel Holtmann { 2986a98e383SMarcel Holtmann struct hci_dev *hdev = container_of(work, struct hci_dev, cmd_sync_work); 2996a98e383SMarcel Holtmann 3006a98e383SMarcel Holtmann bt_dev_dbg(hdev, ""); 3016a98e383SMarcel Holtmann 302008ee9ebSLuiz Augusto von Dentz /* Dequeue all entries and run them */ 303008ee9ebSLuiz Augusto von Dentz while (1) { 304008ee9ebSLuiz Augusto von Dentz struct hci_cmd_sync_work_entry *entry; 305008ee9ebSLuiz Augusto von Dentz 3066a98e383SMarcel Holtmann mutex_lock(&hdev->cmd_sync_work_lock); 307008ee9ebSLuiz Augusto von Dentz entry = list_first_entry_or_null(&hdev->cmd_sync_work_list, 308008ee9ebSLuiz Augusto von Dentz struct hci_cmd_sync_work_entry, 309008ee9ebSLuiz Augusto von Dentz list); 310008ee9ebSLuiz Augusto von Dentz if (entry) 3116a98e383SMarcel Holtmann list_del(&entry->list); 3126a98e383SMarcel Holtmann mutex_unlock(&hdev->cmd_sync_work_lock); 3136a98e383SMarcel Holtmann 314008ee9ebSLuiz Augusto von Dentz if (!entry) 315008ee9ebSLuiz Augusto von Dentz break; 316008ee9ebSLuiz Augusto von Dentz 317008ee9ebSLuiz Augusto von Dentz bt_dev_dbg(hdev, "entry %p", entry); 318008ee9ebSLuiz Augusto von Dentz 319008ee9ebSLuiz Augusto von Dentz if (entry->func) { 3206a98e383SMarcel Holtmann int err; 3216a98e383SMarcel Holtmann 3226a98e383SMarcel Holtmann hci_req_sync_lock(hdev); 323008ee9ebSLuiz Augusto von Dentz err = entry->func(hdev, entry->data); 324008ee9ebSLuiz Augusto von Dentz if (entry->destroy) 325008ee9ebSLuiz Augusto von Dentz entry->destroy(hdev, entry->data, err); 3266a98e383SMarcel Holtmann hci_req_sync_unlock(hdev); 3276a98e383SMarcel Holtmann } 328008ee9ebSLuiz Augusto von Dentz 329008ee9ebSLuiz Augusto von Dentz kfree(entry); 330008ee9ebSLuiz Augusto von Dentz } 3316a98e383SMarcel Holtmann } 3326a98e383SMarcel Holtmann 333744451c1SBenjamin Berg static void hci_cmd_sync_cancel_work(struct work_struct *work) 334744451c1SBenjamin Berg { 335744451c1SBenjamin Berg struct hci_dev *hdev = container_of(work, struct hci_dev, cmd_sync_cancel_work); 336744451c1SBenjamin Berg 337744451c1SBenjamin Berg cancel_delayed_work_sync(&hdev->cmd_timer); 338744451c1SBenjamin Berg cancel_delayed_work_sync(&hdev->ncmd_timer); 339744451c1SBenjamin Berg atomic_set(&hdev->cmd_cnt, 1); 340744451c1SBenjamin Berg 341744451c1SBenjamin Berg wake_up_interruptible(&hdev->req_wait_q); 342744451c1SBenjamin Berg } 343744451c1SBenjamin Berg 3448ffde2a7SBrian Gix static int hci_scan_disable_sync(struct hci_dev *hdev); 3458ffde2a7SBrian Gix static int scan_disable_sync(struct hci_dev *hdev, void *data) 3468ffde2a7SBrian Gix { 3478ffde2a7SBrian Gix return hci_scan_disable_sync(hdev); 3488ffde2a7SBrian Gix } 3498ffde2a7SBrian Gix 3508ffde2a7SBrian Gix static int hci_inquiry_sync(struct hci_dev *hdev, u8 length); 3518ffde2a7SBrian Gix static int interleaved_inquiry_sync(struct hci_dev *hdev, void *data) 3528ffde2a7SBrian Gix { 3538ffde2a7SBrian Gix return hci_inquiry_sync(hdev, DISCOV_INTERLEAVED_INQUIRY_LEN); 3548ffde2a7SBrian Gix } 3558ffde2a7SBrian Gix 3568ffde2a7SBrian Gix static void le_scan_disable(struct work_struct *work) 3578ffde2a7SBrian Gix { 3588ffde2a7SBrian Gix struct hci_dev *hdev = container_of(work, struct hci_dev, 3598ffde2a7SBrian Gix le_scan_disable.work); 3608ffde2a7SBrian Gix int status; 3618ffde2a7SBrian Gix 3628ffde2a7SBrian Gix bt_dev_dbg(hdev, ""); 3638ffde2a7SBrian Gix hci_dev_lock(hdev); 3648ffde2a7SBrian Gix 3658ffde2a7SBrian Gix if (!hci_dev_test_flag(hdev, HCI_LE_SCAN)) 3668ffde2a7SBrian Gix goto _return; 3678ffde2a7SBrian Gix 3688ffde2a7SBrian Gix cancel_delayed_work(&hdev->le_scan_restart); 3698ffde2a7SBrian Gix 3708ffde2a7SBrian Gix status = hci_cmd_sync_queue(hdev, scan_disable_sync, NULL, NULL); 3718ffde2a7SBrian Gix if (status) { 3728ffde2a7SBrian Gix bt_dev_err(hdev, "failed to disable LE scan: %d", status); 3738ffde2a7SBrian Gix goto _return; 3748ffde2a7SBrian Gix } 3758ffde2a7SBrian Gix 3768ffde2a7SBrian Gix hdev->discovery.scan_start = 0; 3778ffde2a7SBrian Gix 3788ffde2a7SBrian Gix /* If we were running LE only scan, change discovery state. If 3798ffde2a7SBrian Gix * we were running both LE and BR/EDR inquiry simultaneously, 3808ffde2a7SBrian Gix * and BR/EDR inquiry is already finished, stop discovery, 3818ffde2a7SBrian Gix * otherwise BR/EDR inquiry will stop discovery when finished. 3828ffde2a7SBrian Gix * If we will resolve remote device name, do not change 3838ffde2a7SBrian Gix * discovery state. 3848ffde2a7SBrian Gix */ 3858ffde2a7SBrian Gix 3868ffde2a7SBrian Gix if (hdev->discovery.type == DISCOV_TYPE_LE) 3878ffde2a7SBrian Gix goto discov_stopped; 3888ffde2a7SBrian Gix 3898ffde2a7SBrian Gix if (hdev->discovery.type != DISCOV_TYPE_INTERLEAVED) 3908ffde2a7SBrian Gix goto _return; 3918ffde2a7SBrian Gix 3928ffde2a7SBrian Gix if (test_bit(HCI_QUIRK_SIMULTANEOUS_DISCOVERY, &hdev->quirks)) { 3938ffde2a7SBrian Gix if (!test_bit(HCI_INQUIRY, &hdev->flags) && 3948ffde2a7SBrian Gix hdev->discovery.state != DISCOVERY_RESOLVING) 3958ffde2a7SBrian Gix goto discov_stopped; 3968ffde2a7SBrian Gix 3978ffde2a7SBrian Gix goto _return; 3988ffde2a7SBrian Gix } 3998ffde2a7SBrian Gix 4008ffde2a7SBrian Gix status = hci_cmd_sync_queue(hdev, interleaved_inquiry_sync, NULL, NULL); 4018ffde2a7SBrian Gix if (status) { 4028ffde2a7SBrian Gix bt_dev_err(hdev, "inquiry failed: status %d", status); 4038ffde2a7SBrian Gix goto discov_stopped; 4048ffde2a7SBrian Gix } 4058ffde2a7SBrian Gix 4068ffde2a7SBrian Gix goto _return; 4078ffde2a7SBrian Gix 4088ffde2a7SBrian Gix discov_stopped: 4098ffde2a7SBrian Gix hci_discovery_set_state(hdev, DISCOVERY_STOPPED); 4108ffde2a7SBrian Gix 4118ffde2a7SBrian Gix _return: 4128ffde2a7SBrian Gix hci_dev_unlock(hdev); 4138ffde2a7SBrian Gix } 4148ffde2a7SBrian Gix 41527d54b77SBrian Gix static int hci_le_set_scan_enable_sync(struct hci_dev *hdev, u8 val, 41627d54b77SBrian Gix u8 filter_dup); 41727d54b77SBrian Gix static int hci_le_scan_restart_sync(struct hci_dev *hdev) 41827d54b77SBrian Gix { 41927d54b77SBrian Gix /* If controller is not scanning we are done. */ 42027d54b77SBrian Gix if (!hci_dev_test_flag(hdev, HCI_LE_SCAN)) 42127d54b77SBrian Gix return 0; 42227d54b77SBrian Gix 42327d54b77SBrian Gix if (hdev->scanning_paused) { 42427d54b77SBrian Gix bt_dev_dbg(hdev, "Scanning is paused for suspend"); 42527d54b77SBrian Gix return 0; 42627d54b77SBrian Gix } 42727d54b77SBrian Gix 42827d54b77SBrian Gix hci_le_set_scan_enable_sync(hdev, LE_SCAN_DISABLE, 0x00); 42927d54b77SBrian Gix return hci_le_set_scan_enable_sync(hdev, LE_SCAN_ENABLE, 43027d54b77SBrian Gix LE_SCAN_FILTER_DUP_ENABLE); 43127d54b77SBrian Gix } 43227d54b77SBrian Gix 43327d54b77SBrian Gix static void le_scan_restart(struct work_struct *work) 43427d54b77SBrian Gix { 43527d54b77SBrian Gix struct hci_dev *hdev = container_of(work, struct hci_dev, 43627d54b77SBrian Gix le_scan_restart.work); 43727d54b77SBrian Gix unsigned long timeout, duration, scan_start, now; 43827d54b77SBrian Gix int status; 43927d54b77SBrian Gix 44027d54b77SBrian Gix bt_dev_dbg(hdev, ""); 44127d54b77SBrian Gix 442941c998bSLuiz Augusto von Dentz status = hci_le_scan_restart_sync(hdev); 44327d54b77SBrian Gix if (status) { 44427d54b77SBrian Gix bt_dev_err(hdev, "failed to restart LE scan: status %d", 44527d54b77SBrian Gix status); 446941c998bSLuiz Augusto von Dentz return; 44727d54b77SBrian Gix } 44827d54b77SBrian Gix 449941c998bSLuiz Augusto von Dentz hci_dev_lock(hdev); 450941c998bSLuiz Augusto von Dentz 45127d54b77SBrian Gix if (!test_bit(HCI_QUIRK_STRICT_DUPLICATE_FILTER, &hdev->quirks) || 45227d54b77SBrian Gix !hdev->discovery.scan_start) 45327d54b77SBrian Gix goto unlock; 45427d54b77SBrian Gix 45527d54b77SBrian Gix /* When the scan was started, hdev->le_scan_disable has been queued 45627d54b77SBrian Gix * after duration from scan_start. During scan restart this job 45727d54b77SBrian Gix * has been canceled, and we need to queue it again after proper 45827d54b77SBrian Gix * timeout, to make sure that scan does not run indefinitely. 45927d54b77SBrian Gix */ 46027d54b77SBrian Gix duration = hdev->discovery.scan_duration; 46127d54b77SBrian Gix scan_start = hdev->discovery.scan_start; 46227d54b77SBrian Gix now = jiffies; 46327d54b77SBrian Gix if (now - scan_start <= duration) { 46427d54b77SBrian Gix int elapsed; 46527d54b77SBrian Gix 46627d54b77SBrian Gix if (now >= scan_start) 46727d54b77SBrian Gix elapsed = now - scan_start; 46827d54b77SBrian Gix else 46927d54b77SBrian Gix elapsed = ULONG_MAX - scan_start + now; 47027d54b77SBrian Gix 47127d54b77SBrian Gix timeout = duration - elapsed; 47227d54b77SBrian Gix } else { 47327d54b77SBrian Gix timeout = 0; 47427d54b77SBrian Gix } 47527d54b77SBrian Gix 47627d54b77SBrian Gix queue_delayed_work(hdev->req_workqueue, 47727d54b77SBrian Gix &hdev->le_scan_disable, timeout); 47827d54b77SBrian Gix 47927d54b77SBrian Gix unlock: 48027d54b77SBrian Gix hci_dev_unlock(hdev); 48127d54b77SBrian Gix } 48227d54b77SBrian Gix 483b338d917SBrian Gix static int reenable_adv_sync(struct hci_dev *hdev, void *data) 484b338d917SBrian Gix { 485b338d917SBrian Gix bt_dev_dbg(hdev, ""); 486b338d917SBrian Gix 487b338d917SBrian Gix if (!hci_dev_test_flag(hdev, HCI_ADVERTISING) && 488b338d917SBrian Gix list_empty(&hdev->adv_instances)) 489b338d917SBrian Gix return 0; 490b338d917SBrian Gix 491b338d917SBrian Gix if (hdev->cur_adv_instance) { 492b338d917SBrian Gix return hci_schedule_adv_instance_sync(hdev, 493b338d917SBrian Gix hdev->cur_adv_instance, 494b338d917SBrian Gix true); 495b338d917SBrian Gix } else { 496b338d917SBrian Gix if (ext_adv_capable(hdev)) { 497b338d917SBrian Gix hci_start_ext_adv_sync(hdev, 0x00); 498b338d917SBrian Gix } else { 499b338d917SBrian Gix hci_update_adv_data_sync(hdev, 0x00); 500b338d917SBrian Gix hci_update_scan_rsp_data_sync(hdev, 0x00); 501b338d917SBrian Gix hci_enable_advertising_sync(hdev); 502b338d917SBrian Gix } 503b338d917SBrian Gix } 504b338d917SBrian Gix 505b338d917SBrian Gix return 0; 506b338d917SBrian Gix } 507b338d917SBrian Gix 508b338d917SBrian Gix static void reenable_adv(struct work_struct *work) 509b338d917SBrian Gix { 510b338d917SBrian Gix struct hci_dev *hdev = container_of(work, struct hci_dev, 511b338d917SBrian Gix reenable_adv_work); 512b338d917SBrian Gix int status; 513b338d917SBrian Gix 514b338d917SBrian Gix bt_dev_dbg(hdev, ""); 515b338d917SBrian Gix 516b338d917SBrian Gix hci_dev_lock(hdev); 517b338d917SBrian Gix 518b338d917SBrian Gix status = hci_cmd_sync_queue(hdev, reenable_adv_sync, NULL, NULL); 519b338d917SBrian Gix if (status) 520b338d917SBrian Gix bt_dev_err(hdev, "failed to reenable ADV: %d", status); 521b338d917SBrian Gix 522b338d917SBrian Gix hci_dev_unlock(hdev); 523b338d917SBrian Gix } 524b338d917SBrian Gix 525c249ea9bSBrian Gix static void cancel_adv_timeout(struct hci_dev *hdev) 526c249ea9bSBrian Gix { 527c249ea9bSBrian Gix if (hdev->adv_instance_timeout) { 528c249ea9bSBrian Gix hdev->adv_instance_timeout = 0; 529c249ea9bSBrian Gix cancel_delayed_work(&hdev->adv_instance_expire); 530c249ea9bSBrian Gix } 531c249ea9bSBrian Gix } 532c249ea9bSBrian Gix 533c249ea9bSBrian Gix /* For a single instance: 534c249ea9bSBrian Gix * - force == true: The instance will be removed even when its remaining 535c249ea9bSBrian Gix * lifetime is not zero. 536c249ea9bSBrian Gix * - force == false: the instance will be deactivated but kept stored unless 537c249ea9bSBrian Gix * the remaining lifetime is zero. 538c249ea9bSBrian Gix * 539c249ea9bSBrian Gix * For instance == 0x00: 540c249ea9bSBrian Gix * - force == true: All instances will be removed regardless of their timeout 541c249ea9bSBrian Gix * setting. 542c249ea9bSBrian Gix * - force == false: Only instances that have a timeout will be removed. 543c249ea9bSBrian Gix */ 544c249ea9bSBrian Gix int hci_clear_adv_instance_sync(struct hci_dev *hdev, struct sock *sk, 545c249ea9bSBrian Gix u8 instance, bool force) 546c249ea9bSBrian Gix { 547c249ea9bSBrian Gix struct adv_info *adv_instance, *n, *next_instance = NULL; 548c249ea9bSBrian Gix int err; 549c249ea9bSBrian Gix u8 rem_inst; 550c249ea9bSBrian Gix 551c249ea9bSBrian Gix /* Cancel any timeout concerning the removed instance(s). */ 552c249ea9bSBrian Gix if (!instance || hdev->cur_adv_instance == instance) 553c249ea9bSBrian Gix cancel_adv_timeout(hdev); 554c249ea9bSBrian Gix 555c249ea9bSBrian Gix /* Get the next instance to advertise BEFORE we remove 556c249ea9bSBrian Gix * the current one. This can be the same instance again 557c249ea9bSBrian Gix * if there is only one instance. 558c249ea9bSBrian Gix */ 559c249ea9bSBrian Gix if (instance && hdev->cur_adv_instance == instance) 560c249ea9bSBrian Gix next_instance = hci_get_next_instance(hdev, instance); 561c249ea9bSBrian Gix 562c249ea9bSBrian Gix if (instance == 0x00) { 563c249ea9bSBrian Gix list_for_each_entry_safe(adv_instance, n, &hdev->adv_instances, 564c249ea9bSBrian Gix list) { 565c249ea9bSBrian Gix if (!(force || adv_instance->timeout)) 566c249ea9bSBrian Gix continue; 567c249ea9bSBrian Gix 568c249ea9bSBrian Gix rem_inst = adv_instance->instance; 569c249ea9bSBrian Gix err = hci_remove_adv_instance(hdev, rem_inst); 570c249ea9bSBrian Gix if (!err) 571c249ea9bSBrian Gix mgmt_advertising_removed(sk, hdev, rem_inst); 572c249ea9bSBrian Gix } 573c249ea9bSBrian Gix } else { 574c249ea9bSBrian Gix adv_instance = hci_find_adv_instance(hdev, instance); 575c249ea9bSBrian Gix 576c249ea9bSBrian Gix if (force || (adv_instance && adv_instance->timeout && 577c249ea9bSBrian Gix !adv_instance->remaining_time)) { 578c249ea9bSBrian Gix /* Don't advertise a removed instance. */ 579c249ea9bSBrian Gix if (next_instance && 580c249ea9bSBrian Gix next_instance->instance == instance) 581c249ea9bSBrian Gix next_instance = NULL; 582c249ea9bSBrian Gix 583c249ea9bSBrian Gix err = hci_remove_adv_instance(hdev, instance); 584c249ea9bSBrian Gix if (!err) 585c249ea9bSBrian Gix mgmt_advertising_removed(sk, hdev, instance); 586c249ea9bSBrian Gix } 587c249ea9bSBrian Gix } 588c249ea9bSBrian Gix 589c249ea9bSBrian Gix if (!hdev_is_powered(hdev) || hci_dev_test_flag(hdev, HCI_ADVERTISING)) 590c249ea9bSBrian Gix return 0; 591c249ea9bSBrian Gix 592c249ea9bSBrian Gix if (next_instance && !ext_adv_capable(hdev)) 593c249ea9bSBrian Gix return hci_schedule_adv_instance_sync(hdev, 594c249ea9bSBrian Gix next_instance->instance, 595c249ea9bSBrian Gix false); 596c249ea9bSBrian Gix 597c249ea9bSBrian Gix return 0; 598c249ea9bSBrian Gix } 599c249ea9bSBrian Gix 600c249ea9bSBrian Gix static int adv_timeout_expire_sync(struct hci_dev *hdev, void *data) 601c249ea9bSBrian Gix { 602c249ea9bSBrian Gix u8 instance = *(u8 *)data; 603c249ea9bSBrian Gix 604c249ea9bSBrian Gix kfree(data); 605c249ea9bSBrian Gix 606c249ea9bSBrian Gix hci_clear_adv_instance_sync(hdev, NULL, instance, false); 607c249ea9bSBrian Gix 608c249ea9bSBrian Gix if (list_empty(&hdev->adv_instances)) 609c249ea9bSBrian Gix return hci_disable_advertising_sync(hdev); 610c249ea9bSBrian Gix 611c249ea9bSBrian Gix return 0; 612c249ea9bSBrian Gix } 613c249ea9bSBrian Gix 614c249ea9bSBrian Gix static void adv_timeout_expire(struct work_struct *work) 615c249ea9bSBrian Gix { 616c249ea9bSBrian Gix u8 *inst_ptr; 617c249ea9bSBrian Gix struct hci_dev *hdev = container_of(work, struct hci_dev, 618c249ea9bSBrian Gix adv_instance_expire.work); 619c249ea9bSBrian Gix 620c249ea9bSBrian Gix bt_dev_dbg(hdev, ""); 621c249ea9bSBrian Gix 622c249ea9bSBrian Gix hci_dev_lock(hdev); 623c249ea9bSBrian Gix 624c249ea9bSBrian Gix hdev->adv_instance_timeout = 0; 625c249ea9bSBrian Gix 626c249ea9bSBrian Gix if (hdev->cur_adv_instance == 0x00) 627c249ea9bSBrian Gix goto unlock; 628c249ea9bSBrian Gix 629c249ea9bSBrian Gix inst_ptr = kmalloc(1, GFP_KERNEL); 630c249ea9bSBrian Gix if (!inst_ptr) 631c249ea9bSBrian Gix goto unlock; 632c249ea9bSBrian Gix 633c249ea9bSBrian Gix *inst_ptr = hdev->cur_adv_instance; 634c249ea9bSBrian Gix hci_cmd_sync_queue(hdev, adv_timeout_expire_sync, inst_ptr, NULL); 635c249ea9bSBrian Gix 636c249ea9bSBrian Gix unlock: 637c249ea9bSBrian Gix hci_dev_unlock(hdev); 638c249ea9bSBrian Gix } 639c249ea9bSBrian Gix 6406a98e383SMarcel Holtmann void hci_cmd_sync_init(struct hci_dev *hdev) 6416a98e383SMarcel Holtmann { 6426a98e383SMarcel Holtmann INIT_WORK(&hdev->cmd_sync_work, hci_cmd_sync_work); 6436a98e383SMarcel Holtmann INIT_LIST_HEAD(&hdev->cmd_sync_work_list); 6446a98e383SMarcel Holtmann mutex_init(&hdev->cmd_sync_work_lock); 6451857c199SZhengping Jiang mutex_init(&hdev->unregister_lock); 646744451c1SBenjamin Berg 647744451c1SBenjamin Berg INIT_WORK(&hdev->cmd_sync_cancel_work, hci_cmd_sync_cancel_work); 648b338d917SBrian Gix INIT_WORK(&hdev->reenable_adv_work, reenable_adv); 6498ffde2a7SBrian Gix INIT_DELAYED_WORK(&hdev->le_scan_disable, le_scan_disable); 65027d54b77SBrian Gix INIT_DELAYED_WORK(&hdev->le_scan_restart, le_scan_restart); 651c249ea9bSBrian Gix INIT_DELAYED_WORK(&hdev->adv_instance_expire, adv_timeout_expire); 6526a98e383SMarcel Holtmann } 6536a98e383SMarcel Holtmann 6546a98e383SMarcel Holtmann void hci_cmd_sync_clear(struct hci_dev *hdev) 6556a98e383SMarcel Holtmann { 6566a98e383SMarcel Holtmann struct hci_cmd_sync_work_entry *entry, *tmp; 6576a98e383SMarcel Holtmann 6586a98e383SMarcel Holtmann cancel_work_sync(&hdev->cmd_sync_work); 659b338d917SBrian Gix cancel_work_sync(&hdev->reenable_adv_work); 6606a98e383SMarcel Holtmann 6611c66bee4SMin Li mutex_lock(&hdev->cmd_sync_work_lock); 6626a98e383SMarcel Holtmann list_for_each_entry_safe(entry, tmp, &hdev->cmd_sync_work_list, list) { 6636a98e383SMarcel Holtmann if (entry->destroy) 6646a98e383SMarcel Holtmann entry->destroy(hdev, entry->data, -ECANCELED); 6656a98e383SMarcel Holtmann 6666a98e383SMarcel Holtmann list_del(&entry->list); 6676a98e383SMarcel Holtmann kfree(entry); 6686a98e383SMarcel Holtmann } 6691c66bee4SMin Li mutex_unlock(&hdev->cmd_sync_work_lock); 6706a98e383SMarcel Holtmann } 6716a98e383SMarcel Holtmann 672744451c1SBenjamin Berg void hci_cmd_sync_cancel(struct hci_dev *hdev, int err) 673744451c1SBenjamin Berg { 674744451c1SBenjamin Berg bt_dev_dbg(hdev, "err 0x%2.2x", err); 675744451c1SBenjamin Berg 676744451c1SBenjamin Berg if (hdev->req_status == HCI_REQ_PEND) { 677744451c1SBenjamin Berg hdev->req_result = err; 678744451c1SBenjamin Berg hdev->req_status = HCI_REQ_CANCELED; 679744451c1SBenjamin Berg 680744451c1SBenjamin Berg queue_work(hdev->workqueue, &hdev->cmd_sync_cancel_work); 681744451c1SBenjamin Berg } 682744451c1SBenjamin Berg } 683914b08b3SBenjamin Berg EXPORT_SYMBOL(hci_cmd_sync_cancel); 684914b08b3SBenjamin Berg 6850ce1229cSLuiz Augusto von Dentz /* Cancel ongoing command request synchronously: 6860ce1229cSLuiz Augusto von Dentz * 6870ce1229cSLuiz Augusto von Dentz * - Set result and mark status to HCI_REQ_CANCELED 6880ce1229cSLuiz Augusto von Dentz * - Wakeup command sync thread 6890ce1229cSLuiz Augusto von Dentz */ 6900ce1229cSLuiz Augusto von Dentz void hci_cmd_sync_cancel_sync(struct hci_dev *hdev, int err) 6910ce1229cSLuiz Augusto von Dentz { 6920ce1229cSLuiz Augusto von Dentz bt_dev_dbg(hdev, "err 0x%2.2x", err); 6930ce1229cSLuiz Augusto von Dentz 6940ce1229cSLuiz Augusto von Dentz if (hdev->req_status == HCI_REQ_PEND) { 6959ae3954dSLuiz Augusto von Dentz /* req_result is __u32 so error must be positive to be properly 6969ae3954dSLuiz Augusto von Dentz * propagated. 6979ae3954dSLuiz Augusto von Dentz */ 6989ae3954dSLuiz Augusto von Dentz hdev->req_result = err < 0 ? -err : err; 6990ce1229cSLuiz Augusto von Dentz hdev->req_status = HCI_REQ_CANCELED; 7000ce1229cSLuiz Augusto von Dentz 7010ce1229cSLuiz Augusto von Dentz wake_up_interruptible(&hdev->req_wait_q); 7020ce1229cSLuiz Augusto von Dentz } 7030ce1229cSLuiz Augusto von Dentz } 7040ce1229cSLuiz Augusto von Dentz EXPORT_SYMBOL(hci_cmd_sync_cancel_sync); 7050ce1229cSLuiz Augusto von Dentz 706d883a466SLuiz Augusto von Dentz /* Submit HCI command to be run in as cmd_sync_work: 707d883a466SLuiz Augusto von Dentz * 708d883a466SLuiz Augusto von Dentz * - hdev must _not_ be unregistered 709d883a466SLuiz Augusto von Dentz */ 710d883a466SLuiz Augusto von Dentz int hci_cmd_sync_submit(struct hci_dev *hdev, hci_cmd_sync_work_func_t func, 7116a98e383SMarcel Holtmann void *data, hci_cmd_sync_work_destroy_t destroy) 7126a98e383SMarcel Holtmann { 7136a98e383SMarcel Holtmann struct hci_cmd_sync_work_entry *entry; 7141857c199SZhengping Jiang int err = 0; 7156a98e383SMarcel Holtmann 7161857c199SZhengping Jiang mutex_lock(&hdev->unregister_lock); 7171857c199SZhengping Jiang if (hci_dev_test_flag(hdev, HCI_UNREGISTER)) { 7181857c199SZhengping Jiang err = -ENODEV; 7191857c199SZhengping Jiang goto unlock; 7201857c199SZhengping Jiang } 7210b94f265SLuiz Augusto von Dentz 7226a98e383SMarcel Holtmann entry = kmalloc(sizeof(*entry), GFP_KERNEL); 7231857c199SZhengping Jiang if (!entry) { 7241857c199SZhengping Jiang err = -ENOMEM; 7251857c199SZhengping Jiang goto unlock; 7261857c199SZhengping Jiang } 7276a98e383SMarcel Holtmann entry->func = func; 7286a98e383SMarcel Holtmann entry->data = data; 7296a98e383SMarcel Holtmann entry->destroy = destroy; 7306a98e383SMarcel Holtmann 7316a98e383SMarcel Holtmann mutex_lock(&hdev->cmd_sync_work_lock); 7326a98e383SMarcel Holtmann list_add_tail(&entry->list, &hdev->cmd_sync_work_list); 7336a98e383SMarcel Holtmann mutex_unlock(&hdev->cmd_sync_work_lock); 7346a98e383SMarcel Holtmann 7356a98e383SMarcel Holtmann queue_work(hdev->req_workqueue, &hdev->cmd_sync_work); 7366a98e383SMarcel Holtmann 7371857c199SZhengping Jiang unlock: 7381857c199SZhengping Jiang mutex_unlock(&hdev->unregister_lock); 7391857c199SZhengping Jiang return err; 7406a98e383SMarcel Holtmann } 741d883a466SLuiz Augusto von Dentz EXPORT_SYMBOL(hci_cmd_sync_submit); 742d883a466SLuiz Augusto von Dentz 743d883a466SLuiz Augusto von Dentz /* Queue HCI command: 744d883a466SLuiz Augusto von Dentz * 745d883a466SLuiz Augusto von Dentz * - hdev must be running 746d883a466SLuiz Augusto von Dentz */ 747d883a466SLuiz Augusto von Dentz int hci_cmd_sync_queue(struct hci_dev *hdev, hci_cmd_sync_work_func_t func, 748d883a466SLuiz Augusto von Dentz void *data, hci_cmd_sync_work_destroy_t destroy) 749d883a466SLuiz Augusto von Dentz { 750d883a466SLuiz Augusto von Dentz /* Only queue command if hdev is running which means it had been opened 751d883a466SLuiz Augusto von Dentz * and is either on init phase or is already up. 752d883a466SLuiz Augusto von Dentz */ 753d883a466SLuiz Augusto von Dentz if (!test_bit(HCI_RUNNING, &hdev->flags)) 754d883a466SLuiz Augusto von Dentz return -ENETDOWN; 755d883a466SLuiz Augusto von Dentz 756d883a466SLuiz Augusto von Dentz return hci_cmd_sync_submit(hdev, func, data, destroy); 757d883a466SLuiz Augusto von Dentz } 7586a98e383SMarcel Holtmann EXPORT_SYMBOL(hci_cmd_sync_queue); 759161510ccSLuiz Augusto von Dentz 760161510ccSLuiz Augusto von Dentz int hci_update_eir_sync(struct hci_dev *hdev) 761161510ccSLuiz Augusto von Dentz { 762161510ccSLuiz Augusto von Dentz struct hci_cp_write_eir cp; 763161510ccSLuiz Augusto von Dentz 764161510ccSLuiz Augusto von Dentz bt_dev_dbg(hdev, ""); 765161510ccSLuiz Augusto von Dentz 766161510ccSLuiz Augusto von Dentz if (!hdev_is_powered(hdev)) 767161510ccSLuiz Augusto von Dentz return 0; 768161510ccSLuiz Augusto von Dentz 769161510ccSLuiz Augusto von Dentz if (!lmp_ext_inq_capable(hdev)) 770161510ccSLuiz Augusto von Dentz return 0; 771161510ccSLuiz Augusto von Dentz 772161510ccSLuiz Augusto von Dentz if (!hci_dev_test_flag(hdev, HCI_SSP_ENABLED)) 773161510ccSLuiz Augusto von Dentz return 0; 774161510ccSLuiz Augusto von Dentz 775161510ccSLuiz Augusto von Dentz if (hci_dev_test_flag(hdev, HCI_SERVICE_CACHE)) 776161510ccSLuiz Augusto von Dentz return 0; 777161510ccSLuiz Augusto von Dentz 778161510ccSLuiz Augusto von Dentz memset(&cp, 0, sizeof(cp)); 779161510ccSLuiz Augusto von Dentz 780161510ccSLuiz Augusto von Dentz eir_create(hdev, cp.data); 781161510ccSLuiz Augusto von Dentz 782161510ccSLuiz Augusto von Dentz if (memcmp(cp.data, hdev->eir, sizeof(cp.data)) == 0) 783161510ccSLuiz Augusto von Dentz return 0; 784161510ccSLuiz Augusto von Dentz 785161510ccSLuiz Augusto von Dentz memcpy(hdev->eir, cp.data, sizeof(cp.data)); 786161510ccSLuiz Augusto von Dentz 787161510ccSLuiz Augusto von Dentz return __hci_cmd_sync_status(hdev, HCI_OP_WRITE_EIR, sizeof(cp), &cp, 788161510ccSLuiz Augusto von Dentz HCI_CMD_TIMEOUT); 789161510ccSLuiz Augusto von Dentz } 790161510ccSLuiz Augusto von Dentz 791161510ccSLuiz Augusto von Dentz static u8 get_service_classes(struct hci_dev *hdev) 792161510ccSLuiz Augusto von Dentz { 793161510ccSLuiz Augusto von Dentz struct bt_uuid *uuid; 794161510ccSLuiz Augusto von Dentz u8 val = 0; 795161510ccSLuiz Augusto von Dentz 796161510ccSLuiz Augusto von Dentz list_for_each_entry(uuid, &hdev->uuids, list) 797161510ccSLuiz Augusto von Dentz val |= uuid->svc_hint; 798161510ccSLuiz Augusto von Dentz 799161510ccSLuiz Augusto von Dentz return val; 800161510ccSLuiz Augusto von Dentz } 801161510ccSLuiz Augusto von Dentz 802161510ccSLuiz Augusto von Dentz int hci_update_class_sync(struct hci_dev *hdev) 803161510ccSLuiz Augusto von Dentz { 804161510ccSLuiz Augusto von Dentz u8 cod[3]; 805161510ccSLuiz Augusto von Dentz 806161510ccSLuiz Augusto von Dentz bt_dev_dbg(hdev, ""); 807161510ccSLuiz Augusto von Dentz 808161510ccSLuiz Augusto von Dentz if (!hdev_is_powered(hdev)) 809161510ccSLuiz Augusto von Dentz return 0; 810161510ccSLuiz Augusto von Dentz 811161510ccSLuiz Augusto von Dentz if (!hci_dev_test_flag(hdev, HCI_BREDR_ENABLED)) 812161510ccSLuiz Augusto von Dentz return 0; 813161510ccSLuiz Augusto von Dentz 814161510ccSLuiz Augusto von Dentz if (hci_dev_test_flag(hdev, HCI_SERVICE_CACHE)) 815161510ccSLuiz Augusto von Dentz return 0; 816161510ccSLuiz Augusto von Dentz 817161510ccSLuiz Augusto von Dentz cod[0] = hdev->minor_class; 818161510ccSLuiz Augusto von Dentz cod[1] = hdev->major_class; 819161510ccSLuiz Augusto von Dentz cod[2] = get_service_classes(hdev); 820161510ccSLuiz Augusto von Dentz 821161510ccSLuiz Augusto von Dentz if (hci_dev_test_flag(hdev, HCI_LIMITED_DISCOVERABLE)) 822161510ccSLuiz Augusto von Dentz cod[1] |= 0x20; 823161510ccSLuiz Augusto von Dentz 824161510ccSLuiz Augusto von Dentz if (memcmp(cod, hdev->dev_class, 3) == 0) 825161510ccSLuiz Augusto von Dentz return 0; 826161510ccSLuiz Augusto von Dentz 827161510ccSLuiz Augusto von Dentz return __hci_cmd_sync_status(hdev, HCI_OP_WRITE_CLASS_OF_DEV, 828161510ccSLuiz Augusto von Dentz sizeof(cod), cod, HCI_CMD_TIMEOUT); 829161510ccSLuiz Augusto von Dentz } 830cba6b758SLuiz Augusto von Dentz 831cba6b758SLuiz Augusto von Dentz static bool is_advertising_allowed(struct hci_dev *hdev, bool connectable) 832cba6b758SLuiz Augusto von Dentz { 833cba6b758SLuiz Augusto von Dentz /* If there is no connection we are OK to advertise. */ 834cba6b758SLuiz Augusto von Dentz if (hci_conn_num(hdev, LE_LINK) == 0) 835cba6b758SLuiz Augusto von Dentz return true; 836cba6b758SLuiz Augusto von Dentz 837cba6b758SLuiz Augusto von Dentz /* Check le_states if there is any connection in peripheral role. */ 838cba6b758SLuiz Augusto von Dentz if (hdev->conn_hash.le_num_peripheral > 0) { 839cba6b758SLuiz Augusto von Dentz /* Peripheral connection state and non connectable mode 840cba6b758SLuiz Augusto von Dentz * bit 20. 841cba6b758SLuiz Augusto von Dentz */ 842cba6b758SLuiz Augusto von Dentz if (!connectable && !(hdev->le_states[2] & 0x10)) 843cba6b758SLuiz Augusto von Dentz return false; 844cba6b758SLuiz Augusto von Dentz 845cba6b758SLuiz Augusto von Dentz /* Peripheral connection state and connectable mode bit 38 846cba6b758SLuiz Augusto von Dentz * and scannable bit 21. 847cba6b758SLuiz Augusto von Dentz */ 848cba6b758SLuiz Augusto von Dentz if (connectable && (!(hdev->le_states[4] & 0x40) || 849cba6b758SLuiz Augusto von Dentz !(hdev->le_states[2] & 0x20))) 850cba6b758SLuiz Augusto von Dentz return false; 851cba6b758SLuiz Augusto von Dentz } 852cba6b758SLuiz Augusto von Dentz 853cba6b758SLuiz Augusto von Dentz /* Check le_states if there is any connection in central role. */ 854cba6b758SLuiz Augusto von Dentz if (hci_conn_num(hdev, LE_LINK) != hdev->conn_hash.le_num_peripheral) { 855cba6b758SLuiz Augusto von Dentz /* Central connection state and non connectable mode bit 18. */ 856cba6b758SLuiz Augusto von Dentz if (!connectable && !(hdev->le_states[2] & 0x02)) 857cba6b758SLuiz Augusto von Dentz return false; 858cba6b758SLuiz Augusto von Dentz 859cba6b758SLuiz Augusto von Dentz /* Central connection state and connectable mode bit 35 and 860cba6b758SLuiz Augusto von Dentz * scannable 19. 861cba6b758SLuiz Augusto von Dentz */ 862cba6b758SLuiz Augusto von Dentz if (connectable && (!(hdev->le_states[4] & 0x08) || 863cba6b758SLuiz Augusto von Dentz !(hdev->le_states[2] & 0x08))) 864cba6b758SLuiz Augusto von Dentz return false; 865cba6b758SLuiz Augusto von Dentz } 866cba6b758SLuiz Augusto von Dentz 867cba6b758SLuiz Augusto von Dentz return true; 868cba6b758SLuiz Augusto von Dentz } 869cba6b758SLuiz Augusto von Dentz 870cba6b758SLuiz Augusto von Dentz static bool adv_use_rpa(struct hci_dev *hdev, uint32_t flags) 871cba6b758SLuiz Augusto von Dentz { 872cba6b758SLuiz Augusto von Dentz /* If privacy is not enabled don't use RPA */ 873cba6b758SLuiz Augusto von Dentz if (!hci_dev_test_flag(hdev, HCI_PRIVACY)) 874cba6b758SLuiz Augusto von Dentz return false; 875cba6b758SLuiz Augusto von Dentz 876cba6b758SLuiz Augusto von Dentz /* If basic privacy mode is enabled use RPA */ 877cba6b758SLuiz Augusto von Dentz if (!hci_dev_test_flag(hdev, HCI_LIMITED_PRIVACY)) 878cba6b758SLuiz Augusto von Dentz return true; 879cba6b758SLuiz Augusto von Dentz 880cba6b758SLuiz Augusto von Dentz /* If limited privacy mode is enabled don't use RPA if we're 881cba6b758SLuiz Augusto von Dentz * both discoverable and bondable. 882cba6b758SLuiz Augusto von Dentz */ 883cba6b758SLuiz Augusto von Dentz if ((flags & MGMT_ADV_FLAG_DISCOV) && 884cba6b758SLuiz Augusto von Dentz hci_dev_test_flag(hdev, HCI_BONDABLE)) 885cba6b758SLuiz Augusto von Dentz return false; 886cba6b758SLuiz Augusto von Dentz 887cba6b758SLuiz Augusto von Dentz /* We're neither bondable nor discoverable in the limited 888cba6b758SLuiz Augusto von Dentz * privacy mode, therefore use RPA. 889cba6b758SLuiz Augusto von Dentz */ 890cba6b758SLuiz Augusto von Dentz return true; 891cba6b758SLuiz Augusto von Dentz } 892cba6b758SLuiz Augusto von Dentz 893cba6b758SLuiz Augusto von Dentz static int hci_set_random_addr_sync(struct hci_dev *hdev, bdaddr_t *rpa) 894cba6b758SLuiz Augusto von Dentz { 895cba6b758SLuiz Augusto von Dentz /* If we're advertising or initiating an LE connection we can't 896cba6b758SLuiz Augusto von Dentz * go ahead and change the random address at this time. This is 897cba6b758SLuiz Augusto von Dentz * because the eventual initiator address used for the 898cba6b758SLuiz Augusto von Dentz * subsequently created connection will be undefined (some 899cba6b758SLuiz Augusto von Dentz * controllers use the new address and others the one we had 900cba6b758SLuiz Augusto von Dentz * when the operation started). 901cba6b758SLuiz Augusto von Dentz * 902cba6b758SLuiz Augusto von Dentz * In this kind of scenario skip the update and let the random 903cba6b758SLuiz Augusto von Dentz * address be updated at the next cycle. 904cba6b758SLuiz Augusto von Dentz */ 905cba6b758SLuiz Augusto von Dentz if (hci_dev_test_flag(hdev, HCI_LE_ADV) || 906cba6b758SLuiz Augusto von Dentz hci_lookup_le_connect(hdev)) { 907cba6b758SLuiz Augusto von Dentz bt_dev_dbg(hdev, "Deferring random address update"); 908cba6b758SLuiz Augusto von Dentz hci_dev_set_flag(hdev, HCI_RPA_EXPIRED); 909cba6b758SLuiz Augusto von Dentz return 0; 910cba6b758SLuiz Augusto von Dentz } 911cba6b758SLuiz Augusto von Dentz 912cba6b758SLuiz Augusto von Dentz return __hci_cmd_sync_status(hdev, HCI_OP_LE_SET_RANDOM_ADDR, 913cba6b758SLuiz Augusto von Dentz 6, rpa, HCI_CMD_TIMEOUT); 914cba6b758SLuiz Augusto von Dentz } 915cba6b758SLuiz Augusto von Dentz 916cba6b758SLuiz Augusto von Dentz int hci_update_random_address_sync(struct hci_dev *hdev, bool require_privacy, 917cba6b758SLuiz Augusto von Dentz bool rpa, u8 *own_addr_type) 918cba6b758SLuiz Augusto von Dentz { 919cba6b758SLuiz Augusto von Dentz int err; 920cba6b758SLuiz Augusto von Dentz 921cba6b758SLuiz Augusto von Dentz /* If privacy is enabled use a resolvable private address. If 922cba6b758SLuiz Augusto von Dentz * current RPA has expired or there is something else than 923cba6b758SLuiz Augusto von Dentz * the current RPA in use, then generate a new one. 924cba6b758SLuiz Augusto von Dentz */ 925cba6b758SLuiz Augusto von Dentz if (rpa) { 926cba6b758SLuiz Augusto von Dentz /* If Controller supports LL Privacy use own address type is 927cba6b758SLuiz Augusto von Dentz * 0x03 928cba6b758SLuiz Augusto von Dentz */ 929ad383c2cSLuiz Augusto von Dentz if (use_ll_privacy(hdev)) 930cba6b758SLuiz Augusto von Dentz *own_addr_type = ADDR_LE_DEV_RANDOM_RESOLVED; 931cba6b758SLuiz Augusto von Dentz else 932cba6b758SLuiz Augusto von Dentz *own_addr_type = ADDR_LE_DEV_RANDOM; 933cba6b758SLuiz Augusto von Dentz 934cba6b758SLuiz Augusto von Dentz /* Check if RPA is valid */ 935cba6b758SLuiz Augusto von Dentz if (rpa_valid(hdev)) 936cba6b758SLuiz Augusto von Dentz return 0; 937cba6b758SLuiz Augusto von Dentz 938cba6b758SLuiz Augusto von Dentz err = smp_generate_rpa(hdev, hdev->irk, &hdev->rpa); 939cba6b758SLuiz Augusto von Dentz if (err < 0) { 940cba6b758SLuiz Augusto von Dentz bt_dev_err(hdev, "failed to generate new RPA"); 941cba6b758SLuiz Augusto von Dentz return err; 942cba6b758SLuiz Augusto von Dentz } 943cba6b758SLuiz Augusto von Dentz 944cba6b758SLuiz Augusto von Dentz err = hci_set_random_addr_sync(hdev, &hdev->rpa); 945cba6b758SLuiz Augusto von Dentz if (err) 946cba6b758SLuiz Augusto von Dentz return err; 947cba6b758SLuiz Augusto von Dentz 948cba6b758SLuiz Augusto von Dentz return 0; 949cba6b758SLuiz Augusto von Dentz } 950cba6b758SLuiz Augusto von Dentz 951cba6b758SLuiz Augusto von Dentz /* In case of required privacy without resolvable private address, 952cba6b758SLuiz Augusto von Dentz * use an non-resolvable private address. This is useful for active 953cba6b758SLuiz Augusto von Dentz * scanning and non-connectable advertising. 954cba6b758SLuiz Augusto von Dentz */ 955cba6b758SLuiz Augusto von Dentz if (require_privacy) { 956cba6b758SLuiz Augusto von Dentz bdaddr_t nrpa; 957cba6b758SLuiz Augusto von Dentz 958cba6b758SLuiz Augusto von Dentz while (true) { 959cba6b758SLuiz Augusto von Dentz /* The non-resolvable private address is generated 960cba6b758SLuiz Augusto von Dentz * from random six bytes with the two most significant 961cba6b758SLuiz Augusto von Dentz * bits cleared. 962cba6b758SLuiz Augusto von Dentz */ 963cba6b758SLuiz Augusto von Dentz get_random_bytes(&nrpa, 6); 964cba6b758SLuiz Augusto von Dentz nrpa.b[5] &= 0x3f; 965cba6b758SLuiz Augusto von Dentz 966cba6b758SLuiz Augusto von Dentz /* The non-resolvable private address shall not be 967cba6b758SLuiz Augusto von Dentz * equal to the public address. 968cba6b758SLuiz Augusto von Dentz */ 969cba6b758SLuiz Augusto von Dentz if (bacmp(&hdev->bdaddr, &nrpa)) 970cba6b758SLuiz Augusto von Dentz break; 971cba6b758SLuiz Augusto von Dentz } 972cba6b758SLuiz Augusto von Dentz 973cba6b758SLuiz Augusto von Dentz *own_addr_type = ADDR_LE_DEV_RANDOM; 974cba6b758SLuiz Augusto von Dentz 975cba6b758SLuiz Augusto von Dentz return hci_set_random_addr_sync(hdev, &nrpa); 976cba6b758SLuiz Augusto von Dentz } 977cba6b758SLuiz Augusto von Dentz 978cba6b758SLuiz Augusto von Dentz /* If forcing static address is in use or there is no public 979cba6b758SLuiz Augusto von Dentz * address use the static address as random address (but skip 980cba6b758SLuiz Augusto von Dentz * the HCI command if the current random address is already the 981cba6b758SLuiz Augusto von Dentz * static one. 982cba6b758SLuiz Augusto von Dentz * 983cba6b758SLuiz Augusto von Dentz * In case BR/EDR has been disabled on a dual-mode controller 984cba6b758SLuiz Augusto von Dentz * and a static address has been configured, then use that 985cba6b758SLuiz Augusto von Dentz * address instead of the public BR/EDR address. 986cba6b758SLuiz Augusto von Dentz */ 987cba6b758SLuiz Augusto von Dentz if (hci_dev_test_flag(hdev, HCI_FORCE_STATIC_ADDR) || 988cba6b758SLuiz Augusto von Dentz !bacmp(&hdev->bdaddr, BDADDR_ANY) || 989cba6b758SLuiz Augusto von Dentz (!hci_dev_test_flag(hdev, HCI_BREDR_ENABLED) && 990cba6b758SLuiz Augusto von Dentz bacmp(&hdev->static_addr, BDADDR_ANY))) { 991cba6b758SLuiz Augusto von Dentz *own_addr_type = ADDR_LE_DEV_RANDOM; 992cba6b758SLuiz Augusto von Dentz if (bacmp(&hdev->static_addr, &hdev->random_addr)) 993cba6b758SLuiz Augusto von Dentz return hci_set_random_addr_sync(hdev, 994cba6b758SLuiz Augusto von Dentz &hdev->static_addr); 995cba6b758SLuiz Augusto von Dentz return 0; 996cba6b758SLuiz Augusto von Dentz } 997cba6b758SLuiz Augusto von Dentz 998cba6b758SLuiz Augusto von Dentz /* Neither privacy nor static address is being used so use a 999cba6b758SLuiz Augusto von Dentz * public address. 1000cba6b758SLuiz Augusto von Dentz */ 1001cba6b758SLuiz Augusto von Dentz *own_addr_type = ADDR_LE_DEV_PUBLIC; 1002cba6b758SLuiz Augusto von Dentz 1003cba6b758SLuiz Augusto von Dentz return 0; 1004cba6b758SLuiz Augusto von Dentz } 1005cba6b758SLuiz Augusto von Dentz 1006cba6b758SLuiz Augusto von Dentz static int hci_disable_ext_adv_instance_sync(struct hci_dev *hdev, u8 instance) 1007cba6b758SLuiz Augusto von Dentz { 1008cba6b758SLuiz Augusto von Dentz struct hci_cp_le_set_ext_adv_enable *cp; 1009cba6b758SLuiz Augusto von Dentz struct hci_cp_ext_adv_set *set; 1010cba6b758SLuiz Augusto von Dentz u8 data[sizeof(*cp) + sizeof(*set) * 1]; 1011cba6b758SLuiz Augusto von Dentz u8 size; 1012cba6b758SLuiz Augusto von Dentz 1013cba6b758SLuiz Augusto von Dentz /* If request specifies an instance that doesn't exist, fail */ 1014cba6b758SLuiz Augusto von Dentz if (instance > 0) { 1015cba6b758SLuiz Augusto von Dentz struct adv_info *adv; 1016cba6b758SLuiz Augusto von Dentz 1017cba6b758SLuiz Augusto von Dentz adv = hci_find_adv_instance(hdev, instance); 1018cba6b758SLuiz Augusto von Dentz if (!adv) 1019cba6b758SLuiz Augusto von Dentz return -EINVAL; 1020cba6b758SLuiz Augusto von Dentz 1021cba6b758SLuiz Augusto von Dentz /* If not enabled there is nothing to do */ 1022cba6b758SLuiz Augusto von Dentz if (!adv->enabled) 1023cba6b758SLuiz Augusto von Dentz return 0; 1024cba6b758SLuiz Augusto von Dentz } 1025cba6b758SLuiz Augusto von Dentz 1026cba6b758SLuiz Augusto von Dentz memset(data, 0, sizeof(data)); 1027cba6b758SLuiz Augusto von Dentz 1028cba6b758SLuiz Augusto von Dentz cp = (void *)data; 1029cba6b758SLuiz Augusto von Dentz set = (void *)cp->data; 1030cba6b758SLuiz Augusto von Dentz 1031cba6b758SLuiz Augusto von Dentz /* Instance 0x00 indicates all advertising instances will be disabled */ 1032cba6b758SLuiz Augusto von Dentz cp->num_of_sets = !!instance; 1033cba6b758SLuiz Augusto von Dentz cp->enable = 0x00; 1034cba6b758SLuiz Augusto von Dentz 1035cba6b758SLuiz Augusto von Dentz set->handle = instance; 1036cba6b758SLuiz Augusto von Dentz 1037cba6b758SLuiz Augusto von Dentz size = sizeof(*cp) + sizeof(*set) * cp->num_of_sets; 1038cba6b758SLuiz Augusto von Dentz 1039cba6b758SLuiz Augusto von Dentz return __hci_cmd_sync_status(hdev, HCI_OP_LE_SET_EXT_ADV_ENABLE, 1040cba6b758SLuiz Augusto von Dentz size, data, HCI_CMD_TIMEOUT); 1041cba6b758SLuiz Augusto von Dentz } 1042cba6b758SLuiz Augusto von Dentz 1043cba6b758SLuiz Augusto von Dentz static int hci_set_adv_set_random_addr_sync(struct hci_dev *hdev, u8 instance, 1044cba6b758SLuiz Augusto von Dentz bdaddr_t *random_addr) 1045cba6b758SLuiz Augusto von Dentz { 1046cba6b758SLuiz Augusto von Dentz struct hci_cp_le_set_adv_set_rand_addr cp; 1047cba6b758SLuiz Augusto von Dentz int err; 1048cba6b758SLuiz Augusto von Dentz 1049cba6b758SLuiz Augusto von Dentz if (!instance) { 1050cba6b758SLuiz Augusto von Dentz /* Instance 0x00 doesn't have an adv_info, instead it uses 1051cba6b758SLuiz Augusto von Dentz * hdev->random_addr to track its address so whenever it needs 1052cba6b758SLuiz Augusto von Dentz * to be updated this also set the random address since 1053cba6b758SLuiz Augusto von Dentz * hdev->random_addr is shared with scan state machine. 1054cba6b758SLuiz Augusto von Dentz */ 1055cba6b758SLuiz Augusto von Dentz err = hci_set_random_addr_sync(hdev, random_addr); 1056cba6b758SLuiz Augusto von Dentz if (err) 1057cba6b758SLuiz Augusto von Dentz return err; 1058cba6b758SLuiz Augusto von Dentz } 1059cba6b758SLuiz Augusto von Dentz 1060cba6b758SLuiz Augusto von Dentz memset(&cp, 0, sizeof(cp)); 1061cba6b758SLuiz Augusto von Dentz 1062cba6b758SLuiz Augusto von Dentz cp.handle = instance; 1063cba6b758SLuiz Augusto von Dentz bacpy(&cp.bdaddr, random_addr); 1064cba6b758SLuiz Augusto von Dentz 1065cba6b758SLuiz Augusto von Dentz return __hci_cmd_sync_status(hdev, HCI_OP_LE_SET_ADV_SET_RAND_ADDR, 1066cba6b758SLuiz Augusto von Dentz sizeof(cp), &cp, HCI_CMD_TIMEOUT); 1067cba6b758SLuiz Augusto von Dentz } 1068cba6b758SLuiz Augusto von Dentz 1069cba6b758SLuiz Augusto von Dentz int hci_setup_ext_adv_instance_sync(struct hci_dev *hdev, u8 instance) 1070cba6b758SLuiz Augusto von Dentz { 1071cba6b758SLuiz Augusto von Dentz struct hci_cp_le_set_ext_adv_params cp; 1072cba6b758SLuiz Augusto von Dentz bool connectable; 1073cba6b758SLuiz Augusto von Dentz u32 flags; 1074cba6b758SLuiz Augusto von Dentz bdaddr_t random_addr; 1075cba6b758SLuiz Augusto von Dentz u8 own_addr_type; 1076cba6b758SLuiz Augusto von Dentz int err; 1077cba6b758SLuiz Augusto von Dentz struct adv_info *adv; 1078cba6b758SLuiz Augusto von Dentz bool secondary_adv; 1079cba6b758SLuiz Augusto von Dentz 1080cba6b758SLuiz Augusto von Dentz if (instance > 0) { 1081cba6b758SLuiz Augusto von Dentz adv = hci_find_adv_instance(hdev, instance); 1082cba6b758SLuiz Augusto von Dentz if (!adv) 1083cba6b758SLuiz Augusto von Dentz return -EINVAL; 1084cba6b758SLuiz Augusto von Dentz } else { 1085cba6b758SLuiz Augusto von Dentz adv = NULL; 1086cba6b758SLuiz Augusto von Dentz } 1087cba6b758SLuiz Augusto von Dentz 1088cba6b758SLuiz Augusto von Dentz /* Updating parameters of an active instance will return a 1089cba6b758SLuiz Augusto von Dentz * Command Disallowed error, so we must first disable the 1090cba6b758SLuiz Augusto von Dentz * instance if it is active. 1091cba6b758SLuiz Augusto von Dentz */ 1092cba6b758SLuiz Augusto von Dentz if (adv && !adv->pending) { 1093cba6b758SLuiz Augusto von Dentz err = hci_disable_ext_adv_instance_sync(hdev, instance); 1094cba6b758SLuiz Augusto von Dentz if (err) 1095cba6b758SLuiz Augusto von Dentz return err; 1096cba6b758SLuiz Augusto von Dentz } 1097cba6b758SLuiz Augusto von Dentz 1098cba6b758SLuiz Augusto von Dentz flags = hci_adv_instance_flags(hdev, instance); 1099cba6b758SLuiz Augusto von Dentz 1100cba6b758SLuiz Augusto von Dentz /* If the "connectable" instance flag was not set, then choose between 1101cba6b758SLuiz Augusto von Dentz * ADV_IND and ADV_NONCONN_IND based on the global connectable setting. 1102cba6b758SLuiz Augusto von Dentz */ 1103cba6b758SLuiz Augusto von Dentz connectable = (flags & MGMT_ADV_FLAG_CONNECTABLE) || 1104cba6b758SLuiz Augusto von Dentz mgmt_get_connectable(hdev); 1105cba6b758SLuiz Augusto von Dentz 1106cba6b758SLuiz Augusto von Dentz if (!is_advertising_allowed(hdev, connectable)) 1107cba6b758SLuiz Augusto von Dentz return -EPERM; 1108cba6b758SLuiz Augusto von Dentz 1109cba6b758SLuiz Augusto von Dentz /* Set require_privacy to true only when non-connectable 1110cba6b758SLuiz Augusto von Dentz * advertising is used. In that case it is fine to use a 1111cba6b758SLuiz Augusto von Dentz * non-resolvable private address. 1112cba6b758SLuiz Augusto von Dentz */ 1113cba6b758SLuiz Augusto von Dentz err = hci_get_random_address(hdev, !connectable, 1114cba6b758SLuiz Augusto von Dentz adv_use_rpa(hdev, flags), adv, 1115cba6b758SLuiz Augusto von Dentz &own_addr_type, &random_addr); 1116cba6b758SLuiz Augusto von Dentz if (err < 0) 1117cba6b758SLuiz Augusto von Dentz return err; 1118cba6b758SLuiz Augusto von Dentz 1119cba6b758SLuiz Augusto von Dentz memset(&cp, 0, sizeof(cp)); 1120cba6b758SLuiz Augusto von Dentz 1121cba6b758SLuiz Augusto von Dentz if (adv) { 1122cba6b758SLuiz Augusto von Dentz hci_cpu_to_le24(adv->min_interval, cp.min_interval); 1123cba6b758SLuiz Augusto von Dentz hci_cpu_to_le24(adv->max_interval, cp.max_interval); 1124cba6b758SLuiz Augusto von Dentz cp.tx_power = adv->tx_power; 1125cba6b758SLuiz Augusto von Dentz } else { 1126cba6b758SLuiz Augusto von Dentz hci_cpu_to_le24(hdev->le_adv_min_interval, cp.min_interval); 1127cba6b758SLuiz Augusto von Dentz hci_cpu_to_le24(hdev->le_adv_max_interval, cp.max_interval); 1128cba6b758SLuiz Augusto von Dentz cp.tx_power = HCI_ADV_TX_POWER_NO_PREFERENCE; 1129cba6b758SLuiz Augusto von Dentz } 1130cba6b758SLuiz Augusto von Dentz 1131cba6b758SLuiz Augusto von Dentz secondary_adv = (flags & MGMT_ADV_FLAG_SEC_MASK); 1132cba6b758SLuiz Augusto von Dentz 1133cba6b758SLuiz Augusto von Dentz if (connectable) { 1134cba6b758SLuiz Augusto von Dentz if (secondary_adv) 1135cba6b758SLuiz Augusto von Dentz cp.evt_properties = cpu_to_le16(LE_EXT_ADV_CONN_IND); 1136cba6b758SLuiz Augusto von Dentz else 1137cba6b758SLuiz Augusto von Dentz cp.evt_properties = cpu_to_le16(LE_LEGACY_ADV_IND); 1138cba6b758SLuiz Augusto von Dentz } else if (hci_adv_instance_is_scannable(hdev, instance) || 1139cba6b758SLuiz Augusto von Dentz (flags & MGMT_ADV_PARAM_SCAN_RSP)) { 1140cba6b758SLuiz Augusto von Dentz if (secondary_adv) 1141cba6b758SLuiz Augusto von Dentz cp.evt_properties = cpu_to_le16(LE_EXT_ADV_SCAN_IND); 1142cba6b758SLuiz Augusto von Dentz else 1143cba6b758SLuiz Augusto von Dentz cp.evt_properties = cpu_to_le16(LE_LEGACY_ADV_SCAN_IND); 1144cba6b758SLuiz Augusto von Dentz } else { 1145cba6b758SLuiz Augusto von Dentz if (secondary_adv) 1146cba6b758SLuiz Augusto von Dentz cp.evt_properties = cpu_to_le16(LE_EXT_ADV_NON_CONN_IND); 1147cba6b758SLuiz Augusto von Dentz else 1148cba6b758SLuiz Augusto von Dentz cp.evt_properties = cpu_to_le16(LE_LEGACY_NONCONN_IND); 1149cba6b758SLuiz Augusto von Dentz } 1150cba6b758SLuiz Augusto von Dentz 1151cf75ad8bSLuiz Augusto von Dentz /* If Own_Address_Type equals 0x02 or 0x03, the Peer_Address parameter 1152cf75ad8bSLuiz Augusto von Dentz * contains the peer’s Identity Address and the Peer_Address_Type 1153cf75ad8bSLuiz Augusto von Dentz * parameter contains the peer’s Identity Type (i.e., 0x00 or 0x01). 1154cf75ad8bSLuiz Augusto von Dentz * These parameters are used to locate the corresponding local IRK in 1155cf75ad8bSLuiz Augusto von Dentz * the resolving list; this IRK is used to generate their own address 1156cf75ad8bSLuiz Augusto von Dentz * used in the advertisement. 1157cf75ad8bSLuiz Augusto von Dentz */ 1158cf75ad8bSLuiz Augusto von Dentz if (own_addr_type == ADDR_LE_DEV_RANDOM_RESOLVED) 1159cf75ad8bSLuiz Augusto von Dentz hci_copy_identity_address(hdev, &cp.peer_addr, 1160cf75ad8bSLuiz Augusto von Dentz &cp.peer_addr_type); 1161cf75ad8bSLuiz Augusto von Dentz 1162cba6b758SLuiz Augusto von Dentz cp.own_addr_type = own_addr_type; 1163cba6b758SLuiz Augusto von Dentz cp.channel_map = hdev->le_adv_channel_map; 1164cba6b758SLuiz Augusto von Dentz cp.handle = instance; 1165cba6b758SLuiz Augusto von Dentz 1166cba6b758SLuiz Augusto von Dentz if (flags & MGMT_ADV_FLAG_SEC_2M) { 1167cba6b758SLuiz Augusto von Dentz cp.primary_phy = HCI_ADV_PHY_1M; 1168cba6b758SLuiz Augusto von Dentz cp.secondary_phy = HCI_ADV_PHY_2M; 1169cba6b758SLuiz Augusto von Dentz } else if (flags & MGMT_ADV_FLAG_SEC_CODED) { 1170cba6b758SLuiz Augusto von Dentz cp.primary_phy = HCI_ADV_PHY_CODED; 1171cba6b758SLuiz Augusto von Dentz cp.secondary_phy = HCI_ADV_PHY_CODED; 1172cba6b758SLuiz Augusto von Dentz } else { 1173cba6b758SLuiz Augusto von Dentz /* In all other cases use 1M */ 1174cba6b758SLuiz Augusto von Dentz cp.primary_phy = HCI_ADV_PHY_1M; 1175cba6b758SLuiz Augusto von Dentz cp.secondary_phy = HCI_ADV_PHY_1M; 1176cba6b758SLuiz Augusto von Dentz } 1177cba6b758SLuiz Augusto von Dentz 1178cba6b758SLuiz Augusto von Dentz err = __hci_cmd_sync_status(hdev, HCI_OP_LE_SET_EXT_ADV_PARAMS, 1179cba6b758SLuiz Augusto von Dentz sizeof(cp), &cp, HCI_CMD_TIMEOUT); 1180cba6b758SLuiz Augusto von Dentz if (err) 1181cba6b758SLuiz Augusto von Dentz return err; 1182cba6b758SLuiz Augusto von Dentz 1183cba6b758SLuiz Augusto von Dentz if ((own_addr_type == ADDR_LE_DEV_RANDOM || 1184cba6b758SLuiz Augusto von Dentz own_addr_type == ADDR_LE_DEV_RANDOM_RESOLVED) && 1185cba6b758SLuiz Augusto von Dentz bacmp(&random_addr, BDADDR_ANY)) { 1186cba6b758SLuiz Augusto von Dentz /* Check if random address need to be updated */ 1187cba6b758SLuiz Augusto von Dentz if (adv) { 1188cba6b758SLuiz Augusto von Dentz if (!bacmp(&random_addr, &adv->random_addr)) 1189cba6b758SLuiz Augusto von Dentz return 0; 1190cba6b758SLuiz Augusto von Dentz } else { 1191cba6b758SLuiz Augusto von Dentz if (!bacmp(&random_addr, &hdev->random_addr)) 1192cba6b758SLuiz Augusto von Dentz return 0; 1193cba6b758SLuiz Augusto von Dentz } 1194cba6b758SLuiz Augusto von Dentz 1195cba6b758SLuiz Augusto von Dentz return hci_set_adv_set_random_addr_sync(hdev, instance, 1196cba6b758SLuiz Augusto von Dentz &random_addr); 1197cba6b758SLuiz Augusto von Dentz } 1198cba6b758SLuiz Augusto von Dentz 1199cba6b758SLuiz Augusto von Dentz return 0; 1200cba6b758SLuiz Augusto von Dentz } 1201cba6b758SLuiz Augusto von Dentz 1202cba6b758SLuiz Augusto von Dentz static int hci_set_ext_scan_rsp_data_sync(struct hci_dev *hdev, u8 instance) 1203cba6b758SLuiz Augusto von Dentz { 1204cba6b758SLuiz Augusto von Dentz struct { 1205cba6b758SLuiz Augusto von Dentz struct hci_cp_le_set_ext_scan_rsp_data cp; 1206cba6b758SLuiz Augusto von Dentz u8 data[HCI_MAX_EXT_AD_LENGTH]; 1207cba6b758SLuiz Augusto von Dentz } pdu; 1208cba6b758SLuiz Augusto von Dentz u8 len; 120934a718bcSLuiz Augusto von Dentz struct adv_info *adv = NULL; 121034a718bcSLuiz Augusto von Dentz int err; 1211cba6b758SLuiz Augusto von Dentz 1212cba6b758SLuiz Augusto von Dentz memset(&pdu, 0, sizeof(pdu)); 1213cba6b758SLuiz Augusto von Dentz 121434a718bcSLuiz Augusto von Dentz if (instance) { 121534a718bcSLuiz Augusto von Dentz adv = hci_find_adv_instance(hdev, instance); 121634a718bcSLuiz Augusto von Dentz if (!adv || !adv->scan_rsp_changed) 1217cba6b758SLuiz Augusto von Dentz return 0; 121834a718bcSLuiz Augusto von Dentz } 1219cba6b758SLuiz Augusto von Dentz 122034a718bcSLuiz Augusto von Dentz len = eir_create_scan_rsp(hdev, instance, pdu.data); 1221cba6b758SLuiz Augusto von Dentz 1222cba6b758SLuiz Augusto von Dentz pdu.cp.handle = instance; 1223cba6b758SLuiz Augusto von Dentz pdu.cp.length = len; 1224cba6b758SLuiz Augusto von Dentz pdu.cp.operation = LE_SET_ADV_DATA_OP_COMPLETE; 1225cba6b758SLuiz Augusto von Dentz pdu.cp.frag_pref = LE_SET_ADV_DATA_NO_FRAG; 1226cba6b758SLuiz Augusto von Dentz 122734a718bcSLuiz Augusto von Dentz err = __hci_cmd_sync_status(hdev, HCI_OP_LE_SET_EXT_SCAN_RSP_DATA, 1228cba6b758SLuiz Augusto von Dentz sizeof(pdu.cp) + len, &pdu.cp, 1229cba6b758SLuiz Augusto von Dentz HCI_CMD_TIMEOUT); 123034a718bcSLuiz Augusto von Dentz if (err) 123134a718bcSLuiz Augusto von Dentz return err; 123234a718bcSLuiz Augusto von Dentz 123334a718bcSLuiz Augusto von Dentz if (adv) { 123434a718bcSLuiz Augusto von Dentz adv->scan_rsp_changed = false; 123534a718bcSLuiz Augusto von Dentz } else { 123634a718bcSLuiz Augusto von Dentz memcpy(hdev->scan_rsp_data, pdu.data, len); 123734a718bcSLuiz Augusto von Dentz hdev->scan_rsp_data_len = len; 123834a718bcSLuiz Augusto von Dentz } 123934a718bcSLuiz Augusto von Dentz 124034a718bcSLuiz Augusto von Dentz return 0; 1241cba6b758SLuiz Augusto von Dentz } 1242cba6b758SLuiz Augusto von Dentz 1243cba6b758SLuiz Augusto von Dentz static int __hci_set_scan_rsp_data_sync(struct hci_dev *hdev, u8 instance) 1244cba6b758SLuiz Augusto von Dentz { 1245cba6b758SLuiz Augusto von Dentz struct hci_cp_le_set_scan_rsp_data cp; 1246cba6b758SLuiz Augusto von Dentz u8 len; 1247cba6b758SLuiz Augusto von Dentz 1248cba6b758SLuiz Augusto von Dentz memset(&cp, 0, sizeof(cp)); 1249cba6b758SLuiz Augusto von Dentz 1250cba6b758SLuiz Augusto von Dentz len = eir_create_scan_rsp(hdev, instance, cp.data); 1251cba6b758SLuiz Augusto von Dentz 1252cba6b758SLuiz Augusto von Dentz if (hdev->scan_rsp_data_len == len && 1253cba6b758SLuiz Augusto von Dentz !memcmp(cp.data, hdev->scan_rsp_data, len)) 1254cba6b758SLuiz Augusto von Dentz return 0; 1255cba6b758SLuiz Augusto von Dentz 1256cba6b758SLuiz Augusto von Dentz memcpy(hdev->scan_rsp_data, cp.data, sizeof(cp.data)); 1257cba6b758SLuiz Augusto von Dentz hdev->scan_rsp_data_len = len; 1258cba6b758SLuiz Augusto von Dentz 1259cba6b758SLuiz Augusto von Dentz cp.length = len; 1260cba6b758SLuiz Augusto von Dentz 1261cba6b758SLuiz Augusto von Dentz return __hci_cmd_sync_status(hdev, HCI_OP_LE_SET_SCAN_RSP_DATA, 1262cba6b758SLuiz Augusto von Dentz sizeof(cp), &cp, HCI_CMD_TIMEOUT); 1263cba6b758SLuiz Augusto von Dentz } 1264cba6b758SLuiz Augusto von Dentz 1265cba6b758SLuiz Augusto von Dentz int hci_update_scan_rsp_data_sync(struct hci_dev *hdev, u8 instance) 1266cba6b758SLuiz Augusto von Dentz { 1267cba6b758SLuiz Augusto von Dentz if (!hci_dev_test_flag(hdev, HCI_LE_ENABLED)) 1268cba6b758SLuiz Augusto von Dentz return 0; 1269cba6b758SLuiz Augusto von Dentz 1270cba6b758SLuiz Augusto von Dentz if (ext_adv_capable(hdev)) 1271cba6b758SLuiz Augusto von Dentz return hci_set_ext_scan_rsp_data_sync(hdev, instance); 1272cba6b758SLuiz Augusto von Dentz 1273cba6b758SLuiz Augusto von Dentz return __hci_set_scan_rsp_data_sync(hdev, instance); 1274cba6b758SLuiz Augusto von Dentz } 1275cba6b758SLuiz Augusto von Dentz 1276cba6b758SLuiz Augusto von Dentz int hci_enable_ext_advertising_sync(struct hci_dev *hdev, u8 instance) 1277cba6b758SLuiz Augusto von Dentz { 1278cba6b758SLuiz Augusto von Dentz struct hci_cp_le_set_ext_adv_enable *cp; 1279cba6b758SLuiz Augusto von Dentz struct hci_cp_ext_adv_set *set; 1280cba6b758SLuiz Augusto von Dentz u8 data[sizeof(*cp) + sizeof(*set) * 1]; 1281cba6b758SLuiz Augusto von Dentz struct adv_info *adv; 1282cba6b758SLuiz Augusto von Dentz 1283cba6b758SLuiz Augusto von Dentz if (instance > 0) { 1284cba6b758SLuiz Augusto von Dentz adv = hci_find_adv_instance(hdev, instance); 1285cba6b758SLuiz Augusto von Dentz if (!adv) 1286cba6b758SLuiz Augusto von Dentz return -EINVAL; 1287cba6b758SLuiz Augusto von Dentz /* If already enabled there is nothing to do */ 1288cba6b758SLuiz Augusto von Dentz if (adv->enabled) 1289cba6b758SLuiz Augusto von Dentz return 0; 1290cba6b758SLuiz Augusto von Dentz } else { 1291cba6b758SLuiz Augusto von Dentz adv = NULL; 1292cba6b758SLuiz Augusto von Dentz } 1293cba6b758SLuiz Augusto von Dentz 1294cba6b758SLuiz Augusto von Dentz cp = (void *)data; 1295cba6b758SLuiz Augusto von Dentz set = (void *)cp->data; 1296cba6b758SLuiz Augusto von Dentz 1297cba6b758SLuiz Augusto von Dentz memset(cp, 0, sizeof(*cp)); 1298cba6b758SLuiz Augusto von Dentz 1299cba6b758SLuiz Augusto von Dentz cp->enable = 0x01; 1300cba6b758SLuiz Augusto von Dentz cp->num_of_sets = 0x01; 1301cba6b758SLuiz Augusto von Dentz 1302cba6b758SLuiz Augusto von Dentz memset(set, 0, sizeof(*set)); 1303cba6b758SLuiz Augusto von Dentz 1304cba6b758SLuiz Augusto von Dentz set->handle = instance; 1305cba6b758SLuiz Augusto von Dentz 1306cba6b758SLuiz Augusto von Dentz /* Set duration per instance since controller is responsible for 1307cba6b758SLuiz Augusto von Dentz * scheduling it. 1308cba6b758SLuiz Augusto von Dentz */ 1309f16a491cSLuiz Augusto von Dentz if (adv && adv->timeout) { 1310cba6b758SLuiz Augusto von Dentz u16 duration = adv->timeout * MSEC_PER_SEC; 1311cba6b758SLuiz Augusto von Dentz 1312cba6b758SLuiz Augusto von Dentz /* Time = N * 10 ms */ 1313cba6b758SLuiz Augusto von Dentz set->duration = cpu_to_le16(duration / 10); 1314cba6b758SLuiz Augusto von Dentz } 1315cba6b758SLuiz Augusto von Dentz 1316cba6b758SLuiz Augusto von Dentz return __hci_cmd_sync_status(hdev, HCI_OP_LE_SET_EXT_ADV_ENABLE, 1317cba6b758SLuiz Augusto von Dentz sizeof(*cp) + 1318cba6b758SLuiz Augusto von Dentz sizeof(*set) * cp->num_of_sets, 1319cba6b758SLuiz Augusto von Dentz data, HCI_CMD_TIMEOUT); 1320cba6b758SLuiz Augusto von Dentz } 1321cba6b758SLuiz Augusto von Dentz 1322cba6b758SLuiz Augusto von Dentz int hci_start_ext_adv_sync(struct hci_dev *hdev, u8 instance) 1323cba6b758SLuiz Augusto von Dentz { 1324cba6b758SLuiz Augusto von Dentz int err; 1325cba6b758SLuiz Augusto von Dentz 1326cba6b758SLuiz Augusto von Dentz err = hci_setup_ext_adv_instance_sync(hdev, instance); 1327cba6b758SLuiz Augusto von Dentz if (err) 1328cba6b758SLuiz Augusto von Dentz return err; 1329cba6b758SLuiz Augusto von Dentz 1330cba6b758SLuiz Augusto von Dentz err = hci_set_ext_scan_rsp_data_sync(hdev, instance); 1331cba6b758SLuiz Augusto von Dentz if (err) 1332cba6b758SLuiz Augusto von Dentz return err; 1333cba6b758SLuiz Augusto von Dentz 1334cba6b758SLuiz Augusto von Dentz return hci_enable_ext_advertising_sync(hdev, instance); 1335cba6b758SLuiz Augusto von Dentz } 1336cba6b758SLuiz Augusto von Dentz 1337f03d3322SIulia Tanasescu int hci_disable_per_advertising_sync(struct hci_dev *hdev, u8 instance) 1338eca0ae4aSLuiz Augusto von Dentz { 1339eca0ae4aSLuiz Augusto von Dentz struct hci_cp_le_set_per_adv_enable cp; 13406a42e9bfSIulia Tanasescu struct adv_info *adv = NULL; 1341eca0ae4aSLuiz Augusto von Dentz 1342eca0ae4aSLuiz Augusto von Dentz /* If periodic advertising already disabled there is nothing to do. */ 13436a42e9bfSIulia Tanasescu adv = hci_find_adv_instance(hdev, instance); 13446a42e9bfSIulia Tanasescu if (!adv || !adv->periodic || !adv->enabled) 1345eca0ae4aSLuiz Augusto von Dentz return 0; 1346eca0ae4aSLuiz Augusto von Dentz 1347eca0ae4aSLuiz Augusto von Dentz memset(&cp, 0, sizeof(cp)); 1348eca0ae4aSLuiz Augusto von Dentz 1349eca0ae4aSLuiz Augusto von Dentz cp.enable = 0x00; 1350eca0ae4aSLuiz Augusto von Dentz cp.handle = instance; 1351eca0ae4aSLuiz Augusto von Dentz 1352eca0ae4aSLuiz Augusto von Dentz return __hci_cmd_sync_status(hdev, HCI_OP_LE_SET_PER_ADV_ENABLE, 1353eca0ae4aSLuiz Augusto von Dentz sizeof(cp), &cp, HCI_CMD_TIMEOUT); 1354eca0ae4aSLuiz Augusto von Dentz } 1355eca0ae4aSLuiz Augusto von Dentz 1356eca0ae4aSLuiz Augusto von Dentz static int hci_set_per_adv_params_sync(struct hci_dev *hdev, u8 instance, 1357eca0ae4aSLuiz Augusto von Dentz u16 min_interval, u16 max_interval) 1358eca0ae4aSLuiz Augusto von Dentz { 1359eca0ae4aSLuiz Augusto von Dentz struct hci_cp_le_set_per_adv_params cp; 1360eca0ae4aSLuiz Augusto von Dentz 1361eca0ae4aSLuiz Augusto von Dentz memset(&cp, 0, sizeof(cp)); 1362eca0ae4aSLuiz Augusto von Dentz 1363eca0ae4aSLuiz Augusto von Dentz if (!min_interval) 1364eca0ae4aSLuiz Augusto von Dentz min_interval = DISCOV_LE_PER_ADV_INT_MIN; 1365eca0ae4aSLuiz Augusto von Dentz 1366eca0ae4aSLuiz Augusto von Dentz if (!max_interval) 1367eca0ae4aSLuiz Augusto von Dentz max_interval = DISCOV_LE_PER_ADV_INT_MAX; 1368eca0ae4aSLuiz Augusto von Dentz 1369eca0ae4aSLuiz Augusto von Dentz cp.handle = instance; 1370eca0ae4aSLuiz Augusto von Dentz cp.min_interval = cpu_to_le16(min_interval); 1371eca0ae4aSLuiz Augusto von Dentz cp.max_interval = cpu_to_le16(max_interval); 1372eca0ae4aSLuiz Augusto von Dentz cp.periodic_properties = 0x0000; 1373eca0ae4aSLuiz Augusto von Dentz 1374eca0ae4aSLuiz Augusto von Dentz return __hci_cmd_sync_status(hdev, HCI_OP_LE_SET_PER_ADV_PARAMS, 1375eca0ae4aSLuiz Augusto von Dentz sizeof(cp), &cp, HCI_CMD_TIMEOUT); 1376eca0ae4aSLuiz Augusto von Dentz } 1377eca0ae4aSLuiz Augusto von Dentz 1378eca0ae4aSLuiz Augusto von Dentz static int hci_set_per_adv_data_sync(struct hci_dev *hdev, u8 instance) 1379eca0ae4aSLuiz Augusto von Dentz { 1380eca0ae4aSLuiz Augusto von Dentz struct { 1381eca0ae4aSLuiz Augusto von Dentz struct hci_cp_le_set_per_adv_data cp; 1382eca0ae4aSLuiz Augusto von Dentz u8 data[HCI_MAX_PER_AD_LENGTH]; 1383eca0ae4aSLuiz Augusto von Dentz } pdu; 1384eca0ae4aSLuiz Augusto von Dentz u8 len; 1385eca0ae4aSLuiz Augusto von Dentz 1386eca0ae4aSLuiz Augusto von Dentz memset(&pdu, 0, sizeof(pdu)); 1387eca0ae4aSLuiz Augusto von Dentz 1388eca0ae4aSLuiz Augusto von Dentz if (instance) { 1389eca0ae4aSLuiz Augusto von Dentz struct adv_info *adv = hci_find_adv_instance(hdev, instance); 1390eca0ae4aSLuiz Augusto von Dentz 1391eca0ae4aSLuiz Augusto von Dentz if (!adv || !adv->periodic) 1392eca0ae4aSLuiz Augusto von Dentz return 0; 1393eca0ae4aSLuiz Augusto von Dentz } 1394eca0ae4aSLuiz Augusto von Dentz 1395eca0ae4aSLuiz Augusto von Dentz len = eir_create_per_adv_data(hdev, instance, pdu.data); 1396eca0ae4aSLuiz Augusto von Dentz 1397eca0ae4aSLuiz Augusto von Dentz pdu.cp.length = len; 1398eca0ae4aSLuiz Augusto von Dentz pdu.cp.handle = instance; 1399eca0ae4aSLuiz Augusto von Dentz pdu.cp.operation = LE_SET_ADV_DATA_OP_COMPLETE; 1400eca0ae4aSLuiz Augusto von Dentz 1401eca0ae4aSLuiz Augusto von Dentz return __hci_cmd_sync_status(hdev, HCI_OP_LE_SET_PER_ADV_DATA, 1402eca0ae4aSLuiz Augusto von Dentz sizeof(pdu.cp) + len, &pdu, 1403eca0ae4aSLuiz Augusto von Dentz HCI_CMD_TIMEOUT); 1404eca0ae4aSLuiz Augusto von Dentz } 1405eca0ae4aSLuiz Augusto von Dentz 1406eca0ae4aSLuiz Augusto von Dentz static int hci_enable_per_advertising_sync(struct hci_dev *hdev, u8 instance) 1407eca0ae4aSLuiz Augusto von Dentz { 1408eca0ae4aSLuiz Augusto von Dentz struct hci_cp_le_set_per_adv_enable cp; 14096a42e9bfSIulia Tanasescu struct adv_info *adv = NULL; 1410eca0ae4aSLuiz Augusto von Dentz 1411eca0ae4aSLuiz Augusto von Dentz /* If periodic advertising already enabled there is nothing to do. */ 14126a42e9bfSIulia Tanasescu adv = hci_find_adv_instance(hdev, instance); 14136a42e9bfSIulia Tanasescu if (adv && adv->periodic && adv->enabled) 1414eca0ae4aSLuiz Augusto von Dentz return 0; 1415eca0ae4aSLuiz Augusto von Dentz 1416eca0ae4aSLuiz Augusto von Dentz memset(&cp, 0, sizeof(cp)); 1417eca0ae4aSLuiz Augusto von Dentz 1418eca0ae4aSLuiz Augusto von Dentz cp.enable = 0x01; 1419eca0ae4aSLuiz Augusto von Dentz cp.handle = instance; 1420eca0ae4aSLuiz Augusto von Dentz 1421eca0ae4aSLuiz Augusto von Dentz return __hci_cmd_sync_status(hdev, HCI_OP_LE_SET_PER_ADV_ENABLE, 1422eca0ae4aSLuiz Augusto von Dentz sizeof(cp), &cp, HCI_CMD_TIMEOUT); 1423eca0ae4aSLuiz Augusto von Dentz } 1424eca0ae4aSLuiz Augusto von Dentz 1425eca0ae4aSLuiz Augusto von Dentz /* Checks if periodic advertising data contains a Basic Announcement and if it 1426eca0ae4aSLuiz Augusto von Dentz * does generates a Broadcast ID and add Broadcast Announcement. 1427eca0ae4aSLuiz Augusto von Dentz */ 1428eca0ae4aSLuiz Augusto von Dentz static int hci_adv_bcast_annoucement(struct hci_dev *hdev, struct adv_info *adv) 1429eca0ae4aSLuiz Augusto von Dentz { 1430eca0ae4aSLuiz Augusto von Dentz u8 bid[3]; 1431eca0ae4aSLuiz Augusto von Dentz u8 ad[4 + 3]; 1432eca0ae4aSLuiz Augusto von Dentz 1433eca0ae4aSLuiz Augusto von Dentz /* Skip if NULL adv as instance 0x00 is used for general purpose 1434eca0ae4aSLuiz Augusto von Dentz * advertising so it cannot used for the likes of Broadcast Announcement 1435eca0ae4aSLuiz Augusto von Dentz * as it can be overwritten at any point. 1436eca0ae4aSLuiz Augusto von Dentz */ 1437eca0ae4aSLuiz Augusto von Dentz if (!adv) 1438eca0ae4aSLuiz Augusto von Dentz return 0; 1439eca0ae4aSLuiz Augusto von Dentz 1440eca0ae4aSLuiz Augusto von Dentz /* Check if PA data doesn't contains a Basic Audio Announcement then 1441eca0ae4aSLuiz Augusto von Dentz * there is nothing to do. 1442eca0ae4aSLuiz Augusto von Dentz */ 1443eca0ae4aSLuiz Augusto von Dentz if (!eir_get_service_data(adv->per_adv_data, adv->per_adv_data_len, 1444eca0ae4aSLuiz Augusto von Dentz 0x1851, NULL)) 1445eca0ae4aSLuiz Augusto von Dentz return 0; 1446eca0ae4aSLuiz Augusto von Dentz 1447eca0ae4aSLuiz Augusto von Dentz /* Check if advertising data already has a Broadcast Announcement since 1448eca0ae4aSLuiz Augusto von Dentz * the process may want to control the Broadcast ID directly and in that 1449eca0ae4aSLuiz Augusto von Dentz * case the kernel shall no interfere. 1450eca0ae4aSLuiz Augusto von Dentz */ 1451eca0ae4aSLuiz Augusto von Dentz if (eir_get_service_data(adv->adv_data, adv->adv_data_len, 0x1852, 1452eca0ae4aSLuiz Augusto von Dentz NULL)) 1453eca0ae4aSLuiz Augusto von Dentz return 0; 1454eca0ae4aSLuiz Augusto von Dentz 1455eca0ae4aSLuiz Augusto von Dentz /* Generate Broadcast ID */ 1456eca0ae4aSLuiz Augusto von Dentz get_random_bytes(bid, sizeof(bid)); 1457eca0ae4aSLuiz Augusto von Dentz eir_append_service_data(ad, 0, 0x1852, bid, sizeof(bid)); 1458eca0ae4aSLuiz Augusto von Dentz hci_set_adv_instance_data(hdev, adv->instance, sizeof(ad), ad, 0, NULL); 1459eca0ae4aSLuiz Augusto von Dentz 1460eca0ae4aSLuiz Augusto von Dentz return hci_update_adv_data_sync(hdev, adv->instance); 1461eca0ae4aSLuiz Augusto von Dentz } 1462eca0ae4aSLuiz Augusto von Dentz 1463eca0ae4aSLuiz Augusto von Dentz int hci_start_per_adv_sync(struct hci_dev *hdev, u8 instance, u8 data_len, 1464eca0ae4aSLuiz Augusto von Dentz u8 *data, u32 flags, u16 min_interval, 1465eca0ae4aSLuiz Augusto von Dentz u16 max_interval, u16 sync_interval) 1466eca0ae4aSLuiz Augusto von Dentz { 1467eca0ae4aSLuiz Augusto von Dentz struct adv_info *adv = NULL; 1468eca0ae4aSLuiz Augusto von Dentz int err; 1469eca0ae4aSLuiz Augusto von Dentz bool added = false; 1470eca0ae4aSLuiz Augusto von Dentz 1471eca0ae4aSLuiz Augusto von Dentz hci_disable_per_advertising_sync(hdev, instance); 1472eca0ae4aSLuiz Augusto von Dentz 1473eca0ae4aSLuiz Augusto von Dentz if (instance) { 1474eca0ae4aSLuiz Augusto von Dentz adv = hci_find_adv_instance(hdev, instance); 1475eca0ae4aSLuiz Augusto von Dentz /* Create an instance if that could not be found */ 1476eca0ae4aSLuiz Augusto von Dentz if (!adv) { 1477eca0ae4aSLuiz Augusto von Dentz adv = hci_add_per_instance(hdev, instance, flags, 1478eca0ae4aSLuiz Augusto von Dentz data_len, data, 1479eca0ae4aSLuiz Augusto von Dentz sync_interval, 1480eca0ae4aSLuiz Augusto von Dentz sync_interval); 1481eca0ae4aSLuiz Augusto von Dentz if (IS_ERR(adv)) 1482eca0ae4aSLuiz Augusto von Dentz return PTR_ERR(adv); 14836a42e9bfSIulia Tanasescu adv->pending = false; 1484eca0ae4aSLuiz Augusto von Dentz added = true; 1485eca0ae4aSLuiz Augusto von Dentz } 1486eca0ae4aSLuiz Augusto von Dentz } 1487eca0ae4aSLuiz Augusto von Dentz 14886a42e9bfSIulia Tanasescu /* Start advertising */ 1489eca0ae4aSLuiz Augusto von Dentz err = hci_start_ext_adv_sync(hdev, instance); 1490eca0ae4aSLuiz Augusto von Dentz if (err < 0) 1491eca0ae4aSLuiz Augusto von Dentz goto fail; 1492eca0ae4aSLuiz Augusto von Dentz 1493eca0ae4aSLuiz Augusto von Dentz err = hci_adv_bcast_annoucement(hdev, adv); 1494eca0ae4aSLuiz Augusto von Dentz if (err < 0) 1495eca0ae4aSLuiz Augusto von Dentz goto fail; 1496eca0ae4aSLuiz Augusto von Dentz 1497eca0ae4aSLuiz Augusto von Dentz err = hci_set_per_adv_params_sync(hdev, instance, min_interval, 1498eca0ae4aSLuiz Augusto von Dentz max_interval); 1499eca0ae4aSLuiz Augusto von Dentz if (err < 0) 1500eca0ae4aSLuiz Augusto von Dentz goto fail; 1501eca0ae4aSLuiz Augusto von Dentz 1502eca0ae4aSLuiz Augusto von Dentz err = hci_set_per_adv_data_sync(hdev, instance); 1503eca0ae4aSLuiz Augusto von Dentz if (err < 0) 1504eca0ae4aSLuiz Augusto von Dentz goto fail; 1505eca0ae4aSLuiz Augusto von Dentz 1506eca0ae4aSLuiz Augusto von Dentz err = hci_enable_per_advertising_sync(hdev, instance); 1507eca0ae4aSLuiz Augusto von Dentz if (err < 0) 1508eca0ae4aSLuiz Augusto von Dentz goto fail; 1509eca0ae4aSLuiz Augusto von Dentz 1510eca0ae4aSLuiz Augusto von Dentz return 0; 1511eca0ae4aSLuiz Augusto von Dentz 1512eca0ae4aSLuiz Augusto von Dentz fail: 1513eca0ae4aSLuiz Augusto von Dentz if (added) 1514eca0ae4aSLuiz Augusto von Dentz hci_remove_adv_instance(hdev, instance); 1515eca0ae4aSLuiz Augusto von Dentz 1516eca0ae4aSLuiz Augusto von Dentz return err; 1517eca0ae4aSLuiz Augusto von Dentz } 1518eca0ae4aSLuiz Augusto von Dentz 1519cba6b758SLuiz Augusto von Dentz static int hci_start_adv_sync(struct hci_dev *hdev, u8 instance) 1520cba6b758SLuiz Augusto von Dentz { 1521cba6b758SLuiz Augusto von Dentz int err; 1522cba6b758SLuiz Augusto von Dentz 1523cba6b758SLuiz Augusto von Dentz if (ext_adv_capable(hdev)) 1524cba6b758SLuiz Augusto von Dentz return hci_start_ext_adv_sync(hdev, instance); 1525cba6b758SLuiz Augusto von Dentz 1526cba6b758SLuiz Augusto von Dentz err = hci_update_adv_data_sync(hdev, instance); 1527cba6b758SLuiz Augusto von Dentz if (err) 1528cba6b758SLuiz Augusto von Dentz return err; 1529cba6b758SLuiz Augusto von Dentz 1530cba6b758SLuiz Augusto von Dentz err = hci_update_scan_rsp_data_sync(hdev, instance); 1531cba6b758SLuiz Augusto von Dentz if (err) 1532cba6b758SLuiz Augusto von Dentz return err; 1533cba6b758SLuiz Augusto von Dentz 1534cba6b758SLuiz Augusto von Dentz return hci_enable_advertising_sync(hdev); 1535cba6b758SLuiz Augusto von Dentz } 1536cba6b758SLuiz Augusto von Dentz 1537cba6b758SLuiz Augusto von Dentz int hci_enable_advertising_sync(struct hci_dev *hdev) 1538cba6b758SLuiz Augusto von Dentz { 1539cba6b758SLuiz Augusto von Dentz struct adv_info *adv_instance; 1540cba6b758SLuiz Augusto von Dentz struct hci_cp_le_set_adv_param cp; 1541cba6b758SLuiz Augusto von Dentz u8 own_addr_type, enable = 0x01; 1542cba6b758SLuiz Augusto von Dentz bool connectable; 1543cba6b758SLuiz Augusto von Dentz u16 adv_min_interval, adv_max_interval; 1544cba6b758SLuiz Augusto von Dentz u32 flags; 1545cba6b758SLuiz Augusto von Dentz u8 status; 1546cba6b758SLuiz Augusto von Dentz 1547ad383c2cSLuiz Augusto von Dentz if (ext_adv_capable(hdev)) 1548ad383c2cSLuiz Augusto von Dentz return hci_enable_ext_advertising_sync(hdev, 1549ad383c2cSLuiz Augusto von Dentz hdev->cur_adv_instance); 1550ad383c2cSLuiz Augusto von Dentz 1551cba6b758SLuiz Augusto von Dentz flags = hci_adv_instance_flags(hdev, hdev->cur_adv_instance); 1552cba6b758SLuiz Augusto von Dentz adv_instance = hci_find_adv_instance(hdev, hdev->cur_adv_instance); 1553cba6b758SLuiz Augusto von Dentz 1554cba6b758SLuiz Augusto von Dentz /* If the "connectable" instance flag was not set, then choose between 1555cba6b758SLuiz Augusto von Dentz * ADV_IND and ADV_NONCONN_IND based on the global connectable setting. 1556cba6b758SLuiz Augusto von Dentz */ 1557cba6b758SLuiz Augusto von Dentz connectable = (flags & MGMT_ADV_FLAG_CONNECTABLE) || 1558cba6b758SLuiz Augusto von Dentz mgmt_get_connectable(hdev); 1559cba6b758SLuiz Augusto von Dentz 1560cba6b758SLuiz Augusto von Dentz if (!is_advertising_allowed(hdev, connectable)) 1561cba6b758SLuiz Augusto von Dentz return -EINVAL; 1562cba6b758SLuiz Augusto von Dentz 1563cba6b758SLuiz Augusto von Dentz status = hci_disable_advertising_sync(hdev); 1564cba6b758SLuiz Augusto von Dentz if (status) 1565cba6b758SLuiz Augusto von Dentz return status; 1566cba6b758SLuiz Augusto von Dentz 1567cba6b758SLuiz Augusto von Dentz /* Clear the HCI_LE_ADV bit temporarily so that the 1568cba6b758SLuiz Augusto von Dentz * hci_update_random_address knows that it's safe to go ahead 1569cba6b758SLuiz Augusto von Dentz * and write a new random address. The flag will be set back on 1570cba6b758SLuiz Augusto von Dentz * as soon as the SET_ADV_ENABLE HCI command completes. 1571cba6b758SLuiz Augusto von Dentz */ 1572cba6b758SLuiz Augusto von Dentz hci_dev_clear_flag(hdev, HCI_LE_ADV); 1573cba6b758SLuiz Augusto von Dentz 1574cba6b758SLuiz Augusto von Dentz /* Set require_privacy to true only when non-connectable 1575cba6b758SLuiz Augusto von Dentz * advertising is used. In that case it is fine to use a 1576cba6b758SLuiz Augusto von Dentz * non-resolvable private address. 1577cba6b758SLuiz Augusto von Dentz */ 1578cba6b758SLuiz Augusto von Dentz status = hci_update_random_address_sync(hdev, !connectable, 1579cba6b758SLuiz Augusto von Dentz adv_use_rpa(hdev, flags), 1580cba6b758SLuiz Augusto von Dentz &own_addr_type); 1581cba6b758SLuiz Augusto von Dentz if (status) 1582cba6b758SLuiz Augusto von Dentz return status; 1583cba6b758SLuiz Augusto von Dentz 1584cba6b758SLuiz Augusto von Dentz memset(&cp, 0, sizeof(cp)); 1585cba6b758SLuiz Augusto von Dentz 1586cba6b758SLuiz Augusto von Dentz if (adv_instance) { 1587cba6b758SLuiz Augusto von Dentz adv_min_interval = adv_instance->min_interval; 1588cba6b758SLuiz Augusto von Dentz adv_max_interval = adv_instance->max_interval; 1589cba6b758SLuiz Augusto von Dentz } else { 1590cba6b758SLuiz Augusto von Dentz adv_min_interval = hdev->le_adv_min_interval; 1591cba6b758SLuiz Augusto von Dentz adv_max_interval = hdev->le_adv_max_interval; 1592cba6b758SLuiz Augusto von Dentz } 1593cba6b758SLuiz Augusto von Dentz 1594cba6b758SLuiz Augusto von Dentz if (connectable) { 1595cba6b758SLuiz Augusto von Dentz cp.type = LE_ADV_IND; 1596cba6b758SLuiz Augusto von Dentz } else { 1597cba6b758SLuiz Augusto von Dentz if (hci_adv_instance_is_scannable(hdev, hdev->cur_adv_instance)) 1598cba6b758SLuiz Augusto von Dentz cp.type = LE_ADV_SCAN_IND; 1599cba6b758SLuiz Augusto von Dentz else 1600cba6b758SLuiz Augusto von Dentz cp.type = LE_ADV_NONCONN_IND; 1601cba6b758SLuiz Augusto von Dentz 1602cba6b758SLuiz Augusto von Dentz if (!hci_dev_test_flag(hdev, HCI_DISCOVERABLE) || 1603cba6b758SLuiz Augusto von Dentz hci_dev_test_flag(hdev, HCI_LIMITED_DISCOVERABLE)) { 1604cba6b758SLuiz Augusto von Dentz adv_min_interval = DISCOV_LE_FAST_ADV_INT_MIN; 1605cba6b758SLuiz Augusto von Dentz adv_max_interval = DISCOV_LE_FAST_ADV_INT_MAX; 1606cba6b758SLuiz Augusto von Dentz } 1607cba6b758SLuiz Augusto von Dentz } 1608cba6b758SLuiz Augusto von Dentz 1609cba6b758SLuiz Augusto von Dentz cp.min_interval = cpu_to_le16(adv_min_interval); 1610cba6b758SLuiz Augusto von Dentz cp.max_interval = cpu_to_le16(adv_max_interval); 1611cba6b758SLuiz Augusto von Dentz cp.own_address_type = own_addr_type; 1612cba6b758SLuiz Augusto von Dentz cp.channel_map = hdev->le_adv_channel_map; 1613cba6b758SLuiz Augusto von Dentz 1614cba6b758SLuiz Augusto von Dentz status = __hci_cmd_sync_status(hdev, HCI_OP_LE_SET_ADV_PARAM, 1615cba6b758SLuiz Augusto von Dentz sizeof(cp), &cp, HCI_CMD_TIMEOUT); 1616cba6b758SLuiz Augusto von Dentz if (status) 1617cba6b758SLuiz Augusto von Dentz return status; 1618cba6b758SLuiz Augusto von Dentz 1619cba6b758SLuiz Augusto von Dentz return __hci_cmd_sync_status(hdev, HCI_OP_LE_SET_ADV_ENABLE, 1620cba6b758SLuiz Augusto von Dentz sizeof(enable), &enable, HCI_CMD_TIMEOUT); 1621cba6b758SLuiz Augusto von Dentz } 1622cba6b758SLuiz Augusto von Dentz 1623abfeea47SLuiz Augusto von Dentz static int enable_advertising_sync(struct hci_dev *hdev, void *data) 1624abfeea47SLuiz Augusto von Dentz { 1625abfeea47SLuiz Augusto von Dentz return hci_enable_advertising_sync(hdev); 1626abfeea47SLuiz Augusto von Dentz } 1627abfeea47SLuiz Augusto von Dentz 1628abfeea47SLuiz Augusto von Dentz int hci_enable_advertising(struct hci_dev *hdev) 1629abfeea47SLuiz Augusto von Dentz { 1630abfeea47SLuiz Augusto von Dentz if (!hci_dev_test_flag(hdev, HCI_ADVERTISING) && 1631abfeea47SLuiz Augusto von Dentz list_empty(&hdev->adv_instances)) 1632abfeea47SLuiz Augusto von Dentz return 0; 1633abfeea47SLuiz Augusto von Dentz 1634abfeea47SLuiz Augusto von Dentz return hci_cmd_sync_queue(hdev, enable_advertising_sync, NULL, NULL); 1635abfeea47SLuiz Augusto von Dentz } 1636abfeea47SLuiz Augusto von Dentz 1637abfeea47SLuiz Augusto von Dentz int hci_remove_ext_adv_instance_sync(struct hci_dev *hdev, u8 instance, 1638cba6b758SLuiz Augusto von Dentz struct sock *sk) 1639cba6b758SLuiz Augusto von Dentz { 1640cba6b758SLuiz Augusto von Dentz int err; 1641cba6b758SLuiz Augusto von Dentz 1642cba6b758SLuiz Augusto von Dentz if (!ext_adv_capable(hdev)) 1643cba6b758SLuiz Augusto von Dentz return 0; 1644cba6b758SLuiz Augusto von Dentz 1645cba6b758SLuiz Augusto von Dentz err = hci_disable_ext_adv_instance_sync(hdev, instance); 1646cba6b758SLuiz Augusto von Dentz if (err) 1647cba6b758SLuiz Augusto von Dentz return err; 1648cba6b758SLuiz Augusto von Dentz 1649cba6b758SLuiz Augusto von Dentz /* If request specifies an instance that doesn't exist, fail */ 1650cba6b758SLuiz Augusto von Dentz if (instance > 0 && !hci_find_adv_instance(hdev, instance)) 1651cba6b758SLuiz Augusto von Dentz return -EINVAL; 1652cba6b758SLuiz Augusto von Dentz 1653cba6b758SLuiz Augusto von Dentz return __hci_cmd_sync_status_sk(hdev, HCI_OP_LE_REMOVE_ADV_SET, 1654cba6b758SLuiz Augusto von Dentz sizeof(instance), &instance, 0, 1655cba6b758SLuiz Augusto von Dentz HCI_CMD_TIMEOUT, sk); 1656cba6b758SLuiz Augusto von Dentz } 1657cba6b758SLuiz Augusto von Dentz 1658eca0ae4aSLuiz Augusto von Dentz static int remove_ext_adv_sync(struct hci_dev *hdev, void *data) 1659eca0ae4aSLuiz Augusto von Dentz { 1660eca0ae4aSLuiz Augusto von Dentz struct adv_info *adv = data; 1661eca0ae4aSLuiz Augusto von Dentz u8 instance = 0; 1662eca0ae4aSLuiz Augusto von Dentz 1663eca0ae4aSLuiz Augusto von Dentz if (adv) 1664eca0ae4aSLuiz Augusto von Dentz instance = adv->instance; 1665eca0ae4aSLuiz Augusto von Dentz 1666eca0ae4aSLuiz Augusto von Dentz return hci_remove_ext_adv_instance_sync(hdev, instance, NULL); 1667eca0ae4aSLuiz Augusto von Dentz } 1668eca0ae4aSLuiz Augusto von Dentz 1669eca0ae4aSLuiz Augusto von Dentz int hci_remove_ext_adv_instance(struct hci_dev *hdev, u8 instance) 1670eca0ae4aSLuiz Augusto von Dentz { 1671eca0ae4aSLuiz Augusto von Dentz struct adv_info *adv = NULL; 1672eca0ae4aSLuiz Augusto von Dentz 1673eca0ae4aSLuiz Augusto von Dentz if (instance) { 1674eca0ae4aSLuiz Augusto von Dentz adv = hci_find_adv_instance(hdev, instance); 1675eca0ae4aSLuiz Augusto von Dentz if (!adv) 1676eca0ae4aSLuiz Augusto von Dentz return -EINVAL; 1677eca0ae4aSLuiz Augusto von Dentz } 1678eca0ae4aSLuiz Augusto von Dentz 1679eca0ae4aSLuiz Augusto von Dentz return hci_cmd_sync_queue(hdev, remove_ext_adv_sync, adv, NULL); 1680eca0ae4aSLuiz Augusto von Dentz } 1681eca0ae4aSLuiz Augusto von Dentz 1682eca0ae4aSLuiz Augusto von Dentz int hci_le_terminate_big_sync(struct hci_dev *hdev, u8 handle, u8 reason) 1683eca0ae4aSLuiz Augusto von Dentz { 1684eca0ae4aSLuiz Augusto von Dentz struct hci_cp_le_term_big cp; 1685eca0ae4aSLuiz Augusto von Dentz 1686eca0ae4aSLuiz Augusto von Dentz memset(&cp, 0, sizeof(cp)); 1687eca0ae4aSLuiz Augusto von Dentz cp.handle = handle; 1688eca0ae4aSLuiz Augusto von Dentz cp.reason = reason; 1689eca0ae4aSLuiz Augusto von Dentz 1690eca0ae4aSLuiz Augusto von Dentz return __hci_cmd_sync_status(hdev, HCI_OP_LE_TERM_BIG, 1691eca0ae4aSLuiz Augusto von Dentz sizeof(cp), &cp, HCI_CMD_TIMEOUT); 1692eca0ae4aSLuiz Augusto von Dentz } 1693eca0ae4aSLuiz Augusto von Dentz 1694cba6b758SLuiz Augusto von Dentz static int hci_set_ext_adv_data_sync(struct hci_dev *hdev, u8 instance) 1695cba6b758SLuiz Augusto von Dentz { 1696cba6b758SLuiz Augusto von Dentz struct { 1697cba6b758SLuiz Augusto von Dentz struct hci_cp_le_set_ext_adv_data cp; 1698cba6b758SLuiz Augusto von Dentz u8 data[HCI_MAX_EXT_AD_LENGTH]; 1699cba6b758SLuiz Augusto von Dentz } pdu; 1700cba6b758SLuiz Augusto von Dentz u8 len; 170134a718bcSLuiz Augusto von Dentz struct adv_info *adv = NULL; 170234a718bcSLuiz Augusto von Dentz int err; 1703cba6b758SLuiz Augusto von Dentz 1704cba6b758SLuiz Augusto von Dentz memset(&pdu, 0, sizeof(pdu)); 1705cba6b758SLuiz Augusto von Dentz 170634a718bcSLuiz Augusto von Dentz if (instance) { 170734a718bcSLuiz Augusto von Dentz adv = hci_find_adv_instance(hdev, instance); 170834a718bcSLuiz Augusto von Dentz if (!adv || !adv->adv_data_changed) 1709cba6b758SLuiz Augusto von Dentz return 0; 171034a718bcSLuiz Augusto von Dentz } 1711cba6b758SLuiz Augusto von Dentz 171234a718bcSLuiz Augusto von Dentz len = eir_create_adv_data(hdev, instance, pdu.data); 1713cba6b758SLuiz Augusto von Dentz 1714cba6b758SLuiz Augusto von Dentz pdu.cp.length = len; 1715cba6b758SLuiz Augusto von Dentz pdu.cp.handle = instance; 1716cba6b758SLuiz Augusto von Dentz pdu.cp.operation = LE_SET_ADV_DATA_OP_COMPLETE; 1717cba6b758SLuiz Augusto von Dentz pdu.cp.frag_pref = LE_SET_ADV_DATA_NO_FRAG; 1718cba6b758SLuiz Augusto von Dentz 171934a718bcSLuiz Augusto von Dentz err = __hci_cmd_sync_status(hdev, HCI_OP_LE_SET_EXT_ADV_DATA, 1720cba6b758SLuiz Augusto von Dentz sizeof(pdu.cp) + len, &pdu.cp, 1721cba6b758SLuiz Augusto von Dentz HCI_CMD_TIMEOUT); 172234a718bcSLuiz Augusto von Dentz if (err) 172334a718bcSLuiz Augusto von Dentz return err; 172434a718bcSLuiz Augusto von Dentz 172534a718bcSLuiz Augusto von Dentz /* Update data if the command succeed */ 172634a718bcSLuiz Augusto von Dentz if (adv) { 172734a718bcSLuiz Augusto von Dentz adv->adv_data_changed = false; 172834a718bcSLuiz Augusto von Dentz } else { 172934a718bcSLuiz Augusto von Dentz memcpy(hdev->adv_data, pdu.data, len); 173034a718bcSLuiz Augusto von Dentz hdev->adv_data_len = len; 173134a718bcSLuiz Augusto von Dentz } 173234a718bcSLuiz Augusto von Dentz 173334a718bcSLuiz Augusto von Dentz return 0; 1734cba6b758SLuiz Augusto von Dentz } 1735cba6b758SLuiz Augusto von Dentz 1736cba6b758SLuiz Augusto von Dentz static int hci_set_adv_data_sync(struct hci_dev *hdev, u8 instance) 1737cba6b758SLuiz Augusto von Dentz { 1738cba6b758SLuiz Augusto von Dentz struct hci_cp_le_set_adv_data cp; 1739cba6b758SLuiz Augusto von Dentz u8 len; 1740cba6b758SLuiz Augusto von Dentz 1741cba6b758SLuiz Augusto von Dentz memset(&cp, 0, sizeof(cp)); 1742cba6b758SLuiz Augusto von Dentz 1743cba6b758SLuiz Augusto von Dentz len = eir_create_adv_data(hdev, instance, cp.data); 1744cba6b758SLuiz Augusto von Dentz 1745cba6b758SLuiz Augusto von Dentz /* There's nothing to do if the data hasn't changed */ 1746cba6b758SLuiz Augusto von Dentz if (hdev->adv_data_len == len && 1747cba6b758SLuiz Augusto von Dentz memcmp(cp.data, hdev->adv_data, len) == 0) 1748cba6b758SLuiz Augusto von Dentz return 0; 1749cba6b758SLuiz Augusto von Dentz 1750cba6b758SLuiz Augusto von Dentz memcpy(hdev->adv_data, cp.data, sizeof(cp.data)); 1751cba6b758SLuiz Augusto von Dentz hdev->adv_data_len = len; 1752cba6b758SLuiz Augusto von Dentz 1753cba6b758SLuiz Augusto von Dentz cp.length = len; 1754cba6b758SLuiz Augusto von Dentz 1755cba6b758SLuiz Augusto von Dentz return __hci_cmd_sync_status(hdev, HCI_OP_LE_SET_ADV_DATA, 1756cba6b758SLuiz Augusto von Dentz sizeof(cp), &cp, HCI_CMD_TIMEOUT); 1757cba6b758SLuiz Augusto von Dentz } 1758cba6b758SLuiz Augusto von Dentz 1759cba6b758SLuiz Augusto von Dentz int hci_update_adv_data_sync(struct hci_dev *hdev, u8 instance) 1760cba6b758SLuiz Augusto von Dentz { 1761cba6b758SLuiz Augusto von Dentz if (!hci_dev_test_flag(hdev, HCI_LE_ENABLED)) 1762cba6b758SLuiz Augusto von Dentz return 0; 1763cba6b758SLuiz Augusto von Dentz 1764cba6b758SLuiz Augusto von Dentz if (ext_adv_capable(hdev)) 1765cba6b758SLuiz Augusto von Dentz return hci_set_ext_adv_data_sync(hdev, instance); 1766cba6b758SLuiz Augusto von Dentz 1767cba6b758SLuiz Augusto von Dentz return hci_set_adv_data_sync(hdev, instance); 1768cba6b758SLuiz Augusto von Dentz } 1769cba6b758SLuiz Augusto von Dentz 1770cba6b758SLuiz Augusto von Dentz int hci_schedule_adv_instance_sync(struct hci_dev *hdev, u8 instance, 1771cba6b758SLuiz Augusto von Dentz bool force) 1772cba6b758SLuiz Augusto von Dentz { 1773cba6b758SLuiz Augusto von Dentz struct adv_info *adv = NULL; 1774cba6b758SLuiz Augusto von Dentz u16 timeout; 1775cba6b758SLuiz Augusto von Dentz 1776cf75ad8bSLuiz Augusto von Dentz if (hci_dev_test_flag(hdev, HCI_ADVERTISING) && !ext_adv_capable(hdev)) 1777cba6b758SLuiz Augusto von Dentz return -EPERM; 1778cba6b758SLuiz Augusto von Dentz 1779cba6b758SLuiz Augusto von Dentz if (hdev->adv_instance_timeout) 1780cba6b758SLuiz Augusto von Dentz return -EBUSY; 1781cba6b758SLuiz Augusto von Dentz 1782cba6b758SLuiz Augusto von Dentz adv = hci_find_adv_instance(hdev, instance); 1783cba6b758SLuiz Augusto von Dentz if (!adv) 1784cba6b758SLuiz Augusto von Dentz return -ENOENT; 1785cba6b758SLuiz Augusto von Dentz 1786cba6b758SLuiz Augusto von Dentz /* A zero timeout means unlimited advertising. As long as there is 1787cba6b758SLuiz Augusto von Dentz * only one instance, duration should be ignored. We still set a timeout 1788cba6b758SLuiz Augusto von Dentz * in case further instances are being added later on. 1789cba6b758SLuiz Augusto von Dentz * 1790cba6b758SLuiz Augusto von Dentz * If the remaining lifetime of the instance is more than the duration 1791cba6b758SLuiz Augusto von Dentz * then the timeout corresponds to the duration, otherwise it will be 1792cba6b758SLuiz Augusto von Dentz * reduced to the remaining instance lifetime. 1793cba6b758SLuiz Augusto von Dentz */ 1794cba6b758SLuiz Augusto von Dentz if (adv->timeout == 0 || adv->duration <= adv->remaining_time) 1795cba6b758SLuiz Augusto von Dentz timeout = adv->duration; 1796cba6b758SLuiz Augusto von Dentz else 1797cba6b758SLuiz Augusto von Dentz timeout = adv->remaining_time; 1798cba6b758SLuiz Augusto von Dentz 1799cba6b758SLuiz Augusto von Dentz /* The remaining time is being reduced unless the instance is being 1800cba6b758SLuiz Augusto von Dentz * advertised without time limit. 1801cba6b758SLuiz Augusto von Dentz */ 1802cba6b758SLuiz Augusto von Dentz if (adv->timeout) 1803cba6b758SLuiz Augusto von Dentz adv->remaining_time = adv->remaining_time - timeout; 1804cba6b758SLuiz Augusto von Dentz 1805cba6b758SLuiz Augusto von Dentz /* Only use work for scheduling instances with legacy advertising */ 1806cba6b758SLuiz Augusto von Dentz if (!ext_adv_capable(hdev)) { 1807cba6b758SLuiz Augusto von Dentz hdev->adv_instance_timeout = timeout; 1808cba6b758SLuiz Augusto von Dentz queue_delayed_work(hdev->req_workqueue, 1809cba6b758SLuiz Augusto von Dentz &hdev->adv_instance_expire, 1810cba6b758SLuiz Augusto von Dentz msecs_to_jiffies(timeout * 1000)); 1811cba6b758SLuiz Augusto von Dentz } 1812cba6b758SLuiz Augusto von Dentz 1813cba6b758SLuiz Augusto von Dentz /* If we're just re-scheduling the same instance again then do not 1814cba6b758SLuiz Augusto von Dentz * execute any HCI commands. This happens when a single instance is 1815cba6b758SLuiz Augusto von Dentz * being advertised. 1816cba6b758SLuiz Augusto von Dentz */ 1817cba6b758SLuiz Augusto von Dentz if (!force && hdev->cur_adv_instance == instance && 1818cba6b758SLuiz Augusto von Dentz hci_dev_test_flag(hdev, HCI_LE_ADV)) 1819cba6b758SLuiz Augusto von Dentz return 0; 1820cba6b758SLuiz Augusto von Dentz 1821cba6b758SLuiz Augusto von Dentz hdev->cur_adv_instance = instance; 1822cba6b758SLuiz Augusto von Dentz 1823cba6b758SLuiz Augusto von Dentz return hci_start_adv_sync(hdev, instance); 1824cba6b758SLuiz Augusto von Dentz } 1825cba6b758SLuiz Augusto von Dentz 1826cba6b758SLuiz Augusto von Dentz static int hci_clear_adv_sets_sync(struct hci_dev *hdev, struct sock *sk) 1827cba6b758SLuiz Augusto von Dentz { 1828cba6b758SLuiz Augusto von Dentz int err; 1829cba6b758SLuiz Augusto von Dentz 1830cba6b758SLuiz Augusto von Dentz if (!ext_adv_capable(hdev)) 1831cba6b758SLuiz Augusto von Dentz return 0; 1832cba6b758SLuiz Augusto von Dentz 1833cba6b758SLuiz Augusto von Dentz /* Disable instance 0x00 to disable all instances */ 1834cba6b758SLuiz Augusto von Dentz err = hci_disable_ext_adv_instance_sync(hdev, 0x00); 1835cba6b758SLuiz Augusto von Dentz if (err) 1836cba6b758SLuiz Augusto von Dentz return err; 1837cba6b758SLuiz Augusto von Dentz 1838cba6b758SLuiz Augusto von Dentz return __hci_cmd_sync_status_sk(hdev, HCI_OP_LE_CLEAR_ADV_SETS, 1839cba6b758SLuiz Augusto von Dentz 0, NULL, 0, HCI_CMD_TIMEOUT, sk); 1840cba6b758SLuiz Augusto von Dentz } 1841cba6b758SLuiz Augusto von Dentz 1842cba6b758SLuiz Augusto von Dentz static int hci_clear_adv_sync(struct hci_dev *hdev, struct sock *sk, bool force) 1843cba6b758SLuiz Augusto von Dentz { 1844cba6b758SLuiz Augusto von Dentz struct adv_info *adv, *n; 1845b338d917SBrian Gix int err = 0; 1846cba6b758SLuiz Augusto von Dentz 1847cba6b758SLuiz Augusto von Dentz if (ext_adv_capable(hdev)) 1848cba6b758SLuiz Augusto von Dentz /* Remove all existing sets */ 1849b338d917SBrian Gix err = hci_clear_adv_sets_sync(hdev, sk); 1850b338d917SBrian Gix if (ext_adv_capable(hdev)) 1851b338d917SBrian Gix return err; 1852cba6b758SLuiz Augusto von Dentz 1853cba6b758SLuiz Augusto von Dentz /* This is safe as long as there is no command send while the lock is 1854cba6b758SLuiz Augusto von Dentz * held. 1855cba6b758SLuiz Augusto von Dentz */ 1856cba6b758SLuiz Augusto von Dentz hci_dev_lock(hdev); 1857cba6b758SLuiz Augusto von Dentz 1858cba6b758SLuiz Augusto von Dentz /* Cleanup non-ext instances */ 1859cba6b758SLuiz Augusto von Dentz list_for_each_entry_safe(adv, n, &hdev->adv_instances, list) { 1860cba6b758SLuiz Augusto von Dentz u8 instance = adv->instance; 1861cba6b758SLuiz Augusto von Dentz int err; 1862cba6b758SLuiz Augusto von Dentz 1863cba6b758SLuiz Augusto von Dentz if (!(force || adv->timeout)) 1864cba6b758SLuiz Augusto von Dentz continue; 1865cba6b758SLuiz Augusto von Dentz 1866cba6b758SLuiz Augusto von Dentz err = hci_remove_adv_instance(hdev, instance); 1867cba6b758SLuiz Augusto von Dentz if (!err) 1868cba6b758SLuiz Augusto von Dentz mgmt_advertising_removed(sk, hdev, instance); 1869cba6b758SLuiz Augusto von Dentz } 1870cba6b758SLuiz Augusto von Dentz 1871cba6b758SLuiz Augusto von Dentz hci_dev_unlock(hdev); 1872cba6b758SLuiz Augusto von Dentz 1873cba6b758SLuiz Augusto von Dentz return 0; 1874cba6b758SLuiz Augusto von Dentz } 1875cba6b758SLuiz Augusto von Dentz 1876cba6b758SLuiz Augusto von Dentz static int hci_remove_adv_sync(struct hci_dev *hdev, u8 instance, 1877cba6b758SLuiz Augusto von Dentz struct sock *sk) 1878cba6b758SLuiz Augusto von Dentz { 1879b338d917SBrian Gix int err = 0; 1880cba6b758SLuiz Augusto von Dentz 1881cba6b758SLuiz Augusto von Dentz /* If we use extended advertising, instance has to be removed first. */ 1882cba6b758SLuiz Augusto von Dentz if (ext_adv_capable(hdev)) 1883b338d917SBrian Gix err = hci_remove_ext_adv_instance_sync(hdev, instance, sk); 1884b338d917SBrian Gix if (ext_adv_capable(hdev)) 1885b338d917SBrian Gix return err; 1886cba6b758SLuiz Augusto von Dentz 1887cba6b758SLuiz Augusto von Dentz /* This is safe as long as there is no command send while the lock is 1888cba6b758SLuiz Augusto von Dentz * held. 1889cba6b758SLuiz Augusto von Dentz */ 1890cba6b758SLuiz Augusto von Dentz hci_dev_lock(hdev); 1891cba6b758SLuiz Augusto von Dentz 1892cba6b758SLuiz Augusto von Dentz err = hci_remove_adv_instance(hdev, instance); 1893cba6b758SLuiz Augusto von Dentz if (!err) 1894cba6b758SLuiz Augusto von Dentz mgmt_advertising_removed(sk, hdev, instance); 1895cba6b758SLuiz Augusto von Dentz 1896cba6b758SLuiz Augusto von Dentz hci_dev_unlock(hdev); 1897cba6b758SLuiz Augusto von Dentz 1898cba6b758SLuiz Augusto von Dentz return err; 1899cba6b758SLuiz Augusto von Dentz } 1900cba6b758SLuiz Augusto von Dentz 1901cba6b758SLuiz Augusto von Dentz /* For a single instance: 1902cba6b758SLuiz Augusto von Dentz * - force == true: The instance will be removed even when its remaining 1903cba6b758SLuiz Augusto von Dentz * lifetime is not zero. 1904cba6b758SLuiz Augusto von Dentz * - force == false: the instance will be deactivated but kept stored unless 1905cba6b758SLuiz Augusto von Dentz * the remaining lifetime is zero. 1906cba6b758SLuiz Augusto von Dentz * 1907cba6b758SLuiz Augusto von Dentz * For instance == 0x00: 1908cba6b758SLuiz Augusto von Dentz * - force == true: All instances will be removed regardless of their timeout 1909cba6b758SLuiz Augusto von Dentz * setting. 1910cba6b758SLuiz Augusto von Dentz * - force == false: Only instances that have a timeout will be removed. 1911cba6b758SLuiz Augusto von Dentz */ 1912cba6b758SLuiz Augusto von Dentz int hci_remove_advertising_sync(struct hci_dev *hdev, struct sock *sk, 1913cba6b758SLuiz Augusto von Dentz u8 instance, bool force) 1914cba6b758SLuiz Augusto von Dentz { 1915cba6b758SLuiz Augusto von Dentz struct adv_info *next = NULL; 1916cba6b758SLuiz Augusto von Dentz int err; 1917cba6b758SLuiz Augusto von Dentz 1918cba6b758SLuiz Augusto von Dentz /* Cancel any timeout concerning the removed instance(s). */ 1919cba6b758SLuiz Augusto von Dentz if (!instance || hdev->cur_adv_instance == instance) 1920cba6b758SLuiz Augusto von Dentz cancel_adv_timeout(hdev); 1921cba6b758SLuiz Augusto von Dentz 1922cba6b758SLuiz Augusto von Dentz /* Get the next instance to advertise BEFORE we remove 1923cba6b758SLuiz Augusto von Dentz * the current one. This can be the same instance again 1924cba6b758SLuiz Augusto von Dentz * if there is only one instance. 1925cba6b758SLuiz Augusto von Dentz */ 1926cba6b758SLuiz Augusto von Dentz if (hdev->cur_adv_instance == instance) 1927cba6b758SLuiz Augusto von Dentz next = hci_get_next_instance(hdev, instance); 1928cba6b758SLuiz Augusto von Dentz 1929cba6b758SLuiz Augusto von Dentz if (!instance) { 1930cba6b758SLuiz Augusto von Dentz err = hci_clear_adv_sync(hdev, sk, force); 1931cba6b758SLuiz Augusto von Dentz if (err) 1932cba6b758SLuiz Augusto von Dentz return err; 1933cba6b758SLuiz Augusto von Dentz } else { 1934cba6b758SLuiz Augusto von Dentz struct adv_info *adv = hci_find_adv_instance(hdev, instance); 1935cba6b758SLuiz Augusto von Dentz 1936cba6b758SLuiz Augusto von Dentz if (force || (adv && adv->timeout && !adv->remaining_time)) { 1937cba6b758SLuiz Augusto von Dentz /* Don't advertise a removed instance. */ 1938cba6b758SLuiz Augusto von Dentz if (next && next->instance == instance) 1939cba6b758SLuiz Augusto von Dentz next = NULL; 1940cba6b758SLuiz Augusto von Dentz 1941cba6b758SLuiz Augusto von Dentz err = hci_remove_adv_sync(hdev, instance, sk); 1942cba6b758SLuiz Augusto von Dentz if (err) 1943cba6b758SLuiz Augusto von Dentz return err; 1944cba6b758SLuiz Augusto von Dentz } 1945cba6b758SLuiz Augusto von Dentz } 1946cba6b758SLuiz Augusto von Dentz 1947cba6b758SLuiz Augusto von Dentz if (!hdev_is_powered(hdev) || hci_dev_test_flag(hdev, HCI_ADVERTISING)) 1948cba6b758SLuiz Augusto von Dentz return 0; 1949cba6b758SLuiz Augusto von Dentz 1950cba6b758SLuiz Augusto von Dentz if (next && !ext_adv_capable(hdev)) 1951cba6b758SLuiz Augusto von Dentz hci_schedule_adv_instance_sync(hdev, next->instance, false); 1952cba6b758SLuiz Augusto von Dentz 1953cba6b758SLuiz Augusto von Dentz return 0; 1954cba6b758SLuiz Augusto von Dentz } 1955cba6b758SLuiz Augusto von Dentz 195647db6b42SBrian Gix int hci_read_rssi_sync(struct hci_dev *hdev, __le16 handle) 195747db6b42SBrian Gix { 195847db6b42SBrian Gix struct hci_cp_read_rssi cp; 195947db6b42SBrian Gix 196047db6b42SBrian Gix cp.handle = handle; 196147db6b42SBrian Gix return __hci_cmd_sync_status(hdev, HCI_OP_READ_RSSI, 196247db6b42SBrian Gix sizeof(cp), &cp, HCI_CMD_TIMEOUT); 196347db6b42SBrian Gix } 196447db6b42SBrian Gix 19655a750137SBrian Gix int hci_read_clock_sync(struct hci_dev *hdev, struct hci_cp_read_clock *cp) 19665a750137SBrian Gix { 19675a750137SBrian Gix return __hci_cmd_sync_status(hdev, HCI_OP_READ_CLOCK, 19685a750137SBrian Gix sizeof(*cp), cp, HCI_CMD_TIMEOUT); 19695a750137SBrian Gix } 19705a750137SBrian Gix 197147db6b42SBrian Gix int hci_read_tx_power_sync(struct hci_dev *hdev, __le16 handle, u8 type) 197247db6b42SBrian Gix { 197347db6b42SBrian Gix struct hci_cp_read_tx_power cp; 197447db6b42SBrian Gix 197547db6b42SBrian Gix cp.handle = handle; 197647db6b42SBrian Gix cp.type = type; 197747db6b42SBrian Gix return __hci_cmd_sync_status(hdev, HCI_OP_READ_TX_POWER, 197847db6b42SBrian Gix sizeof(cp), &cp, HCI_CMD_TIMEOUT); 197947db6b42SBrian Gix } 198047db6b42SBrian Gix 1981cba6b758SLuiz Augusto von Dentz int hci_disable_advertising_sync(struct hci_dev *hdev) 1982cba6b758SLuiz Augusto von Dentz { 1983cba6b758SLuiz Augusto von Dentz u8 enable = 0x00; 1984b338d917SBrian Gix int err = 0; 1985cba6b758SLuiz Augusto von Dentz 1986ad383c2cSLuiz Augusto von Dentz /* If controller is not advertising we are done. */ 1987ad383c2cSLuiz Augusto von Dentz if (!hci_dev_test_flag(hdev, HCI_LE_ADV)) 1988ad383c2cSLuiz Augusto von Dentz return 0; 1989ad383c2cSLuiz Augusto von Dentz 1990cba6b758SLuiz Augusto von Dentz if (ext_adv_capable(hdev)) 1991b338d917SBrian Gix err = hci_disable_ext_adv_instance_sync(hdev, 0x00); 1992b338d917SBrian Gix if (ext_adv_capable(hdev)) 1993b338d917SBrian Gix return err; 1994cba6b758SLuiz Augusto von Dentz 1995cba6b758SLuiz Augusto von Dentz return __hci_cmd_sync_status(hdev, HCI_OP_LE_SET_ADV_ENABLE, 1996cba6b758SLuiz Augusto von Dentz sizeof(enable), &enable, HCI_CMD_TIMEOUT); 1997cba6b758SLuiz Augusto von Dentz } 1998e8907f76SLuiz Augusto von Dentz 1999e8907f76SLuiz Augusto von Dentz static int hci_le_set_ext_scan_enable_sync(struct hci_dev *hdev, u8 val, 2000e8907f76SLuiz Augusto von Dentz u8 filter_dup) 2001e8907f76SLuiz Augusto von Dentz { 2002e8907f76SLuiz Augusto von Dentz struct hci_cp_le_set_ext_scan_enable cp; 2003e8907f76SLuiz Augusto von Dentz 2004e8907f76SLuiz Augusto von Dentz memset(&cp, 0, sizeof(cp)); 2005e8907f76SLuiz Augusto von Dentz cp.enable = val; 2006b338d917SBrian Gix 2007b338d917SBrian Gix if (hci_dev_test_flag(hdev, HCI_MESH)) 2008b338d917SBrian Gix cp.filter_dup = LE_SCAN_FILTER_DUP_DISABLE; 2009b338d917SBrian Gix else 2010e8907f76SLuiz Augusto von Dentz cp.filter_dup = filter_dup; 2011e8907f76SLuiz Augusto von Dentz 2012e8907f76SLuiz Augusto von Dentz return __hci_cmd_sync_status(hdev, HCI_OP_LE_SET_EXT_SCAN_ENABLE, 2013e8907f76SLuiz Augusto von Dentz sizeof(cp), &cp, HCI_CMD_TIMEOUT); 2014e8907f76SLuiz Augusto von Dentz } 2015e8907f76SLuiz Augusto von Dentz 2016e8907f76SLuiz Augusto von Dentz static int hci_le_set_scan_enable_sync(struct hci_dev *hdev, u8 val, 2017e8907f76SLuiz Augusto von Dentz u8 filter_dup) 2018e8907f76SLuiz Augusto von Dentz { 2019e8907f76SLuiz Augusto von Dentz struct hci_cp_le_set_scan_enable cp; 2020e8907f76SLuiz Augusto von Dentz 2021e8907f76SLuiz Augusto von Dentz if (use_ext_scan(hdev)) 2022e8907f76SLuiz Augusto von Dentz return hci_le_set_ext_scan_enable_sync(hdev, val, filter_dup); 2023e8907f76SLuiz Augusto von Dentz 2024e8907f76SLuiz Augusto von Dentz memset(&cp, 0, sizeof(cp)); 2025e8907f76SLuiz Augusto von Dentz cp.enable = val; 2026b338d917SBrian Gix 2027b338d917SBrian Gix if (val && hci_dev_test_flag(hdev, HCI_MESH)) 2028b338d917SBrian Gix cp.filter_dup = LE_SCAN_FILTER_DUP_DISABLE; 2029b338d917SBrian Gix else 2030e8907f76SLuiz Augusto von Dentz cp.filter_dup = filter_dup; 2031e8907f76SLuiz Augusto von Dentz 2032e8907f76SLuiz Augusto von Dentz return __hci_cmd_sync_status(hdev, HCI_OP_LE_SET_SCAN_ENABLE, 2033e8907f76SLuiz Augusto von Dentz sizeof(cp), &cp, HCI_CMD_TIMEOUT); 2034e8907f76SLuiz Augusto von Dentz } 2035e8907f76SLuiz Augusto von Dentz 2036e8907f76SLuiz Augusto von Dentz static int hci_le_set_addr_resolution_enable_sync(struct hci_dev *hdev, u8 val) 2037e8907f76SLuiz Augusto von Dentz { 2038ad383c2cSLuiz Augusto von Dentz if (!use_ll_privacy(hdev)) 2039ad383c2cSLuiz Augusto von Dentz return 0; 2040ad383c2cSLuiz Augusto von Dentz 2041ad383c2cSLuiz Augusto von Dentz /* If controller is not/already resolving we are done. */ 2042ad383c2cSLuiz Augusto von Dentz if (val == hci_dev_test_flag(hdev, HCI_LL_RPA_RESOLUTION)) 2043e8907f76SLuiz Augusto von Dentz return 0; 2044e8907f76SLuiz Augusto von Dentz 2045e8907f76SLuiz Augusto von Dentz return __hci_cmd_sync_status(hdev, HCI_OP_LE_SET_ADDR_RESOLV_ENABLE, 2046e8907f76SLuiz Augusto von Dentz sizeof(val), &val, HCI_CMD_TIMEOUT); 2047e8907f76SLuiz Augusto von Dentz } 2048e8907f76SLuiz Augusto von Dentz 204927592ca1SLuiz Augusto von Dentz static int hci_scan_disable_sync(struct hci_dev *hdev) 2050e8907f76SLuiz Augusto von Dentz { 2051e8907f76SLuiz Augusto von Dentz int err; 2052e8907f76SLuiz Augusto von Dentz 2053e8907f76SLuiz Augusto von Dentz /* If controller is not scanning we are done. */ 2054e8907f76SLuiz Augusto von Dentz if (!hci_dev_test_flag(hdev, HCI_LE_SCAN)) 2055e8907f76SLuiz Augusto von Dentz return 0; 2056e8907f76SLuiz Augusto von Dentz 2057e8907f76SLuiz Augusto von Dentz if (hdev->scanning_paused) { 2058e8907f76SLuiz Augusto von Dentz bt_dev_dbg(hdev, "Scanning is paused for suspend"); 2059e8907f76SLuiz Augusto von Dentz return 0; 2060e8907f76SLuiz Augusto von Dentz } 2061e8907f76SLuiz Augusto von Dentz 2062e8907f76SLuiz Augusto von Dentz err = hci_le_set_scan_enable_sync(hdev, LE_SCAN_DISABLE, 0x00); 2063e8907f76SLuiz Augusto von Dentz if (err) { 2064e8907f76SLuiz Augusto von Dentz bt_dev_err(hdev, "Unable to disable scanning: %d", err); 2065e8907f76SLuiz Augusto von Dentz return err; 2066e8907f76SLuiz Augusto von Dentz } 2067e8907f76SLuiz Augusto von Dentz 2068e8907f76SLuiz Augusto von Dentz return err; 2069e8907f76SLuiz Augusto von Dentz } 2070e8907f76SLuiz Augusto von Dentz 2071e8907f76SLuiz Augusto von Dentz static bool scan_use_rpa(struct hci_dev *hdev) 2072e8907f76SLuiz Augusto von Dentz { 2073e8907f76SLuiz Augusto von Dentz return hci_dev_test_flag(hdev, HCI_PRIVACY); 2074e8907f76SLuiz Augusto von Dentz } 2075e8907f76SLuiz Augusto von Dentz 2076e8907f76SLuiz Augusto von Dentz static void hci_start_interleave_scan(struct hci_dev *hdev) 2077e8907f76SLuiz Augusto von Dentz { 2078e8907f76SLuiz Augusto von Dentz hdev->interleave_scan_state = INTERLEAVE_SCAN_NO_FILTER; 2079e8907f76SLuiz Augusto von Dentz queue_delayed_work(hdev->req_workqueue, 2080e8907f76SLuiz Augusto von Dentz &hdev->interleave_scan, 0); 2081e8907f76SLuiz Augusto von Dentz } 2082e8907f76SLuiz Augusto von Dentz 2083e8907f76SLuiz Augusto von Dentz static bool is_interleave_scanning(struct hci_dev *hdev) 2084e8907f76SLuiz Augusto von Dentz { 2085e8907f76SLuiz Augusto von Dentz return hdev->interleave_scan_state != INTERLEAVE_SCAN_NONE; 2086e8907f76SLuiz Augusto von Dentz } 2087e8907f76SLuiz Augusto von Dentz 2088e8907f76SLuiz Augusto von Dentz static void cancel_interleave_scan(struct hci_dev *hdev) 2089e8907f76SLuiz Augusto von Dentz { 2090e8907f76SLuiz Augusto von Dentz bt_dev_dbg(hdev, "cancelling interleave scan"); 2091e8907f76SLuiz Augusto von Dentz 2092e8907f76SLuiz Augusto von Dentz cancel_delayed_work_sync(&hdev->interleave_scan); 2093e8907f76SLuiz Augusto von Dentz 2094e8907f76SLuiz Augusto von Dentz hdev->interleave_scan_state = INTERLEAVE_SCAN_NONE; 2095e8907f76SLuiz Augusto von Dentz } 2096e8907f76SLuiz Augusto von Dentz 2097e8907f76SLuiz Augusto von Dentz /* Return true if interleave_scan wasn't started until exiting this function, 2098e8907f76SLuiz Augusto von Dentz * otherwise, return false 2099e8907f76SLuiz Augusto von Dentz */ 2100e8907f76SLuiz Augusto von Dentz static bool hci_update_interleaved_scan_sync(struct hci_dev *hdev) 2101e8907f76SLuiz Augusto von Dentz { 2102e8907f76SLuiz Augusto von Dentz /* Do interleaved scan only if all of the following are true: 2103e8907f76SLuiz Augusto von Dentz * - There is at least one ADV monitor 2104e8907f76SLuiz Augusto von Dentz * - At least one pending LE connection or one device to be scanned for 2105e8907f76SLuiz Augusto von Dentz * - Monitor offloading is not supported 2106e8907f76SLuiz Augusto von Dentz * If so, we should alternate between allowlist scan and one without 2107e8907f76SLuiz Augusto von Dentz * any filters to save power. 2108e8907f76SLuiz Augusto von Dentz */ 2109e8907f76SLuiz Augusto von Dentz bool use_interleaving = hci_is_adv_monitoring(hdev) && 2110e8907f76SLuiz Augusto von Dentz !(list_empty(&hdev->pend_le_conns) && 2111e8907f76SLuiz Augusto von Dentz list_empty(&hdev->pend_le_reports)) && 2112e8907f76SLuiz Augusto von Dentz hci_get_adv_monitor_offload_ext(hdev) == 2113e8907f76SLuiz Augusto von Dentz HCI_ADV_MONITOR_EXT_NONE; 2114e8907f76SLuiz Augusto von Dentz bool is_interleaving = is_interleave_scanning(hdev); 2115e8907f76SLuiz Augusto von Dentz 2116e8907f76SLuiz Augusto von Dentz if (use_interleaving && !is_interleaving) { 2117e8907f76SLuiz Augusto von Dentz hci_start_interleave_scan(hdev); 2118e8907f76SLuiz Augusto von Dentz bt_dev_dbg(hdev, "starting interleave scan"); 2119e8907f76SLuiz Augusto von Dentz return true; 2120e8907f76SLuiz Augusto von Dentz } 2121e8907f76SLuiz Augusto von Dentz 2122e8907f76SLuiz Augusto von Dentz if (!use_interleaving && is_interleaving) 2123e8907f76SLuiz Augusto von Dentz cancel_interleave_scan(hdev); 2124e8907f76SLuiz Augusto von Dentz 2125e8907f76SLuiz Augusto von Dentz return false; 2126e8907f76SLuiz Augusto von Dentz } 2127e8907f76SLuiz Augusto von Dentz 2128e8907f76SLuiz Augusto von Dentz /* Removes connection to resolve list if needed.*/ 2129e8907f76SLuiz Augusto von Dentz static int hci_le_del_resolve_list_sync(struct hci_dev *hdev, 2130e8907f76SLuiz Augusto von Dentz bdaddr_t *bdaddr, u8 bdaddr_type) 2131e8907f76SLuiz Augusto von Dentz { 2132e8907f76SLuiz Augusto von Dentz struct hci_cp_le_del_from_resolv_list cp; 2133e8907f76SLuiz Augusto von Dentz struct bdaddr_list_with_irk *entry; 2134e8907f76SLuiz Augusto von Dentz 2135ad383c2cSLuiz Augusto von Dentz if (!use_ll_privacy(hdev)) 2136e8907f76SLuiz Augusto von Dentz return 0; 2137e8907f76SLuiz Augusto von Dentz 2138e8907f76SLuiz Augusto von Dentz /* Check if the IRK has been programmed */ 2139e8907f76SLuiz Augusto von Dentz entry = hci_bdaddr_list_lookup_with_irk(&hdev->le_resolv_list, bdaddr, 2140e8907f76SLuiz Augusto von Dentz bdaddr_type); 2141e8907f76SLuiz Augusto von Dentz if (!entry) 2142e8907f76SLuiz Augusto von Dentz return 0; 2143e8907f76SLuiz Augusto von Dentz 2144e8907f76SLuiz Augusto von Dentz cp.bdaddr_type = bdaddr_type; 2145e8907f76SLuiz Augusto von Dentz bacpy(&cp.bdaddr, bdaddr); 2146e8907f76SLuiz Augusto von Dentz 2147e8907f76SLuiz Augusto von Dentz return __hci_cmd_sync_status(hdev, HCI_OP_LE_DEL_FROM_RESOLV_LIST, 2148e8907f76SLuiz Augusto von Dentz sizeof(cp), &cp, HCI_CMD_TIMEOUT); 2149e8907f76SLuiz Augusto von Dentz } 2150e8907f76SLuiz Augusto von Dentz 2151e8907f76SLuiz Augusto von Dentz static int hci_le_del_accept_list_sync(struct hci_dev *hdev, 2152e8907f76SLuiz Augusto von Dentz bdaddr_t *bdaddr, u8 bdaddr_type) 2153e8907f76SLuiz Augusto von Dentz { 2154e8907f76SLuiz Augusto von Dentz struct hci_cp_le_del_from_accept_list cp; 2155e8907f76SLuiz Augusto von Dentz int err; 2156e8907f76SLuiz Augusto von Dentz 2157e8907f76SLuiz Augusto von Dentz /* Check if device is on accept list before removing it */ 2158e8907f76SLuiz Augusto von Dentz if (!hci_bdaddr_list_lookup(&hdev->le_accept_list, bdaddr, bdaddr_type)) 2159e8907f76SLuiz Augusto von Dentz return 0; 2160e8907f76SLuiz Augusto von Dentz 2161e8907f76SLuiz Augusto von Dentz cp.bdaddr_type = bdaddr_type; 2162e8907f76SLuiz Augusto von Dentz bacpy(&cp.bdaddr, bdaddr); 2163e8907f76SLuiz Augusto von Dentz 2164ad383c2cSLuiz Augusto von Dentz /* Ignore errors when removing from resolving list as that is likely 2165ad383c2cSLuiz Augusto von Dentz * that the device was never added. 2166ad383c2cSLuiz Augusto von Dentz */ 2167ad383c2cSLuiz Augusto von Dentz hci_le_del_resolve_list_sync(hdev, &cp.bdaddr, cp.bdaddr_type); 2168ad383c2cSLuiz Augusto von Dentz 2169e8907f76SLuiz Augusto von Dentz err = __hci_cmd_sync_status(hdev, HCI_OP_LE_DEL_FROM_ACCEPT_LIST, 2170e8907f76SLuiz Augusto von Dentz sizeof(cp), &cp, HCI_CMD_TIMEOUT); 2171e8907f76SLuiz Augusto von Dentz if (err) { 2172e8907f76SLuiz Augusto von Dentz bt_dev_err(hdev, "Unable to remove from allow list: %d", err); 2173e8907f76SLuiz Augusto von Dentz return err; 2174e8907f76SLuiz Augusto von Dentz } 2175e8907f76SLuiz Augusto von Dentz 2176e8907f76SLuiz Augusto von Dentz bt_dev_dbg(hdev, "Remove %pMR (0x%x) from allow list", &cp.bdaddr, 2177e8907f76SLuiz Augusto von Dentz cp.bdaddr_type); 2178e8907f76SLuiz Augusto von Dentz 2179ad383c2cSLuiz Augusto von Dentz return 0; 2180e8907f76SLuiz Augusto von Dentz } 2181e8907f76SLuiz Augusto von Dentz 2182195ef75eSPauli Virtanen struct conn_params { 2183195ef75eSPauli Virtanen bdaddr_t addr; 2184195ef75eSPauli Virtanen u8 addr_type; 2185195ef75eSPauli Virtanen hci_conn_flags_t flags; 2186195ef75eSPauli Virtanen u8 privacy_mode; 2187195ef75eSPauli Virtanen }; 2188195ef75eSPauli Virtanen 2189cf75ad8bSLuiz Augusto von Dentz /* Adds connection to resolve list if needed. 2190cf75ad8bSLuiz Augusto von Dentz * Setting params to NULL programs local hdev->irk 2191cf75ad8bSLuiz Augusto von Dentz */ 2192e8907f76SLuiz Augusto von Dentz static int hci_le_add_resolve_list_sync(struct hci_dev *hdev, 2193195ef75eSPauli Virtanen struct conn_params *params) 2194e8907f76SLuiz Augusto von Dentz { 2195e8907f76SLuiz Augusto von Dentz struct hci_cp_le_add_to_resolv_list cp; 2196e8907f76SLuiz Augusto von Dentz struct smp_irk *irk; 2197e8907f76SLuiz Augusto von Dentz struct bdaddr_list_with_irk *entry; 2198195ef75eSPauli Virtanen struct hci_conn_params *p; 2199e8907f76SLuiz Augusto von Dentz 2200ad383c2cSLuiz Augusto von Dentz if (!use_ll_privacy(hdev)) 2201e8907f76SLuiz Augusto von Dentz return 0; 2202e8907f76SLuiz Augusto von Dentz 2203cf75ad8bSLuiz Augusto von Dentz /* Attempt to program local identity address, type and irk if params is 2204cf75ad8bSLuiz Augusto von Dentz * NULL. 2205cf75ad8bSLuiz Augusto von Dentz */ 2206cf75ad8bSLuiz Augusto von Dentz if (!params) { 2207cf75ad8bSLuiz Augusto von Dentz if (!hci_dev_test_flag(hdev, HCI_PRIVACY)) 2208cf75ad8bSLuiz Augusto von Dentz return 0; 2209cf75ad8bSLuiz Augusto von Dentz 2210cf75ad8bSLuiz Augusto von Dentz hci_copy_identity_address(hdev, &cp.bdaddr, &cp.bdaddr_type); 2211cf75ad8bSLuiz Augusto von Dentz memcpy(cp.peer_irk, hdev->irk, 16); 2212cf75ad8bSLuiz Augusto von Dentz goto done; 2213cf75ad8bSLuiz Augusto von Dentz } 2214cf75ad8bSLuiz Augusto von Dentz 2215e8907f76SLuiz Augusto von Dentz irk = hci_find_irk_by_addr(hdev, ¶ms->addr, params->addr_type); 2216e8907f76SLuiz Augusto von Dentz if (!irk) 2217e8907f76SLuiz Augusto von Dentz return 0; 2218e8907f76SLuiz Augusto von Dentz 2219e8907f76SLuiz Augusto von Dentz /* Check if the IK has _not_ been programmed yet. */ 2220e8907f76SLuiz Augusto von Dentz entry = hci_bdaddr_list_lookup_with_irk(&hdev->le_resolv_list, 2221e8907f76SLuiz Augusto von Dentz ¶ms->addr, 2222e8907f76SLuiz Augusto von Dentz params->addr_type); 2223e8907f76SLuiz Augusto von Dentz if (entry) 2224e8907f76SLuiz Augusto von Dentz return 0; 2225e8907f76SLuiz Augusto von Dentz 2226e8907f76SLuiz Augusto von Dentz cp.bdaddr_type = params->addr_type; 2227e8907f76SLuiz Augusto von Dentz bacpy(&cp.bdaddr, ¶ms->addr); 2228e8907f76SLuiz Augusto von Dentz memcpy(cp.peer_irk, irk->val, 16); 2229e8907f76SLuiz Augusto von Dentz 22300900b1c6SLuiz Augusto von Dentz /* Default privacy mode is always Network */ 22310900b1c6SLuiz Augusto von Dentz params->privacy_mode = HCI_NETWORK_PRIVACY; 22320900b1c6SLuiz Augusto von Dentz 2233195ef75eSPauli Virtanen rcu_read_lock(); 2234195ef75eSPauli Virtanen p = hci_pend_le_action_lookup(&hdev->pend_le_conns, 2235195ef75eSPauli Virtanen ¶ms->addr, params->addr_type); 2236195ef75eSPauli Virtanen if (!p) 2237195ef75eSPauli Virtanen p = hci_pend_le_action_lookup(&hdev->pend_le_reports, 2238195ef75eSPauli Virtanen ¶ms->addr, params->addr_type); 2239195ef75eSPauli Virtanen if (p) 2240195ef75eSPauli Virtanen WRITE_ONCE(p->privacy_mode, HCI_NETWORK_PRIVACY); 2241195ef75eSPauli Virtanen rcu_read_unlock(); 2242195ef75eSPauli Virtanen 2243cf75ad8bSLuiz Augusto von Dentz done: 2244e8907f76SLuiz Augusto von Dentz if (hci_dev_test_flag(hdev, HCI_PRIVACY)) 2245e8907f76SLuiz Augusto von Dentz memcpy(cp.local_irk, hdev->irk, 16); 2246e8907f76SLuiz Augusto von Dentz else 2247e8907f76SLuiz Augusto von Dentz memset(cp.local_irk, 0, 16); 2248e8907f76SLuiz Augusto von Dentz 2249e8907f76SLuiz Augusto von Dentz return __hci_cmd_sync_status(hdev, HCI_OP_LE_ADD_TO_RESOLV_LIST, 2250e8907f76SLuiz Augusto von Dentz sizeof(cp), &cp, HCI_CMD_TIMEOUT); 2251e8907f76SLuiz Augusto von Dentz } 2252e8907f76SLuiz Augusto von Dentz 2253853b70b5SLuiz Augusto von Dentz /* Set Device Privacy Mode. */ 2254853b70b5SLuiz Augusto von Dentz static int hci_le_set_privacy_mode_sync(struct hci_dev *hdev, 2255195ef75eSPauli Virtanen struct conn_params *params) 2256853b70b5SLuiz Augusto von Dentz { 2257853b70b5SLuiz Augusto von Dentz struct hci_cp_le_set_privacy_mode cp; 2258853b70b5SLuiz Augusto von Dentz struct smp_irk *irk; 2259853b70b5SLuiz Augusto von Dentz 2260853b70b5SLuiz Augusto von Dentz /* If device privacy mode has already been set there is nothing to do */ 2261853b70b5SLuiz Augusto von Dentz if (params->privacy_mode == HCI_DEVICE_PRIVACY) 2262853b70b5SLuiz Augusto von Dentz return 0; 2263853b70b5SLuiz Augusto von Dentz 2264853b70b5SLuiz Augusto von Dentz /* Check if HCI_CONN_FLAG_DEVICE_PRIVACY has been set as it also 2265853b70b5SLuiz Augusto von Dentz * indicates that LL Privacy has been enabled and 2266853b70b5SLuiz Augusto von Dentz * HCI_OP_LE_SET_PRIVACY_MODE is supported. 2267853b70b5SLuiz Augusto von Dentz */ 2268e1cff700SLinus Torvalds if (!(params->flags & HCI_CONN_FLAG_DEVICE_PRIVACY)) 2269853b70b5SLuiz Augusto von Dentz return 0; 2270853b70b5SLuiz Augusto von Dentz 2271853b70b5SLuiz Augusto von Dentz irk = hci_find_irk_by_addr(hdev, ¶ms->addr, params->addr_type); 2272853b70b5SLuiz Augusto von Dentz if (!irk) 2273853b70b5SLuiz Augusto von Dentz return 0; 2274853b70b5SLuiz Augusto von Dentz 2275853b70b5SLuiz Augusto von Dentz memset(&cp, 0, sizeof(cp)); 2276853b70b5SLuiz Augusto von Dentz cp.bdaddr_type = irk->addr_type; 2277853b70b5SLuiz Augusto von Dentz bacpy(&cp.bdaddr, &irk->bdaddr); 2278853b70b5SLuiz Augusto von Dentz cp.mode = HCI_DEVICE_PRIVACY; 2279853b70b5SLuiz Augusto von Dentz 2280195ef75eSPauli Virtanen /* Note: params->privacy_mode is not updated since it is a copy */ 2281195ef75eSPauli Virtanen 2282853b70b5SLuiz Augusto von Dentz return __hci_cmd_sync_status(hdev, HCI_OP_LE_SET_PRIVACY_MODE, 2283853b70b5SLuiz Augusto von Dentz sizeof(cp), &cp, HCI_CMD_TIMEOUT); 2284853b70b5SLuiz Augusto von Dentz } 2285853b70b5SLuiz Augusto von Dentz 2286e8907f76SLuiz Augusto von Dentz /* Adds connection to allow list if needed, if the device uses RPA (has IRK) 2287853b70b5SLuiz Augusto von Dentz * this attempts to program the device in the resolving list as well and 2288853b70b5SLuiz Augusto von Dentz * properly set the privacy mode. 2289e8907f76SLuiz Augusto von Dentz */ 2290e8907f76SLuiz Augusto von Dentz static int hci_le_add_accept_list_sync(struct hci_dev *hdev, 2291195ef75eSPauli Virtanen struct conn_params *params, 2292ad383c2cSLuiz Augusto von Dentz u8 *num_entries) 2293e8907f76SLuiz Augusto von Dentz { 2294e8907f76SLuiz Augusto von Dentz struct hci_cp_le_add_to_accept_list cp; 2295e8907f76SLuiz Augusto von Dentz int err; 2296e8907f76SLuiz Augusto von Dentz 22973b420553SLuiz Augusto von Dentz /* During suspend, only wakeable devices can be in acceptlist */ 22983b420553SLuiz Augusto von Dentz if (hdev->suspended && 22996699d7ceSLuiz Augusto von Dentz !(params->flags & HCI_CONN_FLAG_REMOTE_WAKEUP)) { 23006699d7ceSLuiz Augusto von Dentz hci_le_del_accept_list_sync(hdev, ¶ms->addr, 23016699d7ceSLuiz Augusto von Dentz params->addr_type); 23023b420553SLuiz Augusto von Dentz return 0; 23036699d7ceSLuiz Augusto von Dentz } 23043b420553SLuiz Augusto von Dentz 2305e8907f76SLuiz Augusto von Dentz /* Select filter policy to accept all advertising */ 2306e8907f76SLuiz Augusto von Dentz if (*num_entries >= hdev->le_accept_list_size) 2307e8907f76SLuiz Augusto von Dentz return -ENOSPC; 2308e8907f76SLuiz Augusto von Dentz 2309e8907f76SLuiz Augusto von Dentz /* Accept list can not be used with RPAs */ 2310ad383c2cSLuiz Augusto von Dentz if (!use_ll_privacy(hdev) && 23113b420553SLuiz Augusto von Dentz hci_find_irk_by_addr(hdev, ¶ms->addr, params->addr_type)) 2312e8907f76SLuiz Augusto von Dentz return -EINVAL; 2313e8907f76SLuiz Augusto von Dentz 2314ad383c2cSLuiz Augusto von Dentz /* Attempt to program the device in the resolving list first to avoid 2315ad383c2cSLuiz Augusto von Dentz * having to rollback in case it fails since the resolving list is 2316ad383c2cSLuiz Augusto von Dentz * dynamic it can probably be smaller than the accept list. 2317ad383c2cSLuiz Augusto von Dentz */ 2318ad383c2cSLuiz Augusto von Dentz err = hci_le_add_resolve_list_sync(hdev, params); 2319ad383c2cSLuiz Augusto von Dentz if (err) { 2320ad383c2cSLuiz Augusto von Dentz bt_dev_err(hdev, "Unable to add to resolve list: %d", err); 2321ad383c2cSLuiz Augusto von Dentz return err; 2322ad383c2cSLuiz Augusto von Dentz } 2323ad383c2cSLuiz Augusto von Dentz 2324853b70b5SLuiz Augusto von Dentz /* Set Privacy Mode */ 2325853b70b5SLuiz Augusto von Dentz err = hci_le_set_privacy_mode_sync(hdev, params); 2326853b70b5SLuiz Augusto von Dentz if (err) { 2327853b70b5SLuiz Augusto von Dentz bt_dev_err(hdev, "Unable to set privacy mode: %d", err); 2328853b70b5SLuiz Augusto von Dentz return err; 2329853b70b5SLuiz Augusto von Dentz } 2330853b70b5SLuiz Augusto von Dentz 2331853b70b5SLuiz Augusto von Dentz /* Check if already in accept list */ 2332853b70b5SLuiz Augusto von Dentz if (hci_bdaddr_list_lookup(&hdev->le_accept_list, ¶ms->addr, 2333853b70b5SLuiz Augusto von Dentz params->addr_type)) 2334853b70b5SLuiz Augusto von Dentz return 0; 2335853b70b5SLuiz Augusto von Dentz 2336e8907f76SLuiz Augusto von Dentz *num_entries += 1; 2337e8907f76SLuiz Augusto von Dentz cp.bdaddr_type = params->addr_type; 2338e8907f76SLuiz Augusto von Dentz bacpy(&cp.bdaddr, ¶ms->addr); 2339e8907f76SLuiz Augusto von Dentz 2340e8907f76SLuiz Augusto von Dentz err = __hci_cmd_sync_status(hdev, HCI_OP_LE_ADD_TO_ACCEPT_LIST, 2341e8907f76SLuiz Augusto von Dentz sizeof(cp), &cp, HCI_CMD_TIMEOUT); 2342e8907f76SLuiz Augusto von Dentz if (err) { 2343e8907f76SLuiz Augusto von Dentz bt_dev_err(hdev, "Unable to add to allow list: %d", err); 2344ad383c2cSLuiz Augusto von Dentz /* Rollback the device from the resolving list */ 2345ad383c2cSLuiz Augusto von Dentz hci_le_del_resolve_list_sync(hdev, &cp.bdaddr, cp.bdaddr_type); 2346e8907f76SLuiz Augusto von Dentz return err; 2347e8907f76SLuiz Augusto von Dentz } 2348e8907f76SLuiz Augusto von Dentz 2349e8907f76SLuiz Augusto von Dentz bt_dev_dbg(hdev, "Add %pMR (0x%x) to allow list", &cp.bdaddr, 2350e8907f76SLuiz Augusto von Dentz cp.bdaddr_type); 2351e8907f76SLuiz Augusto von Dentz 2352ad383c2cSLuiz Augusto von Dentz return 0; 2353e8907f76SLuiz Augusto von Dentz } 2354e8907f76SLuiz Augusto von Dentz 2355182ee45dSLuiz Augusto von Dentz /* This function disables/pause all advertising instances */ 2356ad383c2cSLuiz Augusto von Dentz static int hci_pause_advertising_sync(struct hci_dev *hdev) 2357ad383c2cSLuiz Augusto von Dentz { 2358ad383c2cSLuiz Augusto von Dentz int err; 2359182ee45dSLuiz Augusto von Dentz int old_state; 2360ad383c2cSLuiz Augusto von Dentz 23619446bddeSLuiz Augusto von Dentz /* If already been paused there is nothing to do. */ 23629446bddeSLuiz Augusto von Dentz if (hdev->advertising_paused) 2363ad383c2cSLuiz Augusto von Dentz return 0; 2364ad383c2cSLuiz Augusto von Dentz 2365182ee45dSLuiz Augusto von Dentz bt_dev_dbg(hdev, "Pausing directed advertising"); 2366182ee45dSLuiz Augusto von Dentz 2367182ee45dSLuiz Augusto von Dentz /* Stop directed advertising */ 2368182ee45dSLuiz Augusto von Dentz old_state = hci_dev_test_flag(hdev, HCI_ADVERTISING); 2369182ee45dSLuiz Augusto von Dentz if (old_state) { 2370182ee45dSLuiz Augusto von Dentz /* When discoverable timeout triggers, then just make sure 2371182ee45dSLuiz Augusto von Dentz * the limited discoverable flag is cleared. Even in the case 2372182ee45dSLuiz Augusto von Dentz * of a timeout triggered from general discoverable, it is 2373182ee45dSLuiz Augusto von Dentz * safe to unconditionally clear the flag. 2374182ee45dSLuiz Augusto von Dentz */ 2375182ee45dSLuiz Augusto von Dentz hci_dev_clear_flag(hdev, HCI_LIMITED_DISCOVERABLE); 2376182ee45dSLuiz Augusto von Dentz hci_dev_clear_flag(hdev, HCI_DISCOVERABLE); 2377182ee45dSLuiz Augusto von Dentz hdev->discov_timeout = 0; 2378182ee45dSLuiz Augusto von Dentz } 2379182ee45dSLuiz Augusto von Dentz 2380ad383c2cSLuiz Augusto von Dentz bt_dev_dbg(hdev, "Pausing advertising instances"); 2381ad383c2cSLuiz Augusto von Dentz 2382ad383c2cSLuiz Augusto von Dentz /* Call to disable any advertisements active on the controller. 2383ad383c2cSLuiz Augusto von Dentz * This will succeed even if no advertisements are configured. 2384ad383c2cSLuiz Augusto von Dentz */ 2385ad383c2cSLuiz Augusto von Dentz err = hci_disable_advertising_sync(hdev); 2386ad383c2cSLuiz Augusto von Dentz if (err) 2387ad383c2cSLuiz Augusto von Dentz return err; 2388ad383c2cSLuiz Augusto von Dentz 2389ad383c2cSLuiz Augusto von Dentz /* If we are using software rotation, pause the loop */ 2390ad383c2cSLuiz Augusto von Dentz if (!ext_adv_capable(hdev)) 2391ad383c2cSLuiz Augusto von Dentz cancel_adv_timeout(hdev); 2392ad383c2cSLuiz Augusto von Dentz 2393ad383c2cSLuiz Augusto von Dentz hdev->advertising_paused = true; 2394182ee45dSLuiz Augusto von Dentz hdev->advertising_old_state = old_state; 2395ad383c2cSLuiz Augusto von Dentz 2396ad383c2cSLuiz Augusto von Dentz return 0; 2397ad383c2cSLuiz Augusto von Dentz } 2398ad383c2cSLuiz Augusto von Dentz 2399182ee45dSLuiz Augusto von Dentz /* This function enables all user advertising instances */ 2400ad383c2cSLuiz Augusto von Dentz static int hci_resume_advertising_sync(struct hci_dev *hdev) 2401ad383c2cSLuiz Augusto von Dentz { 2402ad383c2cSLuiz Augusto von Dentz struct adv_info *adv, *tmp; 2403ad383c2cSLuiz Augusto von Dentz int err; 2404ad383c2cSLuiz Augusto von Dentz 2405ad383c2cSLuiz Augusto von Dentz /* If advertising has not been paused there is nothing to do. */ 2406ad383c2cSLuiz Augusto von Dentz if (!hdev->advertising_paused) 2407ad383c2cSLuiz Augusto von Dentz return 0; 2408ad383c2cSLuiz Augusto von Dentz 2409182ee45dSLuiz Augusto von Dentz /* Resume directed advertising */ 2410182ee45dSLuiz Augusto von Dentz hdev->advertising_paused = false; 2411182ee45dSLuiz Augusto von Dentz if (hdev->advertising_old_state) { 2412182ee45dSLuiz Augusto von Dentz hci_dev_set_flag(hdev, HCI_ADVERTISING); 2413182ee45dSLuiz Augusto von Dentz hdev->advertising_old_state = 0; 2414182ee45dSLuiz Augusto von Dentz } 2415182ee45dSLuiz Augusto von Dentz 2416ad383c2cSLuiz Augusto von Dentz bt_dev_dbg(hdev, "Resuming advertising instances"); 2417ad383c2cSLuiz Augusto von Dentz 2418ad383c2cSLuiz Augusto von Dentz if (ext_adv_capable(hdev)) { 2419ad383c2cSLuiz Augusto von Dentz /* Call for each tracked instance to be re-enabled */ 2420ad383c2cSLuiz Augusto von Dentz list_for_each_entry_safe(adv, tmp, &hdev->adv_instances, list) { 2421ad383c2cSLuiz Augusto von Dentz err = hci_enable_ext_advertising_sync(hdev, 2422ad383c2cSLuiz Augusto von Dentz adv->instance); 2423ad383c2cSLuiz Augusto von Dentz if (!err) 2424ad383c2cSLuiz Augusto von Dentz continue; 2425ad383c2cSLuiz Augusto von Dentz 2426ad383c2cSLuiz Augusto von Dentz /* If the instance cannot be resumed remove it */ 2427ad383c2cSLuiz Augusto von Dentz hci_remove_ext_adv_instance_sync(hdev, adv->instance, 2428ad383c2cSLuiz Augusto von Dentz NULL); 2429ad383c2cSLuiz Augusto von Dentz } 2430ad383c2cSLuiz Augusto von Dentz } else { 2431ad383c2cSLuiz Augusto von Dentz /* Schedule for most recent instance to be restarted and begin 2432ad383c2cSLuiz Augusto von Dentz * the software rotation loop 2433ad383c2cSLuiz Augusto von Dentz */ 2434ad383c2cSLuiz Augusto von Dentz err = hci_schedule_adv_instance_sync(hdev, 2435ad383c2cSLuiz Augusto von Dentz hdev->cur_adv_instance, 2436ad383c2cSLuiz Augusto von Dentz true); 2437ad383c2cSLuiz Augusto von Dentz } 2438ad383c2cSLuiz Augusto von Dentz 2439ad383c2cSLuiz Augusto von Dentz hdev->advertising_paused = false; 2440ad383c2cSLuiz Augusto von Dentz 2441ad383c2cSLuiz Augusto von Dentz return err; 2442ad383c2cSLuiz Augusto von Dentz } 2443ad383c2cSLuiz Augusto von Dentz 24443c44a431SZhengping Jiang static int hci_pause_addr_resolution(struct hci_dev *hdev) 24453c44a431SZhengping Jiang { 24463c44a431SZhengping Jiang int err; 24473c44a431SZhengping Jiang 24483c44a431SZhengping Jiang if (!use_ll_privacy(hdev)) 24493c44a431SZhengping Jiang return 0; 24503c44a431SZhengping Jiang 24513c44a431SZhengping Jiang if (!hci_dev_test_flag(hdev, HCI_LL_RPA_RESOLUTION)) 24523c44a431SZhengping Jiang return 0; 24533c44a431SZhengping Jiang 24543c44a431SZhengping Jiang /* Cannot disable addr resolution if scanning is enabled or 24553c44a431SZhengping Jiang * when initiating an LE connection. 24563c44a431SZhengping Jiang */ 24573c44a431SZhengping Jiang if (hci_dev_test_flag(hdev, HCI_LE_SCAN) || 24583c44a431SZhengping Jiang hci_lookup_le_connect(hdev)) { 24593c44a431SZhengping Jiang bt_dev_err(hdev, "Command not allowed when scan/LE connect"); 24603c44a431SZhengping Jiang return -EPERM; 24613c44a431SZhengping Jiang } 24623c44a431SZhengping Jiang 24633c44a431SZhengping Jiang /* Cannot disable addr resolution if advertising is enabled. */ 24643c44a431SZhengping Jiang err = hci_pause_advertising_sync(hdev); 24653c44a431SZhengping Jiang if (err) { 24663c44a431SZhengping Jiang bt_dev_err(hdev, "Pause advertising failed: %d", err); 24673c44a431SZhengping Jiang return err; 24683c44a431SZhengping Jiang } 24693c44a431SZhengping Jiang 24703c44a431SZhengping Jiang err = hci_le_set_addr_resolution_enable_sync(hdev, 0x00); 24713c44a431SZhengping Jiang if (err) 24723c44a431SZhengping Jiang bt_dev_err(hdev, "Unable to disable Address Resolution: %d", 24733c44a431SZhengping Jiang err); 24743c44a431SZhengping Jiang 24753c44a431SZhengping Jiang /* Return if address resolution is disabled and RPA is not used. */ 24763c44a431SZhengping Jiang if (!err && scan_use_rpa(hdev)) 2477ae051b04SLuiz Augusto von Dentz return 0; 24783c44a431SZhengping Jiang 24793c44a431SZhengping Jiang hci_resume_advertising_sync(hdev); 24803c44a431SZhengping Jiang return err; 24813c44a431SZhengping Jiang } 24823c44a431SZhengping Jiang 2483f892244bSBrian Gix struct sk_buff *hci_read_local_oob_data_sync(struct hci_dev *hdev, 2484f892244bSBrian Gix bool extended, struct sock *sk) 2485f892244bSBrian Gix { 2486f892244bSBrian Gix u16 opcode = extended ? HCI_OP_READ_LOCAL_OOB_EXT_DATA : 2487f892244bSBrian Gix HCI_OP_READ_LOCAL_OOB_DATA; 2488f892244bSBrian Gix 2489f892244bSBrian Gix return __hci_cmd_sync_sk(hdev, opcode, 0, NULL, 0, HCI_CMD_TIMEOUT, sk); 2490f892244bSBrian Gix } 2491f892244bSBrian Gix 2492195ef75eSPauli Virtanen static struct conn_params *conn_params_copy(struct list_head *list, size_t *n) 2493195ef75eSPauli Virtanen { 2494195ef75eSPauli Virtanen struct hci_conn_params *params; 2495195ef75eSPauli Virtanen struct conn_params *p; 2496195ef75eSPauli Virtanen size_t i; 2497195ef75eSPauli Virtanen 2498195ef75eSPauli Virtanen rcu_read_lock(); 2499195ef75eSPauli Virtanen 2500195ef75eSPauli Virtanen i = 0; 2501195ef75eSPauli Virtanen list_for_each_entry_rcu(params, list, action) 2502195ef75eSPauli Virtanen ++i; 2503195ef75eSPauli Virtanen *n = i; 2504195ef75eSPauli Virtanen 2505195ef75eSPauli Virtanen rcu_read_unlock(); 2506195ef75eSPauli Virtanen 2507195ef75eSPauli Virtanen p = kvcalloc(*n, sizeof(struct conn_params), GFP_KERNEL); 2508195ef75eSPauli Virtanen if (!p) 2509195ef75eSPauli Virtanen return NULL; 2510195ef75eSPauli Virtanen 2511195ef75eSPauli Virtanen rcu_read_lock(); 2512195ef75eSPauli Virtanen 2513195ef75eSPauli Virtanen i = 0; 2514195ef75eSPauli Virtanen list_for_each_entry_rcu(params, list, action) { 2515195ef75eSPauli Virtanen /* Racing adds are handled in next scan update */ 2516195ef75eSPauli Virtanen if (i >= *n) 2517195ef75eSPauli Virtanen break; 2518195ef75eSPauli Virtanen 2519195ef75eSPauli Virtanen /* No hdev->lock, but: addr, addr_type are immutable. 2520195ef75eSPauli Virtanen * privacy_mode is only written by us or in 2521195ef75eSPauli Virtanen * hci_cc_le_set_privacy_mode that we wait for. 2522195ef75eSPauli Virtanen * We should be idempotent so MGMT updating flags 2523195ef75eSPauli Virtanen * while we are processing is OK. 2524195ef75eSPauli Virtanen */ 2525195ef75eSPauli Virtanen bacpy(&p[i].addr, ¶ms->addr); 2526195ef75eSPauli Virtanen p[i].addr_type = params->addr_type; 2527195ef75eSPauli Virtanen p[i].flags = READ_ONCE(params->flags); 2528195ef75eSPauli Virtanen p[i].privacy_mode = READ_ONCE(params->privacy_mode); 2529195ef75eSPauli Virtanen ++i; 2530195ef75eSPauli Virtanen } 2531195ef75eSPauli Virtanen 2532195ef75eSPauli Virtanen rcu_read_unlock(); 2533195ef75eSPauli Virtanen 2534195ef75eSPauli Virtanen *n = i; 2535195ef75eSPauli Virtanen return p; 2536195ef75eSPauli Virtanen } 2537195ef75eSPauli Virtanen 2538ad383c2cSLuiz Augusto von Dentz /* Device must not be scanning when updating the accept list. 2539ad383c2cSLuiz Augusto von Dentz * 2540ad383c2cSLuiz Augusto von Dentz * Update is done using the following sequence: 2541ad383c2cSLuiz Augusto von Dentz * 2542ad383c2cSLuiz Augusto von Dentz * use_ll_privacy((Disable Advertising) -> Disable Resolving List) -> 2543ad383c2cSLuiz Augusto von Dentz * Remove Devices From Accept List -> 2544ad383c2cSLuiz Augusto von Dentz * (has IRK && use_ll_privacy(Remove Devices From Resolving List))-> 2545ad383c2cSLuiz Augusto von Dentz * Add Devices to Accept List -> 2546ad383c2cSLuiz Augusto von Dentz * (has IRK && use_ll_privacy(Remove Devices From Resolving List)) -> 2547ad383c2cSLuiz Augusto von Dentz * use_ll_privacy(Enable Resolving List -> (Enable Advertising)) -> 2548ad383c2cSLuiz Augusto von Dentz * Enable Scanning 2549ad383c2cSLuiz Augusto von Dentz * 2550ad383c2cSLuiz Augusto von Dentz * In case of failure advertising shall be restored to its original state and 2551ad383c2cSLuiz Augusto von Dentz * return would disable accept list since either accept or resolving list could 2552ad383c2cSLuiz Augusto von Dentz * not be programmed. 2553ad383c2cSLuiz Augusto von Dentz * 2554ad383c2cSLuiz Augusto von Dentz */ 2555e8907f76SLuiz Augusto von Dentz static u8 hci_update_accept_list_sync(struct hci_dev *hdev) 2556e8907f76SLuiz Augusto von Dentz { 2557195ef75eSPauli Virtanen struct conn_params *params; 2558e8907f76SLuiz Augusto von Dentz struct bdaddr_list *b, *t; 2559e8907f76SLuiz Augusto von Dentz u8 num_entries = 0; 2560e8907f76SLuiz Augusto von Dentz bool pend_conn, pend_report; 256180740ebbSLuiz Augusto von Dentz u8 filter_policy; 2562195ef75eSPauli Virtanen size_t i, n; 2563ad383c2cSLuiz Augusto von Dentz int err; 2564e8907f76SLuiz Augusto von Dentz 25653c44a431SZhengping Jiang /* Pause advertising if resolving list can be used as controllers 2566ad383c2cSLuiz Augusto von Dentz * cannot accept resolving list modifications while advertising. 2567ad383c2cSLuiz Augusto von Dentz */ 2568ad383c2cSLuiz Augusto von Dentz if (use_ll_privacy(hdev)) { 2569ad383c2cSLuiz Augusto von Dentz err = hci_pause_advertising_sync(hdev); 2570ad383c2cSLuiz Augusto von Dentz if (err) { 2571ad383c2cSLuiz Augusto von Dentz bt_dev_err(hdev, "pause advertising failed: %d", err); 2572ad383c2cSLuiz Augusto von Dentz return 0x00; 2573ad383c2cSLuiz Augusto von Dentz } 2574ad383c2cSLuiz Augusto von Dentz } 2575ad383c2cSLuiz Augusto von Dentz 2576ad383c2cSLuiz Augusto von Dentz /* Disable address resolution while reprogramming accept list since 2577ad383c2cSLuiz Augusto von Dentz * devices that do have an IRK will be programmed in the resolving list 2578ad383c2cSLuiz Augusto von Dentz * when LL Privacy is enabled. 2579ad383c2cSLuiz Augusto von Dentz */ 2580ad383c2cSLuiz Augusto von Dentz err = hci_le_set_addr_resolution_enable_sync(hdev, 0x00); 2581ad383c2cSLuiz Augusto von Dentz if (err) { 2582ad383c2cSLuiz Augusto von Dentz bt_dev_err(hdev, "Unable to disable LL privacy: %d", err); 2583ad383c2cSLuiz Augusto von Dentz goto done; 2584ad383c2cSLuiz Augusto von Dentz } 2585e8907f76SLuiz Augusto von Dentz 2586e8907f76SLuiz Augusto von Dentz /* Go through the current accept list programmed into the 25876828b583SLuiz Augusto von Dentz * controller one by one and check if that address is connected or is 25886828b583SLuiz Augusto von Dentz * still in the list of pending connections or list of devices to 2589e8907f76SLuiz Augusto von Dentz * report. If not present in either list, then remove it from 2590e8907f76SLuiz Augusto von Dentz * the controller. 2591e8907f76SLuiz Augusto von Dentz */ 2592e8907f76SLuiz Augusto von Dentz list_for_each_entry_safe(b, t, &hdev->le_accept_list, list) { 25936828b583SLuiz Augusto von Dentz if (hci_conn_hash_lookup_le(hdev, &b->bdaddr, b->bdaddr_type)) 25946828b583SLuiz Augusto von Dentz continue; 25956828b583SLuiz Augusto von Dentz 2596195ef75eSPauli Virtanen /* Pointers not dereferenced, no locks needed */ 2597e8907f76SLuiz Augusto von Dentz pend_conn = hci_pend_le_action_lookup(&hdev->pend_le_conns, 2598e8907f76SLuiz Augusto von Dentz &b->bdaddr, 2599e8907f76SLuiz Augusto von Dentz b->bdaddr_type); 2600e8907f76SLuiz Augusto von Dentz pend_report = hci_pend_le_action_lookup(&hdev->pend_le_reports, 2601e8907f76SLuiz Augusto von Dentz &b->bdaddr, 2602e8907f76SLuiz Augusto von Dentz b->bdaddr_type); 2603e8907f76SLuiz Augusto von Dentz 2604e8907f76SLuiz Augusto von Dentz /* If the device is not likely to connect or report, 2605e8907f76SLuiz Augusto von Dentz * remove it from the acceptlist. 2606e8907f76SLuiz Augusto von Dentz */ 2607e8907f76SLuiz Augusto von Dentz if (!pend_conn && !pend_report) { 2608e8907f76SLuiz Augusto von Dentz hci_le_del_accept_list_sync(hdev, &b->bdaddr, 2609e8907f76SLuiz Augusto von Dentz b->bdaddr_type); 2610e8907f76SLuiz Augusto von Dentz continue; 2611e8907f76SLuiz Augusto von Dentz } 2612e8907f76SLuiz Augusto von Dentz 2613e8907f76SLuiz Augusto von Dentz num_entries++; 2614e8907f76SLuiz Augusto von Dentz } 2615e8907f76SLuiz Augusto von Dentz 2616e8907f76SLuiz Augusto von Dentz /* Since all no longer valid accept list entries have been 2617e8907f76SLuiz Augusto von Dentz * removed, walk through the list of pending connections 2618e8907f76SLuiz Augusto von Dentz * and ensure that any new device gets programmed into 2619e8907f76SLuiz Augusto von Dentz * the controller. 2620e8907f76SLuiz Augusto von Dentz * 2621e8907f76SLuiz Augusto von Dentz * If the list of the devices is larger than the list of 2622e8907f76SLuiz Augusto von Dentz * available accept list entries in the controller, then 2623e8907f76SLuiz Augusto von Dentz * just abort and return filer policy value to not use the 2624e8907f76SLuiz Augusto von Dentz * accept list. 2625195ef75eSPauli Virtanen * 2626195ef75eSPauli Virtanen * The list and params may be mutated while we wait for events, 2627195ef75eSPauli Virtanen * so make a copy and iterate it. 2628e8907f76SLuiz Augusto von Dentz */ 2629195ef75eSPauli Virtanen 2630195ef75eSPauli Virtanen params = conn_params_copy(&hdev->pend_le_conns, &n); 2631195ef75eSPauli Virtanen if (!params) { 2632195ef75eSPauli Virtanen err = -ENOMEM; 2633ad383c2cSLuiz Augusto von Dentz goto done; 2634e8907f76SLuiz Augusto von Dentz } 2635e8907f76SLuiz Augusto von Dentz 2636195ef75eSPauli Virtanen for (i = 0; i < n; ++i) { 2637195ef75eSPauli Virtanen err = hci_le_add_accept_list_sync(hdev, ¶ms[i], 2638195ef75eSPauli Virtanen &num_entries); 2639195ef75eSPauli Virtanen if (err) { 2640195ef75eSPauli Virtanen kvfree(params); 2641195ef75eSPauli Virtanen goto done; 2642195ef75eSPauli Virtanen } 2643195ef75eSPauli Virtanen } 2644195ef75eSPauli Virtanen 2645195ef75eSPauli Virtanen kvfree(params); 2646195ef75eSPauli Virtanen 2647e8907f76SLuiz Augusto von Dentz /* After adding all new pending connections, walk through 2648e8907f76SLuiz Augusto von Dentz * the list of pending reports and also add these to the 2649e8907f76SLuiz Augusto von Dentz * accept list if there is still space. Abort if space runs out. 2650e8907f76SLuiz Augusto von Dentz */ 2651195ef75eSPauli Virtanen 2652195ef75eSPauli Virtanen params = conn_params_copy(&hdev->pend_le_reports, &n); 2653195ef75eSPauli Virtanen if (!params) { 2654195ef75eSPauli Virtanen err = -ENOMEM; 2655ad383c2cSLuiz Augusto von Dentz goto done; 2656e8907f76SLuiz Augusto von Dentz } 2657e8907f76SLuiz Augusto von Dentz 2658195ef75eSPauli Virtanen for (i = 0; i < n; ++i) { 2659195ef75eSPauli Virtanen err = hci_le_add_accept_list_sync(hdev, ¶ms[i], 2660195ef75eSPauli Virtanen &num_entries); 2661195ef75eSPauli Virtanen if (err) { 2662195ef75eSPauli Virtanen kvfree(params); 2663195ef75eSPauli Virtanen goto done; 2664195ef75eSPauli Virtanen } 2665195ef75eSPauli Virtanen } 2666195ef75eSPauli Virtanen 2667195ef75eSPauli Virtanen kvfree(params); 2668195ef75eSPauli Virtanen 2669e8907f76SLuiz Augusto von Dentz /* Use the allowlist unless the following conditions are all true: 2670e8907f76SLuiz Augusto von Dentz * - We are not currently suspending 2671e8907f76SLuiz Augusto von Dentz * - There are 1 or more ADV monitors registered and it's not offloaded 2672e8907f76SLuiz Augusto von Dentz * - Interleaved scanning is not currently using the allowlist 2673e8907f76SLuiz Augusto von Dentz */ 2674e8907f76SLuiz Augusto von Dentz if (!idr_is_empty(&hdev->adv_monitors_idr) && !hdev->suspended && 2675e8907f76SLuiz Augusto von Dentz hci_get_adv_monitor_offload_ext(hdev) == HCI_ADV_MONITOR_EXT_NONE && 2676e8907f76SLuiz Augusto von Dentz hdev->interleave_scan_state != INTERLEAVE_SCAN_ALLOWLIST) 2677ad383c2cSLuiz Augusto von Dentz err = -EINVAL; 2678ad383c2cSLuiz Augusto von Dentz 2679ad383c2cSLuiz Augusto von Dentz done: 268080740ebbSLuiz Augusto von Dentz filter_policy = err ? 0x00 : 0x01; 268180740ebbSLuiz Augusto von Dentz 2682ad383c2cSLuiz Augusto von Dentz /* Enable address resolution when LL Privacy is enabled. */ 2683ad383c2cSLuiz Augusto von Dentz err = hci_le_set_addr_resolution_enable_sync(hdev, 0x01); 2684ad383c2cSLuiz Augusto von Dentz if (err) 2685ad383c2cSLuiz Augusto von Dentz bt_dev_err(hdev, "Unable to enable LL privacy: %d", err); 2686ad383c2cSLuiz Augusto von Dentz 2687ad383c2cSLuiz Augusto von Dentz /* Resume advertising if it was paused */ 2688ad383c2cSLuiz Augusto von Dentz if (use_ll_privacy(hdev)) 2689ad383c2cSLuiz Augusto von Dentz hci_resume_advertising_sync(hdev); 2690e8907f76SLuiz Augusto von Dentz 2691e8907f76SLuiz Augusto von Dentz /* Select filter policy to use accept list */ 269280740ebbSLuiz Augusto von Dentz return filter_policy; 2693e8907f76SLuiz Augusto von Dentz } 2694e8907f76SLuiz Augusto von Dentz 2695de3c85d3SLuiz Augusto von Dentz static void hci_le_scan_phy_params(struct hci_cp_le_scan_phy_params *cp, 2696de3c85d3SLuiz Augusto von Dentz u8 type, u16 interval, u16 window) 2697de3c85d3SLuiz Augusto von Dentz { 2698de3c85d3SLuiz Augusto von Dentz cp->type = type; 2699de3c85d3SLuiz Augusto von Dentz cp->interval = cpu_to_le16(interval); 2700de3c85d3SLuiz Augusto von Dentz cp->window = cpu_to_le16(window); 2701de3c85d3SLuiz Augusto von Dentz } 2702de3c85d3SLuiz Augusto von Dentz 2703e8907f76SLuiz Augusto von Dentz static int hci_le_set_ext_scan_param_sync(struct hci_dev *hdev, u8 type, 2704e8907f76SLuiz Augusto von Dentz u16 interval, u16 window, 2705e8907f76SLuiz Augusto von Dentz u8 own_addr_type, u8 filter_policy) 2706e8907f76SLuiz Augusto von Dentz { 2707e8907f76SLuiz Augusto von Dentz struct hci_cp_le_set_ext_scan_params *cp; 2708e8907f76SLuiz Augusto von Dentz struct hci_cp_le_scan_phy_params *phy; 2709e8907f76SLuiz Augusto von Dentz u8 data[sizeof(*cp) + sizeof(*phy) * 2]; 2710de3c85d3SLuiz Augusto von Dentz u8 num_phy = 0x00; 2711e8907f76SLuiz Augusto von Dentz 2712e8907f76SLuiz Augusto von Dentz cp = (void *)data; 2713e8907f76SLuiz Augusto von Dentz phy = (void *)cp->data; 2714e8907f76SLuiz Augusto von Dentz 2715e8907f76SLuiz Augusto von Dentz memset(data, 0, sizeof(data)); 2716e8907f76SLuiz Augusto von Dentz 2717e8907f76SLuiz Augusto von Dentz cp->own_addr_type = own_addr_type; 2718e8907f76SLuiz Augusto von Dentz cp->filter_policy = filter_policy; 2719e8907f76SLuiz Augusto von Dentz 2720de3c85d3SLuiz Augusto von Dentz /* Check if PA Sync is in progress then select the PHY based on the 2721de3c85d3SLuiz Augusto von Dentz * hci_conn.iso_qos. 2722de3c85d3SLuiz Augusto von Dentz */ 2723de3c85d3SLuiz Augusto von Dentz if (hci_dev_test_flag(hdev, HCI_PA_SYNC)) { 2724de3c85d3SLuiz Augusto von Dentz struct hci_cp_le_add_to_accept_list *sent; 2725de3c85d3SLuiz Augusto von Dentz 2726de3c85d3SLuiz Augusto von Dentz sent = hci_sent_cmd_data(hdev, HCI_OP_LE_ADD_TO_ACCEPT_LIST); 2727de3c85d3SLuiz Augusto von Dentz if (sent) { 2728de3c85d3SLuiz Augusto von Dentz struct hci_conn *conn; 2729de3c85d3SLuiz Augusto von Dentz 2730de3c85d3SLuiz Augusto von Dentz conn = hci_conn_hash_lookup_ba(hdev, ISO_LINK, 2731de3c85d3SLuiz Augusto von Dentz &sent->bdaddr); 2732de3c85d3SLuiz Augusto von Dentz if (conn) { 2733de3c85d3SLuiz Augusto von Dentz struct bt_iso_qos *qos = &conn->iso_qos; 2734de3c85d3SLuiz Augusto von Dentz 2735de3c85d3SLuiz Augusto von Dentz if (qos->bcast.in.phy & BT_ISO_PHY_1M || 2736de3c85d3SLuiz Augusto von Dentz qos->bcast.in.phy & BT_ISO_PHY_2M) { 2737de3c85d3SLuiz Augusto von Dentz cp->scanning_phys |= LE_SCAN_PHY_1M; 2738de3c85d3SLuiz Augusto von Dentz hci_le_scan_phy_params(phy, type, 2739de3c85d3SLuiz Augusto von Dentz interval, 2740de3c85d3SLuiz Augusto von Dentz window); 2741de3c85d3SLuiz Augusto von Dentz num_phy++; 2742de3c85d3SLuiz Augusto von Dentz phy++; 2743de3c85d3SLuiz Augusto von Dentz } 2744de3c85d3SLuiz Augusto von Dentz 2745de3c85d3SLuiz Augusto von Dentz if (qos->bcast.in.phy & BT_ISO_PHY_CODED) { 2746de3c85d3SLuiz Augusto von Dentz cp->scanning_phys |= LE_SCAN_PHY_CODED; 2747de3c85d3SLuiz Augusto von Dentz hci_le_scan_phy_params(phy, type, 2748cc950d58SLuiz Augusto von Dentz interval * 3, 2749cc950d58SLuiz Augusto von Dentz window * 3); 2750de3c85d3SLuiz Augusto von Dentz num_phy++; 2751de3c85d3SLuiz Augusto von Dentz phy++; 2752de3c85d3SLuiz Augusto von Dentz } 2753de3c85d3SLuiz Augusto von Dentz 2754de3c85d3SLuiz Augusto von Dentz if (num_phy) 2755de3c85d3SLuiz Augusto von Dentz goto done; 2756de3c85d3SLuiz Augusto von Dentz } 2757de3c85d3SLuiz Augusto von Dentz } 2758de3c85d3SLuiz Augusto von Dentz } 2759de3c85d3SLuiz Augusto von Dentz 2760e8907f76SLuiz Augusto von Dentz if (scan_1m(hdev) || scan_2m(hdev)) { 2761e8907f76SLuiz Augusto von Dentz cp->scanning_phys |= LE_SCAN_PHY_1M; 2762de3c85d3SLuiz Augusto von Dentz hci_le_scan_phy_params(phy, type, interval, window); 2763e8907f76SLuiz Augusto von Dentz num_phy++; 2764e8907f76SLuiz Augusto von Dentz phy++; 2765e8907f76SLuiz Augusto von Dentz } 2766e8907f76SLuiz Augusto von Dentz 2767e8907f76SLuiz Augusto von Dentz if (scan_coded(hdev)) { 2768e8907f76SLuiz Augusto von Dentz cp->scanning_phys |= LE_SCAN_PHY_CODED; 2769cc950d58SLuiz Augusto von Dentz hci_le_scan_phy_params(phy, type, interval * 3, window * 3); 2770e8907f76SLuiz Augusto von Dentz num_phy++; 2771e8907f76SLuiz Augusto von Dentz phy++; 2772e8907f76SLuiz Augusto von Dentz } 2773e8907f76SLuiz Augusto von Dentz 2774de3c85d3SLuiz Augusto von Dentz done: 2775de3c85d3SLuiz Augusto von Dentz if (!num_phy) 2776de3c85d3SLuiz Augusto von Dentz return -EINVAL; 2777de3c85d3SLuiz Augusto von Dentz 2778e8907f76SLuiz Augusto von Dentz return __hci_cmd_sync_status(hdev, HCI_OP_LE_SET_EXT_SCAN_PARAMS, 2779e8907f76SLuiz Augusto von Dentz sizeof(*cp) + sizeof(*phy) * num_phy, 2780e8907f76SLuiz Augusto von Dentz data, HCI_CMD_TIMEOUT); 2781e8907f76SLuiz Augusto von Dentz } 2782e8907f76SLuiz Augusto von Dentz 2783e8907f76SLuiz Augusto von Dentz static int hci_le_set_scan_param_sync(struct hci_dev *hdev, u8 type, 2784e8907f76SLuiz Augusto von Dentz u16 interval, u16 window, 2785e8907f76SLuiz Augusto von Dentz u8 own_addr_type, u8 filter_policy) 2786e8907f76SLuiz Augusto von Dentz { 2787e8907f76SLuiz Augusto von Dentz struct hci_cp_le_set_scan_param cp; 2788e8907f76SLuiz Augusto von Dentz 2789e8907f76SLuiz Augusto von Dentz if (use_ext_scan(hdev)) 2790e8907f76SLuiz Augusto von Dentz return hci_le_set_ext_scan_param_sync(hdev, type, interval, 2791e8907f76SLuiz Augusto von Dentz window, own_addr_type, 2792e8907f76SLuiz Augusto von Dentz filter_policy); 2793e8907f76SLuiz Augusto von Dentz 2794e8907f76SLuiz Augusto von Dentz memset(&cp, 0, sizeof(cp)); 2795e8907f76SLuiz Augusto von Dentz cp.type = type; 2796e8907f76SLuiz Augusto von Dentz cp.interval = cpu_to_le16(interval); 2797e8907f76SLuiz Augusto von Dentz cp.window = cpu_to_le16(window); 2798e8907f76SLuiz Augusto von Dentz cp.own_address_type = own_addr_type; 2799e8907f76SLuiz Augusto von Dentz cp.filter_policy = filter_policy; 2800e8907f76SLuiz Augusto von Dentz 2801e8907f76SLuiz Augusto von Dentz return __hci_cmd_sync_status(hdev, HCI_OP_LE_SET_SCAN_PARAM, 2802e8907f76SLuiz Augusto von Dentz sizeof(cp), &cp, HCI_CMD_TIMEOUT); 2803e8907f76SLuiz Augusto von Dentz } 2804e8907f76SLuiz Augusto von Dentz 2805e8907f76SLuiz Augusto von Dentz static int hci_start_scan_sync(struct hci_dev *hdev, u8 type, u16 interval, 2806abfeea47SLuiz Augusto von Dentz u16 window, u8 own_addr_type, u8 filter_policy, 2807abfeea47SLuiz Augusto von Dentz u8 filter_dup) 2808e8907f76SLuiz Augusto von Dentz { 2809e8907f76SLuiz Augusto von Dentz int err; 2810e8907f76SLuiz Augusto von Dentz 2811e8907f76SLuiz Augusto von Dentz if (hdev->scanning_paused) { 2812e8907f76SLuiz Augusto von Dentz bt_dev_dbg(hdev, "Scanning is paused for suspend"); 2813e8907f76SLuiz Augusto von Dentz return 0; 2814e8907f76SLuiz Augusto von Dentz } 2815e8907f76SLuiz Augusto von Dentz 2816e8907f76SLuiz Augusto von Dentz err = hci_le_set_scan_param_sync(hdev, type, interval, window, 2817e8907f76SLuiz Augusto von Dentz own_addr_type, filter_policy); 2818e8907f76SLuiz Augusto von Dentz if (err) 2819e8907f76SLuiz Augusto von Dentz return err; 2820e8907f76SLuiz Augusto von Dentz 2821abfeea47SLuiz Augusto von Dentz return hci_le_set_scan_enable_sync(hdev, LE_SCAN_ENABLE, filter_dup); 2822e8907f76SLuiz Augusto von Dentz } 2823e8907f76SLuiz Augusto von Dentz 282427592ca1SLuiz Augusto von Dentz static int hci_passive_scan_sync(struct hci_dev *hdev) 2825e8907f76SLuiz Augusto von Dentz { 2826e8907f76SLuiz Augusto von Dentz u8 own_addr_type; 2827e8907f76SLuiz Augusto von Dentz u8 filter_policy; 2828e8907f76SLuiz Augusto von Dentz u16 window, interval; 2829b338d917SBrian Gix u8 filter_dups = LE_SCAN_FILTER_DUP_ENABLE; 2830ad383c2cSLuiz Augusto von Dentz int err; 2831e8907f76SLuiz Augusto von Dentz 2832e8907f76SLuiz Augusto von Dentz if (hdev->scanning_paused) { 2833e8907f76SLuiz Augusto von Dentz bt_dev_dbg(hdev, "Scanning is paused for suspend"); 2834e8907f76SLuiz Augusto von Dentz return 0; 2835e8907f76SLuiz Augusto von Dentz } 2836e8907f76SLuiz Augusto von Dentz 2837ad383c2cSLuiz Augusto von Dentz err = hci_scan_disable_sync(hdev); 2838ad383c2cSLuiz Augusto von Dentz if (err) { 2839ad383c2cSLuiz Augusto von Dentz bt_dev_err(hdev, "disable scanning failed: %d", err); 2840ad383c2cSLuiz Augusto von Dentz return err; 2841ad383c2cSLuiz Augusto von Dentz } 2842ad383c2cSLuiz Augusto von Dentz 2843e8907f76SLuiz Augusto von Dentz /* Set require_privacy to false since no SCAN_REQ are send 2844e8907f76SLuiz Augusto von Dentz * during passive scanning. Not using an non-resolvable address 2845e8907f76SLuiz Augusto von Dentz * here is important so that peer devices using direct 2846e8907f76SLuiz Augusto von Dentz * advertising with our address will be correctly reported 2847e8907f76SLuiz Augusto von Dentz * by the controller. 2848e8907f76SLuiz Augusto von Dentz */ 2849e8907f76SLuiz Augusto von Dentz if (hci_update_random_address_sync(hdev, false, scan_use_rpa(hdev), 2850e8907f76SLuiz Augusto von Dentz &own_addr_type)) 2851e8907f76SLuiz Augusto von Dentz return 0; 2852e8907f76SLuiz Augusto von Dentz 2853e8907f76SLuiz Augusto von Dentz if (hdev->enable_advmon_interleave_scan && 2854e8907f76SLuiz Augusto von Dentz hci_update_interleaved_scan_sync(hdev)) 2855e8907f76SLuiz Augusto von Dentz return 0; 2856e8907f76SLuiz Augusto von Dentz 2857e8907f76SLuiz Augusto von Dentz bt_dev_dbg(hdev, "interleave state %d", hdev->interleave_scan_state); 2858ad383c2cSLuiz Augusto von Dentz 2859e8907f76SLuiz Augusto von Dentz /* Adding or removing entries from the accept list must 2860e8907f76SLuiz Augusto von Dentz * happen before enabling scanning. The controller does 2861e8907f76SLuiz Augusto von Dentz * not allow accept list modification while scanning. 2862e8907f76SLuiz Augusto von Dentz */ 2863e8907f76SLuiz Augusto von Dentz filter_policy = hci_update_accept_list_sync(hdev); 2864e8907f76SLuiz Augusto von Dentz 2865*ae8853d0SLuiz Augusto von Dentz /* If suspended and filter_policy set to 0x00 (no acceptlist) then 2866*ae8853d0SLuiz Augusto von Dentz * passive scanning cannot be started since that would require the host 2867*ae8853d0SLuiz Augusto von Dentz * to be woken up to process the reports. 2868*ae8853d0SLuiz Augusto von Dentz */ 2869*ae8853d0SLuiz Augusto von Dentz if (hdev->suspended && !filter_policy) { 2870*ae8853d0SLuiz Augusto von Dentz /* Check if accept list is empty then there is no need to scan 2871*ae8853d0SLuiz Augusto von Dentz * while suspended. 2872*ae8853d0SLuiz Augusto von Dentz */ 2873*ae8853d0SLuiz Augusto von Dentz if (list_empty(&hdev->le_accept_list)) 2874*ae8853d0SLuiz Augusto von Dentz return 0; 2875*ae8853d0SLuiz Augusto von Dentz 2876*ae8853d0SLuiz Augusto von Dentz /* If there are devices is the accept_list that means some 2877*ae8853d0SLuiz Augusto von Dentz * devices could not be programmed which in non-suspended case 2878*ae8853d0SLuiz Augusto von Dentz * means filter_policy needs to be set to 0x00 so the host needs 2879*ae8853d0SLuiz Augusto von Dentz * to filter, but since this is treating suspended case we 2880*ae8853d0SLuiz Augusto von Dentz * can ignore device needing host to filter to allow devices in 2881*ae8853d0SLuiz Augusto von Dentz * the acceptlist to be able to wakeup the system. 2882*ae8853d0SLuiz Augusto von Dentz */ 2883*ae8853d0SLuiz Augusto von Dentz filter_policy = 0x01; 2884*ae8853d0SLuiz Augusto von Dentz } 2885*ae8853d0SLuiz Augusto von Dentz 2886e8907f76SLuiz Augusto von Dentz /* When the controller is using random resolvable addresses and 2887e8907f76SLuiz Augusto von Dentz * with that having LE privacy enabled, then controllers with 2888e8907f76SLuiz Augusto von Dentz * Extended Scanner Filter Policies support can now enable support 2889e8907f76SLuiz Augusto von Dentz * for handling directed advertising. 2890e8907f76SLuiz Augusto von Dentz * 2891e8907f76SLuiz Augusto von Dentz * So instead of using filter polices 0x00 (no acceptlist) 2892e8907f76SLuiz Augusto von Dentz * and 0x01 (acceptlist enabled) use the new filter policies 2893e8907f76SLuiz Augusto von Dentz * 0x02 (no acceptlist) and 0x03 (acceptlist enabled). 2894e8907f76SLuiz Augusto von Dentz */ 2895e8907f76SLuiz Augusto von Dentz if (hci_dev_test_flag(hdev, HCI_PRIVACY) && 2896e8907f76SLuiz Augusto von Dentz (hdev->le_features[0] & HCI_LE_EXT_SCAN_POLICY)) 2897e8907f76SLuiz Augusto von Dentz filter_policy |= 0x02; 2898e8907f76SLuiz Augusto von Dentz 2899e8907f76SLuiz Augusto von Dentz if (hdev->suspended) { 2900e8907f76SLuiz Augusto von Dentz window = hdev->le_scan_window_suspend; 2901e8907f76SLuiz Augusto von Dentz interval = hdev->le_scan_int_suspend; 2902e8907f76SLuiz Augusto von Dentz } else if (hci_is_le_conn_scanning(hdev)) { 2903e8907f76SLuiz Augusto von Dentz window = hdev->le_scan_window_connect; 2904e8907f76SLuiz Augusto von Dentz interval = hdev->le_scan_int_connect; 2905e8907f76SLuiz Augusto von Dentz } else if (hci_is_adv_monitoring(hdev)) { 2906e8907f76SLuiz Augusto von Dentz window = hdev->le_scan_window_adv_monitor; 2907e8907f76SLuiz Augusto von Dentz interval = hdev->le_scan_int_adv_monitor; 2908e8907f76SLuiz Augusto von Dentz } else { 2909e8907f76SLuiz Augusto von Dentz window = hdev->le_scan_window; 2910e8907f76SLuiz Augusto von Dentz interval = hdev->le_scan_interval; 2911e8907f76SLuiz Augusto von Dentz } 2912e8907f76SLuiz Augusto von Dentz 2913b338d917SBrian Gix /* Disable all filtering for Mesh */ 2914b338d917SBrian Gix if (hci_dev_test_flag(hdev, HCI_MESH)) { 2915b338d917SBrian Gix filter_policy = 0; 2916b338d917SBrian Gix filter_dups = LE_SCAN_FILTER_DUP_DISABLE; 2917b338d917SBrian Gix } 2918b338d917SBrian Gix 2919e8907f76SLuiz Augusto von Dentz bt_dev_dbg(hdev, "LE passive scan with acceptlist = %d", filter_policy); 2920e8907f76SLuiz Augusto von Dentz 2921e8907f76SLuiz Augusto von Dentz return hci_start_scan_sync(hdev, LE_SCAN_PASSIVE, interval, window, 2922b338d917SBrian Gix own_addr_type, filter_policy, filter_dups); 2923e8907f76SLuiz Augusto von Dentz } 2924e8907f76SLuiz Augusto von Dentz 2925e8907f76SLuiz Augusto von Dentz /* This function controls the passive scanning based on hdev->pend_le_conns 2926e8907f76SLuiz Augusto von Dentz * list. If there are pending LE connection we start the background scanning, 2927ad383c2cSLuiz Augusto von Dentz * otherwise we stop it in the following sequence: 2928ad383c2cSLuiz Augusto von Dentz * 2929ad383c2cSLuiz Augusto von Dentz * If there are devices to scan: 2930ad383c2cSLuiz Augusto von Dentz * 2931ad383c2cSLuiz Augusto von Dentz * Disable Scanning -> Update Accept List -> 2932ad383c2cSLuiz Augusto von Dentz * use_ll_privacy((Disable Advertising) -> Disable Resolving List -> 2933ad383c2cSLuiz Augusto von Dentz * Update Resolving List -> Enable Resolving List -> (Enable Advertising)) -> 2934ad383c2cSLuiz Augusto von Dentz * Enable Scanning 2935ad383c2cSLuiz Augusto von Dentz * 2936ad383c2cSLuiz Augusto von Dentz * Otherwise: 2937ad383c2cSLuiz Augusto von Dentz * 2938ad383c2cSLuiz Augusto von Dentz * Disable Scanning 2939e8907f76SLuiz Augusto von Dentz */ 2940e8907f76SLuiz Augusto von Dentz int hci_update_passive_scan_sync(struct hci_dev *hdev) 2941e8907f76SLuiz Augusto von Dentz { 2942e8907f76SLuiz Augusto von Dentz int err; 2943e8907f76SLuiz Augusto von Dentz 2944e8907f76SLuiz Augusto von Dentz if (!test_bit(HCI_UP, &hdev->flags) || 2945e8907f76SLuiz Augusto von Dentz test_bit(HCI_INIT, &hdev->flags) || 2946e8907f76SLuiz Augusto von Dentz hci_dev_test_flag(hdev, HCI_SETUP) || 2947e8907f76SLuiz Augusto von Dentz hci_dev_test_flag(hdev, HCI_CONFIG) || 2948e8907f76SLuiz Augusto von Dentz hci_dev_test_flag(hdev, HCI_AUTO_OFF) || 2949e8907f76SLuiz Augusto von Dentz hci_dev_test_flag(hdev, HCI_UNREGISTER)) 2950e8907f76SLuiz Augusto von Dentz return 0; 2951e8907f76SLuiz Augusto von Dentz 2952e8907f76SLuiz Augusto von Dentz /* No point in doing scanning if LE support hasn't been enabled */ 2953e8907f76SLuiz Augusto von Dentz if (!hci_dev_test_flag(hdev, HCI_LE_ENABLED)) 2954e8907f76SLuiz Augusto von Dentz return 0; 2955e8907f76SLuiz Augusto von Dentz 2956e8907f76SLuiz Augusto von Dentz /* If discovery is active don't interfere with it */ 2957e8907f76SLuiz Augusto von Dentz if (hdev->discovery.state != DISCOVERY_STOPPED) 2958e8907f76SLuiz Augusto von Dentz return 0; 2959e8907f76SLuiz Augusto von Dentz 2960e8907f76SLuiz Augusto von Dentz /* Reset RSSI and UUID filters when starting background scanning 2961e8907f76SLuiz Augusto von Dentz * since these filters are meant for service discovery only. 2962e8907f76SLuiz Augusto von Dentz * 2963e8907f76SLuiz Augusto von Dentz * The Start Discovery and Start Service Discovery operations 2964e8907f76SLuiz Augusto von Dentz * ensure to set proper values for RSSI threshold and UUID 2965e8907f76SLuiz Augusto von Dentz * filter list. So it is safe to just reset them here. 2966e8907f76SLuiz Augusto von Dentz */ 2967e8907f76SLuiz Augusto von Dentz hci_discovery_filter_clear(hdev); 2968e8907f76SLuiz Augusto von Dentz 2969e8907f76SLuiz Augusto von Dentz bt_dev_dbg(hdev, "ADV monitoring is %s", 2970e8907f76SLuiz Augusto von Dentz hci_is_adv_monitoring(hdev) ? "on" : "off"); 2971e8907f76SLuiz Augusto von Dentz 2972b338d917SBrian Gix if (!hci_dev_test_flag(hdev, HCI_MESH) && 2973b338d917SBrian Gix list_empty(&hdev->pend_le_conns) && 2974e8907f76SLuiz Augusto von Dentz list_empty(&hdev->pend_le_reports) && 2975eca0ae4aSLuiz Augusto von Dentz !hci_is_adv_monitoring(hdev) && 2976eca0ae4aSLuiz Augusto von Dentz !hci_dev_test_flag(hdev, HCI_PA_SYNC)) { 2977e8907f76SLuiz Augusto von Dentz /* If there is no pending LE connections or devices 2978e8907f76SLuiz Augusto von Dentz * to be scanned for or no ADV monitors, we should stop the 2979e8907f76SLuiz Augusto von Dentz * background scanning. 2980e8907f76SLuiz Augusto von Dentz */ 2981e8907f76SLuiz Augusto von Dentz 2982e8907f76SLuiz Augusto von Dentz bt_dev_dbg(hdev, "stopping background scanning"); 2983e8907f76SLuiz Augusto von Dentz 2984ad383c2cSLuiz Augusto von Dentz err = hci_scan_disable_sync(hdev); 2985e8907f76SLuiz Augusto von Dentz if (err) 2986e8907f76SLuiz Augusto von Dentz bt_dev_err(hdev, "stop background scanning failed: %d", 2987e8907f76SLuiz Augusto von Dentz err); 2988e8907f76SLuiz Augusto von Dentz } else { 2989e8907f76SLuiz Augusto von Dentz /* If there is at least one pending LE connection, we should 2990e8907f76SLuiz Augusto von Dentz * keep the background scan running. 2991e8907f76SLuiz Augusto von Dentz */ 2992e8907f76SLuiz Augusto von Dentz 2993e8907f76SLuiz Augusto von Dentz /* If controller is connecting, we should not start scanning 2994e8907f76SLuiz Augusto von Dentz * since some controllers are not able to scan and connect at 2995e8907f76SLuiz Augusto von Dentz * the same time. 2996e8907f76SLuiz Augusto von Dentz */ 2997e8907f76SLuiz Augusto von Dentz if (hci_lookup_le_connect(hdev)) 2998e8907f76SLuiz Augusto von Dentz return 0; 2999e8907f76SLuiz Augusto von Dentz 3000e8907f76SLuiz Augusto von Dentz bt_dev_dbg(hdev, "start background scanning"); 3001e8907f76SLuiz Augusto von Dentz 3002e8907f76SLuiz Augusto von Dentz err = hci_passive_scan_sync(hdev); 3003e8907f76SLuiz Augusto von Dentz if (err) 3004e8907f76SLuiz Augusto von Dentz bt_dev_err(hdev, "start background scanning failed: %d", 3005e8907f76SLuiz Augusto von Dentz err); 3006e8907f76SLuiz Augusto von Dentz } 3007e8907f76SLuiz Augusto von Dentz 3008e8907f76SLuiz Augusto von Dentz return err; 3009e8907f76SLuiz Augusto von Dentz } 3010ad383c2cSLuiz Augusto von Dentz 3011bb876725SBrian Gix static int update_scan_sync(struct hci_dev *hdev, void *data) 3012bb876725SBrian Gix { 3013bb876725SBrian Gix return hci_update_scan_sync(hdev); 3014bb876725SBrian Gix } 3015bb876725SBrian Gix 3016bb876725SBrian Gix int hci_update_scan(struct hci_dev *hdev) 3017bb876725SBrian Gix { 3018bb876725SBrian Gix return hci_cmd_sync_queue(hdev, update_scan_sync, NULL, NULL); 3019bb876725SBrian Gix } 3020bb876725SBrian Gix 3021ad383c2cSLuiz Augusto von Dentz static int update_passive_scan_sync(struct hci_dev *hdev, void *data) 3022ad383c2cSLuiz Augusto von Dentz { 3023ad383c2cSLuiz Augusto von Dentz return hci_update_passive_scan_sync(hdev); 3024ad383c2cSLuiz Augusto von Dentz } 3025ad383c2cSLuiz Augusto von Dentz 3026ad383c2cSLuiz Augusto von Dentz int hci_update_passive_scan(struct hci_dev *hdev) 3027ad383c2cSLuiz Augusto von Dentz { 30285bee2fd6SLuiz Augusto von Dentz /* Only queue if it would have any effect */ 30295bee2fd6SLuiz Augusto von Dentz if (!test_bit(HCI_UP, &hdev->flags) || 30305bee2fd6SLuiz Augusto von Dentz test_bit(HCI_INIT, &hdev->flags) || 30315bee2fd6SLuiz Augusto von Dentz hci_dev_test_flag(hdev, HCI_SETUP) || 30325bee2fd6SLuiz Augusto von Dentz hci_dev_test_flag(hdev, HCI_CONFIG) || 30335bee2fd6SLuiz Augusto von Dentz hci_dev_test_flag(hdev, HCI_AUTO_OFF) || 30345bee2fd6SLuiz Augusto von Dentz hci_dev_test_flag(hdev, HCI_UNREGISTER)) 30355bee2fd6SLuiz Augusto von Dentz return 0; 30365bee2fd6SLuiz Augusto von Dentz 3037ad383c2cSLuiz Augusto von Dentz return hci_cmd_sync_queue(hdev, update_passive_scan_sync, NULL, NULL); 3038ad383c2cSLuiz Augusto von Dentz } 3039cf75ad8bSLuiz Augusto von Dentz 30402f2eb0c9SBrian Gix int hci_write_sc_support_sync(struct hci_dev *hdev, u8 val) 3041cf75ad8bSLuiz Augusto von Dentz { 30422f2eb0c9SBrian Gix int err; 30432f2eb0c9SBrian Gix 3044cf75ad8bSLuiz Augusto von Dentz if (!bredr_sc_enabled(hdev) || lmp_host_sc_capable(hdev)) 3045cf75ad8bSLuiz Augusto von Dentz return 0; 3046cf75ad8bSLuiz Augusto von Dentz 30472f2eb0c9SBrian Gix err = __hci_cmd_sync_status(hdev, HCI_OP_WRITE_SC_SUPPORT, 3048cf75ad8bSLuiz Augusto von Dentz sizeof(val), &val, HCI_CMD_TIMEOUT); 30492f2eb0c9SBrian Gix 30502f2eb0c9SBrian Gix if (!err) { 30512f2eb0c9SBrian Gix if (val) { 30522f2eb0c9SBrian Gix hdev->features[1][0] |= LMP_HOST_SC; 30532f2eb0c9SBrian Gix hci_dev_set_flag(hdev, HCI_SC_ENABLED); 30542f2eb0c9SBrian Gix } else { 30552f2eb0c9SBrian Gix hdev->features[1][0] &= ~LMP_HOST_SC; 30562f2eb0c9SBrian Gix hci_dev_clear_flag(hdev, HCI_SC_ENABLED); 30572f2eb0c9SBrian Gix } 30582f2eb0c9SBrian Gix } 30592f2eb0c9SBrian Gix 30602f2eb0c9SBrian Gix return err; 3061cf75ad8bSLuiz Augusto von Dentz } 3062cf75ad8bSLuiz Augusto von Dentz 30633244845cSBrian Gix int hci_write_ssp_mode_sync(struct hci_dev *hdev, u8 mode) 3064cf75ad8bSLuiz Augusto von Dentz { 3065cf75ad8bSLuiz Augusto von Dentz int err; 3066cf75ad8bSLuiz Augusto von Dentz 3067cf75ad8bSLuiz Augusto von Dentz if (!hci_dev_test_flag(hdev, HCI_SSP_ENABLED) || 3068cf75ad8bSLuiz Augusto von Dentz lmp_host_ssp_capable(hdev)) 3069cf75ad8bSLuiz Augusto von Dentz return 0; 3070cf75ad8bSLuiz Augusto von Dentz 30713244845cSBrian Gix if (!mode && hci_dev_test_flag(hdev, HCI_USE_DEBUG_KEYS)) { 30723244845cSBrian Gix __hci_cmd_sync_status(hdev, HCI_OP_WRITE_SSP_DEBUG_MODE, 30733244845cSBrian Gix sizeof(mode), &mode, HCI_CMD_TIMEOUT); 30743244845cSBrian Gix } 30753244845cSBrian Gix 3076cf75ad8bSLuiz Augusto von Dentz err = __hci_cmd_sync_status(hdev, HCI_OP_WRITE_SSP_MODE, 3077cf75ad8bSLuiz Augusto von Dentz sizeof(mode), &mode, HCI_CMD_TIMEOUT); 3078cf75ad8bSLuiz Augusto von Dentz if (err) 3079cf75ad8bSLuiz Augusto von Dentz return err; 3080cf75ad8bSLuiz Augusto von Dentz 3081cf75ad8bSLuiz Augusto von Dentz return hci_write_sc_support_sync(hdev, 0x01); 3082cf75ad8bSLuiz Augusto von Dentz } 3083cf75ad8bSLuiz Augusto von Dentz 3084d81a494cSBrian Gix int hci_write_le_host_supported_sync(struct hci_dev *hdev, u8 le, u8 simul) 3085cf75ad8bSLuiz Augusto von Dentz { 3086cf75ad8bSLuiz Augusto von Dentz struct hci_cp_write_le_host_supported cp; 3087cf75ad8bSLuiz Augusto von Dentz 3088cf75ad8bSLuiz Augusto von Dentz if (!hci_dev_test_flag(hdev, HCI_LE_ENABLED) || 3089cf75ad8bSLuiz Augusto von Dentz !lmp_bredr_capable(hdev)) 3090cf75ad8bSLuiz Augusto von Dentz return 0; 3091cf75ad8bSLuiz Augusto von Dentz 3092cf75ad8bSLuiz Augusto von Dentz /* Check first if we already have the right host state 3093cf75ad8bSLuiz Augusto von Dentz * (host features set) 3094cf75ad8bSLuiz Augusto von Dentz */ 3095cf75ad8bSLuiz Augusto von Dentz if (le == lmp_host_le_capable(hdev) && 3096cf75ad8bSLuiz Augusto von Dentz simul == lmp_host_le_br_capable(hdev)) 3097cf75ad8bSLuiz Augusto von Dentz return 0; 3098cf75ad8bSLuiz Augusto von Dentz 3099cf75ad8bSLuiz Augusto von Dentz memset(&cp, 0, sizeof(cp)); 3100cf75ad8bSLuiz Augusto von Dentz 3101cf75ad8bSLuiz Augusto von Dentz cp.le = le; 3102cf75ad8bSLuiz Augusto von Dentz cp.simul = simul; 3103cf75ad8bSLuiz Augusto von Dentz 3104cf75ad8bSLuiz Augusto von Dentz return __hci_cmd_sync_status(hdev, HCI_OP_WRITE_LE_HOST_SUPPORTED, 3105cf75ad8bSLuiz Augusto von Dentz sizeof(cp), &cp, HCI_CMD_TIMEOUT); 3106cf75ad8bSLuiz Augusto von Dentz } 3107cf75ad8bSLuiz Augusto von Dentz 3108cf75ad8bSLuiz Augusto von Dentz static int hci_powered_update_adv_sync(struct hci_dev *hdev) 3109cf75ad8bSLuiz Augusto von Dentz { 3110cf75ad8bSLuiz Augusto von Dentz struct adv_info *adv, *tmp; 3111cf75ad8bSLuiz Augusto von Dentz int err; 3112cf75ad8bSLuiz Augusto von Dentz 3113cf75ad8bSLuiz Augusto von Dentz if (!hci_dev_test_flag(hdev, HCI_LE_ENABLED)) 3114cf75ad8bSLuiz Augusto von Dentz return 0; 3115cf75ad8bSLuiz Augusto von Dentz 3116cf75ad8bSLuiz Augusto von Dentz /* If RPA Resolution has not been enable yet it means the 3117cf75ad8bSLuiz Augusto von Dentz * resolving list is empty and we should attempt to program the 3118cf75ad8bSLuiz Augusto von Dentz * local IRK in order to support using own_addr_type 3119cf75ad8bSLuiz Augusto von Dentz * ADDR_LE_DEV_RANDOM_RESOLVED (0x03). 3120cf75ad8bSLuiz Augusto von Dentz */ 3121cf75ad8bSLuiz Augusto von Dentz if (!hci_dev_test_flag(hdev, HCI_LL_RPA_RESOLUTION)) { 3122cf75ad8bSLuiz Augusto von Dentz hci_le_add_resolve_list_sync(hdev, NULL); 3123cf75ad8bSLuiz Augusto von Dentz hci_le_set_addr_resolution_enable_sync(hdev, 0x01); 3124cf75ad8bSLuiz Augusto von Dentz } 3125cf75ad8bSLuiz Augusto von Dentz 3126cf75ad8bSLuiz Augusto von Dentz /* Make sure the controller has a good default for 3127cf75ad8bSLuiz Augusto von Dentz * advertising data. This also applies to the case 3128cf75ad8bSLuiz Augusto von Dentz * where BR/EDR was toggled during the AUTO_OFF phase. 3129cf75ad8bSLuiz Augusto von Dentz */ 3130cf75ad8bSLuiz Augusto von Dentz if (hci_dev_test_flag(hdev, HCI_ADVERTISING) || 3131cf75ad8bSLuiz Augusto von Dentz list_empty(&hdev->adv_instances)) { 3132cf75ad8bSLuiz Augusto von Dentz if (ext_adv_capable(hdev)) { 3133cf75ad8bSLuiz Augusto von Dentz err = hci_setup_ext_adv_instance_sync(hdev, 0x00); 3134cf75ad8bSLuiz Augusto von Dentz if (!err) 3135cf75ad8bSLuiz Augusto von Dentz hci_update_scan_rsp_data_sync(hdev, 0x00); 3136cf75ad8bSLuiz Augusto von Dentz } else { 3137cf75ad8bSLuiz Augusto von Dentz err = hci_update_adv_data_sync(hdev, 0x00); 3138cf75ad8bSLuiz Augusto von Dentz if (!err) 3139cf75ad8bSLuiz Augusto von Dentz hci_update_scan_rsp_data_sync(hdev, 0x00); 3140cf75ad8bSLuiz Augusto von Dentz } 3141cf75ad8bSLuiz Augusto von Dentz 3142cf75ad8bSLuiz Augusto von Dentz if (hci_dev_test_flag(hdev, HCI_ADVERTISING)) 3143cf75ad8bSLuiz Augusto von Dentz hci_enable_advertising_sync(hdev); 3144cf75ad8bSLuiz Augusto von Dentz } 3145cf75ad8bSLuiz Augusto von Dentz 3146cf75ad8bSLuiz Augusto von Dentz /* Call for each tracked instance to be scheduled */ 3147cf75ad8bSLuiz Augusto von Dentz list_for_each_entry_safe(adv, tmp, &hdev->adv_instances, list) 3148cf75ad8bSLuiz Augusto von Dentz hci_schedule_adv_instance_sync(hdev, adv->instance, true); 3149cf75ad8bSLuiz Augusto von Dentz 3150cf75ad8bSLuiz Augusto von Dentz return 0; 3151cf75ad8bSLuiz Augusto von Dentz } 3152cf75ad8bSLuiz Augusto von Dentz 3153cf75ad8bSLuiz Augusto von Dentz static int hci_write_auth_enable_sync(struct hci_dev *hdev) 3154cf75ad8bSLuiz Augusto von Dentz { 3155cf75ad8bSLuiz Augusto von Dentz u8 link_sec; 3156cf75ad8bSLuiz Augusto von Dentz 3157cf75ad8bSLuiz Augusto von Dentz link_sec = hci_dev_test_flag(hdev, HCI_LINK_SECURITY); 3158cf75ad8bSLuiz Augusto von Dentz if (link_sec == test_bit(HCI_AUTH, &hdev->flags)) 3159cf75ad8bSLuiz Augusto von Dentz return 0; 3160cf75ad8bSLuiz Augusto von Dentz 3161cf75ad8bSLuiz Augusto von Dentz return __hci_cmd_sync_status(hdev, HCI_OP_WRITE_AUTH_ENABLE, 3162cf75ad8bSLuiz Augusto von Dentz sizeof(link_sec), &link_sec, 3163cf75ad8bSLuiz Augusto von Dentz HCI_CMD_TIMEOUT); 3164cf75ad8bSLuiz Augusto von Dentz } 3165cf75ad8bSLuiz Augusto von Dentz 3166353a0249SBrian Gix int hci_write_fast_connectable_sync(struct hci_dev *hdev, bool enable) 3167cf75ad8bSLuiz Augusto von Dentz { 3168cf75ad8bSLuiz Augusto von Dentz struct hci_cp_write_page_scan_activity cp; 3169cf75ad8bSLuiz Augusto von Dentz u8 type; 3170cf75ad8bSLuiz Augusto von Dentz int err = 0; 3171cf75ad8bSLuiz Augusto von Dentz 3172cf75ad8bSLuiz Augusto von Dentz if (!hci_dev_test_flag(hdev, HCI_BREDR_ENABLED)) 3173cf75ad8bSLuiz Augusto von Dentz return 0; 3174cf75ad8bSLuiz Augusto von Dentz 3175cf75ad8bSLuiz Augusto von Dentz if (hdev->hci_ver < BLUETOOTH_VER_1_2) 3176cf75ad8bSLuiz Augusto von Dentz return 0; 3177cf75ad8bSLuiz Augusto von Dentz 3178cf75ad8bSLuiz Augusto von Dentz memset(&cp, 0, sizeof(cp)); 3179cf75ad8bSLuiz Augusto von Dentz 3180cf75ad8bSLuiz Augusto von Dentz if (enable) { 3181cf75ad8bSLuiz Augusto von Dentz type = PAGE_SCAN_TYPE_INTERLACED; 3182cf75ad8bSLuiz Augusto von Dentz 3183cf75ad8bSLuiz Augusto von Dentz /* 160 msec page scan interval */ 3184cf75ad8bSLuiz Augusto von Dentz cp.interval = cpu_to_le16(0x0100); 3185cf75ad8bSLuiz Augusto von Dentz } else { 3186cf75ad8bSLuiz Augusto von Dentz type = hdev->def_page_scan_type; 3187cf75ad8bSLuiz Augusto von Dentz cp.interval = cpu_to_le16(hdev->def_page_scan_int); 3188cf75ad8bSLuiz Augusto von Dentz } 3189cf75ad8bSLuiz Augusto von Dentz 3190cf75ad8bSLuiz Augusto von Dentz cp.window = cpu_to_le16(hdev->def_page_scan_window); 3191cf75ad8bSLuiz Augusto von Dentz 3192cf75ad8bSLuiz Augusto von Dentz if (__cpu_to_le16(hdev->page_scan_interval) != cp.interval || 3193cf75ad8bSLuiz Augusto von Dentz __cpu_to_le16(hdev->page_scan_window) != cp.window) { 3194cf75ad8bSLuiz Augusto von Dentz err = __hci_cmd_sync_status(hdev, 3195cf75ad8bSLuiz Augusto von Dentz HCI_OP_WRITE_PAGE_SCAN_ACTIVITY, 3196cf75ad8bSLuiz Augusto von Dentz sizeof(cp), &cp, HCI_CMD_TIMEOUT); 3197cf75ad8bSLuiz Augusto von Dentz if (err) 3198cf75ad8bSLuiz Augusto von Dentz return err; 3199cf75ad8bSLuiz Augusto von Dentz } 3200cf75ad8bSLuiz Augusto von Dentz 3201cf75ad8bSLuiz Augusto von Dentz if (hdev->page_scan_type != type) 3202cf75ad8bSLuiz Augusto von Dentz err = __hci_cmd_sync_status(hdev, 3203cf75ad8bSLuiz Augusto von Dentz HCI_OP_WRITE_PAGE_SCAN_TYPE, 3204cf75ad8bSLuiz Augusto von Dentz sizeof(type), &type, 3205cf75ad8bSLuiz Augusto von Dentz HCI_CMD_TIMEOUT); 3206cf75ad8bSLuiz Augusto von Dentz 3207cf75ad8bSLuiz Augusto von Dentz return err; 3208cf75ad8bSLuiz Augusto von Dentz } 3209cf75ad8bSLuiz Augusto von Dentz 3210cf75ad8bSLuiz Augusto von Dentz static bool disconnected_accept_list_entries(struct hci_dev *hdev) 3211cf75ad8bSLuiz Augusto von Dentz { 3212cf75ad8bSLuiz Augusto von Dentz struct bdaddr_list *b; 3213cf75ad8bSLuiz Augusto von Dentz 3214cf75ad8bSLuiz Augusto von Dentz list_for_each_entry(b, &hdev->accept_list, list) { 3215cf75ad8bSLuiz Augusto von Dentz struct hci_conn *conn; 3216cf75ad8bSLuiz Augusto von Dentz 3217cf75ad8bSLuiz Augusto von Dentz conn = hci_conn_hash_lookup_ba(hdev, ACL_LINK, &b->bdaddr); 3218cf75ad8bSLuiz Augusto von Dentz if (!conn) 3219cf75ad8bSLuiz Augusto von Dentz return true; 3220cf75ad8bSLuiz Augusto von Dentz 3221cf75ad8bSLuiz Augusto von Dentz if (conn->state != BT_CONNECTED && conn->state != BT_CONFIG) 3222cf75ad8bSLuiz Augusto von Dentz return true; 3223cf75ad8bSLuiz Augusto von Dentz } 3224cf75ad8bSLuiz Augusto von Dentz 3225cf75ad8bSLuiz Augusto von Dentz return false; 3226cf75ad8bSLuiz Augusto von Dentz } 3227cf75ad8bSLuiz Augusto von Dentz 3228cf75ad8bSLuiz Augusto von Dentz static int hci_write_scan_enable_sync(struct hci_dev *hdev, u8 val) 3229cf75ad8bSLuiz Augusto von Dentz { 3230cf75ad8bSLuiz Augusto von Dentz return __hci_cmd_sync_status(hdev, HCI_OP_WRITE_SCAN_ENABLE, 3231cf75ad8bSLuiz Augusto von Dentz sizeof(val), &val, 3232cf75ad8bSLuiz Augusto von Dentz HCI_CMD_TIMEOUT); 3233cf75ad8bSLuiz Augusto von Dentz } 3234cf75ad8bSLuiz Augusto von Dentz 3235451d95a9SBrian Gix int hci_update_scan_sync(struct hci_dev *hdev) 3236cf75ad8bSLuiz Augusto von Dentz { 3237cf75ad8bSLuiz Augusto von Dentz u8 scan; 3238cf75ad8bSLuiz Augusto von Dentz 3239cf75ad8bSLuiz Augusto von Dentz if (!hci_dev_test_flag(hdev, HCI_BREDR_ENABLED)) 3240cf75ad8bSLuiz Augusto von Dentz return 0; 3241cf75ad8bSLuiz Augusto von Dentz 3242cf75ad8bSLuiz Augusto von Dentz if (!hdev_is_powered(hdev)) 3243cf75ad8bSLuiz Augusto von Dentz return 0; 3244cf75ad8bSLuiz Augusto von Dentz 3245cf75ad8bSLuiz Augusto von Dentz if (mgmt_powering_down(hdev)) 3246cf75ad8bSLuiz Augusto von Dentz return 0; 3247cf75ad8bSLuiz Augusto von Dentz 3248cf75ad8bSLuiz Augusto von Dentz if (hdev->scanning_paused) 3249cf75ad8bSLuiz Augusto von Dentz return 0; 3250cf75ad8bSLuiz Augusto von Dentz 3251cf75ad8bSLuiz Augusto von Dentz if (hci_dev_test_flag(hdev, HCI_CONNECTABLE) || 3252cf75ad8bSLuiz Augusto von Dentz disconnected_accept_list_entries(hdev)) 3253cf75ad8bSLuiz Augusto von Dentz scan = SCAN_PAGE; 3254cf75ad8bSLuiz Augusto von Dentz else 3255cf75ad8bSLuiz Augusto von Dentz scan = SCAN_DISABLED; 3256cf75ad8bSLuiz Augusto von Dentz 3257cf75ad8bSLuiz Augusto von Dentz if (hci_dev_test_flag(hdev, HCI_DISCOVERABLE)) 3258cf75ad8bSLuiz Augusto von Dentz scan |= SCAN_INQUIRY; 3259cf75ad8bSLuiz Augusto von Dentz 3260cf75ad8bSLuiz Augusto von Dentz if (test_bit(HCI_PSCAN, &hdev->flags) == !!(scan & SCAN_PAGE) && 3261cf75ad8bSLuiz Augusto von Dentz test_bit(HCI_ISCAN, &hdev->flags) == !!(scan & SCAN_INQUIRY)) 3262cf75ad8bSLuiz Augusto von Dentz return 0; 3263cf75ad8bSLuiz Augusto von Dentz 3264cf75ad8bSLuiz Augusto von Dentz return hci_write_scan_enable_sync(hdev, scan); 3265cf75ad8bSLuiz Augusto von Dentz } 3266cf75ad8bSLuiz Augusto von Dentz 32676f6ff38aSBrian Gix int hci_update_name_sync(struct hci_dev *hdev) 3268cf75ad8bSLuiz Augusto von Dentz { 3269cf75ad8bSLuiz Augusto von Dentz struct hci_cp_write_local_name cp; 3270cf75ad8bSLuiz Augusto von Dentz 3271cf75ad8bSLuiz Augusto von Dentz memset(&cp, 0, sizeof(cp)); 3272cf75ad8bSLuiz Augusto von Dentz 3273cf75ad8bSLuiz Augusto von Dentz memcpy(cp.name, hdev->dev_name, sizeof(cp.name)); 3274cf75ad8bSLuiz Augusto von Dentz 3275cf75ad8bSLuiz Augusto von Dentz return __hci_cmd_sync_status(hdev, HCI_OP_WRITE_LOCAL_NAME, 3276cf75ad8bSLuiz Augusto von Dentz sizeof(cp), &cp, 3277cf75ad8bSLuiz Augusto von Dentz HCI_CMD_TIMEOUT); 3278cf75ad8bSLuiz Augusto von Dentz } 3279cf75ad8bSLuiz Augusto von Dentz 3280cf75ad8bSLuiz Augusto von Dentz /* This function perform powered update HCI command sequence after the HCI init 3281cf75ad8bSLuiz Augusto von Dentz * sequence which end up resetting all states, the sequence is as follows: 3282cf75ad8bSLuiz Augusto von Dentz * 3283cf75ad8bSLuiz Augusto von Dentz * HCI_SSP_ENABLED(Enable SSP) 3284cf75ad8bSLuiz Augusto von Dentz * HCI_LE_ENABLED(Enable LE) 3285cf75ad8bSLuiz Augusto von Dentz * HCI_LE_ENABLED(use_ll_privacy(Add local IRK to Resolving List) -> 3286cf75ad8bSLuiz Augusto von Dentz * Update adv data) 3287cf75ad8bSLuiz Augusto von Dentz * Enable Authentication 3288cf75ad8bSLuiz Augusto von Dentz * lmp_bredr_capable(Set Fast Connectable -> Set Scan Type -> Set Class -> 3289cf75ad8bSLuiz Augusto von Dentz * Set Name -> Set EIR) 3290e411443cSLuiz Augusto von Dentz * HCI_FORCE_STATIC_ADDR | BDADDR_ANY && !HCI_BREDR_ENABLED (Set Static Address) 3291cf75ad8bSLuiz Augusto von Dentz */ 3292cf75ad8bSLuiz Augusto von Dentz int hci_powered_update_sync(struct hci_dev *hdev) 3293cf75ad8bSLuiz Augusto von Dentz { 3294cf75ad8bSLuiz Augusto von Dentz int err; 3295cf75ad8bSLuiz Augusto von Dentz 3296cf75ad8bSLuiz Augusto von Dentz /* Register the available SMP channels (BR/EDR and LE) only when 3297cf75ad8bSLuiz Augusto von Dentz * successfully powering on the controller. This late 3298cf75ad8bSLuiz Augusto von Dentz * registration is required so that LE SMP can clearly decide if 3299cf75ad8bSLuiz Augusto von Dentz * the public address or static address is used. 3300cf75ad8bSLuiz Augusto von Dentz */ 3301cf75ad8bSLuiz Augusto von Dentz smp_register(hdev); 3302cf75ad8bSLuiz Augusto von Dentz 3303cf75ad8bSLuiz Augusto von Dentz err = hci_write_ssp_mode_sync(hdev, 0x01); 3304cf75ad8bSLuiz Augusto von Dentz if (err) 3305cf75ad8bSLuiz Augusto von Dentz return err; 3306cf75ad8bSLuiz Augusto von Dentz 3307cf75ad8bSLuiz Augusto von Dentz err = hci_write_le_host_supported_sync(hdev, 0x01, 0x00); 3308cf75ad8bSLuiz Augusto von Dentz if (err) 3309cf75ad8bSLuiz Augusto von Dentz return err; 3310cf75ad8bSLuiz Augusto von Dentz 3311cf75ad8bSLuiz Augusto von Dentz err = hci_powered_update_adv_sync(hdev); 3312cf75ad8bSLuiz Augusto von Dentz if (err) 3313cf75ad8bSLuiz Augusto von Dentz return err; 3314cf75ad8bSLuiz Augusto von Dentz 3315cf75ad8bSLuiz Augusto von Dentz err = hci_write_auth_enable_sync(hdev); 3316cf75ad8bSLuiz Augusto von Dentz if (err) 3317cf75ad8bSLuiz Augusto von Dentz return err; 3318cf75ad8bSLuiz Augusto von Dentz 3319cf75ad8bSLuiz Augusto von Dentz if (lmp_bredr_capable(hdev)) { 3320cf75ad8bSLuiz Augusto von Dentz if (hci_dev_test_flag(hdev, HCI_FAST_CONNECTABLE)) 3321cf75ad8bSLuiz Augusto von Dentz hci_write_fast_connectable_sync(hdev, true); 3322cf75ad8bSLuiz Augusto von Dentz else 3323cf75ad8bSLuiz Augusto von Dentz hci_write_fast_connectable_sync(hdev, false); 3324cf75ad8bSLuiz Augusto von Dentz hci_update_scan_sync(hdev); 3325cf75ad8bSLuiz Augusto von Dentz hci_update_class_sync(hdev); 3326cf75ad8bSLuiz Augusto von Dentz hci_update_name_sync(hdev); 3327cf75ad8bSLuiz Augusto von Dentz hci_update_eir_sync(hdev); 3328cf75ad8bSLuiz Augusto von Dentz } 3329cf75ad8bSLuiz Augusto von Dentz 3330e411443cSLuiz Augusto von Dentz /* If forcing static address is in use or there is no public 3331e411443cSLuiz Augusto von Dentz * address use the static address as random address (but skip 3332e411443cSLuiz Augusto von Dentz * the HCI command if the current random address is already the 3333e411443cSLuiz Augusto von Dentz * static one. 3334e411443cSLuiz Augusto von Dentz * 3335e411443cSLuiz Augusto von Dentz * In case BR/EDR has been disabled on a dual-mode controller 3336e411443cSLuiz Augusto von Dentz * and a static address has been configured, then use that 3337e411443cSLuiz Augusto von Dentz * address instead of the public BR/EDR address. 3338e411443cSLuiz Augusto von Dentz */ 3339e411443cSLuiz Augusto von Dentz if (hci_dev_test_flag(hdev, HCI_FORCE_STATIC_ADDR) || 3340e411443cSLuiz Augusto von Dentz (!bacmp(&hdev->bdaddr, BDADDR_ANY) && 3341e411443cSLuiz Augusto von Dentz !hci_dev_test_flag(hdev, HCI_BREDR_ENABLED))) { 3342e411443cSLuiz Augusto von Dentz if (bacmp(&hdev->static_addr, BDADDR_ANY)) 3343e411443cSLuiz Augusto von Dentz return hci_set_random_addr_sync(hdev, 3344e411443cSLuiz Augusto von Dentz &hdev->static_addr); 3345e411443cSLuiz Augusto von Dentz } 3346e411443cSLuiz Augusto von Dentz 3347cf75ad8bSLuiz Augusto von Dentz return 0; 3348cf75ad8bSLuiz Augusto von Dentz } 3349cf75ad8bSLuiz Augusto von Dentz 3350d0b13706SLuiz Augusto von Dentz /** 3351d0b13706SLuiz Augusto von Dentz * hci_dev_get_bd_addr_from_property - Get the Bluetooth Device Address 3352d0b13706SLuiz Augusto von Dentz * (BD_ADDR) for a HCI device from 3353d0b13706SLuiz Augusto von Dentz * a firmware node property. 3354d0b13706SLuiz Augusto von Dentz * @hdev: The HCI device 3355d0b13706SLuiz Augusto von Dentz * 3356d0b13706SLuiz Augusto von Dentz * Search the firmware node for 'local-bd-address'. 3357d0b13706SLuiz Augusto von Dentz * 3358d0b13706SLuiz Augusto von Dentz * All-zero BD addresses are rejected, because those could be properties 3359d0b13706SLuiz Augusto von Dentz * that exist in the firmware tables, but were not updated by the firmware. For 3360d0b13706SLuiz Augusto von Dentz * example, the DTS could define 'local-bd-address', with zero BD addresses. 3361d0b13706SLuiz Augusto von Dentz */ 3362d0b13706SLuiz Augusto von Dentz static void hci_dev_get_bd_addr_from_property(struct hci_dev *hdev) 3363d0b13706SLuiz Augusto von Dentz { 3364d0b13706SLuiz Augusto von Dentz struct fwnode_handle *fwnode = dev_fwnode(hdev->dev.parent); 3365d0b13706SLuiz Augusto von Dentz bdaddr_t ba; 3366d0b13706SLuiz Augusto von Dentz int ret; 3367d0b13706SLuiz Augusto von Dentz 3368d0b13706SLuiz Augusto von Dentz ret = fwnode_property_read_u8_array(fwnode, "local-bd-address", 3369d0b13706SLuiz Augusto von Dentz (u8 *)&ba, sizeof(ba)); 3370d0b13706SLuiz Augusto von Dentz if (ret < 0 || !bacmp(&ba, BDADDR_ANY)) 3371d0b13706SLuiz Augusto von Dentz return; 3372d0b13706SLuiz Augusto von Dentz 337357e089d3SJohan Hovold if (test_bit(HCI_QUIRK_BDADDR_PROPERTY_BROKEN, &hdev->quirks)) 337457e089d3SJohan Hovold baswap(&hdev->public_addr, &ba); 337557e089d3SJohan Hovold else 3376d0b13706SLuiz Augusto von Dentz bacpy(&hdev->public_addr, &ba); 3377d0b13706SLuiz Augusto von Dentz } 3378d0b13706SLuiz Augusto von Dentz 3379d0b13706SLuiz Augusto von Dentz struct hci_init_stage { 3380d0b13706SLuiz Augusto von Dentz int (*func)(struct hci_dev *hdev); 3381d0b13706SLuiz Augusto von Dentz }; 3382d0b13706SLuiz Augusto von Dentz 3383d0b13706SLuiz Augusto von Dentz /* Run init stage NULL terminated function table */ 3384d0b13706SLuiz Augusto von Dentz static int hci_init_stage_sync(struct hci_dev *hdev, 3385d0b13706SLuiz Augusto von Dentz const struct hci_init_stage *stage) 3386d0b13706SLuiz Augusto von Dentz { 3387d0b13706SLuiz Augusto von Dentz size_t i; 3388d0b13706SLuiz Augusto von Dentz 3389d0b13706SLuiz Augusto von Dentz for (i = 0; stage[i].func; i++) { 3390d0b13706SLuiz Augusto von Dentz int err; 3391d0b13706SLuiz Augusto von Dentz 3392d0b13706SLuiz Augusto von Dentz err = stage[i].func(hdev); 3393d0b13706SLuiz Augusto von Dentz if (err) 3394d0b13706SLuiz Augusto von Dentz return err; 3395d0b13706SLuiz Augusto von Dentz } 3396d0b13706SLuiz Augusto von Dentz 3397d0b13706SLuiz Augusto von Dentz return 0; 3398d0b13706SLuiz Augusto von Dentz } 3399d0b13706SLuiz Augusto von Dentz 3400d0b13706SLuiz Augusto von Dentz /* Read Local Version */ 3401d0b13706SLuiz Augusto von Dentz static int hci_read_local_version_sync(struct hci_dev *hdev) 3402d0b13706SLuiz Augusto von Dentz { 3403d0b13706SLuiz Augusto von Dentz return __hci_cmd_sync_status(hdev, HCI_OP_READ_LOCAL_VERSION, 3404d0b13706SLuiz Augusto von Dentz 0, NULL, HCI_CMD_TIMEOUT); 3405d0b13706SLuiz Augusto von Dentz } 3406d0b13706SLuiz Augusto von Dentz 3407d0b13706SLuiz Augusto von Dentz /* Read BD Address */ 3408d0b13706SLuiz Augusto von Dentz static int hci_read_bd_addr_sync(struct hci_dev *hdev) 3409d0b13706SLuiz Augusto von Dentz { 3410d0b13706SLuiz Augusto von Dentz return __hci_cmd_sync_status(hdev, HCI_OP_READ_BD_ADDR, 3411d0b13706SLuiz Augusto von Dentz 0, NULL, HCI_CMD_TIMEOUT); 3412d0b13706SLuiz Augusto von Dentz } 3413d0b13706SLuiz Augusto von Dentz 3414d0b13706SLuiz Augusto von Dentz #define HCI_INIT(_func) \ 3415d0b13706SLuiz Augusto von Dentz { \ 3416d0b13706SLuiz Augusto von Dentz .func = _func, \ 3417d0b13706SLuiz Augusto von Dentz } 3418d0b13706SLuiz Augusto von Dentz 3419d0b13706SLuiz Augusto von Dentz static const struct hci_init_stage hci_init0[] = { 3420d0b13706SLuiz Augusto von Dentz /* HCI_OP_READ_LOCAL_VERSION */ 3421d0b13706SLuiz Augusto von Dentz HCI_INIT(hci_read_local_version_sync), 3422d0b13706SLuiz Augusto von Dentz /* HCI_OP_READ_BD_ADDR */ 3423d0b13706SLuiz Augusto von Dentz HCI_INIT(hci_read_bd_addr_sync), 3424d0b13706SLuiz Augusto von Dentz {} 3425d0b13706SLuiz Augusto von Dentz }; 3426d0b13706SLuiz Augusto von Dentz 3427d0b13706SLuiz Augusto von Dentz int hci_reset_sync(struct hci_dev *hdev) 3428d0b13706SLuiz Augusto von Dentz { 3429d0b13706SLuiz Augusto von Dentz int err; 3430d0b13706SLuiz Augusto von Dentz 3431d0b13706SLuiz Augusto von Dentz set_bit(HCI_RESET, &hdev->flags); 3432d0b13706SLuiz Augusto von Dentz 3433d0b13706SLuiz Augusto von Dentz err = __hci_cmd_sync_status(hdev, HCI_OP_RESET, 0, NULL, 3434d0b13706SLuiz Augusto von Dentz HCI_CMD_TIMEOUT); 3435d0b13706SLuiz Augusto von Dentz if (err) 3436d0b13706SLuiz Augusto von Dentz return err; 3437d0b13706SLuiz Augusto von Dentz 3438d0b13706SLuiz Augusto von Dentz return 0; 3439d0b13706SLuiz Augusto von Dentz } 3440d0b13706SLuiz Augusto von Dentz 3441d0b13706SLuiz Augusto von Dentz static int hci_init0_sync(struct hci_dev *hdev) 3442d0b13706SLuiz Augusto von Dentz { 3443d0b13706SLuiz Augusto von Dentz int err; 3444d0b13706SLuiz Augusto von Dentz 3445d0b13706SLuiz Augusto von Dentz bt_dev_dbg(hdev, ""); 3446d0b13706SLuiz Augusto von Dentz 3447d0b13706SLuiz Augusto von Dentz /* Reset */ 3448d0b13706SLuiz Augusto von Dentz if (!test_bit(HCI_QUIRK_RESET_ON_CLOSE, &hdev->quirks)) { 3449d0b13706SLuiz Augusto von Dentz err = hci_reset_sync(hdev); 3450d0b13706SLuiz Augusto von Dentz if (err) 3451d0b13706SLuiz Augusto von Dentz return err; 3452d0b13706SLuiz Augusto von Dentz } 3453d0b13706SLuiz Augusto von Dentz 3454d0b13706SLuiz Augusto von Dentz return hci_init_stage_sync(hdev, hci_init0); 3455d0b13706SLuiz Augusto von Dentz } 3456d0b13706SLuiz Augusto von Dentz 3457d0b13706SLuiz Augusto von Dentz static int hci_unconf_init_sync(struct hci_dev *hdev) 3458d0b13706SLuiz Augusto von Dentz { 3459d0b13706SLuiz Augusto von Dentz int err; 3460d0b13706SLuiz Augusto von Dentz 3461d0b13706SLuiz Augusto von Dentz if (test_bit(HCI_QUIRK_RAW_DEVICE, &hdev->quirks)) 3462d0b13706SLuiz Augusto von Dentz return 0; 3463d0b13706SLuiz Augusto von Dentz 3464d0b13706SLuiz Augusto von Dentz err = hci_init0_sync(hdev); 3465d0b13706SLuiz Augusto von Dentz if (err < 0) 3466d0b13706SLuiz Augusto von Dentz return err; 3467d0b13706SLuiz Augusto von Dentz 3468d0b13706SLuiz Augusto von Dentz if (hci_dev_test_flag(hdev, HCI_SETUP)) 3469d0b13706SLuiz Augusto von Dentz hci_debugfs_create_basic(hdev); 3470d0b13706SLuiz Augusto von Dentz 3471d0b13706SLuiz Augusto von Dentz return 0; 3472d0b13706SLuiz Augusto von Dentz } 3473d0b13706SLuiz Augusto von Dentz 3474d0b13706SLuiz Augusto von Dentz /* Read Local Supported Features. */ 3475d0b13706SLuiz Augusto von Dentz static int hci_read_local_features_sync(struct hci_dev *hdev) 3476d0b13706SLuiz Augusto von Dentz { 3477d0b13706SLuiz Augusto von Dentz return __hci_cmd_sync_status(hdev, HCI_OP_READ_LOCAL_FEATURES, 3478d0b13706SLuiz Augusto von Dentz 0, NULL, HCI_CMD_TIMEOUT); 3479d0b13706SLuiz Augusto von Dentz } 3480d0b13706SLuiz Augusto von Dentz 3481d0b13706SLuiz Augusto von Dentz /* BR Controller init stage 1 command sequence */ 3482d0b13706SLuiz Augusto von Dentz static const struct hci_init_stage br_init1[] = { 3483d0b13706SLuiz Augusto von Dentz /* HCI_OP_READ_LOCAL_FEATURES */ 3484d0b13706SLuiz Augusto von Dentz HCI_INIT(hci_read_local_features_sync), 3485d0b13706SLuiz Augusto von Dentz /* HCI_OP_READ_LOCAL_VERSION */ 3486d0b13706SLuiz Augusto von Dentz HCI_INIT(hci_read_local_version_sync), 3487d0b13706SLuiz Augusto von Dentz /* HCI_OP_READ_BD_ADDR */ 3488d0b13706SLuiz Augusto von Dentz HCI_INIT(hci_read_bd_addr_sync), 3489d0b13706SLuiz Augusto von Dentz {} 3490d0b13706SLuiz Augusto von Dentz }; 3491d0b13706SLuiz Augusto von Dentz 3492d0b13706SLuiz Augusto von Dentz /* Read Local Commands */ 3493d0b13706SLuiz Augusto von Dentz static int hci_read_local_cmds_sync(struct hci_dev *hdev) 3494d0b13706SLuiz Augusto von Dentz { 3495d0b13706SLuiz Augusto von Dentz /* All Bluetooth 1.2 and later controllers should support the 3496d0b13706SLuiz Augusto von Dentz * HCI command for reading the local supported commands. 3497d0b13706SLuiz Augusto von Dentz * 3498d0b13706SLuiz Augusto von Dentz * Unfortunately some controllers indicate Bluetooth 1.2 support, 3499d0b13706SLuiz Augusto von Dentz * but do not have support for this command. If that is the case, 3500d0b13706SLuiz Augusto von Dentz * the driver can quirk the behavior and skip reading the local 3501d0b13706SLuiz Augusto von Dentz * supported commands. 3502d0b13706SLuiz Augusto von Dentz */ 3503d0b13706SLuiz Augusto von Dentz if (hdev->hci_ver > BLUETOOTH_VER_1_1 && 3504d0b13706SLuiz Augusto von Dentz !test_bit(HCI_QUIRK_BROKEN_LOCAL_COMMANDS, &hdev->quirks)) 3505d0b13706SLuiz Augusto von Dentz return __hci_cmd_sync_status(hdev, HCI_OP_READ_LOCAL_COMMANDS, 3506d0b13706SLuiz Augusto von Dentz 0, NULL, HCI_CMD_TIMEOUT); 3507d0b13706SLuiz Augusto von Dentz 3508d0b13706SLuiz Augusto von Dentz return 0; 3509d0b13706SLuiz Augusto von Dentz } 3510d0b13706SLuiz Augusto von Dentz 3511d0b13706SLuiz Augusto von Dentz static int hci_init1_sync(struct hci_dev *hdev) 3512d0b13706SLuiz Augusto von Dentz { 3513d0b13706SLuiz Augusto von Dentz int err; 3514d0b13706SLuiz Augusto von Dentz 3515d0b13706SLuiz Augusto von Dentz bt_dev_dbg(hdev, ""); 3516d0b13706SLuiz Augusto von Dentz 3517d0b13706SLuiz Augusto von Dentz /* Reset */ 3518d0b13706SLuiz Augusto von Dentz if (!test_bit(HCI_QUIRK_RESET_ON_CLOSE, &hdev->quirks)) { 3519d0b13706SLuiz Augusto von Dentz err = hci_reset_sync(hdev); 3520d0b13706SLuiz Augusto von Dentz if (err) 3521d0b13706SLuiz Augusto von Dentz return err; 3522d0b13706SLuiz Augusto von Dentz } 3523d0b13706SLuiz Augusto von Dentz 3524d0b13706SLuiz Augusto von Dentz return hci_init_stage_sync(hdev, br_init1); 3525d0b13706SLuiz Augusto von Dentz } 3526d0b13706SLuiz Augusto von Dentz 3527d0b13706SLuiz Augusto von Dentz /* Read Buffer Size (ACL mtu, max pkt, etc.) */ 3528d0b13706SLuiz Augusto von Dentz static int hci_read_buffer_size_sync(struct hci_dev *hdev) 3529d0b13706SLuiz Augusto von Dentz { 3530d0b13706SLuiz Augusto von Dentz return __hci_cmd_sync_status(hdev, HCI_OP_READ_BUFFER_SIZE, 3531d0b13706SLuiz Augusto von Dentz 0, NULL, HCI_CMD_TIMEOUT); 3532d0b13706SLuiz Augusto von Dentz } 3533d0b13706SLuiz Augusto von Dentz 3534d0b13706SLuiz Augusto von Dentz /* Read Class of Device */ 3535d0b13706SLuiz Augusto von Dentz static int hci_read_dev_class_sync(struct hci_dev *hdev) 3536d0b13706SLuiz Augusto von Dentz { 3537d0b13706SLuiz Augusto von Dentz return __hci_cmd_sync_status(hdev, HCI_OP_READ_CLASS_OF_DEV, 3538d0b13706SLuiz Augusto von Dentz 0, NULL, HCI_CMD_TIMEOUT); 3539d0b13706SLuiz Augusto von Dentz } 3540d0b13706SLuiz Augusto von Dentz 3541d0b13706SLuiz Augusto von Dentz /* Read Local Name */ 3542d0b13706SLuiz Augusto von Dentz static int hci_read_local_name_sync(struct hci_dev *hdev) 3543d0b13706SLuiz Augusto von Dentz { 3544d0b13706SLuiz Augusto von Dentz return __hci_cmd_sync_status(hdev, HCI_OP_READ_LOCAL_NAME, 3545d0b13706SLuiz Augusto von Dentz 0, NULL, HCI_CMD_TIMEOUT); 3546d0b13706SLuiz Augusto von Dentz } 3547d0b13706SLuiz Augusto von Dentz 3548d0b13706SLuiz Augusto von Dentz /* Read Voice Setting */ 3549d0b13706SLuiz Augusto von Dentz static int hci_read_voice_setting_sync(struct hci_dev *hdev) 3550d0b13706SLuiz Augusto von Dentz { 3551d0b13706SLuiz Augusto von Dentz return __hci_cmd_sync_status(hdev, HCI_OP_READ_VOICE_SETTING, 3552d0b13706SLuiz Augusto von Dentz 0, NULL, HCI_CMD_TIMEOUT); 3553d0b13706SLuiz Augusto von Dentz } 3554d0b13706SLuiz Augusto von Dentz 3555d0b13706SLuiz Augusto von Dentz /* Read Number of Supported IAC */ 3556d0b13706SLuiz Augusto von Dentz static int hci_read_num_supported_iac_sync(struct hci_dev *hdev) 3557d0b13706SLuiz Augusto von Dentz { 3558d0b13706SLuiz Augusto von Dentz return __hci_cmd_sync_status(hdev, HCI_OP_READ_NUM_SUPPORTED_IAC, 3559d0b13706SLuiz Augusto von Dentz 0, NULL, HCI_CMD_TIMEOUT); 3560d0b13706SLuiz Augusto von Dentz } 3561d0b13706SLuiz Augusto von Dentz 3562d0b13706SLuiz Augusto von Dentz /* Read Current IAC LAP */ 3563d0b13706SLuiz Augusto von Dentz static int hci_read_current_iac_lap_sync(struct hci_dev *hdev) 3564d0b13706SLuiz Augusto von Dentz { 3565d0b13706SLuiz Augusto von Dentz return __hci_cmd_sync_status(hdev, HCI_OP_READ_CURRENT_IAC_LAP, 3566d0b13706SLuiz Augusto von Dentz 0, NULL, HCI_CMD_TIMEOUT); 3567d0b13706SLuiz Augusto von Dentz } 3568d0b13706SLuiz Augusto von Dentz 3569d0b13706SLuiz Augusto von Dentz static int hci_set_event_filter_sync(struct hci_dev *hdev, u8 flt_type, 3570d0b13706SLuiz Augusto von Dentz u8 cond_type, bdaddr_t *bdaddr, 3571d0b13706SLuiz Augusto von Dentz u8 auto_accept) 3572d0b13706SLuiz Augusto von Dentz { 3573d0b13706SLuiz Augusto von Dentz struct hci_cp_set_event_filter cp; 3574d0b13706SLuiz Augusto von Dentz 3575d0b13706SLuiz Augusto von Dentz if (!hci_dev_test_flag(hdev, HCI_BREDR_ENABLED)) 3576d0b13706SLuiz Augusto von Dentz return 0; 3577d0b13706SLuiz Augusto von Dentz 35780eaecfb2SIsmael Ferreras Morezuelas if (test_bit(HCI_QUIRK_BROKEN_FILTER_CLEAR_ALL, &hdev->quirks)) 35790eaecfb2SIsmael Ferreras Morezuelas return 0; 35800eaecfb2SIsmael Ferreras Morezuelas 3581d0b13706SLuiz Augusto von Dentz memset(&cp, 0, sizeof(cp)); 3582d0b13706SLuiz Augusto von Dentz cp.flt_type = flt_type; 3583d0b13706SLuiz Augusto von Dentz 3584d0b13706SLuiz Augusto von Dentz if (flt_type != HCI_FLT_CLEAR_ALL) { 3585d0b13706SLuiz Augusto von Dentz cp.cond_type = cond_type; 3586d0b13706SLuiz Augusto von Dentz bacpy(&cp.addr_conn_flt.bdaddr, bdaddr); 3587d0b13706SLuiz Augusto von Dentz cp.addr_conn_flt.auto_accept = auto_accept; 3588d0b13706SLuiz Augusto von Dentz } 3589d0b13706SLuiz Augusto von Dentz 3590d0b13706SLuiz Augusto von Dentz return __hci_cmd_sync_status(hdev, HCI_OP_SET_EVENT_FLT, 3591d0b13706SLuiz Augusto von Dentz flt_type == HCI_FLT_CLEAR_ALL ? 3592d0b13706SLuiz Augusto von Dentz sizeof(cp.flt_type) : sizeof(cp), &cp, 3593d0b13706SLuiz Augusto von Dentz HCI_CMD_TIMEOUT); 3594d0b13706SLuiz Augusto von Dentz } 3595d0b13706SLuiz Augusto von Dentz 3596d0b13706SLuiz Augusto von Dentz static int hci_clear_event_filter_sync(struct hci_dev *hdev) 3597d0b13706SLuiz Augusto von Dentz { 3598d0b13706SLuiz Augusto von Dentz if (!hci_dev_test_flag(hdev, HCI_EVENT_FILTER_CONFIGURED)) 3599d0b13706SLuiz Augusto von Dentz return 0; 3600d0b13706SLuiz Augusto von Dentz 36010eaecfb2SIsmael Ferreras Morezuelas /* In theory the state machine should not reach here unless 36020eaecfb2SIsmael Ferreras Morezuelas * a hci_set_event_filter_sync() call succeeds, but we do 36030eaecfb2SIsmael Ferreras Morezuelas * the check both for parity and as a future reminder. 36040eaecfb2SIsmael Ferreras Morezuelas */ 36050eaecfb2SIsmael Ferreras Morezuelas if (test_bit(HCI_QUIRK_BROKEN_FILTER_CLEAR_ALL, &hdev->quirks)) 36060eaecfb2SIsmael Ferreras Morezuelas return 0; 36070eaecfb2SIsmael Ferreras Morezuelas 3608d0b13706SLuiz Augusto von Dentz return hci_set_event_filter_sync(hdev, HCI_FLT_CLEAR_ALL, 0x00, 3609d0b13706SLuiz Augusto von Dentz BDADDR_ANY, 0x00); 3610d0b13706SLuiz Augusto von Dentz } 3611d0b13706SLuiz Augusto von Dentz 3612d0b13706SLuiz Augusto von Dentz /* Connection accept timeout ~20 secs */ 3613d0b13706SLuiz Augusto von Dentz static int hci_write_ca_timeout_sync(struct hci_dev *hdev) 3614d0b13706SLuiz Augusto von Dentz { 3615d0b13706SLuiz Augusto von Dentz __le16 param = cpu_to_le16(0x7d00); 3616d0b13706SLuiz Augusto von Dentz 3617d0b13706SLuiz Augusto von Dentz return __hci_cmd_sync_status(hdev, HCI_OP_WRITE_CA_TIMEOUT, 3618d0b13706SLuiz Augusto von Dentz sizeof(param), ¶m, HCI_CMD_TIMEOUT); 3619d0b13706SLuiz Augusto von Dentz } 3620d0b13706SLuiz Augusto von Dentz 3621d0b13706SLuiz Augusto von Dentz /* BR Controller init stage 2 command sequence */ 3622d0b13706SLuiz Augusto von Dentz static const struct hci_init_stage br_init2[] = { 3623d0b13706SLuiz Augusto von Dentz /* HCI_OP_READ_BUFFER_SIZE */ 3624d0b13706SLuiz Augusto von Dentz HCI_INIT(hci_read_buffer_size_sync), 3625d0b13706SLuiz Augusto von Dentz /* HCI_OP_READ_CLASS_OF_DEV */ 3626d0b13706SLuiz Augusto von Dentz HCI_INIT(hci_read_dev_class_sync), 3627d0b13706SLuiz Augusto von Dentz /* HCI_OP_READ_LOCAL_NAME */ 3628d0b13706SLuiz Augusto von Dentz HCI_INIT(hci_read_local_name_sync), 3629d0b13706SLuiz Augusto von Dentz /* HCI_OP_READ_VOICE_SETTING */ 3630d0b13706SLuiz Augusto von Dentz HCI_INIT(hci_read_voice_setting_sync), 3631d0b13706SLuiz Augusto von Dentz /* HCI_OP_READ_NUM_SUPPORTED_IAC */ 3632d0b13706SLuiz Augusto von Dentz HCI_INIT(hci_read_num_supported_iac_sync), 3633d0b13706SLuiz Augusto von Dentz /* HCI_OP_READ_CURRENT_IAC_LAP */ 3634d0b13706SLuiz Augusto von Dentz HCI_INIT(hci_read_current_iac_lap_sync), 3635d0b13706SLuiz Augusto von Dentz /* HCI_OP_SET_EVENT_FLT */ 3636d0b13706SLuiz Augusto von Dentz HCI_INIT(hci_clear_event_filter_sync), 3637d0b13706SLuiz Augusto von Dentz /* HCI_OP_WRITE_CA_TIMEOUT */ 3638d0b13706SLuiz Augusto von Dentz HCI_INIT(hci_write_ca_timeout_sync), 3639d0b13706SLuiz Augusto von Dentz {} 3640d0b13706SLuiz Augusto von Dentz }; 3641d0b13706SLuiz Augusto von Dentz 3642d0b13706SLuiz Augusto von Dentz static int hci_write_ssp_mode_1_sync(struct hci_dev *hdev) 3643d0b13706SLuiz Augusto von Dentz { 3644d0b13706SLuiz Augusto von Dentz u8 mode = 0x01; 3645d0b13706SLuiz Augusto von Dentz 3646d0b13706SLuiz Augusto von Dentz if (!lmp_ssp_capable(hdev) || !hci_dev_test_flag(hdev, HCI_SSP_ENABLED)) 3647d0b13706SLuiz Augusto von Dentz return 0; 3648d0b13706SLuiz Augusto von Dentz 3649d0b13706SLuiz Augusto von Dentz /* When SSP is available, then the host features page 3650d0b13706SLuiz Augusto von Dentz * should also be available as well. However some 3651d0b13706SLuiz Augusto von Dentz * controllers list the max_page as 0 as long as SSP 3652d0b13706SLuiz Augusto von Dentz * has not been enabled. To achieve proper debugging 3653d0b13706SLuiz Augusto von Dentz * output, force the minimum max_page to 1 at least. 3654d0b13706SLuiz Augusto von Dentz */ 3655d0b13706SLuiz Augusto von Dentz hdev->max_page = 0x01; 3656d0b13706SLuiz Augusto von Dentz 3657d0b13706SLuiz Augusto von Dentz return __hci_cmd_sync_status(hdev, HCI_OP_WRITE_SSP_MODE, 3658d0b13706SLuiz Augusto von Dentz sizeof(mode), &mode, HCI_CMD_TIMEOUT); 3659d0b13706SLuiz Augusto von Dentz } 3660d0b13706SLuiz Augusto von Dentz 3661d0b13706SLuiz Augusto von Dentz static int hci_write_eir_sync(struct hci_dev *hdev) 3662d0b13706SLuiz Augusto von Dentz { 3663d0b13706SLuiz Augusto von Dentz struct hci_cp_write_eir cp; 3664d0b13706SLuiz Augusto von Dentz 3665d0b13706SLuiz Augusto von Dentz if (!lmp_ssp_capable(hdev) || hci_dev_test_flag(hdev, HCI_SSP_ENABLED)) 3666d0b13706SLuiz Augusto von Dentz return 0; 3667d0b13706SLuiz Augusto von Dentz 3668d0b13706SLuiz Augusto von Dentz memset(hdev->eir, 0, sizeof(hdev->eir)); 3669d0b13706SLuiz Augusto von Dentz memset(&cp, 0, sizeof(cp)); 3670d0b13706SLuiz Augusto von Dentz 3671d0b13706SLuiz Augusto von Dentz return __hci_cmd_sync_status(hdev, HCI_OP_WRITE_EIR, sizeof(cp), &cp, 3672d0b13706SLuiz Augusto von Dentz HCI_CMD_TIMEOUT); 3673d0b13706SLuiz Augusto von Dentz } 3674d0b13706SLuiz Augusto von Dentz 3675d0b13706SLuiz Augusto von Dentz static int hci_write_inquiry_mode_sync(struct hci_dev *hdev) 3676d0b13706SLuiz Augusto von Dentz { 3677d0b13706SLuiz Augusto von Dentz u8 mode; 3678d0b13706SLuiz Augusto von Dentz 3679d0b13706SLuiz Augusto von Dentz if (!lmp_inq_rssi_capable(hdev) && 3680d0b13706SLuiz Augusto von Dentz !test_bit(HCI_QUIRK_FIXUP_INQUIRY_MODE, &hdev->quirks)) 3681d0b13706SLuiz Augusto von Dentz return 0; 3682d0b13706SLuiz Augusto von Dentz 3683d0b13706SLuiz Augusto von Dentz /* If Extended Inquiry Result events are supported, then 3684d0b13706SLuiz Augusto von Dentz * they are clearly preferred over Inquiry Result with RSSI 3685d0b13706SLuiz Augusto von Dentz * events. 3686d0b13706SLuiz Augusto von Dentz */ 3687d0b13706SLuiz Augusto von Dentz mode = lmp_ext_inq_capable(hdev) ? 0x02 : 0x01; 3688d0b13706SLuiz Augusto von Dentz 3689d0b13706SLuiz Augusto von Dentz return __hci_cmd_sync_status(hdev, HCI_OP_WRITE_INQUIRY_MODE, 3690d0b13706SLuiz Augusto von Dentz sizeof(mode), &mode, HCI_CMD_TIMEOUT); 3691d0b13706SLuiz Augusto von Dentz } 3692d0b13706SLuiz Augusto von Dentz 3693d0b13706SLuiz Augusto von Dentz static int hci_read_inq_rsp_tx_power_sync(struct hci_dev *hdev) 3694d0b13706SLuiz Augusto von Dentz { 3695d0b13706SLuiz Augusto von Dentz if (!lmp_inq_tx_pwr_capable(hdev)) 3696d0b13706SLuiz Augusto von Dentz return 0; 3697d0b13706SLuiz Augusto von Dentz 3698d0b13706SLuiz Augusto von Dentz return __hci_cmd_sync_status(hdev, HCI_OP_READ_INQ_RSP_TX_POWER, 3699d0b13706SLuiz Augusto von Dentz 0, NULL, HCI_CMD_TIMEOUT); 3700d0b13706SLuiz Augusto von Dentz } 3701d0b13706SLuiz Augusto von Dentz 3702d0b13706SLuiz Augusto von Dentz static int hci_read_local_ext_features_sync(struct hci_dev *hdev, u8 page) 3703d0b13706SLuiz Augusto von Dentz { 3704d0b13706SLuiz Augusto von Dentz struct hci_cp_read_local_ext_features cp; 3705d0b13706SLuiz Augusto von Dentz 3706d0b13706SLuiz Augusto von Dentz if (!lmp_ext_feat_capable(hdev)) 3707d0b13706SLuiz Augusto von Dentz return 0; 3708d0b13706SLuiz Augusto von Dentz 3709d0b13706SLuiz Augusto von Dentz memset(&cp, 0, sizeof(cp)); 3710d0b13706SLuiz Augusto von Dentz cp.page = page; 3711d0b13706SLuiz Augusto von Dentz 3712d0b13706SLuiz Augusto von Dentz return __hci_cmd_sync_status(hdev, HCI_OP_READ_LOCAL_EXT_FEATURES, 3713d0b13706SLuiz Augusto von Dentz sizeof(cp), &cp, HCI_CMD_TIMEOUT); 3714d0b13706SLuiz Augusto von Dentz } 3715d0b13706SLuiz Augusto von Dentz 3716d0b13706SLuiz Augusto von Dentz static int hci_read_local_ext_features_1_sync(struct hci_dev *hdev) 3717d0b13706SLuiz Augusto von Dentz { 3718d0b13706SLuiz Augusto von Dentz return hci_read_local_ext_features_sync(hdev, 0x01); 3719d0b13706SLuiz Augusto von Dentz } 3720d0b13706SLuiz Augusto von Dentz 3721d0b13706SLuiz Augusto von Dentz /* HCI Controller init stage 2 command sequence */ 3722d0b13706SLuiz Augusto von Dentz static const struct hci_init_stage hci_init2[] = { 3723d0b13706SLuiz Augusto von Dentz /* HCI_OP_READ_LOCAL_COMMANDS */ 3724d0b13706SLuiz Augusto von Dentz HCI_INIT(hci_read_local_cmds_sync), 3725d0b13706SLuiz Augusto von Dentz /* HCI_OP_WRITE_SSP_MODE */ 3726d0b13706SLuiz Augusto von Dentz HCI_INIT(hci_write_ssp_mode_1_sync), 3727d0b13706SLuiz Augusto von Dentz /* HCI_OP_WRITE_EIR */ 3728d0b13706SLuiz Augusto von Dentz HCI_INIT(hci_write_eir_sync), 3729d0b13706SLuiz Augusto von Dentz /* HCI_OP_WRITE_INQUIRY_MODE */ 3730d0b13706SLuiz Augusto von Dentz HCI_INIT(hci_write_inquiry_mode_sync), 3731d0b13706SLuiz Augusto von Dentz /* HCI_OP_READ_INQ_RSP_TX_POWER */ 3732d0b13706SLuiz Augusto von Dentz HCI_INIT(hci_read_inq_rsp_tx_power_sync), 3733d0b13706SLuiz Augusto von Dentz /* HCI_OP_READ_LOCAL_EXT_FEATURES */ 3734d0b13706SLuiz Augusto von Dentz HCI_INIT(hci_read_local_ext_features_1_sync), 3735d0b13706SLuiz Augusto von Dentz /* HCI_OP_WRITE_AUTH_ENABLE */ 3736d0b13706SLuiz Augusto von Dentz HCI_INIT(hci_write_auth_enable_sync), 3737d0b13706SLuiz Augusto von Dentz {} 3738d0b13706SLuiz Augusto von Dentz }; 3739d0b13706SLuiz Augusto von Dentz 3740d0b13706SLuiz Augusto von Dentz /* Read LE Buffer Size */ 3741d0b13706SLuiz Augusto von Dentz static int hci_le_read_buffer_size_sync(struct hci_dev *hdev) 3742d0b13706SLuiz Augusto von Dentz { 3743c1631dbcSLuiz Augusto von Dentz /* Use Read LE Buffer Size V2 if supported */ 37443a4d29b6SLuiz Augusto von Dentz if (iso_capable(hdev) && hdev->commands[41] & 0x20) 3745c1631dbcSLuiz Augusto von Dentz return __hci_cmd_sync_status(hdev, 3746c1631dbcSLuiz Augusto von Dentz HCI_OP_LE_READ_BUFFER_SIZE_V2, 3747c1631dbcSLuiz Augusto von Dentz 0, NULL, HCI_CMD_TIMEOUT); 3748c1631dbcSLuiz Augusto von Dentz 3749d0b13706SLuiz Augusto von Dentz return __hci_cmd_sync_status(hdev, HCI_OP_LE_READ_BUFFER_SIZE, 3750d0b13706SLuiz Augusto von Dentz 0, NULL, HCI_CMD_TIMEOUT); 3751d0b13706SLuiz Augusto von Dentz } 3752d0b13706SLuiz Augusto von Dentz 3753d0b13706SLuiz Augusto von Dentz /* Read LE Local Supported Features */ 3754d0b13706SLuiz Augusto von Dentz static int hci_le_read_local_features_sync(struct hci_dev *hdev) 3755d0b13706SLuiz Augusto von Dentz { 3756d0b13706SLuiz Augusto von Dentz return __hci_cmd_sync_status(hdev, HCI_OP_LE_READ_LOCAL_FEATURES, 3757d0b13706SLuiz Augusto von Dentz 0, NULL, HCI_CMD_TIMEOUT); 3758d0b13706SLuiz Augusto von Dentz } 3759d0b13706SLuiz Augusto von Dentz 3760d0b13706SLuiz Augusto von Dentz /* Read LE Supported States */ 3761d0b13706SLuiz Augusto von Dentz static int hci_le_read_supported_states_sync(struct hci_dev *hdev) 3762d0b13706SLuiz Augusto von Dentz { 3763d0b13706SLuiz Augusto von Dentz return __hci_cmd_sync_status(hdev, HCI_OP_LE_READ_SUPPORTED_STATES, 3764d0b13706SLuiz Augusto von Dentz 0, NULL, HCI_CMD_TIMEOUT); 3765d0b13706SLuiz Augusto von Dentz } 3766d0b13706SLuiz Augusto von Dentz 3767d0b13706SLuiz Augusto von Dentz /* LE Controller init stage 2 command sequence */ 3768d0b13706SLuiz Augusto von Dentz static const struct hci_init_stage le_init2[] = { 3769d0b13706SLuiz Augusto von Dentz /* HCI_OP_LE_READ_LOCAL_FEATURES */ 3770d0b13706SLuiz Augusto von Dentz HCI_INIT(hci_le_read_local_features_sync), 37713a4d29b6SLuiz Augusto von Dentz /* HCI_OP_LE_READ_BUFFER_SIZE */ 37723a4d29b6SLuiz Augusto von Dentz HCI_INIT(hci_le_read_buffer_size_sync), 3773d0b13706SLuiz Augusto von Dentz /* HCI_OP_LE_READ_SUPPORTED_STATES */ 3774d0b13706SLuiz Augusto von Dentz HCI_INIT(hci_le_read_supported_states_sync), 3775d0b13706SLuiz Augusto von Dentz {} 3776d0b13706SLuiz Augusto von Dentz }; 3777d0b13706SLuiz Augusto von Dentz 3778d0b13706SLuiz Augusto von Dentz static int hci_init2_sync(struct hci_dev *hdev) 3779d0b13706SLuiz Augusto von Dentz { 3780d0b13706SLuiz Augusto von Dentz int err; 3781d0b13706SLuiz Augusto von Dentz 3782d0b13706SLuiz Augusto von Dentz bt_dev_dbg(hdev, ""); 3783d0b13706SLuiz Augusto von Dentz 378426afbd82SLuiz Augusto von Dentz err = hci_init_stage_sync(hdev, hci_init2); 378526afbd82SLuiz Augusto von Dentz if (err) 378626afbd82SLuiz Augusto von Dentz return err; 378726afbd82SLuiz Augusto von Dentz 3788d0b13706SLuiz Augusto von Dentz if (lmp_bredr_capable(hdev)) { 3789d0b13706SLuiz Augusto von Dentz err = hci_init_stage_sync(hdev, br_init2); 3790d0b13706SLuiz Augusto von Dentz if (err) 3791d0b13706SLuiz Augusto von Dentz return err; 3792d0b13706SLuiz Augusto von Dentz } else { 3793d0b13706SLuiz Augusto von Dentz hci_dev_clear_flag(hdev, HCI_BREDR_ENABLED); 3794d0b13706SLuiz Augusto von Dentz } 3795d0b13706SLuiz Augusto von Dentz 3796d0b13706SLuiz Augusto von Dentz if (lmp_le_capable(hdev)) { 3797d0b13706SLuiz Augusto von Dentz err = hci_init_stage_sync(hdev, le_init2); 3798d0b13706SLuiz Augusto von Dentz if (err) 3799d0b13706SLuiz Augusto von Dentz return err; 3800d0b13706SLuiz Augusto von Dentz /* LE-only controllers have LE implicitly enabled */ 3801d0b13706SLuiz Augusto von Dentz if (!lmp_bredr_capable(hdev)) 3802d0b13706SLuiz Augusto von Dentz hci_dev_set_flag(hdev, HCI_LE_ENABLED); 3803d0b13706SLuiz Augusto von Dentz } 3804d0b13706SLuiz Augusto von Dentz 380526afbd82SLuiz Augusto von Dentz return 0; 3806d0b13706SLuiz Augusto von Dentz } 3807d0b13706SLuiz Augusto von Dentz 3808d0b13706SLuiz Augusto von Dentz static int hci_set_event_mask_sync(struct hci_dev *hdev) 3809d0b13706SLuiz Augusto von Dentz { 3810d0b13706SLuiz Augusto von Dentz /* The second byte is 0xff instead of 0x9f (two reserved bits 3811d0b13706SLuiz Augusto von Dentz * disabled) since a Broadcom 1.2 dongle doesn't respond to the 3812d0b13706SLuiz Augusto von Dentz * command otherwise. 3813d0b13706SLuiz Augusto von Dentz */ 3814d0b13706SLuiz Augusto von Dentz u8 events[8] = { 0xff, 0xff, 0xfb, 0xff, 0x00, 0x00, 0x00, 0x00 }; 3815d0b13706SLuiz Augusto von Dentz 3816d0b13706SLuiz Augusto von Dentz /* CSR 1.1 dongles does not accept any bitfield so don't try to set 3817d0b13706SLuiz Augusto von Dentz * any event mask for pre 1.2 devices. 3818d0b13706SLuiz Augusto von Dentz */ 3819d0b13706SLuiz Augusto von Dentz if (hdev->hci_ver < BLUETOOTH_VER_1_2) 3820d0b13706SLuiz Augusto von Dentz return 0; 3821d0b13706SLuiz Augusto von Dentz 3822d0b13706SLuiz Augusto von Dentz if (lmp_bredr_capable(hdev)) { 3823d0b13706SLuiz Augusto von Dentz events[4] |= 0x01; /* Flow Specification Complete */ 3824182ee45dSLuiz Augusto von Dentz 3825e266b7b2Sclancy shang /* Don't set Disconnect Complete and mode change when 3826e266b7b2Sclancy shang * suspended as that would wakeup the host when disconnecting 3827e266b7b2Sclancy shang * due to suspend. 3828182ee45dSLuiz Augusto von Dentz */ 3829e266b7b2Sclancy shang if (hdev->suspended) { 3830182ee45dSLuiz Augusto von Dentz events[0] &= 0xef; 3831e266b7b2Sclancy shang events[2] &= 0xf7; 3832e266b7b2Sclancy shang } 3833d0b13706SLuiz Augusto von Dentz } else { 3834d0b13706SLuiz Augusto von Dentz /* Use a different default for LE-only devices */ 3835d0b13706SLuiz Augusto von Dentz memset(events, 0, sizeof(events)); 3836d0b13706SLuiz Augusto von Dentz events[1] |= 0x20; /* Command Complete */ 3837d0b13706SLuiz Augusto von Dentz events[1] |= 0x40; /* Command Status */ 3838d0b13706SLuiz Augusto von Dentz events[1] |= 0x80; /* Hardware Error */ 3839d0b13706SLuiz Augusto von Dentz 3840d0b13706SLuiz Augusto von Dentz /* If the controller supports the Disconnect command, enable 3841d0b13706SLuiz Augusto von Dentz * the corresponding event. In addition enable packet flow 3842d0b13706SLuiz Augusto von Dentz * control related events. 3843d0b13706SLuiz Augusto von Dentz */ 3844d0b13706SLuiz Augusto von Dentz if (hdev->commands[0] & 0x20) { 3845182ee45dSLuiz Augusto von Dentz /* Don't set Disconnect Complete when suspended as that 3846182ee45dSLuiz Augusto von Dentz * would wakeup the host when disconnecting due to 3847182ee45dSLuiz Augusto von Dentz * suspend. 3848182ee45dSLuiz Augusto von Dentz */ 3849182ee45dSLuiz Augusto von Dentz if (!hdev->suspended) 3850d0b13706SLuiz Augusto von Dentz events[0] |= 0x10; /* Disconnection Complete */ 3851d0b13706SLuiz Augusto von Dentz events[2] |= 0x04; /* Number of Completed Packets */ 3852d0b13706SLuiz Augusto von Dentz events[3] |= 0x02; /* Data Buffer Overflow */ 3853d0b13706SLuiz Augusto von Dentz } 3854d0b13706SLuiz Augusto von Dentz 3855d0b13706SLuiz Augusto von Dentz /* If the controller supports the Read Remote Version 3856d0b13706SLuiz Augusto von Dentz * Information command, enable the corresponding event. 3857d0b13706SLuiz Augusto von Dentz */ 3858d0b13706SLuiz Augusto von Dentz if (hdev->commands[2] & 0x80) 3859d0b13706SLuiz Augusto von Dentz events[1] |= 0x08; /* Read Remote Version Information 3860d0b13706SLuiz Augusto von Dentz * Complete 3861d0b13706SLuiz Augusto von Dentz */ 3862d0b13706SLuiz Augusto von Dentz 3863d0b13706SLuiz Augusto von Dentz if (hdev->le_features[0] & HCI_LE_ENCRYPTION) { 3864d0b13706SLuiz Augusto von Dentz events[0] |= 0x80; /* Encryption Change */ 3865d0b13706SLuiz Augusto von Dentz events[5] |= 0x80; /* Encryption Key Refresh Complete */ 3866d0b13706SLuiz Augusto von Dentz } 3867d0b13706SLuiz Augusto von Dentz } 3868d0b13706SLuiz Augusto von Dentz 3869d0b13706SLuiz Augusto von Dentz if (lmp_inq_rssi_capable(hdev) || 3870d0b13706SLuiz Augusto von Dentz test_bit(HCI_QUIRK_FIXUP_INQUIRY_MODE, &hdev->quirks)) 3871d0b13706SLuiz Augusto von Dentz events[4] |= 0x02; /* Inquiry Result with RSSI */ 3872d0b13706SLuiz Augusto von Dentz 3873d0b13706SLuiz Augusto von Dentz if (lmp_ext_feat_capable(hdev)) 3874d0b13706SLuiz Augusto von Dentz events[4] |= 0x04; /* Read Remote Extended Features Complete */ 3875d0b13706SLuiz Augusto von Dentz 3876d0b13706SLuiz Augusto von Dentz if (lmp_esco_capable(hdev)) { 3877d0b13706SLuiz Augusto von Dentz events[5] |= 0x08; /* Synchronous Connection Complete */ 3878d0b13706SLuiz Augusto von Dentz events[5] |= 0x10; /* Synchronous Connection Changed */ 3879d0b13706SLuiz Augusto von Dentz } 3880d0b13706SLuiz Augusto von Dentz 3881d0b13706SLuiz Augusto von Dentz if (lmp_sniffsubr_capable(hdev)) 3882d0b13706SLuiz Augusto von Dentz events[5] |= 0x20; /* Sniff Subrating */ 3883d0b13706SLuiz Augusto von Dentz 3884d0b13706SLuiz Augusto von Dentz if (lmp_pause_enc_capable(hdev)) 3885d0b13706SLuiz Augusto von Dentz events[5] |= 0x80; /* Encryption Key Refresh Complete */ 3886d0b13706SLuiz Augusto von Dentz 3887d0b13706SLuiz Augusto von Dentz if (lmp_ext_inq_capable(hdev)) 3888d0b13706SLuiz Augusto von Dentz events[5] |= 0x40; /* Extended Inquiry Result */ 3889d0b13706SLuiz Augusto von Dentz 3890d0b13706SLuiz Augusto von Dentz if (lmp_no_flush_capable(hdev)) 3891d0b13706SLuiz Augusto von Dentz events[7] |= 0x01; /* Enhanced Flush Complete */ 3892d0b13706SLuiz Augusto von Dentz 3893d0b13706SLuiz Augusto von Dentz if (lmp_lsto_capable(hdev)) 3894d0b13706SLuiz Augusto von Dentz events[6] |= 0x80; /* Link Supervision Timeout Changed */ 3895d0b13706SLuiz Augusto von Dentz 3896d0b13706SLuiz Augusto von Dentz if (lmp_ssp_capable(hdev)) { 3897d0b13706SLuiz Augusto von Dentz events[6] |= 0x01; /* IO Capability Request */ 3898d0b13706SLuiz Augusto von Dentz events[6] |= 0x02; /* IO Capability Response */ 3899d0b13706SLuiz Augusto von Dentz events[6] |= 0x04; /* User Confirmation Request */ 3900d0b13706SLuiz Augusto von Dentz events[6] |= 0x08; /* User Passkey Request */ 3901d0b13706SLuiz Augusto von Dentz events[6] |= 0x10; /* Remote OOB Data Request */ 3902d0b13706SLuiz Augusto von Dentz events[6] |= 0x20; /* Simple Pairing Complete */ 3903d0b13706SLuiz Augusto von Dentz events[7] |= 0x04; /* User Passkey Notification */ 3904d0b13706SLuiz Augusto von Dentz events[7] |= 0x08; /* Keypress Notification */ 3905d0b13706SLuiz Augusto von Dentz events[7] |= 0x10; /* Remote Host Supported 3906d0b13706SLuiz Augusto von Dentz * Features Notification 3907d0b13706SLuiz Augusto von Dentz */ 3908d0b13706SLuiz Augusto von Dentz } 3909d0b13706SLuiz Augusto von Dentz 3910d0b13706SLuiz Augusto von Dentz if (lmp_le_capable(hdev)) 3911d0b13706SLuiz Augusto von Dentz events[7] |= 0x20; /* LE Meta-Event */ 3912d0b13706SLuiz Augusto von Dentz 3913d0b13706SLuiz Augusto von Dentz return __hci_cmd_sync_status(hdev, HCI_OP_SET_EVENT_MASK, 3914d0b13706SLuiz Augusto von Dentz sizeof(events), events, HCI_CMD_TIMEOUT); 3915d0b13706SLuiz Augusto von Dentz } 3916d0b13706SLuiz Augusto von Dentz 3917d0b13706SLuiz Augusto von Dentz static int hci_read_stored_link_key_sync(struct hci_dev *hdev) 3918d0b13706SLuiz Augusto von Dentz { 3919d0b13706SLuiz Augusto von Dentz struct hci_cp_read_stored_link_key cp; 3920d0b13706SLuiz Augusto von Dentz 3921d0b13706SLuiz Augusto von Dentz if (!(hdev->commands[6] & 0x20) || 3922d0b13706SLuiz Augusto von Dentz test_bit(HCI_QUIRK_BROKEN_STORED_LINK_KEY, &hdev->quirks)) 3923d0b13706SLuiz Augusto von Dentz return 0; 3924d0b13706SLuiz Augusto von Dentz 3925d0b13706SLuiz Augusto von Dentz memset(&cp, 0, sizeof(cp)); 3926d0b13706SLuiz Augusto von Dentz bacpy(&cp.bdaddr, BDADDR_ANY); 3927d0b13706SLuiz Augusto von Dentz cp.read_all = 0x01; 3928d0b13706SLuiz Augusto von Dentz 3929d0b13706SLuiz Augusto von Dentz return __hci_cmd_sync_status(hdev, HCI_OP_READ_STORED_LINK_KEY, 3930d0b13706SLuiz Augusto von Dentz sizeof(cp), &cp, HCI_CMD_TIMEOUT); 3931d0b13706SLuiz Augusto von Dentz } 3932d0b13706SLuiz Augusto von Dentz 3933d0b13706SLuiz Augusto von Dentz static int hci_setup_link_policy_sync(struct hci_dev *hdev) 3934d0b13706SLuiz Augusto von Dentz { 3935d0b13706SLuiz Augusto von Dentz struct hci_cp_write_def_link_policy cp; 3936d0b13706SLuiz Augusto von Dentz u16 link_policy = 0; 3937d0b13706SLuiz Augusto von Dentz 3938d0b13706SLuiz Augusto von Dentz if (!(hdev->commands[5] & 0x10)) 3939d0b13706SLuiz Augusto von Dentz return 0; 3940d0b13706SLuiz Augusto von Dentz 3941d0b13706SLuiz Augusto von Dentz memset(&cp, 0, sizeof(cp)); 3942d0b13706SLuiz Augusto von Dentz 3943d0b13706SLuiz Augusto von Dentz if (lmp_rswitch_capable(hdev)) 3944d0b13706SLuiz Augusto von Dentz link_policy |= HCI_LP_RSWITCH; 3945d0b13706SLuiz Augusto von Dentz if (lmp_hold_capable(hdev)) 3946d0b13706SLuiz Augusto von Dentz link_policy |= HCI_LP_HOLD; 3947d0b13706SLuiz Augusto von Dentz if (lmp_sniff_capable(hdev)) 3948d0b13706SLuiz Augusto von Dentz link_policy |= HCI_LP_SNIFF; 3949d0b13706SLuiz Augusto von Dentz if (lmp_park_capable(hdev)) 3950d0b13706SLuiz Augusto von Dentz link_policy |= HCI_LP_PARK; 3951d0b13706SLuiz Augusto von Dentz 3952d0b13706SLuiz Augusto von Dentz cp.policy = cpu_to_le16(link_policy); 3953d0b13706SLuiz Augusto von Dentz 3954d0b13706SLuiz Augusto von Dentz return __hci_cmd_sync_status(hdev, HCI_OP_WRITE_DEF_LINK_POLICY, 3955d0b13706SLuiz Augusto von Dentz sizeof(cp), &cp, HCI_CMD_TIMEOUT); 3956d0b13706SLuiz Augusto von Dentz } 3957d0b13706SLuiz Augusto von Dentz 3958d0b13706SLuiz Augusto von Dentz static int hci_read_page_scan_activity_sync(struct hci_dev *hdev) 3959d0b13706SLuiz Augusto von Dentz { 3960d0b13706SLuiz Augusto von Dentz if (!(hdev->commands[8] & 0x01)) 3961d0b13706SLuiz Augusto von Dentz return 0; 3962d0b13706SLuiz Augusto von Dentz 3963d0b13706SLuiz Augusto von Dentz return __hci_cmd_sync_status(hdev, HCI_OP_READ_PAGE_SCAN_ACTIVITY, 3964d0b13706SLuiz Augusto von Dentz 0, NULL, HCI_CMD_TIMEOUT); 3965d0b13706SLuiz Augusto von Dentz } 3966d0b13706SLuiz Augusto von Dentz 3967d0b13706SLuiz Augusto von Dentz static int hci_read_def_err_data_reporting_sync(struct hci_dev *hdev) 3968d0b13706SLuiz Augusto von Dentz { 3969d0b13706SLuiz Augusto von Dentz if (!(hdev->commands[18] & 0x04) || 397042d7731eSIsmael Ferreras Morezuelas !(hdev->features[0][6] & LMP_ERR_DATA_REPORTING) || 397142d7731eSIsmael Ferreras Morezuelas test_bit(HCI_QUIRK_BROKEN_ERR_DATA_REPORTING, &hdev->quirks)) 3972d0b13706SLuiz Augusto von Dentz return 0; 3973d0b13706SLuiz Augusto von Dentz 3974d0b13706SLuiz Augusto von Dentz return __hci_cmd_sync_status(hdev, HCI_OP_READ_DEF_ERR_DATA_REPORTING, 3975d0b13706SLuiz Augusto von Dentz 0, NULL, HCI_CMD_TIMEOUT); 3976d0b13706SLuiz Augusto von Dentz } 3977d0b13706SLuiz Augusto von Dentz 3978d0b13706SLuiz Augusto von Dentz static int hci_read_page_scan_type_sync(struct hci_dev *hdev) 3979d0b13706SLuiz Augusto von Dentz { 3980d0b13706SLuiz Augusto von Dentz /* Some older Broadcom based Bluetooth 1.2 controllers do not 3981d0b13706SLuiz Augusto von Dentz * support the Read Page Scan Type command. Check support for 3982d0b13706SLuiz Augusto von Dentz * this command in the bit mask of supported commands. 3983d0b13706SLuiz Augusto von Dentz */ 3984d0b13706SLuiz Augusto von Dentz if (!(hdev->commands[13] & 0x01)) 3985d0b13706SLuiz Augusto von Dentz return 0; 3986d0b13706SLuiz Augusto von Dentz 3987d0b13706SLuiz Augusto von Dentz return __hci_cmd_sync_status(hdev, HCI_OP_READ_PAGE_SCAN_TYPE, 3988d0b13706SLuiz Augusto von Dentz 0, NULL, HCI_CMD_TIMEOUT); 3989d0b13706SLuiz Augusto von Dentz } 3990d0b13706SLuiz Augusto von Dentz 3991d0b13706SLuiz Augusto von Dentz /* Read features beyond page 1 if available */ 3992d0b13706SLuiz Augusto von Dentz static int hci_read_local_ext_features_all_sync(struct hci_dev *hdev) 3993d0b13706SLuiz Augusto von Dentz { 3994d0b13706SLuiz Augusto von Dentz u8 page; 3995d0b13706SLuiz Augusto von Dentz int err; 3996d0b13706SLuiz Augusto von Dentz 3997d0b13706SLuiz Augusto von Dentz if (!lmp_ext_feat_capable(hdev)) 3998d0b13706SLuiz Augusto von Dentz return 0; 3999d0b13706SLuiz Augusto von Dentz 4000d0b13706SLuiz Augusto von Dentz for (page = 2; page < HCI_MAX_PAGES && page <= hdev->max_page; 4001d0b13706SLuiz Augusto von Dentz page++) { 4002d0b13706SLuiz Augusto von Dentz err = hci_read_local_ext_features_sync(hdev, page); 4003d0b13706SLuiz Augusto von Dentz if (err) 4004d0b13706SLuiz Augusto von Dentz return err; 4005d0b13706SLuiz Augusto von Dentz } 4006d0b13706SLuiz Augusto von Dentz 4007d0b13706SLuiz Augusto von Dentz return 0; 4008d0b13706SLuiz Augusto von Dentz } 4009d0b13706SLuiz Augusto von Dentz 4010d0b13706SLuiz Augusto von Dentz /* HCI Controller init stage 3 command sequence */ 4011d0b13706SLuiz Augusto von Dentz static const struct hci_init_stage hci_init3[] = { 4012d0b13706SLuiz Augusto von Dentz /* HCI_OP_SET_EVENT_MASK */ 4013d0b13706SLuiz Augusto von Dentz HCI_INIT(hci_set_event_mask_sync), 4014d0b13706SLuiz Augusto von Dentz /* HCI_OP_READ_STORED_LINK_KEY */ 4015d0b13706SLuiz Augusto von Dentz HCI_INIT(hci_read_stored_link_key_sync), 4016d0b13706SLuiz Augusto von Dentz /* HCI_OP_WRITE_DEF_LINK_POLICY */ 4017d0b13706SLuiz Augusto von Dentz HCI_INIT(hci_setup_link_policy_sync), 4018d0b13706SLuiz Augusto von Dentz /* HCI_OP_READ_PAGE_SCAN_ACTIVITY */ 4019d0b13706SLuiz Augusto von Dentz HCI_INIT(hci_read_page_scan_activity_sync), 4020d0b13706SLuiz Augusto von Dentz /* HCI_OP_READ_DEF_ERR_DATA_REPORTING */ 4021d0b13706SLuiz Augusto von Dentz HCI_INIT(hci_read_def_err_data_reporting_sync), 4022d0b13706SLuiz Augusto von Dentz /* HCI_OP_READ_PAGE_SCAN_TYPE */ 4023d0b13706SLuiz Augusto von Dentz HCI_INIT(hci_read_page_scan_type_sync), 4024d0b13706SLuiz Augusto von Dentz /* HCI_OP_READ_LOCAL_EXT_FEATURES */ 4025d0b13706SLuiz Augusto von Dentz HCI_INIT(hci_read_local_ext_features_all_sync), 4026d0b13706SLuiz Augusto von Dentz {} 4027d0b13706SLuiz Augusto von Dentz }; 4028d0b13706SLuiz Augusto von Dentz 4029d0b13706SLuiz Augusto von Dentz static int hci_le_set_event_mask_sync(struct hci_dev *hdev) 4030d0b13706SLuiz Augusto von Dentz { 4031d0b13706SLuiz Augusto von Dentz u8 events[8]; 4032d0b13706SLuiz Augusto von Dentz 4033d0b13706SLuiz Augusto von Dentz if (!lmp_le_capable(hdev)) 4034d0b13706SLuiz Augusto von Dentz return 0; 4035d0b13706SLuiz Augusto von Dentz 4036d0b13706SLuiz Augusto von Dentz memset(events, 0, sizeof(events)); 4037d0b13706SLuiz Augusto von Dentz 4038d0b13706SLuiz Augusto von Dentz if (hdev->le_features[0] & HCI_LE_ENCRYPTION) 4039d0b13706SLuiz Augusto von Dentz events[0] |= 0x10; /* LE Long Term Key Request */ 4040d0b13706SLuiz Augusto von Dentz 4041d0b13706SLuiz Augusto von Dentz /* If controller supports the Connection Parameters Request 4042d0b13706SLuiz Augusto von Dentz * Link Layer Procedure, enable the corresponding event. 4043d0b13706SLuiz Augusto von Dentz */ 4044d0b13706SLuiz Augusto von Dentz if (hdev->le_features[0] & HCI_LE_CONN_PARAM_REQ_PROC) 4045d0b13706SLuiz Augusto von Dentz /* LE Remote Connection Parameter Request */ 4046d0b13706SLuiz Augusto von Dentz events[0] |= 0x20; 4047d0b13706SLuiz Augusto von Dentz 4048d0b13706SLuiz Augusto von Dentz /* If the controller supports the Data Length Extension 4049d0b13706SLuiz Augusto von Dentz * feature, enable the corresponding event. 4050d0b13706SLuiz Augusto von Dentz */ 4051d0b13706SLuiz Augusto von Dentz if (hdev->le_features[0] & HCI_LE_DATA_LEN_EXT) 4052d0b13706SLuiz Augusto von Dentz events[0] |= 0x40; /* LE Data Length Change */ 4053d0b13706SLuiz Augusto von Dentz 4054a56a1138SLuiz Augusto von Dentz /* If the controller supports LL Privacy feature or LE Extended Adv, 4055a56a1138SLuiz Augusto von Dentz * enable the corresponding event. 4056d0b13706SLuiz Augusto von Dentz */ 4057a56a1138SLuiz Augusto von Dentz if (use_enhanced_conn_complete(hdev)) 4058d0b13706SLuiz Augusto von Dentz events[1] |= 0x02; /* LE Enhanced Connection Complete */ 4059d0b13706SLuiz Augusto von Dentz 4060d0b13706SLuiz Augusto von Dentz /* If the controller supports Extended Scanner Filter 4061d0b13706SLuiz Augusto von Dentz * Policies, enable the corresponding event. 4062d0b13706SLuiz Augusto von Dentz */ 4063d0b13706SLuiz Augusto von Dentz if (hdev->le_features[0] & HCI_LE_EXT_SCAN_POLICY) 4064d0b13706SLuiz Augusto von Dentz events[1] |= 0x04; /* LE Direct Advertising Report */ 4065d0b13706SLuiz Augusto von Dentz 4066d0b13706SLuiz Augusto von Dentz /* If the controller supports Channel Selection Algorithm #2 4067d0b13706SLuiz Augusto von Dentz * feature, enable the corresponding event. 4068d0b13706SLuiz Augusto von Dentz */ 4069d0b13706SLuiz Augusto von Dentz if (hdev->le_features[1] & HCI_LE_CHAN_SEL_ALG2) 4070d0b13706SLuiz Augusto von Dentz events[2] |= 0x08; /* LE Channel Selection Algorithm */ 4071d0b13706SLuiz Augusto von Dentz 4072d0b13706SLuiz Augusto von Dentz /* If the controller supports the LE Set Scan Enable command, 4073d0b13706SLuiz Augusto von Dentz * enable the corresponding advertising report event. 4074d0b13706SLuiz Augusto von Dentz */ 4075d0b13706SLuiz Augusto von Dentz if (hdev->commands[26] & 0x08) 4076d0b13706SLuiz Augusto von Dentz events[0] |= 0x02; /* LE Advertising Report */ 4077d0b13706SLuiz Augusto von Dentz 4078d0b13706SLuiz Augusto von Dentz /* If the controller supports the LE Create Connection 4079d0b13706SLuiz Augusto von Dentz * command, enable the corresponding event. 4080d0b13706SLuiz Augusto von Dentz */ 4081d0b13706SLuiz Augusto von Dentz if (hdev->commands[26] & 0x10) 4082d0b13706SLuiz Augusto von Dentz events[0] |= 0x01; /* LE Connection Complete */ 4083d0b13706SLuiz Augusto von Dentz 4084d0b13706SLuiz Augusto von Dentz /* If the controller supports the LE Connection Update 4085d0b13706SLuiz Augusto von Dentz * command, enable the corresponding event. 4086d0b13706SLuiz Augusto von Dentz */ 4087d0b13706SLuiz Augusto von Dentz if (hdev->commands[27] & 0x04) 4088d0b13706SLuiz Augusto von Dentz events[0] |= 0x04; /* LE Connection Update Complete */ 4089d0b13706SLuiz Augusto von Dentz 4090d0b13706SLuiz Augusto von Dentz /* If the controller supports the LE Read Remote Used Features 4091d0b13706SLuiz Augusto von Dentz * command, enable the corresponding event. 4092d0b13706SLuiz Augusto von Dentz */ 4093d0b13706SLuiz Augusto von Dentz if (hdev->commands[27] & 0x20) 4094d0b13706SLuiz Augusto von Dentz /* LE Read Remote Used Features Complete */ 4095d0b13706SLuiz Augusto von Dentz events[0] |= 0x08; 4096d0b13706SLuiz Augusto von Dentz 4097d0b13706SLuiz Augusto von Dentz /* If the controller supports the LE Read Local P-256 4098d0b13706SLuiz Augusto von Dentz * Public Key command, enable the corresponding event. 4099d0b13706SLuiz Augusto von Dentz */ 4100d0b13706SLuiz Augusto von Dentz if (hdev->commands[34] & 0x02) 4101d0b13706SLuiz Augusto von Dentz /* LE Read Local P-256 Public Key Complete */ 4102d0b13706SLuiz Augusto von Dentz events[0] |= 0x80; 4103d0b13706SLuiz Augusto von Dentz 4104d0b13706SLuiz Augusto von Dentz /* If the controller supports the LE Generate DHKey 4105d0b13706SLuiz Augusto von Dentz * command, enable the corresponding event. 4106d0b13706SLuiz Augusto von Dentz */ 4107d0b13706SLuiz Augusto von Dentz if (hdev->commands[34] & 0x04) 4108d0b13706SLuiz Augusto von Dentz events[1] |= 0x01; /* LE Generate DHKey Complete */ 4109d0b13706SLuiz Augusto von Dentz 4110d0b13706SLuiz Augusto von Dentz /* If the controller supports the LE Set Default PHY or 4111d0b13706SLuiz Augusto von Dentz * LE Set PHY commands, enable the corresponding event. 4112d0b13706SLuiz Augusto von Dentz */ 4113d0b13706SLuiz Augusto von Dentz if (hdev->commands[35] & (0x20 | 0x40)) 4114d0b13706SLuiz Augusto von Dentz events[1] |= 0x08; /* LE PHY Update Complete */ 4115d0b13706SLuiz Augusto von Dentz 4116d0b13706SLuiz Augusto von Dentz /* If the controller supports LE Set Extended Scan Parameters 4117d0b13706SLuiz Augusto von Dentz * and LE Set Extended Scan Enable commands, enable the 4118d0b13706SLuiz Augusto von Dentz * corresponding event. 4119d0b13706SLuiz Augusto von Dentz */ 4120d0b13706SLuiz Augusto von Dentz if (use_ext_scan(hdev)) 4121d0b13706SLuiz Augusto von Dentz events[1] |= 0x10; /* LE Extended Advertising Report */ 4122d0b13706SLuiz Augusto von Dentz 4123d0b13706SLuiz Augusto von Dentz /* If the controller supports the LE Extended Advertising 4124d0b13706SLuiz Augusto von Dentz * command, enable the corresponding event. 4125d0b13706SLuiz Augusto von Dentz */ 4126d0b13706SLuiz Augusto von Dentz if (ext_adv_capable(hdev)) 4127d0b13706SLuiz Augusto von Dentz events[2] |= 0x02; /* LE Advertising Set Terminated */ 4128d0b13706SLuiz Augusto von Dentz 412926afbd82SLuiz Augusto von Dentz if (cis_capable(hdev)) { 413026afbd82SLuiz Augusto von Dentz events[3] |= 0x01; /* LE CIS Established */ 413126afbd82SLuiz Augusto von Dentz if (cis_peripheral_capable(hdev)) 413226afbd82SLuiz Augusto von Dentz events[3] |= 0x02; /* LE CIS Request */ 413326afbd82SLuiz Augusto von Dentz } 413426afbd82SLuiz Augusto von Dentz 4135eca0ae4aSLuiz Augusto von Dentz if (bis_capable(hdev)) { 4136c33362a5SClaudia Draghicescu events[1] |= 0x20; /* LE PA Report */ 4137c33362a5SClaudia Draghicescu events[1] |= 0x40; /* LE PA Sync Established */ 4138eca0ae4aSLuiz Augusto von Dentz events[3] |= 0x04; /* LE Create BIG Complete */ 4139eca0ae4aSLuiz Augusto von Dentz events[3] |= 0x08; /* LE Terminate BIG Complete */ 4140eca0ae4aSLuiz Augusto von Dentz events[3] |= 0x10; /* LE BIG Sync Established */ 4141eca0ae4aSLuiz Augusto von Dentz events[3] |= 0x20; /* LE BIG Sync Loss */ 4142c33362a5SClaudia Draghicescu events[4] |= 0x02; /* LE BIG Info Advertising Report */ 4143eca0ae4aSLuiz Augusto von Dentz } 4144eca0ae4aSLuiz Augusto von Dentz 4145d0b13706SLuiz Augusto von Dentz return __hci_cmd_sync_status(hdev, HCI_OP_LE_SET_EVENT_MASK, 4146d0b13706SLuiz Augusto von Dentz sizeof(events), events, HCI_CMD_TIMEOUT); 4147d0b13706SLuiz Augusto von Dentz } 4148d0b13706SLuiz Augusto von Dentz 4149d0b13706SLuiz Augusto von Dentz /* Read LE Advertising Channel TX Power */ 4150d0b13706SLuiz Augusto von Dentz static int hci_le_read_adv_tx_power_sync(struct hci_dev *hdev) 4151d0b13706SLuiz Augusto von Dentz { 4152d0b13706SLuiz Augusto von Dentz if ((hdev->commands[25] & 0x40) && !ext_adv_capable(hdev)) { 4153d0b13706SLuiz Augusto von Dentz /* HCI TS spec forbids mixing of legacy and extended 4154d0b13706SLuiz Augusto von Dentz * advertising commands wherein READ_ADV_TX_POWER is 4155d0b13706SLuiz Augusto von Dentz * also included. So do not call it if extended adv 4156d0b13706SLuiz Augusto von Dentz * is supported otherwise controller will return 4157d0b13706SLuiz Augusto von Dentz * COMMAND_DISALLOWED for extended commands. 4158d0b13706SLuiz Augusto von Dentz */ 4159d0b13706SLuiz Augusto von Dentz return __hci_cmd_sync_status(hdev, 4160d0b13706SLuiz Augusto von Dentz HCI_OP_LE_READ_ADV_TX_POWER, 4161d0b13706SLuiz Augusto von Dentz 0, NULL, HCI_CMD_TIMEOUT); 4162d0b13706SLuiz Augusto von Dentz } 4163d0b13706SLuiz Augusto von Dentz 4164d0b13706SLuiz Augusto von Dentz return 0; 4165d0b13706SLuiz Augusto von Dentz } 4166d0b13706SLuiz Augusto von Dentz 4167d0b13706SLuiz Augusto von Dentz /* Read LE Min/Max Tx Power*/ 4168d0b13706SLuiz Augusto von Dentz static int hci_le_read_tx_power_sync(struct hci_dev *hdev) 4169d0b13706SLuiz Augusto von Dentz { 4170d2f8114fSAditya Garg if (!(hdev->commands[38] & 0x80) || 4171d2f8114fSAditya Garg test_bit(HCI_QUIRK_BROKEN_READ_TRANSMIT_POWER, &hdev->quirks)) 4172d0b13706SLuiz Augusto von Dentz return 0; 4173d0b13706SLuiz Augusto von Dentz 4174d0b13706SLuiz Augusto von Dentz return __hci_cmd_sync_status(hdev, HCI_OP_LE_READ_TRANSMIT_POWER, 4175d0b13706SLuiz Augusto von Dentz 0, NULL, HCI_CMD_TIMEOUT); 4176d0b13706SLuiz Augusto von Dentz } 4177d0b13706SLuiz Augusto von Dentz 4178d0b13706SLuiz Augusto von Dentz /* Read LE Accept List Size */ 4179d0b13706SLuiz Augusto von Dentz static int hci_le_read_accept_list_size_sync(struct hci_dev *hdev) 4180d0b13706SLuiz Augusto von Dentz { 4181d0b13706SLuiz Augusto von Dentz if (!(hdev->commands[26] & 0x40)) 4182d0b13706SLuiz Augusto von Dentz return 0; 4183d0b13706SLuiz Augusto von Dentz 4184d0b13706SLuiz Augusto von Dentz return __hci_cmd_sync_status(hdev, HCI_OP_LE_READ_ACCEPT_LIST_SIZE, 4185d0b13706SLuiz Augusto von Dentz 0, NULL, HCI_CMD_TIMEOUT); 4186d0b13706SLuiz Augusto von Dentz } 4187d0b13706SLuiz Augusto von Dentz 4188d0b13706SLuiz Augusto von Dentz /* Clear LE Accept List */ 4189d0b13706SLuiz Augusto von Dentz static int hci_le_clear_accept_list_sync(struct hci_dev *hdev) 4190d0b13706SLuiz Augusto von Dentz { 4191d0b13706SLuiz Augusto von Dentz if (!(hdev->commands[26] & 0x80)) 4192d0b13706SLuiz Augusto von Dentz return 0; 4193d0b13706SLuiz Augusto von Dentz 4194d0b13706SLuiz Augusto von Dentz return __hci_cmd_sync_status(hdev, HCI_OP_LE_CLEAR_ACCEPT_LIST, 0, NULL, 4195d0b13706SLuiz Augusto von Dentz HCI_CMD_TIMEOUT); 4196d0b13706SLuiz Augusto von Dentz } 4197d0b13706SLuiz Augusto von Dentz 4198d0b13706SLuiz Augusto von Dentz /* Read LE Resolving List Size */ 4199d0b13706SLuiz Augusto von Dentz static int hci_le_read_resolv_list_size_sync(struct hci_dev *hdev) 4200d0b13706SLuiz Augusto von Dentz { 4201d0b13706SLuiz Augusto von Dentz if (!(hdev->commands[34] & 0x40)) 4202d0b13706SLuiz Augusto von Dentz return 0; 4203d0b13706SLuiz Augusto von Dentz 4204d0b13706SLuiz Augusto von Dentz return __hci_cmd_sync_status(hdev, HCI_OP_LE_READ_RESOLV_LIST_SIZE, 4205d0b13706SLuiz Augusto von Dentz 0, NULL, HCI_CMD_TIMEOUT); 4206d0b13706SLuiz Augusto von Dentz } 4207d0b13706SLuiz Augusto von Dentz 4208d0b13706SLuiz Augusto von Dentz /* Clear LE Resolving List */ 4209d0b13706SLuiz Augusto von Dentz static int hci_le_clear_resolv_list_sync(struct hci_dev *hdev) 4210d0b13706SLuiz Augusto von Dentz { 4211d0b13706SLuiz Augusto von Dentz if (!(hdev->commands[34] & 0x20)) 4212d0b13706SLuiz Augusto von Dentz return 0; 4213d0b13706SLuiz Augusto von Dentz 4214d0b13706SLuiz Augusto von Dentz return __hci_cmd_sync_status(hdev, HCI_OP_LE_CLEAR_RESOLV_LIST, 0, NULL, 4215d0b13706SLuiz Augusto von Dentz HCI_CMD_TIMEOUT); 4216d0b13706SLuiz Augusto von Dentz } 4217d0b13706SLuiz Augusto von Dentz 4218d0b13706SLuiz Augusto von Dentz /* Set RPA timeout */ 4219d0b13706SLuiz Augusto von Dentz static int hci_le_set_rpa_timeout_sync(struct hci_dev *hdev) 4220d0b13706SLuiz Augusto von Dentz { 4221d0b13706SLuiz Augusto von Dentz __le16 timeout = cpu_to_le16(hdev->rpa_timeout); 4222d0b13706SLuiz Augusto von Dentz 422391b6d02dSRaul Cheleguini if (!(hdev->commands[35] & 0x04) || 422491b6d02dSRaul Cheleguini test_bit(HCI_QUIRK_BROKEN_SET_RPA_TIMEOUT, &hdev->quirks)) 4225d0b13706SLuiz Augusto von Dentz return 0; 4226d0b13706SLuiz Augusto von Dentz 4227d0b13706SLuiz Augusto von Dentz return __hci_cmd_sync_status(hdev, HCI_OP_LE_SET_RPA_TIMEOUT, 4228d0b13706SLuiz Augusto von Dentz sizeof(timeout), &timeout, 4229d0b13706SLuiz Augusto von Dentz HCI_CMD_TIMEOUT); 4230d0b13706SLuiz Augusto von Dentz } 4231d0b13706SLuiz Augusto von Dentz 4232d0b13706SLuiz Augusto von Dentz /* Read LE Maximum Data Length */ 4233d0b13706SLuiz Augusto von Dentz static int hci_le_read_max_data_len_sync(struct hci_dev *hdev) 4234d0b13706SLuiz Augusto von Dentz { 4235d0b13706SLuiz Augusto von Dentz if (!(hdev->le_features[0] & HCI_LE_DATA_LEN_EXT)) 4236d0b13706SLuiz Augusto von Dentz return 0; 4237d0b13706SLuiz Augusto von Dentz 4238d0b13706SLuiz Augusto von Dentz return __hci_cmd_sync_status(hdev, HCI_OP_LE_READ_MAX_DATA_LEN, 0, NULL, 4239d0b13706SLuiz Augusto von Dentz HCI_CMD_TIMEOUT); 4240d0b13706SLuiz Augusto von Dentz } 4241d0b13706SLuiz Augusto von Dentz 4242d0b13706SLuiz Augusto von Dentz /* Read LE Suggested Default Data Length */ 4243d0b13706SLuiz Augusto von Dentz static int hci_le_read_def_data_len_sync(struct hci_dev *hdev) 4244d0b13706SLuiz Augusto von Dentz { 4245d0b13706SLuiz Augusto von Dentz if (!(hdev->le_features[0] & HCI_LE_DATA_LEN_EXT)) 4246d0b13706SLuiz Augusto von Dentz return 0; 4247d0b13706SLuiz Augusto von Dentz 4248d0b13706SLuiz Augusto von Dentz return __hci_cmd_sync_status(hdev, HCI_OP_LE_READ_DEF_DATA_LEN, 0, NULL, 4249d0b13706SLuiz Augusto von Dentz HCI_CMD_TIMEOUT); 4250d0b13706SLuiz Augusto von Dentz } 4251d0b13706SLuiz Augusto von Dentz 4252d0b13706SLuiz Augusto von Dentz /* Read LE Number of Supported Advertising Sets */ 4253d0b13706SLuiz Augusto von Dentz static int hci_le_read_num_support_adv_sets_sync(struct hci_dev *hdev) 4254d0b13706SLuiz Augusto von Dentz { 4255d0b13706SLuiz Augusto von Dentz if (!ext_adv_capable(hdev)) 4256d0b13706SLuiz Augusto von Dentz return 0; 4257d0b13706SLuiz Augusto von Dentz 4258d0b13706SLuiz Augusto von Dentz return __hci_cmd_sync_status(hdev, 4259d0b13706SLuiz Augusto von Dentz HCI_OP_LE_READ_NUM_SUPPORTED_ADV_SETS, 4260d0b13706SLuiz Augusto von Dentz 0, NULL, HCI_CMD_TIMEOUT); 4261d0b13706SLuiz Augusto von Dentz } 4262d0b13706SLuiz Augusto von Dentz 4263d0b13706SLuiz Augusto von Dentz /* Write LE Host Supported */ 4264d0b13706SLuiz Augusto von Dentz static int hci_set_le_support_sync(struct hci_dev *hdev) 4265d0b13706SLuiz Augusto von Dentz { 4266d0b13706SLuiz Augusto von Dentz struct hci_cp_write_le_host_supported cp; 4267d0b13706SLuiz Augusto von Dentz 4268d0b13706SLuiz Augusto von Dentz /* LE-only devices do not support explicit enablement */ 4269d0b13706SLuiz Augusto von Dentz if (!lmp_bredr_capable(hdev)) 4270d0b13706SLuiz Augusto von Dentz return 0; 4271d0b13706SLuiz Augusto von Dentz 4272d0b13706SLuiz Augusto von Dentz memset(&cp, 0, sizeof(cp)); 4273d0b13706SLuiz Augusto von Dentz 4274d0b13706SLuiz Augusto von Dentz if (hci_dev_test_flag(hdev, HCI_LE_ENABLED)) { 4275d0b13706SLuiz Augusto von Dentz cp.le = 0x01; 4276d0b13706SLuiz Augusto von Dentz cp.simul = 0x00; 4277d0b13706SLuiz Augusto von Dentz } 4278d0b13706SLuiz Augusto von Dentz 4279d0b13706SLuiz Augusto von Dentz if (cp.le == lmp_host_le_capable(hdev)) 4280d0b13706SLuiz Augusto von Dentz return 0; 4281d0b13706SLuiz Augusto von Dentz 4282d0b13706SLuiz Augusto von Dentz return __hci_cmd_sync_status(hdev, HCI_OP_WRITE_LE_HOST_SUPPORTED, 4283d0b13706SLuiz Augusto von Dentz sizeof(cp), &cp, HCI_CMD_TIMEOUT); 4284d0b13706SLuiz Augusto von Dentz } 4285d0b13706SLuiz Augusto von Dentz 428626afbd82SLuiz Augusto von Dentz /* LE Set Host Feature */ 428726afbd82SLuiz Augusto von Dentz static int hci_le_set_host_feature_sync(struct hci_dev *hdev) 428826afbd82SLuiz Augusto von Dentz { 428926afbd82SLuiz Augusto von Dentz struct hci_cp_le_set_host_feature cp; 429026afbd82SLuiz Augusto von Dentz 429126afbd82SLuiz Augusto von Dentz if (!iso_capable(hdev)) 429226afbd82SLuiz Augusto von Dentz return 0; 429326afbd82SLuiz Augusto von Dentz 429426afbd82SLuiz Augusto von Dentz memset(&cp, 0, sizeof(cp)); 429526afbd82SLuiz Augusto von Dentz 429626afbd82SLuiz Augusto von Dentz /* Isochronous Channels (Host Support) */ 429726afbd82SLuiz Augusto von Dentz cp.bit_number = 32; 429826afbd82SLuiz Augusto von Dentz cp.bit_value = 1; 429926afbd82SLuiz Augusto von Dentz 430026afbd82SLuiz Augusto von Dentz return __hci_cmd_sync_status(hdev, HCI_OP_LE_SET_HOST_FEATURE, 430126afbd82SLuiz Augusto von Dentz sizeof(cp), &cp, HCI_CMD_TIMEOUT); 430226afbd82SLuiz Augusto von Dentz } 430326afbd82SLuiz Augusto von Dentz 4304d0b13706SLuiz Augusto von Dentz /* LE Controller init stage 3 command sequence */ 4305d0b13706SLuiz Augusto von Dentz static const struct hci_init_stage le_init3[] = { 4306d0b13706SLuiz Augusto von Dentz /* HCI_OP_LE_SET_EVENT_MASK */ 4307d0b13706SLuiz Augusto von Dentz HCI_INIT(hci_le_set_event_mask_sync), 4308d0b13706SLuiz Augusto von Dentz /* HCI_OP_LE_READ_ADV_TX_POWER */ 4309d0b13706SLuiz Augusto von Dentz HCI_INIT(hci_le_read_adv_tx_power_sync), 4310d0b13706SLuiz Augusto von Dentz /* HCI_OP_LE_READ_TRANSMIT_POWER */ 4311d0b13706SLuiz Augusto von Dentz HCI_INIT(hci_le_read_tx_power_sync), 4312d0b13706SLuiz Augusto von Dentz /* HCI_OP_LE_READ_ACCEPT_LIST_SIZE */ 4313d0b13706SLuiz Augusto von Dentz HCI_INIT(hci_le_read_accept_list_size_sync), 4314d0b13706SLuiz Augusto von Dentz /* HCI_OP_LE_CLEAR_ACCEPT_LIST */ 4315d0b13706SLuiz Augusto von Dentz HCI_INIT(hci_le_clear_accept_list_sync), 4316d0b13706SLuiz Augusto von Dentz /* HCI_OP_LE_READ_RESOLV_LIST_SIZE */ 4317d0b13706SLuiz Augusto von Dentz HCI_INIT(hci_le_read_resolv_list_size_sync), 4318d0b13706SLuiz Augusto von Dentz /* HCI_OP_LE_CLEAR_RESOLV_LIST */ 4319d0b13706SLuiz Augusto von Dentz HCI_INIT(hci_le_clear_resolv_list_sync), 4320d0b13706SLuiz Augusto von Dentz /* HCI_OP_LE_SET_RPA_TIMEOUT */ 4321d0b13706SLuiz Augusto von Dentz HCI_INIT(hci_le_set_rpa_timeout_sync), 4322d0b13706SLuiz Augusto von Dentz /* HCI_OP_LE_READ_MAX_DATA_LEN */ 4323d0b13706SLuiz Augusto von Dentz HCI_INIT(hci_le_read_max_data_len_sync), 4324d0b13706SLuiz Augusto von Dentz /* HCI_OP_LE_READ_DEF_DATA_LEN */ 4325d0b13706SLuiz Augusto von Dentz HCI_INIT(hci_le_read_def_data_len_sync), 4326d0b13706SLuiz Augusto von Dentz /* HCI_OP_LE_READ_NUM_SUPPORTED_ADV_SETS */ 4327d0b13706SLuiz Augusto von Dentz HCI_INIT(hci_le_read_num_support_adv_sets_sync), 4328d0b13706SLuiz Augusto von Dentz /* HCI_OP_WRITE_LE_HOST_SUPPORTED */ 4329d0b13706SLuiz Augusto von Dentz HCI_INIT(hci_set_le_support_sync), 433026afbd82SLuiz Augusto von Dentz /* HCI_OP_LE_SET_HOST_FEATURE */ 433126afbd82SLuiz Augusto von Dentz HCI_INIT(hci_le_set_host_feature_sync), 4332d0b13706SLuiz Augusto von Dentz {} 4333d0b13706SLuiz Augusto von Dentz }; 4334d0b13706SLuiz Augusto von Dentz 4335d0b13706SLuiz Augusto von Dentz static int hci_init3_sync(struct hci_dev *hdev) 4336d0b13706SLuiz Augusto von Dentz { 4337d0b13706SLuiz Augusto von Dentz int err; 4338d0b13706SLuiz Augusto von Dentz 4339d0b13706SLuiz Augusto von Dentz bt_dev_dbg(hdev, ""); 4340d0b13706SLuiz Augusto von Dentz 4341d0b13706SLuiz Augusto von Dentz err = hci_init_stage_sync(hdev, hci_init3); 4342d0b13706SLuiz Augusto von Dentz if (err) 4343d0b13706SLuiz Augusto von Dentz return err; 4344d0b13706SLuiz Augusto von Dentz 4345d0b13706SLuiz Augusto von Dentz if (lmp_le_capable(hdev)) 4346d0b13706SLuiz Augusto von Dentz return hci_init_stage_sync(hdev, le_init3); 4347d0b13706SLuiz Augusto von Dentz 4348d0b13706SLuiz Augusto von Dentz return 0; 4349d0b13706SLuiz Augusto von Dentz } 4350d0b13706SLuiz Augusto von Dentz 4351d0b13706SLuiz Augusto von Dentz static int hci_delete_stored_link_key_sync(struct hci_dev *hdev) 4352d0b13706SLuiz Augusto von Dentz { 4353d0b13706SLuiz Augusto von Dentz struct hci_cp_delete_stored_link_key cp; 4354d0b13706SLuiz Augusto von Dentz 4355d0b13706SLuiz Augusto von Dentz /* Some Broadcom based Bluetooth controllers do not support the 4356d0b13706SLuiz Augusto von Dentz * Delete Stored Link Key command. They are clearly indicating its 4357d0b13706SLuiz Augusto von Dentz * absence in the bit mask of supported commands. 4358d0b13706SLuiz Augusto von Dentz * 4359d0b13706SLuiz Augusto von Dentz * Check the supported commands and only if the command is marked 4360d0b13706SLuiz Augusto von Dentz * as supported send it. If not supported assume that the controller 4361d0b13706SLuiz Augusto von Dentz * does not have actual support for stored link keys which makes this 4362d0b13706SLuiz Augusto von Dentz * command redundant anyway. 4363d0b13706SLuiz Augusto von Dentz * 4364d0b13706SLuiz Augusto von Dentz * Some controllers indicate that they support handling deleting 4365d0b13706SLuiz Augusto von Dentz * stored link keys, but they don't. The quirk lets a driver 4366d0b13706SLuiz Augusto von Dentz * just disable this command. 4367d0b13706SLuiz Augusto von Dentz */ 4368d0b13706SLuiz Augusto von Dentz if (!(hdev->commands[6] & 0x80) || 4369d0b13706SLuiz Augusto von Dentz test_bit(HCI_QUIRK_BROKEN_STORED_LINK_KEY, &hdev->quirks)) 4370d0b13706SLuiz Augusto von Dentz return 0; 4371d0b13706SLuiz Augusto von Dentz 4372d0b13706SLuiz Augusto von Dentz memset(&cp, 0, sizeof(cp)); 4373d0b13706SLuiz Augusto von Dentz bacpy(&cp.bdaddr, BDADDR_ANY); 4374d0b13706SLuiz Augusto von Dentz cp.delete_all = 0x01; 4375d0b13706SLuiz Augusto von Dentz 4376d0b13706SLuiz Augusto von Dentz return __hci_cmd_sync_status(hdev, HCI_OP_DELETE_STORED_LINK_KEY, 4377d0b13706SLuiz Augusto von Dentz sizeof(cp), &cp, HCI_CMD_TIMEOUT); 4378d0b13706SLuiz Augusto von Dentz } 4379d0b13706SLuiz Augusto von Dentz 4380d0b13706SLuiz Augusto von Dentz static int hci_set_event_mask_page_2_sync(struct hci_dev *hdev) 4381d0b13706SLuiz Augusto von Dentz { 4382d0b13706SLuiz Augusto von Dentz u8 events[8] = { 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00 }; 4383d0b13706SLuiz Augusto von Dentz bool changed = false; 4384d0b13706SLuiz Augusto von Dentz 4385d0b13706SLuiz Augusto von Dentz /* Set event mask page 2 if the HCI command for it is supported */ 4386d0b13706SLuiz Augusto von Dentz if (!(hdev->commands[22] & 0x04)) 4387d0b13706SLuiz Augusto von Dentz return 0; 4388d0b13706SLuiz Augusto von Dentz 4389d0b13706SLuiz Augusto von Dentz /* If Connectionless Peripheral Broadcast central role is supported 4390d0b13706SLuiz Augusto von Dentz * enable all necessary events for it. 4391d0b13706SLuiz Augusto von Dentz */ 4392d0b13706SLuiz Augusto von Dentz if (lmp_cpb_central_capable(hdev)) { 4393d0b13706SLuiz Augusto von Dentz events[1] |= 0x40; /* Triggered Clock Capture */ 4394d0b13706SLuiz Augusto von Dentz events[1] |= 0x80; /* Synchronization Train Complete */ 43950feb8af0SZijun Hu events[2] |= 0x08; /* Truncated Page Complete */ 4396d0b13706SLuiz Augusto von Dentz events[2] |= 0x20; /* CPB Channel Map Change */ 4397d0b13706SLuiz Augusto von Dentz changed = true; 4398d0b13706SLuiz Augusto von Dentz } 4399d0b13706SLuiz Augusto von Dentz 4400d0b13706SLuiz Augusto von Dentz /* If Connectionless Peripheral Broadcast peripheral role is supported 4401d0b13706SLuiz Augusto von Dentz * enable all necessary events for it. 4402d0b13706SLuiz Augusto von Dentz */ 4403d0b13706SLuiz Augusto von Dentz if (lmp_cpb_peripheral_capable(hdev)) { 4404d0b13706SLuiz Augusto von Dentz events[2] |= 0x01; /* Synchronization Train Received */ 4405d0b13706SLuiz Augusto von Dentz events[2] |= 0x02; /* CPB Receive */ 4406d0b13706SLuiz Augusto von Dentz events[2] |= 0x04; /* CPB Timeout */ 44070feb8af0SZijun Hu events[2] |= 0x10; /* Peripheral Page Response Timeout */ 4408d0b13706SLuiz Augusto von Dentz changed = true; 4409d0b13706SLuiz Augusto von Dentz } 4410d0b13706SLuiz Augusto von Dentz 4411d0b13706SLuiz Augusto von Dentz /* Enable Authenticated Payload Timeout Expired event if supported */ 4412d0b13706SLuiz Augusto von Dentz if (lmp_ping_capable(hdev) || hdev->le_features[0] & HCI_LE_PING) { 4413d0b13706SLuiz Augusto von Dentz events[2] |= 0x80; 4414d0b13706SLuiz Augusto von Dentz changed = true; 4415d0b13706SLuiz Augusto von Dentz } 4416d0b13706SLuiz Augusto von Dentz 4417d0b13706SLuiz Augusto von Dentz /* Some Broadcom based controllers indicate support for Set Event 4418d0b13706SLuiz Augusto von Dentz * Mask Page 2 command, but then actually do not support it. Since 4419d0b13706SLuiz Augusto von Dentz * the default value is all bits set to zero, the command is only 4420d0b13706SLuiz Augusto von Dentz * required if the event mask has to be changed. In case no change 4421d0b13706SLuiz Augusto von Dentz * to the event mask is needed, skip this command. 4422d0b13706SLuiz Augusto von Dentz */ 4423d0b13706SLuiz Augusto von Dentz if (!changed) 4424d0b13706SLuiz Augusto von Dentz return 0; 4425d0b13706SLuiz Augusto von Dentz 4426d0b13706SLuiz Augusto von Dentz return __hci_cmd_sync_status(hdev, HCI_OP_SET_EVENT_MASK_PAGE_2, 4427d0b13706SLuiz Augusto von Dentz sizeof(events), events, HCI_CMD_TIMEOUT); 4428d0b13706SLuiz Augusto von Dentz } 4429d0b13706SLuiz Augusto von Dentz 4430d0b13706SLuiz Augusto von Dentz /* Read local codec list if the HCI command is supported */ 4431d0b13706SLuiz Augusto von Dentz static int hci_read_local_codecs_sync(struct hci_dev *hdev) 4432d0b13706SLuiz Augusto von Dentz { 4433828cea2bSChethan T N if (hdev->commands[45] & 0x04) 4434828cea2bSChethan T N hci_read_supported_codecs_v2(hdev); 4435828cea2bSChethan T N else if (hdev->commands[29] & 0x20) 4436828cea2bSChethan T N hci_read_supported_codecs(hdev); 4437d0b13706SLuiz Augusto von Dentz 4438828cea2bSChethan T N return 0; 4439d0b13706SLuiz Augusto von Dentz } 4440d0b13706SLuiz Augusto von Dentz 4441d0b13706SLuiz Augusto von Dentz /* Read local pairing options if the HCI command is supported */ 4442d0b13706SLuiz Augusto von Dentz static int hci_read_local_pairing_opts_sync(struct hci_dev *hdev) 4443d0b13706SLuiz Augusto von Dentz { 4444d0b13706SLuiz Augusto von Dentz if (!(hdev->commands[41] & 0x08)) 4445d0b13706SLuiz Augusto von Dentz return 0; 4446d0b13706SLuiz Augusto von Dentz 4447d0b13706SLuiz Augusto von Dentz return __hci_cmd_sync_status(hdev, HCI_OP_READ_LOCAL_PAIRING_OPTS, 4448d0b13706SLuiz Augusto von Dentz 0, NULL, HCI_CMD_TIMEOUT); 4449d0b13706SLuiz Augusto von Dentz } 4450d0b13706SLuiz Augusto von Dentz 4451d0b13706SLuiz Augusto von Dentz /* Get MWS transport configuration if the HCI command is supported */ 4452d0b13706SLuiz Augusto von Dentz static int hci_get_mws_transport_config_sync(struct hci_dev *hdev) 4453d0b13706SLuiz Augusto von Dentz { 4454ffcb0a44SSven Peter if (!mws_transport_config_capable(hdev)) 4455d0b13706SLuiz Augusto von Dentz return 0; 4456d0b13706SLuiz Augusto von Dentz 4457d0b13706SLuiz Augusto von Dentz return __hci_cmd_sync_status(hdev, HCI_OP_GET_MWS_TRANSPORT_CONFIG, 4458d0b13706SLuiz Augusto von Dentz 0, NULL, HCI_CMD_TIMEOUT); 4459d0b13706SLuiz Augusto von Dentz } 4460d0b13706SLuiz Augusto von Dentz 4461d0b13706SLuiz Augusto von Dentz /* Check for Synchronization Train support */ 4462d0b13706SLuiz Augusto von Dentz static int hci_read_sync_train_params_sync(struct hci_dev *hdev) 4463d0b13706SLuiz Augusto von Dentz { 4464d0b13706SLuiz Augusto von Dentz if (!lmp_sync_train_capable(hdev)) 4465d0b13706SLuiz Augusto von Dentz return 0; 4466d0b13706SLuiz Augusto von Dentz 4467d0b13706SLuiz Augusto von Dentz return __hci_cmd_sync_status(hdev, HCI_OP_READ_SYNC_TRAIN_PARAMS, 4468d0b13706SLuiz Augusto von Dentz 0, NULL, HCI_CMD_TIMEOUT); 4469d0b13706SLuiz Augusto von Dentz } 4470d0b13706SLuiz Augusto von Dentz 4471d0b13706SLuiz Augusto von Dentz /* Enable Secure Connections if supported and configured */ 4472d0b13706SLuiz Augusto von Dentz static int hci_write_sc_support_1_sync(struct hci_dev *hdev) 4473d0b13706SLuiz Augusto von Dentz { 4474d0b13706SLuiz Augusto von Dentz u8 support = 0x01; 4475d0b13706SLuiz Augusto von Dentz 4476d0b13706SLuiz Augusto von Dentz if (!hci_dev_test_flag(hdev, HCI_SSP_ENABLED) || 4477d0b13706SLuiz Augusto von Dentz !bredr_sc_enabled(hdev)) 4478d0b13706SLuiz Augusto von Dentz return 0; 4479d0b13706SLuiz Augusto von Dentz 4480d0b13706SLuiz Augusto von Dentz return __hci_cmd_sync_status(hdev, HCI_OP_WRITE_SC_SUPPORT, 4481d0b13706SLuiz Augusto von Dentz sizeof(support), &support, 4482d0b13706SLuiz Augusto von Dentz HCI_CMD_TIMEOUT); 4483d0b13706SLuiz Augusto von Dentz } 4484d0b13706SLuiz Augusto von Dentz 4485d0b13706SLuiz Augusto von Dentz /* Set erroneous data reporting if supported to the wideband speech 4486d0b13706SLuiz Augusto von Dentz * setting value 4487d0b13706SLuiz Augusto von Dentz */ 4488d0b13706SLuiz Augusto von Dentz static int hci_set_err_data_report_sync(struct hci_dev *hdev) 4489d0b13706SLuiz Augusto von Dentz { 4490d0b13706SLuiz Augusto von Dentz struct hci_cp_write_def_err_data_reporting cp; 4491d0b13706SLuiz Augusto von Dentz bool enabled = hci_dev_test_flag(hdev, HCI_WIDEBAND_SPEECH_ENABLED); 4492d0b13706SLuiz Augusto von Dentz 4493d0b13706SLuiz Augusto von Dentz if (!(hdev->commands[18] & 0x08) || 449442d7731eSIsmael Ferreras Morezuelas !(hdev->features[0][6] & LMP_ERR_DATA_REPORTING) || 449542d7731eSIsmael Ferreras Morezuelas test_bit(HCI_QUIRK_BROKEN_ERR_DATA_REPORTING, &hdev->quirks)) 4496d0b13706SLuiz Augusto von Dentz return 0; 4497d0b13706SLuiz Augusto von Dentz 4498d0b13706SLuiz Augusto von Dentz if (enabled == hdev->err_data_reporting) 4499d0b13706SLuiz Augusto von Dentz return 0; 4500d0b13706SLuiz Augusto von Dentz 4501d0b13706SLuiz Augusto von Dentz memset(&cp, 0, sizeof(cp)); 4502d0b13706SLuiz Augusto von Dentz cp.err_data_reporting = enabled ? ERR_DATA_REPORTING_ENABLED : 4503d0b13706SLuiz Augusto von Dentz ERR_DATA_REPORTING_DISABLED; 4504d0b13706SLuiz Augusto von Dentz 4505d0b13706SLuiz Augusto von Dentz return __hci_cmd_sync_status(hdev, HCI_OP_WRITE_DEF_ERR_DATA_REPORTING, 4506d0b13706SLuiz Augusto von Dentz sizeof(cp), &cp, HCI_CMD_TIMEOUT); 4507d0b13706SLuiz Augusto von Dentz } 4508d0b13706SLuiz Augusto von Dentz 4509d0b13706SLuiz Augusto von Dentz static const struct hci_init_stage hci_init4[] = { 4510d0b13706SLuiz Augusto von Dentz /* HCI_OP_DELETE_STORED_LINK_KEY */ 4511d0b13706SLuiz Augusto von Dentz HCI_INIT(hci_delete_stored_link_key_sync), 4512d0b13706SLuiz Augusto von Dentz /* HCI_OP_SET_EVENT_MASK_PAGE_2 */ 4513d0b13706SLuiz Augusto von Dentz HCI_INIT(hci_set_event_mask_page_2_sync), 4514d0b13706SLuiz Augusto von Dentz /* HCI_OP_READ_LOCAL_CODECS */ 4515d0b13706SLuiz Augusto von Dentz HCI_INIT(hci_read_local_codecs_sync), 4516d0b13706SLuiz Augusto von Dentz /* HCI_OP_READ_LOCAL_PAIRING_OPTS */ 4517d0b13706SLuiz Augusto von Dentz HCI_INIT(hci_read_local_pairing_opts_sync), 4518d0b13706SLuiz Augusto von Dentz /* HCI_OP_GET_MWS_TRANSPORT_CONFIG */ 4519d0b13706SLuiz Augusto von Dentz HCI_INIT(hci_get_mws_transport_config_sync), 4520d0b13706SLuiz Augusto von Dentz /* HCI_OP_READ_SYNC_TRAIN_PARAMS */ 4521d0b13706SLuiz Augusto von Dentz HCI_INIT(hci_read_sync_train_params_sync), 4522d0b13706SLuiz Augusto von Dentz /* HCI_OP_WRITE_SC_SUPPORT */ 4523d0b13706SLuiz Augusto von Dentz HCI_INIT(hci_write_sc_support_1_sync), 4524d0b13706SLuiz Augusto von Dentz /* HCI_OP_WRITE_DEF_ERR_DATA_REPORTING */ 4525d0b13706SLuiz Augusto von Dentz HCI_INIT(hci_set_err_data_report_sync), 4526d0b13706SLuiz Augusto von Dentz {} 4527d0b13706SLuiz Augusto von Dentz }; 4528d0b13706SLuiz Augusto von Dentz 4529d0b13706SLuiz Augusto von Dentz /* Set Suggested Default Data Length to maximum if supported */ 4530d0b13706SLuiz Augusto von Dentz static int hci_le_set_write_def_data_len_sync(struct hci_dev *hdev) 4531d0b13706SLuiz Augusto von Dentz { 4532d0b13706SLuiz Augusto von Dentz struct hci_cp_le_write_def_data_len cp; 4533d0b13706SLuiz Augusto von Dentz 4534d0b13706SLuiz Augusto von Dentz if (!(hdev->le_features[0] & HCI_LE_DATA_LEN_EXT)) 4535d0b13706SLuiz Augusto von Dentz return 0; 4536d0b13706SLuiz Augusto von Dentz 4537d0b13706SLuiz Augusto von Dentz memset(&cp, 0, sizeof(cp)); 4538d0b13706SLuiz Augusto von Dentz cp.tx_len = cpu_to_le16(hdev->le_max_tx_len); 4539d0b13706SLuiz Augusto von Dentz cp.tx_time = cpu_to_le16(hdev->le_max_tx_time); 4540d0b13706SLuiz Augusto von Dentz 4541d0b13706SLuiz Augusto von Dentz return __hci_cmd_sync_status(hdev, HCI_OP_LE_WRITE_DEF_DATA_LEN, 4542d0b13706SLuiz Augusto von Dentz sizeof(cp), &cp, HCI_CMD_TIMEOUT); 4543d0b13706SLuiz Augusto von Dentz } 4544d0b13706SLuiz Augusto von Dentz 4545288c9022SLuiz Augusto von Dentz /* Set Default PHY parameters if command is supported, enables all supported 4546288c9022SLuiz Augusto von Dentz * PHYs according to the LE Features bits. 4547288c9022SLuiz Augusto von Dentz */ 4548d0b13706SLuiz Augusto von Dentz static int hci_le_set_default_phy_sync(struct hci_dev *hdev) 4549d0b13706SLuiz Augusto von Dentz { 4550d0b13706SLuiz Augusto von Dentz struct hci_cp_le_set_default_phy cp; 4551d0b13706SLuiz Augusto von Dentz 4552288c9022SLuiz Augusto von Dentz if (!(hdev->commands[35] & 0x20)) { 4553288c9022SLuiz Augusto von Dentz /* If the command is not supported it means only 1M PHY is 4554288c9022SLuiz Augusto von Dentz * supported. 4555288c9022SLuiz Augusto von Dentz */ 4556288c9022SLuiz Augusto von Dentz hdev->le_tx_def_phys = HCI_LE_SET_PHY_1M; 4557288c9022SLuiz Augusto von Dentz hdev->le_rx_def_phys = HCI_LE_SET_PHY_1M; 4558d0b13706SLuiz Augusto von Dentz return 0; 4559288c9022SLuiz Augusto von Dentz } 4560d0b13706SLuiz Augusto von Dentz 4561d0b13706SLuiz Augusto von Dentz memset(&cp, 0, sizeof(cp)); 4562d0b13706SLuiz Augusto von Dentz cp.all_phys = 0x00; 4563288c9022SLuiz Augusto von Dentz cp.tx_phys = HCI_LE_SET_PHY_1M; 4564288c9022SLuiz Augusto von Dentz cp.rx_phys = HCI_LE_SET_PHY_1M; 4565288c9022SLuiz Augusto von Dentz 4566288c9022SLuiz Augusto von Dentz /* Enables 2M PHY if supported */ 4567288c9022SLuiz Augusto von Dentz if (le_2m_capable(hdev)) { 4568288c9022SLuiz Augusto von Dentz cp.tx_phys |= HCI_LE_SET_PHY_2M; 4569288c9022SLuiz Augusto von Dentz cp.rx_phys |= HCI_LE_SET_PHY_2M; 4570288c9022SLuiz Augusto von Dentz } 4571288c9022SLuiz Augusto von Dentz 4572288c9022SLuiz Augusto von Dentz /* Enables Coded PHY if supported */ 4573288c9022SLuiz Augusto von Dentz if (le_coded_capable(hdev)) { 4574288c9022SLuiz Augusto von Dentz cp.tx_phys |= HCI_LE_SET_PHY_CODED; 4575288c9022SLuiz Augusto von Dentz cp.rx_phys |= HCI_LE_SET_PHY_CODED; 4576288c9022SLuiz Augusto von Dentz } 4577d0b13706SLuiz Augusto von Dentz 4578d0b13706SLuiz Augusto von Dentz return __hci_cmd_sync_status(hdev, HCI_OP_LE_SET_DEFAULT_PHY, 4579d0b13706SLuiz Augusto von Dentz sizeof(cp), &cp, HCI_CMD_TIMEOUT); 4580d0b13706SLuiz Augusto von Dentz } 4581d0b13706SLuiz Augusto von Dentz 4582d0b13706SLuiz Augusto von Dentz static const struct hci_init_stage le_init4[] = { 4583d0b13706SLuiz Augusto von Dentz /* HCI_OP_LE_WRITE_DEF_DATA_LEN */ 4584d0b13706SLuiz Augusto von Dentz HCI_INIT(hci_le_set_write_def_data_len_sync), 4585d0b13706SLuiz Augusto von Dentz /* HCI_OP_LE_SET_DEFAULT_PHY */ 4586d0b13706SLuiz Augusto von Dentz HCI_INIT(hci_le_set_default_phy_sync), 4587d0b13706SLuiz Augusto von Dentz {} 4588d0b13706SLuiz Augusto von Dentz }; 4589d0b13706SLuiz Augusto von Dentz 4590d0b13706SLuiz Augusto von Dentz static int hci_init4_sync(struct hci_dev *hdev) 4591d0b13706SLuiz Augusto von Dentz { 4592d0b13706SLuiz Augusto von Dentz int err; 4593d0b13706SLuiz Augusto von Dentz 4594d0b13706SLuiz Augusto von Dentz bt_dev_dbg(hdev, ""); 4595d0b13706SLuiz Augusto von Dentz 4596d0b13706SLuiz Augusto von Dentz err = hci_init_stage_sync(hdev, hci_init4); 4597d0b13706SLuiz Augusto von Dentz if (err) 4598d0b13706SLuiz Augusto von Dentz return err; 4599d0b13706SLuiz Augusto von Dentz 4600d0b13706SLuiz Augusto von Dentz if (lmp_le_capable(hdev)) 4601d0b13706SLuiz Augusto von Dentz return hci_init_stage_sync(hdev, le_init4); 4602d0b13706SLuiz Augusto von Dentz 4603d0b13706SLuiz Augusto von Dentz return 0; 4604d0b13706SLuiz Augusto von Dentz } 4605d0b13706SLuiz Augusto von Dentz 4606d0b13706SLuiz Augusto von Dentz static int hci_init_sync(struct hci_dev *hdev) 4607d0b13706SLuiz Augusto von Dentz { 4608d0b13706SLuiz Augusto von Dentz int err; 4609d0b13706SLuiz Augusto von Dentz 4610d0b13706SLuiz Augusto von Dentz err = hci_init1_sync(hdev); 4611d0b13706SLuiz Augusto von Dentz if (err < 0) 4612d0b13706SLuiz Augusto von Dentz return err; 4613d0b13706SLuiz Augusto von Dentz 4614d0b13706SLuiz Augusto von Dentz if (hci_dev_test_flag(hdev, HCI_SETUP)) 4615d0b13706SLuiz Augusto von Dentz hci_debugfs_create_basic(hdev); 4616d0b13706SLuiz Augusto von Dentz 4617d0b13706SLuiz Augusto von Dentz err = hci_init2_sync(hdev); 4618d0b13706SLuiz Augusto von Dentz if (err < 0) 4619d0b13706SLuiz Augusto von Dentz return err; 4620d0b13706SLuiz Augusto von Dentz 4621d0b13706SLuiz Augusto von Dentz err = hci_init3_sync(hdev); 4622d0b13706SLuiz Augusto von Dentz if (err < 0) 4623d0b13706SLuiz Augusto von Dentz return err; 4624d0b13706SLuiz Augusto von Dentz 4625d0b13706SLuiz Augusto von Dentz err = hci_init4_sync(hdev); 4626d0b13706SLuiz Augusto von Dentz if (err < 0) 4627d0b13706SLuiz Augusto von Dentz return err; 4628d0b13706SLuiz Augusto von Dentz 4629d0b13706SLuiz Augusto von Dentz /* This function is only called when the controller is actually in 4630d0b13706SLuiz Augusto von Dentz * configured state. When the controller is marked as unconfigured, 4631d0b13706SLuiz Augusto von Dentz * this initialization procedure is not run. 4632d0b13706SLuiz Augusto von Dentz * 4633d0b13706SLuiz Augusto von Dentz * It means that it is possible that a controller runs through its 4634d0b13706SLuiz Augusto von Dentz * setup phase and then discovers missing settings. If that is the 4635d0b13706SLuiz Augusto von Dentz * case, then this function will not be called. It then will only 4636d0b13706SLuiz Augusto von Dentz * be called during the config phase. 4637d0b13706SLuiz Augusto von Dentz * 4638d0b13706SLuiz Augusto von Dentz * So only when in setup phase or config phase, create the debugfs 4639d0b13706SLuiz Augusto von Dentz * entries and register the SMP channels. 4640d0b13706SLuiz Augusto von Dentz */ 4641d0b13706SLuiz Augusto von Dentz if (!hci_dev_test_flag(hdev, HCI_SETUP) && 4642d0b13706SLuiz Augusto von Dentz !hci_dev_test_flag(hdev, HCI_CONFIG)) 4643d0b13706SLuiz Augusto von Dentz return 0; 4644d0b13706SLuiz Augusto von Dentz 4645fe2ccc6cSJohan Hovold if (hci_dev_test_and_set_flag(hdev, HCI_DEBUGFS_CREATED)) 4646fe2ccc6cSJohan Hovold return 0; 4647fe2ccc6cSJohan Hovold 4648d0b13706SLuiz Augusto von Dentz hci_debugfs_create_common(hdev); 4649d0b13706SLuiz Augusto von Dentz 4650d0b13706SLuiz Augusto von Dentz if (lmp_bredr_capable(hdev)) 4651d0b13706SLuiz Augusto von Dentz hci_debugfs_create_bredr(hdev); 4652d0b13706SLuiz Augusto von Dentz 4653d0b13706SLuiz Augusto von Dentz if (lmp_le_capable(hdev)) 4654d0b13706SLuiz Augusto von Dentz hci_debugfs_create_le(hdev); 4655d0b13706SLuiz Augusto von Dentz 4656d0b13706SLuiz Augusto von Dentz return 0; 4657d0b13706SLuiz Augusto von Dentz } 4658d0b13706SLuiz Augusto von Dentz 46596b5c1cdaSLuiz Augusto von Dentz #define HCI_QUIRK_BROKEN(_quirk, _desc) { HCI_QUIRK_BROKEN_##_quirk, _desc } 46606b5c1cdaSLuiz Augusto von Dentz 46616b5c1cdaSLuiz Augusto von Dentz static const struct { 46626b5c1cdaSLuiz Augusto von Dentz unsigned long quirk; 46636b5c1cdaSLuiz Augusto von Dentz const char *desc; 46646b5c1cdaSLuiz Augusto von Dentz } hci_broken_table[] = { 46656b5c1cdaSLuiz Augusto von Dentz HCI_QUIRK_BROKEN(LOCAL_COMMANDS, 46666b5c1cdaSLuiz Augusto von Dentz "HCI Read Local Supported Commands not supported"), 46676b5c1cdaSLuiz Augusto von Dentz HCI_QUIRK_BROKEN(STORED_LINK_KEY, 46686b5c1cdaSLuiz Augusto von Dentz "HCI Delete Stored Link Key command is advertised, " 46696b5c1cdaSLuiz Augusto von Dentz "but not supported."), 467042d7731eSIsmael Ferreras Morezuelas HCI_QUIRK_BROKEN(ERR_DATA_REPORTING, 467142d7731eSIsmael Ferreras Morezuelas "HCI Read Default Erroneous Data Reporting command is " 467242d7731eSIsmael Ferreras Morezuelas "advertised, but not supported."), 46736b5c1cdaSLuiz Augusto von Dentz HCI_QUIRK_BROKEN(READ_TRANSMIT_POWER, 46746b5c1cdaSLuiz Augusto von Dentz "HCI Read Transmit Power Level command is advertised, " 46756b5c1cdaSLuiz Augusto von Dentz "but not supported."), 46766b5c1cdaSLuiz Augusto von Dentz HCI_QUIRK_BROKEN(FILTER_CLEAR_ALL, 46776b5c1cdaSLuiz Augusto von Dentz "HCI Set Event Filter command not supported."), 46786b5c1cdaSLuiz Augusto von Dentz HCI_QUIRK_BROKEN(ENHANCED_SETUP_SYNC_CONN, 46796b5c1cdaSLuiz Augusto von Dentz "HCI Enhanced Setup Synchronous Connection command is " 468091b6d02dSRaul Cheleguini "advertised, but not supported."), 468191b6d02dSRaul Cheleguini HCI_QUIRK_BROKEN(SET_RPA_TIMEOUT, 468291b6d02dSRaul Cheleguini "HCI LE Set Random Private Address Timeout command is " 4683253f3399SLuiz Augusto von Dentz "advertised, but not supported."), 4684253f3399SLuiz Augusto von Dentz HCI_QUIRK_BROKEN(LE_CODED, 4685253f3399SLuiz Augusto von Dentz "HCI LE Coded PHY feature bit is set, " 4686253f3399SLuiz Augusto von Dentz "but its usage is not supported.") 46876b5c1cdaSLuiz Augusto von Dentz }; 46886b5c1cdaSLuiz Augusto von Dentz 46891bbf4023SLuiz Augusto von Dentz /* This function handles hdev setup stage: 46901bbf4023SLuiz Augusto von Dentz * 46911bbf4023SLuiz Augusto von Dentz * Calls hdev->setup 46921bbf4023SLuiz Augusto von Dentz * Setup address if HCI_QUIRK_USE_BDADDR_PROPERTY is set. 46931bbf4023SLuiz Augusto von Dentz */ 46941bbf4023SLuiz Augusto von Dentz static int hci_dev_setup_sync(struct hci_dev *hdev) 4695d0b13706SLuiz Augusto von Dentz { 4696d0b13706SLuiz Augusto von Dentz int ret = 0; 46971bbf4023SLuiz Augusto von Dentz bool invalid_bdaddr; 46981bbf4023SLuiz Augusto von Dentz size_t i; 46991bbf4023SLuiz Augusto von Dentz 47001bbf4023SLuiz Augusto von Dentz if (!hci_dev_test_flag(hdev, HCI_SETUP) && 47011bbf4023SLuiz Augusto von Dentz !test_bit(HCI_QUIRK_NON_PERSISTENT_SETUP, &hdev->quirks)) 47021bbf4023SLuiz Augusto von Dentz return 0; 47031bbf4023SLuiz Augusto von Dentz 47041bbf4023SLuiz Augusto von Dentz bt_dev_dbg(hdev, ""); 47051bbf4023SLuiz Augusto von Dentz 47061bbf4023SLuiz Augusto von Dentz hci_sock_dev_event(hdev, HCI_DEV_SETUP); 47071bbf4023SLuiz Augusto von Dentz 47081bbf4023SLuiz Augusto von Dentz if (hdev->setup) 47091bbf4023SLuiz Augusto von Dentz ret = hdev->setup(hdev); 47101bbf4023SLuiz Augusto von Dentz 47111bbf4023SLuiz Augusto von Dentz for (i = 0; i < ARRAY_SIZE(hci_broken_table); i++) { 47121bbf4023SLuiz Augusto von Dentz if (test_bit(hci_broken_table[i].quirk, &hdev->quirks)) 47131bbf4023SLuiz Augusto von Dentz bt_dev_warn(hdev, "%s", hci_broken_table[i].desc); 47141bbf4023SLuiz Augusto von Dentz } 47151bbf4023SLuiz Augusto von Dentz 47161bbf4023SLuiz Augusto von Dentz /* The transport driver can set the quirk to mark the 47171bbf4023SLuiz Augusto von Dentz * BD_ADDR invalid before creating the HCI device or in 47181bbf4023SLuiz Augusto von Dentz * its setup callback. 47191bbf4023SLuiz Augusto von Dentz */ 47206945795bSJohan Hovold invalid_bdaddr = test_bit(HCI_QUIRK_INVALID_BDADDR, &hdev->quirks) || 47216945795bSJohan Hovold test_bit(HCI_QUIRK_USE_BDADDR_PROPERTY, &hdev->quirks); 47221bbf4023SLuiz Augusto von Dentz if (!ret) { 47230cb73658SJohan Hovold if (test_bit(HCI_QUIRK_USE_BDADDR_PROPERTY, &hdev->quirks) && 47240cb73658SJohan Hovold !bacmp(&hdev->public_addr, BDADDR_ANY)) 47251bbf4023SLuiz Augusto von Dentz hci_dev_get_bd_addr_from_property(hdev); 47261bbf4023SLuiz Augusto von Dentz 47276945795bSJohan Hovold if (invalid_bdaddr && bacmp(&hdev->public_addr, BDADDR_ANY) && 47281bbf4023SLuiz Augusto von Dentz hdev->set_bdaddr) { 47290cb73658SJohan Hovold ret = hdev->set_bdaddr(hdev, &hdev->public_addr); 47301bbf4023SLuiz Augusto von Dentz if (!ret) 47311bbf4023SLuiz Augusto von Dentz invalid_bdaddr = false; 47321bbf4023SLuiz Augusto von Dentz } 47331bbf4023SLuiz Augusto von Dentz } 47341bbf4023SLuiz Augusto von Dentz 47351bbf4023SLuiz Augusto von Dentz /* The transport driver can set these quirks before 47361bbf4023SLuiz Augusto von Dentz * creating the HCI device or in its setup callback. 47371bbf4023SLuiz Augusto von Dentz * 47381bbf4023SLuiz Augusto von Dentz * For the invalid BD_ADDR quirk it is possible that 47391bbf4023SLuiz Augusto von Dentz * it becomes a valid address if the bootloader does 47401bbf4023SLuiz Augusto von Dentz * provide it (see above). 47411bbf4023SLuiz Augusto von Dentz * 47421bbf4023SLuiz Augusto von Dentz * In case any of them is set, the controller has to 47431bbf4023SLuiz Augusto von Dentz * start up as unconfigured. 47441bbf4023SLuiz Augusto von Dentz */ 47451bbf4023SLuiz Augusto von Dentz if (test_bit(HCI_QUIRK_EXTERNAL_CONFIG, &hdev->quirks) || 47461bbf4023SLuiz Augusto von Dentz invalid_bdaddr) 47471bbf4023SLuiz Augusto von Dentz hci_dev_set_flag(hdev, HCI_UNCONFIGURED); 47481bbf4023SLuiz Augusto von Dentz 47491bbf4023SLuiz Augusto von Dentz /* For an unconfigured controller it is required to 47501bbf4023SLuiz Augusto von Dentz * read at least the version information provided by 47511bbf4023SLuiz Augusto von Dentz * the Read Local Version Information command. 47521bbf4023SLuiz Augusto von Dentz * 47531bbf4023SLuiz Augusto von Dentz * If the set_bdaddr driver callback is provided, then 47541bbf4023SLuiz Augusto von Dentz * also the original Bluetooth public device address 47551bbf4023SLuiz Augusto von Dentz * will be read using the Read BD Address command. 47561bbf4023SLuiz Augusto von Dentz */ 47571bbf4023SLuiz Augusto von Dentz if (hci_dev_test_flag(hdev, HCI_UNCONFIGURED)) 47581bbf4023SLuiz Augusto von Dentz return hci_unconf_init_sync(hdev); 47591bbf4023SLuiz Augusto von Dentz 47601bbf4023SLuiz Augusto von Dentz return ret; 47611bbf4023SLuiz Augusto von Dentz } 47621bbf4023SLuiz Augusto von Dentz 47631bbf4023SLuiz Augusto von Dentz /* This function handles hdev init stage: 47641bbf4023SLuiz Augusto von Dentz * 47651bbf4023SLuiz Augusto von Dentz * Calls hci_dev_setup_sync to perform setup stage 47661bbf4023SLuiz Augusto von Dentz * Calls hci_init_sync to perform HCI command init sequence 47671bbf4023SLuiz Augusto von Dentz */ 47681bbf4023SLuiz Augusto von Dentz static int hci_dev_init_sync(struct hci_dev *hdev) 47691bbf4023SLuiz Augusto von Dentz { 47701bbf4023SLuiz Augusto von Dentz int ret; 47711bbf4023SLuiz Augusto von Dentz 47721bbf4023SLuiz Augusto von Dentz bt_dev_dbg(hdev, ""); 47731bbf4023SLuiz Augusto von Dentz 47741bbf4023SLuiz Augusto von Dentz atomic_set(&hdev->cmd_cnt, 1); 47751bbf4023SLuiz Augusto von Dentz set_bit(HCI_INIT, &hdev->flags); 47761bbf4023SLuiz Augusto von Dentz 47771bbf4023SLuiz Augusto von Dentz ret = hci_dev_setup_sync(hdev); 47781bbf4023SLuiz Augusto von Dentz 47791bbf4023SLuiz Augusto von Dentz if (hci_dev_test_flag(hdev, HCI_CONFIG)) { 47801bbf4023SLuiz Augusto von Dentz /* If public address change is configured, ensure that 47811bbf4023SLuiz Augusto von Dentz * the address gets programmed. If the driver does not 47821bbf4023SLuiz Augusto von Dentz * support changing the public address, fail the power 47831bbf4023SLuiz Augusto von Dentz * on procedure. 47841bbf4023SLuiz Augusto von Dentz */ 47851bbf4023SLuiz Augusto von Dentz if (bacmp(&hdev->public_addr, BDADDR_ANY) && 47861bbf4023SLuiz Augusto von Dentz hdev->set_bdaddr) 47871bbf4023SLuiz Augusto von Dentz ret = hdev->set_bdaddr(hdev, &hdev->public_addr); 47881bbf4023SLuiz Augusto von Dentz else 47891bbf4023SLuiz Augusto von Dentz ret = -EADDRNOTAVAIL; 47901bbf4023SLuiz Augusto von Dentz } 47911bbf4023SLuiz Augusto von Dentz 47921bbf4023SLuiz Augusto von Dentz if (!ret) { 47931bbf4023SLuiz Augusto von Dentz if (!hci_dev_test_flag(hdev, HCI_UNCONFIGURED) && 47941bbf4023SLuiz Augusto von Dentz !hci_dev_test_flag(hdev, HCI_USER_CHANNEL)) { 47951bbf4023SLuiz Augusto von Dentz ret = hci_init_sync(hdev); 47961bbf4023SLuiz Augusto von Dentz if (!ret && hdev->post_init) 47971bbf4023SLuiz Augusto von Dentz ret = hdev->post_init(hdev); 47981bbf4023SLuiz Augusto von Dentz } 47991bbf4023SLuiz Augusto von Dentz } 48001bbf4023SLuiz Augusto von Dentz 48011bbf4023SLuiz Augusto von Dentz /* If the HCI Reset command is clearing all diagnostic settings, 48021bbf4023SLuiz Augusto von Dentz * then they need to be reprogrammed after the init procedure 48031bbf4023SLuiz Augusto von Dentz * completed. 48041bbf4023SLuiz Augusto von Dentz */ 48051bbf4023SLuiz Augusto von Dentz if (test_bit(HCI_QUIRK_NON_PERSISTENT_DIAG, &hdev->quirks) && 48061bbf4023SLuiz Augusto von Dentz !hci_dev_test_flag(hdev, HCI_USER_CHANNEL) && 48071bbf4023SLuiz Augusto von Dentz hci_dev_test_flag(hdev, HCI_VENDOR_DIAG) && hdev->set_diag) 48081bbf4023SLuiz Augusto von Dentz ret = hdev->set_diag(hdev, true); 48091bbf4023SLuiz Augusto von Dentz 48101bbf4023SLuiz Augusto von Dentz if (!hci_dev_test_flag(hdev, HCI_USER_CHANNEL)) { 48111bbf4023SLuiz Augusto von Dentz msft_do_open(hdev); 48121bbf4023SLuiz Augusto von Dentz aosp_do_open(hdev); 48131bbf4023SLuiz Augusto von Dentz } 48141bbf4023SLuiz Augusto von Dentz 48151bbf4023SLuiz Augusto von Dentz clear_bit(HCI_INIT, &hdev->flags); 48161bbf4023SLuiz Augusto von Dentz 48171bbf4023SLuiz Augusto von Dentz return ret; 48181bbf4023SLuiz Augusto von Dentz } 48191bbf4023SLuiz Augusto von Dentz 48201bbf4023SLuiz Augusto von Dentz int hci_dev_open_sync(struct hci_dev *hdev) 48211bbf4023SLuiz Augusto von Dentz { 48221bbf4023SLuiz Augusto von Dentz int ret; 4823d0b13706SLuiz Augusto von Dentz 4824d0b13706SLuiz Augusto von Dentz bt_dev_dbg(hdev, ""); 4825d0b13706SLuiz Augusto von Dentz 4826d0b13706SLuiz Augusto von Dentz if (hci_dev_test_flag(hdev, HCI_UNREGISTER)) { 4827d0b13706SLuiz Augusto von Dentz ret = -ENODEV; 4828d0b13706SLuiz Augusto von Dentz goto done; 4829d0b13706SLuiz Augusto von Dentz } 4830d0b13706SLuiz Augusto von Dentz 4831d0b13706SLuiz Augusto von Dentz if (!hci_dev_test_flag(hdev, HCI_SETUP) && 4832d0b13706SLuiz Augusto von Dentz !hci_dev_test_flag(hdev, HCI_CONFIG)) { 4833d0b13706SLuiz Augusto von Dentz /* Check for rfkill but allow the HCI setup stage to 4834d0b13706SLuiz Augusto von Dentz * proceed (which in itself doesn't cause any RF activity). 4835d0b13706SLuiz Augusto von Dentz */ 4836d0b13706SLuiz Augusto von Dentz if (hci_dev_test_flag(hdev, HCI_RFKILLED)) { 4837d0b13706SLuiz Augusto von Dentz ret = -ERFKILL; 4838d0b13706SLuiz Augusto von Dentz goto done; 4839d0b13706SLuiz Augusto von Dentz } 4840d0b13706SLuiz Augusto von Dentz 4841d0b13706SLuiz Augusto von Dentz /* Check for valid public address or a configured static 4842d0b13706SLuiz Augusto von Dentz * random address, but let the HCI setup proceed to 4843d0b13706SLuiz Augusto von Dentz * be able to determine if there is a public address 4844d0b13706SLuiz Augusto von Dentz * or not. 4845d0b13706SLuiz Augusto von Dentz * 4846d0b13706SLuiz Augusto von Dentz * In case of user channel usage, it is not important 4847d0b13706SLuiz Augusto von Dentz * if a public address or static random address is 4848d0b13706SLuiz Augusto von Dentz * available. 4849d0b13706SLuiz Augusto von Dentz */ 4850d0b13706SLuiz Augusto von Dentz if (!hci_dev_test_flag(hdev, HCI_USER_CHANNEL) && 4851d0b13706SLuiz Augusto von Dentz !bacmp(&hdev->bdaddr, BDADDR_ANY) && 4852d0b13706SLuiz Augusto von Dentz !bacmp(&hdev->static_addr, BDADDR_ANY)) { 4853d0b13706SLuiz Augusto von Dentz ret = -EADDRNOTAVAIL; 4854d0b13706SLuiz Augusto von Dentz goto done; 4855d0b13706SLuiz Augusto von Dentz } 4856d0b13706SLuiz Augusto von Dentz } 4857d0b13706SLuiz Augusto von Dentz 4858d0b13706SLuiz Augusto von Dentz if (test_bit(HCI_UP, &hdev->flags)) { 4859d0b13706SLuiz Augusto von Dentz ret = -EALREADY; 4860d0b13706SLuiz Augusto von Dentz goto done; 4861d0b13706SLuiz Augusto von Dentz } 4862d0b13706SLuiz Augusto von Dentz 4863d0b13706SLuiz Augusto von Dentz if (hdev->open(hdev)) { 4864d0b13706SLuiz Augusto von Dentz ret = -EIO; 4865d0b13706SLuiz Augusto von Dentz goto done; 4866d0b13706SLuiz Augusto von Dentz } 4867d0b13706SLuiz Augusto von Dentz 48689695ef87SAbhishek Pandit-Subedi hci_devcd_reset(hdev); 48699695ef87SAbhishek Pandit-Subedi 4870d0b13706SLuiz Augusto von Dentz set_bit(HCI_RUNNING, &hdev->flags); 4871d0b13706SLuiz Augusto von Dentz hci_sock_dev_event(hdev, HCI_DEV_OPEN); 4872d0b13706SLuiz Augusto von Dentz 48731bbf4023SLuiz Augusto von Dentz ret = hci_dev_init_sync(hdev); 4874d0b13706SLuiz Augusto von Dentz if (!ret) { 4875d0b13706SLuiz Augusto von Dentz hci_dev_hold(hdev); 4876d0b13706SLuiz Augusto von Dentz hci_dev_set_flag(hdev, HCI_RPA_EXPIRED); 4877d0b13706SLuiz Augusto von Dentz hci_adv_instances_set_rpa_expired(hdev, true); 4878d0b13706SLuiz Augusto von Dentz set_bit(HCI_UP, &hdev->flags); 4879d0b13706SLuiz Augusto von Dentz hci_sock_dev_event(hdev, HCI_DEV_UP); 4880d0b13706SLuiz Augusto von Dentz hci_leds_update_powered(hdev, true); 4881d0b13706SLuiz Augusto von Dentz if (!hci_dev_test_flag(hdev, HCI_SETUP) && 4882d0b13706SLuiz Augusto von Dentz !hci_dev_test_flag(hdev, HCI_CONFIG) && 4883d0b13706SLuiz Augusto von Dentz !hci_dev_test_flag(hdev, HCI_UNCONFIGURED) && 4884d0b13706SLuiz Augusto von Dentz !hci_dev_test_flag(hdev, HCI_USER_CHANNEL) && 48855af2e235SLuiz Augusto von Dentz hci_dev_test_flag(hdev, HCI_MGMT)) { 4886d0b13706SLuiz Augusto von Dentz ret = hci_powered_update_sync(hdev); 48876abf0daeSLuiz Augusto von Dentz mgmt_power_on(hdev, ret); 4888d0b13706SLuiz Augusto von Dentz } 4889d0b13706SLuiz Augusto von Dentz } else { 4890d0b13706SLuiz Augusto von Dentz /* Init failed, cleanup */ 4891d0b13706SLuiz Augusto von Dentz flush_work(&hdev->tx_work); 4892d0b13706SLuiz Augusto von Dentz 4893d0b13706SLuiz Augusto von Dentz /* Since hci_rx_work() is possible to awake new cmd_work 4894d0b13706SLuiz Augusto von Dentz * it should be flushed first to avoid unexpected call of 4895d0b13706SLuiz Augusto von Dentz * hci_cmd_work() 4896d0b13706SLuiz Augusto von Dentz */ 4897d0b13706SLuiz Augusto von Dentz flush_work(&hdev->rx_work); 4898d0b13706SLuiz Augusto von Dentz flush_work(&hdev->cmd_work); 4899d0b13706SLuiz Augusto von Dentz 4900d0b13706SLuiz Augusto von Dentz skb_queue_purge(&hdev->cmd_q); 4901d0b13706SLuiz Augusto von Dentz skb_queue_purge(&hdev->rx_q); 4902d0b13706SLuiz Augusto von Dentz 4903d0b13706SLuiz Augusto von Dentz if (hdev->flush) 4904d0b13706SLuiz Augusto von Dentz hdev->flush(hdev); 4905d0b13706SLuiz Augusto von Dentz 4906d0b13706SLuiz Augusto von Dentz if (hdev->sent_cmd) { 490797dfaf07SArchie Pusaka cancel_delayed_work_sync(&hdev->cmd_timer); 4908d0b13706SLuiz Augusto von Dentz kfree_skb(hdev->sent_cmd); 4909d0b13706SLuiz Augusto von Dentz hdev->sent_cmd = NULL; 4910d0b13706SLuiz Augusto von Dentz } 4911d0b13706SLuiz Augusto von Dentz 49122af7aa66SLuiz Augusto von Dentz if (hdev->req_skb) { 49132af7aa66SLuiz Augusto von Dentz kfree_skb(hdev->req_skb); 49142af7aa66SLuiz Augusto von Dentz hdev->req_skb = NULL; 49152af7aa66SLuiz Augusto von Dentz } 49162af7aa66SLuiz Augusto von Dentz 4917d0b13706SLuiz Augusto von Dentz clear_bit(HCI_RUNNING, &hdev->flags); 4918d0b13706SLuiz Augusto von Dentz hci_sock_dev_event(hdev, HCI_DEV_CLOSE); 4919d0b13706SLuiz Augusto von Dentz 4920d0b13706SLuiz Augusto von Dentz hdev->close(hdev); 4921d0b13706SLuiz Augusto von Dentz hdev->flags &= BIT(HCI_RAW); 4922d0b13706SLuiz Augusto von Dentz } 4923d0b13706SLuiz Augusto von Dentz 4924d0b13706SLuiz Augusto von Dentz done: 4925d0b13706SLuiz Augusto von Dentz return ret; 4926d0b13706SLuiz Augusto von Dentz } 4927d0b13706SLuiz Augusto von Dentz 4928d0b13706SLuiz Augusto von Dentz /* This function requires the caller holds hdev->lock */ 4929d0b13706SLuiz Augusto von Dentz static void hci_pend_le_actions_clear(struct hci_dev *hdev) 4930d0b13706SLuiz Augusto von Dentz { 4931d0b13706SLuiz Augusto von Dentz struct hci_conn_params *p; 4932d0b13706SLuiz Augusto von Dentz 4933d0b13706SLuiz Augusto von Dentz list_for_each_entry(p, &hdev->le_conn_params, list) { 4934195ef75eSPauli Virtanen hci_pend_le_list_del_init(p); 4935d0b13706SLuiz Augusto von Dentz if (p->conn) { 4936d0b13706SLuiz Augusto von Dentz hci_conn_drop(p->conn); 4937d0b13706SLuiz Augusto von Dentz hci_conn_put(p->conn); 4938d0b13706SLuiz Augusto von Dentz p->conn = NULL; 4939d0b13706SLuiz Augusto von Dentz } 4940d0b13706SLuiz Augusto von Dentz } 4941d0b13706SLuiz Augusto von Dentz 4942d0b13706SLuiz Augusto von Dentz BT_DBG("All LE pending actions cleared"); 4943d0b13706SLuiz Augusto von Dentz } 4944d0b13706SLuiz Augusto von Dentz 49458dbc3e75SAbhishek Pandit-Subedi static int hci_dev_shutdown(struct hci_dev *hdev) 49468dbc3e75SAbhishek Pandit-Subedi { 49478dbc3e75SAbhishek Pandit-Subedi int err = 0; 49488dbc3e75SAbhishek Pandit-Subedi /* Similar to how we first do setup and then set the exclusive access 49498dbc3e75SAbhishek Pandit-Subedi * bit for userspace, we must first unset userchannel and then clean up. 49508dbc3e75SAbhishek Pandit-Subedi * Otherwise, the kernel can't properly use the hci channel to clean up 49518dbc3e75SAbhishek Pandit-Subedi * the controller (some shutdown routines require sending additional 49528dbc3e75SAbhishek Pandit-Subedi * commands to the controller for example). 49538dbc3e75SAbhishek Pandit-Subedi */ 49548dbc3e75SAbhishek Pandit-Subedi bool was_userchannel = 49558dbc3e75SAbhishek Pandit-Subedi hci_dev_test_and_clear_flag(hdev, HCI_USER_CHANNEL); 49568dbc3e75SAbhishek Pandit-Subedi 49578dbc3e75SAbhishek Pandit-Subedi if (!hci_dev_test_flag(hdev, HCI_UNREGISTER) && 49588dbc3e75SAbhishek Pandit-Subedi test_bit(HCI_UP, &hdev->flags)) { 49598dbc3e75SAbhishek Pandit-Subedi /* Execute vendor specific shutdown routine */ 49608dbc3e75SAbhishek Pandit-Subedi if (hdev->shutdown) 49618dbc3e75SAbhishek Pandit-Subedi err = hdev->shutdown(hdev); 49628dbc3e75SAbhishek Pandit-Subedi } 49638dbc3e75SAbhishek Pandit-Subedi 49648dbc3e75SAbhishek Pandit-Subedi if (was_userchannel) 49658dbc3e75SAbhishek Pandit-Subedi hci_dev_set_flag(hdev, HCI_USER_CHANNEL); 49668dbc3e75SAbhishek Pandit-Subedi 49678dbc3e75SAbhishek Pandit-Subedi return err; 49688dbc3e75SAbhishek Pandit-Subedi } 49698dbc3e75SAbhishek Pandit-Subedi 4970d0b13706SLuiz Augusto von Dentz int hci_dev_close_sync(struct hci_dev *hdev) 4971d0b13706SLuiz Augusto von Dentz { 4972d0b13706SLuiz Augusto von Dentz bool auto_off; 4973d0b13706SLuiz Augusto von Dentz int err = 0; 4974d0b13706SLuiz Augusto von Dentz 4975d0b13706SLuiz Augusto von Dentz bt_dev_dbg(hdev, ""); 4976d0b13706SLuiz Augusto von Dentz 4977d0b13706SLuiz Augusto von Dentz cancel_delayed_work(&hdev->power_off); 4978d0b13706SLuiz Augusto von Dentz cancel_delayed_work(&hdev->ncmd_timer); 49798ffde2a7SBrian Gix cancel_delayed_work(&hdev->le_scan_disable); 498027d54b77SBrian Gix cancel_delayed_work(&hdev->le_scan_restart); 4981d0b13706SLuiz Augusto von Dentz 4982d0b13706SLuiz Augusto von Dentz hci_request_cancel_all(hdev); 4983d0b13706SLuiz Augusto von Dentz 4984c249ea9bSBrian Gix if (hdev->adv_instance_timeout) { 4985c249ea9bSBrian Gix cancel_delayed_work_sync(&hdev->adv_instance_expire); 4986c249ea9bSBrian Gix hdev->adv_instance_timeout = 0; 4987c249ea9bSBrian Gix } 4988c249ea9bSBrian Gix 49898dbc3e75SAbhishek Pandit-Subedi err = hci_dev_shutdown(hdev); 4990d0b13706SLuiz Augusto von Dentz 4991d0b13706SLuiz Augusto von Dentz if (!test_and_clear_bit(HCI_UP, &hdev->flags)) { 4992d0b13706SLuiz Augusto von Dentz cancel_delayed_work_sync(&hdev->cmd_timer); 4993d0b13706SLuiz Augusto von Dentz return err; 4994d0b13706SLuiz Augusto von Dentz } 4995d0b13706SLuiz Augusto von Dentz 4996d0b13706SLuiz Augusto von Dentz hci_leds_update_powered(hdev, false); 4997d0b13706SLuiz Augusto von Dentz 4998d0b13706SLuiz Augusto von Dentz /* Flush RX and TX works */ 4999d0b13706SLuiz Augusto von Dentz flush_work(&hdev->tx_work); 5000d0b13706SLuiz Augusto von Dentz flush_work(&hdev->rx_work); 5001d0b13706SLuiz Augusto von Dentz 5002d0b13706SLuiz Augusto von Dentz if (hdev->discov_timeout > 0) { 5003d0b13706SLuiz Augusto von Dentz hdev->discov_timeout = 0; 5004d0b13706SLuiz Augusto von Dentz hci_dev_clear_flag(hdev, HCI_DISCOVERABLE); 5005d0b13706SLuiz Augusto von Dentz hci_dev_clear_flag(hdev, HCI_LIMITED_DISCOVERABLE); 5006d0b13706SLuiz Augusto von Dentz } 5007d0b13706SLuiz Augusto von Dentz 5008d0b13706SLuiz Augusto von Dentz if (hci_dev_test_and_clear_flag(hdev, HCI_SERVICE_CACHE)) 5009d0b13706SLuiz Augusto von Dentz cancel_delayed_work(&hdev->service_cache); 5010d0b13706SLuiz Augusto von Dentz 5011d0b13706SLuiz Augusto von Dentz if (hci_dev_test_flag(hdev, HCI_MGMT)) { 5012d0b13706SLuiz Augusto von Dentz struct adv_info *adv_instance; 5013d0b13706SLuiz Augusto von Dentz 5014d0b13706SLuiz Augusto von Dentz cancel_delayed_work_sync(&hdev->rpa_expired); 5015d0b13706SLuiz Augusto von Dentz 5016d0b13706SLuiz Augusto von Dentz list_for_each_entry(adv_instance, &hdev->adv_instances, list) 5017d0b13706SLuiz Augusto von Dentz cancel_delayed_work_sync(&adv_instance->rpa_expired_cb); 5018d0b13706SLuiz Augusto von Dentz } 5019d0b13706SLuiz Augusto von Dentz 5020d0b13706SLuiz Augusto von Dentz /* Avoid potential lockdep warnings from the *_flush() calls by 5021d0b13706SLuiz Augusto von Dentz * ensuring the workqueue is empty up front. 5022d0b13706SLuiz Augusto von Dentz */ 5023d0b13706SLuiz Augusto von Dentz drain_workqueue(hdev->workqueue); 5024d0b13706SLuiz Augusto von Dentz 5025d0b13706SLuiz Augusto von Dentz hci_dev_lock(hdev); 5026d0b13706SLuiz Augusto von Dentz 5027d0b13706SLuiz Augusto von Dentz hci_discovery_set_state(hdev, DISCOVERY_STOPPED); 5028d0b13706SLuiz Augusto von Dentz 5029d0b13706SLuiz Augusto von Dentz auto_off = hci_dev_test_and_clear_flag(hdev, HCI_AUTO_OFF); 5030d0b13706SLuiz Augusto von Dentz 50315af2e235SLuiz Augusto von Dentz if (!auto_off && !hci_dev_test_flag(hdev, HCI_USER_CHANNEL) && 5032d0b13706SLuiz Augusto von Dentz hci_dev_test_flag(hdev, HCI_MGMT)) 5033d0b13706SLuiz Augusto von Dentz __mgmt_power_off(hdev); 5034d0b13706SLuiz Augusto von Dentz 5035d0b13706SLuiz Augusto von Dentz hci_inquiry_cache_flush(hdev); 5036d0b13706SLuiz Augusto von Dentz hci_pend_le_actions_clear(hdev); 5037d0b13706SLuiz Augusto von Dentz hci_conn_hash_flush(hdev); 5038fa78d2d1SLin Ma /* Prevent data races on hdev->smp_data or hdev->smp_bredr_data */ 5039d0b13706SLuiz Augusto von Dentz smp_unregister(hdev); 5040fa78d2d1SLin Ma hci_dev_unlock(hdev); 5041d0b13706SLuiz Augusto von Dentz 5042d0b13706SLuiz Augusto von Dentz hci_sock_dev_event(hdev, HCI_DEV_DOWN); 5043d0b13706SLuiz Augusto von Dentz 5044385315deSJesse Melhuish if (!hci_dev_test_flag(hdev, HCI_USER_CHANNEL)) { 5045d0b13706SLuiz Augusto von Dentz aosp_do_close(hdev); 5046d0b13706SLuiz Augusto von Dentz msft_do_close(hdev); 5047385315deSJesse Melhuish } 5048d0b13706SLuiz Augusto von Dentz 5049d0b13706SLuiz Augusto von Dentz if (hdev->flush) 5050d0b13706SLuiz Augusto von Dentz hdev->flush(hdev); 5051d0b13706SLuiz Augusto von Dentz 5052d0b13706SLuiz Augusto von Dentz /* Reset device */ 5053d0b13706SLuiz Augusto von Dentz skb_queue_purge(&hdev->cmd_q); 5054d0b13706SLuiz Augusto von Dentz atomic_set(&hdev->cmd_cnt, 1); 5055d0b13706SLuiz Augusto von Dentz if (test_bit(HCI_QUIRK_RESET_ON_CLOSE, &hdev->quirks) && 5056d0b13706SLuiz Augusto von Dentz !auto_off && !hci_dev_test_flag(hdev, HCI_UNCONFIGURED)) { 5057d0b13706SLuiz Augusto von Dentz set_bit(HCI_INIT, &hdev->flags); 5058d0b13706SLuiz Augusto von Dentz hci_reset_sync(hdev); 5059d0b13706SLuiz Augusto von Dentz clear_bit(HCI_INIT, &hdev->flags); 5060d0b13706SLuiz Augusto von Dentz } 5061d0b13706SLuiz Augusto von Dentz 5062d0b13706SLuiz Augusto von Dentz /* flush cmd work */ 5063d0b13706SLuiz Augusto von Dentz flush_work(&hdev->cmd_work); 5064d0b13706SLuiz Augusto von Dentz 5065d0b13706SLuiz Augusto von Dentz /* Drop queues */ 5066d0b13706SLuiz Augusto von Dentz skb_queue_purge(&hdev->rx_q); 5067d0b13706SLuiz Augusto von Dentz skb_queue_purge(&hdev->cmd_q); 5068d0b13706SLuiz Augusto von Dentz skb_queue_purge(&hdev->raw_q); 5069d0b13706SLuiz Augusto von Dentz 5070d0b13706SLuiz Augusto von Dentz /* Drop last sent command */ 5071d0b13706SLuiz Augusto von Dentz if (hdev->sent_cmd) { 5072d0b13706SLuiz Augusto von Dentz cancel_delayed_work_sync(&hdev->cmd_timer); 5073d0b13706SLuiz Augusto von Dentz kfree_skb(hdev->sent_cmd); 5074d0b13706SLuiz Augusto von Dentz hdev->sent_cmd = NULL; 5075d0b13706SLuiz Augusto von Dentz } 5076d0b13706SLuiz Augusto von Dentz 50772af7aa66SLuiz Augusto von Dentz /* Drop last request */ 50782af7aa66SLuiz Augusto von Dentz if (hdev->req_skb) { 50792af7aa66SLuiz Augusto von Dentz kfree_skb(hdev->req_skb); 50802af7aa66SLuiz Augusto von Dentz hdev->req_skb = NULL; 50812af7aa66SLuiz Augusto von Dentz } 50822af7aa66SLuiz Augusto von Dentz 5083d0b13706SLuiz Augusto von Dentz clear_bit(HCI_RUNNING, &hdev->flags); 5084d0b13706SLuiz Augusto von Dentz hci_sock_dev_event(hdev, HCI_DEV_CLOSE); 5085d0b13706SLuiz Augusto von Dentz 5086d0b13706SLuiz Augusto von Dentz /* After this point our queues are empty and no tasks are scheduled. */ 5087d0b13706SLuiz Augusto von Dentz hdev->close(hdev); 5088d0b13706SLuiz Augusto von Dentz 5089d0b13706SLuiz Augusto von Dentz /* Clear flags */ 5090d0b13706SLuiz Augusto von Dentz hdev->flags &= BIT(HCI_RAW); 5091d0b13706SLuiz Augusto von Dentz hci_dev_clear_volatile_flags(hdev); 5092d0b13706SLuiz Augusto von Dentz 5093d0b13706SLuiz Augusto von Dentz memset(hdev->eir, 0, sizeof(hdev->eir)); 5094d0b13706SLuiz Augusto von Dentz memset(hdev->dev_class, 0, sizeof(hdev->dev_class)); 5095d0b13706SLuiz Augusto von Dentz bacpy(&hdev->random_addr, BDADDR_ANY); 5096b938790eSLuiz Augusto von Dentz hci_codec_list_clear(&hdev->local_codecs); 5097d0b13706SLuiz Augusto von Dentz 5098d0b13706SLuiz Augusto von Dentz hci_dev_put(hdev); 5099d0b13706SLuiz Augusto von Dentz return err; 5100d0b13706SLuiz Augusto von Dentz } 5101d0b13706SLuiz Augusto von Dentz 5102cf75ad8bSLuiz Augusto von Dentz /* This function perform power on HCI command sequence as follows: 5103cf75ad8bSLuiz Augusto von Dentz * 5104cf75ad8bSLuiz Augusto von Dentz * If controller is already up (HCI_UP) performs hci_powered_update_sync 5105cf75ad8bSLuiz Augusto von Dentz * sequence otherwise run hci_dev_open_sync which will follow with 5106cf75ad8bSLuiz Augusto von Dentz * hci_powered_update_sync after the init sequence is completed. 5107cf75ad8bSLuiz Augusto von Dentz */ 5108cf75ad8bSLuiz Augusto von Dentz static int hci_power_on_sync(struct hci_dev *hdev) 5109cf75ad8bSLuiz Augusto von Dentz { 5110cf75ad8bSLuiz Augusto von Dentz int err; 5111cf75ad8bSLuiz Augusto von Dentz 5112cf75ad8bSLuiz Augusto von Dentz if (test_bit(HCI_UP, &hdev->flags) && 5113cf75ad8bSLuiz Augusto von Dentz hci_dev_test_flag(hdev, HCI_MGMT) && 5114cf75ad8bSLuiz Augusto von Dentz hci_dev_test_and_clear_flag(hdev, HCI_AUTO_OFF)) { 5115cf75ad8bSLuiz Augusto von Dentz cancel_delayed_work(&hdev->power_off); 5116cf75ad8bSLuiz Augusto von Dentz return hci_powered_update_sync(hdev); 5117cf75ad8bSLuiz Augusto von Dentz } 5118cf75ad8bSLuiz Augusto von Dentz 5119cf75ad8bSLuiz Augusto von Dentz err = hci_dev_open_sync(hdev); 5120cf75ad8bSLuiz Augusto von Dentz if (err < 0) 5121cf75ad8bSLuiz Augusto von Dentz return err; 5122cf75ad8bSLuiz Augusto von Dentz 5123cf75ad8bSLuiz Augusto von Dentz /* During the HCI setup phase, a few error conditions are 5124cf75ad8bSLuiz Augusto von Dentz * ignored and they need to be checked now. If they are still 5125cf75ad8bSLuiz Augusto von Dentz * valid, it is important to return the device back off. 5126cf75ad8bSLuiz Augusto von Dentz */ 5127cf75ad8bSLuiz Augusto von Dentz if (hci_dev_test_flag(hdev, HCI_RFKILLED) || 5128cf75ad8bSLuiz Augusto von Dentz hci_dev_test_flag(hdev, HCI_UNCONFIGURED) || 51295af2e235SLuiz Augusto von Dentz (!bacmp(&hdev->bdaddr, BDADDR_ANY) && 5130cf75ad8bSLuiz Augusto von Dentz !bacmp(&hdev->static_addr, BDADDR_ANY))) { 5131cf75ad8bSLuiz Augusto von Dentz hci_dev_clear_flag(hdev, HCI_AUTO_OFF); 5132cf75ad8bSLuiz Augusto von Dentz hci_dev_close_sync(hdev); 5133cf75ad8bSLuiz Augusto von Dentz } else if (hci_dev_test_flag(hdev, HCI_AUTO_OFF)) { 5134cf75ad8bSLuiz Augusto von Dentz queue_delayed_work(hdev->req_workqueue, &hdev->power_off, 5135cf75ad8bSLuiz Augusto von Dentz HCI_AUTO_OFF_TIMEOUT); 5136cf75ad8bSLuiz Augusto von Dentz } 5137cf75ad8bSLuiz Augusto von Dentz 5138cf75ad8bSLuiz Augusto von Dentz if (hci_dev_test_and_clear_flag(hdev, HCI_SETUP)) { 5139cf75ad8bSLuiz Augusto von Dentz /* For unconfigured devices, set the HCI_RAW flag 5140cf75ad8bSLuiz Augusto von Dentz * so that userspace can easily identify them. 5141cf75ad8bSLuiz Augusto von Dentz */ 5142cf75ad8bSLuiz Augusto von Dentz if (hci_dev_test_flag(hdev, HCI_UNCONFIGURED)) 5143cf75ad8bSLuiz Augusto von Dentz set_bit(HCI_RAW, &hdev->flags); 5144cf75ad8bSLuiz Augusto von Dentz 5145cf75ad8bSLuiz Augusto von Dentz /* For fully configured devices, this will send 5146cf75ad8bSLuiz Augusto von Dentz * the Index Added event. For unconfigured devices, 5147cf75ad8bSLuiz Augusto von Dentz * it will send Unconfigued Index Added event. 5148cf75ad8bSLuiz Augusto von Dentz * 5149cf75ad8bSLuiz Augusto von Dentz * Devices with HCI_QUIRK_RAW_DEVICE are ignored 5150cf75ad8bSLuiz Augusto von Dentz * and no event will be send. 5151cf75ad8bSLuiz Augusto von Dentz */ 5152cf75ad8bSLuiz Augusto von Dentz mgmt_index_added(hdev); 5153cf75ad8bSLuiz Augusto von Dentz } else if (hci_dev_test_and_clear_flag(hdev, HCI_CONFIG)) { 5154cf75ad8bSLuiz Augusto von Dentz /* When the controller is now configured, then it 5155cf75ad8bSLuiz Augusto von Dentz * is important to clear the HCI_RAW flag. 5156cf75ad8bSLuiz Augusto von Dentz */ 5157cf75ad8bSLuiz Augusto von Dentz if (!hci_dev_test_flag(hdev, HCI_UNCONFIGURED)) 5158cf75ad8bSLuiz Augusto von Dentz clear_bit(HCI_RAW, &hdev->flags); 5159cf75ad8bSLuiz Augusto von Dentz 5160cf75ad8bSLuiz Augusto von Dentz /* Powering on the controller with HCI_CONFIG set only 5161cf75ad8bSLuiz Augusto von Dentz * happens with the transition from unconfigured to 5162cf75ad8bSLuiz Augusto von Dentz * configured. This will send the Index Added event. 5163cf75ad8bSLuiz Augusto von Dentz */ 5164cf75ad8bSLuiz Augusto von Dentz mgmt_index_added(hdev); 5165cf75ad8bSLuiz Augusto von Dentz } 5166cf75ad8bSLuiz Augusto von Dentz 5167cf75ad8bSLuiz Augusto von Dentz return 0; 5168cf75ad8bSLuiz Augusto von Dentz } 5169cf75ad8bSLuiz Augusto von Dentz 5170cf75ad8bSLuiz Augusto von Dentz static int hci_remote_name_cancel_sync(struct hci_dev *hdev, bdaddr_t *addr) 5171cf75ad8bSLuiz Augusto von Dentz { 5172cf75ad8bSLuiz Augusto von Dentz struct hci_cp_remote_name_req_cancel cp; 5173cf75ad8bSLuiz Augusto von Dentz 5174cf75ad8bSLuiz Augusto von Dentz memset(&cp, 0, sizeof(cp)); 5175cf75ad8bSLuiz Augusto von Dentz bacpy(&cp.bdaddr, addr); 5176cf75ad8bSLuiz Augusto von Dentz 5177cf75ad8bSLuiz Augusto von Dentz return __hci_cmd_sync_status(hdev, HCI_OP_REMOTE_NAME_REQ_CANCEL, 5178cf75ad8bSLuiz Augusto von Dentz sizeof(cp), &cp, HCI_CMD_TIMEOUT); 5179cf75ad8bSLuiz Augusto von Dentz } 5180cf75ad8bSLuiz Augusto von Dentz 5181abfeea47SLuiz Augusto von Dentz int hci_stop_discovery_sync(struct hci_dev *hdev) 5182cf75ad8bSLuiz Augusto von Dentz { 5183cf75ad8bSLuiz Augusto von Dentz struct discovery_state *d = &hdev->discovery; 5184cf75ad8bSLuiz Augusto von Dentz struct inquiry_entry *e; 5185cf75ad8bSLuiz Augusto von Dentz int err; 5186cf75ad8bSLuiz Augusto von Dentz 5187cf75ad8bSLuiz Augusto von Dentz bt_dev_dbg(hdev, "state %u", hdev->discovery.state); 5188cf75ad8bSLuiz Augusto von Dentz 5189cf75ad8bSLuiz Augusto von Dentz if (d->state == DISCOVERY_FINDING || d->state == DISCOVERY_STOPPING) { 5190cf75ad8bSLuiz Augusto von Dentz if (test_bit(HCI_INQUIRY, &hdev->flags)) { 5191cf75ad8bSLuiz Augusto von Dentz err = __hci_cmd_sync_status(hdev, HCI_OP_INQUIRY_CANCEL, 5192cf75ad8bSLuiz Augusto von Dentz 0, NULL, HCI_CMD_TIMEOUT); 5193cf75ad8bSLuiz Augusto von Dentz if (err) 5194cf75ad8bSLuiz Augusto von Dentz return err; 5195cf75ad8bSLuiz Augusto von Dentz } 5196cf75ad8bSLuiz Augusto von Dentz 5197cf75ad8bSLuiz Augusto von Dentz if (hci_dev_test_flag(hdev, HCI_LE_SCAN)) { 5198cf75ad8bSLuiz Augusto von Dentz cancel_delayed_work(&hdev->le_scan_disable); 5199cf75ad8bSLuiz Augusto von Dentz cancel_delayed_work(&hdev->le_scan_restart); 5200cf75ad8bSLuiz Augusto von Dentz 5201cf75ad8bSLuiz Augusto von Dentz err = hci_scan_disable_sync(hdev); 5202cf75ad8bSLuiz Augusto von Dentz if (err) 5203cf75ad8bSLuiz Augusto von Dentz return err; 5204cf75ad8bSLuiz Augusto von Dentz } 5205cf75ad8bSLuiz Augusto von Dentz 5206cf75ad8bSLuiz Augusto von Dentz } else { 5207cf75ad8bSLuiz Augusto von Dentz err = hci_scan_disable_sync(hdev); 5208cf75ad8bSLuiz Augusto von Dentz if (err) 5209cf75ad8bSLuiz Augusto von Dentz return err; 5210cf75ad8bSLuiz Augusto von Dentz } 5211cf75ad8bSLuiz Augusto von Dentz 5212abfeea47SLuiz Augusto von Dentz /* Resume advertising if it was paused */ 5213abfeea47SLuiz Augusto von Dentz if (use_ll_privacy(hdev)) 5214abfeea47SLuiz Augusto von Dentz hci_resume_advertising_sync(hdev); 5215abfeea47SLuiz Augusto von Dentz 5216cf75ad8bSLuiz Augusto von Dentz /* No further actions needed for LE-only discovery */ 5217cf75ad8bSLuiz Augusto von Dentz if (d->type == DISCOV_TYPE_LE) 5218cf75ad8bSLuiz Augusto von Dentz return 0; 5219cf75ad8bSLuiz Augusto von Dentz 5220cf75ad8bSLuiz Augusto von Dentz if (d->state == DISCOVERY_RESOLVING || d->state == DISCOVERY_STOPPING) { 5221cf75ad8bSLuiz Augusto von Dentz e = hci_inquiry_cache_lookup_resolve(hdev, BDADDR_ANY, 5222cf75ad8bSLuiz Augusto von Dentz NAME_PENDING); 5223cf75ad8bSLuiz Augusto von Dentz if (!e) 5224cf75ad8bSLuiz Augusto von Dentz return 0; 5225cf75ad8bSLuiz Augusto von Dentz 5226cf75ad8bSLuiz Augusto von Dentz return hci_remote_name_cancel_sync(hdev, &e->data.bdaddr); 5227cf75ad8bSLuiz Augusto von Dentz } 5228cf75ad8bSLuiz Augusto von Dentz 5229cf75ad8bSLuiz Augusto von Dentz return 0; 5230cf75ad8bSLuiz Augusto von Dentz } 5231cf75ad8bSLuiz Augusto von Dentz 5232cf75ad8bSLuiz Augusto von Dentz static int hci_disconnect_sync(struct hci_dev *hdev, struct hci_conn *conn, 5233cf75ad8bSLuiz Augusto von Dentz u8 reason) 5234cf75ad8bSLuiz Augusto von Dentz { 5235cf75ad8bSLuiz Augusto von Dentz struct hci_cp_disconnect cp; 5236cf75ad8bSLuiz Augusto von Dentz 5237f03d3322SIulia Tanasescu if (test_bit(HCI_CONN_BIG_CREATED, &conn->flags)) { 5238f03d3322SIulia Tanasescu /* This is a BIS connection, hci_conn_del will 5239f03d3322SIulia Tanasescu * do the necessary cleanup. 5240f03d3322SIulia Tanasescu */ 5241f03d3322SIulia Tanasescu hci_dev_lock(hdev); 5242f03d3322SIulia Tanasescu hci_conn_failed(conn, reason); 5243f03d3322SIulia Tanasescu hci_dev_unlock(hdev); 5244f03d3322SIulia Tanasescu 5245f03d3322SIulia Tanasescu return 0; 5246f03d3322SIulia Tanasescu } 5247f03d3322SIulia Tanasescu 5248cf75ad8bSLuiz Augusto von Dentz memset(&cp, 0, sizeof(cp)); 5249cf75ad8bSLuiz Augusto von Dentz cp.handle = cpu_to_le16(conn->handle); 5250cf75ad8bSLuiz Augusto von Dentz cp.reason = reason; 5251cf75ad8bSLuiz Augusto von Dentz 5252f5d13029SArchie Pusaka /* Wait for HCI_EV_DISCONN_COMPLETE, not HCI_EV_CMD_STATUS, when the 5253f5d13029SArchie Pusaka * reason is anything but HCI_ERROR_REMOTE_POWER_OFF. This reason is 5254f5d13029SArchie Pusaka * used when suspending or powering off, where we don't want to wait 5255f5d13029SArchie Pusaka * for the peer's response. 5256d0b13706SLuiz Augusto von Dentz */ 5257f5d13029SArchie Pusaka if (reason != HCI_ERROR_REMOTE_POWER_OFF) 5258d0b13706SLuiz Augusto von Dentz return __hci_cmd_sync_status_sk(hdev, HCI_OP_DISCONNECT, 5259d0b13706SLuiz Augusto von Dentz sizeof(cp), &cp, 5260d0b13706SLuiz Augusto von Dentz HCI_EV_DISCONN_COMPLETE, 5261d0b13706SLuiz Augusto von Dentz HCI_CMD_TIMEOUT, NULL); 5262d0b13706SLuiz Augusto von Dentz 5263d0b13706SLuiz Augusto von Dentz return __hci_cmd_sync_status(hdev, HCI_OP_DISCONNECT, sizeof(cp), &cp, 5264d0b13706SLuiz Augusto von Dentz HCI_CMD_TIMEOUT); 5265cf75ad8bSLuiz Augusto von Dentz } 5266cf75ad8bSLuiz Augusto von Dentz 5267cf75ad8bSLuiz Augusto von Dentz static int hci_le_connect_cancel_sync(struct hci_dev *hdev, 5268a13f316eSLuiz Augusto von Dentz struct hci_conn *conn, u8 reason) 5269cf75ad8bSLuiz Augusto von Dentz { 5270a13f316eSLuiz Augusto von Dentz /* Return reason if scanning since the connection shall probably be 5271a13f316eSLuiz Augusto von Dentz * cleanup directly. 5272a13f316eSLuiz Augusto von Dentz */ 5273cf75ad8bSLuiz Augusto von Dentz if (test_bit(HCI_CONN_SCANNING, &conn->flags)) 5274a13f316eSLuiz Augusto von Dentz return reason; 5275cf75ad8bSLuiz Augusto von Dentz 5276a13f316eSLuiz Augusto von Dentz if (conn->role == HCI_ROLE_SLAVE || 5277a13f316eSLuiz Augusto von Dentz test_and_set_bit(HCI_CONN_CANCEL, &conn->flags)) 5278b62e7220SLuiz Augusto von Dentz return 0; 5279b62e7220SLuiz Augusto von Dentz 5280cf75ad8bSLuiz Augusto von Dentz return __hci_cmd_sync_status(hdev, HCI_OP_LE_CREATE_CONN_CANCEL, 5281b62e7220SLuiz Augusto von Dentz 0, NULL, HCI_CMD_TIMEOUT); 5282cf75ad8bSLuiz Augusto von Dentz } 5283cf75ad8bSLuiz Augusto von Dentz 5284a13f316eSLuiz Augusto von Dentz static int hci_connect_cancel_sync(struct hci_dev *hdev, struct hci_conn *conn, 5285a13f316eSLuiz Augusto von Dentz u8 reason) 5286cf75ad8bSLuiz Augusto von Dentz { 5287cf75ad8bSLuiz Augusto von Dentz if (conn->type == LE_LINK) 5288a13f316eSLuiz Augusto von Dentz return hci_le_connect_cancel_sync(hdev, conn, reason); 5289cf75ad8bSLuiz Augusto von Dentz 529004a51d61SLuiz Augusto von Dentz if (conn->type == ISO_LINK) { 529104a51d61SLuiz Augusto von Dentz /* BLUETOOTH CORE SPECIFICATION Version 5.3 | Vol 4, Part E 529204a51d61SLuiz Augusto von Dentz * page 1857: 529304a51d61SLuiz Augusto von Dentz * 529404a51d61SLuiz Augusto von Dentz * If this command is issued for a CIS on the Central and the 529504a51d61SLuiz Augusto von Dentz * CIS is successfully terminated before being established, 529604a51d61SLuiz Augusto von Dentz * then an HCI_LE_CIS_Established event shall also be sent for 529704a51d61SLuiz Augusto von Dentz * this CIS with the Status Operation Cancelled by Host (0x44). 529804a51d61SLuiz Augusto von Dentz */ 529904a51d61SLuiz Augusto von Dentz if (test_bit(HCI_CONN_CREATE_CIS, &conn->flags)) 530004a51d61SLuiz Augusto von Dentz return hci_disconnect_sync(hdev, conn, reason); 530104a51d61SLuiz Augusto von Dentz 53022889bdd0SPauli Virtanen /* CIS with no Create CIS sent have nothing to cancel */ 53032889bdd0SPauli Virtanen if (bacmp(&conn->dst, BDADDR_ANY)) 53042889bdd0SPauli Virtanen return HCI_ERROR_LOCAL_HOST_TERM; 53052889bdd0SPauli Virtanen 530604a51d61SLuiz Augusto von Dentz /* There is no way to cancel a BIS without terminating the BIG 530704a51d61SLuiz Augusto von Dentz * which is done later on connection cleanup. 530804a51d61SLuiz Augusto von Dentz */ 530904a51d61SLuiz Augusto von Dentz return 0; 531004a51d61SLuiz Augusto von Dentz } 531104a51d61SLuiz Augusto von Dentz 5312cf75ad8bSLuiz Augusto von Dentz if (hdev->hci_ver < BLUETOOTH_VER_1_2) 5313cf75ad8bSLuiz Augusto von Dentz return 0; 5314cf75ad8bSLuiz Augusto von Dentz 5315094e3639SLuiz Augusto von Dentz /* Wait for HCI_EV_CONN_COMPLETE, not HCI_EV_CMD_STATUS, when the 5316094e3639SLuiz Augusto von Dentz * reason is anything but HCI_ERROR_REMOTE_POWER_OFF. This reason is 5317094e3639SLuiz Augusto von Dentz * used when suspending or powering off, where we don't want to wait 5318094e3639SLuiz Augusto von Dentz * for the peer's response. 5319094e3639SLuiz Augusto von Dentz */ 5320094e3639SLuiz Augusto von Dentz if (reason != HCI_ERROR_REMOTE_POWER_OFF) 5321094e3639SLuiz Augusto von Dentz return __hci_cmd_sync_status_sk(hdev, HCI_OP_CREATE_CONN_CANCEL, 5322094e3639SLuiz Augusto von Dentz 6, &conn->dst, 5323094e3639SLuiz Augusto von Dentz HCI_EV_CONN_COMPLETE, 5324094e3639SLuiz Augusto von Dentz HCI_CMD_TIMEOUT, NULL); 5325094e3639SLuiz Augusto von Dentz 5326cf75ad8bSLuiz Augusto von Dentz return __hci_cmd_sync_status(hdev, HCI_OP_CREATE_CONN_CANCEL, 5327cf75ad8bSLuiz Augusto von Dentz 6, &conn->dst, HCI_CMD_TIMEOUT); 5328cf75ad8bSLuiz Augusto von Dentz } 5329cf75ad8bSLuiz Augusto von Dentz 5330cf75ad8bSLuiz Augusto von Dentz static int hci_reject_sco_sync(struct hci_dev *hdev, struct hci_conn *conn, 5331cf75ad8bSLuiz Augusto von Dentz u8 reason) 5332cf75ad8bSLuiz Augusto von Dentz { 5333cf75ad8bSLuiz Augusto von Dentz struct hci_cp_reject_sync_conn_req cp; 5334cf75ad8bSLuiz Augusto von Dentz 5335cf75ad8bSLuiz Augusto von Dentz memset(&cp, 0, sizeof(cp)); 5336cf75ad8bSLuiz Augusto von Dentz bacpy(&cp.bdaddr, &conn->dst); 5337cf75ad8bSLuiz Augusto von Dentz cp.reason = reason; 5338cf75ad8bSLuiz Augusto von Dentz 5339cf75ad8bSLuiz Augusto von Dentz /* SCO rejection has its own limited set of 5340cf75ad8bSLuiz Augusto von Dentz * allowed error values (0x0D-0x0F). 5341cf75ad8bSLuiz Augusto von Dentz */ 5342cf75ad8bSLuiz Augusto von Dentz if (reason < 0x0d || reason > 0x0f) 5343cf75ad8bSLuiz Augusto von Dentz cp.reason = HCI_ERROR_REJ_LIMITED_RESOURCES; 5344cf75ad8bSLuiz Augusto von Dentz 5345cf75ad8bSLuiz Augusto von Dentz return __hci_cmd_sync_status(hdev, HCI_OP_REJECT_SYNC_CONN_REQ, 5346cf75ad8bSLuiz Augusto von Dentz sizeof(cp), &cp, HCI_CMD_TIMEOUT); 5347cf75ad8bSLuiz Augusto von Dentz } 5348cf75ad8bSLuiz Augusto von Dentz 534904a51d61SLuiz Augusto von Dentz static int hci_le_reject_cis_sync(struct hci_dev *hdev, struct hci_conn *conn, 535004a51d61SLuiz Augusto von Dentz u8 reason) 535104a51d61SLuiz Augusto von Dentz { 535204a51d61SLuiz Augusto von Dentz struct hci_cp_le_reject_cis cp; 535304a51d61SLuiz Augusto von Dentz 535404a51d61SLuiz Augusto von Dentz memset(&cp, 0, sizeof(cp)); 535504a51d61SLuiz Augusto von Dentz cp.handle = cpu_to_le16(conn->handle); 535604a51d61SLuiz Augusto von Dentz cp.reason = reason; 535704a51d61SLuiz Augusto von Dentz 535804a51d61SLuiz Augusto von Dentz return __hci_cmd_sync_status(hdev, HCI_OP_LE_REJECT_CIS, 535904a51d61SLuiz Augusto von Dentz sizeof(cp), &cp, HCI_CMD_TIMEOUT); 536004a51d61SLuiz Augusto von Dentz } 536104a51d61SLuiz Augusto von Dentz 5362cf75ad8bSLuiz Augusto von Dentz static int hci_reject_conn_sync(struct hci_dev *hdev, struct hci_conn *conn, 5363cf75ad8bSLuiz Augusto von Dentz u8 reason) 5364cf75ad8bSLuiz Augusto von Dentz { 5365cf75ad8bSLuiz Augusto von Dentz struct hci_cp_reject_conn_req cp; 5366cf75ad8bSLuiz Augusto von Dentz 536704a51d61SLuiz Augusto von Dentz if (conn->type == ISO_LINK) 536804a51d61SLuiz Augusto von Dentz return hci_le_reject_cis_sync(hdev, conn, reason); 536904a51d61SLuiz Augusto von Dentz 5370cf75ad8bSLuiz Augusto von Dentz if (conn->type == SCO_LINK || conn->type == ESCO_LINK) 5371cf75ad8bSLuiz Augusto von Dentz return hci_reject_sco_sync(hdev, conn, reason); 5372cf75ad8bSLuiz Augusto von Dentz 5373cf75ad8bSLuiz Augusto von Dentz memset(&cp, 0, sizeof(cp)); 5374cf75ad8bSLuiz Augusto von Dentz bacpy(&cp.bdaddr, &conn->dst); 5375cf75ad8bSLuiz Augusto von Dentz cp.reason = reason; 5376cf75ad8bSLuiz Augusto von Dentz 5377cf75ad8bSLuiz Augusto von Dentz return __hci_cmd_sync_status(hdev, HCI_OP_REJECT_CONN_REQ, 5378cf75ad8bSLuiz Augusto von Dentz sizeof(cp), &cp, HCI_CMD_TIMEOUT); 5379cf75ad8bSLuiz Augusto von Dentz } 5380cf75ad8bSLuiz Augusto von Dentz 53811f7435c8SLuiz Augusto von Dentz int hci_abort_conn_sync(struct hci_dev *hdev, struct hci_conn *conn, u8 reason) 5382cf75ad8bSLuiz Augusto von Dentz { 53835af1f84eSLuiz Augusto von Dentz int err = 0; 53845af1f84eSLuiz Augusto von Dentz u16 handle = conn->handle; 5385a239110eSPauli Virtanen bool disconnect = false; 538694d9ba9fSLuiz Augusto von Dentz struct hci_conn *c; 53879b3628d7SLuiz Augusto von Dentz 5388cf75ad8bSLuiz Augusto von Dentz switch (conn->state) { 5389cf75ad8bSLuiz Augusto von Dentz case BT_CONNECTED: 5390cf75ad8bSLuiz Augusto von Dentz case BT_CONFIG: 53915af1f84eSLuiz Augusto von Dentz err = hci_disconnect_sync(hdev, conn, reason); 53925af1f84eSLuiz Augusto von Dentz break; 5393cf75ad8bSLuiz Augusto von Dentz case BT_CONNECT: 5394a13f316eSLuiz Augusto von Dentz err = hci_connect_cancel_sync(hdev, conn, reason); 53955af1f84eSLuiz Augusto von Dentz break; 5396cf75ad8bSLuiz Augusto von Dentz case BT_CONNECT2: 53975af1f84eSLuiz Augusto von Dentz err = hci_reject_conn_sync(hdev, conn, reason); 53985af1f84eSLuiz Augusto von Dentz break; 5399f777d882SIulia Tanasescu case BT_OPEN: 54002889bdd0SPauli Virtanen case BT_BOUND: 5401a239110eSPauli Virtanen break; 5402cf75ad8bSLuiz Augusto von Dentz default: 5403a239110eSPauli Virtanen disconnect = true; 5404a239110eSPauli Virtanen break; 5405cf75ad8bSLuiz Augusto von Dentz } 5406cf75ad8bSLuiz Augusto von Dentz 540794d9ba9fSLuiz Augusto von Dentz hci_dev_lock(hdev); 540894d9ba9fSLuiz Augusto von Dentz 5409a239110eSPauli Virtanen /* Check if the connection has been cleaned up concurrently */ 541094d9ba9fSLuiz Augusto von Dentz c = hci_conn_hash_lookup_handle(hdev, handle); 541194d9ba9fSLuiz Augusto von Dentz if (!c || c != conn) { 541294d9ba9fSLuiz Augusto von Dentz err = 0; 541394d9ba9fSLuiz Augusto von Dentz goto unlock; 541494d9ba9fSLuiz Augusto von Dentz } 541594d9ba9fSLuiz Augusto von Dentz 54165af1f84eSLuiz Augusto von Dentz /* Cleanup hci_conn object if it cannot be cancelled as it 54175af1f84eSLuiz Augusto von Dentz * likelly means the controller and host stack are out of sync 54185af1f84eSLuiz Augusto von Dentz * or in case of LE it was still scanning so it can be cleanup 54195af1f84eSLuiz Augusto von Dentz * safely. 54205af1f84eSLuiz Augusto von Dentz */ 5421a239110eSPauli Virtanen if (disconnect) { 5422a239110eSPauli Virtanen conn->state = BT_CLOSED; 5423a239110eSPauli Virtanen hci_disconn_cfm(conn, reason); 5424a239110eSPauli Virtanen hci_conn_del(conn); 5425a239110eSPauli Virtanen } else { 542694d9ba9fSLuiz Augusto von Dentz hci_conn_failed(conn, reason); 5427a239110eSPauli Virtanen } 54285af1f84eSLuiz Augusto von Dentz 542994d9ba9fSLuiz Augusto von Dentz unlock: 54305af1f84eSLuiz Augusto von Dentz hci_dev_unlock(hdev); 54315af1f84eSLuiz Augusto von Dentz return err; 5432cf75ad8bSLuiz Augusto von Dentz } 5433cf75ad8bSLuiz Augusto von Dentz 5434182ee45dSLuiz Augusto von Dentz static int hci_disconnect_all_sync(struct hci_dev *hdev, u8 reason) 5435182ee45dSLuiz Augusto von Dentz { 543694d9ba9fSLuiz Augusto von Dentz struct list_head *head = &hdev->conn_hash.list; 543794d9ba9fSLuiz Augusto von Dentz struct hci_conn *conn; 5438182ee45dSLuiz Augusto von Dentz 543994d9ba9fSLuiz Augusto von Dentz rcu_read_lock(); 544094d9ba9fSLuiz Augusto von Dentz while ((conn = list_first_or_null_rcu(head, struct hci_conn, list))) { 544194d9ba9fSLuiz Augusto von Dentz /* Make sure the connection is not freed while unlocking */ 544294d9ba9fSLuiz Augusto von Dentz conn = hci_conn_get(conn); 544394d9ba9fSLuiz Augusto von Dentz rcu_read_unlock(); 544494d9ba9fSLuiz Augusto von Dentz /* Disregard possible errors since hci_conn_del shall have been 544594d9ba9fSLuiz Augusto von Dentz * called even in case of errors had occurred since it would 544694d9ba9fSLuiz Augusto von Dentz * then cause hci_conn_failed to be called which calls 544794d9ba9fSLuiz Augusto von Dentz * hci_conn_del internally. 544894d9ba9fSLuiz Augusto von Dentz */ 544994d9ba9fSLuiz Augusto von Dentz hci_abort_conn_sync(hdev, conn, reason); 545094d9ba9fSLuiz Augusto von Dentz hci_conn_put(conn); 545194d9ba9fSLuiz Augusto von Dentz rcu_read_lock(); 5452182ee45dSLuiz Augusto von Dentz } 545394d9ba9fSLuiz Augusto von Dentz rcu_read_unlock(); 5454182ee45dSLuiz Augusto von Dentz 54558cd3c55cSTom Rix return 0; 5456182ee45dSLuiz Augusto von Dentz } 5457182ee45dSLuiz Augusto von Dentz 5458cf75ad8bSLuiz Augusto von Dentz /* This function perform power off HCI command sequence as follows: 5459cf75ad8bSLuiz Augusto von Dentz * 5460cf75ad8bSLuiz Augusto von Dentz * Clear Advertising 5461cf75ad8bSLuiz Augusto von Dentz * Stop Discovery 5462cf75ad8bSLuiz Augusto von Dentz * Disconnect all connections 5463cf75ad8bSLuiz Augusto von Dentz * hci_dev_close_sync 5464cf75ad8bSLuiz Augusto von Dentz */ 5465cf75ad8bSLuiz Augusto von Dentz static int hci_power_off_sync(struct hci_dev *hdev) 5466cf75ad8bSLuiz Augusto von Dentz { 5467cf75ad8bSLuiz Augusto von Dentz int err; 5468cf75ad8bSLuiz Augusto von Dentz 5469cf75ad8bSLuiz Augusto von Dentz /* If controller is already down there is nothing to do */ 5470cf75ad8bSLuiz Augusto von Dentz if (!test_bit(HCI_UP, &hdev->flags)) 5471cf75ad8bSLuiz Augusto von Dentz return 0; 5472cf75ad8bSLuiz Augusto von Dentz 5473cf75ad8bSLuiz Augusto von Dentz if (test_bit(HCI_ISCAN, &hdev->flags) || 5474cf75ad8bSLuiz Augusto von Dentz test_bit(HCI_PSCAN, &hdev->flags)) { 5475cf75ad8bSLuiz Augusto von Dentz err = hci_write_scan_enable_sync(hdev, 0x00); 5476cf75ad8bSLuiz Augusto von Dentz if (err) 5477cf75ad8bSLuiz Augusto von Dentz return err; 5478cf75ad8bSLuiz Augusto von Dentz } 5479cf75ad8bSLuiz Augusto von Dentz 5480cf75ad8bSLuiz Augusto von Dentz err = hci_clear_adv_sync(hdev, NULL, false); 5481cf75ad8bSLuiz Augusto von Dentz if (err) 5482cf75ad8bSLuiz Augusto von Dentz return err; 5483cf75ad8bSLuiz Augusto von Dentz 5484cf75ad8bSLuiz Augusto von Dentz err = hci_stop_discovery_sync(hdev); 5485cf75ad8bSLuiz Augusto von Dentz if (err) 5486cf75ad8bSLuiz Augusto von Dentz return err; 5487cf75ad8bSLuiz Augusto von Dentz 5488182ee45dSLuiz Augusto von Dentz /* Terminated due to Power Off */ 5489182ee45dSLuiz Augusto von Dentz err = hci_disconnect_all_sync(hdev, HCI_ERROR_REMOTE_POWER_OFF); 5490182ee45dSLuiz Augusto von Dentz if (err) 5491182ee45dSLuiz Augusto von Dentz return err; 5492cf75ad8bSLuiz Augusto von Dentz 5493cf75ad8bSLuiz Augusto von Dentz return hci_dev_close_sync(hdev); 5494cf75ad8bSLuiz Augusto von Dentz } 5495cf75ad8bSLuiz Augusto von Dentz 5496cf75ad8bSLuiz Augusto von Dentz int hci_set_powered_sync(struct hci_dev *hdev, u8 val) 5497cf75ad8bSLuiz Augusto von Dentz { 5498cf75ad8bSLuiz Augusto von Dentz if (val) 5499cf75ad8bSLuiz Augusto von Dentz return hci_power_on_sync(hdev); 5500cf75ad8bSLuiz Augusto von Dentz 5501cf75ad8bSLuiz Augusto von Dentz return hci_power_off_sync(hdev); 5502cf75ad8bSLuiz Augusto von Dentz } 5503abfeea47SLuiz Augusto von Dentz 55042bd1b237SLuiz Augusto von Dentz static int hci_write_iac_sync(struct hci_dev *hdev) 55052bd1b237SLuiz Augusto von Dentz { 55062bd1b237SLuiz Augusto von Dentz struct hci_cp_write_current_iac_lap cp; 55072bd1b237SLuiz Augusto von Dentz 55082bd1b237SLuiz Augusto von Dentz if (!hci_dev_test_flag(hdev, HCI_DISCOVERABLE)) 55092bd1b237SLuiz Augusto von Dentz return 0; 55102bd1b237SLuiz Augusto von Dentz 55112bd1b237SLuiz Augusto von Dentz memset(&cp, 0, sizeof(cp)); 55122bd1b237SLuiz Augusto von Dentz 55132bd1b237SLuiz Augusto von Dentz if (hci_dev_test_flag(hdev, HCI_LIMITED_DISCOVERABLE)) { 55142bd1b237SLuiz Augusto von Dentz /* Limited discoverable mode */ 55152bd1b237SLuiz Augusto von Dentz cp.num_iac = min_t(u8, hdev->num_iac, 2); 55162bd1b237SLuiz Augusto von Dentz cp.iac_lap[0] = 0x00; /* LIAC */ 55172bd1b237SLuiz Augusto von Dentz cp.iac_lap[1] = 0x8b; 55182bd1b237SLuiz Augusto von Dentz cp.iac_lap[2] = 0x9e; 55192bd1b237SLuiz Augusto von Dentz cp.iac_lap[3] = 0x33; /* GIAC */ 55202bd1b237SLuiz Augusto von Dentz cp.iac_lap[4] = 0x8b; 55212bd1b237SLuiz Augusto von Dentz cp.iac_lap[5] = 0x9e; 55222bd1b237SLuiz Augusto von Dentz } else { 55232bd1b237SLuiz Augusto von Dentz /* General discoverable mode */ 55242bd1b237SLuiz Augusto von Dentz cp.num_iac = 1; 55252bd1b237SLuiz Augusto von Dentz cp.iac_lap[0] = 0x33; /* GIAC */ 55262bd1b237SLuiz Augusto von Dentz cp.iac_lap[1] = 0x8b; 55272bd1b237SLuiz Augusto von Dentz cp.iac_lap[2] = 0x9e; 55282bd1b237SLuiz Augusto von Dentz } 55292bd1b237SLuiz Augusto von Dentz 55302bd1b237SLuiz Augusto von Dentz return __hci_cmd_sync_status(hdev, HCI_OP_WRITE_CURRENT_IAC_LAP, 55312bd1b237SLuiz Augusto von Dentz (cp.num_iac * 3) + 1, &cp, 55322bd1b237SLuiz Augusto von Dentz HCI_CMD_TIMEOUT); 55332bd1b237SLuiz Augusto von Dentz } 55342bd1b237SLuiz Augusto von Dentz 55352bd1b237SLuiz Augusto von Dentz int hci_update_discoverable_sync(struct hci_dev *hdev) 55362bd1b237SLuiz Augusto von Dentz { 55372bd1b237SLuiz Augusto von Dentz int err = 0; 55382bd1b237SLuiz Augusto von Dentz 55392bd1b237SLuiz Augusto von Dentz if (hci_dev_test_flag(hdev, HCI_BREDR_ENABLED)) { 55402bd1b237SLuiz Augusto von Dentz err = hci_write_iac_sync(hdev); 55412bd1b237SLuiz Augusto von Dentz if (err) 55422bd1b237SLuiz Augusto von Dentz return err; 55432bd1b237SLuiz Augusto von Dentz 55442bd1b237SLuiz Augusto von Dentz err = hci_update_scan_sync(hdev); 55452bd1b237SLuiz Augusto von Dentz if (err) 55462bd1b237SLuiz Augusto von Dentz return err; 55472bd1b237SLuiz Augusto von Dentz 55482bd1b237SLuiz Augusto von Dentz err = hci_update_class_sync(hdev); 55492bd1b237SLuiz Augusto von Dentz if (err) 55502bd1b237SLuiz Augusto von Dentz return err; 55512bd1b237SLuiz Augusto von Dentz } 55522bd1b237SLuiz Augusto von Dentz 55532bd1b237SLuiz Augusto von Dentz /* Advertising instances don't use the global discoverable setting, so 55542bd1b237SLuiz Augusto von Dentz * only update AD if advertising was enabled using Set Advertising. 55552bd1b237SLuiz Augusto von Dentz */ 55562bd1b237SLuiz Augusto von Dentz if (hci_dev_test_flag(hdev, HCI_ADVERTISING)) { 55572bd1b237SLuiz Augusto von Dentz err = hci_update_adv_data_sync(hdev, 0x00); 55582bd1b237SLuiz Augusto von Dentz if (err) 55592bd1b237SLuiz Augusto von Dentz return err; 55602bd1b237SLuiz Augusto von Dentz 55612bd1b237SLuiz Augusto von Dentz /* Discoverable mode affects the local advertising 55622bd1b237SLuiz Augusto von Dentz * address in limited privacy mode. 55632bd1b237SLuiz Augusto von Dentz */ 55642bd1b237SLuiz Augusto von Dentz if (hci_dev_test_flag(hdev, HCI_LIMITED_PRIVACY)) { 55652bd1b237SLuiz Augusto von Dentz if (ext_adv_capable(hdev)) 55662bd1b237SLuiz Augusto von Dentz err = hci_start_ext_adv_sync(hdev, 0x00); 55672bd1b237SLuiz Augusto von Dentz else 55682bd1b237SLuiz Augusto von Dentz err = hci_enable_advertising_sync(hdev); 55692bd1b237SLuiz Augusto von Dentz } 55702bd1b237SLuiz Augusto von Dentz } 55712bd1b237SLuiz Augusto von Dentz 55722bd1b237SLuiz Augusto von Dentz return err; 55732bd1b237SLuiz Augusto von Dentz } 55742bd1b237SLuiz Augusto von Dentz 55752bd1b237SLuiz Augusto von Dentz static int update_discoverable_sync(struct hci_dev *hdev, void *data) 55762bd1b237SLuiz Augusto von Dentz { 55772bd1b237SLuiz Augusto von Dentz return hci_update_discoverable_sync(hdev); 55782bd1b237SLuiz Augusto von Dentz } 55792bd1b237SLuiz Augusto von Dentz 55802bd1b237SLuiz Augusto von Dentz int hci_update_discoverable(struct hci_dev *hdev) 55812bd1b237SLuiz Augusto von Dentz { 55822bd1b237SLuiz Augusto von Dentz /* Only queue if it would have any effect */ 55832bd1b237SLuiz Augusto von Dentz if (hdev_is_powered(hdev) && 55842bd1b237SLuiz Augusto von Dentz hci_dev_test_flag(hdev, HCI_ADVERTISING) && 55852bd1b237SLuiz Augusto von Dentz hci_dev_test_flag(hdev, HCI_DISCOVERABLE) && 55862bd1b237SLuiz Augusto von Dentz hci_dev_test_flag(hdev, HCI_LIMITED_PRIVACY)) 55872bd1b237SLuiz Augusto von Dentz return hci_cmd_sync_queue(hdev, update_discoverable_sync, NULL, 55882bd1b237SLuiz Augusto von Dentz NULL); 55892bd1b237SLuiz Augusto von Dentz 55902bd1b237SLuiz Augusto von Dentz return 0; 55912bd1b237SLuiz Augusto von Dentz } 55922bd1b237SLuiz Augusto von Dentz 5593f056a657SLuiz Augusto von Dentz int hci_update_connectable_sync(struct hci_dev *hdev) 5594f056a657SLuiz Augusto von Dentz { 5595f056a657SLuiz Augusto von Dentz int err; 5596f056a657SLuiz Augusto von Dentz 5597f056a657SLuiz Augusto von Dentz err = hci_update_scan_sync(hdev); 5598f056a657SLuiz Augusto von Dentz if (err) 5599f056a657SLuiz Augusto von Dentz return err; 5600f056a657SLuiz Augusto von Dentz 5601f056a657SLuiz Augusto von Dentz /* If BR/EDR is not enabled and we disable advertising as a 5602f056a657SLuiz Augusto von Dentz * by-product of disabling connectable, we need to update the 5603f056a657SLuiz Augusto von Dentz * advertising flags. 5604f056a657SLuiz Augusto von Dentz */ 5605f056a657SLuiz Augusto von Dentz if (!hci_dev_test_flag(hdev, HCI_BREDR_ENABLED)) 5606f056a657SLuiz Augusto von Dentz err = hci_update_adv_data_sync(hdev, hdev->cur_adv_instance); 5607f056a657SLuiz Augusto von Dentz 5608f056a657SLuiz Augusto von Dentz /* Update the advertising parameters if necessary */ 5609f056a657SLuiz Augusto von Dentz if (hci_dev_test_flag(hdev, HCI_ADVERTISING) || 5610f056a657SLuiz Augusto von Dentz !list_empty(&hdev->adv_instances)) { 5611f056a657SLuiz Augusto von Dentz if (ext_adv_capable(hdev)) 5612f056a657SLuiz Augusto von Dentz err = hci_start_ext_adv_sync(hdev, 5613f056a657SLuiz Augusto von Dentz hdev->cur_adv_instance); 5614f056a657SLuiz Augusto von Dentz else 5615f056a657SLuiz Augusto von Dentz err = hci_enable_advertising_sync(hdev); 5616f056a657SLuiz Augusto von Dentz 5617f056a657SLuiz Augusto von Dentz if (err) 5618f056a657SLuiz Augusto von Dentz return err; 5619f056a657SLuiz Augusto von Dentz } 5620f056a657SLuiz Augusto von Dentz 5621f056a657SLuiz Augusto von Dentz return hci_update_passive_scan_sync(hdev); 5622f056a657SLuiz Augusto von Dentz } 5623f056a657SLuiz Augusto von Dentz 5624abfeea47SLuiz Augusto von Dentz static int hci_inquiry_sync(struct hci_dev *hdev, u8 length) 5625abfeea47SLuiz Augusto von Dentz { 5626abfeea47SLuiz Augusto von Dentz const u8 giac[3] = { 0x33, 0x8b, 0x9e }; 5627abfeea47SLuiz Augusto von Dentz const u8 liac[3] = { 0x00, 0x8b, 0x9e }; 5628abfeea47SLuiz Augusto von Dentz struct hci_cp_inquiry cp; 5629abfeea47SLuiz Augusto von Dentz 5630abfeea47SLuiz Augusto von Dentz bt_dev_dbg(hdev, ""); 5631abfeea47SLuiz Augusto von Dentz 56320a07fa1fSJonas Dreßler if (test_bit(HCI_INQUIRY, &hdev->flags)) 5633abfeea47SLuiz Augusto von Dentz return 0; 5634abfeea47SLuiz Augusto von Dentz 5635abfeea47SLuiz Augusto von Dentz hci_dev_lock(hdev); 5636abfeea47SLuiz Augusto von Dentz hci_inquiry_cache_flush(hdev); 5637abfeea47SLuiz Augusto von Dentz hci_dev_unlock(hdev); 5638abfeea47SLuiz Augusto von Dentz 5639abfeea47SLuiz Augusto von Dentz memset(&cp, 0, sizeof(cp)); 5640abfeea47SLuiz Augusto von Dentz 5641abfeea47SLuiz Augusto von Dentz if (hdev->discovery.limited) 5642abfeea47SLuiz Augusto von Dentz memcpy(&cp.lap, liac, sizeof(cp.lap)); 5643abfeea47SLuiz Augusto von Dentz else 5644abfeea47SLuiz Augusto von Dentz memcpy(&cp.lap, giac, sizeof(cp.lap)); 5645abfeea47SLuiz Augusto von Dentz 5646abfeea47SLuiz Augusto von Dentz cp.length = length; 5647abfeea47SLuiz Augusto von Dentz 5648abfeea47SLuiz Augusto von Dentz return __hci_cmd_sync_status(hdev, HCI_OP_INQUIRY, 5649abfeea47SLuiz Augusto von Dentz sizeof(cp), &cp, HCI_CMD_TIMEOUT); 5650abfeea47SLuiz Augusto von Dentz } 5651abfeea47SLuiz Augusto von Dentz 5652abfeea47SLuiz Augusto von Dentz static int hci_active_scan_sync(struct hci_dev *hdev, uint16_t interval) 5653abfeea47SLuiz Augusto von Dentz { 5654abfeea47SLuiz Augusto von Dentz u8 own_addr_type; 5655abfeea47SLuiz Augusto von Dentz /* Accept list is not used for discovery */ 5656abfeea47SLuiz Augusto von Dentz u8 filter_policy = 0x00; 5657abfeea47SLuiz Augusto von Dentz /* Default is to enable duplicates filter */ 5658abfeea47SLuiz Augusto von Dentz u8 filter_dup = LE_SCAN_FILTER_DUP_ENABLE; 5659abfeea47SLuiz Augusto von Dentz int err; 5660abfeea47SLuiz Augusto von Dentz 5661abfeea47SLuiz Augusto von Dentz bt_dev_dbg(hdev, ""); 5662abfeea47SLuiz Augusto von Dentz 5663abfeea47SLuiz Augusto von Dentz /* If controller is scanning, it means the passive scanning is 5664abfeea47SLuiz Augusto von Dentz * running. Thus, we should temporarily stop it in order to set the 5665abfeea47SLuiz Augusto von Dentz * discovery scanning parameters. 5666abfeea47SLuiz Augusto von Dentz */ 5667abfeea47SLuiz Augusto von Dentz err = hci_scan_disable_sync(hdev); 5668abfeea47SLuiz Augusto von Dentz if (err) { 5669abfeea47SLuiz Augusto von Dentz bt_dev_err(hdev, "Unable to disable scanning: %d", err); 5670abfeea47SLuiz Augusto von Dentz return err; 5671abfeea47SLuiz Augusto von Dentz } 5672abfeea47SLuiz Augusto von Dentz 5673abfeea47SLuiz Augusto von Dentz cancel_interleave_scan(hdev); 5674abfeea47SLuiz Augusto von Dentz 56753c44a431SZhengping Jiang /* Pause address resolution for active scan and stop advertising if 56763c44a431SZhengping Jiang * privacy is enabled. 5677abfeea47SLuiz Augusto von Dentz */ 56783c44a431SZhengping Jiang err = hci_pause_addr_resolution(hdev); 56793c44a431SZhengping Jiang if (err) 5680abfeea47SLuiz Augusto von Dentz goto failed; 5681abfeea47SLuiz Augusto von Dentz 5682abfeea47SLuiz Augusto von Dentz /* All active scans will be done with either a resolvable private 5683abfeea47SLuiz Augusto von Dentz * address (when privacy feature has been enabled) or non-resolvable 5684abfeea47SLuiz Augusto von Dentz * private address. 5685abfeea47SLuiz Augusto von Dentz */ 5686abfeea47SLuiz Augusto von Dentz err = hci_update_random_address_sync(hdev, true, scan_use_rpa(hdev), 5687abfeea47SLuiz Augusto von Dentz &own_addr_type); 5688abfeea47SLuiz Augusto von Dentz if (err < 0) 5689abfeea47SLuiz Augusto von Dentz own_addr_type = ADDR_LE_DEV_PUBLIC; 5690abfeea47SLuiz Augusto von Dentz 5691abfeea47SLuiz Augusto von Dentz if (hci_is_adv_monitoring(hdev)) { 5692abfeea47SLuiz Augusto von Dentz /* Duplicate filter should be disabled when some advertisement 5693abfeea47SLuiz Augusto von Dentz * monitor is activated, otherwise AdvMon can only receive one 5694abfeea47SLuiz Augusto von Dentz * advertisement for one peer(*) during active scanning, and 5695abfeea47SLuiz Augusto von Dentz * might report loss to these peers. 5696abfeea47SLuiz Augusto von Dentz * 5697abfeea47SLuiz Augusto von Dentz * Note that different controllers have different meanings of 5698abfeea47SLuiz Augusto von Dentz * |duplicate|. Some of them consider packets with the same 5699abfeea47SLuiz Augusto von Dentz * address as duplicate, and others consider packets with the 5700abfeea47SLuiz Augusto von Dentz * same address and the same RSSI as duplicate. Although in the 5701abfeea47SLuiz Augusto von Dentz * latter case we don't need to disable duplicate filter, but 5702abfeea47SLuiz Augusto von Dentz * it is common to have active scanning for a short period of 5703abfeea47SLuiz Augusto von Dentz * time, the power impact should be neglectable. 5704abfeea47SLuiz Augusto von Dentz */ 5705abfeea47SLuiz Augusto von Dentz filter_dup = LE_SCAN_FILTER_DUP_DISABLE; 5706abfeea47SLuiz Augusto von Dentz } 5707abfeea47SLuiz Augusto von Dentz 5708abfeea47SLuiz Augusto von Dentz err = hci_start_scan_sync(hdev, LE_SCAN_ACTIVE, interval, 5709abfeea47SLuiz Augusto von Dentz hdev->le_scan_window_discovery, 5710abfeea47SLuiz Augusto von Dentz own_addr_type, filter_policy, filter_dup); 5711abfeea47SLuiz Augusto von Dentz if (!err) 5712abfeea47SLuiz Augusto von Dentz return err; 5713abfeea47SLuiz Augusto von Dentz 5714abfeea47SLuiz Augusto von Dentz failed: 5715abfeea47SLuiz Augusto von Dentz /* Resume advertising if it was paused */ 5716abfeea47SLuiz Augusto von Dentz if (use_ll_privacy(hdev)) 5717abfeea47SLuiz Augusto von Dentz hci_resume_advertising_sync(hdev); 5718abfeea47SLuiz Augusto von Dentz 5719abfeea47SLuiz Augusto von Dentz /* Resume passive scanning */ 5720abfeea47SLuiz Augusto von Dentz hci_update_passive_scan_sync(hdev); 5721abfeea47SLuiz Augusto von Dentz return err; 5722abfeea47SLuiz Augusto von Dentz } 5723abfeea47SLuiz Augusto von Dentz 5724abfeea47SLuiz Augusto von Dentz static int hci_start_interleaved_discovery_sync(struct hci_dev *hdev) 5725abfeea47SLuiz Augusto von Dentz { 5726abfeea47SLuiz Augusto von Dentz int err; 5727abfeea47SLuiz Augusto von Dentz 5728abfeea47SLuiz Augusto von Dentz bt_dev_dbg(hdev, ""); 5729abfeea47SLuiz Augusto von Dentz 5730abfeea47SLuiz Augusto von Dentz err = hci_active_scan_sync(hdev, hdev->le_scan_int_discovery * 2); 5731abfeea47SLuiz Augusto von Dentz if (err) 5732abfeea47SLuiz Augusto von Dentz return err; 5733abfeea47SLuiz Augusto von Dentz 5734abfeea47SLuiz Augusto von Dentz return hci_inquiry_sync(hdev, DISCOV_BREDR_INQUIRY_LEN); 5735abfeea47SLuiz Augusto von Dentz } 5736abfeea47SLuiz Augusto von Dentz 5737abfeea47SLuiz Augusto von Dentz int hci_start_discovery_sync(struct hci_dev *hdev) 5738abfeea47SLuiz Augusto von Dentz { 5739abfeea47SLuiz Augusto von Dentz unsigned long timeout; 5740abfeea47SLuiz Augusto von Dentz int err; 5741abfeea47SLuiz Augusto von Dentz 5742abfeea47SLuiz Augusto von Dentz bt_dev_dbg(hdev, "type %u", hdev->discovery.type); 5743abfeea47SLuiz Augusto von Dentz 5744abfeea47SLuiz Augusto von Dentz switch (hdev->discovery.type) { 5745abfeea47SLuiz Augusto von Dentz case DISCOV_TYPE_BREDR: 5746abfeea47SLuiz Augusto von Dentz return hci_inquiry_sync(hdev, DISCOV_BREDR_INQUIRY_LEN); 5747abfeea47SLuiz Augusto von Dentz case DISCOV_TYPE_INTERLEAVED: 5748abfeea47SLuiz Augusto von Dentz /* When running simultaneous discovery, the LE scanning time 5749abfeea47SLuiz Augusto von Dentz * should occupy the whole discovery time sine BR/EDR inquiry 5750abfeea47SLuiz Augusto von Dentz * and LE scanning are scheduled by the controller. 5751abfeea47SLuiz Augusto von Dentz * 5752abfeea47SLuiz Augusto von Dentz * For interleaving discovery in comparison, BR/EDR inquiry 5753abfeea47SLuiz Augusto von Dentz * and LE scanning are done sequentially with separate 5754abfeea47SLuiz Augusto von Dentz * timeouts. 5755abfeea47SLuiz Augusto von Dentz */ 5756abfeea47SLuiz Augusto von Dentz if (test_bit(HCI_QUIRK_SIMULTANEOUS_DISCOVERY, 5757abfeea47SLuiz Augusto von Dentz &hdev->quirks)) { 5758abfeea47SLuiz Augusto von Dentz timeout = msecs_to_jiffies(DISCOV_LE_TIMEOUT); 5759abfeea47SLuiz Augusto von Dentz /* During simultaneous discovery, we double LE scan 5760abfeea47SLuiz Augusto von Dentz * interval. We must leave some time for the controller 5761abfeea47SLuiz Augusto von Dentz * to do BR/EDR inquiry. 5762abfeea47SLuiz Augusto von Dentz */ 5763abfeea47SLuiz Augusto von Dentz err = hci_start_interleaved_discovery_sync(hdev); 5764abfeea47SLuiz Augusto von Dentz break; 5765abfeea47SLuiz Augusto von Dentz } 5766abfeea47SLuiz Augusto von Dentz 5767abfeea47SLuiz Augusto von Dentz timeout = msecs_to_jiffies(hdev->discov_interleaved_timeout); 5768abfeea47SLuiz Augusto von Dentz err = hci_active_scan_sync(hdev, hdev->le_scan_int_discovery); 5769abfeea47SLuiz Augusto von Dentz break; 5770abfeea47SLuiz Augusto von Dentz case DISCOV_TYPE_LE: 5771abfeea47SLuiz Augusto von Dentz timeout = msecs_to_jiffies(DISCOV_LE_TIMEOUT); 5772abfeea47SLuiz Augusto von Dentz err = hci_active_scan_sync(hdev, hdev->le_scan_int_discovery); 5773abfeea47SLuiz Augusto von Dentz break; 5774abfeea47SLuiz Augusto von Dentz default: 5775abfeea47SLuiz Augusto von Dentz return -EINVAL; 5776abfeea47SLuiz Augusto von Dentz } 5777abfeea47SLuiz Augusto von Dentz 5778abfeea47SLuiz Augusto von Dentz if (err) 5779abfeea47SLuiz Augusto von Dentz return err; 5780abfeea47SLuiz Augusto von Dentz 5781abfeea47SLuiz Augusto von Dentz bt_dev_dbg(hdev, "timeout %u ms", jiffies_to_msecs(timeout)); 5782abfeea47SLuiz Augusto von Dentz 5783abfeea47SLuiz Augusto von Dentz /* When service discovery is used and the controller has a 5784abfeea47SLuiz Augusto von Dentz * strict duplicate filter, it is important to remember the 5785abfeea47SLuiz Augusto von Dentz * start and duration of the scan. This is required for 5786abfeea47SLuiz Augusto von Dentz * restarting scanning during the discovery phase. 5787abfeea47SLuiz Augusto von Dentz */ 5788abfeea47SLuiz Augusto von Dentz if (test_bit(HCI_QUIRK_STRICT_DUPLICATE_FILTER, &hdev->quirks) && 5789abfeea47SLuiz Augusto von Dentz hdev->discovery.result_filtering) { 5790abfeea47SLuiz Augusto von Dentz hdev->discovery.scan_start = jiffies; 5791abfeea47SLuiz Augusto von Dentz hdev->discovery.scan_duration = timeout; 5792abfeea47SLuiz Augusto von Dentz } 5793abfeea47SLuiz Augusto von Dentz 5794abfeea47SLuiz Augusto von Dentz queue_delayed_work(hdev->req_workqueue, &hdev->le_scan_disable, 5795abfeea47SLuiz Augusto von Dentz timeout); 5796abfeea47SLuiz Augusto von Dentz return 0; 5797abfeea47SLuiz Augusto von Dentz } 5798182ee45dSLuiz Augusto von Dentz 5799182ee45dSLuiz Augusto von Dentz static void hci_suspend_monitor_sync(struct hci_dev *hdev) 5800182ee45dSLuiz Augusto von Dentz { 5801182ee45dSLuiz Augusto von Dentz switch (hci_get_adv_monitor_offload_ext(hdev)) { 5802182ee45dSLuiz Augusto von Dentz case HCI_ADV_MONITOR_EXT_MSFT: 5803182ee45dSLuiz Augusto von Dentz msft_suspend_sync(hdev); 5804182ee45dSLuiz Augusto von Dentz break; 5805182ee45dSLuiz Augusto von Dentz default: 5806182ee45dSLuiz Augusto von Dentz return; 5807182ee45dSLuiz Augusto von Dentz } 5808182ee45dSLuiz Augusto von Dentz } 5809182ee45dSLuiz Augusto von Dentz 5810182ee45dSLuiz Augusto von Dentz /* This function disables discovery and mark it as paused */ 5811182ee45dSLuiz Augusto von Dentz static int hci_pause_discovery_sync(struct hci_dev *hdev) 5812182ee45dSLuiz Augusto von Dentz { 5813182ee45dSLuiz Augusto von Dentz int old_state = hdev->discovery.state; 5814182ee45dSLuiz Augusto von Dentz int err; 5815182ee45dSLuiz Augusto von Dentz 5816182ee45dSLuiz Augusto von Dentz /* If discovery already stopped/stopping/paused there nothing to do */ 5817182ee45dSLuiz Augusto von Dentz if (old_state == DISCOVERY_STOPPED || old_state == DISCOVERY_STOPPING || 5818182ee45dSLuiz Augusto von Dentz hdev->discovery_paused) 5819182ee45dSLuiz Augusto von Dentz return 0; 5820182ee45dSLuiz Augusto von Dentz 5821182ee45dSLuiz Augusto von Dentz hci_discovery_set_state(hdev, DISCOVERY_STOPPING); 5822182ee45dSLuiz Augusto von Dentz err = hci_stop_discovery_sync(hdev); 5823182ee45dSLuiz Augusto von Dentz if (err) 5824182ee45dSLuiz Augusto von Dentz return err; 5825182ee45dSLuiz Augusto von Dentz 5826182ee45dSLuiz Augusto von Dentz hdev->discovery_paused = true; 5827182ee45dSLuiz Augusto von Dentz hdev->discovery_old_state = old_state; 5828182ee45dSLuiz Augusto von Dentz hci_discovery_set_state(hdev, DISCOVERY_STOPPED); 5829182ee45dSLuiz Augusto von Dentz 5830182ee45dSLuiz Augusto von Dentz return 0; 5831182ee45dSLuiz Augusto von Dentz } 5832182ee45dSLuiz Augusto von Dentz 5833182ee45dSLuiz Augusto von Dentz static int hci_update_event_filter_sync(struct hci_dev *hdev) 5834182ee45dSLuiz Augusto von Dentz { 5835182ee45dSLuiz Augusto von Dentz struct bdaddr_list_with_flags *b; 5836182ee45dSLuiz Augusto von Dentz u8 scan = SCAN_DISABLED; 5837182ee45dSLuiz Augusto von Dentz bool scanning = test_bit(HCI_PSCAN, &hdev->flags); 5838182ee45dSLuiz Augusto von Dentz int err; 5839182ee45dSLuiz Augusto von Dentz 5840182ee45dSLuiz Augusto von Dentz if (!hci_dev_test_flag(hdev, HCI_BREDR_ENABLED)) 5841182ee45dSLuiz Augusto von Dentz return 0; 5842182ee45dSLuiz Augusto von Dentz 58430eaecfb2SIsmael Ferreras Morezuelas /* Some fake CSR controllers lock up after setting this type of 58440eaecfb2SIsmael Ferreras Morezuelas * filter, so avoid sending the request altogether. 58450eaecfb2SIsmael Ferreras Morezuelas */ 58460eaecfb2SIsmael Ferreras Morezuelas if (test_bit(HCI_QUIRK_BROKEN_FILTER_CLEAR_ALL, &hdev->quirks)) 58470eaecfb2SIsmael Ferreras Morezuelas return 0; 58480eaecfb2SIsmael Ferreras Morezuelas 5849182ee45dSLuiz Augusto von Dentz /* Always clear event filter when starting */ 5850182ee45dSLuiz Augusto von Dentz hci_clear_event_filter_sync(hdev); 5851182ee45dSLuiz Augusto von Dentz 5852182ee45dSLuiz Augusto von Dentz list_for_each_entry(b, &hdev->accept_list, list) { 5853e1cff700SLinus Torvalds if (!(b->flags & HCI_CONN_FLAG_REMOTE_WAKEUP)) 5854182ee45dSLuiz Augusto von Dentz continue; 5855182ee45dSLuiz Augusto von Dentz 5856182ee45dSLuiz Augusto von Dentz bt_dev_dbg(hdev, "Adding event filters for %pMR", &b->bdaddr); 5857182ee45dSLuiz Augusto von Dentz 5858182ee45dSLuiz Augusto von Dentz err = hci_set_event_filter_sync(hdev, HCI_FLT_CONN_SETUP, 5859182ee45dSLuiz Augusto von Dentz HCI_CONN_SETUP_ALLOW_BDADDR, 5860182ee45dSLuiz Augusto von Dentz &b->bdaddr, 5861182ee45dSLuiz Augusto von Dentz HCI_CONN_SETUP_AUTO_ON); 5862182ee45dSLuiz Augusto von Dentz if (err) 5863182ee45dSLuiz Augusto von Dentz bt_dev_dbg(hdev, "Failed to set event filter for %pMR", 5864182ee45dSLuiz Augusto von Dentz &b->bdaddr); 5865182ee45dSLuiz Augusto von Dentz else 5866182ee45dSLuiz Augusto von Dentz scan = SCAN_PAGE; 5867182ee45dSLuiz Augusto von Dentz } 5868182ee45dSLuiz Augusto von Dentz 5869182ee45dSLuiz Augusto von Dentz if (scan && !scanning) 5870182ee45dSLuiz Augusto von Dentz hci_write_scan_enable_sync(hdev, scan); 5871182ee45dSLuiz Augusto von Dentz else if (!scan && scanning) 5872182ee45dSLuiz Augusto von Dentz hci_write_scan_enable_sync(hdev, scan); 5873182ee45dSLuiz Augusto von Dentz 5874182ee45dSLuiz Augusto von Dentz return 0; 5875182ee45dSLuiz Augusto von Dentz } 5876182ee45dSLuiz Augusto von Dentz 58773b420553SLuiz Augusto von Dentz /* This function disables scan (BR and LE) and mark it as paused */ 58783b420553SLuiz Augusto von Dentz static int hci_pause_scan_sync(struct hci_dev *hdev) 58793b420553SLuiz Augusto von Dentz { 58803b420553SLuiz Augusto von Dentz if (hdev->scanning_paused) 58813b420553SLuiz Augusto von Dentz return 0; 58823b420553SLuiz Augusto von Dentz 58833b420553SLuiz Augusto von Dentz /* Disable page scan if enabled */ 58843b420553SLuiz Augusto von Dentz if (test_bit(HCI_PSCAN, &hdev->flags)) 58853b420553SLuiz Augusto von Dentz hci_write_scan_enable_sync(hdev, SCAN_DISABLED); 58863b420553SLuiz Augusto von Dentz 58873b420553SLuiz Augusto von Dentz hci_scan_disable_sync(hdev); 58883b420553SLuiz Augusto von Dentz 58893b420553SLuiz Augusto von Dentz hdev->scanning_paused = true; 58903b420553SLuiz Augusto von Dentz 58913b420553SLuiz Augusto von Dentz return 0; 58923b420553SLuiz Augusto von Dentz } 58933b420553SLuiz Augusto von Dentz 5894182ee45dSLuiz Augusto von Dentz /* This function performs the HCI suspend procedures in the follow order: 5895182ee45dSLuiz Augusto von Dentz * 5896182ee45dSLuiz Augusto von Dentz * Pause discovery (active scanning/inquiry) 5897182ee45dSLuiz Augusto von Dentz * Pause Directed Advertising/Advertising 58983b420553SLuiz Augusto von Dentz * Pause Scanning (passive scanning in case discovery was not active) 5899182ee45dSLuiz Augusto von Dentz * Disconnect all connections 5900182ee45dSLuiz Augusto von Dentz * Set suspend_status to BT_SUSPEND_DISCONNECT if hdev cannot wakeup 5901182ee45dSLuiz Augusto von Dentz * otherwise: 5902182ee45dSLuiz Augusto von Dentz * Update event mask (only set events that are allowed to wake up the host) 5903182ee45dSLuiz Augusto von Dentz * Update event filter (with devices marked with HCI_CONN_FLAG_REMOTE_WAKEUP) 5904182ee45dSLuiz Augusto von Dentz * Update passive scanning (lower duty cycle) 5905182ee45dSLuiz Augusto von Dentz * Set suspend_status to BT_SUSPEND_CONFIGURE_WAKE 5906182ee45dSLuiz Augusto von Dentz */ 5907182ee45dSLuiz Augusto von Dentz int hci_suspend_sync(struct hci_dev *hdev) 5908182ee45dSLuiz Augusto von Dentz { 5909182ee45dSLuiz Augusto von Dentz int err; 5910182ee45dSLuiz Augusto von Dentz 5911182ee45dSLuiz Augusto von Dentz /* If marked as suspended there nothing to do */ 5912182ee45dSLuiz Augusto von Dentz if (hdev->suspended) 5913182ee45dSLuiz Augusto von Dentz return 0; 5914182ee45dSLuiz Augusto von Dentz 5915182ee45dSLuiz Augusto von Dentz /* Mark device as suspended */ 5916182ee45dSLuiz Augusto von Dentz hdev->suspended = true; 5917182ee45dSLuiz Augusto von Dentz 5918182ee45dSLuiz Augusto von Dentz /* Pause discovery if not already stopped */ 5919182ee45dSLuiz Augusto von Dentz hci_pause_discovery_sync(hdev); 5920182ee45dSLuiz Augusto von Dentz 5921182ee45dSLuiz Augusto von Dentz /* Pause other advertisements */ 5922182ee45dSLuiz Augusto von Dentz hci_pause_advertising_sync(hdev); 5923182ee45dSLuiz Augusto von Dentz 5924182ee45dSLuiz Augusto von Dentz /* Suspend monitor filters */ 5925182ee45dSLuiz Augusto von Dentz hci_suspend_monitor_sync(hdev); 5926182ee45dSLuiz Augusto von Dentz 5927182ee45dSLuiz Augusto von Dentz /* Prevent disconnects from causing scanning to be re-enabled */ 59283b420553SLuiz Augusto von Dentz hci_pause_scan_sync(hdev); 5929182ee45dSLuiz Augusto von Dentz 5930123f6d3aSLuiz Augusto von Dentz if (hci_conn_count(hdev)) { 5931182ee45dSLuiz Augusto von Dentz /* Soft disconnect everything (power off) */ 5932182ee45dSLuiz Augusto von Dentz err = hci_disconnect_all_sync(hdev, HCI_ERROR_REMOTE_POWER_OFF); 5933182ee45dSLuiz Augusto von Dentz if (err) { 5934182ee45dSLuiz Augusto von Dentz /* Set state to BT_RUNNING so resume doesn't notify */ 5935182ee45dSLuiz Augusto von Dentz hdev->suspend_state = BT_RUNNING; 5936182ee45dSLuiz Augusto von Dentz hci_resume_sync(hdev); 5937182ee45dSLuiz Augusto von Dentz return err; 5938182ee45dSLuiz Augusto von Dentz } 5939182ee45dSLuiz Augusto von Dentz 5940123f6d3aSLuiz Augusto von Dentz /* Update event mask so only the allowed event can wakeup the 5941123f6d3aSLuiz Augusto von Dentz * host. 5942123f6d3aSLuiz Augusto von Dentz */ 5943ef61b6eaSAbhishek Pandit-Subedi hci_set_event_mask_sync(hdev); 5944123f6d3aSLuiz Augusto von Dentz } 5945ef61b6eaSAbhishek Pandit-Subedi 5946182ee45dSLuiz Augusto von Dentz /* Only configure accept list if disconnect succeeded and wake 5947182ee45dSLuiz Augusto von Dentz * isn't being prevented. 5948182ee45dSLuiz Augusto von Dentz */ 5949182ee45dSLuiz Augusto von Dentz if (!hdev->wakeup || !hdev->wakeup(hdev)) { 5950182ee45dSLuiz Augusto von Dentz hdev->suspend_state = BT_SUSPEND_DISCONNECT; 5951182ee45dSLuiz Augusto von Dentz return 0; 5952182ee45dSLuiz Augusto von Dentz } 5953182ee45dSLuiz Augusto von Dentz 5954182ee45dSLuiz Augusto von Dentz /* Unpause to take care of updating scanning params */ 5955182ee45dSLuiz Augusto von Dentz hdev->scanning_paused = false; 5956182ee45dSLuiz Augusto von Dentz 5957182ee45dSLuiz Augusto von Dentz /* Enable event filter for paired devices */ 5958182ee45dSLuiz Augusto von Dentz hci_update_event_filter_sync(hdev); 5959182ee45dSLuiz Augusto von Dentz 5960182ee45dSLuiz Augusto von Dentz /* Update LE passive scan if enabled */ 5961182ee45dSLuiz Augusto von Dentz hci_update_passive_scan_sync(hdev); 5962182ee45dSLuiz Augusto von Dentz 5963182ee45dSLuiz Augusto von Dentz /* Pause scan changes again. */ 5964182ee45dSLuiz Augusto von Dentz hdev->scanning_paused = true; 5965182ee45dSLuiz Augusto von Dentz 5966182ee45dSLuiz Augusto von Dentz hdev->suspend_state = BT_SUSPEND_CONFIGURE_WAKE; 5967182ee45dSLuiz Augusto von Dentz 5968182ee45dSLuiz Augusto von Dentz return 0; 5969182ee45dSLuiz Augusto von Dentz } 5970182ee45dSLuiz Augusto von Dentz 5971182ee45dSLuiz Augusto von Dentz /* This function resumes discovery */ 5972182ee45dSLuiz Augusto von Dentz static int hci_resume_discovery_sync(struct hci_dev *hdev) 5973182ee45dSLuiz Augusto von Dentz { 5974182ee45dSLuiz Augusto von Dentz int err; 5975182ee45dSLuiz Augusto von Dentz 5976182ee45dSLuiz Augusto von Dentz /* If discovery not paused there nothing to do */ 5977182ee45dSLuiz Augusto von Dentz if (!hdev->discovery_paused) 5978182ee45dSLuiz Augusto von Dentz return 0; 5979182ee45dSLuiz Augusto von Dentz 5980182ee45dSLuiz Augusto von Dentz hdev->discovery_paused = false; 5981182ee45dSLuiz Augusto von Dentz 5982182ee45dSLuiz Augusto von Dentz hci_discovery_set_state(hdev, DISCOVERY_STARTING); 5983182ee45dSLuiz Augusto von Dentz 5984182ee45dSLuiz Augusto von Dentz err = hci_start_discovery_sync(hdev); 5985182ee45dSLuiz Augusto von Dentz 5986182ee45dSLuiz Augusto von Dentz hci_discovery_set_state(hdev, err ? DISCOVERY_STOPPED : 5987182ee45dSLuiz Augusto von Dentz DISCOVERY_FINDING); 5988182ee45dSLuiz Augusto von Dentz 5989182ee45dSLuiz Augusto von Dentz return err; 5990182ee45dSLuiz Augusto von Dentz } 5991182ee45dSLuiz Augusto von Dentz 5992182ee45dSLuiz Augusto von Dentz static void hci_resume_monitor_sync(struct hci_dev *hdev) 5993182ee45dSLuiz Augusto von Dentz { 5994182ee45dSLuiz Augusto von Dentz switch (hci_get_adv_monitor_offload_ext(hdev)) { 5995182ee45dSLuiz Augusto von Dentz case HCI_ADV_MONITOR_EXT_MSFT: 5996182ee45dSLuiz Augusto von Dentz msft_resume_sync(hdev); 5997182ee45dSLuiz Augusto von Dentz break; 5998182ee45dSLuiz Augusto von Dentz default: 5999182ee45dSLuiz Augusto von Dentz return; 6000182ee45dSLuiz Augusto von Dentz } 6001182ee45dSLuiz Augusto von Dentz } 6002182ee45dSLuiz Augusto von Dentz 60033b420553SLuiz Augusto von Dentz /* This function resume scan and reset paused flag */ 60043b420553SLuiz Augusto von Dentz static int hci_resume_scan_sync(struct hci_dev *hdev) 60053b420553SLuiz Augusto von Dentz { 60063b420553SLuiz Augusto von Dentz if (!hdev->scanning_paused) 60073b420553SLuiz Augusto von Dentz return 0; 60083b420553SLuiz Augusto von Dentz 600968253f3cSZhengping Jiang hdev->scanning_paused = false; 601068253f3cSZhengping Jiang 60113b420553SLuiz Augusto von Dentz hci_update_scan_sync(hdev); 60123b420553SLuiz Augusto von Dentz 60133b420553SLuiz Augusto von Dentz /* Reset passive scanning to normal */ 60143b420553SLuiz Augusto von Dentz hci_update_passive_scan_sync(hdev); 60153b420553SLuiz Augusto von Dentz 60163b420553SLuiz Augusto von Dentz return 0; 60173b420553SLuiz Augusto von Dentz } 60183b420553SLuiz Augusto von Dentz 6019182ee45dSLuiz Augusto von Dentz /* This function performs the HCI suspend procedures in the follow order: 6020182ee45dSLuiz Augusto von Dentz * 6021182ee45dSLuiz Augusto von Dentz * Restore event mask 6022182ee45dSLuiz Augusto von Dentz * Clear event filter 6023182ee45dSLuiz Augusto von Dentz * Update passive scanning (normal duty cycle) 6024182ee45dSLuiz Augusto von Dentz * Resume Directed Advertising/Advertising 6025182ee45dSLuiz Augusto von Dentz * Resume discovery (active scanning/inquiry) 6026182ee45dSLuiz Augusto von Dentz */ 6027182ee45dSLuiz Augusto von Dentz int hci_resume_sync(struct hci_dev *hdev) 6028182ee45dSLuiz Augusto von Dentz { 6029182ee45dSLuiz Augusto von Dentz /* If not marked as suspended there nothing to do */ 6030182ee45dSLuiz Augusto von Dentz if (!hdev->suspended) 6031182ee45dSLuiz Augusto von Dentz return 0; 6032182ee45dSLuiz Augusto von Dentz 6033182ee45dSLuiz Augusto von Dentz hdev->suspended = false; 6034182ee45dSLuiz Augusto von Dentz 6035182ee45dSLuiz Augusto von Dentz /* Restore event mask */ 6036182ee45dSLuiz Augusto von Dentz hci_set_event_mask_sync(hdev); 6037182ee45dSLuiz Augusto von Dentz 6038182ee45dSLuiz Augusto von Dentz /* Clear any event filters and restore scan state */ 6039182ee45dSLuiz Augusto von Dentz hci_clear_event_filter_sync(hdev); 6040182ee45dSLuiz Augusto von Dentz 60413b420553SLuiz Augusto von Dentz /* Resume scanning */ 60423b420553SLuiz Augusto von Dentz hci_resume_scan_sync(hdev); 6043182ee45dSLuiz Augusto von Dentz 6044182ee45dSLuiz Augusto von Dentz /* Resume monitor filters */ 6045182ee45dSLuiz Augusto von Dentz hci_resume_monitor_sync(hdev); 6046182ee45dSLuiz Augusto von Dentz 6047182ee45dSLuiz Augusto von Dentz /* Resume other advertisements */ 6048182ee45dSLuiz Augusto von Dentz hci_resume_advertising_sync(hdev); 6049182ee45dSLuiz Augusto von Dentz 6050182ee45dSLuiz Augusto von Dentz /* Resume discovery */ 6051182ee45dSLuiz Augusto von Dentz hci_resume_discovery_sync(hdev); 6052182ee45dSLuiz Augusto von Dentz 6053182ee45dSLuiz Augusto von Dentz return 0; 6054182ee45dSLuiz Augusto von Dentz } 60558e8b92eeSLuiz Augusto von Dentz 60568e8b92eeSLuiz Augusto von Dentz static bool conn_use_rpa(struct hci_conn *conn) 60578e8b92eeSLuiz Augusto von Dentz { 60588e8b92eeSLuiz Augusto von Dentz struct hci_dev *hdev = conn->hdev; 60598e8b92eeSLuiz Augusto von Dentz 60608e8b92eeSLuiz Augusto von Dentz return hci_dev_test_flag(hdev, HCI_PRIVACY); 60618e8b92eeSLuiz Augusto von Dentz } 60628e8b92eeSLuiz Augusto von Dentz 60638e8b92eeSLuiz Augusto von Dentz static int hci_le_ext_directed_advertising_sync(struct hci_dev *hdev, 60648e8b92eeSLuiz Augusto von Dentz struct hci_conn *conn) 60658e8b92eeSLuiz Augusto von Dentz { 60668e8b92eeSLuiz Augusto von Dentz struct hci_cp_le_set_ext_adv_params cp; 60678e8b92eeSLuiz Augusto von Dentz int err; 60688e8b92eeSLuiz Augusto von Dentz bdaddr_t random_addr; 60698e8b92eeSLuiz Augusto von Dentz u8 own_addr_type; 60708e8b92eeSLuiz Augusto von Dentz 60718e8b92eeSLuiz Augusto von Dentz err = hci_update_random_address_sync(hdev, false, conn_use_rpa(conn), 60728e8b92eeSLuiz Augusto von Dentz &own_addr_type); 60738e8b92eeSLuiz Augusto von Dentz if (err) 60748e8b92eeSLuiz Augusto von Dentz return err; 60758e8b92eeSLuiz Augusto von Dentz 60768e8b92eeSLuiz Augusto von Dentz /* Set require_privacy to false so that the remote device has a 60778e8b92eeSLuiz Augusto von Dentz * chance of identifying us. 60788e8b92eeSLuiz Augusto von Dentz */ 60798e8b92eeSLuiz Augusto von Dentz err = hci_get_random_address(hdev, false, conn_use_rpa(conn), NULL, 60808e8b92eeSLuiz Augusto von Dentz &own_addr_type, &random_addr); 60818e8b92eeSLuiz Augusto von Dentz if (err) 60828e8b92eeSLuiz Augusto von Dentz return err; 60838e8b92eeSLuiz Augusto von Dentz 60848e8b92eeSLuiz Augusto von Dentz memset(&cp, 0, sizeof(cp)); 60858e8b92eeSLuiz Augusto von Dentz 60868e8b92eeSLuiz Augusto von Dentz cp.evt_properties = cpu_to_le16(LE_LEGACY_ADV_DIRECT_IND); 60878e8b92eeSLuiz Augusto von Dentz cp.channel_map = hdev->le_adv_channel_map; 60888e8b92eeSLuiz Augusto von Dentz cp.tx_power = HCI_TX_POWER_INVALID; 60898e8b92eeSLuiz Augusto von Dentz cp.primary_phy = HCI_ADV_PHY_1M; 60908e8b92eeSLuiz Augusto von Dentz cp.secondary_phy = HCI_ADV_PHY_1M; 60918e8b92eeSLuiz Augusto von Dentz cp.handle = 0x00; /* Use instance 0 for directed adv */ 60928e8b92eeSLuiz Augusto von Dentz cp.own_addr_type = own_addr_type; 60938e8b92eeSLuiz Augusto von Dentz cp.peer_addr_type = conn->dst_type; 60948e8b92eeSLuiz Augusto von Dentz bacpy(&cp.peer_addr, &conn->dst); 60958e8b92eeSLuiz Augusto von Dentz 60968e8b92eeSLuiz Augusto von Dentz /* As per Core Spec 5.2 Vol 2, PART E, Sec 7.8.53, for 60978e8b92eeSLuiz Augusto von Dentz * advertising_event_property LE_LEGACY_ADV_DIRECT_IND 60988e8b92eeSLuiz Augusto von Dentz * does not supports advertising data when the advertising set already 60998e8b92eeSLuiz Augusto von Dentz * contains some, the controller shall return erroc code 'Invalid 61008e8b92eeSLuiz Augusto von Dentz * HCI Command Parameters(0x12). 61018e8b92eeSLuiz Augusto von Dentz * So it is required to remove adv set for handle 0x00. since we use 61028e8b92eeSLuiz Augusto von Dentz * instance 0 for directed adv. 61038e8b92eeSLuiz Augusto von Dentz */ 61048e8b92eeSLuiz Augusto von Dentz err = hci_remove_ext_adv_instance_sync(hdev, cp.handle, NULL); 61058e8b92eeSLuiz Augusto von Dentz if (err) 61068e8b92eeSLuiz Augusto von Dentz return err; 61078e8b92eeSLuiz Augusto von Dentz 61088e8b92eeSLuiz Augusto von Dentz err = __hci_cmd_sync_status(hdev, HCI_OP_LE_SET_EXT_ADV_PARAMS, 61098e8b92eeSLuiz Augusto von Dentz sizeof(cp), &cp, HCI_CMD_TIMEOUT); 61108e8b92eeSLuiz Augusto von Dentz if (err) 61118e8b92eeSLuiz Augusto von Dentz return err; 61128e8b92eeSLuiz Augusto von Dentz 61138e8b92eeSLuiz Augusto von Dentz /* Check if random address need to be updated */ 61148e8b92eeSLuiz Augusto von Dentz if (own_addr_type == ADDR_LE_DEV_RANDOM && 61158e8b92eeSLuiz Augusto von Dentz bacmp(&random_addr, BDADDR_ANY) && 61168e8b92eeSLuiz Augusto von Dentz bacmp(&random_addr, &hdev->random_addr)) { 61178e8b92eeSLuiz Augusto von Dentz err = hci_set_adv_set_random_addr_sync(hdev, 0x00, 61188e8b92eeSLuiz Augusto von Dentz &random_addr); 61198e8b92eeSLuiz Augusto von Dentz if (err) 61208e8b92eeSLuiz Augusto von Dentz return err; 61218e8b92eeSLuiz Augusto von Dentz } 61228e8b92eeSLuiz Augusto von Dentz 61238e8b92eeSLuiz Augusto von Dentz return hci_enable_ext_advertising_sync(hdev, 0x00); 61248e8b92eeSLuiz Augusto von Dentz } 61258e8b92eeSLuiz Augusto von Dentz 61268e8b92eeSLuiz Augusto von Dentz static int hci_le_directed_advertising_sync(struct hci_dev *hdev, 61278e8b92eeSLuiz Augusto von Dentz struct hci_conn *conn) 61288e8b92eeSLuiz Augusto von Dentz { 61298e8b92eeSLuiz Augusto von Dentz struct hci_cp_le_set_adv_param cp; 61308e8b92eeSLuiz Augusto von Dentz u8 status; 61318e8b92eeSLuiz Augusto von Dentz u8 own_addr_type; 61328e8b92eeSLuiz Augusto von Dentz u8 enable; 61338e8b92eeSLuiz Augusto von Dentz 61348e8b92eeSLuiz Augusto von Dentz if (ext_adv_capable(hdev)) 61358e8b92eeSLuiz Augusto von Dentz return hci_le_ext_directed_advertising_sync(hdev, conn); 61368e8b92eeSLuiz Augusto von Dentz 61378e8b92eeSLuiz Augusto von Dentz /* Clear the HCI_LE_ADV bit temporarily so that the 61388e8b92eeSLuiz Augusto von Dentz * hci_update_random_address knows that it's safe to go ahead 61398e8b92eeSLuiz Augusto von Dentz * and write a new random address. The flag will be set back on 61408e8b92eeSLuiz Augusto von Dentz * as soon as the SET_ADV_ENABLE HCI command completes. 61418e8b92eeSLuiz Augusto von Dentz */ 61428e8b92eeSLuiz Augusto von Dentz hci_dev_clear_flag(hdev, HCI_LE_ADV); 61438e8b92eeSLuiz Augusto von Dentz 61448e8b92eeSLuiz Augusto von Dentz /* Set require_privacy to false so that the remote device has a 61458e8b92eeSLuiz Augusto von Dentz * chance of identifying us. 61468e8b92eeSLuiz Augusto von Dentz */ 61478e8b92eeSLuiz Augusto von Dentz status = hci_update_random_address_sync(hdev, false, conn_use_rpa(conn), 61488e8b92eeSLuiz Augusto von Dentz &own_addr_type); 61498e8b92eeSLuiz Augusto von Dentz if (status) 61508e8b92eeSLuiz Augusto von Dentz return status; 61518e8b92eeSLuiz Augusto von Dentz 61528e8b92eeSLuiz Augusto von Dentz memset(&cp, 0, sizeof(cp)); 61538e8b92eeSLuiz Augusto von Dentz 61548e8b92eeSLuiz Augusto von Dentz /* Some controllers might reject command if intervals are not 61558e8b92eeSLuiz Augusto von Dentz * within range for undirected advertising. 61568e8b92eeSLuiz Augusto von Dentz * BCM20702A0 is known to be affected by this. 61578e8b92eeSLuiz Augusto von Dentz */ 61588e8b92eeSLuiz Augusto von Dentz cp.min_interval = cpu_to_le16(0x0020); 61598e8b92eeSLuiz Augusto von Dentz cp.max_interval = cpu_to_le16(0x0020); 61608e8b92eeSLuiz Augusto von Dentz 61618e8b92eeSLuiz Augusto von Dentz cp.type = LE_ADV_DIRECT_IND; 61628e8b92eeSLuiz Augusto von Dentz cp.own_address_type = own_addr_type; 61638e8b92eeSLuiz Augusto von Dentz cp.direct_addr_type = conn->dst_type; 61648e8b92eeSLuiz Augusto von Dentz bacpy(&cp.direct_addr, &conn->dst); 61658e8b92eeSLuiz Augusto von Dentz cp.channel_map = hdev->le_adv_channel_map; 61668e8b92eeSLuiz Augusto von Dentz 61678e8b92eeSLuiz Augusto von Dentz status = __hci_cmd_sync_status(hdev, HCI_OP_LE_SET_ADV_PARAM, 61688e8b92eeSLuiz Augusto von Dentz sizeof(cp), &cp, HCI_CMD_TIMEOUT); 61698e8b92eeSLuiz Augusto von Dentz if (status) 61708e8b92eeSLuiz Augusto von Dentz return status; 61718e8b92eeSLuiz Augusto von Dentz 61728e8b92eeSLuiz Augusto von Dentz enable = 0x01; 61738e8b92eeSLuiz Augusto von Dentz 61748e8b92eeSLuiz Augusto von Dentz return __hci_cmd_sync_status(hdev, HCI_OP_LE_SET_ADV_ENABLE, 61758e8b92eeSLuiz Augusto von Dentz sizeof(enable), &enable, HCI_CMD_TIMEOUT); 61768e8b92eeSLuiz Augusto von Dentz } 61778e8b92eeSLuiz Augusto von Dentz 61788e8b92eeSLuiz Augusto von Dentz static void set_ext_conn_params(struct hci_conn *conn, 61798e8b92eeSLuiz Augusto von Dentz struct hci_cp_le_ext_conn_param *p) 61808e8b92eeSLuiz Augusto von Dentz { 61818e8b92eeSLuiz Augusto von Dentz struct hci_dev *hdev = conn->hdev; 61828e8b92eeSLuiz Augusto von Dentz 61838e8b92eeSLuiz Augusto von Dentz memset(p, 0, sizeof(*p)); 61848e8b92eeSLuiz Augusto von Dentz 61858e8b92eeSLuiz Augusto von Dentz p->scan_interval = cpu_to_le16(hdev->le_scan_int_connect); 61868e8b92eeSLuiz Augusto von Dentz p->scan_window = cpu_to_le16(hdev->le_scan_window_connect); 61878e8b92eeSLuiz Augusto von Dentz p->conn_interval_min = cpu_to_le16(conn->le_conn_min_interval); 61888e8b92eeSLuiz Augusto von Dentz p->conn_interval_max = cpu_to_le16(conn->le_conn_max_interval); 61898e8b92eeSLuiz Augusto von Dentz p->conn_latency = cpu_to_le16(conn->le_conn_latency); 61908e8b92eeSLuiz Augusto von Dentz p->supervision_timeout = cpu_to_le16(conn->le_supv_timeout); 61918e8b92eeSLuiz Augusto von Dentz p->min_ce_len = cpu_to_le16(0x0000); 61928e8b92eeSLuiz Augusto von Dentz p->max_ce_len = cpu_to_le16(0x0000); 61938e8b92eeSLuiz Augusto von Dentz } 61948e8b92eeSLuiz Augusto von Dentz 619589a0b8b9SLuiz Augusto von Dentz static int hci_le_ext_create_conn_sync(struct hci_dev *hdev, 619689a0b8b9SLuiz Augusto von Dentz struct hci_conn *conn, u8 own_addr_type) 61978e8b92eeSLuiz Augusto von Dentz { 61988e8b92eeSLuiz Augusto von Dentz struct hci_cp_le_ext_create_conn *cp; 61998e8b92eeSLuiz Augusto von Dentz struct hci_cp_le_ext_conn_param *p; 62008e8b92eeSLuiz Augusto von Dentz u8 data[sizeof(*cp) + sizeof(*p) * 3]; 62018e8b92eeSLuiz Augusto von Dentz u32 plen; 62028e8b92eeSLuiz Augusto von Dentz 62038e8b92eeSLuiz Augusto von Dentz cp = (void *)data; 62048e8b92eeSLuiz Augusto von Dentz p = (void *)cp->data; 62058e8b92eeSLuiz Augusto von Dentz 62068e8b92eeSLuiz Augusto von Dentz memset(cp, 0, sizeof(*cp)); 62078e8b92eeSLuiz Augusto von Dentz 62088e8b92eeSLuiz Augusto von Dentz bacpy(&cp->peer_addr, &conn->dst); 62098e8b92eeSLuiz Augusto von Dentz cp->peer_addr_type = conn->dst_type; 62108e8b92eeSLuiz Augusto von Dentz cp->own_addr_type = own_addr_type; 62118e8b92eeSLuiz Augusto von Dentz 62128e8b92eeSLuiz Augusto von Dentz plen = sizeof(*cp); 62138e8b92eeSLuiz Augusto von Dentz 62148e8b92eeSLuiz Augusto von Dentz if (scan_1m(hdev)) { 62158e8b92eeSLuiz Augusto von Dentz cp->phys |= LE_SCAN_PHY_1M; 62168e8b92eeSLuiz Augusto von Dentz set_ext_conn_params(conn, p); 62178e8b92eeSLuiz Augusto von Dentz 62188e8b92eeSLuiz Augusto von Dentz p++; 62198e8b92eeSLuiz Augusto von Dentz plen += sizeof(*p); 62208e8b92eeSLuiz Augusto von Dentz } 62218e8b92eeSLuiz Augusto von Dentz 62228e8b92eeSLuiz Augusto von Dentz if (scan_2m(hdev)) { 62238e8b92eeSLuiz Augusto von Dentz cp->phys |= LE_SCAN_PHY_2M; 62248e8b92eeSLuiz Augusto von Dentz set_ext_conn_params(conn, p); 62258e8b92eeSLuiz Augusto von Dentz 62268e8b92eeSLuiz Augusto von Dentz p++; 62278e8b92eeSLuiz Augusto von Dentz plen += sizeof(*p); 62288e8b92eeSLuiz Augusto von Dentz } 62298e8b92eeSLuiz Augusto von Dentz 62308e8b92eeSLuiz Augusto von Dentz if (scan_coded(hdev)) { 62318e8b92eeSLuiz Augusto von Dentz cp->phys |= LE_SCAN_PHY_CODED; 62328e8b92eeSLuiz Augusto von Dentz set_ext_conn_params(conn, p); 62338e8b92eeSLuiz Augusto von Dentz 62348e8b92eeSLuiz Augusto von Dentz plen += sizeof(*p); 62358e8b92eeSLuiz Augusto von Dentz } 62368e8b92eeSLuiz Augusto von Dentz 62376cd29ec6SLuiz Augusto von Dentz return __hci_cmd_sync_status_sk(hdev, HCI_OP_LE_EXT_CREATE_CONN, 62386cd29ec6SLuiz Augusto von Dentz plen, data, 62396cd29ec6SLuiz Augusto von Dentz HCI_EV_LE_ENHANCED_CONN_COMPLETE, 6240a56a1138SLuiz Augusto von Dentz conn->conn_timeout, NULL); 62418e8b92eeSLuiz Augusto von Dentz } 62428e8b92eeSLuiz Augusto von Dentz 62438e8b92eeSLuiz Augusto von Dentz int hci_le_create_conn_sync(struct hci_dev *hdev, struct hci_conn *conn) 62448e8b92eeSLuiz Augusto von Dentz { 62458e8b92eeSLuiz Augusto von Dentz struct hci_cp_le_create_conn cp; 62468e8b92eeSLuiz Augusto von Dentz struct hci_conn_params *params; 62478e8b92eeSLuiz Augusto von Dentz u8 own_addr_type; 62488e8b92eeSLuiz Augusto von Dentz int err; 62498e8b92eeSLuiz Augusto von Dentz 62508e8b92eeSLuiz Augusto von Dentz /* If requested to connect as peripheral use directed advertising */ 62518e8b92eeSLuiz Augusto von Dentz if (conn->role == HCI_ROLE_SLAVE) { 625276d0685bSLuiz Augusto von Dentz /* If we're active scanning and simultaneous roles is not 625376d0685bSLuiz Augusto von Dentz * enabled simply reject the attempt. 62548e8b92eeSLuiz Augusto von Dentz */ 62558e8b92eeSLuiz Augusto von Dentz if (hci_dev_test_flag(hdev, HCI_LE_SCAN) && 62564fc9857aSLuiz Augusto von Dentz hdev->le_scan_type == LE_SCAN_ACTIVE && 625776d0685bSLuiz Augusto von Dentz !hci_dev_test_flag(hdev, HCI_LE_SIMULTANEOUS_ROLES)) { 62588e8b92eeSLuiz Augusto von Dentz hci_conn_del(conn); 62598e8b92eeSLuiz Augusto von Dentz return -EBUSY; 62608e8b92eeSLuiz Augusto von Dentz } 62618e8b92eeSLuiz Augusto von Dentz 62624fc9857aSLuiz Augusto von Dentz /* Pause advertising while doing directed advertising. */ 62634fc9857aSLuiz Augusto von Dentz hci_pause_advertising_sync(hdev); 62644fc9857aSLuiz Augusto von Dentz 62658e8b92eeSLuiz Augusto von Dentz err = hci_le_directed_advertising_sync(hdev, conn); 62668e8b92eeSLuiz Augusto von Dentz goto done; 62678e8b92eeSLuiz Augusto von Dentz } 62688e8b92eeSLuiz Augusto von Dentz 626976d0685bSLuiz Augusto von Dentz /* Disable advertising if simultaneous roles is not in use. */ 627076d0685bSLuiz Augusto von Dentz if (!hci_dev_test_flag(hdev, HCI_LE_SIMULTANEOUS_ROLES)) 62714fc9857aSLuiz Augusto von Dentz hci_pause_advertising_sync(hdev); 62724fc9857aSLuiz Augusto von Dentz 62738e8b92eeSLuiz Augusto von Dentz params = hci_conn_params_lookup(hdev, &conn->dst, conn->dst_type); 62748e8b92eeSLuiz Augusto von Dentz if (params) { 62758e8b92eeSLuiz Augusto von Dentz conn->le_conn_min_interval = params->conn_min_interval; 62768e8b92eeSLuiz Augusto von Dentz conn->le_conn_max_interval = params->conn_max_interval; 62778e8b92eeSLuiz Augusto von Dentz conn->le_conn_latency = params->conn_latency; 62788e8b92eeSLuiz Augusto von Dentz conn->le_supv_timeout = params->supervision_timeout; 62798e8b92eeSLuiz Augusto von Dentz } else { 62808e8b92eeSLuiz Augusto von Dentz conn->le_conn_min_interval = hdev->le_conn_min_interval; 62818e8b92eeSLuiz Augusto von Dentz conn->le_conn_max_interval = hdev->le_conn_max_interval; 62828e8b92eeSLuiz Augusto von Dentz conn->le_conn_latency = hdev->le_conn_latency; 62838e8b92eeSLuiz Augusto von Dentz conn->le_supv_timeout = hdev->le_supv_timeout; 62848e8b92eeSLuiz Augusto von Dentz } 62858e8b92eeSLuiz Augusto von Dentz 62868e8b92eeSLuiz Augusto von Dentz /* If controller is scanning, we stop it since some controllers are 62878e8b92eeSLuiz Augusto von Dentz * not able to scan and connect at the same time. Also set the 62888e8b92eeSLuiz Augusto von Dentz * HCI_LE_SCAN_INTERRUPTED flag so that the command complete 62898e8b92eeSLuiz Augusto von Dentz * handler for scan disabling knows to set the correct discovery 62908e8b92eeSLuiz Augusto von Dentz * state. 62918e8b92eeSLuiz Augusto von Dentz */ 62928e8b92eeSLuiz Augusto von Dentz if (hci_dev_test_flag(hdev, HCI_LE_SCAN)) { 62938e8b92eeSLuiz Augusto von Dentz hci_scan_disable_sync(hdev); 62948e8b92eeSLuiz Augusto von Dentz hci_dev_set_flag(hdev, HCI_LE_SCAN_INTERRUPTED); 62958e8b92eeSLuiz Augusto von Dentz } 62968e8b92eeSLuiz Augusto von Dentz 62978e8b92eeSLuiz Augusto von Dentz /* Update random address, but set require_privacy to false so 62988e8b92eeSLuiz Augusto von Dentz * that we never connect with an non-resolvable address. 62998e8b92eeSLuiz Augusto von Dentz */ 63008e8b92eeSLuiz Augusto von Dentz err = hci_update_random_address_sync(hdev, false, conn_use_rpa(conn), 63018e8b92eeSLuiz Augusto von Dentz &own_addr_type); 63028e8b92eeSLuiz Augusto von Dentz if (err) 63038e8b92eeSLuiz Augusto von Dentz goto done; 63048e8b92eeSLuiz Augusto von Dentz 63058e8b92eeSLuiz Augusto von Dentz if (use_ext_conn(hdev)) { 63068e8b92eeSLuiz Augusto von Dentz err = hci_le_ext_create_conn_sync(hdev, conn, own_addr_type); 63078e8b92eeSLuiz Augusto von Dentz goto done; 63088e8b92eeSLuiz Augusto von Dentz } 63098e8b92eeSLuiz Augusto von Dentz 63108e8b92eeSLuiz Augusto von Dentz memset(&cp, 0, sizeof(cp)); 63118e8b92eeSLuiz Augusto von Dentz 63128e8b92eeSLuiz Augusto von Dentz cp.scan_interval = cpu_to_le16(hdev->le_scan_int_connect); 63138e8b92eeSLuiz Augusto von Dentz cp.scan_window = cpu_to_le16(hdev->le_scan_window_connect); 63148e8b92eeSLuiz Augusto von Dentz 63158e8b92eeSLuiz Augusto von Dentz bacpy(&cp.peer_addr, &conn->dst); 63168e8b92eeSLuiz Augusto von Dentz cp.peer_addr_type = conn->dst_type; 63178e8b92eeSLuiz Augusto von Dentz cp.own_address_type = own_addr_type; 63188e8b92eeSLuiz Augusto von Dentz cp.conn_interval_min = cpu_to_le16(conn->le_conn_min_interval); 63198e8b92eeSLuiz Augusto von Dentz cp.conn_interval_max = cpu_to_le16(conn->le_conn_max_interval); 63208e8b92eeSLuiz Augusto von Dentz cp.conn_latency = cpu_to_le16(conn->le_conn_latency); 63218e8b92eeSLuiz Augusto von Dentz cp.supervision_timeout = cpu_to_le16(conn->le_supv_timeout); 63228e8b92eeSLuiz Augusto von Dentz cp.min_ce_len = cpu_to_le16(0x0000); 63238e8b92eeSLuiz Augusto von Dentz cp.max_ce_len = cpu_to_le16(0x0000); 63248e8b92eeSLuiz Augusto von Dentz 6325a56a1138SLuiz Augusto von Dentz /* BLUETOOTH CORE SPECIFICATION Version 5.3 | Vol 4, Part E page 2261: 6326a56a1138SLuiz Augusto von Dentz * 6327a56a1138SLuiz Augusto von Dentz * If this event is unmasked and the HCI_LE_Connection_Complete event 6328a56a1138SLuiz Augusto von Dentz * is unmasked, only the HCI_LE_Enhanced_Connection_Complete event is 6329a56a1138SLuiz Augusto von Dentz * sent when a new connection has been created. 6330a56a1138SLuiz Augusto von Dentz */ 63316cd29ec6SLuiz Augusto von Dentz err = __hci_cmd_sync_status_sk(hdev, HCI_OP_LE_CREATE_CONN, 6332a56a1138SLuiz Augusto von Dentz sizeof(cp), &cp, 6333a56a1138SLuiz Augusto von Dentz use_enhanced_conn_complete(hdev) ? 6334a56a1138SLuiz Augusto von Dentz HCI_EV_LE_ENHANCED_CONN_COMPLETE : 6335a56a1138SLuiz Augusto von Dentz HCI_EV_LE_CONN_COMPLETE, 6336a56a1138SLuiz Augusto von Dentz conn->conn_timeout, NULL); 63378e8b92eeSLuiz Augusto von Dentz 63388e8b92eeSLuiz Augusto von Dentz done: 6339b62e7220SLuiz Augusto von Dentz if (err == -ETIMEDOUT) 6340a13f316eSLuiz Augusto von Dentz hci_le_connect_cancel_sync(hdev, conn, 0x00); 6341b62e7220SLuiz Augusto von Dentz 63424fc9857aSLuiz Augusto von Dentz /* Re-enable advertising after the connection attempt is finished. */ 63438e8b92eeSLuiz Augusto von Dentz hci_resume_advertising_sync(hdev); 63448e8b92eeSLuiz Augusto von Dentz return err; 63458e8b92eeSLuiz Augusto von Dentz } 634626afbd82SLuiz Augusto von Dentz 63477f74563eSPauli Virtanen int hci_le_create_cis_sync(struct hci_dev *hdev) 6348c09b80beSLuiz Augusto von Dentz { 6349c09b80beSLuiz Augusto von Dentz struct { 6350c09b80beSLuiz Augusto von Dentz struct hci_cp_le_create_cis cp; 6351c09b80beSLuiz Augusto von Dentz struct hci_cis cis[0x1f]; 6352c09b80beSLuiz Augusto von Dentz } cmd; 63537f74563eSPauli Virtanen struct hci_conn *conn; 63547f74563eSPauli Virtanen u8 cig = BT_ISO_QOS_CIG_UNSET; 6355c09b80beSLuiz Augusto von Dentz 63567f74563eSPauli Virtanen /* The spec allows only one pending LE Create CIS command at a time. If 63577f74563eSPauli Virtanen * the command is pending now, don't do anything. We check for pending 63587f74563eSPauli Virtanen * connections after each CIS Established event. 6359c09b80beSLuiz Augusto von Dentz * 6360c09b80beSLuiz Augusto von Dentz * BLUETOOTH CORE SPECIFICATION Version 5.3 | Vol 4, Part E 6361c09b80beSLuiz Augusto von Dentz * page 2566: 6362c09b80beSLuiz Augusto von Dentz * 6363c09b80beSLuiz Augusto von Dentz * If the Host issues this command before all the 6364c09b80beSLuiz Augusto von Dentz * HCI_LE_CIS_Established events from the previous use of the 6365c09b80beSLuiz Augusto von Dentz * command have been generated, the Controller shall return the 6366c09b80beSLuiz Augusto von Dentz * error code Command Disallowed (0x0C). 63677f74563eSPauli Virtanen * 63687f74563eSPauli Virtanen * BLUETOOTH CORE SPECIFICATION Version 5.3 | Vol 4, Part E 63697f74563eSPauli Virtanen * page 2567: 63707f74563eSPauli Virtanen * 63717f74563eSPauli Virtanen * When the Controller receives the HCI_LE_Create_CIS command, the 63727f74563eSPauli Virtanen * Controller sends the HCI_Command_Status event to the Host. An 63737f74563eSPauli Virtanen * HCI_LE_CIS_Established event will be generated for each CIS when it 63747f74563eSPauli Virtanen * is established or if it is disconnected or considered lost before 63757f74563eSPauli Virtanen * being established; until all the events are generated, the command 63767f74563eSPauli Virtanen * remains pending. 6377c09b80beSLuiz Augusto von Dentz */ 63787f74563eSPauli Virtanen 63797f74563eSPauli Virtanen memset(&cmd, 0, sizeof(cmd)); 63807f74563eSPauli Virtanen 63817f74563eSPauli Virtanen hci_dev_lock(hdev); 63827f74563eSPauli Virtanen 63837f74563eSPauli Virtanen rcu_read_lock(); 63847f74563eSPauli Virtanen 63857f74563eSPauli Virtanen /* Wait until previous Create CIS has completed */ 63867f74563eSPauli Virtanen list_for_each_entry_rcu(conn, &hdev->conn_hash.list, list) { 63877f74563eSPauli Virtanen if (test_bit(HCI_CONN_CREATE_CIS, &conn->flags)) 63887f74563eSPauli Virtanen goto done; 63897f74563eSPauli Virtanen } 63907f74563eSPauli Virtanen 63917f74563eSPauli Virtanen /* Find CIG with all CIS ready */ 63927f74563eSPauli Virtanen list_for_each_entry_rcu(conn, &hdev->conn_hash.list, list) { 63937f74563eSPauli Virtanen struct hci_conn *link; 63947f74563eSPauli Virtanen 63957f74563eSPauli Virtanen if (hci_conn_check_create_cis(conn)) 63967f74563eSPauli Virtanen continue; 63977f74563eSPauli Virtanen 63987f74563eSPauli Virtanen cig = conn->iso_qos.ucast.cig; 63997f74563eSPauli Virtanen 64007f74563eSPauli Virtanen list_for_each_entry_rcu(link, &hdev->conn_hash.list, list) { 64017f74563eSPauli Virtanen if (hci_conn_check_create_cis(link) > 0 && 64027f74563eSPauli Virtanen link->iso_qos.ucast.cig == cig && 64037f74563eSPauli Virtanen link->state != BT_CONNECTED) { 64047f74563eSPauli Virtanen cig = BT_ISO_QOS_CIG_UNSET; 64057f74563eSPauli Virtanen break; 64067f74563eSPauli Virtanen } 64077f74563eSPauli Virtanen } 64087f74563eSPauli Virtanen 64097f74563eSPauli Virtanen if (cig != BT_ISO_QOS_CIG_UNSET) 64107f74563eSPauli Virtanen break; 64117f74563eSPauli Virtanen } 64127f74563eSPauli Virtanen 64137f74563eSPauli Virtanen if (cig == BT_ISO_QOS_CIG_UNSET) 64147f74563eSPauli Virtanen goto done; 64157f74563eSPauli Virtanen 64167f74563eSPauli Virtanen list_for_each_entry_rcu(conn, &hdev->conn_hash.list, list) { 64177f74563eSPauli Virtanen struct hci_cis *cis = &cmd.cis[cmd.cp.num_cis]; 64187f74563eSPauli Virtanen 64197f74563eSPauli Virtanen if (hci_conn_check_create_cis(conn) || 64207f74563eSPauli Virtanen conn->iso_qos.ucast.cig != cig) 64217f74563eSPauli Virtanen continue; 64227f74563eSPauli Virtanen 64237f74563eSPauli Virtanen set_bit(HCI_CONN_CREATE_CIS, &conn->flags); 6424c09b80beSLuiz Augusto von Dentz cis->acl_handle = cpu_to_le16(conn->parent->handle); 6425c09b80beSLuiz Augusto von Dentz cis->cis_handle = cpu_to_le16(conn->handle); 6426c09b80beSLuiz Augusto von Dentz cmd.cp.num_cis++; 64277f74563eSPauli Virtanen 64287f74563eSPauli Virtanen if (cmd.cp.num_cis >= ARRAY_SIZE(cmd.cis)) 64297f74563eSPauli Virtanen break; 6430c09b80beSLuiz Augusto von Dentz } 6431c09b80beSLuiz Augusto von Dentz 64327f74563eSPauli Virtanen done: 6433c09b80beSLuiz Augusto von Dentz rcu_read_unlock(); 6434c09b80beSLuiz Augusto von Dentz 6435c09b80beSLuiz Augusto von Dentz hci_dev_unlock(hdev); 6436c09b80beSLuiz Augusto von Dentz 6437c09b80beSLuiz Augusto von Dentz if (!cmd.cp.num_cis) 6438c09b80beSLuiz Augusto von Dentz return 0; 6439c09b80beSLuiz Augusto von Dentz 6440c09b80beSLuiz Augusto von Dentz /* Wait for HCI_LE_CIS_Established */ 6441c09b80beSLuiz Augusto von Dentz return __hci_cmd_sync_status_sk(hdev, HCI_OP_LE_CREATE_CIS, 6442c09b80beSLuiz Augusto von Dentz sizeof(cmd.cp) + sizeof(cmd.cis[0]) * 6443c09b80beSLuiz Augusto von Dentz cmd.cp.num_cis, &cmd, 6444c09b80beSLuiz Augusto von Dentz HCI_EVT_LE_CIS_ESTABLISHED, 6445c09b80beSLuiz Augusto von Dentz conn->conn_timeout, NULL); 6446c09b80beSLuiz Augusto von Dentz } 6447c09b80beSLuiz Augusto von Dentz 644826afbd82SLuiz Augusto von Dentz int hci_le_remove_cig_sync(struct hci_dev *hdev, u8 handle) 644926afbd82SLuiz Augusto von Dentz { 645026afbd82SLuiz Augusto von Dentz struct hci_cp_le_remove_cig cp; 645126afbd82SLuiz Augusto von Dentz 645226afbd82SLuiz Augusto von Dentz memset(&cp, 0, sizeof(cp)); 645326afbd82SLuiz Augusto von Dentz cp.cig_id = handle; 645426afbd82SLuiz Augusto von Dentz 645526afbd82SLuiz Augusto von Dentz return __hci_cmd_sync_status(hdev, HCI_OP_LE_REMOVE_CIG, sizeof(cp), 645626afbd82SLuiz Augusto von Dentz &cp, HCI_CMD_TIMEOUT); 645726afbd82SLuiz Augusto von Dentz } 6458eca0ae4aSLuiz Augusto von Dentz 6459eca0ae4aSLuiz Augusto von Dentz int hci_le_big_terminate_sync(struct hci_dev *hdev, u8 handle) 6460eca0ae4aSLuiz Augusto von Dentz { 6461eca0ae4aSLuiz Augusto von Dentz struct hci_cp_le_big_term_sync cp; 6462eca0ae4aSLuiz Augusto von Dentz 6463eca0ae4aSLuiz Augusto von Dentz memset(&cp, 0, sizeof(cp)); 6464eca0ae4aSLuiz Augusto von Dentz cp.handle = handle; 6465eca0ae4aSLuiz Augusto von Dentz 6466eca0ae4aSLuiz Augusto von Dentz return __hci_cmd_sync_status(hdev, HCI_OP_LE_BIG_TERM_SYNC, 6467eca0ae4aSLuiz Augusto von Dentz sizeof(cp), &cp, HCI_CMD_TIMEOUT); 6468eca0ae4aSLuiz Augusto von Dentz } 6469eca0ae4aSLuiz Augusto von Dentz 6470eca0ae4aSLuiz Augusto von Dentz int hci_le_pa_terminate_sync(struct hci_dev *hdev, u16 handle) 6471eca0ae4aSLuiz Augusto von Dentz { 6472eca0ae4aSLuiz Augusto von Dentz struct hci_cp_le_pa_term_sync cp; 6473eca0ae4aSLuiz Augusto von Dentz 6474eca0ae4aSLuiz Augusto von Dentz memset(&cp, 0, sizeof(cp)); 6475eca0ae4aSLuiz Augusto von Dentz cp.handle = cpu_to_le16(handle); 6476eca0ae4aSLuiz Augusto von Dentz 6477eca0ae4aSLuiz Augusto von Dentz return __hci_cmd_sync_status(hdev, HCI_OP_LE_PA_TERM_SYNC, 6478eca0ae4aSLuiz Augusto von Dentz sizeof(cp), &cp, HCI_CMD_TIMEOUT); 6479eca0ae4aSLuiz Augusto von Dentz } 64803fe318eeSBrian Gix 64813fe318eeSBrian Gix int hci_get_random_address(struct hci_dev *hdev, bool require_privacy, 64823fe318eeSBrian Gix bool use_rpa, struct adv_info *adv_instance, 64833fe318eeSBrian Gix u8 *own_addr_type, bdaddr_t *rand_addr) 64843fe318eeSBrian Gix { 64853fe318eeSBrian Gix int err; 64863fe318eeSBrian Gix 64873fe318eeSBrian Gix bacpy(rand_addr, BDADDR_ANY); 64883fe318eeSBrian Gix 64893fe318eeSBrian Gix /* If privacy is enabled use a resolvable private address. If 64903fe318eeSBrian Gix * current RPA has expired then generate a new one. 64913fe318eeSBrian Gix */ 64923fe318eeSBrian Gix if (use_rpa) { 64933fe318eeSBrian Gix /* If Controller supports LL Privacy use own address type is 64943fe318eeSBrian Gix * 0x03 64953fe318eeSBrian Gix */ 64963fe318eeSBrian Gix if (use_ll_privacy(hdev)) 64973fe318eeSBrian Gix *own_addr_type = ADDR_LE_DEV_RANDOM_RESOLVED; 64983fe318eeSBrian Gix else 64993fe318eeSBrian Gix *own_addr_type = ADDR_LE_DEV_RANDOM; 65003fe318eeSBrian Gix 65013fe318eeSBrian Gix if (adv_instance) { 65023fe318eeSBrian Gix if (adv_rpa_valid(adv_instance)) 65033fe318eeSBrian Gix return 0; 65043fe318eeSBrian Gix } else { 65053fe318eeSBrian Gix if (rpa_valid(hdev)) 65063fe318eeSBrian Gix return 0; 65073fe318eeSBrian Gix } 65083fe318eeSBrian Gix 65093fe318eeSBrian Gix err = smp_generate_rpa(hdev, hdev->irk, &hdev->rpa); 65103fe318eeSBrian Gix if (err < 0) { 65113fe318eeSBrian Gix bt_dev_err(hdev, "failed to generate new RPA"); 65123fe318eeSBrian Gix return err; 65133fe318eeSBrian Gix } 65143fe318eeSBrian Gix 65153fe318eeSBrian Gix bacpy(rand_addr, &hdev->rpa); 65163fe318eeSBrian Gix 65173fe318eeSBrian Gix return 0; 65183fe318eeSBrian Gix } 65193fe318eeSBrian Gix 65203fe318eeSBrian Gix /* In case of required privacy without resolvable private address, 65213fe318eeSBrian Gix * use an non-resolvable private address. This is useful for 65223fe318eeSBrian Gix * non-connectable advertising. 65233fe318eeSBrian Gix */ 65243fe318eeSBrian Gix if (require_privacy) { 65253fe318eeSBrian Gix bdaddr_t nrpa; 65263fe318eeSBrian Gix 65273fe318eeSBrian Gix while (true) { 65283fe318eeSBrian Gix /* The non-resolvable private address is generated 65293fe318eeSBrian Gix * from random six bytes with the two most significant 65303fe318eeSBrian Gix * bits cleared. 65313fe318eeSBrian Gix */ 65323fe318eeSBrian Gix get_random_bytes(&nrpa, 6); 65333fe318eeSBrian Gix nrpa.b[5] &= 0x3f; 65343fe318eeSBrian Gix 65353fe318eeSBrian Gix /* The non-resolvable private address shall not be 65363fe318eeSBrian Gix * equal to the public address. 65373fe318eeSBrian Gix */ 65383fe318eeSBrian Gix if (bacmp(&hdev->bdaddr, &nrpa)) 65393fe318eeSBrian Gix break; 65403fe318eeSBrian Gix } 65413fe318eeSBrian Gix 65423fe318eeSBrian Gix *own_addr_type = ADDR_LE_DEV_RANDOM; 65433fe318eeSBrian Gix bacpy(rand_addr, &nrpa); 65443fe318eeSBrian Gix 65453fe318eeSBrian Gix return 0; 65463fe318eeSBrian Gix } 65473fe318eeSBrian Gix 65483fe318eeSBrian Gix /* No privacy so use a public address. */ 65493fe318eeSBrian Gix *own_addr_type = ADDR_LE_DEV_PUBLIC; 65503fe318eeSBrian Gix 65513fe318eeSBrian Gix return 0; 65523fe318eeSBrian Gix } 6553651cd3d6SBrian Gix 6554651cd3d6SBrian Gix static int _update_adv_data_sync(struct hci_dev *hdev, void *data) 6555651cd3d6SBrian Gix { 6556a1f6c3aeSLuiz Augusto von Dentz u8 instance = PTR_UINT(data); 6557651cd3d6SBrian Gix 6558651cd3d6SBrian Gix return hci_update_adv_data_sync(hdev, instance); 6559651cd3d6SBrian Gix } 6560651cd3d6SBrian Gix 6561651cd3d6SBrian Gix int hci_update_adv_data(struct hci_dev *hdev, u8 instance) 6562651cd3d6SBrian Gix { 65631ed8b37cSZhengchao Shao return hci_cmd_sync_queue(hdev, _update_adv_data_sync, 6564a1f6c3aeSLuiz Augusto von Dentz UINT_PTR(instance), NULL); 6565651cd3d6SBrian Gix } 6566