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