scan.c revision a80f7c0b088187c8471b441d461e937991870661
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/wireless.h>
160a51b27e956bd9580296c48191b78175ed8b5971Johannes Berg#include <linux/if_arp.h>
17078e1e60dd6c6b0d4bc8d58ccb80c008e8efc9ffJohannes Berg#include <linux/rtnetlink.h>
180a51b27e956bd9580296c48191b78175ed8b5971Johannes Berg#include <net/mac80211.h>
190a51b27e956bd9580296c48191b78175ed8b5971Johannes Berg
200a51b27e956bd9580296c48191b78175ed8b5971Johannes Berg#include "ieee80211_i.h"
212448798133d747ad339e57099e32a1d1e68aca1cJohannes Berg#include "driver-ops.h"
225484e23749e78d5a4f56928efaf3c4b0d862b7a6Johannes Berg#include "mesh.h"
230a51b27e956bd9580296c48191b78175ed8b5971Johannes Berg
240a51b27e956bd9580296c48191b78175ed8b5971Johannes Berg#define IEEE80211_PROBE_DELAY (HZ / 33)
250a51b27e956bd9580296c48191b78175ed8b5971Johannes Berg#define IEEE80211_CHANNEL_TIME (HZ / 33)
2696f7e73938da744e718ce4817dd3e7e424624654Helmut Schaa#define IEEE80211_PASSIVE_CHANNEL_TIME (HZ / 8)
270a51b27e956bd9580296c48191b78175ed8b5971Johannes Berg
28c2b13452b283f9c4a5b02a6b53ed6416ebf4c03cJohannes Bergstruct ieee80211_bss *
295484e23749e78d5a4f56928efaf3c4b0d862b7a6Johannes Bergieee80211_rx_bss_get(struct ieee80211_local *local, u8 *bssid, int freq,
305484e23749e78d5a4f56928efaf3c4b0d862b7a6Johannes Berg		     u8 *ssid, u8 ssid_len)
315484e23749e78d5a4f56928efaf3c4b0d862b7a6Johannes Berg{
3200d3f14cf9f12c21428121026a5e1d5f65926447Johannes Berg	return (void *)cfg80211_get_bss(local->hw.wiphy,
3300d3f14cf9f12c21428121026a5e1d5f65926447Johannes Berg					ieee80211_get_channel(local->hw.wiphy,
3400d3f14cf9f12c21428121026a5e1d5f65926447Johannes Berg							      freq),
3500d3f14cf9f12c21428121026a5e1d5f65926447Johannes Berg					bssid, ssid, ssid_len,
3600d3f14cf9f12c21428121026a5e1d5f65926447Johannes Berg					0, 0);
375484e23749e78d5a4f56928efaf3c4b0d862b7a6Johannes Berg}
385484e23749e78d5a4f56928efaf3c4b0d862b7a6Johannes Berg
3900d3f14cf9f12c21428121026a5e1d5f65926447Johannes Bergstatic void ieee80211_rx_bss_free(struct cfg80211_bss *cbss)
405484e23749e78d5a4f56928efaf3c4b0d862b7a6Johannes Berg{
4100d3f14cf9f12c21428121026a5e1d5f65926447Johannes Berg	struct ieee80211_bss *bss = (void *)cbss;
425484e23749e78d5a4f56928efaf3c4b0d862b7a6Johannes Berg
435484e23749e78d5a4f56928efaf3c4b0d862b7a6Johannes Berg	kfree(bss_mesh_id(bss));
445484e23749e78d5a4f56928efaf3c4b0d862b7a6Johannes Berg	kfree(bss_mesh_cfg(bss));
455484e23749e78d5a4f56928efaf3c4b0d862b7a6Johannes Berg}
465484e23749e78d5a4f56928efaf3c4b0d862b7a6Johannes Berg
475484e23749e78d5a4f56928efaf3c4b0d862b7a6Johannes Bergvoid ieee80211_rx_bss_put(struct ieee80211_local *local,
48c2b13452b283f9c4a5b02a6b53ed6416ebf4c03cJohannes Berg			  struct ieee80211_bss *bss)
495484e23749e78d5a4f56928efaf3c4b0d862b7a6Johannes Berg{
5000d3f14cf9f12c21428121026a5e1d5f65926447Johannes Berg	cfg80211_put_bss((struct cfg80211_bss *)bss);
515484e23749e78d5a4f56928efaf3c4b0d862b7a6Johannes Berg}
525484e23749e78d5a4f56928efaf3c4b0d862b7a6Johannes Berg
53c2b13452b283f9c4a5b02a6b53ed6416ebf4c03cJohannes Bergstruct ieee80211_bss *
545484e23749e78d5a4f56928efaf3c4b0d862b7a6Johannes Bergieee80211_bss_info_update(struct ieee80211_local *local,
555484e23749e78d5a4f56928efaf3c4b0d862b7a6Johannes Berg			  struct ieee80211_rx_status *rx_status,
565484e23749e78d5a4f56928efaf3c4b0d862b7a6Johannes Berg			  struct ieee80211_mgmt *mgmt,
575484e23749e78d5a4f56928efaf3c4b0d862b7a6Johannes Berg			  size_t len,
585484e23749e78d5a4f56928efaf3c4b0d862b7a6Johannes Berg			  struct ieee802_11_elems *elems,
592a5193119269062608582418deba7af82844159aJohannes Berg			  struct ieee80211_channel *channel,
602a5193119269062608582418deba7af82844159aJohannes Berg			  bool beacon)
615484e23749e78d5a4f56928efaf3c4b0d862b7a6Johannes Berg{
62c2b13452b283f9c4a5b02a6b53ed6416ebf4c03cJohannes Berg	struct ieee80211_bss *bss;
6300d3f14cf9f12c21428121026a5e1d5f65926447Johannes Berg	int clen;
642a5193119269062608582418deba7af82844159aJohannes Berg	s32 signal = 0;
652a5193119269062608582418deba7af82844159aJohannes Berg
6677965c970d7da9c9b6349ff2b1d9adecf54c403bJohannes Berg	if (local->hw.flags & IEEE80211_HW_SIGNAL_DBM)
672a5193119269062608582418deba7af82844159aJohannes Berg		signal = rx_status->signal * 100;
6877965c970d7da9c9b6349ff2b1d9adecf54c403bJohannes Berg	else if (local->hw.flags & IEEE80211_HW_SIGNAL_UNSPEC)
692a5193119269062608582418deba7af82844159aJohannes Berg		signal = (rx_status->signal * 100) / local->hw.max_signal;
702a5193119269062608582418deba7af82844159aJohannes Berg
7100d3f14cf9f12c21428121026a5e1d5f65926447Johannes Berg	bss = (void *)cfg80211_inform_bss_frame(local->hw.wiphy, channel,
7277965c970d7da9c9b6349ff2b1d9adecf54c403bJohannes Berg						mgmt, len, signal, GFP_ATOMIC);
735484e23749e78d5a4f56928efaf3c4b0d862b7a6Johannes Berg
7400d3f14cf9f12c21428121026a5e1d5f65926447Johannes Berg	if (!bss)
7500d3f14cf9f12c21428121026a5e1d5f65926447Johannes Berg		return NULL;
7600d3f14cf9f12c21428121026a5e1d5f65926447Johannes Berg
7700d3f14cf9f12c21428121026a5e1d5f65926447Johannes Berg	bss->cbss.free_priv = ieee80211_rx_bss_free;
785484e23749e78d5a4f56928efaf3c4b0d862b7a6Johannes Berg
795484e23749e78d5a4f56928efaf3c4b0d862b7a6Johannes Berg	/* save the ERP value so that it is available at association time */
805484e23749e78d5a4f56928efaf3c4b0d862b7a6Johannes Berg	if (elems->erp_info && elems->erp_info_len >= 1) {
815484e23749e78d5a4f56928efaf3c4b0d862b7a6Johannes Berg		bss->erp_value = elems->erp_info[0];
825484e23749e78d5a4f56928efaf3c4b0d862b7a6Johannes Berg		bss->has_erp_value = 1;
835484e23749e78d5a4f56928efaf3c4b0d862b7a6Johannes Berg	}
845484e23749e78d5a4f56928efaf3c4b0d862b7a6Johannes Berg
855484e23749e78d5a4f56928efaf3c4b0d862b7a6Johannes Berg	if (elems->tim) {
865484e23749e78d5a4f56928efaf3c4b0d862b7a6Johannes Berg		struct ieee80211_tim_ie *tim_ie =
875484e23749e78d5a4f56928efaf3c4b0d862b7a6Johannes Berg			(struct ieee80211_tim_ie *)elems->tim;
885484e23749e78d5a4f56928efaf3c4b0d862b7a6Johannes Berg		bss->dtim_period = tim_ie->dtim_period;
895484e23749e78d5a4f56928efaf3c4b0d862b7a6Johannes Berg	}
905484e23749e78d5a4f56928efaf3c4b0d862b7a6Johannes Berg
916a211bf1fc63891bfbc510d9caa751c4dee4bc37Johannes Berg	/* set default value for buggy AP/no TIM element */
926a211bf1fc63891bfbc510d9caa751c4dee4bc37Johannes Berg	if (bss->dtim_period == 0)
935484e23749e78d5a4f56928efaf3c4b0d862b7a6Johannes Berg		bss->dtim_period = 1;
945484e23749e78d5a4f56928efaf3c4b0d862b7a6Johannes Berg
955484e23749e78d5a4f56928efaf3c4b0d862b7a6Johannes Berg	bss->supp_rates_len = 0;
965484e23749e78d5a4f56928efaf3c4b0d862b7a6Johannes Berg	if (elems->supp_rates) {
975484e23749e78d5a4f56928efaf3c4b0d862b7a6Johannes Berg		clen = IEEE80211_MAX_SUPP_RATES - bss->supp_rates_len;
985484e23749e78d5a4f56928efaf3c4b0d862b7a6Johannes Berg		if (clen > elems->supp_rates_len)
995484e23749e78d5a4f56928efaf3c4b0d862b7a6Johannes Berg			clen = elems->supp_rates_len;
1005484e23749e78d5a4f56928efaf3c4b0d862b7a6Johannes Berg		memcpy(&bss->supp_rates[bss->supp_rates_len], elems->supp_rates,
1015484e23749e78d5a4f56928efaf3c4b0d862b7a6Johannes Berg		       clen);
1025484e23749e78d5a4f56928efaf3c4b0d862b7a6Johannes Berg		bss->supp_rates_len += clen;
1035484e23749e78d5a4f56928efaf3c4b0d862b7a6Johannes Berg	}
1045484e23749e78d5a4f56928efaf3c4b0d862b7a6Johannes Berg	if (elems->ext_supp_rates) {
1055484e23749e78d5a4f56928efaf3c4b0d862b7a6Johannes Berg		clen = IEEE80211_MAX_SUPP_RATES - bss->supp_rates_len;
1065484e23749e78d5a4f56928efaf3c4b0d862b7a6Johannes Berg		if (clen > elems->ext_supp_rates_len)
1075484e23749e78d5a4f56928efaf3c4b0d862b7a6Johannes Berg			clen = elems->ext_supp_rates_len;
1085484e23749e78d5a4f56928efaf3c4b0d862b7a6Johannes Berg		memcpy(&bss->supp_rates[bss->supp_rates_len],
1095484e23749e78d5a4f56928efaf3c4b0d862b7a6Johannes Berg		       elems->ext_supp_rates, clen);
1105484e23749e78d5a4f56928efaf3c4b0d862b7a6Johannes Berg		bss->supp_rates_len += clen;
1115484e23749e78d5a4f56928efaf3c4b0d862b7a6Johannes Berg	}
1125484e23749e78d5a4f56928efaf3c4b0d862b7a6Johannes Berg
1135484e23749e78d5a4f56928efaf3c4b0d862b7a6Johannes Berg	bss->wmm_used = elems->wmm_param || elems->wmm_info;
1145484e23749e78d5a4f56928efaf3c4b0d862b7a6Johannes Berg
1155484e23749e78d5a4f56928efaf3c4b0d862b7a6Johannes Berg	if (!beacon)
1165484e23749e78d5a4f56928efaf3c4b0d862b7a6Johannes Berg		bss->last_probe_resp = jiffies;
1175484e23749e78d5a4f56928efaf3c4b0d862b7a6Johannes Berg
1185484e23749e78d5a4f56928efaf3c4b0d862b7a6Johannes Berg	return bss;
1195484e23749e78d5a4f56928efaf3c4b0d862b7a6Johannes Berg}
1200a51b27e956bd9580296c48191b78175ed8b5971Johannes Berg
12198c8fccfaea838e62ffde2f2e44568844e0e5472Johannes Bergieee80211_rx_result
122f1d58c2521eb160178b2151d6326d8dc5d7c8560Johannes Bergieee80211_scan_rx(struct ieee80211_sub_if_data *sdata, struct sk_buff *skb)
12398c8fccfaea838e62ffde2f2e44568844e0e5472Johannes Berg{
124f1d58c2521eb160178b2151d6326d8dc5d7c8560Johannes Berg	struct ieee80211_rx_status *rx_status = IEEE80211_SKB_RXCB(skb);
12598c8fccfaea838e62ffde2f2e44568844e0e5472Johannes Berg	struct ieee80211_mgmt *mgmt;
126c2b13452b283f9c4a5b02a6b53ed6416ebf4c03cJohannes Berg	struct ieee80211_bss *bss;
12798c8fccfaea838e62ffde2f2e44568844e0e5472Johannes Berg	u8 *elements;
12898c8fccfaea838e62ffde2f2e44568844e0e5472Johannes Berg	struct ieee80211_channel *channel;
12998c8fccfaea838e62ffde2f2e44568844e0e5472Johannes Berg	size_t baselen;
13098c8fccfaea838e62ffde2f2e44568844e0e5472Johannes Berg	int freq;
13198c8fccfaea838e62ffde2f2e44568844e0e5472Johannes Berg	__le16 fc;
13298c8fccfaea838e62ffde2f2e44568844e0e5472Johannes Berg	bool presp, beacon = false;
13398c8fccfaea838e62ffde2f2e44568844e0e5472Johannes Berg	struct ieee802_11_elems elems;
13498c8fccfaea838e62ffde2f2e44568844e0e5472Johannes Berg
13598c8fccfaea838e62ffde2f2e44568844e0e5472Johannes Berg	if (skb->len < 2)
13698c8fccfaea838e62ffde2f2e44568844e0e5472Johannes Berg		return RX_DROP_UNUSABLE;
13798c8fccfaea838e62ffde2f2e44568844e0e5472Johannes Berg
13898c8fccfaea838e62ffde2f2e44568844e0e5472Johannes Berg	mgmt = (struct ieee80211_mgmt *) skb->data;
13998c8fccfaea838e62ffde2f2e44568844e0e5472Johannes Berg	fc = mgmt->frame_control;
14098c8fccfaea838e62ffde2f2e44568844e0e5472Johannes Berg
14198c8fccfaea838e62ffde2f2e44568844e0e5472Johannes Berg	if (ieee80211_is_ctl(fc))
14298c8fccfaea838e62ffde2f2e44568844e0e5472Johannes Berg		return RX_CONTINUE;
14398c8fccfaea838e62ffde2f2e44568844e0e5472Johannes Berg
14498c8fccfaea838e62ffde2f2e44568844e0e5472Johannes Berg	if (skb->len < 24)
14598c8fccfaea838e62ffde2f2e44568844e0e5472Johannes Berg		return RX_DROP_MONITOR;
14698c8fccfaea838e62ffde2f2e44568844e0e5472Johannes Berg
14798c8fccfaea838e62ffde2f2e44568844e0e5472Johannes Berg	presp = ieee80211_is_probe_resp(fc);
14898c8fccfaea838e62ffde2f2e44568844e0e5472Johannes Berg	if (presp) {
14998c8fccfaea838e62ffde2f2e44568844e0e5472Johannes Berg		/* ignore ProbeResp to foreign address */
15047846c9b0c10808d9337d2e7d09361f3e0a0a71aJohannes Berg		if (memcmp(mgmt->da, sdata->vif.addr, ETH_ALEN))
15198c8fccfaea838e62ffde2f2e44568844e0e5472Johannes Berg			return RX_DROP_MONITOR;
15298c8fccfaea838e62ffde2f2e44568844e0e5472Johannes Berg
15398c8fccfaea838e62ffde2f2e44568844e0e5472Johannes Berg		presp = true;
15498c8fccfaea838e62ffde2f2e44568844e0e5472Johannes Berg		elements = mgmt->u.probe_resp.variable;
15598c8fccfaea838e62ffde2f2e44568844e0e5472Johannes Berg		baselen = offsetof(struct ieee80211_mgmt, u.probe_resp.variable);
15698c8fccfaea838e62ffde2f2e44568844e0e5472Johannes Berg	} else {
15798c8fccfaea838e62ffde2f2e44568844e0e5472Johannes Berg		beacon = ieee80211_is_beacon(fc);
15898c8fccfaea838e62ffde2f2e44568844e0e5472Johannes Berg		baselen = offsetof(struct ieee80211_mgmt, u.beacon.variable);
15998c8fccfaea838e62ffde2f2e44568844e0e5472Johannes Berg		elements = mgmt->u.beacon.variable;
16098c8fccfaea838e62ffde2f2e44568844e0e5472Johannes Berg	}
16198c8fccfaea838e62ffde2f2e44568844e0e5472Johannes Berg
16298c8fccfaea838e62ffde2f2e44568844e0e5472Johannes Berg	if (!presp && !beacon)
16398c8fccfaea838e62ffde2f2e44568844e0e5472Johannes Berg		return RX_CONTINUE;
16498c8fccfaea838e62ffde2f2e44568844e0e5472Johannes Berg
16598c8fccfaea838e62ffde2f2e44568844e0e5472Johannes Berg	if (baselen > skb->len)
16698c8fccfaea838e62ffde2f2e44568844e0e5472Johannes Berg		return RX_DROP_MONITOR;
16798c8fccfaea838e62ffde2f2e44568844e0e5472Johannes Berg
16898c8fccfaea838e62ffde2f2e44568844e0e5472Johannes Berg	ieee802_11_parse_elems(elements, skb->len - baselen, &elems);
16998c8fccfaea838e62ffde2f2e44568844e0e5472Johannes Berg
17098c8fccfaea838e62ffde2f2e44568844e0e5472Johannes Berg	if (elems.ds_params && elems.ds_params_len == 1)
17198c8fccfaea838e62ffde2f2e44568844e0e5472Johannes Berg		freq = ieee80211_channel_to_frequency(elems.ds_params[0]);
17298c8fccfaea838e62ffde2f2e44568844e0e5472Johannes Berg	else
17398c8fccfaea838e62ffde2f2e44568844e0e5472Johannes Berg		freq = rx_status->freq;
17498c8fccfaea838e62ffde2f2e44568844e0e5472Johannes Berg
17598c8fccfaea838e62ffde2f2e44568844e0e5472Johannes Berg	channel = ieee80211_get_channel(sdata->local->hw.wiphy, freq);
17698c8fccfaea838e62ffde2f2e44568844e0e5472Johannes Berg
17798c8fccfaea838e62ffde2f2e44568844e0e5472Johannes Berg	if (!channel || channel->flags & IEEE80211_CHAN_DISABLED)
17898c8fccfaea838e62ffde2f2e44568844e0e5472Johannes Berg		return RX_DROP_MONITOR;
17998c8fccfaea838e62ffde2f2e44568844e0e5472Johannes Berg
18098c8fccfaea838e62ffde2f2e44568844e0e5472Johannes Berg	bss = ieee80211_bss_info_update(sdata->local, rx_status,
18198c8fccfaea838e62ffde2f2e44568844e0e5472Johannes Berg					mgmt, skb->len, &elems,
1822a5193119269062608582418deba7af82844159aJohannes Berg					channel, beacon);
183d048e503a2b01e771ee87921c24d89d7ec3f0c2fJouni Malinen	if (bss)
184d048e503a2b01e771ee87921c24d89d7ec3f0c2fJouni Malinen		ieee80211_rx_bss_put(sdata->local, bss);
18598c8fccfaea838e62ffde2f2e44568844e0e5472Johannes Berg
18698c8fccfaea838e62ffde2f2e44568844e0e5472Johannes Berg	dev_kfree_skb(skb);
18798c8fccfaea838e62ffde2f2e44568844e0e5472Johannes Berg	return RX_QUEUED;
18898c8fccfaea838e62ffde2f2e44568844e0e5472Johannes Berg}
18998c8fccfaea838e62ffde2f2e44568844e0e5472Johannes Berg
1904d36ec58239eec44d77839ef6c25108efcbbb58cJohannes Berg/* return false if no more work */
1914d36ec58239eec44d77839ef6c25108efcbbb58cJohannes Bergstatic bool ieee80211_prep_hw_scan(struct ieee80211_local *local)
1924d36ec58239eec44d77839ef6c25108efcbbb58cJohannes Berg{
1934d36ec58239eec44d77839ef6c25108efcbbb58cJohannes Berg	struct cfg80211_scan_request *req = local->scan_req;
1944d36ec58239eec44d77839ef6c25108efcbbb58cJohannes Berg	enum ieee80211_band band;
1954d36ec58239eec44d77839ef6c25108efcbbb58cJohannes Berg	int i, ielen, n_chans;
1964d36ec58239eec44d77839ef6c25108efcbbb58cJohannes Berg
1974d36ec58239eec44d77839ef6c25108efcbbb58cJohannes Berg	do {
1984d36ec58239eec44d77839ef6c25108efcbbb58cJohannes Berg		if (local->hw_scan_band == IEEE80211_NUM_BANDS)
1994d36ec58239eec44d77839ef6c25108efcbbb58cJohannes Berg			return false;
2004d36ec58239eec44d77839ef6c25108efcbbb58cJohannes Berg
2014d36ec58239eec44d77839ef6c25108efcbbb58cJohannes Berg		band = local->hw_scan_band;
2024d36ec58239eec44d77839ef6c25108efcbbb58cJohannes Berg		n_chans = 0;
2034d36ec58239eec44d77839ef6c25108efcbbb58cJohannes Berg		for (i = 0; i < req->n_channels; i++) {
2044d36ec58239eec44d77839ef6c25108efcbbb58cJohannes Berg			if (req->channels[i]->band == band) {
2054d36ec58239eec44d77839ef6c25108efcbbb58cJohannes Berg				local->hw_scan_req->channels[n_chans] =
2064d36ec58239eec44d77839ef6c25108efcbbb58cJohannes Berg							req->channels[i];
2074d36ec58239eec44d77839ef6c25108efcbbb58cJohannes Berg				n_chans++;
2084d36ec58239eec44d77839ef6c25108efcbbb58cJohannes Berg			}
2094d36ec58239eec44d77839ef6c25108efcbbb58cJohannes Berg		}
2104d36ec58239eec44d77839ef6c25108efcbbb58cJohannes Berg
2114d36ec58239eec44d77839ef6c25108efcbbb58cJohannes Berg		local->hw_scan_band++;
2124d36ec58239eec44d77839ef6c25108efcbbb58cJohannes Berg	} while (!n_chans);
2134d36ec58239eec44d77839ef6c25108efcbbb58cJohannes Berg
2144d36ec58239eec44d77839ef6c25108efcbbb58cJohannes Berg	local->hw_scan_req->n_channels = n_chans;
2154d36ec58239eec44d77839ef6c25108efcbbb58cJohannes Berg
2164d36ec58239eec44d77839ef6c25108efcbbb58cJohannes Berg	ielen = ieee80211_build_preq_ies(local, (u8 *)local->hw_scan_req->ie,
2174d36ec58239eec44d77839ef6c25108efcbbb58cJohannes Berg					 req->ie, req->ie_len, band);
2184d36ec58239eec44d77839ef6c25108efcbbb58cJohannes Berg	local->hw_scan_req->ie_len = ielen;
2194d36ec58239eec44d77839ef6c25108efcbbb58cJohannes Berg
2204d36ec58239eec44d77839ef6c25108efcbbb58cJohannes Berg	return true;
2214d36ec58239eec44d77839ef6c25108efcbbb58cJohannes Berg}
2224d36ec58239eec44d77839ef6c25108efcbbb58cJohannes Berg
2239050bdd8589c373e01e41ddbd9a192de2ff01ef0Kalle Valo/*
2249050bdd8589c373e01e41ddbd9a192de2ff01ef0Kalle Valo * inform AP that we will go to sleep so that it will buffer the frames
2259050bdd8589c373e01e41ddbd9a192de2ff01ef0Kalle Valo * while we scan
2269050bdd8589c373e01e41ddbd9a192de2ff01ef0Kalle Valo */
2279050bdd8589c373e01e41ddbd9a192de2ff01ef0Kalle Valostatic void ieee80211_scan_ps_enable(struct ieee80211_sub_if_data *sdata)
2289050bdd8589c373e01e41ddbd9a192de2ff01ef0Kalle Valo{
2299050bdd8589c373e01e41ddbd9a192de2ff01ef0Kalle Valo	struct ieee80211_local *local = sdata->local;
2307c3f4bbedc241ddcd3abe1f419c356e625231da1Vivek Natarajan
2317c3f4bbedc241ddcd3abe1f419c356e625231da1Vivek Natarajan	local->scan_ps_enabled = false;
2329050bdd8589c373e01e41ddbd9a192de2ff01ef0Kalle Valo
2339050bdd8589c373e01e41ddbd9a192de2ff01ef0Kalle Valo	/* FIXME: what to do when local->pspolling is true? */
2349050bdd8589c373e01e41ddbd9a192de2ff01ef0Kalle Valo
2359050bdd8589c373e01e41ddbd9a192de2ff01ef0Kalle Valo	del_timer_sync(&local->dynamic_ps_timer);
2369050bdd8589c373e01e41ddbd9a192de2ff01ef0Kalle Valo	cancel_work_sync(&local->dynamic_ps_enable_work);
2379050bdd8589c373e01e41ddbd9a192de2ff01ef0Kalle Valo
2389050bdd8589c373e01e41ddbd9a192de2ff01ef0Kalle Valo	if (local->hw.conf.flags & IEEE80211_CONF_PS) {
2397c3f4bbedc241ddcd3abe1f419c356e625231da1Vivek Natarajan		local->scan_ps_enabled = true;
2409050bdd8589c373e01e41ddbd9a192de2ff01ef0Kalle Valo		local->hw.conf.flags &= ~IEEE80211_CONF_PS;
2419050bdd8589c373e01e41ddbd9a192de2ff01ef0Kalle Valo		ieee80211_hw_config(local, IEEE80211_CONF_CHANGE_PS);
2429050bdd8589c373e01e41ddbd9a192de2ff01ef0Kalle Valo	}
2439050bdd8589c373e01e41ddbd9a192de2ff01ef0Kalle Valo
2447c3f4bbedc241ddcd3abe1f419c356e625231da1Vivek Natarajan	if (!(local->scan_ps_enabled) ||
2457c3f4bbedc241ddcd3abe1f419c356e625231da1Vivek Natarajan	    !(local->hw.flags & IEEE80211_HW_PS_NULLFUNC_STACK))
2469050bdd8589c373e01e41ddbd9a192de2ff01ef0Kalle Valo		/*
2479050bdd8589c373e01e41ddbd9a192de2ff01ef0Kalle Valo		 * If power save was enabled, no need to send a nullfunc
2489050bdd8589c373e01e41ddbd9a192de2ff01ef0Kalle Valo		 * frame because AP knows that we are sleeping. But if the
2499050bdd8589c373e01e41ddbd9a192de2ff01ef0Kalle Valo		 * hardware is creating the nullfunc frame for power save
2509050bdd8589c373e01e41ddbd9a192de2ff01ef0Kalle Valo		 * status (ie. IEEE80211_HW_PS_NULLFUNC_STACK is not
2519050bdd8589c373e01e41ddbd9a192de2ff01ef0Kalle Valo		 * enabled) and power save was enabled, the firmware just
2529050bdd8589c373e01e41ddbd9a192de2ff01ef0Kalle Valo		 * sent a null frame with power save disabled. So we need
2539050bdd8589c373e01e41ddbd9a192de2ff01ef0Kalle Valo		 * to send a new nullfunc frame to inform the AP that we
2549050bdd8589c373e01e41ddbd9a192de2ff01ef0Kalle Valo		 * are again sleeping.
2559050bdd8589c373e01e41ddbd9a192de2ff01ef0Kalle Valo		 */
2569050bdd8589c373e01e41ddbd9a192de2ff01ef0Kalle Valo		ieee80211_send_nullfunc(local, sdata, 1);
2579050bdd8589c373e01e41ddbd9a192de2ff01ef0Kalle Valo}
2589050bdd8589c373e01e41ddbd9a192de2ff01ef0Kalle Valo
2599050bdd8589c373e01e41ddbd9a192de2ff01ef0Kalle Valo/* inform AP that we are awake again, unless power save is enabled */
2609050bdd8589c373e01e41ddbd9a192de2ff01ef0Kalle Valostatic void ieee80211_scan_ps_disable(struct ieee80211_sub_if_data *sdata)
2619050bdd8589c373e01e41ddbd9a192de2ff01ef0Kalle Valo{
2629050bdd8589c373e01e41ddbd9a192de2ff01ef0Kalle Valo	struct ieee80211_local *local = sdata->local;
2639050bdd8589c373e01e41ddbd9a192de2ff01ef0Kalle Valo
264965bedadc01d34027455d5d5b67063ef0209c955Johannes Berg	if (!local->ps_sdata)
2659050bdd8589c373e01e41ddbd9a192de2ff01ef0Kalle Valo		ieee80211_send_nullfunc(local, sdata, 0);
2667c3f4bbedc241ddcd3abe1f419c356e625231da1Vivek Natarajan	else if (local->scan_ps_enabled) {
2679050bdd8589c373e01e41ddbd9a192de2ff01ef0Kalle Valo		/*
2689050bdd8589c373e01e41ddbd9a192de2ff01ef0Kalle Valo		 * In !IEEE80211_HW_PS_NULLFUNC_STACK case the hardware
2699050bdd8589c373e01e41ddbd9a192de2ff01ef0Kalle Valo		 * will send a nullfunc frame with the powersave bit set
2709050bdd8589c373e01e41ddbd9a192de2ff01ef0Kalle Valo		 * even though the AP already knows that we are sleeping.
2719050bdd8589c373e01e41ddbd9a192de2ff01ef0Kalle Valo		 * This could be avoided by sending a null frame with power
2729050bdd8589c373e01e41ddbd9a192de2ff01ef0Kalle Valo		 * save bit disabled before enabling the power save, but
2739050bdd8589c373e01e41ddbd9a192de2ff01ef0Kalle Valo		 * this doesn't gain anything.
2749050bdd8589c373e01e41ddbd9a192de2ff01ef0Kalle Valo		 *
2759050bdd8589c373e01e41ddbd9a192de2ff01ef0Kalle Valo		 * When IEEE80211_HW_PS_NULLFUNC_STACK is enabled, no need
2769050bdd8589c373e01e41ddbd9a192de2ff01ef0Kalle Valo		 * to send a nullfunc frame because AP already knows that
2779050bdd8589c373e01e41ddbd9a192de2ff01ef0Kalle Valo		 * we are sleeping, let's just enable power save mode in
2789050bdd8589c373e01e41ddbd9a192de2ff01ef0Kalle Valo		 * hardware.
2799050bdd8589c373e01e41ddbd9a192de2ff01ef0Kalle Valo		 */
2809050bdd8589c373e01e41ddbd9a192de2ff01ef0Kalle Valo		local->hw.conf.flags |= IEEE80211_CONF_PS;
2819050bdd8589c373e01e41ddbd9a192de2ff01ef0Kalle Valo		ieee80211_hw_config(local, IEEE80211_CONF_CHANGE_PS);
2827c3f4bbedc241ddcd3abe1f419c356e625231da1Vivek Natarajan	} else if (local->hw.conf.dynamic_ps_timeout > 0) {
2837c3f4bbedc241ddcd3abe1f419c356e625231da1Vivek Natarajan		/*
2847c3f4bbedc241ddcd3abe1f419c356e625231da1Vivek Natarajan		 * If IEEE80211_CONF_PS was not set and the dynamic_ps_timer
2857c3f4bbedc241ddcd3abe1f419c356e625231da1Vivek Natarajan		 * had been running before leaving the operating channel,
2867c3f4bbedc241ddcd3abe1f419c356e625231da1Vivek Natarajan		 * restart the timer now and send a nullfunc frame to inform
2877c3f4bbedc241ddcd3abe1f419c356e625231da1Vivek Natarajan		 * the AP that we are awake.
2887c3f4bbedc241ddcd3abe1f419c356e625231da1Vivek Natarajan		 */
2897c3f4bbedc241ddcd3abe1f419c356e625231da1Vivek Natarajan		ieee80211_send_nullfunc(local, sdata, 0);
2907c3f4bbedc241ddcd3abe1f419c356e625231da1Vivek Natarajan		mod_timer(&local->dynamic_ps_timer, jiffies +
2917c3f4bbedc241ddcd3abe1f419c356e625231da1Vivek Natarajan			  msecs_to_jiffies(local->hw.conf.dynamic_ps_timeout));
2929050bdd8589c373e01e41ddbd9a192de2ff01ef0Kalle Valo	}
2939050bdd8589c373e01e41ddbd9a192de2ff01ef0Kalle Valo}
2949050bdd8589c373e01e41ddbd9a192de2ff01ef0Kalle Valo
2952a5193119269062608582418deba7af82844159aJohannes Bergvoid ieee80211_scan_completed(struct ieee80211_hw *hw, bool aborted)
2960a51b27e956bd9580296c48191b78175ed8b5971Johannes Berg{
2970a51b27e956bd9580296c48191b78175ed8b5971Johannes Berg	struct ieee80211_local *local = hw_to_local(hw);
2980a51b27e956bd9580296c48191b78175ed8b5971Johannes Berg	struct ieee80211_sub_if_data *sdata;
299f3b85252f081581a8f257545ed748062dce7798bJohannes Berg	bool was_hw_scan;
3000a51b27e956bd9580296c48191b78175ed8b5971Johannes Berg
301f3b85252f081581a8f257545ed748062dce7798bJohannes Berg	mutex_lock(&local->scan_mtx);
3025bc75728fd43bb15b46f16ef465bcf9d487393cfJohannes Berg
3036d3560d4fc9c5b9fe1a07a63926ea70512c69c32Johannes Berg	/*
3046d3560d4fc9c5b9fe1a07a63926ea70512c69c32Johannes Berg	 * It's ok to abort a not-yet-running scan (that
3056d3560d4fc9c5b9fe1a07a63926ea70512c69c32Johannes Berg	 * we have one at all will be verified by checking
3066d3560d4fc9c5b9fe1a07a63926ea70512c69c32Johannes Berg	 * local->scan_req next), but not to complete it
3076d3560d4fc9c5b9fe1a07a63926ea70512c69c32Johannes Berg	 * successfully.
3086d3560d4fc9c5b9fe1a07a63926ea70512c69c32Johannes Berg	 */
3096d3560d4fc9c5b9fe1a07a63926ea70512c69c32Johannes Berg	if (WARN_ON(!local->scanning && !aborted))
3106d3560d4fc9c5b9fe1a07a63926ea70512c69c32Johannes Berg		aborted = true;
3115bc75728fd43bb15b46f16ef465bcf9d487393cfJohannes Berg
312f3b85252f081581a8f257545ed748062dce7798bJohannes Berg	if (WARN_ON(!local->scan_req)) {
313f3b85252f081581a8f257545ed748062dce7798bJohannes Berg		mutex_unlock(&local->scan_mtx);
314f3b85252f081581a8f257545ed748062dce7798bJohannes Berg		return;
315de95a54b1aebe5592cae971ca5e5d9ec6a381a17Johannes Berg	}
316de95a54b1aebe5592cae971ca5e5d9ec6a381a17Johannes Berg
3174d36ec58239eec44d77839ef6c25108efcbbb58cJohannes Berg	was_hw_scan = test_bit(SCAN_HW_SCANNING, &local->scanning);
3184d36ec58239eec44d77839ef6c25108efcbbb58cJohannes Berg	if (was_hw_scan && !aborted && ieee80211_prep_hw_scan(local)) {
3194d36ec58239eec44d77839ef6c25108efcbbb58cJohannes Berg		ieee80211_queue_delayed_work(&local->hw,
3204d36ec58239eec44d77839ef6c25108efcbbb58cJohannes Berg					     &local->scan_work, 0);
3214d36ec58239eec44d77839ef6c25108efcbbb58cJohannes Berg		mutex_unlock(&local->scan_mtx);
3224d36ec58239eec44d77839ef6c25108efcbbb58cJohannes Berg		return;
3234d36ec58239eec44d77839ef6c25108efcbbb58cJohannes Berg	}
3244d36ec58239eec44d77839ef6c25108efcbbb58cJohannes Berg
3254d36ec58239eec44d77839ef6c25108efcbbb58cJohannes Berg	kfree(local->hw_scan_req);
3264d36ec58239eec44d77839ef6c25108efcbbb58cJohannes Berg	local->hw_scan_req = NULL;
327f3b85252f081581a8f257545ed748062dce7798bJohannes Berg
3285ba63533bbf653631faab60f6988506160ec6ba4Johannes Berg	if (local->scan_req != local->int_scan_req)
3292a5193119269062608582418deba7af82844159aJohannes Berg		cfg80211_scan_done(local->scan_req, aborted);
3302a5193119269062608582418deba7af82844159aJohannes Berg	local->scan_req = NULL;
33115db0b7fd872b0312033666d3a82e1214a227ec0Johannes Berg	local->scan_sdata = NULL;
3322a5193119269062608582418deba7af82844159aJohannes Berg
333fbe9c429f195111bbf7f1630efa19aee295fd8e7Helmut Schaa	local->scanning = 0;
33458905ca5b11a0ff3860f55b789cbbf052f7158a7Johannes Berg	local->scan_channel = NULL;
335f3b85252f081581a8f257545ed748062dce7798bJohannes Berg
336f3b85252f081581a8f257545ed748062dce7798bJohannes Berg	/* we only have to protect scan_req and hw/sw scan */
337f3b85252f081581a8f257545ed748062dce7798bJohannes Berg	mutex_unlock(&local->scan_mtx);
338f3b85252f081581a8f257545ed748062dce7798bJohannes Berg
339e8975581f63870be42ff4662b293d1b0c8c21350Johannes Berg	ieee80211_hw_config(local, IEEE80211_CONF_CHANGE_CHANNEL);
3405cff20e6c5a6591a79d3b027af222870f52bb550Johannes Berg	if (was_hw_scan)
3415cff20e6c5a6591a79d3b027af222870f52bb550Johannes Berg		goto done;
3420a51b27e956bd9580296c48191b78175ed8b5971Johannes Berg
3433ac64beecd27400d12cc7afb4108eef26c499f6aJohannes Berg	ieee80211_configure_filter(local);
3440a51b27e956bd9580296c48191b78175ed8b5971Johannes Berg
3452448798133d747ad339e57099e32a1d1e68aca1cJohannes Berg	drv_sw_scan_complete(local);
34680e775bf08f1915870fbb0c1c7a45a3fdc291721Michael Buesch
347078e1e60dd6c6b0d4bc8d58ccb80c008e8efc9ffJohannes Berg	mutex_lock(&local->iflist_mtx);
348078e1e60dd6c6b0d4bc8d58ccb80c008e8efc9ffJohannes Berg	list_for_each_entry(sdata, &local->interfaces, list) {
3499607e6b66a0d25ca63b70d54a4283fa13d8f7c9dJohannes Berg		if (!ieee80211_sdata_running(sdata))
350fb9ddbf086591ab4c90c44d10468f84d465b3fdfJohannes Berg			continue;
351fb9ddbf086591ab4c90c44d10468f84d465b3fdfJohannes Berg
3520a51b27e956bd9580296c48191b78175ed8b5971Johannes Berg		/* Tell AP we're back */
35305c914fe330fa8e1cc67870dc0d3809dfd96c107Johannes Berg		if (sdata->vif.type == NL80211_IFTYPE_STATION) {
35477fdaa12cea26c204cc12c312fe40bc0f3dcdfd8Johannes Berg			if (sdata->u.mgd.associated) {
3559050bdd8589c373e01e41ddbd9a192de2ff01ef0Kalle Valo				ieee80211_scan_ps_disable(sdata);
35653623f1a09c7a7d23b74f0f7d93dba0ebde1006bJohn W. Linville				netif_wake_queue(sdata->dev);
3570a51b27e956bd9580296c48191b78175ed8b5971Johannes Berg			}
3580a51b27e956bd9580296c48191b78175ed8b5971Johannes Berg		} else
35953623f1a09c7a7d23b74f0f7d93dba0ebde1006bJohn W. Linville			netif_wake_queue(sdata->dev);
360078e1e60dd6c6b0d4bc8d58ccb80c008e8efc9ffJohannes Berg
36114b80724367dfdc86f4807461dd1f7f2dd630416Johannes Berg		/* re-enable beaconing */
36214b80724367dfdc86f4807461dd1f7f2dd630416Johannes Berg		if (sdata->vif.type == NL80211_IFTYPE_AP ||
36314b80724367dfdc86f4807461dd1f7f2dd630416Johannes Berg		    sdata->vif.type == NL80211_IFTYPE_ADHOC ||
36414b80724367dfdc86f4807461dd1f7f2dd630416Johannes Berg		    sdata->vif.type == NL80211_IFTYPE_MESH_POINT)
3652d0ddec5b2b859f06116f631fc0ffe94fbceb556Johannes Berg			ieee80211_bss_info_change_notify(
3662d0ddec5b2b859f06116f631fc0ffe94fbceb556Johannes Berg				sdata, BSS_CHANGED_BEACON_ENABLED);
3670a51b27e956bd9580296c48191b78175ed8b5971Johannes Berg	}
368078e1e60dd6c6b0d4bc8d58ccb80c008e8efc9ffJohannes Berg	mutex_unlock(&local->iflist_mtx);
3690a51b27e956bd9580296c48191b78175ed8b5971Johannes Berg
3700a51b27e956bd9580296c48191b78175ed8b5971Johannes Berg done:
3715cff20e6c5a6591a79d3b027af222870f52bb550Johannes Berg	ieee80211_recalc_idle(local);
3720a51b27e956bd9580296c48191b78175ed8b5971Johannes Berg	ieee80211_mlme_notify_scan_completed(local);
373469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg	ieee80211_ibss_notify_scan_completed(local);
374472dbc45dc1966284de72d7de15690c17ed2cf33Johannes Berg	ieee80211_mesh_notify_scan_completed(local);
3750a51b27e956bd9580296c48191b78175ed8b5971Johannes Berg}
3760a51b27e956bd9580296c48191b78175ed8b5971Johannes BergEXPORT_SYMBOL(ieee80211_scan_completed);
3770a51b27e956bd9580296c48191b78175ed8b5971Johannes Berg
378f3b85252f081581a8f257545ed748062dce7798bJohannes Bergstatic int ieee80211_start_sw_scan(struct ieee80211_local *local)
379f3b85252f081581a8f257545ed748062dce7798bJohannes Berg{
380f3b85252f081581a8f257545ed748062dce7798bJohannes Berg	struct ieee80211_sub_if_data *sdata;
381f3b85252f081581a8f257545ed748062dce7798bJohannes Berg
382f3b85252f081581a8f257545ed748062dce7798bJohannes Berg	/*
383f3b85252f081581a8f257545ed748062dce7798bJohannes Berg	 * Hardware/driver doesn't support hw_scan, so use software
384f3b85252f081581a8f257545ed748062dce7798bJohannes Berg	 * scanning instead. First send a nullfunc frame with power save
385f3b85252f081581a8f257545ed748062dce7798bJohannes Berg	 * bit on so that AP will buffer the frames for us while we are not
386f3b85252f081581a8f257545ed748062dce7798bJohannes Berg	 * listening, then send probe requests to each channel and wait for
387f3b85252f081581a8f257545ed748062dce7798bJohannes Berg	 * the responses. After all channels are scanned, tune back to the
388f3b85252f081581a8f257545ed748062dce7798bJohannes Berg	 * original channel and send a nullfunc frame with power save bit
389f3b85252f081581a8f257545ed748062dce7798bJohannes Berg	 * off to trigger the AP to send us all the buffered frames.
390f3b85252f081581a8f257545ed748062dce7798bJohannes Berg	 *
391f3b85252f081581a8f257545ed748062dce7798bJohannes Berg	 * Note that while local->sw_scanning is true everything else but
392f3b85252f081581a8f257545ed748062dce7798bJohannes Berg	 * nullfunc frames and probe requests will be dropped in
393f3b85252f081581a8f257545ed748062dce7798bJohannes Berg	 * ieee80211_tx_h_check_assoc().
394f3b85252f081581a8f257545ed748062dce7798bJohannes Berg	 */
3952448798133d747ad339e57099e32a1d1e68aca1cJohannes Berg	drv_sw_scan_start(local);
396f3b85252f081581a8f257545ed748062dce7798bJohannes Berg
397f3b85252f081581a8f257545ed748062dce7798bJohannes Berg	mutex_lock(&local->iflist_mtx);
398f3b85252f081581a8f257545ed748062dce7798bJohannes Berg	list_for_each_entry(sdata, &local->interfaces, list) {
3999607e6b66a0d25ca63b70d54a4283fa13d8f7c9dJohannes Berg		if (!ieee80211_sdata_running(sdata))
400f3b85252f081581a8f257545ed748062dce7798bJohannes Berg			continue;
401f3b85252f081581a8f257545ed748062dce7798bJohannes Berg
402f3b85252f081581a8f257545ed748062dce7798bJohannes Berg		/* disable beaconing */
403f3b85252f081581a8f257545ed748062dce7798bJohannes Berg		if (sdata->vif.type == NL80211_IFTYPE_AP ||
404f3b85252f081581a8f257545ed748062dce7798bJohannes Berg		    sdata->vif.type == NL80211_IFTYPE_ADHOC ||
405f3b85252f081581a8f257545ed748062dce7798bJohannes Berg		    sdata->vif.type == NL80211_IFTYPE_MESH_POINT)
4062d0ddec5b2b859f06116f631fc0ffe94fbceb556Johannes Berg			ieee80211_bss_info_change_notify(
4072d0ddec5b2b859f06116f631fc0ffe94fbceb556Johannes Berg				sdata, BSS_CHANGED_BEACON_ENABLED);
408f3b85252f081581a8f257545ed748062dce7798bJohannes Berg
409142b9f5074dc0d09dc0025739ad437723d7bf527Helmut Schaa		/*
410142b9f5074dc0d09dc0025739ad437723d7bf527Helmut Schaa		 * only handle non-STA interfaces here, STA interfaces
411142b9f5074dc0d09dc0025739ad437723d7bf527Helmut Schaa		 * are handled in the scan state machine
412142b9f5074dc0d09dc0025739ad437723d7bf527Helmut Schaa		 */
413142b9f5074dc0d09dc0025739ad437723d7bf527Helmut Schaa		if (sdata->vif.type != NL80211_IFTYPE_STATION)
41453623f1a09c7a7d23b74f0f7d93dba0ebde1006bJohn W. Linville			netif_stop_queue(sdata->dev);
415f3b85252f081581a8f257545ed748062dce7798bJohannes Berg	}
416f3b85252f081581a8f257545ed748062dce7798bJohannes Berg	mutex_unlock(&local->iflist_mtx);
417f3b85252f081581a8f257545ed748062dce7798bJohannes Berg
418977923b00c79185c11b4b47664f5ffa4c3820438Helmut Schaa	local->next_scan_state = SCAN_DECISION;
419f3b85252f081581a8f257545ed748062dce7798bJohannes Berg	local->scan_channel_idx = 0;
420f3b85252f081581a8f257545ed748062dce7798bJohannes Berg
421a80f7c0b088187c8471b441d461e937991870661Johannes Berg	drv_flush(local, false);
422a80f7c0b088187c8471b441d461e937991870661Johannes Berg
4233ac64beecd27400d12cc7afb4108eef26c499f6aJohannes Berg	ieee80211_configure_filter(local);
424f3b85252f081581a8f257545ed748062dce7798bJohannes Berg
42542935ecaf4e784d0815afa9a7e5fe7e141157ca3Luis R. Rodriguez	ieee80211_queue_delayed_work(&local->hw,
42642935ecaf4e784d0815afa9a7e5fe7e141157ca3Luis R. Rodriguez				     &local->scan_work,
42742935ecaf4e784d0815afa9a7e5fe7e141157ca3Luis R. Rodriguez				     IEEE80211_CHANNEL_TIME);
428f3b85252f081581a8f257545ed748062dce7798bJohannes Berg
429f3b85252f081581a8f257545ed748062dce7798bJohannes Berg	return 0;
430f3b85252f081581a8f257545ed748062dce7798bJohannes Berg}
431f3b85252f081581a8f257545ed748062dce7798bJohannes Berg
432f3b85252f081581a8f257545ed748062dce7798bJohannes Berg
433f3b85252f081581a8f257545ed748062dce7798bJohannes Bergstatic int __ieee80211_start_scan(struct ieee80211_sub_if_data *sdata,
434f3b85252f081581a8f257545ed748062dce7798bJohannes Berg				  struct cfg80211_scan_request *req)
435f3b85252f081581a8f257545ed748062dce7798bJohannes Berg{
436f3b85252f081581a8f257545ed748062dce7798bJohannes Berg	struct ieee80211_local *local = sdata->local;
437f3b85252f081581a8f257545ed748062dce7798bJohannes Berg	struct ieee80211_if_managed *ifmgd = &sdata->u.mgd;
438f3b85252f081581a8f257545ed748062dce7798bJohannes Berg	int rc;
439f3b85252f081581a8f257545ed748062dce7798bJohannes Berg
440f3b85252f081581a8f257545ed748062dce7798bJohannes Berg	if (local->scan_req)
441f3b85252f081581a8f257545ed748062dce7798bJohannes Berg		return -EBUSY;
442f3b85252f081581a8f257545ed748062dce7798bJohannes Berg
443f3b85252f081581a8f257545ed748062dce7798bJohannes Berg	if (local->ops->hw_scan) {
444f3b85252f081581a8f257545ed748062dce7798bJohannes Berg		u8 *ies;
445f3b85252f081581a8f257545ed748062dce7798bJohannes Berg
4464d36ec58239eec44d77839ef6c25108efcbbb58cJohannes Berg		local->hw_scan_req = kmalloc(
4474d36ec58239eec44d77839ef6c25108efcbbb58cJohannes Berg				sizeof(*local->hw_scan_req) +
4484d36ec58239eec44d77839ef6c25108efcbbb58cJohannes Berg				req->n_channels * sizeof(req->channels[0]) +
4494d36ec58239eec44d77839ef6c25108efcbbb58cJohannes Berg				2 + IEEE80211_MAX_SSID_LEN + local->scan_ies_len +
4504d36ec58239eec44d77839ef6c25108efcbbb58cJohannes Berg				req->ie_len, GFP_KERNEL);
4514d36ec58239eec44d77839ef6c25108efcbbb58cJohannes Berg		if (!local->hw_scan_req)
452f3b85252f081581a8f257545ed748062dce7798bJohannes Berg			return -ENOMEM;
453f3b85252f081581a8f257545ed748062dce7798bJohannes Berg
4544d36ec58239eec44d77839ef6c25108efcbbb58cJohannes Berg		local->hw_scan_req->ssids = req->ssids;
4554d36ec58239eec44d77839ef6c25108efcbbb58cJohannes Berg		local->hw_scan_req->n_ssids = req->n_ssids;
4564d36ec58239eec44d77839ef6c25108efcbbb58cJohannes Berg		ies = (u8 *)local->hw_scan_req +
4574d36ec58239eec44d77839ef6c25108efcbbb58cJohannes Berg			sizeof(*local->hw_scan_req) +
4584d36ec58239eec44d77839ef6c25108efcbbb58cJohannes Berg			req->n_channels * sizeof(req->channels[0]);
4594d36ec58239eec44d77839ef6c25108efcbbb58cJohannes Berg		local->hw_scan_req->ie = ies;
4604d36ec58239eec44d77839ef6c25108efcbbb58cJohannes Berg
4614d36ec58239eec44d77839ef6c25108efcbbb58cJohannes Berg		local->hw_scan_band = 0;
462f3b85252f081581a8f257545ed748062dce7798bJohannes Berg	}
463f3b85252f081581a8f257545ed748062dce7798bJohannes Berg
464f3b85252f081581a8f257545ed748062dce7798bJohannes Berg	local->scan_req = req;
465f3b85252f081581a8f257545ed748062dce7798bJohannes Berg	local->scan_sdata = sdata;
466f3b85252f081581a8f257545ed748062dce7798bJohannes Berg
4675ba63533bbf653631faab60f6988506160ec6ba4Johannes Berg	if (req != local->int_scan_req &&
468f3b85252f081581a8f257545ed748062dce7798bJohannes Berg	    sdata->vif.type == NL80211_IFTYPE_STATION &&
46977fdaa12cea26c204cc12c312fe40bc0f3dcdfd8Johannes Berg	    !list_empty(&ifmgd->work_list)) {
47077fdaa12cea26c204cc12c312fe40bc0f3dcdfd8Johannes Berg		/* actually wait for the work it's doing to finish/time out */
471f3b85252f081581a8f257545ed748062dce7798bJohannes Berg		set_bit(IEEE80211_STA_REQ_SCAN, &ifmgd->request);
472f3b85252f081581a8f257545ed748062dce7798bJohannes Berg		return 0;
473f3b85252f081581a8f257545ed748062dce7798bJohannes Berg	}
474f3b85252f081581a8f257545ed748062dce7798bJohannes Berg
475f3b85252f081581a8f257545ed748062dce7798bJohannes Berg	if (local->ops->hw_scan)
476fbe9c429f195111bbf7f1630efa19aee295fd8e7Helmut Schaa		__set_bit(SCAN_HW_SCANNING, &local->scanning);
477f3b85252f081581a8f257545ed748062dce7798bJohannes Berg	else
478fbe9c429f195111bbf7f1630efa19aee295fd8e7Helmut Schaa		__set_bit(SCAN_SW_SCANNING, &local->scanning);
479f3b85252f081581a8f257545ed748062dce7798bJohannes Berg	/*
480f3b85252f081581a8f257545ed748062dce7798bJohannes Berg	 * Kicking off the scan need not be protected,
481f3b85252f081581a8f257545ed748062dce7798bJohannes Berg	 * only the scan variable stuff, since now
482f3b85252f081581a8f257545ed748062dce7798bJohannes Berg	 * local->scan_req is assigned and other callers
483f3b85252f081581a8f257545ed748062dce7798bJohannes Berg	 * will abort their scan attempts.
484f3b85252f081581a8f257545ed748062dce7798bJohannes Berg	 *
485f3b85252f081581a8f257545ed748062dce7798bJohannes Berg	 * This avoids getting a scan_mtx -> iflist_mtx
486f3b85252f081581a8f257545ed748062dce7798bJohannes Berg	 * dependency, so that the scan completed calls
487f3b85252f081581a8f257545ed748062dce7798bJohannes Berg	 * have more locking freedom.
488f3b85252f081581a8f257545ed748062dce7798bJohannes Berg	 */
4895cff20e6c5a6591a79d3b027af222870f52bb550Johannes Berg
4905cff20e6c5a6591a79d3b027af222870f52bb550Johannes Berg	ieee80211_recalc_idle(local);
491f3b85252f081581a8f257545ed748062dce7798bJohannes Berg	mutex_unlock(&local->scan_mtx);
492f3b85252f081581a8f257545ed748062dce7798bJohannes Berg
4934d36ec58239eec44d77839ef6c25108efcbbb58cJohannes Berg	if (local->ops->hw_scan) {
4944d36ec58239eec44d77839ef6c25108efcbbb58cJohannes Berg		WARN_ON(!ieee80211_prep_hw_scan(local));
4954d36ec58239eec44d77839ef6c25108efcbbb58cJohannes Berg		rc = drv_hw_scan(local, local->hw_scan_req);
4964d36ec58239eec44d77839ef6c25108efcbbb58cJohannes Berg	} else
497f3b85252f081581a8f257545ed748062dce7798bJohannes Berg		rc = ieee80211_start_sw_scan(local);
498f3b85252f081581a8f257545ed748062dce7798bJohannes Berg
499f3b85252f081581a8f257545ed748062dce7798bJohannes Berg	mutex_lock(&local->scan_mtx);
500f3b85252f081581a8f257545ed748062dce7798bJohannes Berg
501f3b85252f081581a8f257545ed748062dce7798bJohannes Berg	if (rc) {
5024d36ec58239eec44d77839ef6c25108efcbbb58cJohannes Berg		kfree(local->hw_scan_req);
5034d36ec58239eec44d77839ef6c25108efcbbb58cJohannes Berg		local->hw_scan_req = NULL;
504fbe9c429f195111bbf7f1630efa19aee295fd8e7Helmut Schaa		local->scanning = 0;
505f3b85252f081581a8f257545ed748062dce7798bJohannes Berg
5065cff20e6c5a6591a79d3b027af222870f52bb550Johannes Berg		ieee80211_recalc_idle(local);
5075cff20e6c5a6591a79d3b027af222870f52bb550Johannes Berg
508f3b85252f081581a8f257545ed748062dce7798bJohannes Berg		local->scan_req = NULL;
509f3b85252f081581a8f257545ed748062dce7798bJohannes Berg		local->scan_sdata = NULL;
510f3b85252f081581a8f257545ed748062dce7798bJohannes Berg	}
511f3b85252f081581a8f257545ed748062dce7798bJohannes Berg
512f3b85252f081581a8f257545ed748062dce7798bJohannes Berg	return rc;
513f3b85252f081581a8f257545ed748062dce7798bJohannes Berg}
514f3b85252f081581a8f257545ed748062dce7798bJohannes Berg
5152fb3f028a9a46bd344329766257699b4acb36525Helmut Schaastatic int ieee80211_scan_state_decision(struct ieee80211_local *local,
5162fb3f028a9a46bd344329766257699b4acb36525Helmut Schaa					 unsigned long *next_delay)
5177d3be3cc489176bc7bd23e673b0b4aef597af2b3Helmut Schaa{
518142b9f5074dc0d09dc0025739ad437723d7bf527Helmut Schaa	bool associated = false;
519142b9f5074dc0d09dc0025739ad437723d7bf527Helmut Schaa	struct ieee80211_sub_if_data *sdata;
520142b9f5074dc0d09dc0025739ad437723d7bf527Helmut Schaa
521142b9f5074dc0d09dc0025739ad437723d7bf527Helmut Schaa	/* if no more bands/channels left, complete scan and advance to the idle state */
5227d3be3cc489176bc7bd23e673b0b4aef597af2b3Helmut Schaa	if (local->scan_channel_idx >= local->scan_req->n_channels) {
5237d3be3cc489176bc7bd23e673b0b4aef597af2b3Helmut Schaa		ieee80211_scan_completed(&local->hw, false);
5247d3be3cc489176bc7bd23e673b0b4aef597af2b3Helmut Schaa		return 1;
5257d3be3cc489176bc7bd23e673b0b4aef597af2b3Helmut Schaa	}
5262fb3f028a9a46bd344329766257699b4acb36525Helmut Schaa
527142b9f5074dc0d09dc0025739ad437723d7bf527Helmut Schaa	/* check if at least one STA interface is associated */
528142b9f5074dc0d09dc0025739ad437723d7bf527Helmut Schaa	mutex_lock(&local->iflist_mtx);
529142b9f5074dc0d09dc0025739ad437723d7bf527Helmut Schaa	list_for_each_entry(sdata, &local->interfaces, list) {
5309607e6b66a0d25ca63b70d54a4283fa13d8f7c9dJohannes Berg		if (!ieee80211_sdata_running(sdata))
531142b9f5074dc0d09dc0025739ad437723d7bf527Helmut Schaa			continue;
532142b9f5074dc0d09dc0025739ad437723d7bf527Helmut Schaa
533142b9f5074dc0d09dc0025739ad437723d7bf527Helmut Schaa		if (sdata->vif.type == NL80211_IFTYPE_STATION) {
534142b9f5074dc0d09dc0025739ad437723d7bf527Helmut Schaa			if (sdata->u.mgd.associated) {
535142b9f5074dc0d09dc0025739ad437723d7bf527Helmut Schaa				associated = true;
536142b9f5074dc0d09dc0025739ad437723d7bf527Helmut Schaa				break;
537142b9f5074dc0d09dc0025739ad437723d7bf527Helmut Schaa			}
538142b9f5074dc0d09dc0025739ad437723d7bf527Helmut Schaa		}
539142b9f5074dc0d09dc0025739ad437723d7bf527Helmut Schaa	}
540142b9f5074dc0d09dc0025739ad437723d7bf527Helmut Schaa	mutex_unlock(&local->iflist_mtx);
541142b9f5074dc0d09dc0025739ad437723d7bf527Helmut Schaa
542142b9f5074dc0d09dc0025739ad437723d7bf527Helmut Schaa	if (local->scan_channel) {
543142b9f5074dc0d09dc0025739ad437723d7bf527Helmut Schaa		/*
544142b9f5074dc0d09dc0025739ad437723d7bf527Helmut Schaa		 * we're currently scanning a different channel, let's
545142b9f5074dc0d09dc0025739ad437723d7bf527Helmut Schaa		 * switch back to the operating channel now if at least
546142b9f5074dc0d09dc0025739ad437723d7bf527Helmut Schaa		 * one interface is associated. Otherwise just scan the
547142b9f5074dc0d09dc0025739ad437723d7bf527Helmut Schaa		 * next channel
548142b9f5074dc0d09dc0025739ad437723d7bf527Helmut Schaa		 */
549142b9f5074dc0d09dc0025739ad437723d7bf527Helmut Schaa		if (associated)
550977923b00c79185c11b4b47664f5ffa4c3820438Helmut Schaa			local->next_scan_state = SCAN_ENTER_OPER_CHANNEL;
551142b9f5074dc0d09dc0025739ad437723d7bf527Helmut Schaa		else
552977923b00c79185c11b4b47664f5ffa4c3820438Helmut Schaa			local->next_scan_state = SCAN_SET_CHANNEL;
553142b9f5074dc0d09dc0025739ad437723d7bf527Helmut Schaa	} else {
554142b9f5074dc0d09dc0025739ad437723d7bf527Helmut Schaa		/*
555142b9f5074dc0d09dc0025739ad437723d7bf527Helmut Schaa		 * we're on the operating channel currently, let's
556142b9f5074dc0d09dc0025739ad437723d7bf527Helmut Schaa		 * leave that channel now to scan another one
557142b9f5074dc0d09dc0025739ad437723d7bf527Helmut Schaa		 */
558977923b00c79185c11b4b47664f5ffa4c3820438Helmut Schaa		local->next_scan_state = SCAN_LEAVE_OPER_CHANNEL;
559142b9f5074dc0d09dc0025739ad437723d7bf527Helmut Schaa	}
560142b9f5074dc0d09dc0025739ad437723d7bf527Helmut Schaa
5612fb3f028a9a46bd344329766257699b4acb36525Helmut Schaa	*next_delay = 0;
5622fb3f028a9a46bd344329766257699b4acb36525Helmut Schaa	return 0;
5632fb3f028a9a46bd344329766257699b4acb36525Helmut Schaa}
5642fb3f028a9a46bd344329766257699b4acb36525Helmut Schaa
565142b9f5074dc0d09dc0025739ad437723d7bf527Helmut Schaastatic void ieee80211_scan_state_leave_oper_channel(struct ieee80211_local *local,
566142b9f5074dc0d09dc0025739ad437723d7bf527Helmut Schaa						    unsigned long *next_delay)
567142b9f5074dc0d09dc0025739ad437723d7bf527Helmut Schaa{
568142b9f5074dc0d09dc0025739ad437723d7bf527Helmut Schaa	struct ieee80211_sub_if_data *sdata;
569142b9f5074dc0d09dc0025739ad437723d7bf527Helmut Schaa
570142b9f5074dc0d09dc0025739ad437723d7bf527Helmut Schaa	/*
571142b9f5074dc0d09dc0025739ad437723d7bf527Helmut Schaa	 * notify the AP about us leaving the channel and stop all STA interfaces
572142b9f5074dc0d09dc0025739ad437723d7bf527Helmut Schaa	 */
573142b9f5074dc0d09dc0025739ad437723d7bf527Helmut Schaa	mutex_lock(&local->iflist_mtx);
574142b9f5074dc0d09dc0025739ad437723d7bf527Helmut Schaa	list_for_each_entry(sdata, &local->interfaces, list) {
5759607e6b66a0d25ca63b70d54a4283fa13d8f7c9dJohannes Berg		if (!ieee80211_sdata_running(sdata))
576142b9f5074dc0d09dc0025739ad437723d7bf527Helmut Schaa			continue;
577142b9f5074dc0d09dc0025739ad437723d7bf527Helmut Schaa
578142b9f5074dc0d09dc0025739ad437723d7bf527Helmut Schaa		if (sdata->vif.type == NL80211_IFTYPE_STATION) {
57953623f1a09c7a7d23b74f0f7d93dba0ebde1006bJohn W. Linville			netif_stop_queue(sdata->dev);
580142b9f5074dc0d09dc0025739ad437723d7bf527Helmut Schaa			if (sdata->u.mgd.associated)
581142b9f5074dc0d09dc0025739ad437723d7bf527Helmut Schaa				ieee80211_scan_ps_enable(sdata);
582142b9f5074dc0d09dc0025739ad437723d7bf527Helmut Schaa		}
583142b9f5074dc0d09dc0025739ad437723d7bf527Helmut Schaa	}
584142b9f5074dc0d09dc0025739ad437723d7bf527Helmut Schaa	mutex_unlock(&local->iflist_mtx);
585142b9f5074dc0d09dc0025739ad437723d7bf527Helmut Schaa
586142b9f5074dc0d09dc0025739ad437723d7bf527Helmut Schaa	__set_bit(SCAN_OFF_CHANNEL, &local->scanning);
587142b9f5074dc0d09dc0025739ad437723d7bf527Helmut Schaa
588a80f7c0b088187c8471b441d461e937991870661Johannes Berg	/*
589a80f7c0b088187c8471b441d461e937991870661Johannes Berg	 * What if the nullfunc frames didn't arrive?
590a80f7c0b088187c8471b441d461e937991870661Johannes Berg	 */
591a80f7c0b088187c8471b441d461e937991870661Johannes Berg	drv_flush(local, false);
592a80f7c0b088187c8471b441d461e937991870661Johannes Berg	if (local->ops->flush)
593a80f7c0b088187c8471b441d461e937991870661Johannes Berg		*next_delay = 0;
594a80f7c0b088187c8471b441d461e937991870661Johannes Berg	else
595a80f7c0b088187c8471b441d461e937991870661Johannes Berg		*next_delay = HZ / 10;
596a80f7c0b088187c8471b441d461e937991870661Johannes Berg
597142b9f5074dc0d09dc0025739ad437723d7bf527Helmut Schaa	/* advance to the next channel to be scanned */
598977923b00c79185c11b4b47664f5ffa4c3820438Helmut Schaa	local->next_scan_state = SCAN_SET_CHANNEL;
599142b9f5074dc0d09dc0025739ad437723d7bf527Helmut Schaa}
600142b9f5074dc0d09dc0025739ad437723d7bf527Helmut Schaa
601142b9f5074dc0d09dc0025739ad437723d7bf527Helmut Schaastatic void ieee80211_scan_state_enter_oper_channel(struct ieee80211_local *local,
602142b9f5074dc0d09dc0025739ad437723d7bf527Helmut Schaa						    unsigned long *next_delay)
603142b9f5074dc0d09dc0025739ad437723d7bf527Helmut Schaa{
604142b9f5074dc0d09dc0025739ad437723d7bf527Helmut Schaa	struct ieee80211_sub_if_data *sdata = local->scan_sdata;
605142b9f5074dc0d09dc0025739ad437723d7bf527Helmut Schaa
606142b9f5074dc0d09dc0025739ad437723d7bf527Helmut Schaa	/* switch back to the operating channel */
607142b9f5074dc0d09dc0025739ad437723d7bf527Helmut Schaa	local->scan_channel = NULL;
608142b9f5074dc0d09dc0025739ad437723d7bf527Helmut Schaa	ieee80211_hw_config(local, IEEE80211_CONF_CHANGE_CHANNEL);
609142b9f5074dc0d09dc0025739ad437723d7bf527Helmut Schaa
610142b9f5074dc0d09dc0025739ad437723d7bf527Helmut Schaa	/*
611142b9f5074dc0d09dc0025739ad437723d7bf527Helmut Schaa	 * notify the AP about us being back and restart all STA interfaces
612142b9f5074dc0d09dc0025739ad437723d7bf527Helmut Schaa	 */
613142b9f5074dc0d09dc0025739ad437723d7bf527Helmut Schaa	mutex_lock(&local->iflist_mtx);
614142b9f5074dc0d09dc0025739ad437723d7bf527Helmut Schaa	list_for_each_entry(sdata, &local->interfaces, list) {
6159607e6b66a0d25ca63b70d54a4283fa13d8f7c9dJohannes Berg		if (!ieee80211_sdata_running(sdata))
616142b9f5074dc0d09dc0025739ad437723d7bf527Helmut Schaa			continue;
617142b9f5074dc0d09dc0025739ad437723d7bf527Helmut Schaa
618142b9f5074dc0d09dc0025739ad437723d7bf527Helmut Schaa		/* Tell AP we're back */
619142b9f5074dc0d09dc0025739ad437723d7bf527Helmut Schaa		if (sdata->vif.type == NL80211_IFTYPE_STATION) {
620142b9f5074dc0d09dc0025739ad437723d7bf527Helmut Schaa			if (sdata->u.mgd.associated)
621142b9f5074dc0d09dc0025739ad437723d7bf527Helmut Schaa				ieee80211_scan_ps_disable(sdata);
62253623f1a09c7a7d23b74f0f7d93dba0ebde1006bJohn W. Linville			netif_wake_queue(sdata->dev);
623142b9f5074dc0d09dc0025739ad437723d7bf527Helmut Schaa		}
624142b9f5074dc0d09dc0025739ad437723d7bf527Helmut Schaa	}
625142b9f5074dc0d09dc0025739ad437723d7bf527Helmut Schaa	mutex_unlock(&local->iflist_mtx);
626142b9f5074dc0d09dc0025739ad437723d7bf527Helmut Schaa
627142b9f5074dc0d09dc0025739ad437723d7bf527Helmut Schaa	__clear_bit(SCAN_OFF_CHANNEL, &local->scanning);
628142b9f5074dc0d09dc0025739ad437723d7bf527Helmut Schaa
629142b9f5074dc0d09dc0025739ad437723d7bf527Helmut Schaa	*next_delay = HZ / 5;
630977923b00c79185c11b4b47664f5ffa4c3820438Helmut Schaa	local->next_scan_state = SCAN_DECISION;
631142b9f5074dc0d09dc0025739ad437723d7bf527Helmut Schaa}
632142b9f5074dc0d09dc0025739ad437723d7bf527Helmut Schaa
6332fb3f028a9a46bd344329766257699b4acb36525Helmut Schaastatic void ieee80211_scan_state_set_channel(struct ieee80211_local *local,
6342fb3f028a9a46bd344329766257699b4acb36525Helmut Schaa					     unsigned long *next_delay)
6352fb3f028a9a46bd344329766257699b4acb36525Helmut Schaa{
6362fb3f028a9a46bd344329766257699b4acb36525Helmut Schaa	int skip;
6372fb3f028a9a46bd344329766257699b4acb36525Helmut Schaa	struct ieee80211_channel *chan;
6382fb3f028a9a46bd344329766257699b4acb36525Helmut Schaa
6397d3be3cc489176bc7bd23e673b0b4aef597af2b3Helmut Schaa	skip = 0;
6407d3be3cc489176bc7bd23e673b0b4aef597af2b3Helmut Schaa	chan = local->scan_req->channels[local->scan_channel_idx];
6417d3be3cc489176bc7bd23e673b0b4aef597af2b3Helmut Schaa
642584991dccfd347cd2e1675ab262998f6c335d3c0Johannes Berg	local->scan_channel = chan;
643584991dccfd347cd2e1675ab262998f6c335d3c0Johannes Berg	if (ieee80211_hw_config(local, IEEE80211_CONF_CHANGE_CHANNEL))
6447d3be3cc489176bc7bd23e673b0b4aef597af2b3Helmut Schaa		skip = 1;
6457d3be3cc489176bc7bd23e673b0b4aef597af2b3Helmut Schaa
6467d3be3cc489176bc7bd23e673b0b4aef597af2b3Helmut Schaa	/* advance state machine to next channel/band */
6477d3be3cc489176bc7bd23e673b0b4aef597af2b3Helmut Schaa	local->scan_channel_idx++;
6487d3be3cc489176bc7bd23e673b0b4aef597af2b3Helmut Schaa
6490ee9c13c7c92581ab005d80795cf65897213b249Helmut Schaa	if (skip) {
6500ee9c13c7c92581ab005d80795cf65897213b249Helmut Schaa		/* if we skip this channel return to the decision state */
6510ee9c13c7c92581ab005d80795cf65897213b249Helmut Schaa		local->next_scan_state = SCAN_DECISION;
6522fb3f028a9a46bd344329766257699b4acb36525Helmut Schaa		return;
6530ee9c13c7c92581ab005d80795cf65897213b249Helmut Schaa	}
6547d3be3cc489176bc7bd23e673b0b4aef597af2b3Helmut Schaa
6557d3be3cc489176bc7bd23e673b0b4aef597af2b3Helmut Schaa	/*
6567d3be3cc489176bc7bd23e673b0b4aef597af2b3Helmut Schaa	 * Probe delay is used to update the NAV, cf. 11.1.3.2.2
6577d3be3cc489176bc7bd23e673b0b4aef597af2b3Helmut Schaa	 * (which unfortunately doesn't say _why_ step a) is done,
6587d3be3cc489176bc7bd23e673b0b4aef597af2b3Helmut Schaa	 * but it waits for the probe delay or until a frame is
6597d3be3cc489176bc7bd23e673b0b4aef597af2b3Helmut Schaa	 * received - and the received frame would update the NAV).
6607d3be3cc489176bc7bd23e673b0b4aef597af2b3Helmut Schaa	 * For now, we do not support waiting until a frame is
6617d3be3cc489176bc7bd23e673b0b4aef597af2b3Helmut Schaa	 * received.
6627d3be3cc489176bc7bd23e673b0b4aef597af2b3Helmut Schaa	 *
6637d3be3cc489176bc7bd23e673b0b4aef597af2b3Helmut Schaa	 * In any case, it is not necessary for a passive scan.
6647d3be3cc489176bc7bd23e673b0b4aef597af2b3Helmut Schaa	 */
6657d3be3cc489176bc7bd23e673b0b4aef597af2b3Helmut Schaa	if (chan->flags & IEEE80211_CHAN_PASSIVE_SCAN ||
6667d3be3cc489176bc7bd23e673b0b4aef597af2b3Helmut Schaa	    !local->scan_req->n_ssids) {
6677d3be3cc489176bc7bd23e673b0b4aef597af2b3Helmut Schaa		*next_delay = IEEE80211_PASSIVE_CHANNEL_TIME;
668977923b00c79185c11b4b47664f5ffa4c3820438Helmut Schaa		local->next_scan_state = SCAN_DECISION;
6692fb3f028a9a46bd344329766257699b4acb36525Helmut Schaa		return;
6707d3be3cc489176bc7bd23e673b0b4aef597af2b3Helmut Schaa	}
6717d3be3cc489176bc7bd23e673b0b4aef597af2b3Helmut Schaa
6722fb3f028a9a46bd344329766257699b4acb36525Helmut Schaa	/* active scan, send probes */
6737d3be3cc489176bc7bd23e673b0b4aef597af2b3Helmut Schaa	*next_delay = IEEE80211_PROBE_DELAY;
674977923b00c79185c11b4b47664f5ffa4c3820438Helmut Schaa	local->next_scan_state = SCAN_SEND_PROBE;
6757d3be3cc489176bc7bd23e673b0b4aef597af2b3Helmut Schaa}
6767d3be3cc489176bc7bd23e673b0b4aef597af2b3Helmut Schaa
6777d3be3cc489176bc7bd23e673b0b4aef597af2b3Helmut Schaastatic void ieee80211_scan_state_send_probe(struct ieee80211_local *local,
6787d3be3cc489176bc7bd23e673b0b4aef597af2b3Helmut Schaa					    unsigned long *next_delay)
6797d3be3cc489176bc7bd23e673b0b4aef597af2b3Helmut Schaa{
6807d3be3cc489176bc7bd23e673b0b4aef597af2b3Helmut Schaa	int i;
6817d3be3cc489176bc7bd23e673b0b4aef597af2b3Helmut Schaa	struct ieee80211_sub_if_data *sdata = local->scan_sdata;
6827d3be3cc489176bc7bd23e673b0b4aef597af2b3Helmut Schaa
6837d3be3cc489176bc7bd23e673b0b4aef597af2b3Helmut Schaa	for (i = 0; i < local->scan_req->n_ssids; i++)
6847d3be3cc489176bc7bd23e673b0b4aef597af2b3Helmut Schaa		ieee80211_send_probe_req(
6857d3be3cc489176bc7bd23e673b0b4aef597af2b3Helmut Schaa			sdata, NULL,
6867d3be3cc489176bc7bd23e673b0b4aef597af2b3Helmut Schaa			local->scan_req->ssids[i].ssid,
6877d3be3cc489176bc7bd23e673b0b4aef597af2b3Helmut Schaa			local->scan_req->ssids[i].ssid_len,
6887d3be3cc489176bc7bd23e673b0b4aef597af2b3Helmut Schaa			local->scan_req->ie, local->scan_req->ie_len);
6897d3be3cc489176bc7bd23e673b0b4aef597af2b3Helmut Schaa
6907d3be3cc489176bc7bd23e673b0b4aef597af2b3Helmut Schaa	/*
6917d3be3cc489176bc7bd23e673b0b4aef597af2b3Helmut Schaa	 * After sending probe requests, wait for probe responses
6927d3be3cc489176bc7bd23e673b0b4aef597af2b3Helmut Schaa	 * on the channel.
6937d3be3cc489176bc7bd23e673b0b4aef597af2b3Helmut Schaa	 */
6947d3be3cc489176bc7bd23e673b0b4aef597af2b3Helmut Schaa	*next_delay = IEEE80211_CHANNEL_TIME;
695977923b00c79185c11b4b47664f5ffa4c3820438Helmut Schaa	local->next_scan_state = SCAN_DECISION;
6967d3be3cc489176bc7bd23e673b0b4aef597af2b3Helmut Schaa}
6977d3be3cc489176bc7bd23e673b0b4aef597af2b3Helmut Schaa
698c2b13452b283f9c4a5b02a6b53ed6416ebf4c03cJohannes Bergvoid ieee80211_scan_work(struct work_struct *work)
6990a51b27e956bd9580296c48191b78175ed8b5971Johannes Berg{
7000a51b27e956bd9580296c48191b78175ed8b5971Johannes Berg	struct ieee80211_local *local =
7010a51b27e956bd9580296c48191b78175ed8b5971Johannes Berg		container_of(work, struct ieee80211_local, scan_work.work);
7020a51b27e956bd9580296c48191b78175ed8b5971Johannes Berg	struct ieee80211_sub_if_data *sdata = local->scan_sdata;
7030a51b27e956bd9580296c48191b78175ed8b5971Johannes Berg	unsigned long next_delay = 0;
7040a51b27e956bd9580296c48191b78175ed8b5971Johannes Berg
705f3b85252f081581a8f257545ed748062dce7798bJohannes Berg	mutex_lock(&local->scan_mtx);
706f3b85252f081581a8f257545ed748062dce7798bJohannes Berg	if (!sdata || !local->scan_req) {
707f3b85252f081581a8f257545ed748062dce7798bJohannes Berg		mutex_unlock(&local->scan_mtx);
708f3b85252f081581a8f257545ed748062dce7798bJohannes Berg		return;
709f3b85252f081581a8f257545ed748062dce7798bJohannes Berg	}
710f3b85252f081581a8f257545ed748062dce7798bJohannes Berg
7114d36ec58239eec44d77839ef6c25108efcbbb58cJohannes Berg	if (local->hw_scan_req) {
7124d36ec58239eec44d77839ef6c25108efcbbb58cJohannes Berg		int rc = drv_hw_scan(local, local->hw_scan_req);
7134d36ec58239eec44d77839ef6c25108efcbbb58cJohannes Berg		mutex_unlock(&local->scan_mtx);
7144d36ec58239eec44d77839ef6c25108efcbbb58cJohannes Berg		if (rc)
7154d36ec58239eec44d77839ef6c25108efcbbb58cJohannes Berg			ieee80211_scan_completed(&local->hw, true);
7164d36ec58239eec44d77839ef6c25108efcbbb58cJohannes Berg		return;
7174d36ec58239eec44d77839ef6c25108efcbbb58cJohannes Berg	}
7184d36ec58239eec44d77839ef6c25108efcbbb58cJohannes Berg
719fbe9c429f195111bbf7f1630efa19aee295fd8e7Helmut Schaa	if (local->scan_req && !local->scanning) {
720f3b85252f081581a8f257545ed748062dce7798bJohannes Berg		struct cfg80211_scan_request *req = local->scan_req;
721f3b85252f081581a8f257545ed748062dce7798bJohannes Berg		int rc;
722f3b85252f081581a8f257545ed748062dce7798bJohannes Berg
723f3b85252f081581a8f257545ed748062dce7798bJohannes Berg		local->scan_req = NULL;
72415db0b7fd872b0312033666d3a82e1214a227ec0Johannes Berg		local->scan_sdata = NULL;
725f3b85252f081581a8f257545ed748062dce7798bJohannes Berg
726f3b85252f081581a8f257545ed748062dce7798bJohannes Berg		rc = __ieee80211_start_scan(sdata, req);
727f3b85252f081581a8f257545ed748062dce7798bJohannes Berg		mutex_unlock(&local->scan_mtx);
728f3b85252f081581a8f257545ed748062dce7798bJohannes Berg
729f3b85252f081581a8f257545ed748062dce7798bJohannes Berg		if (rc)
730f3b85252f081581a8f257545ed748062dce7798bJohannes Berg			ieee80211_scan_completed(&local->hw, true);
731f3b85252f081581a8f257545ed748062dce7798bJohannes Berg		return;
732f3b85252f081581a8f257545ed748062dce7798bJohannes Berg	}
733f3b85252f081581a8f257545ed748062dce7798bJohannes Berg
734f3b85252f081581a8f257545ed748062dce7798bJohannes Berg	mutex_unlock(&local->scan_mtx);
735f3b85252f081581a8f257545ed748062dce7798bJohannes Berg
7365bc75728fd43bb15b46f16ef465bcf9d487393cfJohannes Berg	/*
7375bc75728fd43bb15b46f16ef465bcf9d487393cfJohannes Berg	 * Avoid re-scheduling when the sdata is going away.
7385bc75728fd43bb15b46f16ef465bcf9d487393cfJohannes Berg	 */
7399607e6b66a0d25ca63b70d54a4283fa13d8f7c9dJohannes Berg	if (!ieee80211_sdata_running(sdata)) {
740f3b85252f081581a8f257545ed748062dce7798bJohannes Berg		ieee80211_scan_completed(&local->hw, true);
7410a51b27e956bd9580296c48191b78175ed8b5971Johannes Berg		return;
742f3b85252f081581a8f257545ed748062dce7798bJohannes Berg	}
7430a51b27e956bd9580296c48191b78175ed8b5971Johannes Berg
744f502d09b750437a4ec9c63333acf1070fe7958afHelmut Schaa	/*
745f502d09b750437a4ec9c63333acf1070fe7958afHelmut Schaa	 * as long as no delay is required advance immediately
746f502d09b750437a4ec9c63333acf1070fe7958afHelmut Schaa	 * without scheduling a new work
747f502d09b750437a4ec9c63333acf1070fe7958afHelmut Schaa	 */
748f502d09b750437a4ec9c63333acf1070fe7958afHelmut Schaa	do {
749977923b00c79185c11b4b47664f5ffa4c3820438Helmut Schaa		switch (local->next_scan_state) {
7502fb3f028a9a46bd344329766257699b4acb36525Helmut Schaa		case SCAN_DECISION:
7512fb3f028a9a46bd344329766257699b4acb36525Helmut Schaa			if (ieee80211_scan_state_decision(local, &next_delay))
752f502d09b750437a4ec9c63333acf1070fe7958afHelmut Schaa				return;
753f502d09b750437a4ec9c63333acf1070fe7958afHelmut Schaa			break;
7542fb3f028a9a46bd344329766257699b4acb36525Helmut Schaa		case SCAN_SET_CHANNEL:
7552fb3f028a9a46bd344329766257699b4acb36525Helmut Schaa			ieee80211_scan_state_set_channel(local, &next_delay);
7562fb3f028a9a46bd344329766257699b4acb36525Helmut Schaa			break;
757f502d09b750437a4ec9c63333acf1070fe7958afHelmut Schaa		case SCAN_SEND_PROBE:
758f502d09b750437a4ec9c63333acf1070fe7958afHelmut Schaa			ieee80211_scan_state_send_probe(local, &next_delay);
759f502d09b750437a4ec9c63333acf1070fe7958afHelmut Schaa			break;
760142b9f5074dc0d09dc0025739ad437723d7bf527Helmut Schaa		case SCAN_LEAVE_OPER_CHANNEL:
761142b9f5074dc0d09dc0025739ad437723d7bf527Helmut Schaa			ieee80211_scan_state_leave_oper_channel(local, &next_delay);
762142b9f5074dc0d09dc0025739ad437723d7bf527Helmut Schaa			break;
763142b9f5074dc0d09dc0025739ad437723d7bf527Helmut Schaa		case SCAN_ENTER_OPER_CHANNEL:
764142b9f5074dc0d09dc0025739ad437723d7bf527Helmut Schaa			ieee80211_scan_state_enter_oper_channel(local, &next_delay);
765142b9f5074dc0d09dc0025739ad437723d7bf527Helmut Schaa			break;
766f502d09b750437a4ec9c63333acf1070fe7958afHelmut Schaa		}
767f502d09b750437a4ec9c63333acf1070fe7958afHelmut Schaa	} while (next_delay == 0);
7680a51b27e956bd9580296c48191b78175ed8b5971Johannes Berg
76942935ecaf4e784d0815afa9a7e5fe7e141157ca3Luis R. Rodriguez	ieee80211_queue_delayed_work(&local->hw, &local->scan_work, next_delay);
7700a51b27e956bd9580296c48191b78175ed8b5971Johannes Berg}
7710a51b27e956bd9580296c48191b78175ed8b5971Johannes Berg
772f3b85252f081581a8f257545ed748062dce7798bJohannes Bergint ieee80211_request_scan(struct ieee80211_sub_if_data *sdata,
773f3b85252f081581a8f257545ed748062dce7798bJohannes Berg			   struct cfg80211_scan_request *req)
7740a51b27e956bd9580296c48191b78175ed8b5971Johannes Berg{
775f3b85252f081581a8f257545ed748062dce7798bJohannes Berg	int res;
776de95a54b1aebe5592cae971ca5e5d9ec6a381a17Johannes Berg
777f3b85252f081581a8f257545ed748062dce7798bJohannes Berg	mutex_lock(&sdata->local->scan_mtx);
778f3b85252f081581a8f257545ed748062dce7798bJohannes Berg	res = __ieee80211_start_scan(sdata, req);
779f3b85252f081581a8f257545ed748062dce7798bJohannes Berg	mutex_unlock(&sdata->local->scan_mtx);
7800a51b27e956bd9580296c48191b78175ed8b5971Johannes Berg
781f3b85252f081581a8f257545ed748062dce7798bJohannes Berg	return res;
7820a51b27e956bd9580296c48191b78175ed8b5971Johannes Berg}
7830a51b27e956bd9580296c48191b78175ed8b5971Johannes Berg
784f3b85252f081581a8f257545ed748062dce7798bJohannes Bergint ieee80211_request_internal_scan(struct ieee80211_sub_if_data *sdata,
785f3b85252f081581a8f257545ed748062dce7798bJohannes Berg				    const u8 *ssid, u8 ssid_len)
7860a51b27e956bd9580296c48191b78175ed8b5971Johannes Berg{
7870a51b27e956bd9580296c48191b78175ed8b5971Johannes Berg	struct ieee80211_local *local = sdata->local;
788f3b85252f081581a8f257545ed748062dce7798bJohannes Berg	int ret = -EBUSY;
7892a5193119269062608582418deba7af82844159aJohannes Berg
790f3b85252f081581a8f257545ed748062dce7798bJohannes Berg	mutex_lock(&local->scan_mtx);
7910a51b27e956bd9580296c48191b78175ed8b5971Johannes Berg
792f3b85252f081581a8f257545ed748062dce7798bJohannes Berg	/* busy scanning */
793f3b85252f081581a8f257545ed748062dce7798bJohannes Berg	if (local->scan_req)
794f3b85252f081581a8f257545ed748062dce7798bJohannes Berg		goto unlock;
7959116dd01120e249dc2e84e6edecd7ad7f828680fJohannes Berg
7965ba63533bbf653631faab60f6988506160ec6ba4Johannes Berg	memcpy(local->int_scan_req->ssids[0].ssid, ssid, IEEE80211_MAX_SSID_LEN);
7975ba63533bbf653631faab60f6988506160ec6ba4Johannes Berg	local->int_scan_req->ssids[0].ssid_len = ssid_len;
7989116dd01120e249dc2e84e6edecd7ad7f828680fJohannes Berg
7995ba63533bbf653631faab60f6988506160ec6ba4Johannes Berg	ret = __ieee80211_start_scan(sdata, sdata->local->int_scan_req);
800f3b85252f081581a8f257545ed748062dce7798bJohannes Berg unlock:
801f3b85252f081581a8f257545ed748062dce7798bJohannes Berg	mutex_unlock(&local->scan_mtx);
802f3b85252f081581a8f257545ed748062dce7798bJohannes Berg	return ret;
8030a51b27e956bd9580296c48191b78175ed8b5971Johannes Berg}
8045bb644a0fd25a5e083ecbfaa92a211db99aa6ef7Johannes Berg
8055bb644a0fd25a5e083ecbfaa92a211db99aa6ef7Johannes Bergvoid ieee80211_scan_cancel(struct ieee80211_local *local)
8065bb644a0fd25a5e083ecbfaa92a211db99aa6ef7Johannes Berg{
80715db0b7fd872b0312033666d3a82e1214a227ec0Johannes Berg	bool abortscan;
8085bb644a0fd25a5e083ecbfaa92a211db99aa6ef7Johannes Berg
8095bb644a0fd25a5e083ecbfaa92a211db99aa6ef7Johannes Berg	cancel_delayed_work_sync(&local->scan_work);
8105bb644a0fd25a5e083ecbfaa92a211db99aa6ef7Johannes Berg
8115bb644a0fd25a5e083ecbfaa92a211db99aa6ef7Johannes Berg	/*
8125bb644a0fd25a5e083ecbfaa92a211db99aa6ef7Johannes Berg	 * Only call this function when a scan can't be
8135bb644a0fd25a5e083ecbfaa92a211db99aa6ef7Johannes Berg	 * queued -- mostly at suspend under RTNL.
8145bb644a0fd25a5e083ecbfaa92a211db99aa6ef7Johannes Berg	 */
8155bb644a0fd25a5e083ecbfaa92a211db99aa6ef7Johannes Berg	mutex_lock(&local->scan_mtx);
81615db0b7fd872b0312033666d3a82e1214a227ec0Johannes Berg	abortscan = test_bit(SCAN_SW_SCANNING, &local->scanning) ||
81715db0b7fd872b0312033666d3a82e1214a227ec0Johannes Berg		    (!local->scanning && local->scan_req);
8185bb644a0fd25a5e083ecbfaa92a211db99aa6ef7Johannes Berg	mutex_unlock(&local->scan_mtx);
8195bb644a0fd25a5e083ecbfaa92a211db99aa6ef7Johannes Berg
82015db0b7fd872b0312033666d3a82e1214a227ec0Johannes Berg	if (abortscan)
8215bb644a0fd25a5e083ecbfaa92a211db99aa6ef7Johannes Berg		ieee80211_scan_completed(&local->hw, true);
8225bb644a0fd25a5e083ecbfaa92a211db99aa6ef7Johannes Berg}
823