xref: /openbmc/linux/net/mac80211/scan.c (revision 24f68eb5bf14a74027946970a18bc902e19d986a)
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
12c9da889aSJohannes 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.scan_width = NL80211_BSS_CHAN_WIDTH_20;
191da6a4352SJohannes Berg 	if (rx_status->bw == RATE_INFO_BW_5)
19261f6bba0SJohannes Berg 		bss_meta.scan_width = NL80211_BSS_CHAN_WIDTH_5;
193da6a4352SJohannes Berg 	else if (rx_status->bw == RATE_INFO_BW_10)
19461f6bba0SJohannes Berg 		bss_meta.scan_width = NL80211_BSS_CHAN_WIDTH_10;
1957ca15a0aSSimon Wunderlich 
19661f6bba0SJohannes Berg 	bss_meta.chan = channel;
1977947d3e0SAvraham Stern 
1987947d3e0SAvraham Stern 	rcu_read_lock();
1997947d3e0SAvraham Stern 	scan_sdata = rcu_dereference(local->scan_sdata);
2007947d3e0SAvraham Stern 	if (scan_sdata && scan_sdata->vif.type == NL80211_IFTYPE_STATION &&
201f276e20bSJohannes Berg 	    scan_sdata->vif.cfg.assoc &&
2027947d3e0SAvraham Stern 	    ieee80211_have_rx_timestamp(rx_status)) {
2037947d3e0SAvraham Stern 		bss_meta.parent_tsf =
2047947d3e0SAvraham Stern 			ieee80211_calculate_rx_timestamp(local, rx_status,
2057947d3e0SAvraham Stern 							 len + FCS_LEN, 24);
2067947d3e0SAvraham Stern 		ether_addr_copy(bss_meta.parent_bssid,
2077947d3e0SAvraham Stern 				scan_sdata->vif.bss_conf.bssid);
2087947d3e0SAvraham Stern 	}
2097947d3e0SAvraham Stern 	rcu_read_unlock();
2107947d3e0SAvraham Stern 
21161f6bba0SJohannes Berg 	cbss = cfg80211_inform_bss_frame_data(local->hw.wiphy, &bss_meta,
21261f6bba0SJohannes Berg 					      mgmt, len, GFP_ATOMIC);
2130c1ad2caSJohannes Berg 	if (!cbss)
2145484e237SJohannes Berg 		return NULL;
2154abb52a4SSara Sharon 
21674d803b6SSara Sharon 	/* In case the signal is invalid update the status */
2177bb106ebSEmmanuel Grumbach 	signal_valid = channel == cbss->channel;
21874d803b6SSara Sharon 	if (!signal_valid)
21974d803b6SSara Sharon 		rx_status->flag |= RX_FLAG_NO_SIGNAL_VAL;
22000d3f14cSJohannes Berg 
221108d2022SBenjamin Berg 	return (void *)cbss->priv;
2225484e237SJohannes Berg }
2230a51b27eSJohannes Berg 
ieee80211_scan_accept_presp(struct ieee80211_sub_if_data * sdata,struct ieee80211_channel * channel,u32 scan_flags,const u8 * da)22440b0bd24SRoee Zamir static bool ieee80211_scan_accept_presp(struct ieee80211_sub_if_data *sdata,
225c9da889aSJohannes Berg 					struct ieee80211_channel *channel,
22640b0bd24SRoee Zamir 					u32 scan_flags, const u8 *da)
22740b0bd24SRoee Zamir {
22840b0bd24SRoee Zamir 	if (!sdata)
22940b0bd24SRoee Zamir 		return false;
230c9da889aSJohannes Berg 
231c9da889aSJohannes Berg 	/* accept broadcast on 6 GHz and for OCE */
232c9da889aSJohannes Berg 	if (is_broadcast_ether_addr(da) &&
233c9da889aSJohannes Berg 	    (channel->band == NL80211_BAND_6GHZ ||
234c9da889aSJohannes Berg 	     scan_flags & NL80211_SCAN_FLAG_ACCEPT_BCAST_PROBE_RESP))
23540b0bd24SRoee Zamir 		return true;
236c9da889aSJohannes Berg 
23740b0bd24SRoee Zamir 	if (scan_flags & NL80211_SCAN_FLAG_RANDOM_ADDR)
23840b0bd24SRoee Zamir 		return true;
23940b0bd24SRoee Zamir 	return ether_addr_equal(da, sdata->vif.addr);
24040b0bd24SRoee Zamir }
24140b0bd24SRoee Zamir 
ieee80211_scan_rx(struct ieee80211_local * local,struct sk_buff * skb)242d48b2968SJohannes Berg void ieee80211_scan_rx(struct ieee80211_local *local, struct sk_buff *skb)
24398c8fccfSJohannes Berg {
244f1d58c25SJohannes Berg 	struct ieee80211_rx_status *rx_status = IEEE80211_SKB_RXCB(skb);
245d48b2968SJohannes Berg 	struct ieee80211_sub_if_data *sdata1, *sdata2;
246d48b2968SJohannes Berg 	struct ieee80211_mgmt *mgmt = (void *)skb->data;
247c2b13452SJohannes Berg 	struct ieee80211_bss *bss;
24898c8fccfSJohannes Berg 	struct ieee80211_channel *channel;
249e298aa35SDu Cheng 	size_t min_hdr_len = offsetof(struct ieee80211_mgmt,
250e298aa35SDu Cheng 				      u.probe_resp.variable);
251e298aa35SDu Cheng 
252e298aa35SDu Cheng 	if (!ieee80211_is_probe_resp(mgmt->frame_control) &&
253e298aa35SDu Cheng 	    !ieee80211_is_beacon(mgmt->frame_control) &&
254e298aa35SDu Cheng 	    !ieee80211_is_s1g_beacon(mgmt->frame_control))
255e298aa35SDu Cheng 		return;
25698c8fccfSJohannes Berg 
257cd418ba6SThomas Pedersen 	if (ieee80211_is_s1g_beacon(mgmt->frame_control)) {
258e298aa35SDu Cheng 		if (ieee80211_is_s1g_short_beacon(mgmt->frame_control))
259e298aa35SDu Cheng 			min_hdr_len = offsetof(struct ieee80211_ext,
260e298aa35SDu Cheng 					       u.s1g_short_beacon.variable);
261e298aa35SDu Cheng 		else
262e298aa35SDu Cheng 			min_hdr_len = offsetof(struct ieee80211_ext,
263e298aa35SDu Cheng 					       u.s1g_beacon);
264e298aa35SDu Cheng 	}
265e298aa35SDu Cheng 
266e298aa35SDu Cheng 	if (skb->len < min_hdr_len)
267d48b2968SJohannes Berg 		return;
26898c8fccfSJohannes Berg 
269d48b2968SJohannes Berg 	sdata1 = rcu_dereference(local->scan_sdata);
270d48b2968SJohannes Berg 	sdata2 = rcu_dereference(local->sched_scan_sdata);
27198c8fccfSJohannes Berg 
272d48b2968SJohannes Berg 	if (likely(!sdata1 && !sdata2))
273d48b2968SJohannes Berg 		return;
27498c8fccfSJohannes Berg 
275b041b7b9SFelix Fietkau 	if (test_and_clear_bit(SCAN_BEACON_WAIT, &local->scanning)) {
276b041b7b9SFelix Fietkau 		/*
277b041b7b9SFelix Fietkau 		 * we were passive scanning because of radar/no-IR, but
278b041b7b9SFelix Fietkau 		 * the beacon/proberesp rx gives us an opportunity to upgrade
279b041b7b9SFelix Fietkau 		 * to active scan
280b041b7b9SFelix Fietkau 		 */
281b041b7b9SFelix Fietkau 		set_bit(SCAN_BEACON_DONE, &local->scanning);
282d69c7a4eSJohannes Berg 		wiphy_delayed_work_queue(local->hw.wiphy, &local->scan_work, 0);
283b041b7b9SFelix Fietkau 	}
284b041b7b9SFelix Fietkau 
285c9da889aSJohannes Berg 	channel = ieee80211_get_channel_khz(local->hw.wiphy,
286c9da889aSJohannes Berg 					    ieee80211_rx_status_to_khz(rx_status));
287c9da889aSJohannes Berg 
288c9da889aSJohannes Berg 	if (!channel || channel->flags & IEEE80211_CHAN_DISABLED)
289c9da889aSJohannes Berg 		return;
290c9da889aSJohannes Berg 
291d48b2968SJohannes Berg 	if (ieee80211_is_probe_resp(mgmt->frame_control)) {
292a344d677SJohannes Berg 		struct cfg80211_scan_request *scan_req;
293a344d677SJohannes Berg 		struct cfg80211_sched_scan_request *sched_scan_req;
29440b0bd24SRoee Zamir 		u32 scan_req_flags = 0, sched_scan_req_flags = 0;
295a344d677SJohannes Berg 
296a344d677SJohannes Berg 		scan_req = rcu_dereference(local->scan_req);
297a344d677SJohannes Berg 		sched_scan_req = rcu_dereference(local->sched_scan_req);
298a344d677SJohannes Berg 
29940b0bd24SRoee Zamir 		if (scan_req)
30040b0bd24SRoee Zamir 			scan_req_flags = scan_req->flags;
30140b0bd24SRoee Zamir 
30240b0bd24SRoee Zamir 		if (sched_scan_req)
30340b0bd24SRoee Zamir 			sched_scan_req_flags = sched_scan_req->flags;
30440b0bd24SRoee Zamir 
30540b0bd24SRoee Zamir 		/* ignore ProbeResp to foreign address or non-bcast (OCE)
30640b0bd24SRoee Zamir 		 * unless scanning with randomised address
307a344d677SJohannes Berg 		 */
308c9da889aSJohannes Berg 		if (!ieee80211_scan_accept_presp(sdata1, channel,
309c9da889aSJohannes Berg 						 scan_req_flags,
31040b0bd24SRoee Zamir 						 mgmt->da) &&
311c9da889aSJohannes Berg 		    !ieee80211_scan_accept_presp(sdata2, channel,
312c9da889aSJohannes Berg 						 sched_scan_req_flags,
31340b0bd24SRoee Zamir 						 mgmt->da))
314d48b2968SJohannes Berg 			return;
31598c8fccfSJohannes Berg 	}
31698c8fccfSJohannes Berg 
317d48b2968SJohannes Berg 	bss = ieee80211_bss_info_update(local, rx_status,
3184abb52a4SSara Sharon 					mgmt, skb->len,
319d45c4172SEmmanuel Grumbach 					channel);
320d048e503SJouni Malinen 	if (bss)
321d48b2968SJohannes Berg 		ieee80211_rx_bss_put(local, bss);
32298c8fccfSJohannes Berg }
32398c8fccfSJohannes Berg 
3242103dec1SSimon Wunderlich static void
ieee80211_prepare_scan_chandef(struct cfg80211_chan_def * chandef,enum nl80211_bss_scan_width scan_width)3252103dec1SSimon Wunderlich ieee80211_prepare_scan_chandef(struct cfg80211_chan_def *chandef,
3262103dec1SSimon Wunderlich 			       enum nl80211_bss_scan_width scan_width)
3272103dec1SSimon Wunderlich {
3282103dec1SSimon Wunderlich 	memset(chandef, 0, sizeof(*chandef));
3292103dec1SSimon Wunderlich 	switch (scan_width) {
3302103dec1SSimon Wunderlich 	case NL80211_BSS_CHAN_WIDTH_5:
3312103dec1SSimon Wunderlich 		chandef->width = NL80211_CHAN_WIDTH_5;
3322103dec1SSimon Wunderlich 		break;
3332103dec1SSimon Wunderlich 	case NL80211_BSS_CHAN_WIDTH_10:
3342103dec1SSimon Wunderlich 		chandef->width = NL80211_CHAN_WIDTH_10;
3352103dec1SSimon Wunderlich 		break;
3362103dec1SSimon Wunderlich 	default:
3372103dec1SSimon Wunderlich 		chandef->width = NL80211_CHAN_WIDTH_20_NOHT;
3382103dec1SSimon Wunderlich 		break;
3392103dec1SSimon Wunderlich 	}
3402103dec1SSimon Wunderlich }
3412103dec1SSimon Wunderlich 
3424d36ec58SJohannes Berg /* return false if no more work */
ieee80211_prep_hw_scan(struct ieee80211_sub_if_data * sdata)3432ad2274cSIlan Peer static bool ieee80211_prep_hw_scan(struct ieee80211_sub_if_data *sdata)
3444d36ec58SJohannes Berg {
3452ad2274cSIlan Peer 	struct ieee80211_local *local = sdata->local;
3466ea0a69cSJohannes Berg 	struct cfg80211_scan_request *req;
3472103dec1SSimon Wunderlich 	struct cfg80211_chan_def chandef;
348c56ef672SDavid Spinadel 	u8 bands_used = 0;
34926b177ecSKenton Groombridge 	int i, ielen;
35026b177ecSKenton Groombridge 	u32 *n_chans;
351b9771d41SJohannes Berg 	u32 flags = 0;
3524d36ec58SJohannes Berg 
3536ea0a69cSJohannes Berg 	req = rcu_dereference_protected(local->scan_req,
3546ea0a69cSJohannes Berg 					lockdep_is_held(&local->mtx));
3556ea0a69cSJohannes Berg 
356a754055aSEmmanuel Grumbach 	if (test_bit(SCAN_HW_CANCELLED, &local->scanning))
357a754055aSEmmanuel Grumbach 		return false;
358a754055aSEmmanuel Grumbach 
35930686bf7SJohannes Berg 	if (ieee80211_hw_check(&local->hw, SINGLE_SCAN_ON_ALL_BANDS)) {
36026b177ecSKenton Groombridge 		local->hw_scan_req->req.n_channels = req->n_channels;
36126b177ecSKenton Groombridge 
362c56ef672SDavid Spinadel 		for (i = 0; i < req->n_channels; i++) {
363c56ef672SDavid Spinadel 			local->hw_scan_req->req.channels[i] = req->channels[i];
364c56ef672SDavid Spinadel 			bands_used |= BIT(req->channels[i]->band);
365c56ef672SDavid Spinadel 		}
366c56ef672SDavid Spinadel 	} else {
3674d36ec58SJohannes Berg 		do {
36857fbcce3SJohannes Berg 			if (local->hw_scan_band == NUM_NL80211_BANDS)
3694d36ec58SJohannes Berg 				return false;
3704d36ec58SJohannes Berg 
37126b177ecSKenton Groombridge 			n_chans = &local->hw_scan_req->req.n_channels;
37226b177ecSKenton Groombridge 			*n_chans = 0;
373c56ef672SDavid Spinadel 
3744d36ec58SJohannes Berg 			for (i = 0; i < req->n_channels; i++) {
375c56ef672SDavid Spinadel 				if (req->channels[i]->band !=
376c56ef672SDavid Spinadel 				    local->hw_scan_band)
377c56ef672SDavid Spinadel 					continue;
37826b177ecSKenton Groombridge 				local->hw_scan_req->req.channels[(*n_chans)++] =
3794d36ec58SJohannes Berg 							req->channels[i];
38026b177ecSKenton Groombridge 
381c56ef672SDavid Spinadel 				bands_used |= BIT(req->channels[i]->band);
3824d36ec58SJohannes Berg 			}
3834d36ec58SJohannes Berg 
3844d36ec58SJohannes Berg 			local->hw_scan_band++;
38526b177ecSKenton Groombridge 		} while (!*n_chans);
386c56ef672SDavid Spinadel 	}
3874d36ec58SJohannes Berg 
3882103dec1SSimon Wunderlich 	ieee80211_prepare_scan_chandef(&chandef, req->scan_width);
3894d36ec58SJohannes Berg 
390b9771d41SJohannes Berg 	if (req->flags & NL80211_SCAN_FLAG_MIN_PREQ_CONTENT)
391b9771d41SJohannes Berg 		flags |= IEEE80211_PROBE_FLAG_MIN_CONTENT;
392b9771d41SJohannes Berg 
3932ad2274cSIlan Peer 	ielen = ieee80211_build_preq_ies(sdata,
394c56ef672SDavid Spinadel 					 (u8 *)local->hw_scan_req->req.ie,
395c604b9f2SJohannes Berg 					 local->hw_scan_ies_bufsize,
396c56ef672SDavid Spinadel 					 &local->hw_scan_req->ies,
397c56ef672SDavid Spinadel 					 req->ie, req->ie_len,
398b9771d41SJohannes Berg 					 bands_used, req->rates, &chandef,
399b9771d41SJohannes Berg 					 flags);
400c56ef672SDavid Spinadel 	local->hw_scan_req->req.ie_len = ielen;
401c56ef672SDavid Spinadel 	local->hw_scan_req->req.no_cck = req->no_cck;
402a344d677SJohannes Berg 	ether_addr_copy(local->hw_scan_req->req.mac_addr, req->mac_addr);
403a344d677SJohannes Berg 	ether_addr_copy(local->hw_scan_req->req.mac_addr_mask,
404a344d677SJohannes Berg 			req->mac_addr_mask);
405e345f44fSJouni Malinen 	ether_addr_copy(local->hw_scan_req->req.bssid, req->bssid);
4064d36ec58SJohannes Berg 
4074d36ec58SJohannes Berg 	return true;
4084d36ec58SJohannes Berg }
4094d36ec58SJohannes Berg 
__ieee80211_scan_completed(struct ieee80211_hw * hw,bool aborted)4108bd2a248SEliad Peller static void __ieee80211_scan_completed(struct ieee80211_hw *hw, bool aborted)
411f3b85252SJohannes Berg {
412f3b85252SJohannes Berg 	struct ieee80211_local *local = hw_to_local(hw);
413e9da68ddSJohannes Berg 	bool hw_scan = test_bit(SCAN_HW_SCANNING, &local->scanning);
414a2b70e83SEliad Peller 	bool was_scanning = local->scanning;
4156ea0a69cSJohannes Berg 	struct cfg80211_scan_request *scan_req;
416a344d677SJohannes Berg 	struct ieee80211_sub_if_data *scan_sdata;
4174fa11ec7SSachin Kulkarni 	struct ieee80211_sub_if_data *sdata;
418f3b85252SJohannes Berg 
419e229f844SStanislaw Gruszka 	lockdep_assert_held(&local->mtx);
420f3b85252SJohannes Berg 
4216d3560d4SJohannes Berg 	/*
4226d3560d4SJohannes Berg 	 * It's ok to abort a not-yet-running scan (that
4236d3560d4SJohannes Berg 	 * we have one at all will be verified by checking
4246d3560d4SJohannes Berg 	 * local->scan_req next), but not to complete it
4256d3560d4SJohannes Berg 	 * successfully.
4266d3560d4SJohannes Berg 	 */
4276d3560d4SJohannes Berg 	if (WARN_ON(!local->scanning && !aborted))
4286d3560d4SJohannes Berg 		aborted = true;
429f3b85252SJohannes Berg 
430e229f844SStanislaw Gruszka 	if (WARN_ON(!local->scan_req))
431d07bfd8bSJohannes Berg 		return;
432f3b85252SJohannes Berg 
4332ad2274cSIlan Peer 	scan_sdata = rcu_dereference_protected(local->scan_sdata,
4342ad2274cSIlan Peer 					       lockdep_is_held(&local->mtx));
4352ad2274cSIlan Peer 
436c56ef672SDavid Spinadel 	if (hw_scan && !aborted &&
43730686bf7SJohannes Berg 	    !ieee80211_hw_check(&local->hw, SINGLE_SCAN_ON_ALL_BANDS) &&
4382ad2274cSIlan Peer 	    ieee80211_prep_hw_scan(scan_sdata)) {
439e2fd5dbcSJohannes Berg 		int rc;
440e2fd5dbcSJohannes Berg 
441e2fd5dbcSJohannes Berg 		rc = drv_hw_scan(local,
442e2fd5dbcSJohannes Berg 			rcu_dereference_protected(local->scan_sdata,
443e2fd5dbcSJohannes Berg 						  lockdep_is_held(&local->mtx)),
444e2fd5dbcSJohannes Berg 			local->hw_scan_req);
445e2fd5dbcSJohannes Berg 
4466eb11a9aSStanislaw Gruszka 		if (rc == 0)
447d07bfd8bSJohannes Berg 			return;
4487947d3e0SAvraham Stern 
4497d10f6b1SJohannes Berg 		/* HW scan failed and is going to be reported as aborted,
4507d10f6b1SJohannes Berg 		 * so clear old scan info.
4517947d3e0SAvraham Stern 		 */
4527947d3e0SAvraham Stern 		memset(&local->scan_info, 0, sizeof(local->scan_info));
4537d10f6b1SJohannes Berg 		aborted = true;
4544d36ec58SJohannes Berg 	}
4554d36ec58SJohannes Berg 
4564d36ec58SJohannes Berg 	kfree(local->hw_scan_req);
4574d36ec58SJohannes Berg 	local->hw_scan_req = NULL;
458f3b85252SJohannes Berg 
4596ea0a69cSJohannes Berg 	scan_req = rcu_dereference_protected(local->scan_req,
4606ea0a69cSJohannes Berg 					     lockdep_is_held(&local->mtx));
4616ea0a69cSJohannes Berg 
4626ea0a69cSJohannes Berg 	RCU_INIT_POINTER(local->scan_req, NULL);
4630c2bef46SMonam Agarwal 	RCU_INIT_POINTER(local->scan_sdata, NULL);
4642a519311SJohannes Berg 
465fbe9c429SHelmut Schaa 	local->scanning = 0;
4667ca15a0aSSimon Wunderlich 	local->scan_chandef.chan = NULL;
467f3b85252SJohannes Berg 
46860deb9f1SSiddh Raman Pant 	synchronize_rcu();
46960deb9f1SSiddh Raman Pant 
47060deb9f1SSiddh Raman Pant 	if (scan_req != local->int_scan_req) {
47160deb9f1SSiddh Raman Pant 		local->scan_info.aborted = aborted;
47260deb9f1SSiddh Raman Pant 		cfg80211_scan_done(scan_req, &local->scan_info);
47360deb9f1SSiddh Raman Pant 	}
47460deb9f1SSiddh Raman Pant 
47559bdf3b0SBen Greear 	/* Set power back to normal operating levels. */
47659bdf3b0SBen Greear 	ieee80211_hw_config(local, 0);
477b23b025fSBen Greear 
478a033afcaSJohannes Berg 	if (!hw_scan && was_scanning) {
479b23b025fSBen Greear 		ieee80211_configure_filter(local);
480a344d677SJohannes Berg 		drv_sw_scan_complete(local, scan_sdata);
481aacde9eeSStanislaw Gruszka 		ieee80211_offchannel_return(local);
482b23b025fSBen Greear 	}
483b23b025fSBen Greear 
4845cff20e6SJohannes Berg 	ieee80211_recalc_idle(local);
485e229f844SStanislaw Gruszka 
4860a51b27eSJohannes Berg 	ieee80211_mlme_notify_scan_completed(local);
48746900298SJohannes Berg 	ieee80211_ibss_notify_scan_completed(local);
4884fa11ec7SSachin Kulkarni 
4894fa11ec7SSachin Kulkarni 	/* Requeue all the work that might have been ignored while
4904fa11ec7SSachin Kulkarni 	 * the scan was in progress; if there was none this will
4914fa11ec7SSachin Kulkarni 	 * just be a no-op for the particular interface.
4924fa11ec7SSachin Kulkarni 	 */
493*bb9982d7SGreg Kroah-Hartman 	list_for_each_entry_rcu(sdata, &local->interfaces, list) {
4944fa11ec7SSachin Kulkarni 		if (ieee80211_sdata_running(sdata))
49516114496SJohannes Berg 			wiphy_work_queue(sdata->local->hw.wiphy, &sdata->work);
4964fa11ec7SSachin Kulkarni 	}
4974fa11ec7SSachin Kulkarni 
498a2b70e83SEliad Peller 	if (was_scanning)
4992eb278e0SJohannes Berg 		ieee80211_start_next_roc(local);
5000a51b27eSJohannes Berg }
5018789d459SJohannes Berg 
ieee80211_scan_completed(struct ieee80211_hw * hw,struct cfg80211_scan_info * info)5027947d3e0SAvraham Stern void ieee80211_scan_completed(struct ieee80211_hw *hw,
5037947d3e0SAvraham Stern 			      struct cfg80211_scan_info *info)
5048789d459SJohannes Berg {
5058789d459SJohannes Berg 	struct ieee80211_local *local = hw_to_local(hw);
5068789d459SJohannes Berg 
50758bd7f11SJohannes Berg 	trace_api_scan_completed(local, info->aborted);
5088789d459SJohannes Berg 
5098789d459SJohannes Berg 	set_bit(SCAN_COMPLETED, &local->scanning);
5107947d3e0SAvraham Stern 	if (info->aborted)
5118789d459SJohannes Berg 		set_bit(SCAN_ABORTED, &local->scanning);
5127947d3e0SAvraham Stern 
5137947d3e0SAvraham Stern 	memcpy(&local->scan_info, info, sizeof(*info));
5147947d3e0SAvraham Stern 
515d69c7a4eSJohannes Berg 	wiphy_delayed_work_queue(local->hw.wiphy, &local->scan_work, 0);
5168789d459SJohannes Berg }
5170a51b27eSJohannes Berg EXPORT_SYMBOL(ieee80211_scan_completed);
5180a51b27eSJohannes Berg 
ieee80211_start_sw_scan(struct ieee80211_local * local,struct ieee80211_sub_if_data * sdata)519a344d677SJohannes Berg static int ieee80211_start_sw_scan(struct ieee80211_local *local,
520a344d677SJohannes Berg 				   struct ieee80211_sub_if_data *sdata)
521f3b85252SJohannes Berg {
522fe57d9f5SJohannes Berg 	/* Software scan is not supported in multi-channel cases */
523fe57d9f5SJohannes Berg 	if (local->use_chanctx)
524fe57d9f5SJohannes Berg 		return -EOPNOTSUPP;
525fe57d9f5SJohannes Berg 
526f3b85252SJohannes Berg 	/*
527f3b85252SJohannes Berg 	 * Hardware/driver doesn't support hw_scan, so use software
528f3b85252SJohannes Berg 	 * scanning instead. First send a nullfunc frame with power save
529f3b85252SJohannes Berg 	 * bit on so that AP will buffer the frames for us while we are not
530f3b85252SJohannes Berg 	 * listening, then send probe requests to each channel and wait for
531f3b85252SJohannes Berg 	 * the responses. After all channels are scanned, tune back to the
532f3b85252SJohannes Berg 	 * original channel and send a nullfunc frame with power save bit
533f3b85252SJohannes Berg 	 * off to trigger the AP to send us all the buffered frames.
534f3b85252SJohannes Berg 	 *
535f3b85252SJohannes Berg 	 * Note that while local->sw_scanning is true everything else but
536f3b85252SJohannes Berg 	 * nullfunc frames and probe requests will be dropped in
537f3b85252SJohannes Berg 	 * ieee80211_tx_h_check_assoc().
538f3b85252SJohannes Berg 	 */
539a344d677SJohannes Berg 	drv_sw_scan_start(local, sdata, local->scan_addr);
540f3b85252SJohannes Berg 
541de312db3SRajkumar Manoharan 	local->leave_oper_channel_time = jiffies;
542977923b0SHelmut Schaa 	local->next_scan_state = SCAN_DECISION;
543f3b85252SJohannes Berg 	local->scan_channel_idx = 0;
544f3b85252SJohannes Berg 
545aacde9eeSStanislaw Gruszka 	ieee80211_offchannel_stop_vifs(local);
546a80f7c0bSJohannes Berg 
5479c35d7d2SSeth Forshee 	/* ensure nullfunc is transmitted before leaving operating channel */
5483b24f4c6SEmmanuel Grumbach 	ieee80211_flush_queues(local, NULL, false);
5499c35d7d2SSeth Forshee 
5503ac64beeSJohannes Berg 	ieee80211_configure_filter(local);
551f3b85252SJohannes Berg 
55259bdf3b0SBen Greear 	/* We need to set power level at maximum rate for scanning. */
55359bdf3b0SBen Greear 	ieee80211_hw_config(local, 0);
55459bdf3b0SBen Greear 
555d69c7a4eSJohannes Berg 	wiphy_delayed_work_queue(local->hw.wiphy, &local->scan_work, 0);
556f3b85252SJohannes Berg 
557f3b85252SJohannes Berg 	return 0;
558f3b85252SJohannes Berg }
559f3b85252SJohannes Berg 
__ieee80211_can_leave_ch(struct ieee80211_sub_if_data * sdata)560dc0c18edSAaron Komisar static bool __ieee80211_can_leave_ch(struct ieee80211_sub_if_data *sdata)
561dc0c18edSAaron Komisar {
562dc0c18edSAaron Komisar 	struct ieee80211_local *local = sdata->local;
563dc0c18edSAaron Komisar 	struct ieee80211_sub_if_data *sdata_iter;
564dc0c18edSAaron Komisar 
565dc0c18edSAaron Komisar 	if (!ieee80211_is_radar_required(local))
566dc0c18edSAaron Komisar 		return true;
567dc0c18edSAaron Komisar 
568dc0c18edSAaron Komisar 	if (!regulatory_pre_cac_allowed(local->hw.wiphy))
569dc0c18edSAaron Komisar 		return false;
570dc0c18edSAaron Komisar 
571dc0c18edSAaron Komisar 	mutex_lock(&local->iflist_mtx);
572dc0c18edSAaron Komisar 	list_for_each_entry(sdata_iter, &local->interfaces, list) {
573dc0c18edSAaron Komisar 		if (sdata_iter->wdev.cac_started) {
574dc0c18edSAaron Komisar 			mutex_unlock(&local->iflist_mtx);
575dc0c18edSAaron Komisar 			return false;
576dc0c18edSAaron Komisar 		}
577dc0c18edSAaron Komisar 	}
578dc0c18edSAaron Komisar 	mutex_unlock(&local->iflist_mtx);
579dc0c18edSAaron Komisar 
580dc0c18edSAaron Komisar 	return true;
581dc0c18edSAaron Komisar }
582dc0c18edSAaron Komisar 
ieee80211_can_scan(struct ieee80211_local * local,struct ieee80211_sub_if_data * sdata)583133d40f9SStanislaw Gruszka static bool ieee80211_can_scan(struct ieee80211_local *local,
584133d40f9SStanislaw Gruszka 			       struct ieee80211_sub_if_data *sdata)
585133d40f9SStanislaw Gruszka {
586dc0c18edSAaron Komisar 	if (!__ieee80211_can_leave_ch(sdata))
587164eb02dSSimon Wunderlich 		return false;
588164eb02dSSimon Wunderlich 
5892eb278e0SJohannes Berg 	if (!list_empty(&local->roc_list))
590133d40f9SStanislaw Gruszka 		return false;
591133d40f9SStanislaw Gruszka 
592133d40f9SStanislaw Gruszka 	if (sdata->vif.type == NL80211_IFTYPE_STATION &&
593392b9ffbSStanislaw Gruszka 	    sdata->u.mgd.flags & IEEE80211_STA_CONNECTION_POLL)
594133d40f9SStanislaw Gruszka 		return false;
595133d40f9SStanislaw Gruszka 
596133d40f9SStanislaw Gruszka 	return true;
597133d40f9SStanislaw Gruszka }
598133d40f9SStanislaw Gruszka 
ieee80211_run_deferred_scan(struct ieee80211_local * local)599133d40f9SStanislaw Gruszka void ieee80211_run_deferred_scan(struct ieee80211_local *local)
600133d40f9SStanislaw Gruszka {
601133d40f9SStanislaw Gruszka 	lockdep_assert_held(&local->mtx);
602133d40f9SStanislaw Gruszka 
603133d40f9SStanislaw Gruszka 	if (!local->scan_req || local->scanning)
604133d40f9SStanislaw Gruszka 		return;
605133d40f9SStanislaw Gruszka 
606e2fd5dbcSJohannes Berg 	if (!ieee80211_can_scan(local,
607e2fd5dbcSJohannes Berg 				rcu_dereference_protected(
608e2fd5dbcSJohannes Berg 					local->scan_sdata,
609e2fd5dbcSJohannes Berg 					lockdep_is_held(&local->mtx))))
610133d40f9SStanislaw Gruszka 		return;
611133d40f9SStanislaw Gruszka 
612d69c7a4eSJohannes Berg 	wiphy_delayed_work_queue(local->hw.wiphy, &local->scan_work,
613133d40f9SStanislaw Gruszka 				 round_jiffies_relative(0));
614133d40f9SStanislaw Gruszka }
615f3b85252SJohannes 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)61645ad6834SJohannes Berg static void ieee80211_send_scan_probe_req(struct ieee80211_sub_if_data *sdata,
61745ad6834SJohannes Berg 					  const u8 *src, const u8 *dst,
61845ad6834SJohannes Berg 					  const u8 *ssid, size_t ssid_len,
61945ad6834SJohannes Berg 					  const u8 *ie, size_t ie_len,
62045ad6834SJohannes Berg 					  u32 ratemask, u32 flags, u32 tx_flags,
62145ad6834SJohannes Berg 					  struct ieee80211_channel *channel)
62245ad6834SJohannes Berg {
62345ad6834SJohannes Berg 	struct sk_buff *skb;
62445ad6834SJohannes Berg 
62545ad6834SJohannes Berg 	skb = ieee80211_build_probe_req(sdata, src, dst, ratemask, channel,
62645ad6834SJohannes Berg 					ssid, ssid_len,
62745ad6834SJohannes Berg 					ie, ie_len, flags);
628b9771d41SJohannes Berg 
62945ad6834SJohannes Berg 	if (skb) {
630b9771d41SJohannes Berg 		if (flags & IEEE80211_PROBE_FLAG_RANDOM_SN) {
631b9771d41SJohannes Berg 			struct ieee80211_hdr *hdr = (void *)skb->data;
6322b3dab13SMathy Vanhoef 			struct ieee80211_tx_info *info = IEEE80211_SKB_CB(skb);
6337e3cf084SJason A. Donenfeld 			u16 sn = get_random_u16();
634b9771d41SJohannes Berg 
6352b3dab13SMathy Vanhoef 			info->control.flags |= IEEE80211_TX_CTRL_NO_SEQNO;
636b9771d41SJohannes Berg 			hdr->seq_ctrl =
637b9771d41SJohannes Berg 				cpu_to_le16(IEEE80211_SN_TO_SEQ(sn));
638b9771d41SJohannes Berg 		}
63945ad6834SJohannes Berg 		IEEE80211_SKB_CB(skb)->flags |= tx_flags;
640d54455a3SPing-Ke Shih 		IEEE80211_SKB_CB(skb)->control.flags |= IEEE80211_TX_CTRL_DONT_USE_RATE_MASK;
64108aca29aSMathy Vanhoef 		ieee80211_tx_skb_tid_band(sdata, skb, 7, channel->band);
64245ad6834SJohannes Berg 	}
64345ad6834SJohannes Berg }
64445ad6834SJohannes Berg 
ieee80211_scan_state_send_probe(struct ieee80211_local * local,unsigned long * next_delay)6458a690674SBen Greear static void ieee80211_scan_state_send_probe(struct ieee80211_local *local,
6468a690674SBen Greear 					    unsigned long *next_delay)
6478a690674SBen Greear {
6488a690674SBen Greear 	int i;
649e2fd5dbcSJohannes Berg 	struct ieee80211_sub_if_data *sdata;
6506ea0a69cSJohannes Berg 	struct cfg80211_scan_request *scan_req;
65157fbcce3SJohannes Berg 	enum nl80211_band band = local->hw.conf.chandef.chan->band;
652b9771d41SJohannes Berg 	u32 flags = 0, tx_flags;
6536c17b77bSSeth Forshee 
6546ea0a69cSJohannes Berg 	scan_req = rcu_dereference_protected(local->scan_req,
6556ea0a69cSJohannes Berg 					     lockdep_is_held(&local->mtx));
6566ea0a69cSJohannes Berg 
6576c17b77bSSeth Forshee 	tx_flags = IEEE80211_TX_INTFL_OFFCHAN_TX_OK;
6586ea0a69cSJohannes Berg 	if (scan_req->no_cck)
6596c17b77bSSeth Forshee 		tx_flags |= IEEE80211_TX_CTL_NO_CCK_RATE;
660b9771d41SJohannes Berg 	if (scan_req->flags & NL80211_SCAN_FLAG_MIN_PREQ_CONTENT)
661b9771d41SJohannes Berg 		flags |= IEEE80211_PROBE_FLAG_MIN_CONTENT;
662b9771d41SJohannes Berg 	if (scan_req->flags & NL80211_SCAN_FLAG_RANDOM_SN)
663b9771d41SJohannes Berg 		flags |= IEEE80211_PROBE_FLAG_RANDOM_SN;
6648a690674SBen Greear 
665e2fd5dbcSJohannes Berg 	sdata = rcu_dereference_protected(local->scan_sdata,
666316b6b5dSPeter Senna Tschudin 					  lockdep_is_held(&local->mtx));
667e2fd5dbcSJohannes Berg 
6686ea0a69cSJohannes Berg 	for (i = 0; i < scan_req->n_ssids; i++)
66945ad6834SJohannes Berg 		ieee80211_send_scan_probe_req(
670e345f44fSJouni Malinen 			sdata, local->scan_addr, scan_req->bssid,
6716ea0a69cSJohannes Berg 			scan_req->ssids[i].ssid, scan_req->ssids[i].ssid_len,
6726ea0a69cSJohannes Berg 			scan_req->ie, scan_req->ie_len,
673b9771d41SJohannes Berg 			scan_req->rates[band], flags,
67445ad6834SJohannes Berg 			tx_flags, local->hw.conf.chandef.chan);
6758a690674SBen Greear 
6768a690674SBen Greear 	/*
6778a690674SBen Greear 	 * After sending probe requests, wait for probe responses
6788a690674SBen Greear 	 * on the channel.
6798a690674SBen Greear 	 */
6808a690674SBen Greear 	*next_delay = IEEE80211_CHANNEL_TIME;
6818a690674SBen Greear 	local->next_scan_state = SCAN_DECISION;
6828a690674SBen Greear }
6838a690674SBen Greear 
__ieee80211_start_scan(struct ieee80211_sub_if_data * sdata,struct cfg80211_scan_request * req)684f3b85252SJohannes Berg static int __ieee80211_start_scan(struct ieee80211_sub_if_data *sdata,
685f3b85252SJohannes Berg 				  struct cfg80211_scan_request *req)
686f3b85252SJohannes Berg {
687f3b85252SJohannes Berg 	struct ieee80211_local *local = sdata->local;
688e9da68ddSJohannes Berg 	bool hw_scan = local->ops->hw_scan;
689f3b85252SJohannes Berg 	int rc;
690f3b85252SJohannes Berg 
691e229f844SStanislaw Gruszka 	lockdep_assert_held(&local->mtx);
692e229f844SStanislaw Gruszka 
693dc0c18edSAaron Komisar 	if (local->scan_req)
694dc0c18edSAaron Komisar 		return -EBUSY;
695dc0c18edSAaron Komisar 
696dc0c18edSAaron Komisar 	if (!__ieee80211_can_leave_ch(sdata))
697f3b85252SJohannes Berg 		return -EBUSY;
698f3b85252SJohannes Berg 
699133d40f9SStanislaw Gruszka 	if (!ieee80211_can_scan(local, sdata)) {
7006e7e6213SJohn W. Linville 		/* wait for the work to finish/time out */
7016ea0a69cSJohannes Berg 		rcu_assign_pointer(local->scan_req, req);
702e2fd5dbcSJohannes Berg 		rcu_assign_pointer(local->scan_sdata, sdata);
703c0ce77b8SJohannes Berg 		return 0;
704c0ce77b8SJohannes Berg 	}
705c0ce77b8SJohannes Berg 
706e9da68ddSJohannes Berg  again:
707e9da68ddSJohannes Berg 	if (hw_scan) {
708f3b85252SJohannes Berg 		u8 *ies;
709f3b85252SJohannes Berg 
710e4dcbb37SDavid Spinadel 		local->hw_scan_ies_bufsize = local->scan_ies_len + req->ie_len;
711c56ef672SDavid Spinadel 
71230686bf7SJohannes Berg 		if (ieee80211_hw_check(&local->hw, SINGLE_SCAN_ON_ALL_BANDS)) {
713c56ef672SDavid Spinadel 			int i, n_bands = 0;
714c56ef672SDavid Spinadel 			u8 bands_counted = 0;
715c56ef672SDavid Spinadel 
716c56ef672SDavid Spinadel 			for (i = 0; i < req->n_channels; i++) {
717c56ef672SDavid Spinadel 				if (bands_counted & BIT(req->channels[i]->band))
718c56ef672SDavid Spinadel 					continue;
719c56ef672SDavid Spinadel 				bands_counted |= BIT(req->channels[i]->band);
720c56ef672SDavid Spinadel 				n_bands++;
721c56ef672SDavid Spinadel 			}
722c56ef672SDavid Spinadel 
723c56ef672SDavid Spinadel 			local->hw_scan_ies_bufsize *= n_bands;
724c56ef672SDavid Spinadel 		}
725c56ef672SDavid Spinadel 
726a1834cfcSDmitry Antipov 		local->hw_scan_req = kmalloc(struct_size(local->hw_scan_req,
727a1834cfcSDmitry Antipov 							 req.channels,
728a1834cfcSDmitry Antipov 							 req->n_channels) +
729a1834cfcSDmitry Antipov 					     local->hw_scan_ies_bufsize,
730a1834cfcSDmitry Antipov 					     GFP_KERNEL);
7314d36ec58SJohannes Berg 		if (!local->hw_scan_req)
732f3b85252SJohannes Berg 			return -ENOMEM;
733f3b85252SJohannes Berg 
734c56ef672SDavid Spinadel 		local->hw_scan_req->req.ssids = req->ssids;
735c56ef672SDavid Spinadel 		local->hw_scan_req->req.n_ssids = req->n_ssids;
736a1834cfcSDmitry Antipov 		/* None of the channels are actually set
737a1834cfcSDmitry Antipov 		 * up but let UBSAN know the boundaries.
738a1834cfcSDmitry Antipov 		 */
739a1834cfcSDmitry Antipov 		local->hw_scan_req->req.n_channels = req->n_channels;
740a1834cfcSDmitry Antipov 
7414d36ec58SJohannes Berg 		ies = (u8 *)local->hw_scan_req +
7424d36ec58SJohannes Berg 			sizeof(*local->hw_scan_req) +
7434d36ec58SJohannes Berg 			req->n_channels * sizeof(req->channels[0]);
744c56ef672SDavid Spinadel 		local->hw_scan_req->req.ie = ies;
745c56ef672SDavid Spinadel 		local->hw_scan_req->req.flags = req->flags;
746e345f44fSJouni Malinen 		eth_broadcast_addr(local->hw_scan_req->req.bssid);
7477947d3e0SAvraham Stern 		local->hw_scan_req->req.duration = req->duration;
7487947d3e0SAvraham Stern 		local->hw_scan_req->req.duration_mandatory =
7497947d3e0SAvraham Stern 			req->duration_mandatory;
7504d36ec58SJohannes Berg 
7514d36ec58SJohannes Berg 		local->hw_scan_band = 0;
752c8cb5b85STova Mussai 		local->hw_scan_req->req.n_6ghz_params = req->n_6ghz_params;
753c8cb5b85STova Mussai 		local->hw_scan_req->req.scan_6ghz_params =
754c8cb5b85STova Mussai 			req->scan_6ghz_params;
755c8cb5b85STova Mussai 		local->hw_scan_req->req.scan_6ghz = req->scan_6ghz;
7566e7e6213SJohn W. Linville 
7576e7e6213SJohn W. Linville 		/*
7586e7e6213SJohn W. Linville 		 * After allocating local->hw_scan_req, we must
7596e7e6213SJohn W. Linville 		 * go through until ieee80211_prep_hw_scan(), so
7606e7e6213SJohn W. Linville 		 * anything that might be changed here and leave
7616e7e6213SJohn W. Linville 		 * this function early must not go after this
7626e7e6213SJohn W. Linville 		 * allocation.
7636e7e6213SJohn W. Linville 		 */
764f3b85252SJohannes Berg 	}
765f3b85252SJohannes Berg 
7666ea0a69cSJohannes Berg 	rcu_assign_pointer(local->scan_req, req);
767e2fd5dbcSJohannes Berg 	rcu_assign_pointer(local->scan_sdata, sdata);
768f3b85252SJohannes Berg 
769a344d677SJohannes Berg 	if (req->flags & NL80211_SCAN_FLAG_RANDOM_ADDR)
770a344d677SJohannes Berg 		get_random_mask_addr(local->scan_addr,
771a344d677SJohannes Berg 				     req->mac_addr,
772a344d677SJohannes Berg 				     req->mac_addr_mask);
773a344d677SJohannes Berg 	else
774a344d677SJohannes Berg 		memcpy(local->scan_addr, sdata->vif.addr, ETH_ALEN);
775a344d677SJohannes Berg 
776e9da68ddSJohannes Berg 	if (hw_scan) {
777fbe9c429SHelmut Schaa 		__set_bit(SCAN_HW_SCANNING, &local->scanning);
7788a690674SBen Greear 	} else if ((req->n_channels == 1) &&
779675a0b04SKarl Beldan 		   (req->channels[0] == local->_oper_chandef.chan)) {
7809b864870SJohannes Berg 		/*
7819b864870SJohannes Berg 		 * If we are scanning only on the operating channel
7829b864870SJohannes Berg 		 * then we do not need to stop normal activities
7838a690674SBen Greear 		 */
7848a690674SBen Greear 		unsigned long next_delay;
7858a690674SBen Greear 
7868a690674SBen Greear 		__set_bit(SCAN_ONCHANNEL_SCANNING, &local->scanning);
7878a690674SBen Greear 
7888a690674SBen Greear 		ieee80211_recalc_idle(local);
7898a690674SBen Greear 
7908a690674SBen Greear 		/* Notify driver scan is starting, keep order of operations
7918a690674SBen Greear 		 * same as normal software scan, in case that matters. */
792a344d677SJohannes Berg 		drv_sw_scan_start(local, sdata, local->scan_addr);
7938a690674SBen Greear 
7948a690674SBen Greear 		ieee80211_configure_filter(local); /* accept probe-responses */
7958a690674SBen Greear 
7968a690674SBen Greear 		/* We need to ensure power level is at max for scanning. */
7978a690674SBen Greear 		ieee80211_hw_config(local, 0);
7988a690674SBen Greear 
7994e39ccacSAntonio Quartulli 		if ((req->channels[0]->flags & (IEEE80211_CHAN_NO_IR |
8004e39ccacSAntonio Quartulli 						IEEE80211_CHAN_RADAR)) ||
8016ea0a69cSJohannes Berg 		    !req->n_ssids) {
8028a690674SBen Greear 			next_delay = IEEE80211_PASSIVE_CHANNEL_TIME;
803b041b7b9SFelix Fietkau 			if (req->n_ssids)
804b041b7b9SFelix Fietkau 				set_bit(SCAN_BEACON_WAIT, &local->scanning);
8058a690674SBen Greear 		} else {
8068a690674SBen Greear 			ieee80211_scan_state_send_probe(local, &next_delay);
8078a690674SBen Greear 			next_delay = IEEE80211_CHANNEL_TIME;
8088a690674SBen Greear 		}
8098a690674SBen Greear 
8108a690674SBen Greear 		/* Now, just wait a bit and we are all done! */
811d69c7a4eSJohannes Berg 		wiphy_delayed_work_queue(local->hw.wiphy, &local->scan_work,
8128a690674SBen Greear 					 next_delay);
8138a690674SBen Greear 		return 0;
8148a690674SBen Greear 	} else {
8158a690674SBen Greear 		/* Do normal software scan */
816fbe9c429SHelmut Schaa 		__set_bit(SCAN_SW_SCANNING, &local->scanning);
8178a690674SBen Greear 	}
8186e7e6213SJohn W. Linville 
8195cff20e6SJohannes Berg 	ieee80211_recalc_idle(local);
820f3b85252SJohannes Berg 
821e9da68ddSJohannes Berg 	if (hw_scan) {
8222ad2274cSIlan Peer 		WARN_ON(!ieee80211_prep_hw_scan(sdata));
823a060bbfeSJohannes Berg 		rc = drv_hw_scan(local, sdata, local->hw_scan_req);
824a344d677SJohannes Berg 	} else {
825a344d677SJohannes Berg 		rc = ieee80211_start_sw_scan(local, sdata);
826a344d677SJohannes Berg 	}
827f3b85252SJohannes Berg 
828f3b85252SJohannes Berg 	if (rc) {
8294d36ec58SJohannes Berg 		kfree(local->hw_scan_req);
8304d36ec58SJohannes Berg 		local->hw_scan_req = NULL;
831fbe9c429SHelmut Schaa 		local->scanning = 0;
832f3b85252SJohannes Berg 
8335cff20e6SJohannes Berg 		ieee80211_recalc_idle(local);
8345cff20e6SJohannes Berg 
835f3b85252SJohannes Berg 		local->scan_req = NULL;
8360c2bef46SMonam Agarwal 		RCU_INIT_POINTER(local->scan_sdata, NULL);
837f3b85252SJohannes Berg 	}
838f3b85252SJohannes Berg 
839e9da68ddSJohannes Berg 	if (hw_scan && rc == 1) {
840e9da68ddSJohannes Berg 		/*
841e9da68ddSJohannes Berg 		 * we can't fall back to software for P2P-GO
842e9da68ddSJohannes Berg 		 * as it must update NoA etc.
843e9da68ddSJohannes Berg 		 */
844e9da68ddSJohannes Berg 		if (ieee80211_vif_type_p2p(&sdata->vif) ==
845e9da68ddSJohannes Berg 				NL80211_IFTYPE_P2P_GO)
846e9da68ddSJohannes Berg 			return -EOPNOTSUPP;
847e9da68ddSJohannes Berg 		hw_scan = false;
848e9da68ddSJohannes Berg 		goto again;
849e9da68ddSJohannes Berg 	}
850e9da68ddSJohannes Berg 
851f3b85252SJohannes Berg 	return rc;
852f3b85252SJohannes Berg }
853f3b85252SJohannes Berg 
854df13cce5SHelmut Schaa static unsigned long
ieee80211_scan_get_channel_time(struct ieee80211_channel * chan)855df13cce5SHelmut Schaa ieee80211_scan_get_channel_time(struct ieee80211_channel *chan)
856df13cce5SHelmut Schaa {
857df13cce5SHelmut Schaa 	/*
858df13cce5SHelmut Schaa 	 * TODO: channel switching also consumes quite some time,
859df13cce5SHelmut Schaa 	 * add that delay as well to get a better estimation
860df13cce5SHelmut Schaa 	 */
8614e39ccacSAntonio Quartulli 	if (chan->flags & (IEEE80211_CHAN_NO_IR | IEEE80211_CHAN_RADAR))
862df13cce5SHelmut Schaa 		return IEEE80211_PASSIVE_CHANNEL_TIME;
863df13cce5SHelmut Schaa 	return IEEE80211_PROBE_DELAY + IEEE80211_CHANNEL_TIME;
864df13cce5SHelmut Schaa }
865df13cce5SHelmut Schaa 
ieee80211_scan_state_decision(struct ieee80211_local * local,unsigned long * next_delay)866e229f844SStanislaw Gruszka static void ieee80211_scan_state_decision(struct ieee80211_local *local,
8672fb3f028SHelmut Schaa 					  unsigned long *next_delay)
8682fb3f028SHelmut Schaa {
869142b9f50SHelmut Schaa 	bool associated = false;
870df13cce5SHelmut Schaa 	bool tx_empty = true;
871df13cce5SHelmut Schaa 	bool bad_latency;
872142b9f50SHelmut Schaa 	struct ieee80211_sub_if_data *sdata;
873df13cce5SHelmut Schaa 	struct ieee80211_channel *next_chan;
874cd2bb512SSam Leffler 	enum mac80211_scan_state next_scan_state;
8756ea0a69cSJohannes Berg 	struct cfg80211_scan_request *scan_req;
876142b9f50SHelmut Schaa 
877df13cce5SHelmut Schaa 	/*
878df13cce5SHelmut Schaa 	 * check if at least one STA interface is associated,
879df13cce5SHelmut Schaa 	 * check if at least one STA interface has pending tx frames
880df13cce5SHelmut Schaa 	 * and grab the lowest used beacon interval
881df13cce5SHelmut Schaa 	 */
882142b9f50SHelmut Schaa 	mutex_lock(&local->iflist_mtx);
883142b9f50SHelmut Schaa 	list_for_each_entry(sdata, &local->interfaces, list) {
8849607e6b6SJohannes Berg 		if (!ieee80211_sdata_running(sdata))
885142b9f50SHelmut Schaa 			continue;
886142b9f50SHelmut Schaa 
887142b9f50SHelmut Schaa 		if (sdata->vif.type == NL80211_IFTYPE_STATION) {
888142b9f50SHelmut Schaa 			if (sdata->u.mgd.associated) {
889142b9f50SHelmut Schaa 				associated = true;
890df13cce5SHelmut Schaa 
891df13cce5SHelmut Schaa 				if (!qdisc_all_tx_empty(sdata->dev)) {
892df13cce5SHelmut Schaa 					tx_empty = false;
893142b9f50SHelmut Schaa 					break;
894142b9f50SHelmut Schaa 				}
895142b9f50SHelmut Schaa 			}
896142b9f50SHelmut Schaa 		}
897df13cce5SHelmut Schaa 	}
898142b9f50SHelmut Schaa 	mutex_unlock(&local->iflist_mtx);
899142b9f50SHelmut Schaa 
9006ea0a69cSJohannes Berg 	scan_req = rcu_dereference_protected(local->scan_req,
9016ea0a69cSJohannes Berg 					     lockdep_is_held(&local->mtx));
9026ea0a69cSJohannes Berg 
9036ea0a69cSJohannes Berg 	next_chan = scan_req->channels[local->scan_channel_idx];
904b23b025fSBen Greear 
905142b9f50SHelmut Schaa 	/*
906142b9f50SHelmut Schaa 	 * we're currently scanning a different channel, let's
907df13cce5SHelmut Schaa 	 * see if we can scan another channel without interfering
908df13cce5SHelmut Schaa 	 * with the current traffic situation.
909df13cce5SHelmut Schaa 	 *
9103f892b61SStanislaw Gruszka 	 * Keep good latency, do not stay off-channel more than 125 ms.
911142b9f50SHelmut Schaa 	 */
912df13cce5SHelmut Schaa 
913df13cce5SHelmut Schaa 	bad_latency = time_after(jiffies +
914df13cce5SHelmut Schaa 				 ieee80211_scan_get_channel_time(next_chan),
9153f892b61SStanislaw Gruszka 				 local->leave_oper_channel_time + HZ / 8);
916df13cce5SHelmut Schaa 
917cd2bb512SSam Leffler 	if (associated && !tx_empty) {
9186ea0a69cSJohannes Berg 		if (scan_req->flags & NL80211_SCAN_FLAG_LOW_PRIORITY)
919cd2bb512SSam Leffler 			next_scan_state = SCAN_ABORT;
920142b9f50SHelmut Schaa 		else
921cd2bb512SSam Leffler 			next_scan_state = SCAN_SUSPEND;
9223f892b61SStanislaw Gruszka 	} else if (associated && bad_latency) {
923cd2bb512SSam Leffler 		next_scan_state = SCAN_SUSPEND;
924cd2bb512SSam Leffler 	} else {
925cd2bb512SSam Leffler 		next_scan_state = SCAN_SET_CHANNEL;
926cd2bb512SSam Leffler 	}
927cd2bb512SSam Leffler 
928cd2bb512SSam Leffler 	local->next_scan_state = next_scan_state;
929142b9f50SHelmut Schaa 
930142b9f50SHelmut Schaa 	*next_delay = 0;
9312fb3f028SHelmut Schaa }
9322fb3f028SHelmut Schaa 
ieee80211_scan_state_set_channel(struct ieee80211_local * local,unsigned long * next_delay)9332fb3f028SHelmut Schaa static void ieee80211_scan_state_set_channel(struct ieee80211_local *local,
9347d3be3ccSHelmut Schaa 					     unsigned long *next_delay)
9357d3be3ccSHelmut Schaa {
9367d3be3ccSHelmut Schaa 	int skip;
9377d3be3ccSHelmut Schaa 	struct ieee80211_channel *chan;
9387ca15a0aSSimon Wunderlich 	enum nl80211_bss_scan_width oper_scan_width;
9396ea0a69cSJohannes Berg 	struct cfg80211_scan_request *scan_req;
9406ea0a69cSJohannes Berg 
9416ea0a69cSJohannes Berg 	scan_req = rcu_dereference_protected(local->scan_req,
9426ea0a69cSJohannes Berg 					     lockdep_is_held(&local->mtx));
9437d3be3ccSHelmut Schaa 
9447d3be3ccSHelmut Schaa 	skip = 0;
9456ea0a69cSJohannes Berg 	chan = scan_req->channels[local->scan_channel_idx];
9467d3be3ccSHelmut Schaa 
9477ca15a0aSSimon Wunderlich 	local->scan_chandef.chan = chan;
9487ca15a0aSSimon Wunderlich 	local->scan_chandef.center_freq1 = chan->center_freq;
949b6011960SThomas Pedersen 	local->scan_chandef.freq1_offset = chan->freq_offset;
9507ca15a0aSSimon Wunderlich 	local->scan_chandef.center_freq2 = 0;
95175b15935SThomas Pedersen 
95275b15935SThomas Pedersen 	/* For scanning on the S1G band, ignore scan_width (which is constant
95375b15935SThomas Pedersen 	 * across all channels) for now since channel width is specific to each
95475b15935SThomas Pedersen 	 * channel. Detect the required channel width here and likely revisit
95575b15935SThomas Pedersen 	 * later. Maybe scan_width could be used to build the channel scan list?
95675b15935SThomas Pedersen 	 */
95775b15935SThomas Pedersen 	if (chan->band == NL80211_BAND_S1GHZ) {
95875b15935SThomas Pedersen 		local->scan_chandef.width = ieee80211_s1g_channel_width(chan);
95975b15935SThomas Pedersen 		goto set_channel;
96075b15935SThomas Pedersen 	}
96175b15935SThomas Pedersen 
9626ea0a69cSJohannes Berg 	switch (scan_req->scan_width) {
9637ca15a0aSSimon Wunderlich 	case NL80211_BSS_CHAN_WIDTH_5:
9647ca15a0aSSimon Wunderlich 		local->scan_chandef.width = NL80211_CHAN_WIDTH_5;
9657ca15a0aSSimon Wunderlich 		break;
9667ca15a0aSSimon Wunderlich 	case NL80211_BSS_CHAN_WIDTH_10:
9677ca15a0aSSimon Wunderlich 		local->scan_chandef.width = NL80211_CHAN_WIDTH_10;
9687ca15a0aSSimon Wunderlich 		break;
969df78a0c0SThomas Pedersen 	default:
9707ca15a0aSSimon Wunderlich 	case NL80211_BSS_CHAN_WIDTH_20:
9717ca15a0aSSimon Wunderlich 		/* If scanning on oper channel, use whatever channel-type
9727ca15a0aSSimon Wunderlich 		 * is currently in use.
9737ca15a0aSSimon Wunderlich 		 */
9747ca15a0aSSimon Wunderlich 		oper_scan_width = cfg80211_chandef_to_scan_width(
9757ca15a0aSSimon Wunderlich 					&local->_oper_chandef);
9767ca15a0aSSimon Wunderlich 		if (chan == local->_oper_chandef.chan &&
9776ea0a69cSJohannes Berg 		    oper_scan_width == scan_req->scan_width)
9787ca15a0aSSimon Wunderlich 			local->scan_chandef = local->_oper_chandef;
9797ca15a0aSSimon Wunderlich 		else
9807ca15a0aSSimon Wunderlich 			local->scan_chandef.width = NL80211_CHAN_WIDTH_20_NOHT;
9817ca15a0aSSimon Wunderlich 		break;
98275b15935SThomas Pedersen 	case NL80211_BSS_CHAN_WIDTH_1:
98375b15935SThomas Pedersen 	case NL80211_BSS_CHAN_WIDTH_2:
98475b15935SThomas Pedersen 		/* shouldn't get here, S1G handled above */
98575b15935SThomas Pedersen 		WARN_ON(1);
98675b15935SThomas Pedersen 		break;
9877ca15a0aSSimon Wunderlich 	}
988b23b025fSBen Greear 
98975b15935SThomas Pedersen set_channel:
990584991dcSJohannes Berg 	if (ieee80211_hw_config(local, IEEE80211_CONF_CHANGE_CHANNEL))
9917d3be3ccSHelmut Schaa 		skip = 1;
9927d3be3ccSHelmut Schaa 
9937d3be3ccSHelmut Schaa 	/* advance state machine to next channel/band */
9947d3be3ccSHelmut Schaa 	local->scan_channel_idx++;
9957d3be3ccSHelmut Schaa 
9960ee9c13cSHelmut Schaa 	if (skip) {
9970ee9c13cSHelmut Schaa 		/* if we skip this channel return to the decision state */
9980ee9c13cSHelmut Schaa 		local->next_scan_state = SCAN_DECISION;
9992fb3f028SHelmut Schaa 		return;
10000ee9c13cSHelmut Schaa 	}
10017d3be3ccSHelmut Schaa 
10027d3be3ccSHelmut Schaa 	/*
10037d3be3ccSHelmut Schaa 	 * Probe delay is used to update the NAV, cf. 11.1.3.2.2
10047d3be3ccSHelmut Schaa 	 * (which unfortunately doesn't say _why_ step a) is done,
10057d3be3ccSHelmut Schaa 	 * but it waits for the probe delay or until a frame is
10067d3be3ccSHelmut Schaa 	 * received - and the received frame would update the NAV).
10077d3be3ccSHelmut Schaa 	 * For now, we do not support waiting until a frame is
10087d3be3ccSHelmut Schaa 	 * received.
10097d3be3ccSHelmut Schaa 	 *
10107d3be3ccSHelmut Schaa 	 * In any case, it is not necessary for a passive scan.
10117d3be3ccSHelmut Schaa 	 */
10124e39ccacSAntonio Quartulli 	if ((chan->flags & (IEEE80211_CHAN_NO_IR | IEEE80211_CHAN_RADAR)) ||
10134e39ccacSAntonio Quartulli 	    !scan_req->n_ssids) {
10147d3be3ccSHelmut Schaa 		*next_delay = IEEE80211_PASSIVE_CHANNEL_TIME;
1015977923b0SHelmut Schaa 		local->next_scan_state = SCAN_DECISION;
1016b041b7b9SFelix Fietkau 		if (scan_req->n_ssids)
1017b041b7b9SFelix Fietkau 			set_bit(SCAN_BEACON_WAIT, &local->scanning);
10182fb3f028SHelmut Schaa 		return;
10197d3be3ccSHelmut Schaa 	}
10207d3be3ccSHelmut Schaa 
10212fb3f028SHelmut Schaa 	/* active scan, send probes */
10227d3be3ccSHelmut Schaa 	*next_delay = IEEE80211_PROBE_DELAY;
1023977923b0SHelmut Schaa 	local->next_scan_state = SCAN_SEND_PROBE;
10247d3be3ccSHelmut Schaa }
10257d3be3ccSHelmut Schaa 
ieee80211_scan_state_suspend(struct ieee80211_local * local,unsigned long * next_delay)102607ef03eeSJohannes Berg static void ieee80211_scan_state_suspend(struct ieee80211_local *local,
102707ef03eeSJohannes Berg 					 unsigned long *next_delay)
102807ef03eeSJohannes Berg {
102907ef03eeSJohannes Berg 	/* switch back to the operating channel */
10307ca15a0aSSimon Wunderlich 	local->scan_chandef.chan = NULL;
103107ef03eeSJohannes Berg 	ieee80211_hw_config(local, IEEE80211_CONF_CHANGE_CHANNEL);
103207ef03eeSJohannes Berg 
1033aacde9eeSStanislaw Gruszka 	/* disable PS */
1034aacde9eeSStanislaw Gruszka 	ieee80211_offchannel_return(local);
103507ef03eeSJohannes Berg 
103607ef03eeSJohannes Berg 	*next_delay = HZ / 5;
103707ef03eeSJohannes Berg 	/* afterwards, resume scan & go to next channel */
103807ef03eeSJohannes Berg 	local->next_scan_state = SCAN_RESUME;
103907ef03eeSJohannes Berg }
104007ef03eeSJohannes Berg 
ieee80211_scan_state_resume(struct ieee80211_local * local,unsigned long * next_delay)104107ef03eeSJohannes Berg static void ieee80211_scan_state_resume(struct ieee80211_local *local,
104207ef03eeSJohannes Berg 					unsigned long *next_delay)
104307ef03eeSJohannes Berg {
1044aacde9eeSStanislaw Gruszka 	ieee80211_offchannel_stop_vifs(local);
104507ef03eeSJohannes Berg 
104607ef03eeSJohannes Berg 	if (local->ops->flush) {
10473b24f4c6SEmmanuel Grumbach 		ieee80211_flush_queues(local, NULL, false);
104807ef03eeSJohannes Berg 		*next_delay = 0;
104907ef03eeSJohannes Berg 	} else
105007ef03eeSJohannes Berg 		*next_delay = HZ / 10;
105107ef03eeSJohannes Berg 
105207ef03eeSJohannes Berg 	/* remember when we left the operating channel */
105307ef03eeSJohannes Berg 	local->leave_oper_channel_time = jiffies;
105407ef03eeSJohannes Berg 
105507ef03eeSJohannes Berg 	/* advance to the next channel to be scanned */
1056de2ee84dSMohammed Shafi Shajakhan 	local->next_scan_state = SCAN_SET_CHANNEL;
105707ef03eeSJohannes Berg }
105807ef03eeSJohannes Berg 
ieee80211_scan_work(struct wiphy * wiphy,struct wiphy_work * work)1059d69c7a4eSJohannes Berg void ieee80211_scan_work(struct wiphy *wiphy, struct wiphy_work *work)
10600a51b27eSJohannes Berg {
10610a51b27eSJohannes Berg 	struct ieee80211_local *local =
10620a51b27eSJohannes Berg 		container_of(work, struct ieee80211_local, scan_work.work);
1063d07bfd8bSJohannes Berg 	struct ieee80211_sub_if_data *sdata;
10646ea0a69cSJohannes Berg 	struct cfg80211_scan_request *scan_req;
10650a51b27eSJohannes Berg 	unsigned long next_delay = 0;
10668bd2a248SEliad Peller 	bool aborted;
10678789d459SJohannes Berg 
1068259b62e3SStanislaw Gruszka 	mutex_lock(&local->mtx);
1069259b62e3SStanislaw Gruszka 
1070332ff7feSLuciano Coelho 	if (!ieee80211_can_run_worker(local)) {
1071332ff7feSLuciano Coelho 		aborted = true;
1072332ff7feSLuciano Coelho 		goto out_complete;
1073332ff7feSLuciano Coelho 	}
1074332ff7feSLuciano Coelho 
1075e2fd5dbcSJohannes Berg 	sdata = rcu_dereference_protected(local->scan_sdata,
1076e2fd5dbcSJohannes Berg 					  lockdep_is_held(&local->mtx));
10776ea0a69cSJohannes Berg 	scan_req = rcu_dereference_protected(local->scan_req,
10786ea0a69cSJohannes Berg 					     lockdep_is_held(&local->mtx));
1079d07bfd8bSJohannes Berg 
10808a690674SBen Greear 	/* When scanning on-channel, the first-callback means completed. */
10818a690674SBen Greear 	if (test_bit(SCAN_ONCHANNEL_SCANNING, &local->scanning)) {
10828a690674SBen Greear 		aborted = test_and_clear_bit(SCAN_ABORTED, &local->scanning);
10838a690674SBen Greear 		goto out_complete;
10848a690674SBen Greear 	}
10858a690674SBen Greear 
1086259b62e3SStanislaw Gruszka 	if (test_and_clear_bit(SCAN_COMPLETED, &local->scanning)) {
10878789d459SJohannes Berg 		aborted = test_and_clear_bit(SCAN_ABORTED, &local->scanning);
1088259b62e3SStanislaw Gruszka 		goto out_complete;
10898789d459SJohannes Berg 	}
10908789d459SJohannes Berg 
10916ea0a69cSJohannes Berg 	if (!sdata || !scan_req)
1092259b62e3SStanislaw Gruszka 		goto out;
1093f3b85252SJohannes Berg 
1094ff5db439SEliad Peller 	if (!local->scanning) {
1095f3b85252SJohannes Berg 		int rc;
1096f3b85252SJohannes Berg 
10976ea0a69cSJohannes Berg 		RCU_INIT_POINTER(local->scan_req, NULL);
10980c2bef46SMonam Agarwal 		RCU_INIT_POINTER(local->scan_sdata, NULL);
1099f3b85252SJohannes Berg 
11006ea0a69cSJohannes Berg 		rc = __ieee80211_start_scan(sdata, scan_req);
1101259b62e3SStanislaw Gruszka 		if (rc) {
11023aed49efSStanislaw Gruszka 			/* need to complete scan in cfg80211 */
11036ea0a69cSJohannes Berg 			rcu_assign_pointer(local->scan_req, scan_req);
1104259b62e3SStanislaw Gruszka 			aborted = true;
1105259b62e3SStanislaw Gruszka 			goto out_complete;
1106259b62e3SStanislaw Gruszka 		} else
1107259b62e3SStanislaw Gruszka 			goto out;
1108f3b85252SJohannes Berg 	}
1109f3b85252SJohannes Berg 
1110b041b7b9SFelix Fietkau 	clear_bit(SCAN_BEACON_WAIT, &local->scanning);
1111b041b7b9SFelix Fietkau 
11125bc75728SJohannes Berg 	/*
1113f502d09bSHelmut Schaa 	 * as long as no delay is required advance immediately
1114f502d09bSHelmut Schaa 	 * without scheduling a new work
1115f502d09bSHelmut Schaa 	 */
1116f502d09bSHelmut Schaa 	do {
1117c29acf20SRajkumar Manoharan 		if (!ieee80211_sdata_running(sdata)) {
1118c29acf20SRajkumar Manoharan 			aborted = true;
1119c29acf20SRajkumar Manoharan 			goto out_complete;
1120c29acf20SRajkumar Manoharan 		}
1121c29acf20SRajkumar Manoharan 
1122b041b7b9SFelix Fietkau 		if (test_and_clear_bit(SCAN_BEACON_DONE, &local->scanning) &&
1123b041b7b9SFelix Fietkau 		    local->next_scan_state == SCAN_DECISION)
1124b041b7b9SFelix Fietkau 			local->next_scan_state = SCAN_SEND_PROBE;
1125b041b7b9SFelix Fietkau 
1126977923b0SHelmut Schaa 		switch (local->next_scan_state) {
11272fb3f028SHelmut Schaa 		case SCAN_DECISION:
1128e229f844SStanislaw Gruszka 			/* if no more bands/channels left, complete scan */
11296ea0a69cSJohannes Berg 			if (local->scan_channel_idx >= scan_req->n_channels) {
1130e229f844SStanislaw Gruszka 				aborted = false;
1131e229f844SStanislaw Gruszka 				goto out_complete;
1132e229f844SStanislaw Gruszka 			}
1133e229f844SStanislaw Gruszka 			ieee80211_scan_state_decision(local, &next_delay);
11340a51b27eSJohannes Berg 			break;
11352fb3f028SHelmut Schaa 		case SCAN_SET_CHANNEL:
11362fb3f028SHelmut Schaa 			ieee80211_scan_state_set_channel(local, &next_delay);
11372fb3f028SHelmut Schaa 			break;
11380a51b27eSJohannes Berg 		case SCAN_SEND_PROBE:
11397d3be3ccSHelmut Schaa 			ieee80211_scan_state_send_probe(local, &next_delay);
11400a51b27eSJohannes Berg 			break;
114107ef03eeSJohannes Berg 		case SCAN_SUSPEND:
114207ef03eeSJohannes Berg 			ieee80211_scan_state_suspend(local, &next_delay);
1143142b9f50SHelmut Schaa 			break;
114407ef03eeSJohannes Berg 		case SCAN_RESUME:
114507ef03eeSJohannes Berg 			ieee80211_scan_state_resume(local, &next_delay);
1146142b9f50SHelmut Schaa 			break;
1147cd2bb512SSam Leffler 		case SCAN_ABORT:
1148cd2bb512SSam Leffler 			aborted = true;
1149cd2bb512SSam Leffler 			goto out_complete;
11500a51b27eSJohannes Berg 		}
1151f502d09bSHelmut Schaa 	} while (next_delay == 0);
11520a51b27eSJohannes Berg 
1153d69c7a4eSJohannes Berg 	wiphy_delayed_work_queue(local->hw.wiphy, &local->scan_work,
1154d69c7a4eSJohannes Berg 				 next_delay);
1155d07bfd8bSJohannes Berg 	goto out;
1156259b62e3SStanislaw Gruszka 
1157259b62e3SStanislaw Gruszka out_complete:
11588bd2a248SEliad Peller 	__ieee80211_scan_completed(&local->hw, aborted);
1159259b62e3SStanislaw Gruszka out:
1160259b62e3SStanislaw Gruszka 	mutex_unlock(&local->mtx);
11610a51b27eSJohannes Berg }
11620a51b27eSJohannes Berg 
ieee80211_request_scan(struct ieee80211_sub_if_data * sdata,struct cfg80211_scan_request * req)1163c2b13452SJohannes Berg int ieee80211_request_scan(struct ieee80211_sub_if_data *sdata,
11642a519311SJohannes Berg 			   struct cfg80211_scan_request *req)
11650a51b27eSJohannes Berg {
1166f3b85252SJohannes Berg 	int res;
11670a51b27eSJohannes Berg 
1168a1699b75SJohannes Berg 	mutex_lock(&sdata->local->mtx);
1169f3b85252SJohannes Berg 	res = __ieee80211_start_scan(sdata, req);
1170a1699b75SJohannes Berg 	mutex_unlock(&sdata->local->mtx);
11712a519311SJohannes Berg 
1172f3b85252SJohannes Berg 	return res;
11730a51b27eSJohannes Berg }
11740a51b27eSJohannes 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,enum nl80211_bss_scan_width scan_width)117534bcf715SStanislaw Gruszka int ieee80211_request_ibss_scan(struct ieee80211_sub_if_data *sdata,
1176be4a4b6aSJohannes Berg 				const u8 *ssid, u8 ssid_len,
117776bed0f4SJanusz.Dziedzic@tieto.com 				struct ieee80211_channel **channels,
117876bed0f4SJanusz.Dziedzic@tieto.com 				unsigned int n_channels,
11797ca15a0aSSimon Wunderlich 				enum nl80211_bss_scan_width scan_width)
1180f3b85252SJohannes Berg {
1181f3b85252SJohannes Berg 	struct ieee80211_local *local = sdata->local;
118276bed0f4SJanusz.Dziedzic@tieto.com 	int ret = -EBUSY, i, n_ch = 0;
118357fbcce3SJohannes Berg 	enum nl80211_band band;
11849116dd01SJohannes Berg 
1185a1699b75SJohannes Berg 	mutex_lock(&local->mtx);
1186f3b85252SJohannes Berg 
1187f3b85252SJohannes Berg 	/* busy scanning */
1188f3b85252SJohannes Berg 	if (local->scan_req)
1189f3b85252SJohannes Berg 		goto unlock;
1190f3b85252SJohannes Berg 
1191be4a4b6aSJohannes Berg 	/* fill internal scan request */
119276bed0f4SJanusz.Dziedzic@tieto.com 	if (!channels) {
119376bed0f4SJanusz.Dziedzic@tieto.com 		int max_n;
1194be4a4b6aSJohannes Berg 
119557fbcce3SJohannes Berg 		for (band = 0; band < NUM_NL80211_BANDS; band++) {
1196c8cb5b85STova Mussai 			if (!local->hw.wiphy->bands[band] ||
1197c8cb5b85STova Mussai 			    band == NL80211_BAND_6GHZ)
1198be4a4b6aSJohannes Berg 				continue;
119934bcf715SStanislaw Gruszka 
120034bcf715SStanislaw Gruszka 			max_n = local->hw.wiphy->bands[band]->n_channels;
120134bcf715SStanislaw Gruszka 			for (i = 0; i < max_n; i++) {
120234bcf715SStanislaw Gruszka 				struct ieee80211_channel *tmp_ch =
1203be4a4b6aSJohannes Berg 				    &local->hw.wiphy->bands[band]->channels[i];
120434bcf715SStanislaw Gruszka 
12058fe02e16SLuis R. Rodriguez 				if (tmp_ch->flags & (IEEE80211_CHAN_NO_IR |
120634bcf715SStanislaw Gruszka 						     IEEE80211_CHAN_DISABLED))
120734bcf715SStanislaw Gruszka 					continue;
120834bcf715SStanislaw Gruszka 
120934bcf715SStanislaw Gruszka 				local->int_scan_req->channels[n_ch] = tmp_ch;
121034bcf715SStanislaw Gruszka 				n_ch++;
1211be4a4b6aSJohannes Berg 			}
1212be4a4b6aSJohannes Berg 		}
1213be4a4b6aSJohannes Berg 
121434bcf715SStanislaw Gruszka 		if (WARN_ON_ONCE(n_ch == 0))
121534bcf715SStanislaw Gruszka 			goto unlock;
121634bcf715SStanislaw Gruszka 
121734bcf715SStanislaw Gruszka 		local->int_scan_req->n_channels = n_ch;
1218be4a4b6aSJohannes Berg 	} else {
121976bed0f4SJanusz.Dziedzic@tieto.com 		for (i = 0; i < n_channels; i++) {
122076bed0f4SJanusz.Dziedzic@tieto.com 			if (channels[i]->flags & (IEEE80211_CHAN_NO_IR |
122176bed0f4SJanusz.Dziedzic@tieto.com 						  IEEE80211_CHAN_DISABLED))
122276bed0f4SJanusz.Dziedzic@tieto.com 				continue;
122376bed0f4SJanusz.Dziedzic@tieto.com 
122476bed0f4SJanusz.Dziedzic@tieto.com 			local->int_scan_req->channels[n_ch] = channels[i];
122576bed0f4SJanusz.Dziedzic@tieto.com 			n_ch++;
122676bed0f4SJanusz.Dziedzic@tieto.com 		}
122776bed0f4SJanusz.Dziedzic@tieto.com 
122876bed0f4SJanusz.Dziedzic@tieto.com 		if (WARN_ON_ONCE(n_ch == 0))
122934bcf715SStanislaw Gruszka 			goto unlock;
123034bcf715SStanislaw Gruszka 
123176bed0f4SJanusz.Dziedzic@tieto.com 		local->int_scan_req->n_channels = n_ch;
1232be4a4b6aSJohannes Berg 	}
1233be4a4b6aSJohannes Berg 
1234be4a4b6aSJohannes Berg 	local->int_scan_req->ssids = &local->scan_ssid;
1235be4a4b6aSJohannes Berg 	local->int_scan_req->n_ssids = 1;
12367ca15a0aSSimon Wunderlich 	local->int_scan_req->scan_width = scan_width;
12375ba63533SJohannes Berg 	memcpy(local->int_scan_req->ssids[0].ssid, ssid, IEEE80211_MAX_SSID_LEN);
12385ba63533SJohannes Berg 	local->int_scan_req->ssids[0].ssid_len = ssid_len;
1239f3b85252SJohannes Berg 
12405ba63533SJohannes Berg 	ret = __ieee80211_start_scan(sdata, sdata->local->int_scan_req);
1241f3b85252SJohannes Berg  unlock:
1242a1699b75SJohannes Berg 	mutex_unlock(&local->mtx);
1243f3b85252SJohannes Berg 	return ret;
12440a51b27eSJohannes Berg }
12455bb644a0SJohannes Berg 
ieee80211_scan_cancel(struct ieee80211_local * local)12465bb644a0SJohannes Berg void ieee80211_scan_cancel(struct ieee80211_local *local)
12475bb644a0SJohannes Berg {
12480fd3af61SJohannes Berg 	/* ensure a new scan cannot be queued */
12490fd3af61SJohannes Berg 	lockdep_assert_wiphy(local->hw.wiphy);
12500fd3af61SJohannes Berg 
12515bb644a0SJohannes Berg 	/*
1252b856439bSEliad Peller 	 * We are canceling software scan, or deferred scan that was not
12534136c422SStanislaw Gruszka 	 * yet really started (see __ieee80211_start_scan ).
12544136c422SStanislaw Gruszka 	 *
12554136c422SStanislaw Gruszka 	 * Regarding hardware scan:
12564136c422SStanislaw Gruszka 	 * - we can not call  __ieee80211_scan_completed() as when
12574136c422SStanislaw Gruszka 	 *   SCAN_HW_SCANNING bit is set this function change
12584136c422SStanislaw Gruszka 	 *   local->hw_scan_req to operate on 5G band, what race with
12594136c422SStanislaw Gruszka 	 *   driver which can use local->hw_scan_req
12604136c422SStanislaw Gruszka 	 *
12614136c422SStanislaw Gruszka 	 * - we can not cancel scan_work since driver can schedule it
12624136c422SStanislaw Gruszka 	 *   by ieee80211_scan_completed(..., true) to finish scan
12634136c422SStanislaw Gruszka 	 *
1264b856439bSEliad Peller 	 * Hence we only call the cancel_hw_scan() callback, but the low-level
1265b856439bSEliad Peller 	 * driver is still responsible for calling ieee80211_scan_completed()
1266b856439bSEliad Peller 	 * after the scan was completed/aborted.
12675bb644a0SJohannes Berg 	 */
12684136c422SStanislaw Gruszka 
1269a1699b75SJohannes Berg 	mutex_lock(&local->mtx);
1270b856439bSEliad Peller 	if (!local->scan_req)
1271b856439bSEliad Peller 		goto out;
1272b856439bSEliad Peller 
1273a754055aSEmmanuel Grumbach 	/*
1274a754055aSEmmanuel Grumbach 	 * We have a scan running and the driver already reported completion,
1275a754055aSEmmanuel Grumbach 	 * but the worker hasn't run yet or is stuck on the mutex - mark it as
1276a754055aSEmmanuel Grumbach 	 * cancelled.
1277a754055aSEmmanuel Grumbach 	 */
1278a754055aSEmmanuel Grumbach 	if (test_bit(SCAN_HW_SCANNING, &local->scanning) &&
1279a754055aSEmmanuel Grumbach 	    test_bit(SCAN_COMPLETED, &local->scanning)) {
1280a754055aSEmmanuel Grumbach 		set_bit(SCAN_HW_CANCELLED, &local->scanning);
1281a754055aSEmmanuel Grumbach 		goto out;
1282a754055aSEmmanuel Grumbach 	}
1283a754055aSEmmanuel Grumbach 
1284b856439bSEliad Peller 	if (test_bit(SCAN_HW_SCANNING, &local->scanning)) {
1285a754055aSEmmanuel Grumbach 		/*
1286a754055aSEmmanuel Grumbach 		 * Make sure that __ieee80211_scan_completed doesn't trigger a
1287a754055aSEmmanuel Grumbach 		 * scan on another band.
1288a754055aSEmmanuel Grumbach 		 */
1289a754055aSEmmanuel Grumbach 		set_bit(SCAN_HW_CANCELLED, &local->scanning);
1290b856439bSEliad Peller 		if (local->ops->cancel_hw_scan)
1291e2fd5dbcSJohannes Berg 			drv_cancel_hw_scan(local,
1292e2fd5dbcSJohannes Berg 				rcu_dereference_protected(local->scan_sdata,
1293e2fd5dbcSJohannes Berg 						lockdep_is_held(&local->mtx)));
1294b856439bSEliad Peller 		goto out;
1295b856439bSEliad Peller 	}
1296b856439bSEliad Peller 
1297d69c7a4eSJohannes Berg 	wiphy_delayed_work_cancel(local->hw.wiphy, &local->scan_work);
1298d07bfd8bSJohannes Berg 	/* and clean up */
12997947d3e0SAvraham Stern 	memset(&local->scan_info, 0, sizeof(local->scan_info));
13008bd2a248SEliad Peller 	__ieee80211_scan_completed(&local->hw, true);
1301b856439bSEliad Peller out:
1302d07bfd8bSJohannes Berg 	mutex_unlock(&local->mtx);
13035bb644a0SJohannes Berg }
130479f460caSLuciano Coelho 
__ieee80211_request_sched_scan_start(struct ieee80211_sub_if_data * sdata,struct cfg80211_sched_scan_request * req)1305d43c6b6eSDavid Spinadel int __ieee80211_request_sched_scan_start(struct ieee80211_sub_if_data *sdata,
130679f460caSLuciano Coelho 					struct cfg80211_sched_scan_request *req)
130779f460caSLuciano Coelho {
130879f460caSLuciano Coelho 	struct ieee80211_local *local = sdata->local;
1309633e2713SDavid Spinadel 	struct ieee80211_scan_ies sched_scan_ies = {};
13102103dec1SSimon Wunderlich 	struct cfg80211_chan_def chandef;
1311633e2713SDavid Spinadel 	int ret, i, iebufsz, num_bands = 0;
131257fbcce3SJohannes Berg 	u32 rate_masks[NUM_NL80211_BANDS] = {};
1313633e2713SDavid Spinadel 	u8 bands_used = 0;
1314633e2713SDavid Spinadel 	u8 *ie;
1315b9771d41SJohannes Berg 	u32 flags = 0;
1316c604b9f2SJohannes Berg 
1317e4dcbb37SDavid Spinadel 	iebufsz = local->scan_ies_len + req->ie_len;
131879f460caSLuciano Coelho 
1319d43c6b6eSDavid Spinadel 	lockdep_assert_held(&local->mtx);
132079f460caSLuciano Coelho 
1321d43c6b6eSDavid Spinadel 	if (!local->ops->sched_scan_start)
1322d43c6b6eSDavid Spinadel 		return -ENOTSUPP;
132379f460caSLuciano Coelho 
132457fbcce3SJohannes Berg 	for (i = 0; i < NUM_NL80211_BANDS; i++) {
1325633e2713SDavid Spinadel 		if (local->hw.wiphy->bands[i]) {
1326633e2713SDavid Spinadel 			bands_used |= BIT(i);
1327633e2713SDavid Spinadel 			rate_masks[i] = (u32) -1;
1328633e2713SDavid Spinadel 			num_bands++;
1329633e2713SDavid Spinadel 		}
1330633e2713SDavid Spinadel 	}
1331c56ef672SDavid Spinadel 
1332b9771d41SJohannes Berg 	if (req->flags & NL80211_SCAN_FLAG_MIN_PREQ_CONTENT)
1333b9771d41SJohannes Berg 		flags |= IEEE80211_PROBE_FLAG_MIN_CONTENT;
1334b9771d41SJohannes Berg 
13356396bb22SKees Cook 	ie = kcalloc(iebufsz, num_bands, GFP_KERNEL);
1336633e2713SDavid Spinadel 	if (!ie) {
133779f460caSLuciano Coelho 		ret = -ENOMEM;
1338633e2713SDavid Spinadel 		goto out;
133979f460caSLuciano Coelho 	}
134079f460caSLuciano Coelho 
13412103dec1SSimon Wunderlich 	ieee80211_prepare_scan_chandef(&chandef, req->scan_width);
13422103dec1SSimon Wunderlich 
13432ad2274cSIlan Peer 	ieee80211_build_preq_ies(sdata, ie, num_bands * iebufsz,
1344633e2713SDavid Spinadel 				 &sched_scan_ies, req->ie,
134500387f32SJohannes Berg 				 req->ie_len, bands_used, rate_masks, &chandef,
1346b9771d41SJohannes Berg 				 flags);
134779f460caSLuciano Coelho 
134830dd3edfSJohannes Berg 	ret = drv_sched_scan_start(local, sdata, req, &sched_scan_ies);
1349d43c6b6eSDavid Spinadel 	if (ret == 0) {
13505260a5b2SJohannes Berg 		rcu_assign_pointer(local->sched_scan_sdata, sdata);
13516ea0a69cSJohannes Berg 		rcu_assign_pointer(local->sched_scan_req, req);
1352d43c6b6eSDavid Spinadel 	}
135379f460caSLuciano Coelho 
1354633e2713SDavid Spinadel 	kfree(ie);
1355d43c6b6eSDavid Spinadel 
1356633e2713SDavid Spinadel out:
1357d43c6b6eSDavid Spinadel 	if (ret) {
1358d43c6b6eSDavid Spinadel 		/* Clean in case of failure after HW restart or upon resume. */
13590c2bef46SMonam Agarwal 		RCU_INIT_POINTER(local->sched_scan_sdata, NULL);
13606ea0a69cSJohannes Berg 		RCU_INIT_POINTER(local->sched_scan_req, NULL);
1361d43c6b6eSDavid Spinadel 	}
1362d43c6b6eSDavid Spinadel 
1363d43c6b6eSDavid Spinadel 	return ret;
1364d43c6b6eSDavid Spinadel }
1365d43c6b6eSDavid Spinadel 
ieee80211_request_sched_scan_start(struct ieee80211_sub_if_data * sdata,struct cfg80211_sched_scan_request * req)1366d43c6b6eSDavid Spinadel int ieee80211_request_sched_scan_start(struct ieee80211_sub_if_data *sdata,
1367d43c6b6eSDavid Spinadel 				       struct cfg80211_sched_scan_request *req)
1368d43c6b6eSDavid Spinadel {
1369d43c6b6eSDavid Spinadel 	struct ieee80211_local *local = sdata->local;
1370d43c6b6eSDavid Spinadel 	int ret;
1371d43c6b6eSDavid Spinadel 
1372d43c6b6eSDavid Spinadel 	mutex_lock(&local->mtx);
1373d43c6b6eSDavid Spinadel 
1374d43c6b6eSDavid Spinadel 	if (rcu_access_pointer(local->sched_scan_sdata)) {
1375d43c6b6eSDavid Spinadel 		mutex_unlock(&local->mtx);
1376d43c6b6eSDavid Spinadel 		return -EBUSY;
1377d43c6b6eSDavid Spinadel 	}
1378d43c6b6eSDavid Spinadel 
1379d43c6b6eSDavid Spinadel 	ret = __ieee80211_request_sched_scan_start(sdata, req);
1380d43c6b6eSDavid Spinadel 
13815260a5b2SJohannes Berg 	mutex_unlock(&local->mtx);
138279f460caSLuciano Coelho 	return ret;
138379f460caSLuciano Coelho }
138479f460caSLuciano Coelho 
ieee80211_request_sched_scan_stop(struct ieee80211_local * local)13850d440ea2SEliad Peller int ieee80211_request_sched_scan_stop(struct ieee80211_local *local)
138679f460caSLuciano Coelho {
13870d440ea2SEliad Peller 	struct ieee80211_sub_if_data *sched_scan_sdata;
13880d440ea2SEliad Peller 	int ret = -ENOENT;
138979f460caSLuciano Coelho 
13905260a5b2SJohannes Berg 	mutex_lock(&local->mtx);
139179f460caSLuciano Coelho 
139279f460caSLuciano Coelho 	if (!local->ops->sched_scan_stop) {
139379f460caSLuciano Coelho 		ret = -ENOTSUPP;
139479f460caSLuciano Coelho 		goto out;
139579f460caSLuciano Coelho 	}
139679f460caSLuciano Coelho 
1397d43c6b6eSDavid Spinadel 	/* We don't want to restart sched scan anymore. */
13986ea0a69cSJohannes Berg 	RCU_INIT_POINTER(local->sched_scan_req, NULL);
1399d43c6b6eSDavid Spinadel 
14000d440ea2SEliad Peller 	sched_scan_sdata = rcu_dereference_protected(local->sched_scan_sdata,
14010d440ea2SEliad Peller 						lockdep_is_held(&local->mtx));
14020d440ea2SEliad Peller 	if (sched_scan_sdata) {
14030d440ea2SEliad Peller 		ret = drv_sched_scan_stop(local, sched_scan_sdata);
140471228a1eSAlexander Bondar 		if (!ret)
1405ad053a96SAndreea-Cristina Bernat 			RCU_INIT_POINTER(local->sched_scan_sdata, NULL);
140671228a1eSAlexander Bondar 	}
140779f460caSLuciano Coelho out:
14085260a5b2SJohannes Berg 	mutex_unlock(&local->mtx);
140979f460caSLuciano Coelho 
141079f460caSLuciano Coelho 	return ret;
141179f460caSLuciano Coelho }
141279f460caSLuciano Coelho 
ieee80211_sched_scan_results(struct ieee80211_hw * hw)141379f460caSLuciano Coelho void ieee80211_sched_scan_results(struct ieee80211_hw *hw)
141479f460caSLuciano Coelho {
141579f460caSLuciano Coelho 	struct ieee80211_local *local = hw_to_local(hw);
141679f460caSLuciano Coelho 
141779f460caSLuciano Coelho 	trace_api_sched_scan_results(local);
141879f460caSLuciano Coelho 
1419b34939b9SArend Van Spriel 	cfg80211_sched_scan_results(hw->wiphy, 0);
142079f460caSLuciano Coelho }
142179f460caSLuciano Coelho EXPORT_SYMBOL(ieee80211_sched_scan_results);
142279f460caSLuciano Coelho 
ieee80211_sched_scan_end(struct ieee80211_local * local)1423f6837ba8SJohannes Berg void ieee80211_sched_scan_end(struct ieee80211_local *local)
142485a9994aSLuciano Coelho {
142585a9994aSLuciano Coelho 	mutex_lock(&local->mtx);
142685a9994aSLuciano Coelho 
14275260a5b2SJohannes Berg 	if (!rcu_access_pointer(local->sched_scan_sdata)) {
142885a9994aSLuciano Coelho 		mutex_unlock(&local->mtx);
142985a9994aSLuciano Coelho 		return;
143085a9994aSLuciano Coelho 	}
143185a9994aSLuciano Coelho 
14320c2bef46SMonam Agarwal 	RCU_INIT_POINTER(local->sched_scan_sdata, NULL);
143385a9994aSLuciano Coelho 
1434d43c6b6eSDavid Spinadel 	/* If sched scan was aborted by the driver. */
14356ea0a69cSJohannes Berg 	RCU_INIT_POINTER(local->sched_scan_req, NULL);
1436d43c6b6eSDavid Spinadel 
143785a9994aSLuciano Coelho 	mutex_unlock(&local->mtx);
143885a9994aSLuciano Coelho 
1439e114cad7SJohannes Berg 	cfg80211_sched_scan_stopped_locked(local->hw.wiphy, 0);
144085a9994aSLuciano Coelho }
144185a9994aSLuciano Coelho 
ieee80211_sched_scan_stopped_work(struct wiphy * wiphy,struct wiphy_work * work)1442e114cad7SJohannes Berg void ieee80211_sched_scan_stopped_work(struct wiphy *wiphy,
1443e114cad7SJohannes Berg 				       struct wiphy_work *work)
1444f6837ba8SJohannes Berg {
1445f6837ba8SJohannes Berg 	struct ieee80211_local *local =
1446f6837ba8SJohannes Berg 		container_of(work, struct ieee80211_local,
1447f6837ba8SJohannes Berg 			     sched_scan_stopped_work);
1448f6837ba8SJohannes Berg 
1449f6837ba8SJohannes Berg 	ieee80211_sched_scan_end(local);
1450f6837ba8SJohannes Berg }
1451f6837ba8SJohannes Berg 
ieee80211_sched_scan_stopped(struct ieee80211_hw * hw)145279f460caSLuciano Coelho void ieee80211_sched_scan_stopped(struct ieee80211_hw *hw)
145379f460caSLuciano Coelho {
145479f460caSLuciano Coelho 	struct ieee80211_local *local = hw_to_local(hw);
145579f460caSLuciano Coelho 
145679f460caSLuciano Coelho 	trace_api_sched_scan_stopped(local);
145779f460caSLuciano Coelho 
14582bc533bdSEliad Peller 	/*
14592bc533bdSEliad Peller 	 * this shouldn't really happen, so for simplicity
14602bc533bdSEliad Peller 	 * simply ignore it, and let mac80211 reconfigure
14612bc533bdSEliad Peller 	 * the sched scan later on.
14622bc533bdSEliad Peller 	 */
14632bc533bdSEliad Peller 	if (local->in_reconfig)
14642bc533bdSEliad Peller 		return;
14652bc533bdSEliad Peller 
1466e114cad7SJohannes Berg 	wiphy_work_queue(hw->wiphy, &local->sched_scan_stopped_work);
146779f460caSLuciano Coelho }
146879f460caSLuciano Coelho EXPORT_SYMBOL(ieee80211_sched_scan_stopped);
1469