mirror of
				https://github.com/torvalds/linux.git
				synced 2025-11-04 10:40:15 +02:00 
			
		
		
		
	This moves hci_is_le_conn_scanning to hci_core.h so it can be used by different files without having to duplicate its code. Signed-off-by: Luiz Augusto von Dentz <luiz.von.dentz@intel.com>
		
			
				
	
	
		
			901 lines
		
	
	
	
		
			25 KiB
		
	
	
	
		
			C
		
	
	
	
	
	
			
		
		
	
	
			901 lines
		
	
	
	
		
			25 KiB
		
	
	
	
		
			C
		
	
	
	
	
	
/*
 | 
						|
   BlueZ - Bluetooth protocol stack for Linux
 | 
						|
 | 
						|
   Copyright (C) 2014 Intel Corporation
 | 
						|
 | 
						|
   This program is free software; you can redistribute it and/or modify
 | 
						|
   it under the terms of the GNU General Public License version 2 as
 | 
						|
   published by the Free Software Foundation;
 | 
						|
 | 
						|
   THE SOFTWARE IS PROVIDED "AS IS", WITHOUT WARRANTY OF ANY KIND, EXPRESS
 | 
						|
   OR IMPLIED, INCLUDING BUT NOT LIMITED TO THE WARRANTIES OF MERCHANTABILITY,
 | 
						|
   FITNESS FOR A PARTICULAR PURPOSE AND NONINFRINGEMENT OF THIRD PARTY RIGHTS.
 | 
						|
   IN NO EVENT SHALL THE COPYRIGHT HOLDER(S) AND AUTHOR(S) BE LIABLE FOR ANY
 | 
						|
   CLAIM, OR ANY SPECIAL INDIRECT OR CONSEQUENTIAL DAMAGES, OR ANY DAMAGES
 | 
						|
   WHATSOEVER RESULTING FROM LOSS OF USE, DATA OR PROFITS, WHETHER IN AN
 | 
						|
   ACTION OF CONTRACT, NEGLIGENCE OR OTHER TORTIOUS ACTION, ARISING OUT OF
 | 
						|
   OR IN CONNECTION WITH THE USE OR PERFORMANCE OF THIS SOFTWARE.
 | 
						|
 | 
						|
   ALL LIABILITY, INCLUDING LIABILITY FOR INFRINGEMENT OF ANY PATENTS,
 | 
						|
   COPYRIGHTS, TRADEMARKS OR OTHER RIGHTS, RELATING TO USE OF THIS
 | 
						|
   SOFTWARE IS DISCLAIMED.
 | 
						|
*/
 | 
						|
 | 
						|
#include <linux/sched/signal.h>
 | 
						|
 | 
						|
#include <net/bluetooth/bluetooth.h>
 | 
						|
#include <net/bluetooth/hci_core.h>
 | 
						|
#include <net/bluetooth/mgmt.h>
 | 
						|
 | 
						|
#include "smp.h"
 | 
						|
#include "hci_request.h"
 | 
						|
#include "msft.h"
 | 
						|
#include "eir.h"
 | 
						|
 | 
						|
void hci_req_init(struct hci_request *req, struct hci_dev *hdev)
 | 
						|
{
 | 
						|
	skb_queue_head_init(&req->cmd_q);
 | 
						|
	req->hdev = hdev;
 | 
						|
	req->err = 0;
 | 
						|
}
 | 
						|
 | 
						|
void hci_req_purge(struct hci_request *req)
 | 
						|
{
 | 
						|
	skb_queue_purge(&req->cmd_q);
 | 
						|
}
 | 
						|
 | 
						|
bool hci_req_status_pend(struct hci_dev *hdev)
 | 
						|
{
 | 
						|
	return hdev->req_status == HCI_REQ_PEND;
 | 
						|
}
 | 
						|
 | 
						|
static int req_run(struct hci_request *req, hci_req_complete_t complete,
 | 
						|
		   hci_req_complete_skb_t complete_skb)
 | 
						|
{
 | 
						|
	struct hci_dev *hdev = req->hdev;
 | 
						|
	struct sk_buff *skb;
 | 
						|
	unsigned long flags;
 | 
						|
 | 
						|
	bt_dev_dbg(hdev, "length %u", skb_queue_len(&req->cmd_q));
 | 
						|
 | 
						|
	/* If an error occurred during request building, remove all HCI
 | 
						|
	 * commands queued on the HCI request queue.
 | 
						|
	 */
 | 
						|
	if (req->err) {
 | 
						|
		skb_queue_purge(&req->cmd_q);
 | 
						|
		return req->err;
 | 
						|
	}
 | 
						|
 | 
						|
	/* Do not allow empty requests */
 | 
						|
	if (skb_queue_empty(&req->cmd_q))
 | 
						|
		return -ENODATA;
 | 
						|
 | 
						|
	skb = skb_peek_tail(&req->cmd_q);
 | 
						|
	if (complete) {
 | 
						|
		bt_cb(skb)->hci.req_complete = complete;
 | 
						|
	} else if (complete_skb) {
 | 
						|
		bt_cb(skb)->hci.req_complete_skb = complete_skb;
 | 
						|
		bt_cb(skb)->hci.req_flags |= HCI_REQ_SKB;
 | 
						|
	}
 | 
						|
 | 
						|
	spin_lock_irqsave(&hdev->cmd_q.lock, flags);
 | 
						|
	skb_queue_splice_tail(&req->cmd_q, &hdev->cmd_q);
 | 
						|
	spin_unlock_irqrestore(&hdev->cmd_q.lock, flags);
 | 
						|
 | 
						|
	queue_work(hdev->workqueue, &hdev->cmd_work);
 | 
						|
 | 
						|
	return 0;
 | 
						|
}
 | 
						|
 | 
						|
int hci_req_run(struct hci_request *req, hci_req_complete_t complete)
 | 
						|
{
 | 
						|
	return req_run(req, complete, NULL);
 | 
						|
}
 | 
						|
 | 
						|
int hci_req_run_skb(struct hci_request *req, hci_req_complete_skb_t complete)
 | 
						|
{
 | 
						|
	return req_run(req, NULL, complete);
 | 
						|
}
 | 
						|
 | 
						|
