xref: /openbmc/linux/net/bluetooth/hci_sync.c (revision ae8853d0a3826bd4c5d3f13ee61c03deb3b74818)
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, &params->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 						&params->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, &params->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 				      &params->addr, params->addr_type);
2236195ef75eSPauli Virtanen 	if (!p)
2237195ef75eSPauli Virtanen 		p = hci_pend_le_action_lookup(&hdev->pend_le_reports,
2238195ef75eSPauli Virtanen 					      &params->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, &params->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, &params->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, &params->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, &params->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, &params->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, &params->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, &params[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, &params[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), &param, 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