scan.c revision 6d3560d4fc9c5b9fe1a07a63926ea70512c69c32
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 */
15098c8fccfaea838e62ffde2f2e44568844e0e5472Johannes Berg		if (memcmp(mgmt->da, sdata->dev->dev_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;
2309050bdd8589c373e01e41ddbd9a192de2ff01ef0Kalle Valo	bool ps = false;
2319050bdd8589c373e01e41ddbd9a192de2ff01ef0Kalle Valo
2329050bdd8589c373e01e41ddbd9a192de2ff01ef0Kalle Valo	/* FIXME: what to do when local->pspolling is true? */
2339050bdd8589c373e01e41ddbd9a192de2ff01ef0Kalle Valo
2349050bdd8589c373e01e41ddbd9a192de2ff01ef0Kalle Valo	del_timer_sync(&local->dynamic_ps_timer);
2359050bdd8589c373e01e41ddbd9a192de2ff01ef0Kalle Valo	cancel_work_sync(&local->dynamic_ps_enable_work);
2369050bdd8589c373e01e41ddbd9a192de2ff01ef0Kalle Valo
2379050bdd8589c373e01e41ddbd9a192de2ff01ef0Kalle Valo	if (local->hw.conf.flags & IEEE80211_CONF_PS) {
2389050bdd8589c373e01e41ddbd9a192de2ff01ef0Kalle Valo		ps = true;
2399050bdd8589c373e01e41ddbd9a192de2ff01ef0Kalle Valo		local->hw.conf.flags &= ~IEEE80211_CONF_PS;
2409050bdd8589c373e01e41ddbd9a192de2ff01ef0Kalle Valo		ieee80211_hw_config(local, IEEE80211_CONF_CHANGE_PS);
2419050bdd8589c373e01e41ddbd9a192de2ff01ef0Kalle Valo	}
2429050bdd8589c373e01e41ddbd9a192de2ff01ef0Kalle Valo
2439050bdd8589c373e01e41ddbd9a192de2ff01ef0Kalle Valo	if (!ps || !(local->hw.flags & IEEE80211_HW_PS_NULLFUNC_STACK))
2449050bdd8589c373e01e41ddbd9a192de2ff01ef0Kalle Valo		/*
2459050bdd8589c373e01e41ddbd9a192de2ff01ef0Kalle Valo		 * If power save was enabled, no need to send a nullfunc
2469050bdd8589c373e01e41ddbd9a192de2ff01ef0Kalle Valo		 * frame because AP knows that we are sleeping. But if the
2479050bdd8589c373e01e41ddbd9a192de2ff01ef0Kalle Valo		 * hardware is creating the nullfunc frame for power save
2489050bdd8589c373e01e41ddbd9a192de2ff01ef0Kalle Valo		 * status (ie. IEEE80211_HW_PS_NULLFUNC_STACK is not
2499050bdd8589c373e01e41ddbd9a192de2ff01ef0Kalle Valo		 * enabled) and power save was enabled, the firmware just
2509050bdd8589c373e01e41ddbd9a192de2ff01ef0Kalle Valo		 * sent a null frame with power save disabled. So we need
2519050bdd8589c373e01e41ddbd9a192de2ff01ef0Kalle Valo		 * to send a new nullfunc frame to inform the AP that we
2529050bdd8589c373e01e41ddbd9a192de2ff01ef0Kalle Valo		 * are again sleeping.
2539050bdd8589c373e01e41ddbd9a192de2ff01ef0Kalle Valo		 */
2549050bdd8589c373e01e41ddbd9a192de2ff01ef0Kalle Valo		ieee80211_send_nullfunc(local, sdata, 1);
2559050bdd8589c373e01e41ddbd9a192de2ff01ef0Kalle Valo}
2569050bdd8589c373e01e41ddbd9a192de2ff01ef0Kalle Valo
2579050bdd8589c373e01e41ddbd9a192de2ff01ef0Kalle Valo/* inform AP that we are awake again, unless power save is enabled */
2589050bdd8589c373e01e41ddbd9a192de2ff01ef0Kalle Valostatic void ieee80211_scan_ps_disable(struct ieee80211_sub_if_data *sdata)
2599050bdd8589c373e01e41ddbd9a192de2ff01ef0Kalle Valo{
2609050bdd8589c373e01e41ddbd9a192de2ff01ef0Kalle Valo	struct ieee80211_local *local = sdata->local;
2619050bdd8589c373e01e41ddbd9a192de2ff01ef0Kalle Valo
262965bedadc01d34027455d5d5b67063ef0209c955Johannes Berg	if (!local->ps_sdata)
2639050bdd8589c373e01e41ddbd9a192de2ff01ef0Kalle Valo		ieee80211_send_nullfunc(local, sdata, 0);
2649050bdd8589c373e01e41ddbd9a192de2ff01ef0Kalle Valo	else {
2659050bdd8589c373e01e41ddbd9a192de2ff01ef0Kalle Valo		/*
2669050bdd8589c373e01e41ddbd9a192de2ff01ef0Kalle Valo		 * In !IEEE80211_HW_PS_NULLFUNC_STACK case the hardware
2679050bdd8589c373e01e41ddbd9a192de2ff01ef0Kalle Valo		 * will send a nullfunc frame with the powersave bit set
2689050bdd8589c373e01e41ddbd9a192de2ff01ef0Kalle Valo		 * even though the AP already knows that we are sleeping.
2699050bdd8589c373e01e41ddbd9a192de2ff01ef0Kalle Valo		 * This could be avoided by sending a null frame with power
2709050bdd8589c373e01e41ddbd9a192de2ff01ef0Kalle Valo		 * save bit disabled before enabling the power save, but
2719050bdd8589c373e01e41ddbd9a192de2ff01ef0Kalle Valo		 * this doesn't gain anything.
2729050bdd8589c373e01e41ddbd9a192de2ff01ef0Kalle Valo		 *
2739050bdd8589c373e01e41ddbd9a192de2ff01ef0Kalle Valo		 * When IEEE80211_HW_PS_NULLFUNC_STACK is enabled, no need
2749050bdd8589c373e01e41ddbd9a192de2ff01ef0Kalle Valo		 * to send a nullfunc frame because AP already knows that
2759050bdd8589c373e01e41ddbd9a192de2ff01ef0Kalle Valo		 * we are sleeping, let's just enable power save mode in
2769050bdd8589c373e01e41ddbd9a192de2ff01ef0Kalle Valo		 * hardware.
2779050bdd8589c373e01e41ddbd9a192de2ff01ef0Kalle Valo		 */
2789050bdd8589c373e01e41ddbd9a192de2ff01ef0Kalle Valo		local->hw.conf.flags |= IEEE80211_CONF_PS;
2799050bdd8589c373e01e41ddbd9a192de2ff01ef0Kalle Valo		ieee80211_hw_config(local, IEEE80211_CONF_CHANGE_PS);
2809050bdd8589c373e01e41ddbd9a192de2ff01ef0Kalle Valo	}
2819050bdd8589c373e01e41ddbd9a192de2ff01ef0Kalle Valo}
2829050bdd8589c373e01e41ddbd9a192de2ff01ef0Kalle Valo
2832a5193119269062608582418deba7af82844159aJohannes Bergvoid ieee80211_scan_completed(struct ieee80211_hw *hw, bool aborted)
2840a51b27e956bd9580296c48191b78175ed8b5971Johannes Berg{
2850a51b27e956bd9580296c48191b78175ed8b5971Johannes Berg	struct ieee80211_local *local = hw_to_local(hw);
2860a51b27e956bd9580296c48191b78175ed8b5971Johannes Berg	struct ieee80211_sub_if_data *sdata;
287f3b85252f081581a8f257545ed748062dce7798bJohannes Berg	bool was_hw_scan;
2880a51b27e956bd9580296c48191b78175ed8b5971Johannes Berg
289f3b85252f081581a8f257545ed748062dce7798bJohannes Berg	mutex_lock(&local->scan_mtx);
2905bc75728fd43bb15b46f16ef465bcf9d487393cfJohannes Berg
2916d3560d4fc9c5b9fe1a07a63926ea70512c69c32Johannes Berg	/*
2926d3560d4fc9c5b9fe1a07a63926ea70512c69c32Johannes Berg	 * It's ok to abort a not-yet-running scan (that
2936d3560d4fc9c5b9fe1a07a63926ea70512c69c32Johannes Berg	 * we have one at all will be verified by checking
2946d3560d4fc9c5b9fe1a07a63926ea70512c69c32Johannes Berg	 * local->scan_req next), but not to complete it
2956d3560d4fc9c5b9fe1a07a63926ea70512c69c32Johannes Berg	 * successfully.
2966d3560d4fc9c5b9fe1a07a63926ea70512c69c32Johannes Berg	 */
2976d3560d4fc9c5b9fe1a07a63926ea70512c69c32Johannes Berg	if (WARN_ON(!local->scanning && !aborted))
2986d3560d4fc9c5b9fe1a07a63926ea70512c69c32Johannes Berg		aborted = true;
2995bc75728fd43bb15b46f16ef465bcf9d487393cfJohannes Berg
300f3b85252f081581a8f257545ed748062dce7798bJohannes Berg	if (WARN_ON(!local->scan_req)) {
301f3b85252f081581a8f257545ed748062dce7798bJohannes Berg		mutex_unlock(&local->scan_mtx);
302f3b85252f081581a8f257545ed748062dce7798bJohannes Berg		return;
303de95a54b1aebe5592cae971ca5e5d9ec6a381a17Johannes Berg	}
304de95a54b1aebe5592cae971ca5e5d9ec6a381a17Johannes Berg
3054d36ec58239eec44d77839ef6c25108efcbbb58cJohannes Berg	was_hw_scan = test_bit(SCAN_HW_SCANNING, &local->scanning);
3064d36ec58239eec44d77839ef6c25108efcbbb58cJohannes Berg	if (was_hw_scan && !aborted && ieee80211_prep_hw_scan(local)) {
3074d36ec58239eec44d77839ef6c25108efcbbb58cJohannes Berg		ieee80211_queue_delayed_work(&local->hw,
3084d36ec58239eec44d77839ef6c25108efcbbb58cJohannes Berg					     &local->scan_work, 0);
3094d36ec58239eec44d77839ef6c25108efcbbb58cJohannes Berg		mutex_unlock(&local->scan_mtx);
3104d36ec58239eec44d77839ef6c25108efcbbb58cJohannes Berg		return;
3114d36ec58239eec44d77839ef6c25108efcbbb58cJohannes Berg	}
3124d36ec58239eec44d77839ef6c25108efcbbb58cJohannes Berg
3134d36ec58239eec44d77839ef6c25108efcbbb58cJohannes Berg	kfree(local->hw_scan_req);
3144d36ec58239eec44d77839ef6c25108efcbbb58cJohannes Berg	local->hw_scan_req = NULL;
315f3b85252f081581a8f257545ed748062dce7798bJohannes Berg
3165ba63533bbf653631faab60f6988506160ec6ba4Johannes Berg	if (local->scan_req != local->int_scan_req)
3172a5193119269062608582418deba7af82844159aJohannes Berg		cfg80211_scan_done(local->scan_req, aborted);
3182a5193119269062608582418deba7af82844159aJohannes Berg	local->scan_req = NULL;
31915db0b7fd872b0312033666d3a82e1214a227ec0Johannes Berg	local->scan_sdata = NULL;
3202a5193119269062608582418deba7af82844159aJohannes Berg
321fbe9c429f195111bbf7f1630efa19aee295fd8e7Helmut Schaa	local->scanning = 0;
32258905ca5b11a0ff3860f55b789cbbf052f7158a7Johannes Berg	local->scan_channel = NULL;
323f3b85252f081581a8f257545ed748062dce7798bJohannes Berg
324f3b85252f081581a8f257545ed748062dce7798bJohannes Berg	/* we only have to protect scan_req and hw/sw scan */
325f3b85252f081581a8f257545ed748062dce7798bJohannes Berg	mutex_unlock(&local->scan_mtx);
326f3b85252f081581a8f257545ed748062dce7798bJohannes Berg
327e8975581f63870be42ff4662b293d1b0c8c21350Johannes Berg	ieee80211_hw_config(local, IEEE80211_CONF_CHANGE_CHANNEL);
3285cff20e6c5a6591a79d3b027af222870f52bb550Johannes Berg	if (was_hw_scan)
3295cff20e6c5a6591a79d3b027af222870f52bb550Johannes Berg		goto done;
3300a51b27e956bd9580296c48191b78175ed8b5971Johannes Berg
3313ac64beecd27400d12cc7afb4108eef26c499f6aJohannes Berg	ieee80211_configure_filter(local);
3320a51b27e956bd9580296c48191b78175ed8b5971Johannes Berg
3332448798133d747ad339e57099e32a1d1e68aca1cJohannes Berg	drv_sw_scan_complete(local);
33480e775bf08f1915870fbb0c1c7a45a3fdc291721Michael Buesch
335078e1e60dd6c6b0d4bc8d58ccb80c008e8efc9ffJohannes Berg	mutex_lock(&local->iflist_mtx);
336078e1e60dd6c6b0d4bc8d58ccb80c008e8efc9ffJohannes Berg	list_for_each_entry(sdata, &local->interfaces, list) {
337fb9ddbf086591ab4c90c44d10468f84d465b3fdfJohannes Berg		if (!netif_running(sdata->dev))
338fb9ddbf086591ab4c90c44d10468f84d465b3fdfJohannes Berg			continue;
339fb9ddbf086591ab4c90c44d10468f84d465b3fdfJohannes Berg
3400a51b27e956bd9580296c48191b78175ed8b5971Johannes Berg		/* Tell AP we're back */
34105c914fe330fa8e1cc67870dc0d3809dfd96c107Johannes Berg		if (sdata->vif.type == NL80211_IFTYPE_STATION) {
34277fdaa12cea26c204cc12c312fe40bc0f3dcdfd8Johannes Berg			if (sdata->u.mgd.associated) {
3439050bdd8589c373e01e41ddbd9a192de2ff01ef0Kalle Valo				ieee80211_scan_ps_disable(sdata);
34453623f1a09c7a7d23b74f0f7d93dba0ebde1006bJohn W. Linville				netif_wake_queue(sdata->dev);
3450a51b27e956bd9580296c48191b78175ed8b5971Johannes Berg			}
3460a51b27e956bd9580296c48191b78175ed8b5971Johannes Berg		} else
34753623f1a09c7a7d23b74f0f7d93dba0ebde1006bJohn W. Linville			netif_wake_queue(sdata->dev);
348078e1e60dd6c6b0d4bc8d58ccb80c008e8efc9ffJohannes Berg
34914b80724367dfdc86f4807461dd1f7f2dd630416Johannes Berg		/* re-enable beaconing */
35014b80724367dfdc86f4807461dd1f7f2dd630416Johannes Berg		if (sdata->vif.type == NL80211_IFTYPE_AP ||
35114b80724367dfdc86f4807461dd1f7f2dd630416Johannes Berg		    sdata->vif.type == NL80211_IFTYPE_ADHOC ||
35214b80724367dfdc86f4807461dd1f7f2dd630416Johannes Berg		    sdata->vif.type == NL80211_IFTYPE_MESH_POINT)
3532d0ddec5b2b859f06116f631fc0ffe94fbceb556Johannes Berg			ieee80211_bss_info_change_notify(
3542d0ddec5b2b859f06116f631fc0ffe94fbceb556Johannes Berg				sdata, BSS_CHANGED_BEACON_ENABLED);
3550a51b27e956bd9580296c48191b78175ed8b5971Johannes Berg	}
356078e1e60dd6c6b0d4bc8d58ccb80c008e8efc9ffJohannes Berg	mutex_unlock(&local->iflist_mtx);
3570a51b27e956bd9580296c48191b78175ed8b5971Johannes Berg
3580a51b27e956bd9580296c48191b78175ed8b5971Johannes Berg done:
3595cff20e6c5a6591a79d3b027af222870f52bb550Johannes Berg	ieee80211_recalc_idle(local);
3600a51b27e956bd9580296c48191b78175ed8b5971Johannes Berg	ieee80211_mlme_notify_scan_completed(local);
361469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg	ieee80211_ibss_notify_scan_completed(local);
362472dbc45dc1966284de72d7de15690c17ed2cf33Johannes Berg	ieee80211_mesh_notify_scan_completed(local);
3630a51b27e956bd9580296c48191b78175ed8b5971Johannes Berg}
3640a51b27e956bd9580296c48191b78175ed8b5971Johannes BergEXPORT_SYMBOL(ieee80211_scan_completed);
3650a51b27e956bd9580296c48191b78175ed8b5971Johannes Berg
366f3b85252f081581a8f257545ed748062dce7798bJohannes Bergstatic int ieee80211_start_sw_scan(struct ieee80211_local *local)
367f3b85252f081581a8f257545ed748062dce7798bJohannes Berg{
368f3b85252f081581a8f257545ed748062dce7798bJohannes Berg	struct ieee80211_sub_if_data *sdata;
369f3b85252f081581a8f257545ed748062dce7798bJohannes Berg
370f3b85252f081581a8f257545ed748062dce7798bJohannes Berg	/*
371f3b85252f081581a8f257545ed748062dce7798bJohannes Berg	 * Hardware/driver doesn't support hw_scan, so use software
372f3b85252f081581a8f257545ed748062dce7798bJohannes Berg	 * scanning instead. First send a nullfunc frame with power save
373f3b85252f081581a8f257545ed748062dce7798bJohannes Berg	 * bit on so that AP will buffer the frames for us while we are not
374f3b85252f081581a8f257545ed748062dce7798bJohannes Berg	 * listening, then send probe requests to each channel and wait for
375f3b85252f081581a8f257545ed748062dce7798bJohannes Berg	 * the responses. After all channels are scanned, tune back to the
376f3b85252f081581a8f257545ed748062dce7798bJohannes Berg	 * original channel and send a nullfunc frame with power save bit
377f3b85252f081581a8f257545ed748062dce7798bJohannes Berg	 * off to trigger the AP to send us all the buffered frames.
378f3b85252f081581a8f257545ed748062dce7798bJohannes Berg	 *
379f3b85252f081581a8f257545ed748062dce7798bJohannes Berg	 * Note that while local->sw_scanning is true everything else but
380f3b85252f081581a8f257545ed748062dce7798bJohannes Berg	 * nullfunc frames and probe requests will be dropped in
381f3b85252f081581a8f257545ed748062dce7798bJohannes Berg	 * ieee80211_tx_h_check_assoc().
382f3b85252f081581a8f257545ed748062dce7798bJohannes Berg	 */
3832448798133d747ad339e57099e32a1d1e68aca1cJohannes Berg	drv_sw_scan_start(local);
384f3b85252f081581a8f257545ed748062dce7798bJohannes Berg
385f3b85252f081581a8f257545ed748062dce7798bJohannes Berg	mutex_lock(&local->iflist_mtx);
386f3b85252f081581a8f257545ed748062dce7798bJohannes Berg	list_for_each_entry(sdata, &local->interfaces, list) {
387f3b85252f081581a8f257545ed748062dce7798bJohannes Berg		if (!netif_running(sdata->dev))
388f3b85252f081581a8f257545ed748062dce7798bJohannes Berg			continue;
389f3b85252f081581a8f257545ed748062dce7798bJohannes Berg
390f3b85252f081581a8f257545ed748062dce7798bJohannes Berg		/* disable beaconing */
391f3b85252f081581a8f257545ed748062dce7798bJohannes Berg		if (sdata->vif.type == NL80211_IFTYPE_AP ||
392f3b85252f081581a8f257545ed748062dce7798bJohannes Berg		    sdata->vif.type == NL80211_IFTYPE_ADHOC ||
393f3b85252f081581a8f257545ed748062dce7798bJohannes Berg		    sdata->vif.type == NL80211_IFTYPE_MESH_POINT)
3942d0ddec5b2b859f06116f631fc0ffe94fbceb556Johannes Berg			ieee80211_bss_info_change_notify(
3952d0ddec5b2b859f06116f631fc0ffe94fbceb556Johannes Berg				sdata, BSS_CHANGED_BEACON_ENABLED);
396f3b85252f081581a8f257545ed748062dce7798bJohannes Berg
397142b9f5074dc0d09dc0025739ad437723d7bf527Helmut Schaa		/*
398142b9f5074dc0d09dc0025739ad437723d7bf527Helmut Schaa		 * only handle non-STA interfaces here, STA interfaces
399142b9f5074dc0d09dc0025739ad437723d7bf527Helmut Schaa		 * are handled in the scan state machine
400142b9f5074dc0d09dc0025739ad437723d7bf527Helmut Schaa		 */
401142b9f5074dc0d09dc0025739ad437723d7bf527Helmut Schaa		if (sdata->vif.type != NL80211_IFTYPE_STATION)
40253623f1a09c7a7d23b74f0f7d93dba0ebde1006bJohn W. Linville			netif_stop_queue(sdata->dev);
403f3b85252f081581a8f257545ed748062dce7798bJohannes Berg	}
404f3b85252f081581a8f257545ed748062dce7798bJohannes Berg	mutex_unlock(&local->iflist_mtx);
405f3b85252f081581a8f257545ed748062dce7798bJohannes Berg
406977923b00c79185c11b4b47664f5ffa4c3820438Helmut Schaa	local->next_scan_state = SCAN_DECISION;
407f3b85252f081581a8f257545ed748062dce7798bJohannes Berg	local->scan_channel_idx = 0;
408f3b85252f081581a8f257545ed748062dce7798bJohannes Berg
4093ac64beecd27400d12cc7afb4108eef26c499f6aJohannes Berg	ieee80211_configure_filter(local);
410f3b85252f081581a8f257545ed748062dce7798bJohannes Berg
411f3b85252f081581a8f257545ed748062dce7798bJohannes Berg	/* TODO: start scan as soon as all nullfunc frames are ACKed */
41242935ecaf4e784d0815afa9a7e5fe7e141157ca3Luis R. Rodriguez	ieee80211_queue_delayed_work(&local->hw,
41342935ecaf4e784d0815afa9a7e5fe7e141157ca3Luis R. Rodriguez				     &local->scan_work,
41442935ecaf4e784d0815afa9a7e5fe7e141157ca3Luis R. Rodriguez				     IEEE80211_CHANNEL_TIME);
415f3b85252f081581a8f257545ed748062dce7798bJohannes Berg
416f3b85252f081581a8f257545ed748062dce7798bJohannes Berg	return 0;
417f3b85252f081581a8f257545ed748062dce7798bJohannes Berg}
418f3b85252f081581a8f257545ed748062dce7798bJohannes Berg
419f3b85252f081581a8f257545ed748062dce7798bJohannes Berg
420f3b85252f081581a8f257545ed748062dce7798bJohannes Bergstatic int __ieee80211_start_scan(struct ieee80211_sub_if_data *sdata,
421f3b85252f081581a8f257545ed748062dce7798bJohannes Berg				  struct cfg80211_scan_request *req)
422f3b85252f081581a8f257545ed748062dce7798bJohannes Berg{
423f3b85252f081581a8f257545ed748062dce7798bJohannes Berg	struct ieee80211_local *local = sdata->local;
424f3b85252f081581a8f257545ed748062dce7798bJohannes Berg	struct ieee80211_if_managed *ifmgd = &sdata->u.mgd;
425f3b85252f081581a8f257545ed748062dce7798bJohannes Berg	int rc;
426f3b85252f081581a8f257545ed748062dce7798bJohannes Berg
427f3b85252f081581a8f257545ed748062dce7798bJohannes Berg	if (local->scan_req)
428f3b85252f081581a8f257545ed748062dce7798bJohannes Berg		return -EBUSY;
429f3b85252f081581a8f257545ed748062dce7798bJohannes Berg
430f3b85252f081581a8f257545ed748062dce7798bJohannes Berg	if (local->ops->hw_scan) {
431f3b85252f081581a8f257545ed748062dce7798bJohannes Berg		u8 *ies;
432f3b85252f081581a8f257545ed748062dce7798bJohannes Berg
4334d36ec58239eec44d77839ef6c25108efcbbb58cJohannes Berg		local->hw_scan_req = kmalloc(
4344d36ec58239eec44d77839ef6c25108efcbbb58cJohannes Berg				sizeof(*local->hw_scan_req) +
4354d36ec58239eec44d77839ef6c25108efcbbb58cJohannes Berg				req->n_channels * sizeof(req->channels[0]) +
4364d36ec58239eec44d77839ef6c25108efcbbb58cJohannes Berg				2 + IEEE80211_MAX_SSID_LEN + local->scan_ies_len +
4374d36ec58239eec44d77839ef6c25108efcbbb58cJohannes Berg				req->ie_len, GFP_KERNEL);
4384d36ec58239eec44d77839ef6c25108efcbbb58cJohannes Berg		if (!local->hw_scan_req)
439f3b85252f081581a8f257545ed748062dce7798bJohannes Berg			return -ENOMEM;
440f3b85252f081581a8f257545ed748062dce7798bJohannes Berg
4414d36ec58239eec44d77839ef6c25108efcbbb58cJohannes Berg		local->hw_scan_req->ssids = req->ssids;
4424d36ec58239eec44d77839ef6c25108efcbbb58cJohannes Berg		local->hw_scan_req->n_ssids = req->n_ssids;
4434d36ec58239eec44d77839ef6c25108efcbbb58cJohannes Berg		ies = (u8 *)local->hw_scan_req +
4444d36ec58239eec44d77839ef6c25108efcbbb58cJohannes Berg			sizeof(*local->hw_scan_req) +
4454d36ec58239eec44d77839ef6c25108efcbbb58cJohannes Berg			req->n_channels * sizeof(req->channels[0]);
4464d36ec58239eec44d77839ef6c25108efcbbb58cJohannes Berg		local->hw_scan_req->ie = ies;
4474d36ec58239eec44d77839ef6c25108efcbbb58cJohannes Berg
4484d36ec58239eec44d77839ef6c25108efcbbb58cJohannes Berg		local->hw_scan_band = 0;
449f3b85252f081581a8f257545ed748062dce7798bJohannes Berg	}
450f3b85252f081581a8f257545ed748062dce7798bJohannes Berg
451f3b85252f081581a8f257545ed748062dce7798bJohannes Berg	local->scan_req = req;
452f3b85252f081581a8f257545ed748062dce7798bJohannes Berg	local->scan_sdata = sdata;
453f3b85252f081581a8f257545ed748062dce7798bJohannes Berg
4545ba63533bbf653631faab60f6988506160ec6ba4Johannes Berg	if (req != local->int_scan_req &&
455f3b85252f081581a8f257545ed748062dce7798bJohannes Berg	    sdata->vif.type == NL80211_IFTYPE_STATION &&
45677fdaa12cea26c204cc12c312fe40bc0f3dcdfd8Johannes Berg	    !list_empty(&ifmgd->work_list)) {
45777fdaa12cea26c204cc12c312fe40bc0f3dcdfd8Johannes Berg		/* actually wait for the work it's doing to finish/time out */
458f3b85252f081581a8f257545ed748062dce7798bJohannes Berg		set_bit(IEEE80211_STA_REQ_SCAN, &ifmgd->request);
459f3b85252f081581a8f257545ed748062dce7798bJohannes Berg		return 0;
460f3b85252f081581a8f257545ed748062dce7798bJohannes Berg	}
461f3b85252f081581a8f257545ed748062dce7798bJohannes Berg
462f3b85252f081581a8f257545ed748062dce7798bJohannes Berg	if (local->ops->hw_scan)
463fbe9c429f195111bbf7f1630efa19aee295fd8e7Helmut Schaa		__set_bit(SCAN_HW_SCANNING, &local->scanning);
464f3b85252f081581a8f257545ed748062dce7798bJohannes Berg	else
465fbe9c429f195111bbf7f1630efa19aee295fd8e7Helmut Schaa		__set_bit(SCAN_SW_SCANNING, &local->scanning);
466f3b85252f081581a8f257545ed748062dce7798bJohannes Berg	/*
467f3b85252f081581a8f257545ed748062dce7798bJohannes Berg	 * Kicking off the scan need not be protected,
468f3b85252f081581a8f257545ed748062dce7798bJohannes Berg	 * only the scan variable stuff, since now
469f3b85252f081581a8f257545ed748062dce7798bJohannes Berg	 * local->scan_req is assigned and other callers
470f3b85252f081581a8f257545ed748062dce7798bJohannes Berg	 * will abort their scan attempts.
471f3b85252f081581a8f257545ed748062dce7798bJohannes Berg	 *
472f3b85252f081581a8f257545ed748062dce7798bJohannes Berg	 * This avoids getting a scan_mtx -> iflist_mtx
473f3b85252f081581a8f257545ed748062dce7798bJohannes Berg	 * dependency, so that the scan completed calls
474f3b85252f081581a8f257545ed748062dce7798bJohannes Berg	 * have more locking freedom.
475f3b85252f081581a8f257545ed748062dce7798bJohannes Berg	 */
4765cff20e6c5a6591a79d3b027af222870f52bb550Johannes Berg
4775cff20e6c5a6591a79d3b027af222870f52bb550Johannes Berg	ieee80211_recalc_idle(local);
478f3b85252f081581a8f257545ed748062dce7798bJohannes Berg	mutex_unlock(&local->scan_mtx);
479f3b85252f081581a8f257545ed748062dce7798bJohannes Berg
4804d36ec58239eec44d77839ef6c25108efcbbb58cJohannes Berg	if (local->ops->hw_scan) {
4814d36ec58239eec44d77839ef6c25108efcbbb58cJohannes Berg		WARN_ON(!ieee80211_prep_hw_scan(local));
4824d36ec58239eec44d77839ef6c25108efcbbb58cJohannes Berg		rc = drv_hw_scan(local, local->hw_scan_req);
4834d36ec58239eec44d77839ef6c25108efcbbb58cJohannes Berg	} else
484f3b85252f081581a8f257545ed748062dce7798bJohannes Berg		rc = ieee80211_start_sw_scan(local);
485f3b85252f081581a8f257545ed748062dce7798bJohannes Berg
486f3b85252f081581a8f257545ed748062dce7798bJohannes Berg	mutex_lock(&local->scan_mtx);
487f3b85252f081581a8f257545ed748062dce7798bJohannes Berg
488f3b85252f081581a8f257545ed748062dce7798bJohannes Berg	if (rc) {
4894d36ec58239eec44d77839ef6c25108efcbbb58cJohannes Berg		kfree(local->hw_scan_req);
4904d36ec58239eec44d77839ef6c25108efcbbb58cJohannes Berg		local->hw_scan_req = NULL;
491fbe9c429f195111bbf7f1630efa19aee295fd8e7Helmut Schaa		local->scanning = 0;
492f3b85252f081581a8f257545ed748062dce7798bJohannes Berg
4935cff20e6c5a6591a79d3b027af222870f52bb550Johannes Berg		ieee80211_recalc_idle(local);
4945cff20e6c5a6591a79d3b027af222870f52bb550Johannes Berg
495f3b85252f081581a8f257545ed748062dce7798bJohannes Berg		local->scan_req = NULL;
496f3b85252f081581a8f257545ed748062dce7798bJohannes Berg		local->scan_sdata = NULL;
497f3b85252f081581a8f257545ed748062dce7798bJohannes Berg	}
498f3b85252f081581a8f257545ed748062dce7798bJohannes Berg
499f3b85252f081581a8f257545ed748062dce7798bJohannes Berg	return rc;
500f3b85252f081581a8f257545ed748062dce7798bJohannes Berg}
501f3b85252f081581a8f257545ed748062dce7798bJohannes Berg
5022fb3f028a9a46bd344329766257699b4acb36525Helmut Schaastatic int ieee80211_scan_state_decision(struct ieee80211_local *local,
5032fb3f028a9a46bd344329766257699b4acb36525Helmut Schaa					 unsigned long *next_delay)
5047d3be3cc489176bc7bd23e673b0b4aef597af2b3Helmut Schaa{
505142b9f5074dc0d09dc0025739ad437723d7bf527Helmut Schaa	bool associated = false;
506142b9f5074dc0d09dc0025739ad437723d7bf527Helmut Schaa	struct ieee80211_sub_if_data *sdata;
507142b9f5074dc0d09dc0025739ad437723d7bf527Helmut Schaa
508142b9f5074dc0d09dc0025739ad437723d7bf527Helmut Schaa	/* if no more bands/channels left, complete scan and advance to the idle state */
5097d3be3cc489176bc7bd23e673b0b4aef597af2b3Helmut Schaa	if (local->scan_channel_idx >= local->scan_req->n_channels) {
5107d3be3cc489176bc7bd23e673b0b4aef597af2b3Helmut Schaa		ieee80211_scan_completed(&local->hw, false);
5117d3be3cc489176bc7bd23e673b0b4aef597af2b3Helmut Schaa		return 1;
5127d3be3cc489176bc7bd23e673b0b4aef597af2b3Helmut Schaa	}
5132fb3f028a9a46bd344329766257699b4acb36525Helmut Schaa
514142b9f5074dc0d09dc0025739ad437723d7bf527Helmut Schaa	/* check if at least one STA interface is associated */
515142b9f5074dc0d09dc0025739ad437723d7bf527Helmut Schaa	mutex_lock(&local->iflist_mtx);
516142b9f5074dc0d09dc0025739ad437723d7bf527Helmut Schaa	list_for_each_entry(sdata, &local->interfaces, list) {
517142b9f5074dc0d09dc0025739ad437723d7bf527Helmut Schaa		if (!netif_running(sdata->dev))
518142b9f5074dc0d09dc0025739ad437723d7bf527Helmut Schaa			continue;
519142b9f5074dc0d09dc0025739ad437723d7bf527Helmut Schaa
520142b9f5074dc0d09dc0025739ad437723d7bf527Helmut Schaa		if (sdata->vif.type == NL80211_IFTYPE_STATION) {
521142b9f5074dc0d09dc0025739ad437723d7bf527Helmut Schaa			if (sdata->u.mgd.associated) {
522142b9f5074dc0d09dc0025739ad437723d7bf527Helmut Schaa				associated = true;
523142b9f5074dc0d09dc0025739ad437723d7bf527Helmut Schaa				break;
524142b9f5074dc0d09dc0025739ad437723d7bf527Helmut Schaa			}
525142b9f5074dc0d09dc0025739ad437723d7bf527Helmut Schaa		}
526142b9f5074dc0d09dc0025739ad437723d7bf527Helmut Schaa	}
527142b9f5074dc0d09dc0025739ad437723d7bf527Helmut Schaa	mutex_unlock(&local->iflist_mtx);
528142b9f5074dc0d09dc0025739ad437723d7bf527Helmut Schaa
529142b9f5074dc0d09dc0025739ad437723d7bf527Helmut Schaa	if (local->scan_channel) {
530142b9f5074dc0d09dc0025739ad437723d7bf527Helmut Schaa		/*
531142b9f5074dc0d09dc0025739ad437723d7bf527Helmut Schaa		 * we're currently scanning a different channel, let's
532142b9f5074dc0d09dc0025739ad437723d7bf527Helmut Schaa		 * switch back to the operating channel now if at least
533142b9f5074dc0d09dc0025739ad437723d7bf527Helmut Schaa		 * one interface is associated. Otherwise just scan the
534142b9f5074dc0d09dc0025739ad437723d7bf527Helmut Schaa		 * next channel
535142b9f5074dc0d09dc0025739ad437723d7bf527Helmut Schaa		 */
536142b9f5074dc0d09dc0025739ad437723d7bf527Helmut Schaa		if (associated)
537977923b00c79185c11b4b47664f5ffa4c3820438Helmut Schaa			local->next_scan_state = SCAN_ENTER_OPER_CHANNEL;
538142b9f5074dc0d09dc0025739ad437723d7bf527Helmut Schaa		else
539977923b00c79185c11b4b47664f5ffa4c3820438Helmut Schaa			local->next_scan_state = SCAN_SET_CHANNEL;
540142b9f5074dc0d09dc0025739ad437723d7bf527Helmut Schaa	} else {
541142b9f5074dc0d09dc0025739ad437723d7bf527Helmut Schaa		/*
542142b9f5074dc0d09dc0025739ad437723d7bf527Helmut Schaa		 * we're on the operating channel currently, let's
543142b9f5074dc0d09dc0025739ad437723d7bf527Helmut Schaa		 * leave that channel now to scan another one
544142b9f5074dc0d09dc0025739ad437723d7bf527Helmut Schaa		 */
545977923b00c79185c11b4b47664f5ffa4c3820438Helmut Schaa		local->next_scan_state = SCAN_LEAVE_OPER_CHANNEL;
546142b9f5074dc0d09dc0025739ad437723d7bf527Helmut Schaa	}
547142b9f5074dc0d09dc0025739ad437723d7bf527Helmut Schaa
5482fb3f028a9a46bd344329766257699b4acb36525Helmut Schaa	*next_delay = 0;
5492fb3f028a9a46bd344329766257699b4acb36525Helmut Schaa	return 0;
5502fb3f028a9a46bd344329766257699b4acb36525Helmut Schaa}
5512fb3f028a9a46bd344329766257699b4acb36525Helmut Schaa
552142b9f5074dc0d09dc0025739ad437723d7bf527Helmut Schaastatic void ieee80211_scan_state_leave_oper_channel(struct ieee80211_local *local,
553142b9f5074dc0d09dc0025739ad437723d7bf527Helmut Schaa						    unsigned long *next_delay)
554142b9f5074dc0d09dc0025739ad437723d7bf527Helmut Schaa{
555142b9f5074dc0d09dc0025739ad437723d7bf527Helmut Schaa	struct ieee80211_sub_if_data *sdata;
556142b9f5074dc0d09dc0025739ad437723d7bf527Helmut Schaa
557142b9f5074dc0d09dc0025739ad437723d7bf527Helmut Schaa	/*
558142b9f5074dc0d09dc0025739ad437723d7bf527Helmut Schaa	 * notify the AP about us leaving the channel and stop all STA interfaces
559142b9f5074dc0d09dc0025739ad437723d7bf527Helmut Schaa	 */
560142b9f5074dc0d09dc0025739ad437723d7bf527Helmut Schaa	mutex_lock(&local->iflist_mtx);
561142b9f5074dc0d09dc0025739ad437723d7bf527Helmut Schaa	list_for_each_entry(sdata, &local->interfaces, list) {
562142b9f5074dc0d09dc0025739ad437723d7bf527Helmut Schaa		if (!netif_running(sdata->dev))
563142b9f5074dc0d09dc0025739ad437723d7bf527Helmut Schaa			continue;
564142b9f5074dc0d09dc0025739ad437723d7bf527Helmut Schaa
565142b9f5074dc0d09dc0025739ad437723d7bf527Helmut Schaa		if (sdata->vif.type == NL80211_IFTYPE_STATION) {
56653623f1a09c7a7d23b74f0f7d93dba0ebde1006bJohn W. Linville			netif_stop_queue(sdata->dev);
567142b9f5074dc0d09dc0025739ad437723d7bf527Helmut Schaa			if (sdata->u.mgd.associated)
568142b9f5074dc0d09dc0025739ad437723d7bf527Helmut Schaa				ieee80211_scan_ps_enable(sdata);
569142b9f5074dc0d09dc0025739ad437723d7bf527Helmut Schaa		}
570142b9f5074dc0d09dc0025739ad437723d7bf527Helmut Schaa	}
571142b9f5074dc0d09dc0025739ad437723d7bf527Helmut Schaa	mutex_unlock(&local->iflist_mtx);
572142b9f5074dc0d09dc0025739ad437723d7bf527Helmut Schaa
573142b9f5074dc0d09dc0025739ad437723d7bf527Helmut Schaa	__set_bit(SCAN_OFF_CHANNEL, &local->scanning);
574142b9f5074dc0d09dc0025739ad437723d7bf527Helmut Schaa
575142b9f5074dc0d09dc0025739ad437723d7bf527Helmut Schaa	/* advance to the next channel to be scanned */
576142b9f5074dc0d09dc0025739ad437723d7bf527Helmut Schaa	*next_delay = HZ / 10;
577977923b00c79185c11b4b47664f5ffa4c3820438Helmut Schaa	local->next_scan_state = SCAN_SET_CHANNEL;
578142b9f5074dc0d09dc0025739ad437723d7bf527Helmut Schaa}
579142b9f5074dc0d09dc0025739ad437723d7bf527Helmut Schaa
580142b9f5074dc0d09dc0025739ad437723d7bf527Helmut Schaastatic void ieee80211_scan_state_enter_oper_channel(struct ieee80211_local *local,
581142b9f5074dc0d09dc0025739ad437723d7bf527Helmut Schaa						    unsigned long *next_delay)
582142b9f5074dc0d09dc0025739ad437723d7bf527Helmut Schaa{
583142b9f5074dc0d09dc0025739ad437723d7bf527Helmut Schaa	struct ieee80211_sub_if_data *sdata = local->scan_sdata;
584142b9f5074dc0d09dc0025739ad437723d7bf527Helmut Schaa
585142b9f5074dc0d09dc0025739ad437723d7bf527Helmut Schaa	/* switch back to the operating channel */
586142b9f5074dc0d09dc0025739ad437723d7bf527Helmut Schaa	local->scan_channel = NULL;
587142b9f5074dc0d09dc0025739ad437723d7bf527Helmut Schaa	ieee80211_hw_config(local, IEEE80211_CONF_CHANGE_CHANNEL);
588142b9f5074dc0d09dc0025739ad437723d7bf527Helmut Schaa
589142b9f5074dc0d09dc0025739ad437723d7bf527Helmut Schaa	/*
590142b9f5074dc0d09dc0025739ad437723d7bf527Helmut Schaa	 * notify the AP about us being back and restart all STA interfaces
591142b9f5074dc0d09dc0025739ad437723d7bf527Helmut Schaa	 */
592142b9f5074dc0d09dc0025739ad437723d7bf527Helmut Schaa	mutex_lock(&local->iflist_mtx);
593142b9f5074dc0d09dc0025739ad437723d7bf527Helmut Schaa	list_for_each_entry(sdata, &local->interfaces, list) {
594142b9f5074dc0d09dc0025739ad437723d7bf527Helmut Schaa		if (!netif_running(sdata->dev))
595142b9f5074dc0d09dc0025739ad437723d7bf527Helmut Schaa			continue;
596142b9f5074dc0d09dc0025739ad437723d7bf527Helmut Schaa
597142b9f5074dc0d09dc0025739ad437723d7bf527Helmut Schaa		/* Tell AP we're back */
598142b9f5074dc0d09dc0025739ad437723d7bf527Helmut Schaa		if (sdata->vif.type == NL80211_IFTYPE_STATION) {
599142b9f5074dc0d09dc0025739ad437723d7bf527Helmut Schaa			if (sdata->u.mgd.associated)
600142b9f5074dc0d09dc0025739ad437723d7bf527Helmut Schaa				ieee80211_scan_ps_disable(sdata);
60153623f1a09c7a7d23b74f0f7d93dba0ebde1006bJohn W. Linville			netif_wake_queue(sdata->dev);
602142b9f5074dc0d09dc0025739ad437723d7bf527Helmut Schaa		}
603142b9f5074dc0d09dc0025739ad437723d7bf527Helmut Schaa	}
604142b9f5074dc0d09dc0025739ad437723d7bf527Helmut Schaa	mutex_unlock(&local->iflist_mtx);
605142b9f5074dc0d09dc0025739ad437723d7bf527Helmut Schaa
606142b9f5074dc0d09dc0025739ad437723d7bf527Helmut Schaa	__clear_bit(SCAN_OFF_CHANNEL, &local->scanning);
607142b9f5074dc0d09dc0025739ad437723d7bf527Helmut Schaa
608142b9f5074dc0d09dc0025739ad437723d7bf527Helmut Schaa	*next_delay = HZ / 5;
609977923b00c79185c11b4b47664f5ffa4c3820438Helmut Schaa	local->next_scan_state = SCAN_DECISION;
610142b9f5074dc0d09dc0025739ad437723d7bf527Helmut Schaa}
611142b9f5074dc0d09dc0025739ad437723d7bf527Helmut Schaa
6122fb3f028a9a46bd344329766257699b4acb36525Helmut Schaastatic void ieee80211_scan_state_set_channel(struct ieee80211_local *local,
6132fb3f028a9a46bd344329766257699b4acb36525Helmut Schaa					     unsigned long *next_delay)
6142fb3f028a9a46bd344329766257699b4acb36525Helmut Schaa{
6152fb3f028a9a46bd344329766257699b4acb36525Helmut Schaa	int skip;
6162fb3f028a9a46bd344329766257699b4acb36525Helmut Schaa	struct ieee80211_channel *chan;
6172fb3f028a9a46bd344329766257699b4acb36525Helmut Schaa	struct ieee80211_sub_if_data *sdata = local->scan_sdata;
6182fb3f028a9a46bd344329766257699b4acb36525Helmut Schaa
6197d3be3cc489176bc7bd23e673b0b4aef597af2b3Helmut Schaa	skip = 0;
6207d3be3cc489176bc7bd23e673b0b4aef597af2b3Helmut Schaa	chan = local->scan_req->channels[local->scan_channel_idx];
6217d3be3cc489176bc7bd23e673b0b4aef597af2b3Helmut Schaa
6227d3be3cc489176bc7bd23e673b0b4aef597af2b3Helmut Schaa	if (chan->flags & IEEE80211_CHAN_DISABLED ||
6237d3be3cc489176bc7bd23e673b0b4aef597af2b3Helmut Schaa	    (sdata->vif.type == NL80211_IFTYPE_ADHOC &&
6247d3be3cc489176bc7bd23e673b0b4aef597af2b3Helmut Schaa	     chan->flags & IEEE80211_CHAN_NO_IBSS))
6257d3be3cc489176bc7bd23e673b0b4aef597af2b3Helmut Schaa		skip = 1;
6267d3be3cc489176bc7bd23e673b0b4aef597af2b3Helmut Schaa
6277d3be3cc489176bc7bd23e673b0b4aef597af2b3Helmut Schaa	if (!skip) {
6287d3be3cc489176bc7bd23e673b0b4aef597af2b3Helmut Schaa		local->scan_channel = chan;
6297d3be3cc489176bc7bd23e673b0b4aef597af2b3Helmut Schaa		if (ieee80211_hw_config(local,
6307d3be3cc489176bc7bd23e673b0b4aef597af2b3Helmut Schaa					IEEE80211_CONF_CHANGE_CHANNEL))
6317d3be3cc489176bc7bd23e673b0b4aef597af2b3Helmut Schaa			skip = 1;
6327d3be3cc489176bc7bd23e673b0b4aef597af2b3Helmut Schaa	}
6337d3be3cc489176bc7bd23e673b0b4aef597af2b3Helmut Schaa
6347d3be3cc489176bc7bd23e673b0b4aef597af2b3Helmut Schaa	/* advance state machine to next channel/band */
6357d3be3cc489176bc7bd23e673b0b4aef597af2b3Helmut Schaa	local->scan_channel_idx++;
6367d3be3cc489176bc7bd23e673b0b4aef597af2b3Helmut Schaa
6370ee9c13c7c92581ab005d80795cf65897213b249Helmut Schaa	if (skip) {
6380ee9c13c7c92581ab005d80795cf65897213b249Helmut Schaa		/* if we skip this channel return to the decision state */
6390ee9c13c7c92581ab005d80795cf65897213b249Helmut Schaa		local->next_scan_state = SCAN_DECISION;
6402fb3f028a9a46bd344329766257699b4acb36525Helmut Schaa		return;
6410ee9c13c7c92581ab005d80795cf65897213b249Helmut Schaa	}
6427d3be3cc489176bc7bd23e673b0b4aef597af2b3Helmut Schaa
6437d3be3cc489176bc7bd23e673b0b4aef597af2b3Helmut Schaa	/*
6447d3be3cc489176bc7bd23e673b0b4aef597af2b3Helmut Schaa	 * Probe delay is used to update the NAV, cf. 11.1.3.2.2
6457d3be3cc489176bc7bd23e673b0b4aef597af2b3Helmut Schaa	 * (which unfortunately doesn't say _why_ step a) is done,
6467d3be3cc489176bc7bd23e673b0b4aef597af2b3Helmut Schaa	 * but it waits for the probe delay or until a frame is
6477d3be3cc489176bc7bd23e673b0b4aef597af2b3Helmut Schaa	 * received - and the received frame would update the NAV).
6487d3be3cc489176bc7bd23e673b0b4aef597af2b3Helmut Schaa	 * For now, we do not support waiting until a frame is
6497d3be3cc489176bc7bd23e673b0b4aef597af2b3Helmut Schaa	 * received.
6507d3be3cc489176bc7bd23e673b0b4aef597af2b3Helmut Schaa	 *
6517d3be3cc489176bc7bd23e673b0b4aef597af2b3Helmut Schaa	 * In any case, it is not necessary for a passive scan.
6527d3be3cc489176bc7bd23e673b0b4aef597af2b3Helmut Schaa	 */
6537d3be3cc489176bc7bd23e673b0b4aef597af2b3Helmut Schaa	if (chan->flags & IEEE80211_CHAN_PASSIVE_SCAN ||
6547d3be3cc489176bc7bd23e673b0b4aef597af2b3Helmut Schaa	    !local->scan_req->n_ssids) {
6557d3be3cc489176bc7bd23e673b0b4aef597af2b3Helmut Schaa		*next_delay = IEEE80211_PASSIVE_CHANNEL_TIME;
656977923b00c79185c11b4b47664f5ffa4c3820438Helmut Schaa		local->next_scan_state = SCAN_DECISION;
6572fb3f028a9a46bd344329766257699b4acb36525Helmut Schaa		return;
6587d3be3cc489176bc7bd23e673b0b4aef597af2b3Helmut Schaa	}
6597d3be3cc489176bc7bd23e673b0b4aef597af2b3Helmut Schaa
6602fb3f028a9a46bd344329766257699b4acb36525Helmut Schaa	/* active scan, send probes */
6617d3be3cc489176bc7bd23e673b0b4aef597af2b3Helmut Schaa	*next_delay = IEEE80211_PROBE_DELAY;
662977923b00c79185c11b4b47664f5ffa4c3820438Helmut Schaa	local->next_scan_state = SCAN_SEND_PROBE;
6637d3be3cc489176bc7bd23e673b0b4aef597af2b3Helmut Schaa}
6647d3be3cc489176bc7bd23e673b0b4aef597af2b3Helmut Schaa
6657d3be3cc489176bc7bd23e673b0b4aef597af2b3Helmut Schaastatic void ieee80211_scan_state_send_probe(struct ieee80211_local *local,
6667d3be3cc489176bc7bd23e673b0b4aef597af2b3Helmut Schaa					    unsigned long *next_delay)
6677d3be3cc489176bc7bd23e673b0b4aef597af2b3Helmut Schaa{
6687d3be3cc489176bc7bd23e673b0b4aef597af2b3Helmut Schaa	int i;
6697d3be3cc489176bc7bd23e673b0b4aef597af2b3Helmut Schaa	struct ieee80211_sub_if_data *sdata = local->scan_sdata;
6707d3be3cc489176bc7bd23e673b0b4aef597af2b3Helmut Schaa
6717d3be3cc489176bc7bd23e673b0b4aef597af2b3Helmut Schaa	for (i = 0; i < local->scan_req->n_ssids; i++)
6727d3be3cc489176bc7bd23e673b0b4aef597af2b3Helmut Schaa		ieee80211_send_probe_req(
6737d3be3cc489176bc7bd23e673b0b4aef597af2b3Helmut Schaa			sdata, NULL,
6747d3be3cc489176bc7bd23e673b0b4aef597af2b3Helmut Schaa			local->scan_req->ssids[i].ssid,
6757d3be3cc489176bc7bd23e673b0b4aef597af2b3Helmut Schaa			local->scan_req->ssids[i].ssid_len,
6767d3be3cc489176bc7bd23e673b0b4aef597af2b3Helmut Schaa			local->scan_req->ie, local->scan_req->ie_len);
6777d3be3cc489176bc7bd23e673b0b4aef597af2b3Helmut Schaa
6787d3be3cc489176bc7bd23e673b0b4aef597af2b3Helmut Schaa	/*
6797d3be3cc489176bc7bd23e673b0b4aef597af2b3Helmut Schaa	 * After sending probe requests, wait for probe responses
6807d3be3cc489176bc7bd23e673b0b4aef597af2b3Helmut Schaa	 * on the channel.
6817d3be3cc489176bc7bd23e673b0b4aef597af2b3Helmut Schaa	 */
6827d3be3cc489176bc7bd23e673b0b4aef597af2b3Helmut Schaa	*next_delay = IEEE80211_CHANNEL_TIME;
683977923b00c79185c11b4b47664f5ffa4c3820438Helmut Schaa	local->next_scan_state = SCAN_DECISION;
6847d3be3cc489176bc7bd23e673b0b4aef597af2b3Helmut Schaa}
6857d3be3cc489176bc7bd23e673b0b4aef597af2b3Helmut Schaa
686c2b13452b283f9c4a5b02a6b53ed6416ebf4c03cJohannes Bergvoid ieee80211_scan_work(struct work_struct *work)
6870a51b27e956bd9580296c48191b78175ed8b5971Johannes Berg{
6880a51b27e956bd9580296c48191b78175ed8b5971Johannes Berg	struct ieee80211_local *local =
6890a51b27e956bd9580296c48191b78175ed8b5971Johannes Berg		container_of(work, struct ieee80211_local, scan_work.work);
6900a51b27e956bd9580296c48191b78175ed8b5971Johannes Berg	struct ieee80211_sub_if_data *sdata = local->scan_sdata;
6910a51b27e956bd9580296c48191b78175ed8b5971Johannes Berg	unsigned long next_delay = 0;
6920a51b27e956bd9580296c48191b78175ed8b5971Johannes Berg
693f3b85252f081581a8f257545ed748062dce7798bJohannes Berg	mutex_lock(&local->scan_mtx);
694f3b85252f081581a8f257545ed748062dce7798bJohannes Berg	if (!sdata || !local->scan_req) {
695f3b85252f081581a8f257545ed748062dce7798bJohannes Berg		mutex_unlock(&local->scan_mtx);
696f3b85252f081581a8f257545ed748062dce7798bJohannes Berg		return;
697f3b85252f081581a8f257545ed748062dce7798bJohannes Berg	}
698f3b85252f081581a8f257545ed748062dce7798bJohannes Berg
6994d36ec58239eec44d77839ef6c25108efcbbb58cJohannes Berg	if (local->hw_scan_req) {
7004d36ec58239eec44d77839ef6c25108efcbbb58cJohannes Berg		int rc = drv_hw_scan(local, local->hw_scan_req);
7014d36ec58239eec44d77839ef6c25108efcbbb58cJohannes Berg		mutex_unlock(&local->scan_mtx);
7024d36ec58239eec44d77839ef6c25108efcbbb58cJohannes Berg		if (rc)
7034d36ec58239eec44d77839ef6c25108efcbbb58cJohannes Berg			ieee80211_scan_completed(&local->hw, true);
7044d36ec58239eec44d77839ef6c25108efcbbb58cJohannes Berg		return;
7054d36ec58239eec44d77839ef6c25108efcbbb58cJohannes Berg	}
7064d36ec58239eec44d77839ef6c25108efcbbb58cJohannes Berg
707fbe9c429f195111bbf7f1630efa19aee295fd8e7Helmut Schaa	if (local->scan_req && !local->scanning) {
708f3b85252f081581a8f257545ed748062dce7798bJohannes Berg		struct cfg80211_scan_request *req = local->scan_req;
709f3b85252f081581a8f257545ed748062dce7798bJohannes Berg		int rc;
710f3b85252f081581a8f257545ed748062dce7798bJohannes Berg
711f3b85252f081581a8f257545ed748062dce7798bJohannes Berg		local->scan_req = NULL;
71215db0b7fd872b0312033666d3a82e1214a227ec0Johannes Berg		local->scan_sdata = NULL;
713f3b85252f081581a8f257545ed748062dce7798bJohannes Berg
714f3b85252f081581a8f257545ed748062dce7798bJohannes Berg		rc = __ieee80211_start_scan(sdata, req);
715f3b85252f081581a8f257545ed748062dce7798bJohannes Berg		mutex_unlock(&local->scan_mtx);
716f3b85252f081581a8f257545ed748062dce7798bJohannes Berg
717f3b85252f081581a8f257545ed748062dce7798bJohannes Berg		if (rc)
718f3b85252f081581a8f257545ed748062dce7798bJohannes Berg			ieee80211_scan_completed(&local->hw, true);
719f3b85252f081581a8f257545ed748062dce7798bJohannes Berg		return;
720f3b85252f081581a8f257545ed748062dce7798bJohannes Berg	}
721f3b85252f081581a8f257545ed748062dce7798bJohannes Berg
722f3b85252f081581a8f257545ed748062dce7798bJohannes Berg	mutex_unlock(&local->scan_mtx);
723f3b85252f081581a8f257545ed748062dce7798bJohannes Berg
7245bc75728fd43bb15b46f16ef465bcf9d487393cfJohannes Berg	/*
7255bc75728fd43bb15b46f16ef465bcf9d487393cfJohannes Berg	 * Avoid re-scheduling when the sdata is going away.
7265bc75728fd43bb15b46f16ef465bcf9d487393cfJohannes Berg	 */
727f3b85252f081581a8f257545ed748062dce7798bJohannes Berg	if (!netif_running(sdata->dev)) {
728f3b85252f081581a8f257545ed748062dce7798bJohannes Berg		ieee80211_scan_completed(&local->hw, true);
7290a51b27e956bd9580296c48191b78175ed8b5971Johannes Berg		return;
730f3b85252f081581a8f257545ed748062dce7798bJohannes Berg	}
7310a51b27e956bd9580296c48191b78175ed8b5971Johannes Berg
732f502d09b750437a4ec9c63333acf1070fe7958afHelmut Schaa	/*
733f502d09b750437a4ec9c63333acf1070fe7958afHelmut Schaa	 * as long as no delay is required advance immediately
734f502d09b750437a4ec9c63333acf1070fe7958afHelmut Schaa	 * without scheduling a new work
735f502d09b750437a4ec9c63333acf1070fe7958afHelmut Schaa	 */
736f502d09b750437a4ec9c63333acf1070fe7958afHelmut Schaa	do {
737977923b00c79185c11b4b47664f5ffa4c3820438Helmut Schaa		switch (local->next_scan_state) {
7382fb3f028a9a46bd344329766257699b4acb36525Helmut Schaa		case SCAN_DECISION:
7392fb3f028a9a46bd344329766257699b4acb36525Helmut Schaa			if (ieee80211_scan_state_decision(local, &next_delay))
740f502d09b750437a4ec9c63333acf1070fe7958afHelmut Schaa				return;
741f502d09b750437a4ec9c63333acf1070fe7958afHelmut Schaa			break;
7422fb3f028a9a46bd344329766257699b4acb36525Helmut Schaa		case SCAN_SET_CHANNEL:
7432fb3f028a9a46bd344329766257699b4acb36525Helmut Schaa			ieee80211_scan_state_set_channel(local, &next_delay);
7442fb3f028a9a46bd344329766257699b4acb36525Helmut Schaa			break;
745f502d09b750437a4ec9c63333acf1070fe7958afHelmut Schaa		case SCAN_SEND_PROBE:
746f502d09b750437a4ec9c63333acf1070fe7958afHelmut Schaa			ieee80211_scan_state_send_probe(local, &next_delay);
747f502d09b750437a4ec9c63333acf1070fe7958afHelmut Schaa			break;
748142b9f5074dc0d09dc0025739ad437723d7bf527Helmut Schaa		case SCAN_LEAVE_OPER_CHANNEL:
749142b9f5074dc0d09dc0025739ad437723d7bf527Helmut Schaa			ieee80211_scan_state_leave_oper_channel(local, &next_delay);
750142b9f5074dc0d09dc0025739ad437723d7bf527Helmut Schaa			break;
751142b9f5074dc0d09dc0025739ad437723d7bf527Helmut Schaa		case SCAN_ENTER_OPER_CHANNEL:
752142b9f5074dc0d09dc0025739ad437723d7bf527Helmut Schaa			ieee80211_scan_state_enter_oper_channel(local, &next_delay);
753142b9f5074dc0d09dc0025739ad437723d7bf527Helmut Schaa			break;
754f502d09b750437a4ec9c63333acf1070fe7958afHelmut Schaa		}
755f502d09b750437a4ec9c63333acf1070fe7958afHelmut Schaa	} while (next_delay == 0);
7560a51b27e956bd9580296c48191b78175ed8b5971Johannes Berg
75742935ecaf4e784d0815afa9a7e5fe7e141157ca3Luis R. Rodriguez	ieee80211_queue_delayed_work(&local->hw, &local->scan_work, next_delay);
7580a51b27e956bd9580296c48191b78175ed8b5971Johannes Berg}
7590a51b27e956bd9580296c48191b78175ed8b5971Johannes Berg
760f3b85252f081581a8f257545ed748062dce7798bJohannes Bergint ieee80211_request_scan(struct ieee80211_sub_if_data *sdata,
761f3b85252f081581a8f257545ed748062dce7798bJohannes Berg			   struct cfg80211_scan_request *req)
7620a51b27e956bd9580296c48191b78175ed8b5971Johannes Berg{
763f3b85252f081581a8f257545ed748062dce7798bJohannes Berg	int res;
764de95a54b1aebe5592cae971ca5e5d9ec6a381a17Johannes Berg
765f3b85252f081581a8f257545ed748062dce7798bJohannes Berg	mutex_lock(&sdata->local->scan_mtx);
766f3b85252f081581a8f257545ed748062dce7798bJohannes Berg	res = __ieee80211_start_scan(sdata, req);
767f3b85252f081581a8f257545ed748062dce7798bJohannes Berg	mutex_unlock(&sdata->local->scan_mtx);
7680a51b27e956bd9580296c48191b78175ed8b5971Johannes Berg
769f3b85252f081581a8f257545ed748062dce7798bJohannes Berg	return res;
7700a51b27e956bd9580296c48191b78175ed8b5971Johannes Berg}
7710a51b27e956bd9580296c48191b78175ed8b5971Johannes Berg
772f3b85252f081581a8f257545ed748062dce7798bJohannes Bergint ieee80211_request_internal_scan(struct ieee80211_sub_if_data *sdata,
773f3b85252f081581a8f257545ed748062dce7798bJohannes Berg				    const u8 *ssid, u8 ssid_len)
7740a51b27e956bd9580296c48191b78175ed8b5971Johannes Berg{
7750a51b27e956bd9580296c48191b78175ed8b5971Johannes Berg	struct ieee80211_local *local = sdata->local;
776f3b85252f081581a8f257545ed748062dce7798bJohannes Berg	int ret = -EBUSY;
7772a5193119269062608582418deba7af82844159aJohannes Berg
778f3b85252f081581a8f257545ed748062dce7798bJohannes Berg	mutex_lock(&local->scan_mtx);
7790a51b27e956bd9580296c48191b78175ed8b5971Johannes Berg
780f3b85252f081581a8f257545ed748062dce7798bJohannes Berg	/* busy scanning */
781f3b85252f081581a8f257545ed748062dce7798bJohannes Berg	if (local->scan_req)
782f3b85252f081581a8f257545ed748062dce7798bJohannes Berg		goto unlock;
7839116dd01120e249dc2e84e6edecd7ad7f828680fJohannes Berg
7845ba63533bbf653631faab60f6988506160ec6ba4Johannes Berg	memcpy(local->int_scan_req->ssids[0].ssid, ssid, IEEE80211_MAX_SSID_LEN);
7855ba63533bbf653631faab60f6988506160ec6ba4Johannes Berg	local->int_scan_req->ssids[0].ssid_len = ssid_len;
7869116dd01120e249dc2e84e6edecd7ad7f828680fJohannes Berg
7875ba63533bbf653631faab60f6988506160ec6ba4Johannes Berg	ret = __ieee80211_start_scan(sdata, sdata->local->int_scan_req);
788f3b85252f081581a8f257545ed748062dce7798bJohannes Berg unlock:
789f3b85252f081581a8f257545ed748062dce7798bJohannes Berg	mutex_unlock(&local->scan_mtx);
790f3b85252f081581a8f257545ed748062dce7798bJohannes Berg	return ret;
7910a51b27e956bd9580296c48191b78175ed8b5971Johannes Berg}
7925bb644a0fd25a5e083ecbfaa92a211db99aa6ef7Johannes Berg
7935bb644a0fd25a5e083ecbfaa92a211db99aa6ef7Johannes Bergvoid ieee80211_scan_cancel(struct ieee80211_local *local)
7945bb644a0fd25a5e083ecbfaa92a211db99aa6ef7Johannes Berg{
79515db0b7fd872b0312033666d3a82e1214a227ec0Johannes Berg	bool abortscan;
7965bb644a0fd25a5e083ecbfaa92a211db99aa6ef7Johannes Berg
7975bb644a0fd25a5e083ecbfaa92a211db99aa6ef7Johannes Berg	cancel_delayed_work_sync(&local->scan_work);
7985bb644a0fd25a5e083ecbfaa92a211db99aa6ef7Johannes Berg
7995bb644a0fd25a5e083ecbfaa92a211db99aa6ef7Johannes Berg	/*
8005bb644a0fd25a5e083ecbfaa92a211db99aa6ef7Johannes Berg	 * Only call this function when a scan can't be
8015bb644a0fd25a5e083ecbfaa92a211db99aa6ef7Johannes Berg	 * queued -- mostly at suspend under RTNL.
8025bb644a0fd25a5e083ecbfaa92a211db99aa6ef7Johannes Berg	 */
8035bb644a0fd25a5e083ecbfaa92a211db99aa6ef7Johannes Berg	mutex_lock(&local->scan_mtx);
80415db0b7fd872b0312033666d3a82e1214a227ec0Johannes Berg	abortscan = test_bit(SCAN_SW_SCANNING, &local->scanning) ||
80515db0b7fd872b0312033666d3a82e1214a227ec0Johannes Berg		    (!local->scanning && local->scan_req);
8065bb644a0fd25a5e083ecbfaa92a211db99aa6ef7Johannes Berg	mutex_unlock(&local->scan_mtx);
8075bb644a0fd25a5e083ecbfaa92a211db99aa6ef7Johannes Berg
80815db0b7fd872b0312033666d3a82e1214a227ec0Johannes Berg	if (abortscan)
8095bb644a0fd25a5e083ecbfaa92a211db99aa6ef7Johannes Berg		ieee80211_scan_completed(&local->hw, true);
8105bb644a0fd25a5e083ecbfaa92a211db99aa6ef7Johannes Berg}
811