void hci_req_sync_complete(struct hci_dev *hdev, u8 result, u16 opcode,
 | 
						|
			   struct sk_buff *skb)
 | 
						|
{
 | 
						|
	bt_dev_dbg(hdev, "result 0x%2.2x", result);
 | 
						|
 | 
						|
	if (hdev->req_status == HCI_REQ_PEND) {
 | 
						|
		hdev->req_result = result;
 | 
						|
		hdev->req_status = HCI_REQ_DONE;
 | 
						|
		if (skb)
 | 
						|
			hdev->req_skb = skb_get(skb);
 | 
						|
		wake_up_interruptible(&hdev->req_wait_q);
 | 
						|
	}
 | 
						|
}
 | 
						|
 | 
						|
/* Execute request and wait for completion. */
 | 
						|
int __hci_req_sync(struct hci_dev *hdev, int (*func)(struct hci_request *req,
 | 
						|
						     unsigned long opt),
 | 
						|
		   unsigned long opt, u32 timeout, u8 *hci_status)
 | 
						|
{
 | 
						|
	struct hci_request req;
 | 
						|
	int err = 0;
 | 
						|
 | 
						|
	bt_dev_dbg(hdev, "start");
 | 
						|
 | 
						|
	hci_req_init(&req, hdev);
 | 
						|
 | 
						|
	hdev->req_status = HCI_REQ_PEND;
 | 
						|
 | 
						|
	err = func(&req, opt);
 | 
						|
	if (err) {
 | 
						|
		if (hci_status)
 | 
						|
			*hci_status = HCI_ERROR_UNSPECIFIED;
 | 
						|
		return err;
 | 
						|
	}
 | 
						|
 | 
						|
	err = hci_req_run_skb(&req, hci_req_sync_complete);
 | 
						|
	if (err < 0) {
 | 
						|
		hdev->req_status = 0;
 | 
						|
 | 
						|
		/* ENODATA means the HCI request command queue is empty.
 | 
						|
		 * This can happen when a request with conditionals doesn't
 | 
						|
		 * trigger any commands to be sent. This is normal behavior
 | 
						|
		 * and should not trigger an error return.
 | 
						|
		 */
 | 
						|
		if (err == -ENODATA) {
 | 
						|
			if (hci_status)
 | 
						|
				*hci_status = 0;
 | 
						|
			return 0;
 | 
						|
		}
 | 
						|
 | 
						|
		if (hci_status)
 | 
						|
			*hci_status = HCI_ERROR_UNSPECIFIED;
 | 
						|
 | 
						|
		return err;
 | 
						|
	}
 | 
						|
 | 
						|
	err = wait_event_interruptible_timeout(hdev->req_wait_q,
 | 
						|
			hdev->req_status != HCI_REQ_PEND, timeout);
 | 
						|
 | 
						|
	if (err == -ERESTARTSYS)
 | 
						|
		return -EINTR;
 | 
						|
 | 
						|
	switch (hdev->req_status) {
 | 
						|
	case HCI_REQ_DONE:
 | 
						|
		err = -bt_to_errno(hdev->req_result);
 | 
						|
		if (hci_status)
 | 
						|
			*hci_status = hdev->req_result;
 | 
						|
		break;
 | 
						|
 | 
						|
	case HCI_REQ_CANCELED:
 | 
						|
		err = -hdev->req_result;
 | 
						|
		if (hci_status)
 | 
						|
			*hci_status = HCI_ERROR_UNSPECIFIED;
 | 
						|
		break;
 | 
						|
 | 
						|
	default:
 | 
						|
		err = -ETIMEDOUT;
 | 
						|
		if (hci_status)
 | 
						|
			*hci_status = HCI_ERROR_UNSPECIFIED;
 | 
						|
		break;
 | 
						|
	}
 | 
						|
 | 
						|
	kfree_skb(hdev->req_skb);
 | 
						|
	hdev->req_skb = NULL;
 | 
						|
	hdev->req_status = hdev->req_result = 0;
 | 
						|
 | 
						|
	bt_dev_dbg(hdev, "end: err %d", err);
 | 
						|
 | 
						|
	return err;
 | 
						|
}
 | 
						|
 | 
						|
int hci_req_sync(struct hci_dev *hdev, int (*req)(struct hci_request *req,
 | 
						|
						  unsigned long opt),
 | 
						|
		 unsigned long opt, u32 timeout, u8 *hci_status)
 | 
						|
{
 | 
						|
	int ret;
 | 
						|
 | 
						|
	/* Serialize all requests */
 | 
						|
	hci_req_sync_lock(hdev);
 | 
						|
	/* check the state after obtaing the lock to protect the HCI_UP
 | 
						|
	 * against any races from hci_dev_do_close when the controller
 | 
						|
	 * gets removed.
 | 
						|
	 */
 | 
						|
	if (test_bit(HCI_UP, &hdev->flags))
 | 
						|
		ret = __hci_req_sync(hdev, req, opt, timeout, hci_status);
 | 
						|
	else
 | 
						|
		ret = -ENETDOWN;
 | 
						|
	hci_req_sync_unlock(hdev);
 | 
						|
 | 
						|
	return ret;
 | 
						|
}
 | 
						|
 | 
						|
struct sk_buff *hci_prepare_cmd(struct hci_dev *hdev, u16 opcode, u32 plen,
 | 
						|
				const void *param)
 | 
						|
{
 | 
						|
	int len = HCI_COMMAND_HDR_SIZE + plen;
 | 
						|
	struct hci_command_hdr *hdr;
 | 
						|
	struct sk_buff *skb;
 | 
						|
 | 
						|
	skb = bt_skb_alloc(len, GFP_ATOMIC);
 | 
						|
	if (!skb)
 | 
						|
		return NULL;
 | 
						|
 | 
						|
	hdr = skb_put(skb, HCI_COMMAND_HDR_SIZE);
 | 
						|
	hdr->opcode = cpu_to_le16(opcode);
 | 
						|
	hdr->plen   = plen;
 | 
						|
 | 
						|
	if (plen)
 | 
						|
		skb_put_data(skb, param, plen);
 | 
						|
 | 
						|
	bt_dev_dbg(hdev, "skb len %d", skb->len);
 | 
						|
 | 
						|
	hci_skb_pkt_type(skb) = HCI_COMMAND_PKT;
 | 
						|
	hci_skb_opcode(skb) = opcode;
 | 
						|
 | 
						|
	return skb;
 | 
						|
}
 | 
						|
 | 
						|
