scan.c revision be4a4b6a5d2f76393f545a2545fbaa1b65577e13
10a51b27e956bd9580296c48191b78175ed8b5971Johannes Berg/*
25484e23749e78d5a4f56928efaf3c4b0d862b7a6Johannes Berg * Scanning implementation
35484e23749e78d5a4f56928efaf3c4b0d862b7a6Johannes Berg *
40a51b27e956bd9580296c48191b78175ed8b5971Johannes Berg * Copyright 2003, Jouni Malinen <jkmaline@cc.hut.fi>
50a51b27e956bd9580296c48191b78175ed8b5971Johannes Berg * Copyright 2004, Instant802 Networks, Inc.
60a51b27e956bd9580296c48191b78175ed8b5971Johannes Berg * Copyright 2005, Devicescape Software, Inc.
70a51b27e956bd9580296c48191b78175ed8b5971Johannes Berg * Copyright 2006-2007	Jiri Benc <jbenc@suse.cz>
80a51b27e956bd9580296c48191b78175ed8b5971Johannes Berg * Copyright 2007, Michael Wu <flamingice@sourmilk.net>
90a51b27e956bd9580296c48191b78175ed8b5971Johannes Berg *
100a51b27e956bd9580296c48191b78175ed8b5971Johannes Berg * This program is free software; you can redistribute it and/or modify
110a51b27e956bd9580296c48191b78175ed8b5971Johannes Berg * it under the terms of the GNU General Public License version 2 as
120a51b27e956bd9580296c48191b78175ed8b5971Johannes Berg * published by the Free Software Foundation.
130a51b27e956bd9580296c48191b78175ed8b5971Johannes Berg */
140a51b27e956bd9580296c48191b78175ed8b5971Johannes Berg
150a51b27e956bd9580296c48191b78175ed8b5971Johannes Berg#include <linux/if_arp.h>
16078e1e60dd6c6b0d4bc8d58ccb80c008e8efc9ffJohannes Berg#include <linux/rtnetlink.h>
17df13cce53a7b28a81460e6bfc4857e9df4956141Helmut Schaa#include <linux/pm_qos_params.h>
18df13cce53a7b28a81460e6bfc4857e9df4956141Helmut Schaa#include <net/sch_generic.h>
190a51b27e956bd9580296c48191b78175ed8b5971Johannes Berg#include <net/mac80211.h>
200a51b27e956bd9580296c48191b78175ed8b5971Johannes Berg
210a51b27e956bd9580296c48191b78175ed8b5971Johannes Berg#include "ieee80211_i.h"
222448798133d747ad339e57099e32a1d1e68aca1cJohannes Berg#include "driver-ops.h"
235484e23749e78d5a4f56928efaf3c4b0d862b7a6Johannes Berg#include "mesh.h"
240a51b27e956bd9580296c48191b78175ed8b5971Johannes Berg
250a51b27e956bd9580296c48191b78175ed8b5971Johannes Berg#define IEEE80211_PROBE_DELAY (HZ / 33)
260a51b27e956bd9580296c48191b78175ed8b5971Johannes Berg#define IEEE80211_CHANNEL_TIME (HZ / 33)
2796f7e73938da744e718ce4817dd3e7e424624654Helmut Schaa#define IEEE80211_PASSIVE_CHANNEL_TIME (HZ / 8)
280a51b27e956bd9580296c48191b78175ed8b5971Johannes Berg
29c2b13452b283f9c4a5b02a6b53ed6416ebf4c03cJohannes Bergstruct ieee80211_bss *
305484e23749e78d5a4f56928efaf3c4b0d862b7a6Johannes Bergieee80211_rx_bss_get(struct ieee80211_local *local, u8 *bssid, int freq,
315484e23749e78d5a4f56928efaf3c4b0d862b7a6Johannes Berg		     u8 *ssid, u8 ssid_len)
325484e23749e78d5a4f56928efaf3c4b0d862b7a6Johannes Berg{
330c1ad2cac1cb54db38fd4cc1822965071ee83f6eJohannes Berg	struct cfg80211_bss *cbss;
340c1ad2cac1cb54db38fd4cc1822965071ee83f6eJohannes Berg
350c1ad2cac1cb54db38fd4cc1822965071ee83f6eJohannes Berg	cbss = cfg80211_get_bss(local->hw.wiphy,
360c1ad2cac1cb54db38fd4cc1822965071ee83f6eJohannes Berg				ieee80211_get_channel(local->hw.wiphy, freq),
370c1ad2cac1cb54db38fd4cc1822965071ee83f6eJohannes Berg				bssid, ssid, ssid_len, 0, 0);
380c1ad2cac1cb54db38fd4cc1822965071ee83f6eJohannes Berg	if (!cbss)
390c1ad2cac1cb54db38fd4cc1822965071ee83f6eJohannes Berg		return NULL;
400c1ad2cac1cb54db38fd4cc1822965071ee83f6eJohannes Berg	return (void *)cbss->priv;
415484e23749e78d5a4f56928efaf3c4b0d862b7a6Johannes Berg}
425484e23749e78d5a4f56928efaf3c4b0d862b7a6Johannes Berg
4300d3f14cf9f12c21428121026a5e1d5f65926447Johannes Bergstatic void ieee80211_rx_bss_free(struct cfg80211_bss *cbss)
445484e23749e78d5a4f56928efaf3c4b0d862b7a6Johannes Berg{
450c1ad2cac1cb54db38fd4cc1822965071ee83f6eJohannes Berg	struct ieee80211_bss *bss = (void *)cbss->priv;
465484e23749e78d5a4f56928efaf3c4b0d862b7a6Johannes Berg
475484e23749e78d5a4f56928efaf3c4b0d862b7a6Johannes Berg	kfree(bss_mesh_id(bss));
485484e23749e78d5a4f56928efaf3c4b0d862b7a6Johannes Berg	kfree(bss_mesh_cfg(bss));
495484e23749e78d5a4f56928efaf3c4b0d862b7a6Johannes Berg}
505484e23749e78d5a4f56928efaf3c4b0d862b7a6Johannes Berg
515484e23749e78d5a4f56928efaf3c4b0d862b7a6Johannes Bergvoid ieee80211_rx_bss_put(struct ieee80211_local *local,
52c2b13452b283f9c4a5b02a6b53ed6416ebf4c03cJohannes Berg			  struct ieee80211_bss *bss)
535484e23749e78d5a4f56928efaf3c4b0d862b7a6Johannes Berg{
540c1ad2cac1cb54db38fd4cc1822965071ee83f6eJohannes Berg	if (!bss)
550c1ad2cac1cb54db38fd4cc1822965071ee83f6eJohannes Berg		return;
560c1ad2cac1cb54db38fd4cc1822965071ee83f6eJohannes Berg	cfg80211_put_bss(container_of((void *)bss, struct cfg80211_bss, priv));
575484e23749e78d5a4f56928efaf3c4b0d862b7a6Johannes Berg}
585484e23749e78d5a4f56928efaf3c4b0d862b7a6Johannes Berg
59ab13315af97919fae0e014748105fdc2e30afb2dKalle Valostatic bool is_uapsd_supported(struct ieee802_11_elems *elems)
60ab13315af97919fae0e014748105fdc2e30afb2dKalle Valo{
61ab13315af97919fae0e014748105fdc2e30afb2dKalle Valo	u8 qos_info;
62ab13315af97919fae0e014748105fdc2e30afb2dKalle Valo
63ab13315af97919fae0e014748105fdc2e30afb2dKalle Valo	if (elems->wmm_info && elems->wmm_info_len == 7
64ab13315af97919fae0e014748105fdc2e30afb2dKalle Valo	    && elems->wmm_info[5] == 1)
65ab13315af97919fae0e014748105fdc2e30afb2dKalle Valo		qos_info = elems->wmm_info[6];
66ab13315af97919fae0e014748105fdc2e30afb2dKalle Valo	else if (elems->wmm_param && elems->wmm_param_len == 24
67ab13315af97919fae0e014748105fdc2e30afb2dKalle Valo		 && elems->wmm_param[5] == 1)
68ab13315af97919fae0e014748105fdc2e30afb2dKalle Valo		qos_info = elems->wmm_param[6];
69ab13315af97919fae0e014748105fdc2e30afb2dKalle Valo	else
70ab13315af97919fae0e014748105fdc2e30afb2dKalle Valo		/* no valid wmm information or parameter element found */
71ab13315af97919fae0e014748105fdc2e30afb2dKalle Valo		return false;
72ab13315af97919fae0e014748105fdc2e30afb2dKalle Valo
73ab13315af97919fae0e014748105fdc2e30afb2dKalle Valo	return qos_info & IEEE80211_WMM_IE_AP_QOSINFO_UAPSD;
74ab13315af97919fae0e014748105fdc2e30afb2dKalle Valo}
75ab13315af97919fae0e014748105fdc2e30afb2dKalle Valo
76c2b13452b283f9c4a5b02a6b53ed6416ebf4c03cJohannes Bergstruct ieee80211_bss *
775484e23749e78d5a4f56928efaf3c4b0d862b7a6Johannes Bergieee80211_bss_info_update(struct ieee80211_local *local,
785484e23749e78d5a4f56928efaf3c4b0d862b7a6Johannes Berg			  struct ieee80211_rx_status *rx_status,
795484e23749e78d5a4f56928efaf3c4b0d862b7a6Johannes Berg			  struct ieee80211_mgmt *mgmt,
805484e23749e78d5a4f56928efaf3c4b0d862b7a6Johannes Berg			  size_t len,
815484e23749e78d5a4f56928efaf3c4b0d862b7a6Johannes Berg			  struct ieee802_11_elems *elems,
822a5193119269062608582418deba7af82844159aJohannes Berg			  struct ieee80211_channel *channel,
832a5193119269062608582418deba7af82844159aJohannes Berg			  bool beacon)
845484e23749e78d5a4f56928efaf3c4b0d862b7a6Johannes Berg{
850c1ad2cac1cb54db38fd4cc1822965071ee83f6eJohannes Berg	struct cfg80211_bss *cbss;
86c2b13452b283f9c4a5b02a6b53ed6416ebf4c03cJohannes Berg	struct ieee80211_bss *bss;
87f0b058b61711ebf5be94d6865ca7b2c259b71d37Stanislaw Gruszka	int clen, srlen;
882a5193119269062608582418deba7af82844159aJohannes Berg	s32 signal = 0;
892a5193119269062608582418deba7af82844159aJohannes Berg
9077965c970d7da9c9b6349ff2b1d9adecf54c403bJohannes Berg	if (local->hw.flags & IEEE80211_HW_SIGNAL_DBM)
912a5193119269062608582418deba7af82844159aJohannes Berg		signal = rx_status->signal * 100;
9277965c970d7da9c9b6349ff2b1d9adecf54c403bJohannes Berg	else if (local->hw.flags & IEEE80211_HW_SIGNAL_UNSPEC)
932a5193119269062608582418deba7af82844159aJohannes Berg		signal = (rx_status->signal * 100) / local->hw.max_signal;
942a5193119269062608582418deba7af82844159aJohannes Berg
950c1ad2cac1cb54db38fd4cc1822965071ee83f6eJohannes Berg	cbss = cfg80211_inform_bss_frame(local->hw.wiphy, channel,
960c1ad2cac1cb54db38fd4cc1822965071ee83f6eJohannes Berg					 mgmt, len, signal, GFP_ATOMIC);
975484e23749e78d5a4f56928efaf3c4b0d862b7a6Johannes Berg
980c1ad2cac1cb54db38fd4cc1822965071ee83f6eJohannes Berg	if (!cbss)
9900d3f14cf9f12c21428121026a5e1d5f65926447Johannes Berg		return NULL;
10000d3f14cf9f12c21428121026a5e1d5f65926447Johannes Berg
1010c1ad2cac1cb54db38fd4cc1822965071ee83f6eJohannes Berg	cbss->free_priv = ieee80211_rx_bss_free;
1020c1ad2cac1cb54db38fd4cc1822965071ee83f6eJohannes Berg	bss = (void *)cbss->priv;
1035484e23749e78d5a4f56928efaf3c4b0d862b7a6Johannes Berg
1045484e23749e78d5a4f56928efaf3c4b0d862b7a6Johannes Berg	/* save the ERP value so that it is available at association time */
1055484e23749e78d5a4f56928efaf3c4b0d862b7a6Johannes Berg	if (elems->erp_info && elems->erp_info_len >= 1) {
1065484e23749e78d5a4f56928efaf3c4b0d862b7a6Johannes Berg		bss->erp_value = elems->erp_info[0];
1075484e23749e78d5a4f56928efaf3c4b0d862b7a6Johannes Berg		bss->has_erp_value = 1;
1085484e23749e78d5a4f56928efaf3c4b0d862b7a6Johannes Berg	}
1095484e23749e78d5a4f56928efaf3c4b0d862b7a6Johannes Berg
1105484e23749e78d5a4f56928efaf3c4b0d862b7a6Johannes Berg	if (elems->tim) {
1115484e23749e78d5a4f56928efaf3c4b0d862b7a6Johannes Berg		struct ieee80211_tim_ie *tim_ie =
1125484e23749e78d5a4f56928efaf3c4b0d862b7a6Johannes Berg			(struct ieee80211_tim_ie *)elems->tim;
1135484e23749e78d5a4f56928efaf3c4b0d862b7a6Johannes Berg		bss->dtim_period = tim_ie->dtim_period;
1145484e23749e78d5a4f56928efaf3c4b0d862b7a6Johannes Berg	}
1155484e23749e78d5a4f56928efaf3c4b0d862b7a6Johannes Berg
116f0b058b61711ebf5be94d6865ca7b2c259b71d37Stanislaw Gruszka	/* replace old supported rates if we get new values */
117f0b058b61711ebf5be94d6865ca7b2c259b71d37Stanislaw Gruszka	srlen = 0;
1185484e23749e78d5a4f56928efaf3c4b0d862b7a6Johannes Berg	if (elems->supp_rates) {
119f0b058b61711ebf5be94d6865ca7b2c259b71d37Stanislaw Gruszka		clen = IEEE80211_MAX_SUPP_RATES;
1205484e23749e78d5a4f56928efaf3c4b0d862b7a6Johannes Berg		if (clen > elems->supp_rates_len)
1215484e23749e78d5a4f56928efaf3c4b0d862b7a6Johannes Berg			clen = elems->supp_rates_len;
122f0b058b61711ebf5be94d6865ca7b2c259b71d37Stanislaw Gruszka		memcpy(bss->supp_rates, elems->supp_rates, clen);
123f0b058b61711ebf5be94d6865ca7b2c259b71d37Stanislaw Gruszka		srlen += clen;
1245484e23749e78d5a4f56928efaf3c4b0d862b7a6Johannes Berg	}
1255484e23749e78d5a4f56928efaf3c4b0d862b7a6Johannes Berg	if (elems->ext_supp_rates) {
126f0b058b61711ebf5be94d6865ca7b2c259b71d37Stanislaw Gruszka		clen = IEEE80211_MAX_SUPP_RATES - srlen;
1275484e23749e78d5a4f56928efaf3c4b0d862b7a6Johannes Berg		if (clen > elems->ext_supp_rates_len)
1285484e23749e78d5a4f56928efaf3c4b0d862b7a6Johannes Berg			clen = elems->ext_supp_rates_len;
129f0b058b61711ebf5be94d6865ca7b2c259b71d37Stanislaw Gruszka		memcpy(bss->supp_rates + srlen, elems->ext_supp_rates, clen);
130f0b058b61711ebf5be94d6865ca7b2c259b71d37Stanislaw Gruszka		srlen += clen;
1315484e23749e78d5a4f56928efaf3c4b0d862b7a6Johannes Berg	}
132f0b058b61711ebf5be94d6865ca7b2c259b71d37Stanislaw Gruszka	if (srlen)
133f0b058b61711ebf5be94d6865ca7b2c259b71d37Stanislaw Gruszka		bss->supp_rates_len = srlen;
1345484e23749e78d5a4f56928efaf3c4b0d862b7a6Johannes Berg
1355484e23749e78d5a4f56928efaf3c4b0d862b7a6Johannes Berg	bss->wmm_used = elems->wmm_param || elems->wmm_info;
136ab13315af97919fae0e014748105fdc2e30afb2dKalle Valo	bss->uapsd_supported = is_uapsd_supported(elems);
1375484e23749e78d5a4f56928efaf3c4b0d862b7a6Johannes Berg
1385484e23749e78d5a4f56928efaf3c4b0d862b7a6Johannes Berg	if (!beacon)
1395484e23749e78d5a4f56928efaf3c4b0d862b7a6Johannes Berg		bss->last_probe_resp = jiffies;
1405484e23749e78d5a4f56928efaf3c4b0d862b7a6Johannes Berg
1415484e23749e78d5a4f56928efaf3c4b0d862b7a6Johannes Berg	return bss;
1425484e23749e78d5a4f56928efaf3c4b0d862b7a6Johannes Berg}
1430a51b27e956bd9580296c48191b78175ed8b5971Johannes Berg
14498c8fccfaea838e62ffde2f2e44568844e0e5472Johannes Bergieee80211_rx_result
145f1d58c2521eb160178b2151d6326d8dc5d7c8560Johannes Bergieee80211_scan_rx(struct ieee80211_sub_if_data *sdata, struct sk_buff *skb)
14698c8fccfaea838e62ffde2f2e44568844e0e5472Johannes Berg{
147f1d58c2521eb160178b2151d6326d8dc5d7c8560Johannes Berg	struct ieee80211_rx_status *rx_status = IEEE80211_SKB_RXCB(skb);
14898c8fccfaea838e62ffde2f2e44568844e0e5472Johannes Berg	struct ieee80211_mgmt *mgmt;
149c2b13452b283f9c4a5b02a6b53ed6416ebf4c03cJohannes Berg	struct ieee80211_bss *bss;
15098c8fccfaea838e62ffde2f2e44568844e0e5472Johannes Berg	u8 *elements;
15198c8fccfaea838e62ffde2f2e44568844e0e5472Johannes Berg	struct ieee80211_channel *channel;
15298c8fccfaea838e62ffde2f2e44568844e0e5472Johannes Berg	size_t baselen;
15398c8fccfaea838e62ffde2f2e44568844e0e5472Johannes Berg	int freq;
15498c8fccfaea838e62ffde2f2e44568844e0e5472Johannes Berg	__le16 fc;
15598c8fccfaea838e62ffde2f2e44568844e0e5472Johannes Berg	bool presp, beacon = false;
15698c8fccfaea838e62ffde2f2e44568844e0e5472Johannes Berg	struct ieee802_11_elems elems;
15798c8fccfaea838e62ffde2f2e44568844e0e5472Johannes Berg
15898c8fccfaea838e62ffde2f2e44568844e0e5472Johannes Berg	if (skb->len < 2)
15998c8fccfaea838e62ffde2f2e44568844e0e5472Johannes Berg		return RX_DROP_UNUSABLE;
16098c8fccfaea838e62ffde2f2e44568844e0e5472Johannes Berg
16198c8fccfaea838e62ffde2f2e44568844e0e5472Johannes Berg	mgmt = (struct ieee80211_mgmt *) skb->data;
16298c8fccfaea838e62ffde2f2e44568844e0e5472Johannes Berg	fc = mgmt->frame_control;
16398c8fccfaea838e62ffde2f2e44568844e0e5472Johannes Berg
16498c8fccfaea838e62ffde2f2e44568844e0e5472Johannes Berg	if (ieee80211_is_ctl(fc))
16598c8fccfaea838e62ffde2f2e44568844e0e5472Johannes Berg		return RX_CONTINUE;
16698c8fccfaea838e62ffde2f2e44568844e0e5472Johannes Berg
16798c8fccfaea838e62ffde2f2e44568844e0e5472Johannes Berg	if (skb->len < 24)
16898c8fccfaea838e62ffde2f2e44568844e0e5472Johannes Berg		return RX_DROP_MONITOR;
16998c8fccfaea838e62ffde2f2e44568844e0e5472Johannes Berg
17098c8fccfaea838e62ffde2f2e44568844e0e5472Johannes Berg	presp = ieee80211_is_probe_resp(fc);
17198c8fccfaea838e62ffde2f2e44568844e0e5472Johannes Berg	if (presp) {
17298c8fccfaea838e62ffde2f2e44568844e0e5472Johannes Berg		/* ignore ProbeResp to foreign address */
17347846c9b0c10808d9337d2e7d09361f3e0a0a71aJohannes Berg		if (memcmp(mgmt->da, sdata->vif.addr, ETH_ALEN))
17498c8fccfaea838e62ffde2f2e44568844e0e5472Johannes Berg			return RX_DROP_MONITOR;
17598c8fccfaea838e62ffde2f2e44568844e0e5472Johannes Berg
17698c8fccfaea838e62ffde2f2e44568844e0e5472Johannes Berg		presp = true;
17798c8fccfaea838e62ffde2f2e44568844e0e5472Johannes Berg		elements = mgmt->u.probe_resp.variable;
17898c8fccfaea838e62ffde2f2e44568844e0e5472Johannes Berg		baselen = offsetof(struct ieee80211_mgmt, u.probe_resp.variable);
17998c8fccfaea838e62ffde2f2e44568844e0e5472Johannes Berg	} else {
18098c8fccfaea838e62ffde2f2e44568844e0e5472Johannes Berg		beacon = ieee80211_is_beacon(fc);
18198c8fccfaea838e62ffde2f2e44568844e0e5472Johannes Berg		baselen = offsetof(struct ieee80211_mgmt, u.beacon.variable);
18298c8fccfaea838e62ffde2f2e44568844e0e5472Johannes Berg		elements = mgmt->u.beacon.variable;
18398c8fccfaea838e62ffde2f2e44568844e0e5472Johannes Berg	}
18498c8fccfaea838e62ffde2f2e44568844e0e5472Johannes Berg
18598c8fccfaea838e62ffde2f2e44568844e0e5472Johannes Berg	if (!presp && !beacon)
18698c8fccfaea838e62ffde2f2e44568844e0e5472Johannes Berg		return RX_CONTINUE;
18798c8fccfaea838e62ffde2f2e44568844e0e5472Johannes Berg
18898c8fccfaea838e62ffde2f2e44568844e0e5472Johannes Berg	if (baselen > skb->len)
18998c8fccfaea838e62ffde2f2e44568844e0e5472Johannes Berg		return RX_DROP_MONITOR;
19098c8fccfaea838e62ffde2f2e44568844e0e5472Johannes Berg
19198c8fccfaea838e62ffde2f2e44568844e0e5472Johannes Berg	ieee802_11_parse_elems(elements, skb->len - baselen, &elems);
19298c8fccfaea838e62ffde2f2e44568844e0e5472Johannes Berg
19398c8fccfaea838e62ffde2f2e44568844e0e5472Johannes Berg	if (elems.ds_params && elems.ds_params_len == 1)
19498c8fccfaea838e62ffde2f2e44568844e0e5472Johannes Berg		freq = ieee80211_channel_to_frequency(elems.ds_params[0]);
19598c8fccfaea838e62ffde2f2e44568844e0e5472Johannes Berg	else
19698c8fccfaea838e62ffde2f2e44568844e0e5472Johannes Berg		freq = rx_status->freq;
19798c8fccfaea838e62ffde2f2e44568844e0e5472Johannes Berg
19898c8fccfaea838e62ffde2f2e44568844e0e5472Johannes Berg	channel = ieee80211_get_channel(sdata->local->hw.wiphy, freq);
19998c8fccfaea838e62ffde2f2e44568844e0e5472Johannes Berg
20098c8fccfaea838e62ffde2f2e44568844e0e5472Johannes Berg	if (!channel || channel->flags & IEEE80211_CHAN_DISABLED)
20198c8fccfaea838e62ffde2f2e44568844e0e5472Johannes Berg		return RX_DROP_MONITOR;
20298c8fccfaea838e62ffde2f2e44568844e0e5472Johannes Berg
20398c8fccfaea838e62ffde2f2e44568844e0e5472Johannes Berg	bss = ieee80211_bss_info_update(sdata->local, rx_status,
20498c8fccfaea838e62ffde2f2e44568844e0e5472Johannes Berg					mgmt, skb->len, &elems,
2052a5193119269062608582418deba7af82844159aJohannes Berg					channel, beacon);
206d048e503a2b01e771ee87921c24d89d7ec3f0c2fJouni Malinen	if (bss)
207d048e503a2b01e771ee87921c24d89d7ec3f0c2fJouni Malinen		ieee80211_rx_bss_put(sdata->local, bss);
20898c8fccfaea838e62ffde2f2e44568844e0e5472Johannes Berg
20998c8fccfaea838e62ffde2f2e44568844e0e5472Johannes Berg	dev_kfree_skb(skb);
21098c8fccfaea838e62ffde2f2e44568844e0e5472Johannes Berg	return RX_QUEUED;
21198c8fccfaea838e62ffde2f2e44568844e0e5472Johannes Berg}
21298c8fccfaea838e62ffde2f2e44568844e0e5472Johannes Berg
2134d36ec58239eec44d77839ef6c25108efcbbb58cJohannes Berg/* return false if no more work */
2144d36ec58239eec44d77839ef6c25108efcbbb58cJohannes Bergstatic bool ieee80211_prep_hw_scan(struct ieee80211_local *local)
2154d36ec58239eec44d77839ef6c25108efcbbb58cJohannes Berg{
2164d36ec58239eec44d77839ef6c25108efcbbb58cJohannes Berg	struct cfg80211_scan_request *req = local->scan_req;
2174d36ec58239eec44d77839ef6c25108efcbbb58cJohannes Berg	enum ieee80211_band band;
2184d36ec58239eec44d77839ef6c25108efcbbb58cJohannes Berg	int i, ielen, n_chans;
2194d36ec58239eec44d77839ef6c25108efcbbb58cJohannes Berg
2204d36ec58239eec44d77839ef6c25108efcbbb58cJohannes Berg	do {
2214d36ec58239eec44d77839ef6c25108efcbbb58cJohannes Berg		if (local->hw_scan_band == IEEE80211_NUM_BANDS)
2224d36ec58239eec44d77839ef6c25108efcbbb58cJohannes Berg			return false;
2234d36ec58239eec44d77839ef6c25108efcbbb58cJohannes Berg
2244d36ec58239eec44d77839ef6c25108efcbbb58cJohannes Berg		band = local->hw_scan_band;
2254d36ec58239eec44d77839ef6c25108efcbbb58cJohannes Berg		n_chans = 0;
2264d36ec58239eec44d77839ef6c25108efcbbb58cJohannes Berg		for (i = 0; i < req->n_channels; i++) {
2274d36ec58239eec44d77839ef6c25108efcbbb58cJohannes Berg			if (req->channels[i]->band == band) {
2284d36ec58239eec44d77839ef6c25108efcbbb58cJohannes Berg				local->hw_scan_req->channels[n_chans] =
2294d36ec58239eec44d77839ef6c25108efcbbb58cJohannes Berg							req->channels[i];
2304d36ec58239eec44d77839ef6c25108efcbbb58cJohannes Berg				n_chans++;
2314d36ec58239eec44d77839ef6c25108efcbbb58cJohannes Berg			}
2324d36ec58239eec44d77839ef6c25108efcbbb58cJohannes Berg		}
2334d36ec58239eec44d77839ef6c25108efcbbb58cJohannes Berg
2344d36ec58239eec44d77839ef6c25108efcbbb58cJohannes Berg		local->hw_scan_band++;
2354d36ec58239eec44d77839ef6c25108efcbbb58cJohannes Berg	} while (!n_chans);
2364d36ec58239eec44d77839ef6c25108efcbbb58cJohannes Berg
2374d36ec58239eec44d77839ef6c25108efcbbb58cJohannes Berg	local->hw_scan_req->n_channels = n_chans;
2384d36ec58239eec44d77839ef6c25108efcbbb58cJohannes Berg
2394d36ec58239eec44d77839ef6c25108efcbbb58cJohannes Berg	ielen = ieee80211_build_preq_ies(local, (u8 *)local->hw_scan_req->ie,
2404d36ec58239eec44d77839ef6c25108efcbbb58cJohannes Berg					 req->ie, req->ie_len, band);
2414d36ec58239eec44d77839ef6c25108efcbbb58cJohannes Berg	local->hw_scan_req->ie_len = ielen;
2424d36ec58239eec44d77839ef6c25108efcbbb58cJohannes Berg
2434d36ec58239eec44d77839ef6c25108efcbbb58cJohannes Berg	return true;
2444d36ec58239eec44d77839ef6c25108efcbbb58cJohannes Berg}
2454d36ec58239eec44d77839ef6c25108efcbbb58cJohannes Berg
2462a5193119269062608582418deba7af82844159aJohannes Bergvoid ieee80211_scan_completed(struct ieee80211_hw *hw, bool aborted)
2470a51b27e956bd9580296c48191b78175ed8b5971Johannes Berg{
2480a51b27e956bd9580296c48191b78175ed8b5971Johannes Berg	struct ieee80211_local *local = hw_to_local(hw);
249f3b85252f081581a8f257545ed748062dce7798bJohannes Berg	bool was_hw_scan;
2500a51b27e956bd9580296c48191b78175ed8b5971Johannes Berg
251b5878a2dc5e7e7f031a52c3e15b571224cb6b540Johannes Berg	trace_api_scan_completed(local, aborted);
252b5878a2dc5e7e7f031a52c3e15b571224cb6b540Johannes Berg
253f3b85252f081581a8f257545ed748062dce7798bJohannes Berg	mutex_lock(&local->scan_mtx);
2545bc75728fd43bb15b46f16ef465bcf9d487393cfJohannes Berg
2556d3560d4fc9c5b9fe1a07a63926ea70512c69c32Johannes Berg	/*
2566d3560d4fc9c5b9fe1a07a63926ea70512c69c32Johannes Berg	 * It's ok to abort a not-yet-running scan (that
2576d3560d4fc9c5b9fe1a07a63926ea70512c69c32Johannes Berg	 * we have one at all will be verified by checking
2586d3560d4fc9c5b9fe1a07a63926ea70512c69c32Johannes Berg	 * local->scan_req next), but not to complete it
2596d3560d4fc9c5b9fe1a07a63926ea70512c69c32Johannes Berg	 * successfully.
2606d3560d4fc9c5b9fe1a07a63926ea70512c69c32Johannes Berg	 */
2616d3560d4fc9c5b9fe1a07a63926ea70512c69c32Johannes Berg	if (WARN_ON(!local->scanning && !aborted))
2626d3560d4fc9c5b9fe1a07a63926ea70512c69c32Johannes Berg		aborted = true;
2635bc75728fd43bb15b46f16ef465bcf9d487393cfJohannes Berg
264f3b85252f081581a8f257545ed748062dce7798bJohannes Berg	if (WARN_ON(!local->scan_req)) {
265f3b85252f081581a8f257545ed748062dce7798bJohannes Berg		mutex_unlock(&local->scan_mtx);
266f3b85252f081581a8f257545ed748062dce7798bJohannes Berg		return;
267de95a54b1aebe5592cae971ca5e5d9ec6a381a17Johannes Berg	}
268de95a54b1aebe5592cae971ca5e5d9ec6a381a17Johannes Berg
2694d36ec58239eec44d77839ef6c25108efcbbb58cJohannes Berg	was_hw_scan = test_bit(SCAN_HW_SCANNING, &local->scanning);
2704d36ec58239eec44d77839ef6c25108efcbbb58cJohannes Berg	if (was_hw_scan && !aborted && ieee80211_prep_hw_scan(local)) {
2714d36ec58239eec44d77839ef6c25108efcbbb58cJohannes Berg		ieee80211_queue_delayed_work(&local->hw,
2724d36ec58239eec44d77839ef6c25108efcbbb58cJohannes Berg					     &local->scan_work, 0);
2734d36ec58239eec44d77839ef6c25108efcbbb58cJohannes Berg		mutex_unlock(&local->scan_mtx);
2744d36ec58239eec44d77839ef6c25108efcbbb58cJohannes Berg		return;
2754d36ec58239eec44d77839ef6c25108efcbbb58cJohannes Berg	}
2764d36ec58239eec44d77839ef6c25108efcbbb58cJohannes Berg
2774d36ec58239eec44d77839ef6c25108efcbbb58cJohannes Berg	kfree(local->hw_scan_req);
2784d36ec58239eec44d77839ef6c25108efcbbb58cJohannes Berg	local->hw_scan_req = NULL;
279f3b85252f081581a8f257545ed748062dce7798bJohannes Berg
2805ba63533bbf653631faab60f6988506160ec6ba4Johannes Berg	if (local->scan_req != local->int_scan_req)
2812a5193119269062608582418deba7af82844159aJohannes Berg		cfg80211_scan_done(local->scan_req, aborted);
2822a5193119269062608582418deba7af82844159aJohannes Berg	local->scan_req = NULL;
28315db0b7fd872b0312033666d3a82e1214a227ec0Johannes Berg	local->scan_sdata = NULL;
2842a5193119269062608582418deba7af82844159aJohannes Berg
285fbe9c429f195111bbf7f1630efa19aee295fd8e7Helmut Schaa	local->scanning = 0;
28658905ca5b11a0ff3860f55b789cbbf052f7158a7Johannes Berg	local->scan_channel = NULL;
287f3b85252f081581a8f257545ed748062dce7798bJohannes Berg
288f3b85252f081581a8f257545ed748062dce7798bJohannes Berg	/* we only have to protect scan_req and hw/sw scan */
289f3b85252f081581a8f257545ed748062dce7798bJohannes Berg	mutex_unlock(&local->scan_mtx);
290f3b85252f081581a8f257545ed748062dce7798bJohannes Berg
291e8975581f63870be42ff4662b293d1b0c8c21350Johannes Berg	ieee80211_hw_config(local, IEEE80211_CONF_CHANGE_CHANNEL);
2925cff20e6c5a6591a79d3b027af222870f52bb550Johannes Berg	if (was_hw_scan)
2935cff20e6c5a6591a79d3b027af222870f52bb550Johannes Berg		goto done;
2940a51b27e956bd9580296c48191b78175ed8b5971Johannes Berg
2953ac64beecd27400d12cc7afb4108eef26c499f6aJohannes Berg	ieee80211_configure_filter(local);
2960a51b27e956bd9580296c48191b78175ed8b5971Johannes Berg
2972448798133d747ad339e57099e32a1d1e68aca1cJohannes Berg	drv_sw_scan_complete(local);
29880e775bf08f1915870fbb0c1c7a45a3fdc291721Michael Buesch
299b203ffc3a447eb8d9e6120b783ddee081b143061Jouni Malinen	ieee80211_offchannel_return(local, true);
3000a51b27e956bd9580296c48191b78175ed8b5971Johannes Berg
3010a51b27e956bd9580296c48191b78175ed8b5971Johannes Berg done:
3025cff20e6c5a6591a79d3b027af222870f52bb550Johannes Berg	ieee80211_recalc_idle(local);
3030a51b27e956bd9580296c48191b78175ed8b5971Johannes Berg	ieee80211_mlme_notify_scan_completed(local);
304469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg	ieee80211_ibss_notify_scan_completed(local);
305472dbc45dc1966284de72d7de15690c17ed2cf33Johannes Berg	ieee80211_mesh_notify_scan_completed(local);
30681ac3462d346ee7aaf037a35156b0a7a354e98cfJohannes Berg	ieee80211_queue_work(&local->hw, &local->work_work);
3070a51b27e956bd9580296c48191b78175ed8b5971Johannes Berg}
3080a51b27e956bd9580296c48191b78175ed8b5971Johannes BergEXPORT_SYMBOL(ieee80211_scan_completed);
3090a51b27e956bd9580296c48191b78175ed8b5971Johannes Berg
310f3b85252f081581a8f257545ed748062dce7798bJohannes Bergstatic int ieee80211_start_sw_scan(struct ieee80211_local *local)
311f3b85252f081581a8f257545ed748062dce7798bJohannes Berg{
312f3b85252f081581a8f257545ed748062dce7798bJohannes Berg	/*
313f3b85252f081581a8f257545ed748062dce7798bJohannes Berg	 * Hardware/driver doesn't support hw_scan, so use software
314f3b85252f081581a8f257545ed748062dce7798bJohannes Berg	 * scanning instead. First send a nullfunc frame with power save
315f3b85252f081581a8f257545ed748062dce7798bJohannes Berg	 * bit on so that AP will buffer the frames for us while we are not
316f3b85252f081581a8f257545ed748062dce7798bJohannes Berg	 * listening, then send probe requests to each channel and wait for
317f3b85252f081581a8f257545ed748062dce7798bJohannes Berg	 * the responses. After all channels are scanned, tune back to the
318f3b85252f081581a8f257545ed748062dce7798bJohannes Berg	 * original channel and send a nullfunc frame with power save bit
319f3b85252f081581a8f257545ed748062dce7798bJohannes Berg	 * off to trigger the AP to send us all the buffered frames.
320f3b85252f081581a8f257545ed748062dce7798bJohannes Berg	 *
321f3b85252f081581a8f257545ed748062dce7798bJohannes Berg	 * Note that while local->sw_scanning is true everything else but
322f3b85252f081581a8f257545ed748062dce7798bJohannes Berg	 * nullfunc frames and probe requests will be dropped in
323f3b85252f081581a8f257545ed748062dce7798bJohannes Berg	 * ieee80211_tx_h_check_assoc().
324f3b85252f081581a8f257545ed748062dce7798bJohannes Berg	 */
3252448798133d747ad339e57099e32a1d1e68aca1cJohannes Berg	drv_sw_scan_start(local);
326f3b85252f081581a8f257545ed748062dce7798bJohannes Berg
327b203ffc3a447eb8d9e6120b783ddee081b143061Jouni Malinen	ieee80211_offchannel_stop_beaconing(local);
328f3b85252f081581a8f257545ed748062dce7798bJohannes Berg
329df13cce53a7b28a81460e6bfc4857e9df4956141Helmut Schaa	local->leave_oper_channel_time = 0;
330977923b00c79185c11b4b47664f5ffa4c3820438Helmut Schaa	local->next_scan_state = SCAN_DECISION;
331f3b85252f081581a8f257545ed748062dce7798bJohannes Berg	local->scan_channel_idx = 0;
332f3b85252f081581a8f257545ed748062dce7798bJohannes Berg
333a80f7c0b088187c8471b441d461e937991870661Johannes Berg	drv_flush(local, false);
334a80f7c0b088187c8471b441d461e937991870661Johannes Berg
3353ac64beecd27400d12cc7afb4108eef26c499f6aJohannes Berg	ieee80211_configure_filter(local);
336f3b85252f081581a8f257545ed748062dce7798bJohannes Berg
33742935ecaf4e784d0815afa9a7e5fe7e141157ca3Luis R. Rodriguez	ieee80211_queue_delayed_work(&local->hw,
33842935ecaf4e784d0815afa9a7e5fe7e141157ca3Luis R. Rodriguez				     &local->scan_work,
33942935ecaf4e784d0815afa9a7e5fe7e141157ca3Luis R. Rodriguez				     IEEE80211_CHANNEL_TIME);
340f3b85252f081581a8f257545ed748062dce7798bJohannes Berg
341f3b85252f081581a8f257545ed748062dce7798bJohannes Berg	return 0;
342f3b85252f081581a8f257545ed748062dce7798bJohannes Berg}
343f3b85252f081581a8f257545ed748062dce7798bJohannes Berg
344f3b85252f081581a8f257545ed748062dce7798bJohannes Berg
345f3b85252f081581a8f257545ed748062dce7798bJohannes Bergstatic int __ieee80211_start_scan(struct ieee80211_sub_if_data *sdata,
346f3b85252f081581a8f257545ed748062dce7798bJohannes Berg				  struct cfg80211_scan_request *req)
347f3b85252f081581a8f257545ed748062dce7798bJohannes Berg{
348f3b85252f081581a8f257545ed748062dce7798bJohannes Berg	struct ieee80211_local *local = sdata->local;
349f3b85252f081581a8f257545ed748062dce7798bJohannes Berg	int rc;
350f3b85252f081581a8f257545ed748062dce7798bJohannes Berg
351f3b85252f081581a8f257545ed748062dce7798bJohannes Berg	if (local->scan_req)
352f3b85252f081581a8f257545ed748062dce7798bJohannes Berg		return -EBUSY;
353f3b85252f081581a8f257545ed748062dce7798bJohannes Berg
3546e7e6213e4956828927c30e3ef5a42812d00c650John W. Linville	if (!list_empty(&local->work_list)) {
3556e7e6213e4956828927c30e3ef5a42812d00c650John W. Linville		/* wait for the work to finish/time out */
356c0ce77b8323c1a0d4eeef97caf16c0ea971222a9Johannes Berg		local->scan_req = req;
357c0ce77b8323c1a0d4eeef97caf16c0ea971222a9Johannes Berg		local->scan_sdata = sdata;
358c0ce77b8323c1a0d4eeef97caf16c0ea971222a9Johannes Berg		return 0;
359c0ce77b8323c1a0d4eeef97caf16c0ea971222a9Johannes Berg	}
360c0ce77b8323c1a0d4eeef97caf16c0ea971222a9Johannes Berg
361f3b85252f081581a8f257545ed748062dce7798bJohannes Berg	if (local->ops->hw_scan) {
362f3b85252f081581a8f257545ed748062dce7798bJohannes Berg		u8 *ies;
363f3b85252f081581a8f257545ed748062dce7798bJohannes Berg
3644d36ec58239eec44d77839ef6c25108efcbbb58cJohannes Berg		local->hw_scan_req = kmalloc(
3654d36ec58239eec44d77839ef6c25108efcbbb58cJohannes Berg				sizeof(*local->hw_scan_req) +
3664d36ec58239eec44d77839ef6c25108efcbbb58cJohannes Berg				req->n_channels * sizeof(req->channels[0]) +
3674d36ec58239eec44d77839ef6c25108efcbbb58cJohannes Berg				2 + IEEE80211_MAX_SSID_LEN + local->scan_ies_len +
3684d36ec58239eec44d77839ef6c25108efcbbb58cJohannes Berg				req->ie_len, GFP_KERNEL);
3694d36ec58239eec44d77839ef6c25108efcbbb58cJohannes Berg		if (!local->hw_scan_req)
370f3b85252f081581a8f257545ed748062dce7798bJohannes Berg			return -ENOMEM;
371f3b85252f081581a8f257545ed748062dce7798bJohannes Berg
3724d36ec58239eec44d77839ef6c25108efcbbb58cJohannes Berg		local->hw_scan_req->ssids = req->ssids;
3734d36ec58239eec44d77839ef6c25108efcbbb58cJohannes Berg		local->hw_scan_req->n_ssids = req->n_ssids;
3744d36ec58239eec44d77839ef6c25108efcbbb58cJohannes Berg		ies = (u8 *)local->hw_scan_req +
3754d36ec58239eec44d77839ef6c25108efcbbb58cJohannes Berg			sizeof(*local->hw_scan_req) +
3764d36ec58239eec44d77839ef6c25108efcbbb58cJohannes Berg			req->n_channels * sizeof(req->channels[0]);
3774d36ec58239eec44d77839ef6c25108efcbbb58cJohannes Berg		local->hw_scan_req->ie = ies;
3784d36ec58239eec44d77839ef6c25108efcbbb58cJohannes Berg
3794d36ec58239eec44d77839ef6c25108efcbbb58cJohannes Berg		local->hw_scan_band = 0;
3806e7e6213e4956828927c30e3ef5a42812d00c650John W. Linville
3816e7e6213e4956828927c30e3ef5a42812d00c650John W. Linville		/*
3826e7e6213e4956828927c30e3ef5a42812d00c650John W. Linville		 * After allocating local->hw_scan_req, we must
3836e7e6213e4956828927c30e3ef5a42812d00c650John W. Linville		 * go through until ieee80211_prep_hw_scan(), so
3846e7e6213e4956828927c30e3ef5a42812d00c650John W. Linville		 * anything that might be changed here and leave
3856e7e6213e4956828927c30e3ef5a42812d00c650John W. Linville		 * this function early must not go after this
3866e7e6213e4956828927c30e3ef5a42812d00c650John W. Linville		 * allocation.
3876e7e6213e4956828927c30e3ef5a42812d00c650John W. Linville		 */
388f3b85252f081581a8f257545ed748062dce7798bJohannes Berg	}
389f3b85252f081581a8f257545ed748062dce7798bJohannes Berg
390f3b85252f081581a8f257545ed748062dce7798bJohannes Berg	local->scan_req = req;
391f3b85252f081581a8f257545ed748062dce7798bJohannes Berg	local->scan_sdata = sdata;
392f3b85252f081581a8f257545ed748062dce7798bJohannes Berg
393f3b85252f081581a8f257545ed748062dce7798bJohannes Berg	if (local->ops->hw_scan)
394fbe9c429f195111bbf7f1630efa19aee295fd8e7Helmut Schaa		__set_bit(SCAN_HW_SCANNING, &local->scanning);
395f3b85252f081581a8f257545ed748062dce7798bJohannes Berg	else
396fbe9c429f195111bbf7f1630efa19aee295fd8e7Helmut Schaa		__set_bit(SCAN_SW_SCANNING, &local->scanning);
3976e7e6213e4956828927c30e3ef5a42812d00c650John W. Linville
398f3b85252f081581a8f257545ed748062dce7798bJohannes Berg	/*
399f3b85252f081581a8f257545ed748062dce7798bJohannes Berg	 * Kicking off the scan need not be protected,
400f3b85252f081581a8f257545ed748062dce7798bJohannes Berg	 * only the scan variable stuff, since now
401f3b85252f081581a8f257545ed748062dce7798bJohannes Berg	 * local->scan_req is assigned and other callers
402f3b85252f081581a8f257545ed748062dce7798bJohannes Berg	 * will abort their scan attempts.
403f3b85252f081581a8f257545ed748062dce7798bJohannes Berg	 *
4046e7e6213e4956828927c30e3ef5a42812d00c650John W. Linville	 * This avoids too many locking dependencies
4056e7e6213e4956828927c30e3ef5a42812d00c650John W. Linville	 * so that the scan completed calls have more
4066e7e6213e4956828927c30e3ef5a42812d00c650John W. Linville	 * locking freedom.
407f3b85252f081581a8f257545ed748062dce7798bJohannes Berg	 */
4085cff20e6c5a6591a79d3b027af222870f52bb550Johannes Berg
4095cff20e6c5a6591a79d3b027af222870f52bb550Johannes Berg	ieee80211_recalc_idle(local);
410f3b85252f081581a8f257545ed748062dce7798bJohannes Berg	mutex_unlock(&local->scan_mtx);
411f3b85252f081581a8f257545ed748062dce7798bJohannes Berg
4124d36ec58239eec44d77839ef6c25108efcbbb58cJohannes Berg	if (local->ops->hw_scan) {
4134d36ec58239eec44d77839ef6c25108efcbbb58cJohannes Berg		WARN_ON(!ieee80211_prep_hw_scan(local));
414a060bbfe4ee95d115e8f9705a66894ac34e2c475Johannes Berg		rc = drv_hw_scan(local, sdata, local->hw_scan_req);
4154d36ec58239eec44d77839ef6c25108efcbbb58cJohannes Berg	} else
416f3b85252f081581a8f257545ed748062dce7798bJohannes Berg		rc = ieee80211_start_sw_scan(local);
417f3b85252f081581a8f257545ed748062dce7798bJohannes Berg
418f3b85252f081581a8f257545ed748062dce7798bJohannes Berg	mutex_lock(&local->scan_mtx);
419f3b85252f081581a8f257545ed748062dce7798bJohannes Berg
420f3b85252f081581a8f257545ed748062dce7798bJohannes Berg	if (rc) {
4214d36ec58239eec44d77839ef6c25108efcbbb58cJohannes Berg		kfree(local->hw_scan_req);
4224d36ec58239eec44d77839ef6c25108efcbbb58cJohannes Berg		local->hw_scan_req = NULL;
423fbe9c429f195111bbf7f1630efa19aee295fd8e7Helmut Schaa		local->scanning = 0;
424f3b85252f081581a8f257545ed748062dce7798bJohannes Berg
4255cff20e6c5a6591a79d3b027af222870f52bb550Johannes Berg		ieee80211_recalc_idle(local);
4265cff20e6c5a6591a79d3b027af222870f52bb550Johannes Berg
427f3b85252f081581a8f257545ed748062dce7798bJohannes Berg		local->scan_req = NULL;
428f3b85252f081581a8f257545ed748062dce7798bJohannes Berg		local->scan_sdata = NULL;
429f3b85252f081581a8f257545ed748062dce7798bJohannes Berg	}
430f3b85252f081581a8f257545ed748062dce7798bJohannes Berg
431f3b85252f081581a8f257545ed748062dce7798bJohannes Berg	return rc;
432f3b85252f081581a8f257545ed748062dce7798bJohannes Berg}
433f3b85252f081581a8f257545ed748062dce7798bJohannes Berg
434df13cce53a7b28a81460e6bfc4857e9df4956141Helmut Schaastatic unsigned long
435df13cce53a7b28a81460e6bfc4857e9df4956141Helmut Schaaieee80211_scan_get_channel_time(struct ieee80211_channel *chan)
436df13cce53a7b28a81460e6bfc4857e9df4956141Helmut Schaa{
437df13cce53a7b28a81460e6bfc4857e9df4956141Helmut Schaa	/*
438df13cce53a7b28a81460e6bfc4857e9df4956141Helmut Schaa	 * TODO: channel switching also consumes quite some time,
439df13cce53a7b28a81460e6bfc4857e9df4956141Helmut Schaa	 * add that delay as well to get a better estimation
440df13cce53a7b28a81460e6bfc4857e9df4956141Helmut Schaa	 */
441df13cce53a7b28a81460e6bfc4857e9df4956141Helmut Schaa	if (chan->flags & IEEE80211_CHAN_PASSIVE_SCAN)
442df13cce53a7b28a81460e6bfc4857e9df4956141Helmut Schaa		return IEEE80211_PASSIVE_CHANNEL_TIME;
443df13cce53a7b28a81460e6bfc4857e9df4956141Helmut Schaa	return IEEE80211_PROBE_DELAY + IEEE80211_CHANNEL_TIME;
444df13cce53a7b28a81460e6bfc4857e9df4956141Helmut Schaa}
445df13cce53a7b28a81460e6bfc4857e9df4956141Helmut Schaa
4462fb3f028a9a46bd344329766257699b4acb36525Helmut Schaastatic int ieee80211_scan_state_decision(struct ieee80211_local *local,
4472fb3f028a9a46bd344329766257699b4acb36525Helmut Schaa					 unsigned long *next_delay)
4487d3be3cc489176bc7bd23e673b0b4aef597af2b3Helmut Schaa{
449142b9f5074dc0d09dc0025739ad437723d7bf527Helmut Schaa	bool associated = false;
450df13cce53a7b28a81460e6bfc4857e9df4956141Helmut Schaa	bool tx_empty = true;
451df13cce53a7b28a81460e6bfc4857e9df4956141Helmut Schaa	bool bad_latency;
452df13cce53a7b28a81460e6bfc4857e9df4956141Helmut Schaa	bool listen_int_exceeded;
453df13cce53a7b28a81460e6bfc4857e9df4956141Helmut Schaa	unsigned long min_beacon_int = 0;
454142b9f5074dc0d09dc0025739ad437723d7bf527Helmut Schaa	struct ieee80211_sub_if_data *sdata;
455df13cce53a7b28a81460e6bfc4857e9df4956141Helmut Schaa	struct ieee80211_channel *next_chan;
456142b9f5074dc0d09dc0025739ad437723d7bf527Helmut Schaa
457142b9f5074dc0d09dc0025739ad437723d7bf527Helmut Schaa	/* if no more bands/channels left, complete scan and advance to the idle state */
4587d3be3cc489176bc7bd23e673b0b4aef597af2b3Helmut Schaa	if (local->scan_channel_idx >= local->scan_req->n_channels) {
4597d3be3cc489176bc7bd23e673b0b4aef597af2b3Helmut Schaa		ieee80211_scan_completed(&local->hw, false);
4607d3be3cc489176bc7bd23e673b0b4aef597af2b3Helmut Schaa		return 1;
4617d3be3cc489176bc7bd23e673b0b4aef597af2b3Helmut Schaa	}
4622fb3f028a9a46bd344329766257699b4acb36525Helmut Schaa
463df13cce53a7b28a81460e6bfc4857e9df4956141Helmut Schaa	/*
464df13cce53a7b28a81460e6bfc4857e9df4956141Helmut Schaa	 * check if at least one STA interface is associated,
465df13cce53a7b28a81460e6bfc4857e9df4956141Helmut Schaa	 * check if at least one STA interface has pending tx frames
466df13cce53a7b28a81460e6bfc4857e9df4956141Helmut Schaa	 * and grab the lowest used beacon interval
467df13cce53a7b28a81460e6bfc4857e9df4956141Helmut Schaa	 */
468142b9f5074dc0d09dc0025739ad437723d7bf527Helmut Schaa	mutex_lock(&local->iflist_mtx);
469142b9f5074dc0d09dc0025739ad437723d7bf527Helmut Schaa	list_for_each_entry(sdata, &local->interfaces, list) {
4709607e6b66a0d25ca63b70d54a4283fa13d8f7c9dJohannes Berg		if (!ieee80211_sdata_running(sdata))
471142b9f5074dc0d09dc0025739ad437723d7bf527Helmut Schaa			continue;
472142b9f5074dc0d09dc0025739ad437723d7bf527Helmut Schaa
473142b9f5074dc0d09dc0025739ad437723d7bf527Helmut Schaa		if (sdata->vif.type == NL80211_IFTYPE_STATION) {
474142b9f5074dc0d09dc0025739ad437723d7bf527Helmut Schaa			if (sdata->u.mgd.associated) {
475142b9f5074dc0d09dc0025739ad437723d7bf527Helmut Schaa				associated = true;
476df13cce53a7b28a81460e6bfc4857e9df4956141Helmut Schaa
477df13cce53a7b28a81460e6bfc4857e9df4956141Helmut Schaa				if (sdata->vif.bss_conf.beacon_int <
478df13cce53a7b28a81460e6bfc4857e9df4956141Helmut Schaa				    min_beacon_int || min_beacon_int == 0)
479df13cce53a7b28a81460e6bfc4857e9df4956141Helmut Schaa					min_beacon_int =
480df13cce53a7b28a81460e6bfc4857e9df4956141Helmut Schaa						sdata->vif.bss_conf.beacon_int;
481df13cce53a7b28a81460e6bfc4857e9df4956141Helmut Schaa
482df13cce53a7b28a81460e6bfc4857e9df4956141Helmut Schaa				if (!qdisc_all_tx_empty(sdata->dev)) {
483df13cce53a7b28a81460e6bfc4857e9df4956141Helmut Schaa					tx_empty = false;
484df13cce53a7b28a81460e6bfc4857e9df4956141Helmut Schaa					break;
485df13cce53a7b28a81460e6bfc4857e9df4956141Helmut Schaa				}
486142b9f5074dc0d09dc0025739ad437723d7bf527Helmut Schaa			}
487142b9f5074dc0d09dc0025739ad437723d7bf527Helmut Schaa		}
488142b9f5074dc0d09dc0025739ad437723d7bf527Helmut Schaa	}
489142b9f5074dc0d09dc0025739ad437723d7bf527Helmut Schaa	mutex_unlock(&local->iflist_mtx);
490142b9f5074dc0d09dc0025739ad437723d7bf527Helmut Schaa
491142b9f5074dc0d09dc0025739ad437723d7bf527Helmut Schaa	if (local->scan_channel) {
492142b9f5074dc0d09dc0025739ad437723d7bf527Helmut Schaa		/*
493142b9f5074dc0d09dc0025739ad437723d7bf527Helmut Schaa		 * we're currently scanning a different channel, let's
494df13cce53a7b28a81460e6bfc4857e9df4956141Helmut Schaa		 * see if we can scan another channel without interfering
495df13cce53a7b28a81460e6bfc4857e9df4956141Helmut Schaa		 * with the current traffic situation.
496df13cce53a7b28a81460e6bfc4857e9df4956141Helmut Schaa		 *
497df13cce53a7b28a81460e6bfc4857e9df4956141Helmut Schaa		 * Since we don't know if the AP has pending frames for us
498df13cce53a7b28a81460e6bfc4857e9df4956141Helmut Schaa		 * we can only check for our tx queues and use the current
499df13cce53a7b28a81460e6bfc4857e9df4956141Helmut Schaa		 * pm_qos requirements for rx. Hence, if no tx traffic occurs
500df13cce53a7b28a81460e6bfc4857e9df4956141Helmut Schaa		 * at all we will scan as many channels in a row as the pm_qos
501df13cce53a7b28a81460e6bfc4857e9df4956141Helmut Schaa		 * latency allows us to. Additionally we also check for the
502df13cce53a7b28a81460e6bfc4857e9df4956141Helmut Schaa		 * currently negotiated listen interval to prevent losing
503df13cce53a7b28a81460e6bfc4857e9df4956141Helmut Schaa		 * frames unnecessarily.
504df13cce53a7b28a81460e6bfc4857e9df4956141Helmut Schaa		 *
505df13cce53a7b28a81460e6bfc4857e9df4956141Helmut Schaa		 * Otherwise switch back to the operating channel.
506142b9f5074dc0d09dc0025739ad437723d7bf527Helmut Schaa		 */
507df13cce53a7b28a81460e6bfc4857e9df4956141Helmut Schaa		next_chan = local->scan_req->channels[local->scan_channel_idx];
508df13cce53a7b28a81460e6bfc4857e9df4956141Helmut Schaa
509df13cce53a7b28a81460e6bfc4857e9df4956141Helmut Schaa		bad_latency = time_after(jiffies +
510df13cce53a7b28a81460e6bfc4857e9df4956141Helmut Schaa				ieee80211_scan_get_channel_time(next_chan),
511df13cce53a7b28a81460e6bfc4857e9df4956141Helmut Schaa				local->leave_oper_channel_time +
512df13cce53a7b28a81460e6bfc4857e9df4956141Helmut Schaa				usecs_to_jiffies(pm_qos_requirement(PM_QOS_NETWORK_LATENCY)));
513df13cce53a7b28a81460e6bfc4857e9df4956141Helmut Schaa
514df13cce53a7b28a81460e6bfc4857e9df4956141Helmut Schaa		listen_int_exceeded = time_after(jiffies +
515df13cce53a7b28a81460e6bfc4857e9df4956141Helmut Schaa				ieee80211_scan_get_channel_time(next_chan),
516df13cce53a7b28a81460e6bfc4857e9df4956141Helmut Schaa				local->leave_oper_channel_time +
517df13cce53a7b28a81460e6bfc4857e9df4956141Helmut Schaa				usecs_to_jiffies(min_beacon_int * 1024) *
518df13cce53a7b28a81460e6bfc4857e9df4956141Helmut Schaa				local->hw.conf.listen_interval);
519df13cce53a7b28a81460e6bfc4857e9df4956141Helmut Schaa
520df13cce53a7b28a81460e6bfc4857e9df4956141Helmut Schaa		if (associated && ( !tx_empty || bad_latency ||
521df13cce53a7b28a81460e6bfc4857e9df4956141Helmut Schaa		    listen_int_exceeded))
522977923b00c79185c11b4b47664f5ffa4c3820438Helmut Schaa			local->next_scan_state = SCAN_ENTER_OPER_CHANNEL;
523142b9f5074dc0d09dc0025739ad437723d7bf527Helmut Schaa		else
524977923b00c79185c11b4b47664f5ffa4c3820438Helmut Schaa			local->next_scan_state = SCAN_SET_CHANNEL;
525142b9f5074dc0d09dc0025739ad437723d7bf527Helmut Schaa	} else {
526142b9f5074dc0d09dc0025739ad437723d7bf527Helmut Schaa		/*
527142b9f5074dc0d09dc0025739ad437723d7bf527Helmut Schaa		 * we're on the operating channel currently, let's
528142b9f5074dc0d09dc0025739ad437723d7bf527Helmut Schaa		 * leave that channel now to scan another one
529142b9f5074dc0d09dc0025739ad437723d7bf527Helmut Schaa		 */
530977923b00c79185c11b4b47664f5ffa4c3820438Helmut Schaa		local->next_scan_state = SCAN_LEAVE_OPER_CHANNEL;
531142b9f5074dc0d09dc0025739ad437723d7bf527Helmut Schaa	}
532142b9f5074dc0d09dc0025739ad437723d7bf527Helmut Schaa
5332fb3f028a9a46bd344329766257699b4acb36525Helmut Schaa	*next_delay = 0;
5342fb3f028a9a46bd344329766257699b4acb36525Helmut Schaa	return 0;
5352fb3f028a9a46bd344329766257699b4acb36525Helmut Schaa}
5362fb3f028a9a46bd344329766257699b4acb36525Helmut Schaa
537142b9f5074dc0d09dc0025739ad437723d7bf527Helmut Schaastatic void ieee80211_scan_state_leave_oper_channel(struct ieee80211_local *local,
538142b9f5074dc0d09dc0025739ad437723d7bf527Helmut Schaa						    unsigned long *next_delay)
539142b9f5074dc0d09dc0025739ad437723d7bf527Helmut Schaa{
540b203ffc3a447eb8d9e6120b783ddee081b143061Jouni Malinen	ieee80211_offchannel_stop_station(local);
541142b9f5074dc0d09dc0025739ad437723d7bf527Helmut Schaa
542142b9f5074dc0d09dc0025739ad437723d7bf527Helmut Schaa	__set_bit(SCAN_OFF_CHANNEL, &local->scanning);
543142b9f5074dc0d09dc0025739ad437723d7bf527Helmut Schaa
544a80f7c0b088187c8471b441d461e937991870661Johannes Berg	/*
545a80f7c0b088187c8471b441d461e937991870661Johannes Berg	 * What if the nullfunc frames didn't arrive?
546a80f7c0b088187c8471b441d461e937991870661Johannes Berg	 */
547a80f7c0b088187c8471b441d461e937991870661Johannes Berg	drv_flush(local, false);
548a80f7c0b088187c8471b441d461e937991870661Johannes Berg	if (local->ops->flush)
549a80f7c0b088187c8471b441d461e937991870661Johannes Berg		*next_delay = 0;
550a80f7c0b088187c8471b441d461e937991870661Johannes Berg	else
551a80f7c0b088187c8471b441d461e937991870661Johannes Berg		*next_delay = HZ / 10;
552a80f7c0b088187c8471b441d461e937991870661Johannes Berg
553df13cce53a7b28a81460e6bfc4857e9df4956141Helmut Schaa	/* remember when we left the operating channel */
554df13cce53a7b28a81460e6bfc4857e9df4956141Helmut Schaa	local->leave_oper_channel_time = jiffies;
555df13cce53a7b28a81460e6bfc4857e9df4956141Helmut Schaa
556142b9f5074dc0d09dc0025739ad437723d7bf527Helmut Schaa	/* advance to the next channel to be scanned */
557977923b00c79185c11b4b47664f5ffa4c3820438Helmut Schaa	local->next_scan_state = SCAN_SET_CHANNEL;
558142b9f5074dc0d09dc0025739ad437723d7bf527Helmut Schaa}
559142b9f5074dc0d09dc0025739ad437723d7bf527Helmut Schaa
560142b9f5074dc0d09dc0025739ad437723d7bf527Helmut Schaastatic void ieee80211_scan_state_enter_oper_channel(struct ieee80211_local *local,
561142b9f5074dc0d09dc0025739ad437723d7bf527Helmut Schaa						    unsigned long *next_delay)
562142b9f5074dc0d09dc0025739ad437723d7bf527Helmut Schaa{
563142b9f5074dc0d09dc0025739ad437723d7bf527Helmut Schaa	/* switch back to the operating channel */
564142b9f5074dc0d09dc0025739ad437723d7bf527Helmut Schaa	local->scan_channel = NULL;
565142b9f5074dc0d09dc0025739ad437723d7bf527Helmut Schaa	ieee80211_hw_config(local, IEEE80211_CONF_CHANGE_CHANNEL);
566142b9f5074dc0d09dc0025739ad437723d7bf527Helmut Schaa
567142b9f5074dc0d09dc0025739ad437723d7bf527Helmut Schaa	/*
568b203ffc3a447eb8d9e6120b783ddee081b143061Jouni Malinen	 * Only re-enable station mode interface now; beaconing will be
569b203ffc3a447eb8d9e6120b783ddee081b143061Jouni Malinen	 * re-enabled once the full scan has been completed.
570142b9f5074dc0d09dc0025739ad437723d7bf527Helmut Schaa	 */
571b203ffc3a447eb8d9e6120b783ddee081b143061Jouni Malinen	ieee80211_offchannel_return(local, false);
572142b9f5074dc0d09dc0025739ad437723d7bf527Helmut Schaa
573142b9f5074dc0d09dc0025739ad437723d7bf527Helmut Schaa	__clear_bit(SCAN_OFF_CHANNEL, &local->scanning);
574142b9f5074dc0d09dc0025739ad437723d7bf527Helmut Schaa
575142b9f5074dc0d09dc0025739ad437723d7bf527Helmut Schaa	*next_delay = HZ / 5;
576977923b00c79185c11b4b47664f5ffa4c3820438Helmut Schaa	local->next_scan_state = SCAN_DECISION;
577142b9f5074dc0d09dc0025739ad437723d7bf527Helmut Schaa}
578142b9f5074dc0d09dc0025739ad437723d7bf527Helmut Schaa
5792fb3f028a9a46bd344329766257699b4acb36525Helmut Schaastatic void ieee80211_scan_state_set_channel(struct ieee80211_local *local,
5802fb3f028a9a46bd344329766257699b4acb36525Helmut Schaa					     unsigned long *next_delay)
5812fb3f028a9a46bd344329766257699b4acb36525Helmut Schaa{
5822fb3f028a9a46bd344329766257699b4acb36525Helmut Schaa	int skip;
5832fb3f028a9a46bd344329766257699b4acb36525Helmut Schaa	struct ieee80211_channel *chan;
5842fb3f028a9a46bd344329766257699b4acb36525Helmut Schaa
5857d3be3cc489176bc7bd23e673b0b4aef597af2b3Helmut Schaa	skip = 0;
5867d3be3cc489176bc7bd23e673b0b4aef597af2b3Helmut Schaa	chan = local->scan_req->channels[local->scan_channel_idx];
5877d3be3cc489176bc7bd23e673b0b4aef597af2b3Helmut Schaa
588584991dccfd347cd2e1675ab262998f6c335d3c0Johannes Berg	local->scan_channel = chan;
589584991dccfd347cd2e1675ab262998f6c335d3c0Johannes Berg	if (ieee80211_hw_config(local, IEEE80211_CONF_CHANGE_CHANNEL))
5907d3be3cc489176bc7bd23e673b0b4aef597af2b3Helmut Schaa		skip = 1;
5917d3be3cc489176bc7bd23e673b0b4aef597af2b3Helmut Schaa
5927d3be3cc489176bc7bd23e673b0b4aef597af2b3Helmut Schaa	/* advance state machine to next channel/band */
5937d3be3cc489176bc7bd23e673b0b4aef597af2b3Helmut Schaa	local->scan_channel_idx++;
5947d3be3cc489176bc7bd23e673b0b4aef597af2b3Helmut Schaa
5950ee9c13c7c92581ab005d80795cf65897213b249Helmut Schaa	if (skip) {
5960ee9c13c7c92581ab005d80795cf65897213b249Helmut Schaa		/* if we skip this channel return to the decision state */
5970ee9c13c7c92581ab005d80795cf65897213b249Helmut Schaa		local->next_scan_state = SCAN_DECISION;
5982fb3f028a9a46bd344329766257699b4acb36525Helmut Schaa		return;
5990ee9c13c7c92581ab005d80795cf65897213b249Helmut Schaa	}
6007d3be3cc489176bc7bd23e673b0b4aef597af2b3Helmut Schaa
6017d3be3cc489176bc7bd23e673b0b4aef597af2b3Helmut Schaa	/*
6027d3be3cc489176bc7bd23e673b0b4aef597af2b3Helmut Schaa	 * Probe delay is used to update the NAV, cf. 11.1.3.2.2
6037d3be3cc489176bc7bd23e673b0b4aef597af2b3Helmut Schaa	 * (which unfortunately doesn't say _why_ step a) is done,
6047d3be3cc489176bc7bd23e673b0b4aef597af2b3Helmut Schaa	 * but it waits for the probe delay or until a frame is
6057d3be3cc489176bc7bd23e673b0b4aef597af2b3Helmut Schaa	 * received - and the received frame would update the NAV).
6067d3be3cc489176bc7bd23e673b0b4aef597af2b3Helmut Schaa	 * For now, we do not support waiting until a frame is
6077d3be3cc489176bc7bd23e673b0b4aef597af2b3Helmut Schaa	 * received.
6087d3be3cc489176bc7bd23e673b0b4aef597af2b3Helmut Schaa	 *
6097d3be3cc489176bc7bd23e673b0b4aef597af2b3Helmut Schaa	 * In any case, it is not necessary for a passive scan.
6107d3be3cc489176bc7bd23e673b0b4aef597af2b3Helmut Schaa	 */
6117d3be3cc489176bc7bd23e673b0b4aef597af2b3Helmut Schaa	if (chan->flags & IEEE80211_CHAN_PASSIVE_SCAN ||
6127d3be3cc489176bc7bd23e673b0b4aef597af2b3Helmut Schaa	    !local->scan_req->n_ssids) {
6137d3be3cc489176bc7bd23e673b0b4aef597af2b3Helmut Schaa		*next_delay = IEEE80211_PASSIVE_CHANNEL_TIME;
614977923b00c79185c11b4b47664f5ffa4c3820438Helmut Schaa		local->next_scan_state = SCAN_DECISION;
6152fb3f028a9a46bd344329766257699b4acb36525Helmut Schaa		return;
6167d3be3cc489176bc7bd23e673b0b4aef597af2b3Helmut Schaa	}
6177d3be3cc489176bc7bd23e673b0b4aef597af2b3Helmut Schaa
6182fb3f028a9a46bd344329766257699b4acb36525Helmut Schaa	/* active scan, send probes */
6197d3be3cc489176bc7bd23e673b0b4aef597af2b3Helmut Schaa	*next_delay = IEEE80211_PROBE_DELAY;
620977923b00c79185c11b4b47664f5ffa4c3820438Helmut Schaa	local->next_scan_state = SCAN_SEND_PROBE;
6217d3be3cc489176bc7bd23e673b0b4aef597af2b3Helmut Schaa}
6227d3be3cc489176bc7bd23e673b0b4aef597af2b3Helmut Schaa
6237d3be3cc489176bc7bd23e673b0b4aef597af2b3Helmut Schaastatic void ieee80211_scan_state_send_probe(struct ieee80211_local *local,
6247d3be3cc489176bc7bd23e673b0b4aef597af2b3Helmut Schaa					    unsigned long *next_delay)
6257d3be3cc489176bc7bd23e673b0b4aef597af2b3Helmut Schaa{
6267d3be3cc489176bc7bd23e673b0b4aef597af2b3Helmut Schaa	int i;
6277d3be3cc489176bc7bd23e673b0b4aef597af2b3Helmut Schaa	struct ieee80211_sub_if_data *sdata = local->scan_sdata;
6287d3be3cc489176bc7bd23e673b0b4aef597af2b3Helmut Schaa
6297d3be3cc489176bc7bd23e673b0b4aef597af2b3Helmut Schaa	for (i = 0; i < local->scan_req->n_ssids; i++)
6307d3be3cc489176bc7bd23e673b0b4aef597af2b3Helmut Schaa		ieee80211_send_probe_req(
6317d3be3cc489176bc7bd23e673b0b4aef597af2b3Helmut Schaa			sdata, NULL,
6327d3be3cc489176bc7bd23e673b0b4aef597af2b3Helmut Schaa			local->scan_req->ssids[i].ssid,
6337d3be3cc489176bc7bd23e673b0b4aef597af2b3Helmut Schaa			local->scan_req->ssids[i].ssid_len,
6347d3be3cc489176bc7bd23e673b0b4aef597af2b3Helmut Schaa			local->scan_req->ie, local->scan_req->ie_len);
6357d3be3cc489176bc7bd23e673b0b4aef597af2b3Helmut Schaa
6367d3be3cc489176bc7bd23e673b0b4aef597af2b3Helmut Schaa	/*
6377d3be3cc489176bc7bd23e673b0b4aef597af2b3Helmut Schaa	 * After sending probe requests, wait for probe responses
6387d3be3cc489176bc7bd23e673b0b4aef597af2b3Helmut Schaa	 * on the channel.
6397d3be3cc489176bc7bd23e673b0b4aef597af2b3Helmut Schaa	 */
6407d3be3cc489176bc7bd23e673b0b4aef597af2b3Helmut Schaa	*next_delay = IEEE80211_CHANNEL_TIME;
641977923b00c79185c11b4b47664f5ffa4c3820438Helmut Schaa	local->next_scan_state = SCAN_DECISION;
6427d3be3cc489176bc7bd23e673b0b4aef597af2b3Helmut Schaa}
6437d3be3cc489176bc7bd23e673b0b4aef597af2b3Helmut Schaa
644c2b13452b283f9c4a5b02a6b53ed6416ebf4c03cJohannes Bergvoid ieee80211_scan_work(struct work_struct *work)
6450a51b27e956bd9580296c48191b78175ed8b5971Johannes Berg{
6460a51b27e956bd9580296c48191b78175ed8b5971Johannes Berg	struct ieee80211_local *local =
6470a51b27e956bd9580296c48191b78175ed8b5971Johannes Berg		container_of(work, struct ieee80211_local, scan_work.work);
6480a51b27e956bd9580296c48191b78175ed8b5971Johannes Berg	struct ieee80211_sub_if_data *sdata = local->scan_sdata;
6490a51b27e956bd9580296c48191b78175ed8b5971Johannes Berg	unsigned long next_delay = 0;
6500a51b27e956bd9580296c48191b78175ed8b5971Johannes Berg
651f3b85252f081581a8f257545ed748062dce7798bJohannes Berg	mutex_lock(&local->scan_mtx);
652f3b85252f081581a8f257545ed748062dce7798bJohannes Berg	if (!sdata || !local->scan_req) {
653f3b85252f081581a8f257545ed748062dce7798bJohannes Berg		mutex_unlock(&local->scan_mtx);
654f3b85252f081581a8f257545ed748062dce7798bJohannes Berg		return;
655f3b85252f081581a8f257545ed748062dce7798bJohannes Berg	}
656f3b85252f081581a8f257545ed748062dce7798bJohannes Berg
6574d36ec58239eec44d77839ef6c25108efcbbb58cJohannes Berg	if (local->hw_scan_req) {
658a060bbfe4ee95d115e8f9705a66894ac34e2c475Johannes Berg		int rc = drv_hw_scan(local, sdata, local->hw_scan_req);
6594d36ec58239eec44d77839ef6c25108efcbbb58cJohannes Berg		mutex_unlock(&local->scan_mtx);
6604d36ec58239eec44d77839ef6c25108efcbbb58cJohannes Berg		if (rc)
6614d36ec58239eec44d77839ef6c25108efcbbb58cJohannes Berg			ieee80211_scan_completed(&local->hw, true);
6624d36ec58239eec44d77839ef6c25108efcbbb58cJohannes Berg		return;
6634d36ec58239eec44d77839ef6c25108efcbbb58cJohannes Berg	}
6644d36ec58239eec44d77839ef6c25108efcbbb58cJohannes Berg
665fbe9c429f195111bbf7f1630efa19aee295fd8e7Helmut Schaa	if (local->scan_req && !local->scanning) {
666f3b85252f081581a8f257545ed748062dce7798bJohannes Berg		struct cfg80211_scan_request *req = local->scan_req;
667f3b85252f081581a8f257545ed748062dce7798bJohannes Berg		int rc;
668f3b85252f081581a8f257545ed748062dce7798bJohannes Berg
669f3b85252f081581a8f257545ed748062dce7798bJohannes Berg		local->scan_req = NULL;
67015db0b7fd872b0312033666d3a82e1214a227ec0Johannes Berg		local->scan_sdata = NULL;
671f3b85252f081581a8f257545ed748062dce7798bJohannes Berg
672f3b85252f081581a8f257545ed748062dce7798bJohannes Berg		rc = __ieee80211_start_scan(sdata, req);
673f3b85252f081581a8f257545ed748062dce7798bJohannes Berg		mutex_unlock(&local->scan_mtx);
674f3b85252f081581a8f257545ed748062dce7798bJohannes Berg
675f3b85252f081581a8f257545ed748062dce7798bJohannes Berg		if (rc)
676f3b85252f081581a8f257545ed748062dce7798bJohannes Berg			ieee80211_scan_completed(&local->hw, true);
677f3b85252f081581a8f257545ed748062dce7798bJohannes Berg		return;
678f3b85252f081581a8f257545ed748062dce7798bJohannes Berg	}
679f3b85252f081581a8f257545ed748062dce7798bJohannes Berg
680f3b85252f081581a8f257545ed748062dce7798bJohannes Berg	mutex_unlock(&local->scan_mtx);
681f3b85252f081581a8f257545ed748062dce7798bJohannes Berg
6825bc75728fd43bb15b46f16ef465bcf9d487393cfJohannes Berg	/*
6835bc75728fd43bb15b46f16ef465bcf9d487393cfJohannes Berg	 * Avoid re-scheduling when the sdata is going away.
6845bc75728fd43bb15b46f16ef465bcf9d487393cfJohannes Berg	 */
6859607e6b66a0d25ca63b70d54a4283fa13d8f7c9dJohannes Berg	if (!ieee80211_sdata_running(sdata)) {
686f3b85252f081581a8f257545ed748062dce7798bJohannes Berg		ieee80211_scan_completed(&local->hw, true);
6870a51b27e956bd9580296c48191b78175ed8b5971Johannes Berg		return;
688f3b85252f081581a8f257545ed748062dce7798bJohannes Berg	}
6890a51b27e956bd9580296c48191b78175ed8b5971Johannes Berg
690f502d09b750437a4ec9c63333acf1070fe7958afHelmut Schaa	/*
691f502d09b750437a4ec9c63333acf1070fe7958afHelmut Schaa	 * as long as no delay is required advance immediately
692f502d09b750437a4ec9c63333acf1070fe7958afHelmut Schaa	 * without scheduling a new work
693f502d09b750437a4ec9c63333acf1070fe7958afHelmut Schaa	 */
694f502d09b750437a4ec9c63333acf1070fe7958afHelmut Schaa	do {
695977923b00c79185c11b4b47664f5ffa4c3820438Helmut Schaa		switch (local->next_scan_state) {
6962fb3f028a9a46bd344329766257699b4acb36525Helmut Schaa		case SCAN_DECISION:
6972fb3f028a9a46bd344329766257699b4acb36525Helmut Schaa			if (ieee80211_scan_state_decision(local, &next_delay))
698f502d09b750437a4ec9c63333acf1070fe7958afHelmut Schaa				return;
699f502d09b750437a4ec9c63333acf1070fe7958afHelmut Schaa			break;
7002fb3f028a9a46bd344329766257699b4acb36525Helmut Schaa		case SCAN_SET_CHANNEL:
7012fb3f028a9a46bd344329766257699b4acb36525Helmut Schaa			ieee80211_scan_state_set_channel(local, &next_delay);
7022fb3f028a9a46bd344329766257699b4acb36525Helmut Schaa			break;
703f502d09b750437a4ec9c63333acf1070fe7958afHelmut Schaa		case SCAN_SEND_PROBE:
704f502d09b750437a4ec9c63333acf1070fe7958afHelmut Schaa			ieee80211_scan_state_send_probe(local, &next_delay);
705f502d09b750437a4ec9c63333acf1070fe7958afHelmut Schaa			break;
706142b9f5074dc0d09dc0025739ad437723d7bf527Helmut Schaa		case SCAN_LEAVE_OPER_CHANNEL:
707142b9f5074dc0d09dc0025739ad437723d7bf527Helmut Schaa			ieee80211_scan_state_leave_oper_channel(local, &next_delay);
708142b9f5074dc0d09dc0025739ad437723d7bf527Helmut Schaa			break;
709142b9f5074dc0d09dc0025739ad437723d7bf527Helmut Schaa		case SCAN_ENTER_OPER_CHANNEL:
710142b9f5074dc0d09dc0025739ad437723d7bf527Helmut Schaa			ieee80211_scan_state_enter_oper_channel(local, &next_delay);
711142b9f5074dc0d09dc0025739ad437723d7bf527Helmut Schaa			break;
712f502d09b750437a4ec9c63333acf1070fe7958afHelmut Schaa		}
713f502d09b750437a4ec9c63333acf1070fe7958afHelmut Schaa	} while (next_delay == 0);
7140a51b27e956bd9580296c48191b78175ed8b5971Johannes Berg
71542935ecaf4e784d0815afa9a7e5fe7e141157ca3Luis R. Rodriguez	ieee80211_queue_delayed_work(&local->hw, &local->scan_work, next_delay);
7160a51b27e956bd9580296c48191b78175ed8b5971Johannes Berg}
7170a51b27e956bd9580296c48191b78175ed8b5971Johannes Berg
718f3b85252f081581a8f257545ed748062dce7798bJohannes Bergint ieee80211_request_scan(struct ieee80211_sub_if_data *sdata,
719f3b85252f081581a8f257545ed748062dce7798bJohannes Berg			   struct cfg80211_scan_request *req)
7200a51b27e956bd9580296c48191b78175ed8b5971Johannes Berg{
721f3b85252f081581a8f257545ed748062dce7798bJohannes Berg	int res;
722de95a54b1aebe5592cae971ca5e5d9ec6a381a17Johannes Berg
723f3b85252f081581a8f257545ed748062dce7798bJohannes Berg	mutex_lock(&sdata->local->scan_mtx);
724f3b85252f081581a8f257545ed748062dce7798bJohannes Berg	res = __ieee80211_start_scan(sdata, req);
725f3b85252f081581a8f257545ed748062dce7798bJohannes Berg	mutex_unlock(&sdata->local->scan_mtx);
7260a51b27e956bd9580296c48191b78175ed8b5971Johannes Berg
727f3b85252f081581a8f257545ed748062dce7798bJohannes Berg	return res;
7280a51b27e956bd9580296c48191b78175ed8b5971Johannes Berg}
7290a51b27e956bd9580296c48191b78175ed8b5971Johannes Berg
730f3b85252f081581a8f257545ed748062dce7798bJohannes Bergint ieee80211_request_internal_scan(struct ieee80211_sub_if_data *sdata,
731be4a4b6a5d2f76393f545a2545fbaa1b65577e13Johannes Berg				    const u8 *ssid, u8 ssid_len,
732be4a4b6a5d2f76393f545a2545fbaa1b65577e13Johannes Berg				    struct ieee80211_channel *chan)
7330a51b27e956bd9580296c48191b78175ed8b5971Johannes Berg{
7340a51b27e956bd9580296c48191b78175ed8b5971Johannes Berg	struct ieee80211_local *local = sdata->local;
735f3b85252f081581a8f257545ed748062dce7798bJohannes Berg	int ret = -EBUSY;
736be4a4b6a5d2f76393f545a2545fbaa1b65577e13Johannes Berg	enum nl80211_band band;
7372a5193119269062608582418deba7af82844159aJohannes Berg
738f3b85252f081581a8f257545ed748062dce7798bJohannes Berg	mutex_lock(&local->scan_mtx);
7390a51b27e956bd9580296c48191b78175ed8b5971Johannes Berg
740f3b85252f081581a8f257545ed748062dce7798bJohannes Berg	/* busy scanning */
741f3b85252f081581a8f257545ed748062dce7798bJohannes Berg	if (local->scan_req)
742f3b85252f081581a8f257545ed748062dce7798bJohannes Berg		goto unlock;
7439116dd01120e249dc2e84e6edecd7ad7f828680fJohannes Berg
744be4a4b6a5d2f76393f545a2545fbaa1b65577e13Johannes Berg	/* fill internal scan request */
745be4a4b6a5d2f76393f545a2545fbaa1b65577e13Johannes Berg	if (!chan) {
746be4a4b6a5d2f76393f545a2545fbaa1b65577e13Johannes Berg		int i, nchan = 0;
747be4a4b6a5d2f76393f545a2545fbaa1b65577e13Johannes Berg
748be4a4b6a5d2f76393f545a2545fbaa1b65577e13Johannes Berg		for (band = 0; band < IEEE80211_NUM_BANDS; band++) {
749be4a4b6a5d2f76393f545a2545fbaa1b65577e13Johannes Berg			if (!local->hw.wiphy->bands[band])
750be4a4b6a5d2f76393f545a2545fbaa1b65577e13Johannes Berg				continue;
751be4a4b6a5d2f76393f545a2545fbaa1b65577e13Johannes Berg			for (i = 0;
752be4a4b6a5d2f76393f545a2545fbaa1b65577e13Johannes Berg			     i < local->hw.wiphy->bands[band]->n_channels;
753be4a4b6a5d2f76393f545a2545fbaa1b65577e13Johannes Berg			     i++) {
754be4a4b6a5d2f76393f545a2545fbaa1b65577e13Johannes Berg				local->int_scan_req->channels[nchan] =
755be4a4b6a5d2f76393f545a2545fbaa1b65577e13Johannes Berg				    &local->hw.wiphy->bands[band]->channels[i];
756be4a4b6a5d2f76393f545a2545fbaa1b65577e13Johannes Berg				nchan++;
757be4a4b6a5d2f76393f545a2545fbaa1b65577e13Johannes Berg			}
758be4a4b6a5d2f76393f545a2545fbaa1b65577e13Johannes Berg		}
759be4a4b6a5d2f76393f545a2545fbaa1b65577e13Johannes Berg
760be4a4b6a5d2f76393f545a2545fbaa1b65577e13Johannes Berg		local->int_scan_req->n_channels = nchan;
761be4a4b6a5d2f76393f545a2545fbaa1b65577e13Johannes Berg	} else {
762be4a4b6a5d2f76393f545a2545fbaa1b65577e13Johannes Berg		local->int_scan_req->channels[0] = chan;
763be4a4b6a5d2f76393f545a2545fbaa1b65577e13Johannes Berg		local->int_scan_req->n_channels = 1;
764be4a4b6a5d2f76393f545a2545fbaa1b65577e13Johannes Berg	}
765be4a4b6a5d2f76393f545a2545fbaa1b65577e13Johannes Berg
766be4a4b6a5d2f76393f545a2545fbaa1b65577e13Johannes Berg	local->int_scan_req->ssids = &local->scan_ssid;
767be4a4b6a5d2f76393f545a2545fbaa1b65577e13Johannes Berg	local->int_scan_req->n_ssids = 1;
7685ba63533bbf653631faab60f6988506160ec6ba4Johannes Berg	memcpy(local->int_scan_req->ssids[0].ssid, ssid, IEEE80211_MAX_SSID_LEN);
7695ba63533bbf653631faab60f6988506160ec6ba4Johannes Berg	local->int_scan_req->ssids[0].ssid_len = ssid_len;
7709116dd01120e249dc2e84e6edecd7ad7f828680fJohannes Berg
7715ba63533bbf653631faab60f6988506160ec6ba4Johannes Berg	ret = __ieee80211_start_scan(sdata, sdata->local->int_scan_req);
772f3b85252f081581a8f257545ed748062dce7798bJohannes Berg unlock:
773f3b85252f081581a8f257545ed748062dce7798bJohannes Berg	mutex_unlock(&local->scan_mtx);
774f3b85252f081581a8f257545ed748062dce7798bJohannes Berg	return ret;
7750a51b27e956bd9580296c48191b78175ed8b5971Johannes Berg}
7765bb644a0fd25a5e083ecbfaa92a211db99aa6ef7Johannes Berg
7775bb644a0fd25a5e083ecbfaa92a211db99aa6ef7Johannes Bergvoid ieee80211_scan_cancel(struct ieee80211_local *local)
7785bb644a0fd25a5e083ecbfaa92a211db99aa6ef7Johannes Berg{
77915db0b7fd872b0312033666d3a82e1214a227ec0Johannes Berg	bool abortscan;
7805bb644a0fd25a5e083ecbfaa92a211db99aa6ef7Johannes Berg
7815bb644a0fd25a5e083ecbfaa92a211db99aa6ef7Johannes Berg	cancel_delayed_work_sync(&local->scan_work);
7825bb644a0fd25a5e083ecbfaa92a211db99aa6ef7Johannes Berg
7835bb644a0fd25a5e083ecbfaa92a211db99aa6ef7Johannes Berg	/*
7845bb644a0fd25a5e083ecbfaa92a211db99aa6ef7Johannes Berg	 * Only call this function when a scan can't be
7855bb644a0fd25a5e083ecbfaa92a211db99aa6ef7Johannes Berg	 * queued -- mostly at suspend under RTNL.
7865bb644a0fd25a5e083ecbfaa92a211db99aa6ef7Johannes Berg	 */
7875bb644a0fd25a5e083ecbfaa92a211db99aa6ef7Johannes Berg	mutex_lock(&local->scan_mtx);
78815db0b7fd872b0312033666d3a82e1214a227ec0Johannes Berg	abortscan = test_bit(SCAN_SW_SCANNING, &local->scanning) ||
78915db0b7fd872b0312033666d3a82e1214a227ec0Johannes Berg		    (!local->scanning && local->scan_req);
7905bb644a0fd25a5e083ecbfaa92a211db99aa6ef7Johannes Berg	mutex_unlock(&local->scan_mtx);
7915bb644a0fd25a5e083ecbfaa92a211db99aa6ef7Johannes Berg
79215db0b7fd872b0312033666d3a82e1214a227ec0Johannes Berg	if (abortscan)
7935bb644a0fd25a5e083ecbfaa92a211db99aa6ef7Johannes Berg		ieee80211_scan_completed(&local->hw, true);
7945bb644a0fd25a5e083ecbfaa92a211db99aa6ef7Johannes Berg}
795