xref: /linux/net/mac80211/scan.c (revision 9410645520e9b820069761f3450ef6661418e279)
1d2912cb1SThomas Gleixner // SPDX-License-Identifier: GPL-2.0-only
20a51b27eSJohannes Berg /*
35484e237SJohannes Berg  * Scanning implementation
45484e237SJohannes Berg  *
50a51b27eSJohannes Berg  * Copyright 2003, Jouni Malinen <jkmaline@cc.hut.fi>
60a51b27eSJohannes Berg  * Copyright 2004, Instant802 Networks, Inc.
70a51b27eSJohannes Berg  * Copyright 2005, Devicescape Software, Inc.
80a51b27eSJohannes Berg  * Copyright 2006-2007	Jiri Benc <jbenc@suse.cz>
90a51b27eSJohannes Berg  * Copyright 2007, Michael Wu <flamingice@sourmilk.net>
1074d803b6SSara Sharon  * Copyright 2013-2015  Intel Mobile Communications GmbH
1140b0bd24SRoee Zamir  * Copyright 2016-2017  Intel Deutschland GmbH
1262a6183cSJohannes Berg  * Copyright (C) 2018-2024 Intel Corporation
130a51b27eSJohannes Berg  */
140a51b27eSJohannes Berg 
150a51b27eSJohannes Berg #include <linux/if_arp.h>
16888d04dfSFelix Fietkau #include <linux/etherdevice.h>
17078e1e60SJohannes Berg #include <linux/rtnetlink.h>
18df13cce5SHelmut Schaa #include <net/sch_generic.h>
195a0e3ad6STejun Heo #include <linux/slab.h>
20bc3b2d7fSPaul Gortmaker #include <linux/export.h>
21b9771d41SJohannes Berg #include <linux/random.h>
220a51b27eSJohannes Berg #include <net/mac80211.h>
230a51b27eSJohannes Berg 
240a51b27eSJohannes Berg #include "ieee80211_i.h"
2524487981SJohannes Berg #include "driver-ops.h"
265484e237SJohannes Berg #include "mesh.h"
270a51b27eSJohannes Berg 
280a51b27eSJohannes Berg #define IEEE80211_PROBE_DELAY (HZ / 33)
290a51b27eSJohannes Berg #define IEEE80211_CHANNEL_TIME (HZ / 33)
303f892b61SStanislaw Gruszka #define IEEE80211_PASSIVE_CHANNEL_TIME (HZ / 9)
310a51b27eSJohannes Berg 
ieee80211_rx_bss_put(struct ieee80211_local * local,struct ieee80211_bss * bss)325484e237SJohannes Berg void ieee80211_rx_bss_put(struct ieee80211_local *local,
33c2b13452SJohannes Berg 			  struct ieee80211_bss *bss)
345484e237SJohannes Berg {
350c1ad2caSJohannes Berg 	if (!bss)
360c1ad2caSJohannes Berg 		return;
375b112d3dSJohannes Berg 	cfg80211_put_bss(local->hw.wiphy,
385b112d3dSJohannes Berg 			 container_of((void *)bss, struct cfg80211_bss, priv));
395484e237SJohannes Berg }
405484e237SJohannes Berg 
is_uapsd_supported(struct ieee802_11_elems * elems)41ab13315aSKalle Valo static bool is_uapsd_supported(struct ieee802_11_elems *elems)
42ab13315aSKalle Valo {
43ab13315aSKalle Valo 	u8 qos_info;
44ab13315aSKalle Valo 
45ab13315aSKalle Valo 	if (elems->wmm_info && elems->wmm_info_len == 7
46ab13315aSKalle Valo 	    && elems->wmm_info[5] == 1)
47ab13315aSKalle Valo 		qos_info = elems->wmm_info[6];
48ab13315aSKalle Valo 	else if (elems->wmm_param && elems->wmm_param_len == 24
49ab13315aSKalle Valo 		 && elems->wmm_param[5] == 1)
50ab13315aSKalle Valo 		qos_info = elems->wmm_param[6];
51ab13315aSKalle Valo 	else
52ab13315aSKalle Valo 		/* no valid wmm information or parameter element found */
53ab13315aSKalle Valo 		return false;
54ab13315aSKalle Valo 
55ab13315aSKalle Valo 	return qos_info & IEEE80211_WMM_IE_AP_QOSINFO_UAPSD;
56ab13315aSKalle Valo }
57ab13315aSKalle Valo 
58108d2022SBenjamin Berg struct inform_bss_update_data {
59108d2022SBenjamin Berg 	struct ieee80211_rx_status *rx_status;
60108d2022SBenjamin Berg 	bool beacon;
61108d2022SBenjamin Berg };
62108d2022SBenjamin Berg 
ieee80211_inform_bss(struct wiphy * wiphy,struct cfg80211_bss * cbss,const struct cfg80211_bss_ies * ies,void * data)63108d2022SBenjamin Berg void ieee80211_inform_bss(struct wiphy *wiphy,
64108d2022SBenjamin Berg 			  struct cfg80211_bss *cbss,
65108d2022SBenjamin Berg 			  const struct cfg80211_bss_ies *ies,
66108d2022SBenjamin Berg 			  void *data)
67fcea7db5SSara Sharon {
68108d2022SBenjamin Berg 	struct ieee80211_local *local = wiphy_priv(wiphy);
69108d2022SBenjamin Berg 	struct inform_bss_update_data *update_data = data;
70108d2022SBenjamin Berg 	struct ieee80211_bss *bss = (void *)cbss->priv;
71108d2022SBenjamin Berg 	struct ieee80211_rx_status *rx_status;
72108d2022SBenjamin Berg 	struct ieee802_11_elems *elems;
73fcea7db5SSara Sharon 	int clen, srlen;
74fcea7db5SSara Sharon 
75108d2022SBenjamin Berg 	/* This happens while joining an IBSS */
76108d2022SBenjamin Berg 	if (!update_data)
77108d2022SBenjamin Berg 		return;
78108d2022SBenjamin Berg 
79108d2022SBenjamin Berg 	elems = ieee802_11_parse_elems(ies->data, ies->len, false, NULL);
80108d2022SBenjamin Berg 	if (!elems)
81108d2022SBenjamin Berg 		return;
82108d2022SBenjamin Berg 
83108d2022SBenjamin Berg 	rx_status = update_data->rx_status;
84108d2022SBenjamin Berg 
85108d2022SBenjamin Berg 	if (update_data->beacon)
86fcea7db5SSara Sharon 		bss->device_ts_beacon = rx_status->device_timestamp;
87fcea7db5SSara Sharon 	else
88fcea7db5SSara Sharon 		bss->device_ts_presp = rx_status->device_timestamp;
89fcea7db5SSara Sharon 
90fcea7db5SSara Sharon 	if (elems->parse_error) {
91108d2022SBenjamin Berg 		if (update_data->beacon)
92fcea7db5SSara Sharon 			bss->corrupt_data |= IEEE80211_BSS_CORRUPT_BEACON;
93fcea7db5SSara Sharon 		else
94fcea7db5SSara Sharon 			bss->corrupt_data |= IEEE80211_BSS_CORRUPT_PROBE_RESP;
95fcea7db5SSara Sharon 	} else {
96108d2022SBenjamin Berg 		if (update_data->beacon)
97fcea7db5SSara Sharon 			bss->corrupt_data &= ~IEEE80211_BSS_CORRUPT_BEACON;
98fcea7db5SSara Sharon 		else
99fcea7db5SSara Sharon 			bss->corrupt_data &= ~IEEE80211_BSS_CORRUPT_PROBE_RESP;
100fcea7db5SSara Sharon 	}
101fcea7db5SSara Sharon 
102fcea7db5SSara Sharon 	/* save the ERP value so that it is available at association time */
103fcea7db5SSara Sharon 	if (elems->erp_info && (!elems->parse_error ||
104fcea7db5SSara Sharon 				!(bss->valid_data & IEEE80211_BSS_VALID_ERP))) {
105fcea7db5SSara Sharon 		bss->erp_value = elems->erp_info[0];
106fcea7db5SSara Sharon 		bss->has_erp_value = true;
107fcea7db5SSara Sharon 		if (!elems->parse_error)
108fcea7db5SSara Sharon 			bss->valid_data |= IEEE80211_BSS_VALID_ERP;
109fcea7db5SSara Sharon 	}
110fcea7db5SSara Sharon 
111fcea7db5SSara Sharon 	/* replace old supported rates if we get new values */
112fcea7db5SSara Sharon 	if (!elems->parse_error ||
113fcea7db5SSara Sharon 	    !(bss->valid_data & IEEE80211_BSS_VALID_RATES)) {
114fcea7db5SSara Sharon 		srlen = 0;
115fcea7db5SSara Sharon 		if (elems->supp_rates) {
116fcea7db5SSara Sharon 			clen = IEEE80211_MAX_SUPP_RATES;
117fcea7db5SSara Sharon 			if (clen > elems->supp_rates_len)
118fcea7db5SSara Sharon 				clen = elems->supp_rates_len;
119fcea7db5SSara Sharon 			memcpy(bss->supp_rates, elems->supp_rates, clen);
120fcea7db5SSara Sharon 			srlen += clen;
121fcea7db5SSara Sharon 		}
122fcea7db5SSara Sharon 		if (elems->ext_supp_rates) {
123fcea7db5SSara Sharon 			clen = IEEE80211_MAX_SUPP_RATES - srlen;
124fcea7db5SSara Sharon 			if (clen > elems->ext_supp_rates_len)
125fcea7db5SSara Sharon 				clen = elems->ext_supp_rates_len;
126fcea7db5SSara Sharon 			memcpy(bss->supp_rates + srlen, elems->ext_supp_rates,
127fcea7db5SSara Sharon 			       clen);
128fcea7db5SSara Sharon 			srlen += clen;
129fcea7db5SSara Sharon 		}
130fcea7db5SSara Sharon 		if (srlen) {
131fcea7db5SSara Sharon 			bss->supp_rates_len = srlen;
132fcea7db5SSara Sharon 			if (!elems->parse_error)
133fcea7db5SSara Sharon 				bss->valid_data |= IEEE80211_BSS_VALID_RATES;
134fcea7db5SSara Sharon 		}
135fcea7db5SSara Sharon 	}
136fcea7db5SSara Sharon 
137fcea7db5SSara Sharon 	if (!elems->parse_error ||
138fcea7db5SSara Sharon 	    !(bss->valid_data & IEEE80211_BSS_VALID_WMM)) {
139fcea7db5SSara Sharon 		bss->wmm_used = elems->wmm_param || elems->wmm_info;
140fcea7db5SSara Sharon 		bss->uapsd_supported = is_uapsd_supported(elems);
141fcea7db5SSara Sharon 		if (!elems->parse_error)
142fcea7db5SSara Sharon 			bss->valid_data |= IEEE80211_BSS_VALID_WMM;
143fcea7db5SSara Sharon 	}
144fcea7db5SSara Sharon 
145108d2022SBenjamin Berg 	if (update_data->beacon) {
146fcea7db5SSara Sharon 		struct ieee80211_supported_band *sband =
147fcea7db5SSara Sharon 			local->hw.wiphy->bands[rx_status->band];
148fcea7db5SSara Sharon 		if (!(rx_status->encoding == RX_ENC_HT) &&
149fcea7db5SSara Sharon 		    !(rx_status->encoding == RX_ENC_VHT))
150fcea7db5SSara Sharon 			bss->beacon_rate =
151fcea7db5SSara Sharon 				&sband->bitrates[rx_status->rate_idx];
152fcea7db5SSara Sharon 	}
1532a333a0dSJohannes Berg 
1542a333a0dSJohannes Berg 	if (elems->vht_cap_elem)
1552a333a0dSJohannes Berg 		bss->vht_cap_info =
1562a333a0dSJohannes Berg 			le32_to_cpu(elems->vht_cap_elem->vht_cap_info);
1572a333a0dSJohannes Berg 	else
1582a333a0dSJohannes Berg 		bss->vht_cap_info = 0;
159108d2022SBenjamin Berg 
160108d2022SBenjamin Berg 	kfree(elems);
161fcea7db5SSara Sharon }
162fcea7db5SSara Sharon 
163c2b13452SJohannes Berg struct ieee80211_bss *
ieee80211_bss_info_update(struct ieee80211_local * local,struct ieee80211_rx_status * rx_status,struct ieee80211_mgmt * mgmt,size_t len,struct ieee80211_channel * channel)1645484e237SJohannes Berg ieee80211_bss_info_update(struct ieee80211_local *local,
1655484e237SJohannes Berg 			  struct ieee80211_rx_status *rx_status,
166d45c4172SEmmanuel Grumbach 			  struct ieee80211_mgmt *mgmt, size_t len,
167d45c4172SEmmanuel Grumbach 			  struct ieee80211_channel *channel)
1685484e237SJohannes Berg {
169cd418ba6SThomas Pedersen 	bool beacon = ieee80211_is_beacon(mgmt->frame_control) ||
170cd418ba6SThomas Pedersen 		      ieee80211_is_s1g_beacon(mgmt->frame_control);
171108d2022SBenjamin Berg 	struct cfg80211_bss *cbss;
172108d2022SBenjamin Berg 	struct inform_bss_update_data update_data = {
173108d2022SBenjamin Berg 		.rx_status = rx_status,
174108d2022SBenjamin Berg 		.beacon = beacon,
175108d2022SBenjamin Berg 	};
176162dd6a7SJohannes Berg 	struct cfg80211_inform_bss bss_meta = {
177162dd6a7SJohannes Berg 		.boottime_ns = rx_status->boottime_ns,
178108d2022SBenjamin Berg 		.drv_data = (void *)&update_data,
179162dd6a7SJohannes Berg 	};
18074d803b6SSara Sharon 	bool signal_valid;
1817947d3e0SAvraham Stern 	struct ieee80211_sub_if_data *scan_sdata;
1822a519311SJohannes Berg 
1831ad22fb5STosoni 	if (rx_status->flag & RX_FLAG_NO_SIGNAL_VAL)
1841ad22fb5STosoni 		bss_meta.signal = 0; /* invalid signal indication */
1851ad22fb5STosoni 	else if (ieee80211_hw_check(&local->hw, SIGNAL_DBM))
18661f6bba0SJohannes Berg 		bss_meta.signal = rx_status->signal * 100;
18730686bf7SJohannes Berg 	else if (ieee80211_hw_check(&local->hw, SIGNAL_UNSPEC))
18861f6bba0SJohannes Berg 		bss_meta.signal = (rx_status->signal * 100) / local->hw.max_signal;
1892a519311SJohannes Berg 
19061f6bba0SJohannes Berg 	bss_meta.chan = channel;
1917947d3e0SAvraham Stern 
1927947d3e0SAvraham Stern 	rcu_read_lock();
1937947d3e0SAvraham Stern 	scan_sdata = rcu_dereference(local->scan_sdata);
1947947d3e0SAvraham Stern 	if (scan_sdata && scan_sdata->vif.type == NL80211_IFTYPE_STATION &&
195f276e20bSJohannes Berg 	    scan_sdata->vif.cfg.assoc &&
1967947d3e0SAvraham Stern 	    ieee80211_have_rx_timestamp(rx_status)) {
197cbde0b49SIlan Peer 		struct ieee80211_bss_conf *link_conf = NULL;
198cbde0b49SIlan Peer 
199cbde0b49SIlan Peer 		/* for an MLO connection, set the TSF data only in case we have
200cbde0b49SIlan Peer 		 * an indication on which of the links the frame was received
201cbde0b49SIlan Peer 		 */
202cbde0b49SIlan Peer 		if (ieee80211_vif_is_mld(&scan_sdata->vif)) {
203cbde0b49SIlan Peer 			if (rx_status->link_valid) {
204cbde0b49SIlan Peer 				s8 link_id = rx_status->link_id;
205cbde0b49SIlan Peer 
206cbde0b49SIlan Peer 				link_conf =
207cbde0b49SIlan Peer 					rcu_dereference(scan_sdata->vif.link_conf[link_id]);
208cbde0b49SIlan Peer 			}
209cbde0b49SIlan Peer 		} else {
210cbde0b49SIlan Peer 			link_conf = &scan_sdata->vif.bss_conf;
211cbde0b49SIlan Peer 		}
212cbde0b49SIlan Peer 
213cbde0b49SIlan Peer 		if (link_conf) {
2147947d3e0SAvraham Stern 			bss_meta.parent_tsf =
215cbde0b49SIlan Peer 				ieee80211_calculate_rx_timestamp(local,
216cbde0b49SIlan Peer 								 rx_status,
217cbde0b49SIlan Peer 								 len + FCS_LEN,
218cbde0b49SIlan Peer 								 24);
219cbde0b49SIlan Peer 
2207947d3e0SAvraham Stern 			ether_addr_copy(bss_meta.parent_bssid,
221cbde0b49SIlan Peer 					link_conf->bssid);
222cbde0b49SIlan Peer 		}
2237947d3e0SAvraham Stern 	}
2247947d3e0SAvraham Stern 	rcu_read_unlock();
2257947d3e0SAvraham Stern 
22661f6bba0SJohannes Berg 	cbss = cfg80211_inform_bss_frame_data(local->hw.wiphy, &bss_meta,
22761f6bba0SJohannes Berg 					      mgmt, len, GFP_ATOMIC);
2280c1ad2caSJohannes Berg 	if (!cbss)
2295484e237SJohannes Berg 		return NULL;
2304abb52a4SSara Sharon 
23174d803b6SSara Sharon 	/* In case the signal is invalid update the status */
2327bb106ebSEmmanuel Grumbach 	signal_valid = channel == cbss->channel;
23374d803b6SSara Sharon 	if (!signal_valid)
23474d803b6SSara Sharon 		rx_status->flag |= RX_FLAG_NO_SIGNAL_VAL;
23500d3f14cSJohannes Berg 
236108d2022SBenjamin Berg 	return (void *)cbss->priv;
2375484e237SJohannes Berg }
2380a51b27eSJohannes Berg 
ieee80211_scan_accept_presp(struct ieee80211_sub_if_data * sdata,struct ieee80211_channel * channel,u32 scan_flags,const u8 * da)23940b0bd24SRoee Zamir static bool ieee80211_scan_accept_presp(struct ieee80211_sub_if_data *sdata,
24062a6183cSJohannes Berg 					struct ieee80211_channel *channel,
24140b0bd24SRoee Zamir 					u32 scan_flags, const u8 *da)
24240b0bd24SRoee Zamir {
24340b0bd24SRoee Zamir 	if (!sdata)
24440b0bd24SRoee Zamir 		return false;
24562a6183cSJohannes Berg 
24662a6183cSJohannes Berg 	/* accept broadcast on 6 GHz and for OCE */
24762a6183cSJohannes Berg 	if (is_broadcast_ether_addr(da) &&
24862a6183cSJohannes Berg 	    (channel->band == NL80211_BAND_6GHZ ||
24962a6183cSJohannes Berg 	     scan_flags & NL80211_SCAN_FLAG_ACCEPT_BCAST_PROBE_RESP))
25040b0bd24SRoee Zamir 		return true;
25162a6183cSJohannes Berg 
25240b0bd24SRoee Zamir 	if (scan_flags & NL80211_SCAN_FLAG_RANDOM_ADDR)
25340b0bd24SRoee Zamir 		return true;
25440b0bd24SRoee Zamir 	return ether_addr_equal(da, sdata->vif.addr);
25540b0bd24SRoee Zamir }
25640b0bd24SRoee Zamir 
ieee80211_scan_rx(struct ieee80211_local * local,struct sk_buff * skb)257d48b2968SJohannes Berg void ieee80211_scan_rx(struct ieee80211_local *local, struct sk_buff *skb)
25898c8fccfSJohannes Berg {
259f1d58c25SJohannes Berg 	struct ieee80211_rx_status *rx_status = IEEE80211_SKB_RXCB(skb);
260d48b2968SJohannes Berg 	struct ieee80211_mgmt *mgmt = (void *)skb->data;
261c2b13452SJohannes Berg 	struct ieee80211_bss *bss;
26298c8fccfSJohannes Berg 	struct ieee80211_channel *channel;
263e298aa35SDu Cheng 	size_t min_hdr_len = offsetof(struct ieee80211_mgmt,
264e298aa35SDu Cheng 				      u.probe_resp.variable);
265e298aa35SDu Cheng 
266e298aa35SDu Cheng 	if (!ieee80211_is_probe_resp(mgmt->frame_control) &&
267e298aa35SDu Cheng 	    !ieee80211_is_beacon(mgmt->frame_control) &&
268e298aa35SDu Cheng 	    !ieee80211_is_s1g_beacon(mgmt->frame_control))
269e298aa35SDu Cheng 		return;
27098c8fccfSJohannes Berg 
271cd418ba6SThomas Pedersen 	if (ieee80211_is_s1g_beacon(mgmt->frame_control)) {
272e298aa35SDu Cheng 		if (ieee80211_is_s1g_short_beacon(mgmt->frame_control))
273e298aa35SDu Cheng 			min_hdr_len = offsetof(struct ieee80211_ext,
274e298aa35SDu Cheng 					       u.s1g_short_beacon.variable);
275e298aa35SDu Cheng 		else
276e298aa35SDu Cheng 			min_hdr_len = offsetof(struct ieee80211_ext,
277e298aa35SDu Cheng 					       u.s1g_beacon);
278e298aa35SDu Cheng 	}
279e298aa35SDu Cheng 
280e298aa35SDu Cheng 	if (skb->len < min_hdr_len)
281d48b2968SJohannes Berg 		return;
28298c8fccfSJohannes Berg 
283b041b7b9SFelix Fietkau 	if (test_and_clear_bit(SCAN_BEACON_WAIT, &local->scanning)) {
284b041b7b9SFelix Fietkau 		/*
285b041b7b9SFelix Fietkau 		 * we were passive scanning because of radar/no-IR, but
286b041b7b9SFelix Fietkau 		 * the beacon/proberesp rx gives us an opportunity to upgrade
287b041b7b9SFelix Fietkau 		 * to active scan
288b041b7b9SFelix Fietkau 		 */
289b041b7b9SFelix Fietkau 		set_bit(SCAN_BEACON_DONE, &local->scanning);
29020171251SJohannes Berg 		wiphy_delayed_work_queue(local->hw.wiphy, &local->scan_work, 0);
291b041b7b9SFelix Fietkau 	}
292b041b7b9SFelix Fietkau 
29362a6183cSJohannes Berg 	channel = ieee80211_get_channel_khz(local->hw.wiphy,
29462a6183cSJohannes Berg 					    ieee80211_rx_status_to_khz(rx_status));
29562a6183cSJohannes Berg 
29662a6183cSJohannes Berg 	if (!channel || channel->flags & IEEE80211_CHAN_DISABLED)
29762a6183cSJohannes Berg 		return;
29862a6183cSJohannes Berg 
299d48b2968SJohannes Berg 	if (ieee80211_is_probe_resp(mgmt->frame_control)) {
300ddf82e75SIlan Peer 		struct ieee80211_sub_if_data *sdata1, *sdata2;
301a344d677SJohannes Berg 		struct cfg80211_scan_request *scan_req;
302a344d677SJohannes Berg 		struct cfg80211_sched_scan_request *sched_scan_req;
30340b0bd24SRoee Zamir 		u32 scan_req_flags = 0, sched_scan_req_flags = 0;
304a344d677SJohannes Berg 
305ddf82e75SIlan Peer 		sdata1 = rcu_dereference(local->scan_sdata);
306ddf82e75SIlan Peer 		sdata2 = rcu_dereference(local->sched_scan_sdata);
307ddf82e75SIlan Peer 
308ddf82e75SIlan Peer 		if (likely(!sdata1 && !sdata2))
309ddf82e75SIlan Peer 			return;
310ddf82e75SIlan Peer 
311a344d677SJohannes Berg 		scan_req = rcu_dereference(local->scan_req);
312a344d677SJohannes Berg 		sched_scan_req = rcu_dereference(local->sched_scan_req);
313a344d677SJohannes Berg 
31440b0bd24SRoee Zamir 		if (scan_req)
31540b0bd24SRoee Zamir 			scan_req_flags = scan_req->flags;
31640b0bd24SRoee Zamir 
31740b0bd24SRoee Zamir 		if (sched_scan_req)
31840b0bd24SRoee Zamir 			sched_scan_req_flags = sched_scan_req->flags;
31940b0bd24SRoee Zamir 
32040b0bd24SRoee Zamir 		/* ignore ProbeResp to foreign address or non-bcast (OCE)
32140b0bd24SRoee Zamir 		 * unless scanning with randomised address
322a344d677SJohannes Berg 		 */
32362a6183cSJohannes Berg 		if (!ieee80211_scan_accept_presp(sdata1, channel,
32462a6183cSJohannes Berg 						 scan_req_flags,
32540b0bd24SRoee Zamir 						 mgmt->da) &&
32662a6183cSJohannes Berg 		    !ieee80211_scan_accept_presp(sdata2, channel,
32762a6183cSJohannes Berg 						 sched_scan_req_flags,
32840b0bd24SRoee Zamir 						 mgmt->da))
329d48b2968SJohannes Berg 			return;
330ddf82e75SIlan Peer 	} else {
331ddf82e75SIlan Peer 		/* Beacons are expected only with broadcast address */
332ddf82e75SIlan Peer 		if (!is_broadcast_ether_addr(mgmt->da))
333ddf82e75SIlan Peer 			return;
33498c8fccfSJohannes Berg 	}
33598c8fccfSJohannes Berg 
336ddf82e75SIlan Peer 	/* Do not update the BSS table in case of only monitor interfaces */
337ddf82e75SIlan Peer 	if (local->open_count == local->monitors)
338ddf82e75SIlan Peer 		return;
339ddf82e75SIlan Peer 
340d48b2968SJohannes Berg 	bss = ieee80211_bss_info_update(local, rx_status,
3414abb52a4SSara Sharon 					mgmt, skb->len,
342d45c4172SEmmanuel Grumbach 					channel);
343d048e503SJouni Malinen 	if (bss)
344d48b2968SJohannes Berg 		ieee80211_rx_bss_put(local, bss);
34598c8fccfSJohannes Berg }
34698c8fccfSJohannes Berg 
ieee80211_prepare_scan_chandef(struct cfg80211_chan_def * chandef)3475add321cSJohannes Berg static void ieee80211_prepare_scan_chandef(struct cfg80211_chan_def *chandef)
3482103dec1SSimon Wunderlich {
3492103dec1SSimon Wunderlich 	memset(chandef, 0, sizeof(*chandef));
3505add321cSJohannes Berg 
3512103dec1SSimon Wunderlich 	chandef->width = NL80211_CHAN_WIDTH_20_NOHT;
3522103dec1SSimon Wunderlich }
3532103dec1SSimon Wunderlich 
3544d36ec58SJohannes Berg /* return false if no more work */
ieee80211_prep_hw_scan(struct ieee80211_sub_if_data * sdata)3552ad2274cSIlan Peer static bool ieee80211_prep_hw_scan(struct ieee80211_sub_if_data *sdata)
3564d36ec58SJohannes Berg {
3572ad2274cSIlan Peer 	struct ieee80211_local *local = sdata->local;
3586ea0a69cSJohannes Berg 	struct cfg80211_scan_request *req;
3592103dec1SSimon Wunderlich 	struct cfg80211_chan_def chandef;
360c56ef672SDavid Spinadel 	u8 bands_used = 0;
3612663d046SKenton Groombridge 	int i, ielen;
3622663d046SKenton Groombridge 	u32 *n_chans;
363b9771d41SJohannes Berg 	u32 flags = 0;
3644d36ec58SJohannes Berg 
3656ea0a69cSJohannes Berg 	req = rcu_dereference_protected(local->scan_req,
3660cd8080eSJohannes Berg 					lockdep_is_held(&local->hw.wiphy->mtx));
3676ea0a69cSJohannes Berg 
368a754055aSEmmanuel Grumbach 	if (test_bit(SCAN_HW_CANCELLED, &local->scanning))
369a754055aSEmmanuel Grumbach 		return false;
370a754055aSEmmanuel Grumbach 
37130686bf7SJohannes Berg 	if (ieee80211_hw_check(&local->hw, SINGLE_SCAN_ON_ALL_BANDS)) {
3722663d046SKenton Groombridge 		local->hw_scan_req->req.n_channels = req->n_channels;
3732663d046SKenton Groombridge 
374c56ef672SDavid Spinadel 		for (i = 0; i < req->n_channels; i++) {
375c56ef672SDavid Spinadel 			local->hw_scan_req->req.channels[i] = req->channels[i];
376c56ef672SDavid Spinadel 			bands_used |= BIT(req->channels[i]->band);
377c56ef672SDavid Spinadel 		}
378c56ef672SDavid Spinadel 	} else {
3794d36ec58SJohannes Berg 		do {
38057fbcce3SJohannes Berg 			if (local->hw_scan_band == NUM_NL80211_BANDS)
3814d36ec58SJohannes Berg 				return false;
3824d36ec58SJohannes Berg 
3832663d046SKenton Groombridge 			n_chans = &local->hw_scan_req->req.n_channels;
3842663d046SKenton Groombridge 			*n_chans = 0;
385c56ef672SDavid Spinadel 
3864d36ec58SJohannes Berg 			for (i = 0; i < req->n_channels; i++) {
387c56ef672SDavid Spinadel 				if (req->channels[i]->band !=
388c56ef672SDavid Spinadel 				    local->hw_scan_band)
389c56ef672SDavid Spinadel 					continue;
3902663d046SKenton Groombridge 				local->hw_scan_req->req.channels[(*n_chans)++] =
3914d36ec58SJohannes Berg 							req->channels[i];
3922663d046SKenton Groombridge 
393c56ef672SDavid Spinadel 				bands_used |= BIT(req->channels[i]->band);
3944d36ec58SJohannes Berg 			}
3954d36ec58SJohannes Berg 
3964d36ec58SJohannes Berg 			local->hw_scan_band++;
3972663d046SKenton Groombridge 		} while (!*n_chans);
398c56ef672SDavid Spinadel 	}
3994d36ec58SJohannes Berg 
4005add321cSJohannes Berg 	ieee80211_prepare_scan_chandef(&chandef);
4014d36ec58SJohannes Berg 
402b9771d41SJohannes Berg 	if (req->flags & NL80211_SCAN_FLAG_MIN_PREQ_CONTENT)
403b9771d41SJohannes Berg 		flags |= IEEE80211_PROBE_FLAG_MIN_CONTENT;
404b9771d41SJohannes Berg 
4052ad2274cSIlan Peer 	ielen = ieee80211_build_preq_ies(sdata,
406c56ef672SDavid Spinadel 					 (u8 *)local->hw_scan_req->req.ie,
407c604b9f2SJohannes Berg 					 local->hw_scan_ies_bufsize,
408c56ef672SDavid Spinadel 					 &local->hw_scan_req->ies,
409c56ef672SDavid Spinadel 					 req->ie, req->ie_len,
410b9771d41SJohannes Berg 					 bands_used, req->rates, &chandef,
411b9771d41SJohannes Berg 					 flags);
41207095d16SJohannes Berg 	if (ielen < 0)
41307095d16SJohannes Berg 		return false;
414c56ef672SDavid Spinadel 	local->hw_scan_req->req.ie_len = ielen;
415c56ef672SDavid Spinadel 	local->hw_scan_req->req.no_cck = req->no_cck;
416a344d677SJohannes Berg 	ether_addr_copy(local->hw_scan_req->req.mac_addr, req->mac_addr);
417a344d677SJohannes Berg 	ether_addr_copy(local->hw_scan_req->req.mac_addr_mask,
418a344d677SJohannes Berg 			req->mac_addr_mask);
419e345f44fSJouni Malinen 	ether_addr_copy(local->hw_scan_req->req.bssid, req->bssid);
4204d36ec58SJohannes Berg 
4214d36ec58SJohannes Berg 	return true;
4224d36ec58SJohannes Berg }
4234d36ec58SJohannes Berg 
__ieee80211_scan_completed(struct ieee80211_hw * hw,bool aborted)4248bd2a248SEliad Peller static void __ieee80211_scan_completed(struct ieee80211_hw *hw, bool aborted)
425f3b85252SJohannes Berg {
426f3b85252SJohannes Berg 	struct ieee80211_local *local = hw_to_local(hw);
427e9da68ddSJohannes Berg 	bool hw_scan = test_bit(SCAN_HW_SCANNING, &local->scanning);
428a2b70e83SEliad Peller 	bool was_scanning = local->scanning;
4296ea0a69cSJohannes Berg 	struct cfg80211_scan_request *scan_req;
430a344d677SJohannes Berg 	struct ieee80211_sub_if_data *scan_sdata;
4314fa11ec7SSachin Kulkarni 	struct ieee80211_sub_if_data *sdata;
432f3b85252SJohannes Berg 
4330cd8080eSJohannes Berg 	lockdep_assert_wiphy(local->hw.wiphy);
434f3b85252SJohannes Berg 
4356d3560d4SJohannes Berg 	/*
4366d3560d4SJohannes Berg 	 * It's ok to abort a not-yet-running scan (that
4376d3560d4SJohannes Berg 	 * we have one at all will be verified by checking
4386d3560d4SJohannes Berg 	 * local->scan_req next), but not to complete it
4396d3560d4SJohannes Berg 	 * successfully.
4406d3560d4SJohannes Berg 	 */
4416d3560d4SJohannes Berg 	if (WARN_ON(!local->scanning && !aborted))
4426d3560d4SJohannes Berg 		aborted = true;
443f3b85252SJohannes Berg 
444e229f844SStanislaw Gruszka 	if (WARN_ON(!local->scan_req))
445d07bfd8bSJohannes Berg 		return;
446f3b85252SJohannes Berg 
4472ad2274cSIlan Peer 	scan_sdata = rcu_dereference_protected(local->scan_sdata,
4480cd8080eSJohannes Berg 					       lockdep_is_held(&local->hw.wiphy->mtx));
4492ad2274cSIlan Peer 
450c56ef672SDavid Spinadel 	if (hw_scan && !aborted &&
45130686bf7SJohannes Berg 	    !ieee80211_hw_check(&local->hw, SINGLE_SCAN_ON_ALL_BANDS) &&
4522ad2274cSIlan Peer 	    ieee80211_prep_hw_scan(scan_sdata)) {
453e2fd5dbcSJohannes Berg 		int rc;
454e2fd5dbcSJohannes Berg 
455e2fd5dbcSJohannes Berg 		rc = drv_hw_scan(local,
456e2fd5dbcSJohannes Berg 			rcu_dereference_protected(local->scan_sdata,
4570cd8080eSJohannes Berg 						  lockdep_is_held(&local->hw.wiphy->mtx)),
458e2fd5dbcSJohannes Berg 			local->hw_scan_req);
459e2fd5dbcSJohannes Berg 
4606eb11a9aSStanislaw Gruszka 		if (rc == 0)
461d07bfd8bSJohannes Berg 			return;
4627947d3e0SAvraham Stern 
4637d10f6b1SJohannes Berg 		/* HW scan failed and is going to be reported as aborted,
4647d10f6b1SJohannes Berg 		 * so clear old scan info.
4657947d3e0SAvraham Stern 		 */
4667947d3e0SAvraham Stern 		memset(&local->scan_info, 0, sizeof(local->scan_info));
4677d10f6b1SJohannes Berg 		aborted = true;
4684d36ec58SJohannes Berg 	}
4694d36ec58SJohannes Berg 
4704d36ec58SJohannes Berg 	kfree(local->hw_scan_req);
4714d36ec58SJohannes Berg 	local->hw_scan_req = NULL;
472f3b85252SJohannes Berg 
4736ea0a69cSJohannes Berg 	scan_req = rcu_dereference_protected(local->scan_req,
4740cd8080eSJohannes Berg 					     lockdep_is_held(&local->hw.wiphy->mtx));
4756ea0a69cSJohannes Berg 
4766ea0a69cSJohannes Berg 	RCU_INIT_POINTER(local->scan_req, NULL);
4770c2bef46SMonam Agarwal 	RCU_INIT_POINTER(local->scan_sdata, NULL);
4782a519311SJohannes Berg 
479fbe9c429SHelmut Schaa 	local->scanning = 0;
4807ca15a0aSSimon Wunderlich 	local->scan_chandef.chan = NULL;
481f3b85252SJohannes Berg 
48260deb9f1SSiddh Raman Pant 	synchronize_rcu();
48360deb9f1SSiddh Raman Pant 
48460deb9f1SSiddh Raman Pant 	if (scan_req != local->int_scan_req) {
48560deb9f1SSiddh Raman Pant 		local->scan_info.aborted = aborted;
48660deb9f1SSiddh Raman Pant 		cfg80211_scan_done(scan_req, &local->scan_info);
48760deb9f1SSiddh Raman Pant 	}
48860deb9f1SSiddh Raman Pant 
48959bdf3b0SBen Greear 	/* Set power back to normal operating levels. */
4900a44dfc0SJohannes Berg 	ieee80211_hw_conf_chan(local);
491b23b025fSBen Greear 
492a033afcaSJohannes Berg 	if (!hw_scan && was_scanning) {
493b23b025fSBen Greear 		ieee80211_configure_filter(local);
494a344d677SJohannes Berg 		drv_sw_scan_complete(local, scan_sdata);
495aacde9eeSStanislaw Gruszka 		ieee80211_offchannel_return(local);
496b23b025fSBen Greear 	}
497b23b025fSBen Greear 
4985cff20e6SJohannes Berg 	ieee80211_recalc_idle(local);
499e229f844SStanislaw Gruszka 
5000a51b27eSJohannes Berg 	ieee80211_mlme_notify_scan_completed(local);
50146900298SJohannes Berg 	ieee80211_ibss_notify_scan_completed(local);
5024fa11ec7SSachin Kulkarni 
5034fa11ec7SSachin Kulkarni 	/* Requeue all the work that might have been ignored while
5044fa11ec7SSachin Kulkarni 	 * the scan was in progress; if there was none this will
5054fa11ec7SSachin Kulkarni 	 * just be a no-op for the particular interface.
5064fa11ec7SSachin Kulkarni 	 */
507ac351800SJohannes Berg 	list_for_each_entry(sdata, &local->interfaces, list) {
5084fa11ec7SSachin Kulkarni 		if (ieee80211_sdata_running(sdata))
50916114496SJohannes Berg 			wiphy_work_queue(sdata->local->hw.wiphy, &sdata->work);
5104fa11ec7SSachin Kulkarni 	}
5114fa11ec7SSachin Kulkarni 
512a2b70e83SEliad Peller 	if (was_scanning)
5132eb278e0SJohannes Berg 		ieee80211_start_next_roc(local);
5140a51b27eSJohannes Berg }
5158789d459SJohannes Berg 
ieee80211_scan_completed(struct ieee80211_hw * hw,struct cfg80211_scan_info * info)5167947d3e0SAvraham Stern void ieee80211_scan_completed(struct ieee80211_hw *hw,
5177947d3e0SAvraham Stern 			      struct cfg80211_scan_info *info)
5188789d459SJohannes Berg {
5198789d459SJohannes Berg 	struct ieee80211_local *local = hw_to_local(hw);
5208789d459SJohannes Berg 
52158bd7f11SJohannes Berg 	trace_api_scan_completed(local, info->aborted);
5228789d459SJohannes Berg 
5238789d459SJohannes Berg 	set_bit(SCAN_COMPLETED, &local->scanning);
5247947d3e0SAvraham Stern 	if (info->aborted)
5258789d459SJohannes Berg 		set_bit(SCAN_ABORTED, &local->scanning);
5267947d3e0SAvraham Stern 
5277947d3e0SAvraham Stern 	memcpy(&local->scan_info, info, sizeof(*info));
5287947d3e0SAvraham Stern 
52920171251SJohannes Berg 	wiphy_delayed_work_queue(local->hw.wiphy, &local->scan_work, 0);
5308789d459SJohannes Berg }
5310a51b27eSJohannes Berg EXPORT_SYMBOL(ieee80211_scan_completed);
5320a51b27eSJohannes Berg 
ieee80211_start_sw_scan(struct ieee80211_local * local,struct ieee80211_sub_if_data * sdata)533a344d677SJohannes Berg static int ieee80211_start_sw_scan(struct ieee80211_local *local,
534a344d677SJohannes Berg 				   struct ieee80211_sub_if_data *sdata)
535f3b85252SJohannes Berg {
536fe57d9f5SJohannes Berg 	/* Software scan is not supported in multi-channel cases */
5370a44dfc0SJohannes Berg 	if (!local->emulate_chanctx)
538fe57d9f5SJohannes Berg 		return -EOPNOTSUPP;
539fe57d9f5SJohannes Berg 
540f3b85252SJohannes Berg 	/*
541f3b85252SJohannes Berg 	 * Hardware/driver doesn't support hw_scan, so use software
542f3b85252SJohannes Berg 	 * scanning instead. First send a nullfunc frame with power save
543f3b85252SJohannes Berg 	 * bit on so that AP will buffer the frames for us while we are not
544f3b85252SJohannes Berg 	 * listening, then send probe requests to each channel and wait for
545f3b85252SJohannes Berg 	 * the responses. After all channels are scanned, tune back to the
546f3b85252SJohannes Berg 	 * original channel and send a nullfunc frame with power save bit
547f3b85252SJohannes Berg 	 * off to trigger the AP to send us all the buffered frames.
548f3b85252SJohannes Berg 	 *
549f3b85252SJohannes Berg 	 * Note that while local->sw_scanning is true everything else but
550f3b85252SJohannes Berg 	 * nullfunc frames and probe requests will be dropped in
551f3b85252SJohannes Berg 	 * ieee80211_tx_h_check_assoc().
552f3b85252SJohannes Berg 	 */
553a344d677SJohannes Berg 	drv_sw_scan_start(local, sdata, local->scan_addr);
554f3b85252SJohannes Berg 
555de312db3SRajkumar Manoharan 	local->leave_oper_channel_time = jiffies;
556977923b0SHelmut Schaa 	local->next_scan_state = SCAN_DECISION;
557f3b85252SJohannes Berg 	local->scan_channel_idx = 0;
558f3b85252SJohannes Berg 
559aacde9eeSStanislaw Gruszka 	ieee80211_offchannel_stop_vifs(local);
560a80f7c0bSJohannes Berg 
5619c35d7d2SSeth Forshee 	/* ensure nullfunc is transmitted before leaving operating channel */
5623b24f4c6SEmmanuel Grumbach 	ieee80211_flush_queues(local, NULL, false);
5639c35d7d2SSeth Forshee 
5643ac64beeSJohannes Berg 	ieee80211_configure_filter(local);
565f3b85252SJohannes Berg 
56659bdf3b0SBen Greear 	/* We need to set power level at maximum rate for scanning. */
5670a44dfc0SJohannes Berg 	ieee80211_hw_conf_chan(local);
56859bdf3b0SBen Greear 
56920171251SJohannes Berg 	wiphy_delayed_work_queue(local->hw.wiphy, &local->scan_work, 0);
570f3b85252SJohannes Berg 
571f3b85252SJohannes Berg 	return 0;
572f3b85252SJohannes Berg }
573f3b85252SJohannes Berg 
__ieee80211_can_leave_ch(struct ieee80211_sub_if_data * sdata)574dc0c18edSAaron Komisar static bool __ieee80211_can_leave_ch(struct ieee80211_sub_if_data *sdata)
575dc0c18edSAaron Komisar {
576dc0c18edSAaron Komisar 	struct ieee80211_local *local = sdata->local;
577dc0c18edSAaron Komisar 	struct ieee80211_sub_if_data *sdata_iter;
578*0b779823SAditya Kumar Singh 	unsigned int link_id;
579dc0c18edSAaron Komisar 
580be0df01dSJohannes Berg 	lockdep_assert_wiphy(local->hw.wiphy);
581be0df01dSJohannes Berg 
582dc0c18edSAaron Komisar 	if (!ieee80211_is_radar_required(local))
583dc0c18edSAaron Komisar 		return true;
584dc0c18edSAaron Komisar 
585dc0c18edSAaron Komisar 	if (!regulatory_pre_cac_allowed(local->hw.wiphy))
586dc0c18edSAaron Komisar 		return false;
587dc0c18edSAaron Komisar 
588dc0c18edSAaron Komisar 	list_for_each_entry(sdata_iter, &local->interfaces, list) {
589*0b779823SAditya Kumar Singh 		for_each_valid_link(&sdata_iter->wdev, link_id)
590*0b779823SAditya Kumar Singh 			if (sdata_iter->wdev.links[link_id].cac_started)
591dc0c18edSAaron Komisar 				return false;
592dc0c18edSAaron Komisar 	}
593dc0c18edSAaron Komisar 
594dc0c18edSAaron Komisar 	return true;
595dc0c18edSAaron Komisar }
596dc0c18edSAaron Komisar 
ieee80211_can_scan(struct ieee80211_local * local,struct ieee80211_sub_if_data * sdata)597133d40f9SStanislaw Gruszka static bool ieee80211_can_scan(struct ieee80211_local *local,
598133d40f9SStanislaw Gruszka 			       struct ieee80211_sub_if_data *sdata)
599133d40f9SStanislaw Gruszka {
600dc0c18edSAaron Komisar 	if (!__ieee80211_can_leave_ch(sdata))
601164eb02dSSimon Wunderlich 		return false;
602164eb02dSSimon Wunderlich 
6032eb278e0SJohannes Berg 	if (!list_empty(&local->roc_list))
604133d40f9SStanislaw Gruszka 		return false;
605133d40f9SStanislaw Gruszka 
606133d40f9SStanislaw Gruszka 	if (sdata->vif.type == NL80211_IFTYPE_STATION &&
607392b9ffbSStanislaw Gruszka 	    sdata->u.mgd.flags & IEEE80211_STA_CONNECTION_POLL)
608133d40f9SStanislaw Gruszka 		return false;
609133d40f9SStanislaw Gruszka 
610133d40f9SStanislaw Gruszka 	return true;
611133d40f9SStanislaw Gruszka }
612133d40f9SStanislaw Gruszka 
ieee80211_run_deferred_scan(struct ieee80211_local * local)613133d40f9SStanislaw Gruszka void ieee80211_run_deferred_scan(struct ieee80211_local *local)
614133d40f9SStanislaw Gruszka {
6150cd8080eSJohannes Berg 	lockdep_assert_wiphy(local->hw.wiphy);
616133d40f9SStanislaw Gruszka 
617133d40f9SStanislaw Gruszka 	if (!local->scan_req || local->scanning)
618133d40f9SStanislaw Gruszka 		return;
619133d40f9SStanislaw Gruszka 
620e2fd5dbcSJohannes Berg 	if (!ieee80211_can_scan(local,
621e2fd5dbcSJohannes Berg 				rcu_dereference_protected(
622e2fd5dbcSJohannes Berg 					local->scan_sdata,
6230cd8080eSJohannes Berg 					lockdep_is_held(&local->hw.wiphy->mtx))))
624133d40f9SStanislaw Gruszka 		return;
625133d40f9SStanislaw Gruszka 
62620171251SJohannes Berg 	wiphy_delayed_work_queue(local->hw.wiphy, &local->scan_work,
627133d40f9SStanislaw Gruszka 				 round_jiffies_relative(0));
628133d40f9SStanislaw Gruszka }
629f3b85252SJohannes Berg 
ieee80211_send_scan_probe_req(struct ieee80211_sub_if_data * sdata,const u8 * src,const u8 * dst,const u8 * ssid,size_t ssid_len,const u8 * ie,size_t ie_len,u32 ratemask,u32 flags,u32 tx_flags,struct ieee80211_channel * channel)63045ad6834SJohannes Berg static void ieee80211_send_scan_probe_req(struct ieee80211_sub_if_data *sdata,
63145ad6834SJohannes Berg 					  const u8 *src, const u8 *dst,
63245ad6834SJohannes Berg 					  const u8 *ssid, size_t ssid_len,
63345ad6834SJohannes Berg 					  const u8 *ie, size_t ie_len,
63445ad6834SJohannes Berg 					  u32 ratemask, u32 flags, u32 tx_flags,
63545ad6834SJohannes Berg 					  struct ieee80211_channel *channel)
63645ad6834SJohannes Berg {
63745ad6834SJohannes Berg 	struct sk_buff *skb;
63845ad6834SJohannes Berg 
63945ad6834SJohannes Berg 	skb = ieee80211_build_probe_req(sdata, src, dst, ratemask, channel,
64045ad6834SJohannes Berg 					ssid, ssid_len,
64145ad6834SJohannes Berg 					ie, ie_len, flags);
642b9771d41SJohannes Berg 
64345ad6834SJohannes Berg 	if (skb) {
644b9771d41SJohannes Berg 		if (flags & IEEE80211_PROBE_FLAG_RANDOM_SN) {
645b9771d41SJohannes Berg 			struct ieee80211_hdr *hdr = (void *)skb->data;
6462b3dab13SMathy Vanhoef 			struct ieee80211_tx_info *info = IEEE80211_SKB_CB(skb);
6477e3cf084SJason A. Donenfeld 			u16 sn = get_random_u16();
648b9771d41SJohannes Berg 
6492b3dab13SMathy Vanhoef 			info->control.flags |= IEEE80211_TX_CTRL_NO_SEQNO;
650b9771d41SJohannes Berg 			hdr->seq_ctrl =
651b9771d41SJohannes Berg 				cpu_to_le16(IEEE80211_SN_TO_SEQ(sn));
652b9771d41SJohannes Berg 		}
65345ad6834SJohannes Berg 		IEEE80211_SKB_CB(skb)->flags |= tx_flags;
654e7a7ef9aSPing-Ke Shih 		IEEE80211_SKB_CB(skb)->control.flags |= IEEE80211_TX_CTRL_DONT_USE_RATE_MASK;
65508aca29aSMathy Vanhoef 		ieee80211_tx_skb_tid_band(sdata, skb, 7, channel->band);
65645ad6834SJohannes Berg 	}
65745ad6834SJohannes Berg }
65845ad6834SJohannes Berg 
ieee80211_scan_state_send_probe(struct ieee80211_local * local,unsigned long * next_delay)6598a690674SBen Greear static void ieee80211_scan_state_send_probe(struct ieee80211_local *local,
6608a690674SBen Greear 					    unsigned long *next_delay)
6618a690674SBen Greear {
6628a690674SBen Greear 	int i;
663e2fd5dbcSJohannes Berg 	struct ieee80211_sub_if_data *sdata;
6646ea0a69cSJohannes Berg 	struct cfg80211_scan_request *scan_req;
66557fbcce3SJohannes Berg 	enum nl80211_band band = local->hw.conf.chandef.chan->band;
666b9771d41SJohannes Berg 	u32 flags = 0, tx_flags;
6676c17b77bSSeth Forshee 
6686ea0a69cSJohannes Berg 	scan_req = rcu_dereference_protected(local->scan_req,
6690cd8080eSJohannes Berg 					     lockdep_is_held(&local->hw.wiphy->mtx));
6706ea0a69cSJohannes Berg 
6716c17b77bSSeth Forshee 	tx_flags = IEEE80211_TX_INTFL_OFFCHAN_TX_OK;
6726ea0a69cSJohannes Berg 	if (scan_req->no_cck)
6736c17b77bSSeth Forshee 		tx_flags |= IEEE80211_TX_CTL_NO_CCK_RATE;
674b9771d41SJohannes Berg 	if (scan_req->flags & NL80211_SCAN_FLAG_MIN_PREQ_CONTENT)
675b9771d41SJohannes Berg 		flags |= IEEE80211_PROBE_FLAG_MIN_CONTENT;
676b9771d41SJohannes Berg 	if (scan_req->flags & NL80211_SCAN_FLAG_RANDOM_SN)
677b9771d41SJohannes Berg 		flags |= IEEE80211_PROBE_FLAG_RANDOM_SN;
6788a690674SBen Greear 
679e2fd5dbcSJohannes Berg 	sdata = rcu_dereference_protected(local->scan_sdata,
6800cd8080eSJohannes Berg 					  lockdep_is_held(&local->hw.wiphy->mtx));
681e2fd5dbcSJohannes Berg 
6826ea0a69cSJohannes Berg 	for (i = 0; i < scan_req->n_ssids; i++)
68345ad6834SJohannes Berg 		ieee80211_send_scan_probe_req(
684e345f44fSJouni Malinen 			sdata, local->scan_addr, scan_req->bssid,
6856ea0a69cSJohannes Berg 			scan_req->ssids[i].ssid, scan_req->ssids[i].ssid_len,
6866ea0a69cSJohannes Berg 			scan_req->ie, scan_req->ie_len,
687b9771d41SJohannes Berg 			scan_req->rates[band], flags,
68845ad6834SJohannes Berg 			tx_flags, local->hw.conf.chandef.chan);
6898a690674SBen Greear 
6908a690674SBen Greear 	/*
6918a690674SBen Greear 	 * After sending probe requests, wait for probe responses
6928a690674SBen Greear 	 * on the channel.
6938a690674SBen Greear 	 */
694d60277acSMichael-CY Lee 	*next_delay = msecs_to_jiffies(scan_req->duration) >
695d60277acSMichael-CY Lee 		      IEEE80211_PROBE_DELAY + IEEE80211_CHANNEL_TIME ?
696d60277acSMichael-CY Lee 		      msecs_to_jiffies(scan_req->duration) - IEEE80211_PROBE_DELAY :
697d60277acSMichael-CY Lee 		      IEEE80211_CHANNEL_TIME;
6988a690674SBen Greear 	local->next_scan_state = SCAN_DECISION;
6998a690674SBen Greear }
7008a690674SBen Greear 
__ieee80211_start_scan(struct ieee80211_sub_if_data * sdata,struct cfg80211_scan_request * req)701f3b85252SJohannes Berg static int __ieee80211_start_scan(struct ieee80211_sub_if_data *sdata,
702f3b85252SJohannes Berg 				  struct cfg80211_scan_request *req)
703f3b85252SJohannes Berg {
704f3b85252SJohannes Berg 	struct ieee80211_local *local = sdata->local;
705e9da68ddSJohannes Berg 	bool hw_scan = local->ops->hw_scan;
706f3b85252SJohannes Berg 	int rc;
707f3b85252SJohannes Berg 
7080cd8080eSJohannes Berg 	lockdep_assert_wiphy(local->hw.wiphy);
709e229f844SStanislaw Gruszka 
710dc0c18edSAaron Komisar 	if (local->scan_req)
711dc0c18edSAaron Komisar 		return -EBUSY;
712dc0c18edSAaron Komisar 
713cbde0b49SIlan Peer 	/* For an MLO connection, if a link ID was specified, validate that it
71480b0aacdSAyala Beker 	 * is indeed active.
715cbde0b49SIlan Peer 	 */
71680b0aacdSAyala Beker 	if (ieee80211_vif_is_mld(&sdata->vif) && req->tsf_report_link_id >= 0 &&
71780b0aacdSAyala Beker 	    !(sdata->vif.active_links & BIT(req->tsf_report_link_id)))
718cbde0b49SIlan Peer 		return -EINVAL;
719cbde0b49SIlan Peer 
720dc0c18edSAaron Komisar 	if (!__ieee80211_can_leave_ch(sdata))
721f3b85252SJohannes Berg 		return -EBUSY;
722f3b85252SJohannes Berg 
723133d40f9SStanislaw Gruszka 	if (!ieee80211_can_scan(local, sdata)) {
7246e7e6213SJohn W. Linville 		/* wait for the work to finish/time out */
7256ea0a69cSJohannes Berg 		rcu_assign_pointer(local->scan_req, req);
726e2fd5dbcSJohannes Berg 		rcu_assign_pointer(local->scan_sdata, sdata);
727c0ce77b8SJohannes Berg 		return 0;
728c0ce77b8SJohannes Berg 	}
729c0ce77b8SJohannes Berg 
730e9da68ddSJohannes Berg  again:
731e9da68ddSJohannes Berg 	if (hw_scan) {
732f3b85252SJohannes Berg 		u8 *ies;
733f3b85252SJohannes Berg 
734e4dcbb37SDavid Spinadel 		local->hw_scan_ies_bufsize = local->scan_ies_len + req->ie_len;
735c56ef672SDavid Spinadel 
73630686bf7SJohannes Berg 		if (ieee80211_hw_check(&local->hw, SINGLE_SCAN_ON_ALL_BANDS)) {
737c56ef672SDavid Spinadel 			int i, n_bands = 0;
738c56ef672SDavid Spinadel 			u8 bands_counted = 0;
739c56ef672SDavid Spinadel 
740c56ef672SDavid Spinadel 			for (i = 0; i < req->n_channels; i++) {
741c56ef672SDavid Spinadel 				if (bands_counted & BIT(req->channels[i]->band))
742c56ef672SDavid Spinadel 					continue;
743c56ef672SDavid Spinadel 				bands_counted |= BIT(req->channels[i]->band);
744c56ef672SDavid Spinadel 				n_bands++;
745c56ef672SDavid Spinadel 			}
746c56ef672SDavid Spinadel 
747c56ef672SDavid Spinadel 			local->hw_scan_ies_bufsize *= n_bands;
748c56ef672SDavid Spinadel 		}
749c56ef672SDavid Spinadel 
75092ecbb3aSDmitry Antipov 		local->hw_scan_req = kmalloc(struct_size(local->hw_scan_req,
75192ecbb3aSDmitry Antipov 							 req.channels,
75292ecbb3aSDmitry Antipov 							 req->n_channels) +
75392ecbb3aSDmitry Antipov 					     local->hw_scan_ies_bufsize,
75492ecbb3aSDmitry Antipov 					     GFP_KERNEL);
7554d36ec58SJohannes Berg 		if (!local->hw_scan_req)
756f3b85252SJohannes Berg 			return -ENOMEM;
757f3b85252SJohannes Berg 
758c56ef672SDavid Spinadel 		local->hw_scan_req->req.ssids = req->ssids;
759c56ef672SDavid Spinadel 		local->hw_scan_req->req.n_ssids = req->n_ssids;
76092ecbb3aSDmitry Antipov 		/* None of the channels are actually set
76192ecbb3aSDmitry Antipov 		 * up but let UBSAN know the boundaries.
76292ecbb3aSDmitry Antipov 		 */
76392ecbb3aSDmitry Antipov 		local->hw_scan_req->req.n_channels = req->n_channels;
76492ecbb3aSDmitry Antipov 
7654d36ec58SJohannes Berg 		ies = (u8 *)local->hw_scan_req +
7664d36ec58SJohannes Berg 			sizeof(*local->hw_scan_req) +
7674d36ec58SJohannes Berg 			req->n_channels * sizeof(req->channels[0]);
768c56ef672SDavid Spinadel 		local->hw_scan_req->req.ie = ies;
769c56ef672SDavid Spinadel 		local->hw_scan_req->req.flags = req->flags;
770e345f44fSJouni Malinen 		eth_broadcast_addr(local->hw_scan_req->req.bssid);
7717947d3e0SAvraham Stern 		local->hw_scan_req->req.duration = req->duration;
7727947d3e0SAvraham Stern 		local->hw_scan_req->req.duration_mandatory =
7737947d3e0SAvraham Stern 			req->duration_mandatory;
774cbde0b49SIlan Peer 		local->hw_scan_req->req.tsf_report_link_id =
775cbde0b49SIlan Peer 			req->tsf_report_link_id;
7764d36ec58SJohannes Berg 
7774d36ec58SJohannes Berg 		local->hw_scan_band = 0;
778c8cb5b85STova Mussai 		local->hw_scan_req->req.n_6ghz_params = req->n_6ghz_params;
779c8cb5b85STova Mussai 		local->hw_scan_req->req.scan_6ghz_params =
780c8cb5b85STova Mussai 			req->scan_6ghz_params;
781c8cb5b85STova Mussai 		local->hw_scan_req->req.scan_6ghz = req->scan_6ghz;
7826e7e6213SJohn W. Linville 
7836e7e6213SJohn W. Linville 		/*
7846e7e6213SJohn W. Linville 		 * After allocating local->hw_scan_req, we must
7856e7e6213SJohn W. Linville 		 * go through until ieee80211_prep_hw_scan(), so
7866e7e6213SJohn W. Linville 		 * anything that might be changed here and leave
7876e7e6213SJohn W. Linville 		 * this function early must not go after this
7886e7e6213SJohn W. Linville 		 * allocation.
7896e7e6213SJohn W. Linville 		 */
790f3b85252SJohannes Berg 	}
791f3b85252SJohannes Berg 
7926ea0a69cSJohannes Berg 	rcu_assign_pointer(local->scan_req, req);
793e2fd5dbcSJohannes Berg 	rcu_assign_pointer(local->scan_sdata, sdata);
794f3b85252SJohannes Berg 
795a344d677SJohannes Berg 	if (req->flags & NL80211_SCAN_FLAG_RANDOM_ADDR)
796a344d677SJohannes Berg 		get_random_mask_addr(local->scan_addr,
797a344d677SJohannes Berg 				     req->mac_addr,
798a344d677SJohannes Berg 				     req->mac_addr_mask);
799a344d677SJohannes Berg 	else
800a344d677SJohannes Berg 		memcpy(local->scan_addr, sdata->vif.addr, ETH_ALEN);
801a344d677SJohannes Berg 
802e9da68ddSJohannes Berg 	if (hw_scan) {
803fbe9c429SHelmut Schaa 		__set_bit(SCAN_HW_SCANNING, &local->scanning);
8048a690674SBen Greear 	} else if ((req->n_channels == 1) &&
8050a44dfc0SJohannes Berg 		   (req->channels[0] == local->hw.conf.chandef.chan)) {
8069b864870SJohannes Berg 		/*
8079b864870SJohannes Berg 		 * If we are scanning only on the operating channel
8089b864870SJohannes Berg 		 * then we do not need to stop normal activities
8098a690674SBen Greear 		 */
8108a690674SBen Greear 		unsigned long next_delay;
8118a690674SBen Greear 
8128a690674SBen Greear 		__set_bit(SCAN_ONCHANNEL_SCANNING, &local->scanning);
8138a690674SBen Greear 
8148a690674SBen Greear 		ieee80211_recalc_idle(local);
8158a690674SBen Greear 
8168a690674SBen Greear 		/* Notify driver scan is starting, keep order of operations
8178a690674SBen Greear 		 * same as normal software scan, in case that matters. */
818a344d677SJohannes Berg 		drv_sw_scan_start(local, sdata, local->scan_addr);
8198a690674SBen Greear 
8208a690674SBen Greear 		ieee80211_configure_filter(local); /* accept probe-responses */
8218a690674SBen Greear 
8228a690674SBen Greear 		/* We need to ensure power level is at max for scanning. */
8230a44dfc0SJohannes Berg 		ieee80211_hw_conf_chan(local);
8248a690674SBen Greear 
8254e39ccacSAntonio Quartulli 		if ((req->channels[0]->flags & (IEEE80211_CHAN_NO_IR |
8264e39ccacSAntonio Quartulli 						IEEE80211_CHAN_RADAR)) ||
8276ea0a69cSJohannes Berg 		    !req->n_ssids) {
8288a690674SBen Greear 			next_delay = IEEE80211_PASSIVE_CHANNEL_TIME;
829b041b7b9SFelix Fietkau 			if (req->n_ssids)
830b041b7b9SFelix Fietkau 				set_bit(SCAN_BEACON_WAIT, &local->scanning);
8318a690674SBen Greear 		} else {
8328a690674SBen Greear 			ieee80211_scan_state_send_probe(local, &next_delay);
8338a690674SBen Greear 			next_delay = IEEE80211_CHANNEL_TIME;
8348a690674SBen Greear 		}
8358a690674SBen Greear 
8368a690674SBen Greear 		/* Now, just wait a bit and we are all done! */
83720171251SJohannes Berg 		wiphy_delayed_work_queue(local->hw.wiphy, &local->scan_work,
8388a690674SBen Greear 					 next_delay);
8398a690674SBen Greear 		return 0;
8408a690674SBen Greear 	} else {
8418a690674SBen Greear 		/* Do normal software scan */
842fbe9c429SHelmut Schaa 		__set_bit(SCAN_SW_SCANNING, &local->scanning);
8438a690674SBen Greear 	}
8446e7e6213SJohn W. Linville 
8455cff20e6SJohannes Berg 	ieee80211_recalc_idle(local);
846f3b85252SJohannes Berg 
847e9da68ddSJohannes Berg 	if (hw_scan) {
8482ad2274cSIlan Peer 		WARN_ON(!ieee80211_prep_hw_scan(sdata));
849a060bbfeSJohannes Berg 		rc = drv_hw_scan(local, sdata, local->hw_scan_req);
850a344d677SJohannes Berg 	} else {
851a344d677SJohannes Berg 		rc = ieee80211_start_sw_scan(local, sdata);
852a344d677SJohannes Berg 	}
853f3b85252SJohannes Berg 
854f3b85252SJohannes Berg 	if (rc) {
8554d36ec58SJohannes Berg 		kfree(local->hw_scan_req);
8564d36ec58SJohannes Berg 		local->hw_scan_req = NULL;
857fbe9c429SHelmut Schaa 		local->scanning = 0;
858f3b85252SJohannes Berg 
8595cff20e6SJohannes Berg 		ieee80211_recalc_idle(local);
8605cff20e6SJohannes Berg 
861f3b85252SJohannes Berg 		local->scan_req = NULL;
8620c2bef46SMonam Agarwal 		RCU_INIT_POINTER(local->scan_sdata, NULL);
863f3b85252SJohannes Berg 	}
864f3b85252SJohannes Berg 
865e9da68ddSJohannes Berg 	if (hw_scan && rc == 1) {
866e9da68ddSJohannes Berg 		/*
867e9da68ddSJohannes Berg 		 * we can't fall back to software for P2P-GO
868e9da68ddSJohannes Berg 		 * as it must update NoA etc.
869e9da68ddSJohannes Berg 		 */
870e9da68ddSJohannes Berg 		if (ieee80211_vif_type_p2p(&sdata->vif) ==
871e9da68ddSJohannes Berg 				NL80211_IFTYPE_P2P_GO)
872e9da68ddSJohannes Berg 			return -EOPNOTSUPP;
873e9da68ddSJohannes Berg 		hw_scan = false;
874e9da68ddSJohannes Berg 		goto again;
875e9da68ddSJohannes Berg 	}
876e9da68ddSJohannes Berg 
877f3b85252SJohannes Berg 	return rc;
878f3b85252SJohannes Berg }
879f3b85252SJohannes Berg 
880df13cce5SHelmut Schaa static unsigned long
ieee80211_scan_get_channel_time(struct ieee80211_channel * chan)881df13cce5SHelmut Schaa ieee80211_scan_get_channel_time(struct ieee80211_channel *chan)
882df13cce5SHelmut Schaa {
883df13cce5SHelmut Schaa 	/*
884df13cce5SHelmut Schaa 	 * TODO: channel switching also consumes quite some time,
885df13cce5SHelmut Schaa 	 * add that delay as well to get a better estimation
886df13cce5SHelmut Schaa 	 */
8874e39ccacSAntonio Quartulli 	if (chan->flags & (IEEE80211_CHAN_NO_IR | IEEE80211_CHAN_RADAR))
888df13cce5SHelmut Schaa 		return IEEE80211_PASSIVE_CHANNEL_TIME;
889df13cce5SHelmut Schaa 	return IEEE80211_PROBE_DELAY + IEEE80211_CHANNEL_TIME;
890df13cce5SHelmut Schaa }
891df13cce5SHelmut Schaa 
ieee80211_scan_state_decision(struct ieee80211_local * local,unsigned long * next_delay)892e229f844SStanislaw Gruszka static void ieee80211_scan_state_decision(struct ieee80211_local *local,
8932fb3f028SHelmut Schaa 					  unsigned long *next_delay)
8942fb3f028SHelmut Schaa {
895142b9f50SHelmut Schaa 	bool associated = false;
896df13cce5SHelmut Schaa 	bool tx_empty = true;
897df13cce5SHelmut Schaa 	bool bad_latency;
898142b9f50SHelmut Schaa 	struct ieee80211_sub_if_data *sdata;
899df13cce5SHelmut Schaa 	struct ieee80211_channel *next_chan;
900cd2bb512SSam Leffler 	enum mac80211_scan_state next_scan_state;
9016ea0a69cSJohannes Berg 	struct cfg80211_scan_request *scan_req;
902142b9f50SHelmut Schaa 
903be0df01dSJohannes Berg 	lockdep_assert_wiphy(local->hw.wiphy);
904be0df01dSJohannes Berg 
905df13cce5SHelmut Schaa 	/*
906df13cce5SHelmut Schaa 	 * check if at least one STA interface is associated,
907df13cce5SHelmut Schaa 	 * check if at least one STA interface has pending tx frames
908df13cce5SHelmut Schaa 	 * and grab the lowest used beacon interval
909df13cce5SHelmut Schaa 	 */
910142b9f50SHelmut Schaa 	list_for_each_entry(sdata, &local->interfaces, list) {
9119607e6b6SJohannes Berg 		if (!ieee80211_sdata_running(sdata))
912142b9f50SHelmut Schaa 			continue;
913142b9f50SHelmut Schaa 
914142b9f50SHelmut Schaa 		if (sdata->vif.type == NL80211_IFTYPE_STATION) {
915142b9f50SHelmut Schaa 			if (sdata->u.mgd.associated) {
916142b9f50SHelmut Schaa 				associated = true;
917df13cce5SHelmut Schaa 
918df13cce5SHelmut Schaa 				if (!qdisc_all_tx_empty(sdata->dev)) {
919df13cce5SHelmut Schaa 					tx_empty = false;
920142b9f50SHelmut Schaa 					break;
921142b9f50SHelmut Schaa 				}
922142b9f50SHelmut Schaa 			}
923142b9f50SHelmut Schaa 		}
924df13cce5SHelmut Schaa 	}
925142b9f50SHelmut Schaa 
9266ea0a69cSJohannes Berg 	scan_req = rcu_dereference_protected(local->scan_req,
9270cd8080eSJohannes Berg 					     lockdep_is_held(&local->hw.wiphy->mtx));
9286ea0a69cSJohannes Berg 
9296ea0a69cSJohannes Berg 	next_chan = scan_req->channels[local->scan_channel_idx];
930b23b025fSBen Greear 
931142b9f50SHelmut Schaa 	/*
932142b9f50SHelmut Schaa 	 * we're currently scanning a different channel, let's
933df13cce5SHelmut Schaa 	 * see if we can scan another channel without interfering
934df13cce5SHelmut Schaa 	 * with the current traffic situation.
935df13cce5SHelmut Schaa 	 *
9363f892b61SStanislaw Gruszka 	 * Keep good latency, do not stay off-channel more than 125 ms.
937142b9f50SHelmut Schaa 	 */
938df13cce5SHelmut Schaa 
939df13cce5SHelmut Schaa 	bad_latency = time_after(jiffies +
940df13cce5SHelmut Schaa 				 ieee80211_scan_get_channel_time(next_chan),
9413f892b61SStanislaw Gruszka 				 local->leave_oper_channel_time + HZ / 8);
942df13cce5SHelmut Schaa 
943cd2bb512SSam Leffler 	if (associated && !tx_empty) {
9446ea0a69cSJohannes Berg 		if (scan_req->flags & NL80211_SCAN_FLAG_LOW_PRIORITY)
945cd2bb512SSam Leffler 			next_scan_state = SCAN_ABORT;
946142b9f50SHelmut Schaa 		else
947cd2bb512SSam Leffler 			next_scan_state = SCAN_SUSPEND;
9483f892b61SStanislaw Gruszka 	} else if (associated && bad_latency) {
949cd2bb512SSam Leffler 		next_scan_state = SCAN_SUSPEND;
950cd2bb512SSam Leffler 	} else {
951cd2bb512SSam Leffler 		next_scan_state = SCAN_SET_CHANNEL;
952cd2bb512SSam Leffler 	}
953cd2bb512SSam Leffler 
954cd2bb512SSam Leffler 	local->next_scan_state = next_scan_state;
955142b9f50SHelmut Schaa 
956142b9f50SHelmut Schaa 	*next_delay = 0;
9572fb3f028SHelmut Schaa }
9582fb3f028SHelmut Schaa 
ieee80211_scan_state_set_channel(struct ieee80211_local * local,unsigned long * next_delay)9592fb3f028SHelmut Schaa static void ieee80211_scan_state_set_channel(struct ieee80211_local *local,
9607d3be3ccSHelmut Schaa 					     unsigned long *next_delay)
9617d3be3ccSHelmut Schaa {
9627d3be3ccSHelmut Schaa 	int skip;
9637d3be3ccSHelmut Schaa 	struct ieee80211_channel *chan;
9646ea0a69cSJohannes Berg 	struct cfg80211_scan_request *scan_req;
9656ea0a69cSJohannes Berg 
9666ea0a69cSJohannes Berg 	scan_req = rcu_dereference_protected(local->scan_req,
9670cd8080eSJohannes Berg 					     lockdep_is_held(&local->hw.wiphy->mtx));
9687d3be3ccSHelmut Schaa 
9697d3be3ccSHelmut Schaa 	skip = 0;
9706ea0a69cSJohannes Berg 	chan = scan_req->channels[local->scan_channel_idx];
9717d3be3ccSHelmut Schaa 
9727ca15a0aSSimon Wunderlich 	local->scan_chandef.chan = chan;
9737ca15a0aSSimon Wunderlich 	local->scan_chandef.center_freq1 = chan->center_freq;
974b6011960SThomas Pedersen 	local->scan_chandef.freq1_offset = chan->freq_offset;
9757ca15a0aSSimon Wunderlich 	local->scan_chandef.center_freq2 = 0;
97675b15935SThomas Pedersen 
9775add321cSJohannes Berg 	/* For scanning on the S1G band, detect the channel width according to
9785add321cSJohannes Berg 	 * the channel being scanned.
97975b15935SThomas Pedersen 	 */
98075b15935SThomas Pedersen 	if (chan->band == NL80211_BAND_S1GHZ) {
98175b15935SThomas Pedersen 		local->scan_chandef.width = ieee80211_s1g_channel_width(chan);
98275b15935SThomas Pedersen 		goto set_channel;
98375b15935SThomas Pedersen 	}
98475b15935SThomas Pedersen 
9857ca15a0aSSimon Wunderlich 	/* If scanning on oper channel, use whatever channel-type
9867ca15a0aSSimon Wunderlich 	 * is currently in use.
9877ca15a0aSSimon Wunderlich 	 */
9880a44dfc0SJohannes Berg 	if (chan == local->hw.conf.chandef.chan)
9890a44dfc0SJohannes Berg 		local->scan_chandef = local->hw.conf.chandef;
9907ca15a0aSSimon Wunderlich 	else
9917ca15a0aSSimon Wunderlich 		local->scan_chandef.width = NL80211_CHAN_WIDTH_20_NOHT;
992b23b025fSBen Greear 
99375b15935SThomas Pedersen set_channel:
9940a44dfc0SJohannes Berg 	if (ieee80211_hw_conf_chan(local))
9957d3be3ccSHelmut Schaa 		skip = 1;
9967d3be3ccSHelmut Schaa 
9977d3be3ccSHelmut Schaa 	/* advance state machine to next channel/band */
9987d3be3ccSHelmut Schaa 	local->scan_channel_idx++;
9997d3be3ccSHelmut Schaa 
10000ee9c13cSHelmut Schaa 	if (skip) {
10010ee9c13cSHelmut Schaa 		/* if we skip this channel return to the decision state */
10020ee9c13cSHelmut Schaa 		local->next_scan_state = SCAN_DECISION;
10032fb3f028SHelmut Schaa 		return;
10040ee9c13cSHelmut Schaa 	}
10057d3be3ccSHelmut Schaa 
10067d3be3ccSHelmut Schaa 	/*
10077d3be3ccSHelmut Schaa 	 * Probe delay is used to update the NAV, cf. 11.1.3.2.2
10087d3be3ccSHelmut Schaa 	 * (which unfortunately doesn't say _why_ step a) is done,
10097d3be3ccSHelmut Schaa 	 * but it waits for the probe delay or until a frame is
10107d3be3ccSHelmut Schaa 	 * received - and the received frame would update the NAV).
10117d3be3ccSHelmut Schaa 	 * For now, we do not support waiting until a frame is
10127d3be3ccSHelmut Schaa 	 * received.
10137d3be3ccSHelmut Schaa 	 *
10147d3be3ccSHelmut Schaa 	 * In any case, it is not necessary for a passive scan.
10157d3be3ccSHelmut Schaa 	 */
10164e39ccacSAntonio Quartulli 	if ((chan->flags & (IEEE80211_CHAN_NO_IR | IEEE80211_CHAN_RADAR)) ||
10174e39ccacSAntonio Quartulli 	    !scan_req->n_ssids) {
10188109b226SYan Zhen 		*next_delay = max(msecs_to_jiffies(scan_req->duration),
10198109b226SYan Zhen 				  IEEE80211_PASSIVE_CHANNEL_TIME);
1020977923b0SHelmut Schaa 		local->next_scan_state = SCAN_DECISION;
1021b041b7b9SFelix Fietkau 		if (scan_req->n_ssids)
1022b041b7b9SFelix Fietkau 			set_bit(SCAN_BEACON_WAIT, &local->scanning);
10232fb3f028SHelmut Schaa 		return;
10247d3be3ccSHelmut Schaa 	}
10257d3be3ccSHelmut Schaa 
10262fb3f028SHelmut Schaa 	/* active scan, send probes */
10277d3be3ccSHelmut Schaa 	*next_delay = IEEE80211_PROBE_DELAY;
1028977923b0SHelmut Schaa 	local->next_scan_state = SCAN_SEND_PROBE;
10297d3be3ccSHelmut Schaa }
10307d3be3ccSHelmut Schaa 
ieee80211_scan_state_suspend(struct ieee80211_local * local,unsigned long * next_delay)103107ef03eeSJohannes Berg static void ieee80211_scan_state_suspend(struct ieee80211_local *local,
103207ef03eeSJohannes Berg 					 unsigned long *next_delay)
103307ef03eeSJohannes Berg {
103407ef03eeSJohannes Berg 	/* switch back to the operating channel */
10357ca15a0aSSimon Wunderlich 	local->scan_chandef.chan = NULL;
10360a44dfc0SJohannes Berg 	ieee80211_hw_conf_chan(local);
103707ef03eeSJohannes Berg 
1038aacde9eeSStanislaw Gruszka 	/* disable PS */
1039aacde9eeSStanislaw Gruszka 	ieee80211_offchannel_return(local);
104007ef03eeSJohannes Berg 
104107ef03eeSJohannes Berg 	*next_delay = HZ / 5;
104207ef03eeSJohannes Berg 	/* afterwards, resume scan & go to next channel */
104307ef03eeSJohannes Berg 	local->next_scan_state = SCAN_RESUME;
104407ef03eeSJohannes Berg }
104507ef03eeSJohannes Berg 
ieee80211_scan_state_resume(struct ieee80211_local * local,unsigned long * next_delay)104607ef03eeSJohannes Berg static void ieee80211_scan_state_resume(struct ieee80211_local *local,
104707ef03eeSJohannes Berg 					unsigned long *next_delay)
104807ef03eeSJohannes Berg {
1049aacde9eeSStanislaw Gruszka 	ieee80211_offchannel_stop_vifs(local);
105007ef03eeSJohannes Berg 
105107ef03eeSJohannes Berg 	if (local->ops->flush) {
10523b24f4c6SEmmanuel Grumbach 		ieee80211_flush_queues(local, NULL, false);
105307ef03eeSJohannes Berg 		*next_delay = 0;
105407ef03eeSJohannes Berg 	} else
105507ef03eeSJohannes Berg 		*next_delay = HZ / 10;
105607ef03eeSJohannes Berg 
105707ef03eeSJohannes Berg 	/* remember when we left the operating channel */
105807ef03eeSJohannes Berg 	local->leave_oper_channel_time = jiffies;
105907ef03eeSJohannes Berg 
106007ef03eeSJohannes Berg 	/* advance to the next channel to be scanned */
1061de2ee84dSMohammed Shafi Shajakhan 	local->next_scan_state = SCAN_SET_CHANNEL;
106207ef03eeSJohannes Berg }
106307ef03eeSJohannes Berg 
ieee80211_scan_work(struct wiphy * wiphy,struct wiphy_work * work)106420171251SJohannes Berg void ieee80211_scan_work(struct wiphy *wiphy, struct wiphy_work *work)
10650a51b27eSJohannes Berg {
10660a51b27eSJohannes Berg 	struct ieee80211_local *local =
10670a51b27eSJohannes Berg 		container_of(work, struct ieee80211_local, scan_work.work);
1068d07bfd8bSJohannes Berg 	struct ieee80211_sub_if_data *sdata;
10696ea0a69cSJohannes Berg 	struct cfg80211_scan_request *scan_req;
10700a51b27eSJohannes Berg 	unsigned long next_delay = 0;
10718bd2a248SEliad Peller 	bool aborted;
10728789d459SJohannes Berg 
10730cd8080eSJohannes Berg 	lockdep_assert_wiphy(local->hw.wiphy);
1074259b62e3SStanislaw Gruszka 
1075332ff7feSLuciano Coelho 	if (!ieee80211_can_run_worker(local)) {
1076332ff7feSLuciano Coelho 		aborted = true;
1077332ff7feSLuciano Coelho 		goto out_complete;
1078332ff7feSLuciano Coelho 	}
1079332ff7feSLuciano Coelho 
1080e2fd5dbcSJohannes Berg 	sdata = rcu_dereference_protected(local->scan_sdata,
10810cd8080eSJohannes Berg 					  lockdep_is_held(&local->hw.wiphy->mtx));
10826ea0a69cSJohannes Berg 	scan_req = rcu_dereference_protected(local->scan_req,
10830cd8080eSJohannes Berg 					     lockdep_is_held(&local->hw.wiphy->mtx));
1084d07bfd8bSJohannes Berg 
10858a690674SBen Greear 	/* When scanning on-channel, the first-callback means completed. */
10868a690674SBen Greear 	if (test_bit(SCAN_ONCHANNEL_SCANNING, &local->scanning)) {
10878a690674SBen Greear 		aborted = test_and_clear_bit(SCAN_ABORTED, &local->scanning);
10888a690674SBen Greear 		goto out_complete;
10898a690674SBen Greear 	}
10908a690674SBen Greear 
1091259b62e3SStanislaw Gruszka 	if (test_and_clear_bit(SCAN_COMPLETED, &local->scanning)) {
10928789d459SJohannes Berg 		aborted = test_and_clear_bit(SCAN_ABORTED, &local->scanning);
1093259b62e3SStanislaw Gruszka 		goto out_complete;
10948789d459SJohannes Berg 	}
10958789d459SJohannes Berg 
10966ea0a69cSJohannes Berg 	if (!sdata || !scan_req)
10970cd8080eSJohannes Berg 		return;
1098f3b85252SJohannes Berg 
1099ff5db439SEliad Peller 	if (!local->scanning) {
1100f3b85252SJohannes Berg 		int rc;
1101f3b85252SJohannes Berg 
11026ea0a69cSJohannes Berg 		RCU_INIT_POINTER(local->scan_req, NULL);
11030c2bef46SMonam Agarwal 		RCU_INIT_POINTER(local->scan_sdata, NULL);
1104f3b85252SJohannes Berg 
11056ea0a69cSJohannes Berg 		rc = __ieee80211_start_scan(sdata, scan_req);
11060cd8080eSJohannes Berg 		if (!rc)
11070cd8080eSJohannes Berg 			return;
11083aed49efSStanislaw Gruszka 		/* need to complete scan in cfg80211 */
11096ea0a69cSJohannes Berg 		rcu_assign_pointer(local->scan_req, scan_req);
1110259b62e3SStanislaw Gruszka 		aborted = true;
1111259b62e3SStanislaw Gruszka 		goto out_complete;
1112f3b85252SJohannes Berg 	}
1113f3b85252SJohannes Berg 
1114b041b7b9SFelix Fietkau 	clear_bit(SCAN_BEACON_WAIT, &local->scanning);
1115b041b7b9SFelix Fietkau 
11165bc75728SJohannes Berg 	/*
1117f502d09bSHelmut Schaa 	 * as long as no delay is required advance immediately
1118f502d09bSHelmut Schaa 	 * without scheduling a new work
1119f502d09bSHelmut Schaa 	 */
1120f502d09bSHelmut Schaa 	do {
1121c29acf20SRajkumar Manoharan 		if (!ieee80211_sdata_running(sdata)) {
1122c29acf20SRajkumar Manoharan 			aborted = true;
1123c29acf20SRajkumar Manoharan 			goto out_complete;
1124c29acf20SRajkumar Manoharan 		}
1125c29acf20SRajkumar Manoharan 
1126b041b7b9SFelix Fietkau 		if (test_and_clear_bit(SCAN_BEACON_DONE, &local->scanning) &&
1127b041b7b9SFelix Fietkau 		    local->next_scan_state == SCAN_DECISION)
1128b041b7b9SFelix Fietkau 			local->next_scan_state = SCAN_SEND_PROBE;
1129b041b7b9SFelix Fietkau 
1130977923b0SHelmut Schaa 		switch (local->next_scan_state) {
11312fb3f028SHelmut Schaa 		case SCAN_DECISION:
1132e229f844SStanislaw Gruszka 			/* if no more bands/channels left, complete scan */
11336ea0a69cSJohannes Berg 			if (local->scan_channel_idx >= scan_req->n_channels) {
1134e229f844SStanislaw Gruszka 				aborted = false;
1135e229f844SStanislaw Gruszka 				goto out_complete;
1136e229f844SStanislaw Gruszka 			}
1137e229f844SStanislaw Gruszka 			ieee80211_scan_state_decision(local, &next_delay);
11380a51b27eSJohannes Berg 			break;
11392fb3f028SHelmut Schaa 		case SCAN_SET_CHANNEL:
11402fb3f028SHelmut Schaa 			ieee80211_scan_state_set_channel(local, &next_delay);
11412fb3f028SHelmut Schaa 			break;
11420a51b27eSJohannes Berg 		case SCAN_SEND_PROBE:
11437d3be3ccSHelmut Schaa 			ieee80211_scan_state_send_probe(local, &next_delay);
11440a51b27eSJohannes Berg 			break;
114507ef03eeSJohannes Berg 		case SCAN_SUSPEND:
114607ef03eeSJohannes Berg 			ieee80211_scan_state_suspend(local, &next_delay);
1147142b9f50SHelmut Schaa 			break;
114807ef03eeSJohannes Berg 		case SCAN_RESUME:
114907ef03eeSJohannes Berg 			ieee80211_scan_state_resume(local, &next_delay);
1150142b9f50SHelmut Schaa 			break;
1151cd2bb512SSam Leffler 		case SCAN_ABORT:
1152cd2bb512SSam Leffler 			aborted = true;
1153cd2bb512SSam Leffler 			goto out_complete;
11540a51b27eSJohannes Berg 		}
1155f502d09bSHelmut Schaa 	} while (next_delay == 0);
11560a51b27eSJohannes Berg 
115720171251SJohannes Berg 	wiphy_delayed_work_queue(local->hw.wiphy, &local->scan_work,
115820171251SJohannes Berg 				 next_delay);
11590cd8080eSJohannes Berg 	return;
1160259b62e3SStanislaw Gruszka 
1161259b62e3SStanislaw Gruszka out_complete:
11628bd2a248SEliad Peller 	__ieee80211_scan_completed(&local->hw, aborted);
11630a51b27eSJohannes Berg }
11640a51b27eSJohannes Berg 
ieee80211_request_scan(struct ieee80211_sub_if_data * sdata,struct cfg80211_scan_request * req)1165c2b13452SJohannes Berg int ieee80211_request_scan(struct ieee80211_sub_if_data *sdata,
11662a519311SJohannes Berg 			   struct cfg80211_scan_request *req)
11670a51b27eSJohannes Berg {
11680cd8080eSJohannes Berg 	lockdep_assert_wiphy(sdata->local->hw.wiphy);
11690a51b27eSJohannes Berg 
11700cd8080eSJohannes Berg 	return __ieee80211_start_scan(sdata, req);
11710a51b27eSJohannes Berg }
11720a51b27eSJohannes Berg 
ieee80211_request_ibss_scan(struct ieee80211_sub_if_data * sdata,const u8 * ssid,u8 ssid_len,struct ieee80211_channel ** channels,unsigned int n_channels)117334bcf715SStanislaw Gruszka int ieee80211_request_ibss_scan(struct ieee80211_sub_if_data *sdata,
1174be4a4b6aSJohannes Berg 				const u8 *ssid, u8 ssid_len,
117576bed0f4SJanusz.Dziedzic@tieto.com 				struct ieee80211_channel **channels,
11765add321cSJohannes Berg 				unsigned int n_channels)
1177f3b85252SJohannes Berg {
1178f3b85252SJohannes Berg 	struct ieee80211_local *local = sdata->local;
117976bed0f4SJanusz.Dziedzic@tieto.com 	int ret = -EBUSY, i, n_ch = 0;
118057fbcce3SJohannes Berg 	enum nl80211_band band;
11819116dd01SJohannes Berg 
11820cd8080eSJohannes Berg 	lockdep_assert_wiphy(local->hw.wiphy);
1183f3b85252SJohannes Berg 
1184f3b85252SJohannes Berg 	/* busy scanning */
1185f3b85252SJohannes Berg 	if (local->scan_req)
1186f3b85252SJohannes Berg 		goto unlock;
1187f3b85252SJohannes Berg 
1188be4a4b6aSJohannes Berg 	/* fill internal scan request */
118976bed0f4SJanusz.Dziedzic@tieto.com 	if (!channels) {
119076bed0f4SJanusz.Dziedzic@tieto.com 		int max_n;
1191be4a4b6aSJohannes Berg 
119257fbcce3SJohannes Berg 		for (band = 0; band < NUM_NL80211_BANDS; band++) {
1193c8cb5b85STova Mussai 			if (!local->hw.wiphy->bands[band] ||
1194c8cb5b85STova Mussai 			    band == NL80211_BAND_6GHZ)
1195be4a4b6aSJohannes Berg 				continue;
119634bcf715SStanislaw Gruszka 
119734bcf715SStanislaw Gruszka 			max_n = local->hw.wiphy->bands[band]->n_channels;
119834bcf715SStanislaw Gruszka 			for (i = 0; i < max_n; i++) {
119934bcf715SStanislaw Gruszka 				struct ieee80211_channel *tmp_ch =
1200be4a4b6aSJohannes Berg 				    &local->hw.wiphy->bands[band]->channels[i];
120134bcf715SStanislaw Gruszka 
12028fe02e16SLuis R. Rodriguez 				if (tmp_ch->flags & (IEEE80211_CHAN_NO_IR |
120334bcf715SStanislaw Gruszka 						     IEEE80211_CHAN_DISABLED))
120434bcf715SStanislaw Gruszka 					continue;
120534bcf715SStanislaw Gruszka 
120634bcf715SStanislaw Gruszka 				local->int_scan_req->channels[n_ch] = tmp_ch;
120734bcf715SStanislaw Gruszka 				n_ch++;
1208be4a4b6aSJohannes Berg 			}
1209be4a4b6aSJohannes Berg 		}
1210be4a4b6aSJohannes Berg 
121134bcf715SStanislaw Gruszka 		if (WARN_ON_ONCE(n_ch == 0))
121234bcf715SStanislaw Gruszka 			goto unlock;
121334bcf715SStanislaw Gruszka 
121434bcf715SStanislaw Gruszka 		local->int_scan_req->n_channels = n_ch;
1215be4a4b6aSJohannes Berg 	} else {
121676bed0f4SJanusz.Dziedzic@tieto.com 		for (i = 0; i < n_channels; i++) {
121776bed0f4SJanusz.Dziedzic@tieto.com 			if (channels[i]->flags & (IEEE80211_CHAN_NO_IR |
121876bed0f4SJanusz.Dziedzic@tieto.com 						  IEEE80211_CHAN_DISABLED))
121976bed0f4SJanusz.Dziedzic@tieto.com 				continue;
122076bed0f4SJanusz.Dziedzic@tieto.com 
122176bed0f4SJanusz.Dziedzic@tieto.com 			local->int_scan_req->channels[n_ch] = channels[i];
122276bed0f4SJanusz.Dziedzic@tieto.com 			n_ch++;
122376bed0f4SJanusz.Dziedzic@tieto.com 		}
122476bed0f4SJanusz.Dziedzic@tieto.com 
122576bed0f4SJanusz.Dziedzic@tieto.com 		if (WARN_ON_ONCE(n_ch == 0))
122634bcf715SStanislaw Gruszka 			goto unlock;
122734bcf715SStanislaw Gruszka 
122876bed0f4SJanusz.Dziedzic@tieto.com 		local->int_scan_req->n_channels = n_ch;
1229be4a4b6aSJohannes Berg 	}
1230be4a4b6aSJohannes Berg 
1231be4a4b6aSJohannes Berg 	local->int_scan_req->ssids = &local->scan_ssid;
1232be4a4b6aSJohannes Berg 	local->int_scan_req->n_ssids = 1;
12335ba63533SJohannes Berg 	memcpy(local->int_scan_req->ssids[0].ssid, ssid, IEEE80211_MAX_SSID_LEN);
12345ba63533SJohannes Berg 	local->int_scan_req->ssids[0].ssid_len = ssid_len;
1235f3b85252SJohannes Berg 
12365ba63533SJohannes Berg 	ret = __ieee80211_start_scan(sdata, sdata->local->int_scan_req);
1237f3b85252SJohannes Berg  unlock:
1238f3b85252SJohannes Berg 	return ret;
12390a51b27eSJohannes Berg }
12405bb644a0SJohannes Berg 
ieee80211_scan_cancel(struct ieee80211_local * local)12415bb644a0SJohannes Berg void ieee80211_scan_cancel(struct ieee80211_local *local)
12425bb644a0SJohannes Berg {
12430fd3af61SJohannes Berg 	/* ensure a new scan cannot be queued */
12440fd3af61SJohannes Berg 	lockdep_assert_wiphy(local->hw.wiphy);
12450fd3af61SJohannes Berg 
12465bb644a0SJohannes Berg 	/*
1247b856439bSEliad Peller 	 * We are canceling software scan, or deferred scan that was not
12484136c422SStanislaw Gruszka 	 * yet really started (see __ieee80211_start_scan ).
12494136c422SStanislaw Gruszka 	 *
12504136c422SStanislaw Gruszka 	 * Regarding hardware scan:
12514136c422SStanislaw Gruszka 	 * - we can not call  __ieee80211_scan_completed() as when
12524136c422SStanislaw Gruszka 	 *   SCAN_HW_SCANNING bit is set this function change
12534136c422SStanislaw Gruszka 	 *   local->hw_scan_req to operate on 5G band, what race with
12544136c422SStanislaw Gruszka 	 *   driver which can use local->hw_scan_req
12554136c422SStanislaw Gruszka 	 *
12564136c422SStanislaw Gruszka 	 * - we can not cancel scan_work since driver can schedule it
12574136c422SStanislaw Gruszka 	 *   by ieee80211_scan_completed(..., true) to finish scan
12584136c422SStanislaw Gruszka 	 *
1259b856439bSEliad Peller 	 * Hence we only call the cancel_hw_scan() callback, but the low-level
1260b856439bSEliad Peller 	 * driver is still responsible for calling ieee80211_scan_completed()
1261b856439bSEliad Peller 	 * after the scan was completed/aborted.
12625bb644a0SJohannes Berg 	 */
12634136c422SStanislaw Gruszka 
1264b856439bSEliad Peller 	if (!local->scan_req)
12650cd8080eSJohannes Berg 		return;
1266b856439bSEliad Peller 
1267a754055aSEmmanuel Grumbach 	/*
1268a754055aSEmmanuel Grumbach 	 * We have a scan running and the driver already reported completion,
1269a754055aSEmmanuel Grumbach 	 * but the worker hasn't run yet or is stuck on the mutex - mark it as
1270a754055aSEmmanuel Grumbach 	 * cancelled.
1271a754055aSEmmanuel Grumbach 	 */
1272a754055aSEmmanuel Grumbach 	if (test_bit(SCAN_HW_SCANNING, &local->scanning) &&
1273a754055aSEmmanuel Grumbach 	    test_bit(SCAN_COMPLETED, &local->scanning)) {
1274a754055aSEmmanuel Grumbach 		set_bit(SCAN_HW_CANCELLED, &local->scanning);
12750cd8080eSJohannes Berg 		return;
1276a754055aSEmmanuel Grumbach 	}
1277a754055aSEmmanuel Grumbach 
1278b856439bSEliad Peller 	if (test_bit(SCAN_HW_SCANNING, &local->scanning)) {
1279a754055aSEmmanuel Grumbach 		/*
1280a754055aSEmmanuel Grumbach 		 * Make sure that __ieee80211_scan_completed doesn't trigger a
1281a754055aSEmmanuel Grumbach 		 * scan on another band.
1282a754055aSEmmanuel Grumbach 		 */
1283a754055aSEmmanuel Grumbach 		set_bit(SCAN_HW_CANCELLED, &local->scanning);
1284b856439bSEliad Peller 		if (local->ops->cancel_hw_scan)
1285e2fd5dbcSJohannes Berg 			drv_cancel_hw_scan(local,
1286e2fd5dbcSJohannes Berg 				rcu_dereference_protected(local->scan_sdata,
12870cd8080eSJohannes Berg 						lockdep_is_held(&local->hw.wiphy->mtx)));
12880cd8080eSJohannes Berg 		return;
1289b856439bSEliad Peller 	}
1290b856439bSEliad Peller 
129120171251SJohannes Berg 	wiphy_delayed_work_cancel(local->hw.wiphy, &local->scan_work);
1292d07bfd8bSJohannes Berg 	/* and clean up */
12937947d3e0SAvraham Stern 	memset(&local->scan_info, 0, sizeof(local->scan_info));
12948bd2a248SEliad Peller 	__ieee80211_scan_completed(&local->hw, true);
12955bb644a0SJohannes Berg }
129679f460caSLuciano Coelho 
__ieee80211_request_sched_scan_start(struct ieee80211_sub_if_data * sdata,struct cfg80211_sched_scan_request * req)1297d43c6b6eSDavid Spinadel int __ieee80211_request_sched_scan_start(struct ieee80211_sub_if_data *sdata,
129879f460caSLuciano Coelho 					struct cfg80211_sched_scan_request *req)
129979f460caSLuciano Coelho {
130079f460caSLuciano Coelho 	struct ieee80211_local *local = sdata->local;
1301633e2713SDavid Spinadel 	struct ieee80211_scan_ies sched_scan_ies = {};
13022103dec1SSimon Wunderlich 	struct cfg80211_chan_def chandef;
1303633e2713SDavid Spinadel 	int ret, i, iebufsz, num_bands = 0;
130457fbcce3SJohannes Berg 	u32 rate_masks[NUM_NL80211_BANDS] = {};
1305633e2713SDavid Spinadel 	u8 bands_used = 0;
1306633e2713SDavid Spinadel 	u8 *ie;
1307b9771d41SJohannes Berg 	u32 flags = 0;
1308c604b9f2SJohannes Berg 
13090cd8080eSJohannes Berg 	lockdep_assert_wiphy(local->hw.wiphy);
131079f460caSLuciano Coelho 
13110cd8080eSJohannes Berg 	iebufsz = local->scan_ies_len + req->ie_len;
131279f460caSLuciano Coelho 
1313d43c6b6eSDavid Spinadel 	if (!local->ops->sched_scan_start)
13140528e0fdSAndrei Otcheretianski 		return -EOPNOTSUPP;
131579f460caSLuciano Coelho 
131657fbcce3SJohannes Berg 	for (i = 0; i < NUM_NL80211_BANDS; i++) {
1317633e2713SDavid Spinadel 		if (local->hw.wiphy->bands[i]) {
1318633e2713SDavid Spinadel 			bands_used |= BIT(i);
1319633e2713SDavid Spinadel 			rate_masks[i] = (u32) -1;
1320633e2713SDavid Spinadel 			num_bands++;
1321633e2713SDavid Spinadel 		}
1322633e2713SDavid Spinadel 	}
1323c56ef672SDavid Spinadel 
1324b9771d41SJohannes Berg 	if (req->flags & NL80211_SCAN_FLAG_MIN_PREQ_CONTENT)
1325b9771d41SJohannes Berg 		flags |= IEEE80211_PROBE_FLAG_MIN_CONTENT;
1326b9771d41SJohannes Berg 
13276396bb22SKees Cook 	ie = kcalloc(iebufsz, num_bands, GFP_KERNEL);
1328633e2713SDavid Spinadel 	if (!ie) {
132979f460caSLuciano Coelho 		ret = -ENOMEM;
1330633e2713SDavid Spinadel 		goto out;
133179f460caSLuciano Coelho 	}
133279f460caSLuciano Coelho 
13335add321cSJohannes Berg 	ieee80211_prepare_scan_chandef(&chandef);
13342103dec1SSimon Wunderlich 
133507095d16SJohannes Berg 	ret = ieee80211_build_preq_ies(sdata, ie, num_bands * iebufsz,
1336633e2713SDavid Spinadel 				       &sched_scan_ies, req->ie,
133707095d16SJohannes Berg 				       req->ie_len, bands_used, rate_masks,
133807095d16SJohannes Berg 				       &chandef, flags);
133907095d16SJohannes Berg 	if (ret < 0)
134007095d16SJohannes Berg 		goto error;
134179f460caSLuciano Coelho 
134230dd3edfSJohannes Berg 	ret = drv_sched_scan_start(local, sdata, req, &sched_scan_ies);
1343d43c6b6eSDavid Spinadel 	if (ret == 0) {
13445260a5b2SJohannes Berg 		rcu_assign_pointer(local->sched_scan_sdata, sdata);
13456ea0a69cSJohannes Berg 		rcu_assign_pointer(local->sched_scan_req, req);
1346d43c6b6eSDavid Spinadel 	}
134779f460caSLuciano Coelho 
134807095d16SJohannes Berg error:
1349633e2713SDavid Spinadel 	kfree(ie);
1350633e2713SDavid Spinadel out:
1351d43c6b6eSDavid Spinadel 	if (ret) {
1352d43c6b6eSDavid Spinadel 		/* Clean in case of failure after HW restart or upon resume. */
13530c2bef46SMonam Agarwal 		RCU_INIT_POINTER(local->sched_scan_sdata, NULL);
13546ea0a69cSJohannes Berg 		RCU_INIT_POINTER(local->sched_scan_req, NULL);
1355d43c6b6eSDavid Spinadel 	}
1356d43c6b6eSDavid Spinadel 
1357d43c6b6eSDavid Spinadel 	return ret;
1358d43c6b6eSDavid Spinadel }
1359d43c6b6eSDavid Spinadel 
ieee80211_request_sched_scan_start(struct ieee80211_sub_if_data * sdata,struct cfg80211_sched_scan_request * req)1360d43c6b6eSDavid Spinadel int ieee80211_request_sched_scan_start(struct ieee80211_sub_if_data *sdata,
1361d43c6b6eSDavid Spinadel 				       struct cfg80211_sched_scan_request *req)
1362d43c6b6eSDavid Spinadel {
1363d43c6b6eSDavid Spinadel 	struct ieee80211_local *local = sdata->local;
1364d43c6b6eSDavid Spinadel 
13650cd8080eSJohannes Berg 	lockdep_assert_wiphy(local->hw.wiphy);
1366d43c6b6eSDavid Spinadel 
13670cd8080eSJohannes Berg 	if (rcu_access_pointer(local->sched_scan_sdata))
1368d43c6b6eSDavid Spinadel 		return -EBUSY;
1369d43c6b6eSDavid Spinadel 
13700cd8080eSJohannes Berg 	return __ieee80211_request_sched_scan_start(sdata, req);
137179f460caSLuciano Coelho }
137279f460caSLuciano Coelho 
ieee80211_request_sched_scan_stop(struct ieee80211_local * local)13730d440ea2SEliad Peller int ieee80211_request_sched_scan_stop(struct ieee80211_local *local)
137479f460caSLuciano Coelho {
13750d440ea2SEliad Peller 	struct ieee80211_sub_if_data *sched_scan_sdata;
13760d440ea2SEliad Peller 	int ret = -ENOENT;
137779f460caSLuciano Coelho 
13780cd8080eSJohannes Berg 	lockdep_assert_wiphy(local->hw.wiphy);
137979f460caSLuciano Coelho 
13800cd8080eSJohannes Berg 	if (!local->ops->sched_scan_stop)
13810528e0fdSAndrei Otcheretianski 		return -EOPNOTSUPP;
138279f460caSLuciano Coelho 
1383d43c6b6eSDavid Spinadel 	/* We don't want to restart sched scan anymore. */
13846ea0a69cSJohannes Berg 	RCU_INIT_POINTER(local->sched_scan_req, NULL);
1385d43c6b6eSDavid Spinadel 
13860d440ea2SEliad Peller 	sched_scan_sdata = rcu_dereference_protected(local->sched_scan_sdata,
13870cd8080eSJohannes Berg 						lockdep_is_held(&local->hw.wiphy->mtx));
13880d440ea2SEliad Peller 	if (sched_scan_sdata) {
13890d440ea2SEliad Peller 		ret = drv_sched_scan_stop(local, sched_scan_sdata);
139071228a1eSAlexander Bondar 		if (!ret)
1391ad053a96SAndreea-Cristina Bernat 			RCU_INIT_POINTER(local->sched_scan_sdata, NULL);
139271228a1eSAlexander Bondar 	}
139379f460caSLuciano Coelho 
139479f460caSLuciano Coelho 	return ret;
139579f460caSLuciano Coelho }
139679f460caSLuciano Coelho 
ieee80211_sched_scan_results(struct ieee80211_hw * hw)139779f460caSLuciano Coelho void ieee80211_sched_scan_results(struct ieee80211_hw *hw)
139879f460caSLuciano Coelho {
139979f460caSLuciano Coelho 	struct ieee80211_local *local = hw_to_local(hw);
140079f460caSLuciano Coelho 
140179f460caSLuciano Coelho 	trace_api_sched_scan_results(local);
140279f460caSLuciano Coelho 
1403b34939b9SArend Van Spriel 	cfg80211_sched_scan_results(hw->wiphy, 0);
140479f460caSLuciano Coelho }
140579f460caSLuciano Coelho EXPORT_SYMBOL(ieee80211_sched_scan_results);
140679f460caSLuciano Coelho 
ieee80211_sched_scan_end(struct ieee80211_local * local)1407f6837ba8SJohannes Berg void ieee80211_sched_scan_end(struct ieee80211_local *local)
140885a9994aSLuciano Coelho {
14090cd8080eSJohannes Berg 	lockdep_assert_wiphy(local->hw.wiphy);
141085a9994aSLuciano Coelho 
14110cd8080eSJohannes Berg 	if (!rcu_access_pointer(local->sched_scan_sdata))
141285a9994aSLuciano Coelho 		return;
141385a9994aSLuciano Coelho 
14140c2bef46SMonam Agarwal 	RCU_INIT_POINTER(local->sched_scan_sdata, NULL);
141585a9994aSLuciano Coelho 
1416d43c6b6eSDavid Spinadel 	/* If sched scan was aborted by the driver. */
14176ea0a69cSJohannes Berg 	RCU_INIT_POINTER(local->sched_scan_req, NULL);
1418d43c6b6eSDavid Spinadel 
1419eadfb547SJohannes Berg 	cfg80211_sched_scan_stopped_locked(local->hw.wiphy, 0);
142085a9994aSLuciano Coelho }
142185a9994aSLuciano Coelho 
ieee80211_sched_scan_stopped_work(struct wiphy * wiphy,struct wiphy_work * work)1422eadfb547SJohannes Berg void ieee80211_sched_scan_stopped_work(struct wiphy *wiphy,
1423eadfb547SJohannes Berg 				       struct wiphy_work *work)
1424f6837ba8SJohannes Berg {
1425f6837ba8SJohannes Berg 	struct ieee80211_local *local =
1426f6837ba8SJohannes Berg 		container_of(work, struct ieee80211_local,
1427f6837ba8SJohannes Berg 			     sched_scan_stopped_work);
1428f6837ba8SJohannes Berg 
1429f6837ba8SJohannes Berg 	ieee80211_sched_scan_end(local);
1430f6837ba8SJohannes Berg }
1431f6837ba8SJohannes Berg 
ieee80211_sched_scan_stopped(struct ieee80211_hw * hw)143279f460caSLuciano Coelho void ieee80211_sched_scan_stopped(struct ieee80211_hw *hw)
143379f460caSLuciano Coelho {
143479f460caSLuciano Coelho 	struct ieee80211_local *local = hw_to_local(hw);
143579f460caSLuciano Coelho 
143679f460caSLuciano Coelho 	trace_api_sched_scan_stopped(local);
143779f460caSLuciano Coelho 
14382bc533bdSEliad Peller 	/*
14392bc533bdSEliad Peller 	 * this shouldn't really happen, so for simplicity
14402bc533bdSEliad Peller 	 * simply ignore it, and let mac80211 reconfigure
14412bc533bdSEliad Peller 	 * the sched scan later on.
14422bc533bdSEliad Peller 	 */
14432bc533bdSEliad Peller 	if (local->in_reconfig)
14442bc533bdSEliad Peller 		return;
14452bc533bdSEliad Peller 
1446eadfb547SJohannes Berg 	wiphy_work_queue(hw->wiphy, &local->sched_scan_stopped_work);
144779f460caSLuciano Coelho }
144879f460caSLuciano Coelho EXPORT_SYMBOL(ieee80211_sched_scan_stopped);
1449