/* Queue a command to an asynchronous HCI request */
 | 
						|
void hci_req_add_ev(struct hci_request *req, u16 opcode, u32 plen,
 | 
						|
		    const void *param, u8 event)
 | 
						|
{
 | 
						|
	struct hci_dev *hdev = req->hdev;
 | 
						|
	struct sk_buff *skb;
 | 
						|
 | 
						|
	bt_dev_dbg(hdev, "opcode 0x%4.4x plen %d", opcode, plen);
 | 
						|
 | 
						|
	/* If an error occurred during request building, there is no point in
 | 
						|
	 * queueing the HCI command. We can simply return.
 | 
						|
	 */
 | 
						|
	if (req->err)
 | 
						|
		return;
 | 
						|
 | 
						|
	skb = hci_prepare_cmd(hdev, opcode, plen, param);
 | 
						|
	if (!skb) {
 | 
						|
		bt_dev_err(hdev, "no memory for command (opcode 0x%4.4x)",
 | 
						|
			   opcode);
 | 
						|
		req->err = -ENOMEM;
 | 
						|
		return;
 | 
						|
	}
 | 
						|
 | 
						|
	if (skb_queue_empty(&req->cmd_q))
 | 
						|
		bt_cb(skb)->hci.req_flags |= HCI_REQ_START;
 | 
						|
 | 
						|
	hci_skb_event(skb) = event;
 | 
						|
 | 
						|
	skb_queue_tail(&req->cmd_q, skb);
 | 
						|
}
 | 
						|
 | 
						|
void hci_req_add(struct hci_request *req, u16 opcode, u32 plen,
 | 
						|
		 const void *param)
 | 
						|
{
 | 
						|
	bt_dev_dbg(req->hdev, "HCI_REQ-0x%4.4x", opcode);
 | 
						|
	hci_req_add_ev(req, opcode, plen, param, 0);
 | 
						|
}
 | 
						|
 | 
						|
static void start_interleave_scan(struct hci_dev *hdev)
 | 
						|
{
 | 
						|
	hdev->interleave_scan_state = INTERLEAVE_SCAN_NO_FILTER;
 | 
						|
	queue_delayed_work(hdev->req_workqueue,
 | 
						|
			   &hdev->interleave_scan, 0);
 | 
						|
}
 | 
						|
 | 
						|
static bool is_interleave_scanning(struct hci_dev *hdev)
 | 
						|
{
 | 
						|
	return hdev->interleave_scan_state != INTERLEAVE_SCAN_NONE;
 | 
						|
}
 | 
						|
 | 
						|
static void cancel_interleave_scan(struct hci_dev *hdev)
 | 
						|
{
 | 
						|
	bt_dev_dbg(hdev, "cancelling interleave scan");
 | 
						|
 | 
						|
	cancel_delayed_work_sync(&hdev->interleave_scan);
 | 
						|
 | 
						|
	hdev->interleave_scan_state = INTERLEAVE_SCAN_NONE;
 | 
						|
}
 | 
						|
 | 
						|
/* Return true if interleave_scan wasn't started until exiting this function,
 | 
						|
 * otherwise, return false
 | 
						|
 */
 | 
						|
static bool __hci_update_interleaved_scan(struct hci_dev *hdev)
 | 
						|
{
 | 
						|
	/* Do interleaved scan only if all of the following are true:
 | 
						|
	 * - There is at least one ADV monitor
 | 
						|
	 * - At least one pending LE connection or one device to be scanned for
 | 
						|
	 * - Monitor offloading is not supported
 | 
						|
	 * If so, we should alternate between allowlist scan and one without
 | 
						|
	 * any filters to save power.
 | 
						|
	 */
 | 
						|
	bool use_interleaving = hci_is_adv_monitoring(hdev) &&
 | 
						|
				!(list_empty(&hdev->pend_le_conns) &&
 | 
						|
				  list_empty(&hdev->pend_le_reports)) &&
 | 
						|
				hci_get_adv_monitor_offload_ext(hdev) ==
 | 
						|
				    HCI_ADV_MONITOR_EXT_NONE;
 | 
						|
	bool is_interleaving = is_interleave_scanning(hdev);
 | 
						|
 | 
						|
	if (use_interleaving && !is_interleaving) {
 | 
						|
		start_interleave_scan(hdev);
 | 
						|
		bt_dev_dbg(hdev, "starting interleave scan");
 | 
						|
		return true;
 | 
						|
	}
 | 
						|
 | 
						|
	if (!use_interleaving && is_interleaving)
 | 
						|
		cancel_interleave_scan(hdev);
 | 
						|
 | 
						|
	return false;
 | 
						|
}
 | 
						|
 | 
						|
void hci_req_add_le_scan_disable(struct hci_request *req, bool rpa_le_conn)
 | 
						|
{
 | 
						|
	struct hci_dev *hdev = req->hdev;
 | 
						|
 | 
						|
	if (hdev->scanning_paused) {
 | 
						|
		bt_dev_dbg(hdev, "Scanning is paused for suspend");
 | 
						|
		return;
 | 
						|
	}
 | 
						|
 | 
						|
	if (use_ext_scan(hdev)) {
 | 
						|
		struct hci_cp_le_set_ext_scan_enable cp;
 | 
						|
 | 
						|
		memset(&cp, 0, sizeof(cp));
 | 
						|
		cp.enable = LE_SCAN_DISABLE;
 | 
						|
		hci_req_add(req, HCI_OP_LE_SET_EXT_SCAN_ENABLE, sizeof(cp),
 | 
						|
			    &cp);
 | 
						|
	} else {
 | 
						|
		struct hci_cp_le_set_scan_enable cp;
 | 
						|
 | 
						|
		memset(&cp, 0, sizeof(cp));
 | 
						|
		cp.enable = LE_SCAN_DISABLE;
 | 
						|
		hci_req_add(req, HCI_OP_LE_SET_SCAN_ENABLE, sizeof(cp), &cp);
 | 
						|
	}
 | 
						|
 | 
						|
	/* Disable address resolution */
 | 
						|
	if (hci_dev_test_flag(hdev, HCI_LL_RPA_RESOLUTION) && !rpa_le_conn) {
 | 
						|
		__u8 enable = 0x00;
 | 
						|
 | 
						|
		hci_req_add(req, HCI_OP_LE_SET_ADDR_RESOLV_ENABLE, 1, &enable);
 | 
						|
	}
 | 
						|
}
 | 
						|
 | 
						|
static void del_from_accept_list(struct hci_request *req, bdaddr_t *bdaddr,
 | 
						|
				 u8 bdaddr_type)
 | 
						|
{
 | 
						|
	struct hci_cp_le_del_from_accept_list cp;
 | 
						|
 | 
						|
	cp.bdaddr_type = bdaddr_type;
 | 
						|
	bacpy(&cp.bdaddr, bdaddr);
 | 
						|
 | 
						|
	bt_dev_dbg(req->hdev, "Remove %pMR (0x%x) from accept list", &cp.bdaddr,
 | 
						|
		   cp.bdaddr_type);
 | 
						|
	hci_req_add(req, HCI_OP_LE_DEL_FROM_ACCEPT_LIST, sizeof(cp), &cp);
 | 
						|
 | 
						|
	if (use_ll_privacy(req->hdev)) {
 | 
						|
		struct smp_irk *irk;
 | 
						|
 | 
						|
		irk = hci_find_irk_by_addr(req->hdev, bdaddr, bdaddr_type);
 | 
						|
		if (irk) {
 | 
						|
			struct hci_cp_le_del_from_resolv_list cp;
 | 
						|
 | 
						|
			cp.bdaddr_type = bdaddr_type;
 | 
						|
			bacpy(&cp.bdaddr, bdaddr);
 | 
						|
 | 
						|
			hci_req_add(req, HCI_OP_LE_DEL_FROM_RESOLV_LIST,
 | 
						|
				    sizeof(cp), &cp);
 | 
						|
		}
 | 
						|
	}
 | 
						|
}
 | 
						|
 | 
						|
/* Adds connection to accept list if needed. On error, returns -1. */
 | 
						|
static int add_to_accept_list(struct hci_request *req,
 | 
						|
			      struct hci_conn_params *params, u8 *num_entries,
 | 
						|
			      bool allow_rpa)
 | 
						|
{
 | 
						|
	struct hci_cp_le_add_to_accept_list cp;
 | 
						|
	struct hci_dev *hdev = req->hdev;
 | 
						|
 | 
						|
	/* Already in accept list */
 | 
						|
	if (hci_bdaddr_list_lookup(&hdev->le_accept_list, ¶ms->addr,
 | 
						|
				   params->addr_type))
 | 
						|
		return 0;
 | 
						|
 | 
						|
	/* Select filter policy to accept all advertising */
 | 
						|
	if (*num_entries >= hdev->le_accept_list_size)
 | 
						|
		return -1;
 | 
						|
 | 
						|
	/* Accept list can not be used with RPAs */
 | 
						|
	if (!allow_rpa &&
 | 
						|
	    !hci_dev_test_flag(hdev, HCI_ENABLE_LL_PRIVACY) &&
 | 
						|
	    hci_find_irk_by_addr(hdev, ¶ms->addr, params->addr_type)) {
 | 
						|
		return -1;
 | 
						|
	}
 | 
						|
 | 
						|
	/* During suspend, only wakeable devices can be in accept list */
 | 
						|
	if (hdev->suspended &&
 | 
						|
	    !(params->flags & HCI_CONN_FLAG_REMOTE_WAKEUP))
 | 
						|
		return 0;
 | 
						|
 | 
						|
	*num_entries += 1;
 | 
						|
	cp.bdaddr_type = params->addr_type;
 | 
						|
	bacpy(&cp.bdaddr, ¶ms->addr);
 | 
						|
 | 
						|
	bt_dev_dbg(hdev, "Add %pMR (0x%x) to accept list", &cp.bdaddr,
 | 
						|
		   cp.bdaddr_type);
 | 
						|
	hci_req_add(req, HCI_OP_LE_ADD_TO_ACCEPT_LIST, sizeof(cp), &cp);
 | 
						|
 | 
						|
	if (use_ll_privacy(hdev)) {
 | 
						|
		struct smp_irk *irk;
 | 
						|
 | 
						|
		irk = hci_find_irk_by_addr(hdev, ¶ms->addr,
 | 
						|
					   params->addr_type);
 | 
						|
		if (irk) {
 | 
						|
			struct hci_cp_le_add_to_resolv_list cp;
 | 
						|
 | 
						|
			cp.bdaddr_type = params->addr_type;
 | 
						|
			bacpy(&cp.bdaddr, ¶ms->addr);
 | 
						|
			memcpy(cp.peer_irk, irk->val, 16);
 | 
						|
 | 
						|
			if (hci_dev_test_flag(hdev, HCI_PRIVACY))
 | 
						|
				memcpy(cp.local_irk, hdev->irk, 16);
 | 
						|
			else
 | 
						|
				memset(cp.local_irk, 0, 16);
 | 
						|
 | 
						|
			hci_req_add(req, HCI_OP_LE_ADD_TO_RESOLV_LIST,
 | 
						|
				    sizeof(cp), &cp);
 | 
						|
		}
 | 
						|
	}
 | 
						|
 | 
						|
	return 0;
 | 
						|
}
 | 
						|
 | 
						|
static u8 update_accept_list(struct hci_request *req)
 | 
						|
{
 | 
						|
	struct hci_dev *hdev = req->hdev;
 | 
						|
	struct hci_conn_params *params;
 | 
						|
	struct bdaddr_list *b;
 | 
						|
	u8 num_entries = 0;
 | 
						|
	bool pend_conn, pend_report;
 | 
						|
	/* We allow usage of accept list even with RPAs in suspend. In the worst
 | 
						|
	 * case, we won't be able to wake from devices that use the privacy1.2
 | 
						|
	 * features. Additionally, once we support privacy1.2 and IRK
 | 
						|
	 * offloading, we can update this to also check for those conditions.
 | 
						|
	 */
 | 
						|
	bool allow_rpa = hdev->suspended;
 | 
						|
 | 
						|
	if (use_ll_privacy(hdev))
 | 
						|
		allow_rpa = true;
 | 
						|
 | 
						|
	/* Go through the current accept list programmed into the
 | 
						|
	 * controller one by one and check if that address is still
 | 
						|
	 * in the list of pending connections or list of devices to
 | 
						|
	 * report. If not present in either list, then queue the
 | 
						|
	 * command to remove it from the controller.
 | 
						|
	 */
 | 
						|
	list_for_each_entry(b, &hdev->le_accept_list, list) {
 | 
						|
		pend_conn = hci_pend_le_action_lookup(&hdev->pend_le_conns,
 | 
						|
						      &b->bdaddr,
 | 
						|
						      b->bdaddr_type);
 | 
						|
		pend_report = hci_pend_le_action_lookup(&hdev->pend_le_reports,
 | 
						|
							&b->bdaddr,
 | 
						|
							b->bdaddr_type);
 | 
						|
 | 
						|
		/* If the device is not likely to connect or report,
 | 
						|
		 * remove it from the accept list.
 | 
						|
		 */
 | 
						|
		if (!pend_conn && !pend_report) {
 | 
						|
			del_from_accept_list(req, &b->bdaddr, b->bdaddr_type);
 | 
						|
			continue;
 | 
						|
		}
 | 
						|
 | 
						|
		/* Accept list can not be used with RPAs */
 | 
						|
		if (!allow_rpa &&
 | 
						|
		    !hci_dev_test_flag(hdev, HCI_ENABLE_LL_PRIVACY) &&
 | 
						|
		    hci_find_irk_by_addr(hdev, &b->bdaddr, b->bdaddr_type)) {
 | 
						|
			return 0x00;
 | 
						|
		}
 | 
						|
 | 
						|
		num_entries++;
 | 
						|
	}
 | 
						|
 | 
						|
	/* Since all no longer valid accept list entries have been
 | 
						|
	 * removed, walk through the list of pending connections
 | 
						|
	 * and ensure that any new device gets programmed into
 | 
						|
	 * the controller.
 | 
						|
	 *
 | 
						|
	 * If the list of the devices is larger than the list of
 | 
						|
	 * available accept list entries in the controller, then
 | 
						|
	 * just abort and return filer policy value to not use the
 | 
						|
	 * accept list.
 | 
						|
	 */
 | 
						|
	list_for_each_entry(params, &hdev->pend_le_conns, action) {
 | 
						|
		if (add_to_accept_list(req, params, &num_entries, allow_rpa))
 | 
						|
			return 0x00;
 | 
						|
	}
 | 
						|
 | 
						|
	/* After adding all new pending connections, walk through
 | 
						|
	 * the list of pending reports and also add these to the
 | 
						|
	 * accept list if there is still space. Abort if space runs out.
 | 
						|
	 */
 | 
						|
	list_for_each_entry(params, &hdev->pend_le_reports, action) {
 | 
						|
		if (add_to_accept_list(req, params, &num_entries, allow_rpa))
 | 
						|
			return 0x00;
 | 
						|
	}
 | 
						|
 | 
						|
	/* Use the allowlist unless the following conditions are all true:
 | 
						|
	 * - We are not currently suspending
 | 
						|
	 * - There are 1 or more ADV monitors registered and it's not offloaded
 | 
						|
	 * - Interleaved scanning is not currently using the allowlist
 | 
						|
	 */
 | 
						|
	if (!idr_is_empty(&hdev->adv_monitors_idr) && !hdev->suspended &&
 | 
						|
	    hci_get_adv_monitor_offload_ext(hdev) == HCI_ADV_MONITOR_EXT_NONE &&
 | 
						|
	    hdev->interleave_scan_state != INTERLEAVE_SCAN_ALLOWLIST)
 | 
						|
		return 0x00;
 | 
						|
 | 
						|
	/* Select filter policy to use accept list */
 | 
						|
	return 0x01;
 | 
						|
}
 | 
						|
 | 
						|
static bool scan_use_rpa(struct hci_dev *hdev)
 | 
						|
{
 | 
						|
	return hci_dev_test_flag(hdev, HCI_PRIVACY);
 | 
						|
}
 | 
						|
 | 
						|
static void hci_req_start_scan(struct hci_request *req, u8 type, u16 interval,
 | 
						|
			       u16 window, u8 own_addr_type, u8 filter_policy,
 | 
						|
			       bool filter_dup, bool addr_resolv)
 | 
						|
{
 | 
						|
	struct hci_dev *hdev = req->hdev;
 | 
						|
 | 
						|
	if (hdev->scanning_paused) {
 | 
						|
		bt_dev_dbg(hdev, "Scanning is paused for suspend");
 | 
						|
		return;
 | 
						|
	}
 | 
						|
 | 
						|
	if (use_ll_privacy(hdev) && addr_resolv) {
 | 
						|
		u8 enable = 0x01;
 | 
						|
 | 
						|
		hci_req_add(req, HCI_OP_LE_SET_ADDR_RESOLV_ENABLE, 1, &enable);
 | 
						|
	}
 | 
						|
 | 
						|
	/* Use ext scanning if set ext scan param and ext scan enable is
 | 
						|
	 * supported
 | 
						|
	 */
 | 
						|
	if (use_ext_scan(hdev)) {
 | 
						|
		struct hci_cp_le_set_ext_scan_params *ext_param_cp;
 | 
						|
		struct hci_cp_le_set_ext_scan_enable ext_enable_cp;
 | 
						|
		struct hci_cp_le_scan_phy_params *phy_params;
 | 
						|
		u8 data[sizeof(*ext_param_cp) + sizeof(*phy_params) * 2];
 | 
						|
		u32 plen;
 | 
						|
 | 
						|
		ext_param_cp = (void *)data;
 | 
						|
		phy_params = (void *)ext_param_cp->data;
 | 
						|
 | 
						|
		memset(ext_param_cp, 0, sizeof(*ext_param_cp));
 | 
						|
		ext_param_cp->own_addr_type = own_addr_type;
 | 
						|
		ext_param_cp->filter_policy = filter_policy;
 | 
						|
 | 
						|
		plen = sizeof(*ext_param_cp);
 | 
						|
 | 
						|
		if (scan_1m(hdev) || scan_2m(hdev)) {
 | 
						|
			ext_param_cp->scanning_phys |= LE_SCAN_PHY_1M;
 | 
						|
 | 
						|
			memset(phy_params, 0, sizeof(*phy_params));
 | 
						|
			phy_params->type = type;
 | 
						|
			phy_params->interval = cpu_to_le16(interval);
 | 
						|
			phy_params->window = cpu_to_le16(window);
 | 
						|
 | 
						|
			plen += sizeof(*phy_params);
 | 
						|
			phy_params++;
 | 
						|
		}
 | 
						|
 | 
						|
		if (scan_coded(hdev)) {
 | 
						|
			ext_param_cp->scanning_phys |= LE_SCAN_PHY_CODED;
 | 
						|
 | 
						|
			memset(phy_params, 0, sizeof(*phy_params));
 | 
						|
			phy_params->type = type;
 | 
						|
			phy_params->interval = cpu_to_le16(interval);
 | 
						|
			phy_params->window = cpu_to_le16(window);
 | 
						|
 | 
						|
			plen += sizeof(*phy_params);
 | 
						|
			phy_params++;
 | 
						|
		}
 | 
						|
 | 
						|
		hci_req_add(req, HCI_OP_LE_SET_EXT_SCAN_PARAMS,
 | 
						|
			    plen, ext_param_cp);
 | 
						|
 | 
						|
		memset(&ext_enable_cp, 0, sizeof(ext_enable_cp));
 | 
						|
		ext_enable_cp.enable = LE_SCAN_ENABLE;
 | 
						|
		ext_enable_cp.filter_dup = filter_dup;
 | 
						|
 | 
						|
		hci_req_add(req, HCI_OP_LE_SET_EXT_SCAN_ENABLE,
 | 
						|
			    sizeof(ext_enable_cp), &ext_enable_cp);
 | 
						|
	} else {
 | 
						|
		struct hci_cp_le_set_scan_param param_cp;
 | 
						|
		struct hci_cp_le_set_scan_enable enable_cp;
 | 
						|
 | 
						|
		memset(¶m_cp, 0, sizeof(param_cp));
 | 
						|
		param_cp.type = type;
 | 
						|
		param_cp.interval = cpu_to_le16(interval);
 | 
						|
		param_cp.window = cpu_to_le16(window);
 | 
						|
		param_cp.own_address_type = own_addr_type;
 | 
						|
		param_cp.filter_policy = filter_policy;
 | 
						|
		hci_req_add(req, HCI_OP_LE_SET_SCAN_PARAM, sizeof(param_cp),
 | 
						|
			    ¶m_cp);
 | 
						|
 | 
						|
		memset(&enable_cp, 0, sizeof(enable_cp));
 | 
						|
		enable_cp.enable = LE_SCAN_ENABLE;
 | 
						|
		enable_cp.filter_dup = filter_dup;
 | 
						|
		hci_req_add(req, HCI_OP_LE_SET_SCAN_ENABLE, sizeof(enable_cp),
 | 
						|
			    &enable_cp);
 | 
						|
	}
 | 
						|
}
 | 
						|
 | 
						|
static void set_random_addr(struct hci_request *req, bdaddr_t *rpa);
 | 
						|
static int hci_update_random_address(struct hci_request *req,
 | 
						|
				     bool require_privacy, bool use_rpa,
 | 
						|
				     u8 *own_addr_type)
 | 
						|
{
 | 
						|
	struct hci_dev *hdev = req->hdev;
 | 
						|
	int err;
 | 
						|
 | 
						|
	/* If privacy is enabled use a resolvable private address. If
 | 
						|
	 * current RPA has expired or there is something else than
 | 
						|
	 * the current RPA in use, then generate a new one.
 | 
						|
	 */
 | 
						|
	if (use_rpa) {
 | 
						|
		/* If Controller supports LL Privacy use own address type is
 | 
						|
		 * 0x03
 | 
						|
		 */
 | 
						|
		if (use_ll_privacy(hdev))
 | 
						|
			*own_addr_type = ADDR_LE_DEV_RANDOM_RESOLVED;
 | 
						|
		else
 | 
						|
			*own_addr_type = ADDR_LE_DEV_RANDOM;
 | 
						|
 | 
						|
		if (rpa_valid(hdev))
 | 
						|
			return 0;
 | 
						|
 | 
						|
		err = smp_generate_rpa(hdev, hdev->irk, &hdev->rpa);
 | 
						|
		if (err < 0) {
 | 
						|
			bt_dev_err(hdev, "failed to generate new RPA");
 | 
						|
			return err;
 | 
						|
		}
 | 
						|
 | 
						|
		set_random_addr(req, &hdev->rpa);
 | 
						|
 | 
						|
		return 0;
 | 
						|
	}
 | 
						|
 | 
						|
	/* In case of required privacy without resolvable private address,
 | 
						|
	 * use an non-resolvable private address. This is useful for active
 | 
						|
	 * scanning and non-connectable advertising.
 | 
						|
	 */
 | 
						|
	if (require_privacy) {
 | 
						|
		bdaddr_t nrpa;
 | 
						|
 | 
						|
		while (true) {
 | 
						|
			/* The non-resolvable private address is generated
 | 
						|
			 * from random six bytes with the two most significant
 | 
						|
			 * bits cleared.
 | 
						|
			 */
 | 
						|
			get_random_bytes(&nrpa, 6);
 | 
						|
			nrpa.b[5] &= 0x3f;
 | 
						|
 | 
						|
			/* The non-resolvable private address shall not be
 | 
						|
			 * equal to the public address.
 | 
						|
			 */
 | 
						|
			if (bacmp(&hdev->bdaddr, &nrpa))
 | 
						|
				break;
 | 
						|
		}
 | 
						|
 | 
						|
		*own_addr_type = ADDR_LE_DEV_RANDOM;
 | 
						|
		set_random_addr(req, &nrpa);
 | 
						|
		return 0;
 | 
						|
	}
 | 
						|
 | 
						|
	/* If forcing static address is in use or there is no public
 | 
						|
	 * address use the static address as random address (but skip
 | 
						|
	 * the HCI command if the current random address is already the
 | 
						|
	 * static one.
 | 
						|
	 *
 | 
						|
	 * In case BR/EDR has been disabled on a dual-mode controller
 | 
						|
	 * and a static address has been configured, then use that
 | 
						|
	 * address instead of the public BR/EDR address.
 | 
						|
	 */
 | 
						|
	if (hci_dev_test_flag(hdev, HCI_FORCE_STATIC_ADDR) ||
 | 
						|
	    !bacmp(&hdev->bdaddr, BDADDR_ANY) ||
 | 
						|
	    (!hci_dev_test_flag(hdev, HCI_BREDR_ENABLED) &&
 | 
						|
	     bacmp(&hdev->static_addr, BDADDR_ANY))) {
 | 
						|
		*own_addr_type = ADDR_LE_DEV_RANDOM;
 | 
						|
		if (bacmp(&hdev->static_addr, &hdev->random_addr))
 | 
						|
			hci_req_add(req, HCI_OP_LE_SET_RANDOM_ADDR, 6,
 | 
						|
				    &hdev->static_addr);
 | 
						|
		return 0;
 | 
						|
	}
 | 
						|
 | 
						|
	/* Neither privacy nor static address is being used so use a
 | 
						|
	 * public address.
 | 
						|
	 */
 | 
						|
	*own_addr_type = ADDR_LE_DEV_PUBLIC;
 | 
						|
 | 
						|
	return 0;
 | 
						|
}
 | 
						|
 | 
						|
/* Ensure to call hci_req_add_le_scan_disable() first to disable the
 | 
						|
 * controller based address resolution to be able to reconfigure
 | 
						|
 * resolving list.
 | 
						|
 */
 | 
						|
void hci_req_add_le_passive_scan(struct hci_request *req)
 | 
						|
{
 | 
						|
	struct hci_dev *hdev = req->hdev;
 | 
						|
	u8 own_addr_type;
 | 
						|
	u8 filter_policy;
 | 
						|
	u16 window, interval;
 | 
						|
	/* Default is to enable duplicates filter */
 | 
						|
	u8 filter_dup = LE_SCAN_FILTER_DUP_ENABLE;
 | 
						|
	/* Background scanning should run with address resolution */
 | 
						|
	bool addr_resolv = true;
 | 
						|
 | 
						|
	if (hdev->scanning_paused) {
 | 
						|
		bt_dev_dbg(hdev, "Scanning is paused for suspend");
 | 
						|
		return;
 | 
						|
	}
 | 
						|
 | 
						|
	/* Set require_privacy to false since no SCAN_REQ are send
 | 
						|
	 * during passive scanning. Not using an non-resolvable address
 | 
						|
	 * here is important so that peer devices using direct
 | 
						|
	 * advertising with our address will be correctly reported
 | 
						|
	 * by the controller.
 | 
						|
	 */
 | 
						|
	if (hci_update_random_address(req, false, scan_use_rpa(hdev),
 | 
						|
				      &own_addr_type))
 | 
						|
		return;
 | 
						|
 | 
						|
	if (hdev->enable_advmon_interleave_scan &&
 | 
						|
	    __hci_update_interleaved_scan(hdev))
 | 
						|
		return;
 | 
						|
 | 
						|
	bt_dev_dbg(hdev, "interleave state %d", hdev->interleave_scan_state);
 | 
						|
	/* Adding or removing entries from the accept list must
 | 
						|
	 * happen before enabling scanning. The controller does
 | 
						|
	 * not allow accept list modification while scanning.
 | 
						|
	 */
 | 
						|
	filter_policy = update_accept_list(req);
 | 
						|
 | 
						|
	/* When the controller is using random resolvable addresses and
 | 
						|
	 * with that having LE privacy enabled, then controllers with
 | 
						|
	 * Extended Scanner Filter Policies support can now enable support
 | 
						|
	 * for handling directed advertising.
 | 
						|
	 *
 | 
						|
	 * So instead of using filter polices 0x00 (no accept list)
 | 
						|
	 * and 0x01 (accept list enabled) use the new filter policies
 | 
						|
	 * 0x02 (no accept list) and 0x03 (accept list enabled).
 | 
						|
	 */
 | 
						|
	if (hci_dev_test_flag(hdev, HCI_PRIVACY) &&
 | 
						|
	    (hdev->le_features[0] & HCI_LE_EXT_SCAN_POLICY))
 | 
						|
		filter_policy |= 0x02;
 | 
						|
 | 
						|
	if (hdev->suspended) {
 | 
						|
		window = hdev->le_scan_window_suspend;
 | 
						|
		interval = hdev->le_scan_int_suspend;
 | 
						|
	} else if (hci_is_le_conn_scanning(hdev)) {
 | 
						|
		window = hdev->le_scan_window_connect;
 | 
						|
		interval = hdev->le_scan_int_connect;
 | 
						|
	} else if (hci_is_adv_monitoring(hdev)) {
 | 
						|
		window = hdev->le_scan_window_adv_monitor;
 | 
						|
		interval = hdev->le_scan_int_adv_monitor;
 | 
						|
 | 
						|
		/* Disable duplicates filter when scanning for advertisement
 | 
						|
		 * monitor for the following reasons.
 | 
						|
		 *
 | 
						|
		 * For HW pattern filtering (ex. MSFT), Realtek and Qualcomm
 | 
						|
		 * controllers ignore RSSI_Sampling_Period when the duplicates
 | 
						|
		 * filter is enabled.
 | 
						|
		 *
 | 
						|
		 * For SW pattern filtering, when we're not doing interleaved
 | 
						|
		 * scanning, it is necessary to disable duplicates filter,
 | 
						|
		 * otherwise hosts can only receive one advertisement and it's
 | 
						|
		 * impossible to know if a peer is still in range.
 | 
						|
		 */
 | 
						|
		filter_dup = LE_SCAN_FILTER_DUP_DISABLE;
 | 
						|
	} else {
 | 
						|
		window = hdev->le_scan_window;
 | 
						|
		interval = hdev->le_scan_interval;
 | 
						|
	}
 | 
						|
 | 
						|
	bt_dev_dbg(hdev, "LE passive scan with accept list = %d",
 | 
						|
		   filter_policy);
 | 
						|
	hci_req_start_scan(req, LE_SCAN_PASSIVE, interval, window,
 | 
						|
			   own_addr_type, filter_policy, filter_dup,
 | 
						|
			   addr_resolv);
 | 
						|
}
 | 
						|
 | 
						|
static int hci_req_add_le_interleaved_scan(struct hci_request *req,
 | 
						|
					   unsigned long opt)
 | 
						|
{
 | 
						|
	struct hci_dev *hdev = req->hdev;
 | 
						|
	int ret = 0;
 | 
						|
 | 
						|
	hci_dev_lock(hdev);
 | 
						|
 | 
						|
	if (hci_dev_test_flag(hdev, HCI_LE_SCAN))
 | 
						|
		hci_req_add_le_scan_disable(req, false);
 | 
						|
	hci_req_add_le_passive_scan(req);
 | 
						|
 | 
						|
	switch (hdev->interleave_scan_state) {
 | 
						|
	case INTERLEAVE_SCAN_ALLOWLIST:
 | 
						|
		bt_dev_dbg(hdev, "next state: allowlist");
 | 
						|
		hdev->interleave_scan_state = INTERLEAVE_SCAN_NO_FILTER;
 | 
						|
		break;
 | 
						|
	case INTERLEAVE_SCAN_NO_FILTER:
 | 
						|
		bt_dev_dbg(hdev, "next state: no filter");
 | 
						|
		hdev->interleave_scan_state = INTERLEAVE_SCAN_ALLOWLIST;
 | 
						|
		break;
 | 
						|
	case INTERLEAVE_SCAN_NONE:
 | 
						|
		BT_ERR("unexpected error");
 | 
						|
		ret = -1;
 | 
						|
	}
 | 
						|
 | 
						|
	hci_dev_unlock(hdev);
 | 
						|
 | 
						|
	return ret;
 | 
						|
}
 | 
						|
 | 
						|
static void interleave_scan_work(struct work_struct *work)
 | 
						|
{
 | 
						|
	struct hci_dev *hdev = container_of(work, struct hci_dev,
 | 
						|
					    interleave_scan.work);
 | 
						|
	u8 status;
 | 
						|
	unsigned long timeout;
 | 
						|
 | 
						|
	if (hdev->interleave_scan_state == INTERLEAVE_SCAN_ALLOWLIST) {
 | 
						|
		timeout = msecs_to_jiffies(hdev->advmon_allowlist_duration);
 | 
						|
	} else if (hdev->interleave_scan_state == INTERLEAVE_SCAN_NO_FILTER) {
 | 
						|
		timeout = msecs_to_jiffies(hdev->advmon_no_filter_duration);
 | 
						|
	} else {
 | 
						|
		bt_dev_err(hdev, "unexpected error");
 | 
						|
		return;
 | 
						|
	}
 | 
						|
 | 
						|
	hci_req_sync(hdev, hci_req_add_le_interleaved_scan, 0,
 | 
						|
		     HCI_CMD_TIMEOUT, &status);
 | 
						|
 | 
						|
	/* Don't continue interleaving if it was canceled */
 | 
						|
	if (is_interleave_scanning(hdev))
 | 
						|
		queue_delayed_work(hdev->req_workqueue,
 | 
						|
				   &hdev->interleave_scan, timeout);
 | 
						|
}
 | 
						|
 | 
						|
static void set_random_addr(struct hci_request *req, bdaddr_t *rpa)
 | 
						|
{
 | 
						|
	struct hci_dev *hdev = req->hdev;
 | 
						|
 | 
						|
	/* If we're advertising or initiating an LE connection we can't
 | 
						|
	 * go ahead and change the random address at this time. This is
 | 
						|
	 * because the eventual initiator address used for the
 | 
						|
	 * subsequently created connection will be undefined (some
 | 
						|
	 * controllers use the new address and others the one we had
 | 
						|
	 * when the operation started).
 | 
						|
	 *
 | 
						|
	 * In this kind of scenario skip the update and let the random
 | 
						|
	 * address be updated at the next cycle.
 | 
						|
	 */
 | 
						|
	if (hci_dev_test_flag(hdev, HCI_LE_ADV) ||
 | 
						|
	    hci_lookup_le_connect(hdev)) {
 | 
						|
		bt_dev_dbg(hdev, "Deferring random address update");
 | 
						|
		hci_dev_set_flag(hdev, HCI_RPA_EXPIRED);
 | 
						|
		return;
 | 
						|
	}
 | 
						|
 | 
						|
	hci_req_add(req, HCI_OP_LE_SET_RANDOM_ADDR, 6, rpa);
 | 
						|
}
 | 
						|
 | 
						|
void hci_request_setup(struct hci_dev *hdev)
 | 
						|
{
 | 
						|
	INIT_DELAYED_WORK(&hdev->interleave_scan, interleave_scan_work);
 | 
						|
}
 | 
						|
 | 
						|
void hci_request_cancel_all(struct hci_dev *hdev)
 | 
						|
{
 | 
						|
	__hci_cmd_sync_cancel(hdev, ENODEV);
 | 
						|
 | 
						|
	cancel_interleave_scan(hdev);
 | 
						|
}
 |