scan.c revision de2ee84db6a0201278e35590821cd014cb71830a
10a51b27e956bd9580296c48191b78175ed8b5971Johannes Berg/*
25484e23749e78d5a4f56928efaf3c4b0d862b7a6Johannes Berg * Scanning implementation
35484e23749e78d5a4f56928efaf3c4b0d862b7a6Johannes Berg *
40a51b27e956bd9580296c48191b78175ed8b5971Johannes Berg * Copyright 2003, Jouni Malinen <jkmaline@cc.hut.fi>
50a51b27e956bd9580296c48191b78175ed8b5971Johannes Berg * Copyright 2004, Instant802 Networks, Inc.
60a51b27e956bd9580296c48191b78175ed8b5971Johannes Berg * Copyright 2005, Devicescape Software, Inc.
70a51b27e956bd9580296c48191b78175ed8b5971Johannes Berg * Copyright 2006-2007	Jiri Benc <jbenc@suse.cz>
80a51b27e956bd9580296c48191b78175ed8b5971Johannes Berg * Copyright 2007, Michael Wu <flamingice@sourmilk.net>
90a51b27e956bd9580296c48191b78175ed8b5971Johannes Berg *
100a51b27e956bd9580296c48191b78175ed8b5971Johannes Berg * This program is free software; you can redistribute it and/or modify
110a51b27e956bd9580296c48191b78175ed8b5971Johannes Berg * it under the terms of the GNU General Public License version 2 as
120a51b27e956bd9580296c48191b78175ed8b5971Johannes Berg * published by the Free Software Foundation.
130a51b27e956bd9580296c48191b78175ed8b5971Johannes Berg */
140a51b27e956bd9580296c48191b78175ed8b5971Johannes Berg
150a51b27e956bd9580296c48191b78175ed8b5971Johannes Berg#include <linux/if_arp.h>
16078e1e60dd6c6b0d4bc8d58ccb80c008e8efc9ffJohannes Berg#include <linux/rtnetlink.h>
17e8db0be1245de16a6cc6365506abc392c3c212d4Jean Pihet#include <linux/pm_qos.h>
18df13cce53a7b28a81460e6bfc4857e9df4956141Helmut Schaa#include <net/sch_generic.h>
195a0e3ad6af8660be21ca98a971cd00f331318c05Tejun Heo#include <linux/slab.h>
20bc3b2d7fb9b014d75ebb79ba371a763dbab5e8cfPaul Gortmaker#include <linux/export.h>
210a51b27e956bd9580296c48191b78175ed8b5971Johannes Berg#include <net/mac80211.h>
220a51b27e956bd9580296c48191b78175ed8b5971Johannes Berg
230a51b27e956bd9580296c48191b78175ed8b5971Johannes Berg#include "ieee80211_i.h"
242448798133d747ad339e57099e32a1d1e68aca1cJohannes Berg#include "driver-ops.h"
255484e23749e78d5a4f56928efaf3c4b0d862b7a6Johannes Berg#include "mesh.h"
260a51b27e956bd9580296c48191b78175ed8b5971Johannes Berg
270a51b27e956bd9580296c48191b78175ed8b5971Johannes Berg#define IEEE80211_PROBE_DELAY (HZ / 33)
280a51b27e956bd9580296c48191b78175ed8b5971Johannes Berg#define IEEE80211_CHANNEL_TIME (HZ / 33)
2996f7e73938da744e718ce4817dd3e7e424624654Helmut Schaa#define IEEE80211_PASSIVE_CHANNEL_TIME (HZ / 8)
300a51b27e956bd9580296c48191b78175ed8b5971Johannes Berg
31c2b13452b283f9c4a5b02a6b53ed6416ebf4c03cJohannes Bergstruct ieee80211_bss *
325484e23749e78d5a4f56928efaf3c4b0d862b7a6Johannes Bergieee80211_rx_bss_get(struct ieee80211_local *local, u8 *bssid, int freq,
335484e23749e78d5a4f56928efaf3c4b0d862b7a6Johannes Berg		     u8 *ssid, u8 ssid_len)
345484e23749e78d5a4f56928efaf3c4b0d862b7a6Johannes Berg{
350c1ad2cac1cb54db38fd4cc1822965071ee83f6eJohannes Berg	struct cfg80211_bss *cbss;
360c1ad2cac1cb54db38fd4cc1822965071ee83f6eJohannes Berg
370c1ad2cac1cb54db38fd4cc1822965071ee83f6eJohannes Berg	cbss = cfg80211_get_bss(local->hw.wiphy,
380c1ad2cac1cb54db38fd4cc1822965071ee83f6eJohannes Berg				ieee80211_get_channel(local->hw.wiphy, freq),
390c1ad2cac1cb54db38fd4cc1822965071ee83f6eJohannes Berg				bssid, ssid, ssid_len, 0, 0);
400c1ad2cac1cb54db38fd4cc1822965071ee83f6eJohannes Berg	if (!cbss)
410c1ad2cac1cb54db38fd4cc1822965071ee83f6eJohannes Berg		return NULL;
420c1ad2cac1cb54db38fd4cc1822965071ee83f6eJohannes Berg	return (void *)cbss->priv;
435484e23749e78d5a4f56928efaf3c4b0d862b7a6Johannes Berg}
445484e23749e78d5a4f56928efaf3c4b0d862b7a6Johannes Berg
4500d3f14cf9f12c21428121026a5e1d5f65926447Johannes Bergstatic void ieee80211_rx_bss_free(struct cfg80211_bss *cbss)
465484e23749e78d5a4f56928efaf3c4b0d862b7a6Johannes Berg{
470c1ad2cac1cb54db38fd4cc1822965071ee83f6eJohannes Berg	struct ieee80211_bss *bss = (void *)cbss->priv;
485484e23749e78d5a4f56928efaf3c4b0d862b7a6Johannes Berg
495484e23749e78d5a4f56928efaf3c4b0d862b7a6Johannes Berg	kfree(bss_mesh_id(bss));
505484e23749e78d5a4f56928efaf3c4b0d862b7a6Johannes Berg	kfree(bss_mesh_cfg(bss));
515484e23749e78d5a4f56928efaf3c4b0d862b7a6Johannes Berg}
525484e23749e78d5a4f56928efaf3c4b0d862b7a6Johannes Berg
535484e23749e78d5a4f56928efaf3c4b0d862b7a6Johannes Bergvoid ieee80211_rx_bss_put(struct ieee80211_local *local,
54c2b13452b283f9c4a5b02a6b53ed6416ebf4c03cJohannes Berg			  struct ieee80211_bss *bss)
555484e23749e78d5a4f56928efaf3c4b0d862b7a6Johannes Berg{
560c1ad2cac1cb54db38fd4cc1822965071ee83f6eJohannes Berg	if (!bss)
570c1ad2cac1cb54db38fd4cc1822965071ee83f6eJohannes Berg		return;
580c1ad2cac1cb54db38fd4cc1822965071ee83f6eJohannes Berg	cfg80211_put_bss(container_of((void *)bss, struct cfg80211_bss, priv));
595484e23749e78d5a4f56928efaf3c4b0d862b7a6Johannes Berg}
605484e23749e78d5a4f56928efaf3c4b0d862b7a6Johannes Berg
61ab13315af97919fae0e014748105fdc2e30afb2dKalle Valostatic bool is_uapsd_supported(struct ieee802_11_elems *elems)
62ab13315af97919fae0e014748105fdc2e30afb2dKalle Valo{
63ab13315af97919fae0e014748105fdc2e30afb2dKalle Valo	u8 qos_info;
64ab13315af97919fae0e014748105fdc2e30afb2dKalle Valo
65ab13315af97919fae0e014748105fdc2e30afb2dKalle Valo	if (elems->wmm_info && elems->wmm_info_len == 7
66ab13315af97919fae0e014748105fdc2e30afb2dKalle Valo	    && elems->wmm_info[5] == 1)
67ab13315af97919fae0e014748105fdc2e30afb2dKalle Valo		qos_info = elems->wmm_info[6];
68ab13315af97919fae0e014748105fdc2e30afb2dKalle Valo	else if (elems->wmm_param && elems->wmm_param_len == 24
69ab13315af97919fae0e014748105fdc2e30afb2dKalle Valo		 && elems->wmm_param[5] == 1)
70ab13315af97919fae0e014748105fdc2e30afb2dKalle Valo		qos_info = elems->wmm_param[6];
71ab13315af97919fae0e014748105fdc2e30afb2dKalle Valo	else
72ab13315af97919fae0e014748105fdc2e30afb2dKalle Valo		/* no valid wmm information or parameter element found */
73ab13315af97919fae0e014748105fdc2e30afb2dKalle Valo		return false;
74ab13315af97919fae0e014748105fdc2e30afb2dKalle Valo
75ab13315af97919fae0e014748105fdc2e30afb2dKalle Valo	return qos_info & IEEE80211_WMM_IE_AP_QOSINFO_UAPSD;
76ab13315af97919fae0e014748105fdc2e30afb2dKalle Valo}
77ab13315af97919fae0e014748105fdc2e30afb2dKalle Valo
78c2b13452b283f9c4a5b02a6b53ed6416ebf4c03cJohannes Bergstruct ieee80211_bss *
795484e23749e78d5a4f56928efaf3c4b0d862b7a6Johannes Bergieee80211_bss_info_update(struct ieee80211_local *local,
805484e23749e78d5a4f56928efaf3c4b0d862b7a6Johannes Berg			  struct ieee80211_rx_status *rx_status,
815484e23749e78d5a4f56928efaf3c4b0d862b7a6Johannes Berg			  struct ieee80211_mgmt *mgmt,
825484e23749e78d5a4f56928efaf3c4b0d862b7a6Johannes Berg			  size_t len,
835484e23749e78d5a4f56928efaf3c4b0d862b7a6Johannes Berg			  struct ieee802_11_elems *elems,
842a5193119269062608582418deba7af82844159aJohannes Berg			  struct ieee80211_channel *channel,
852a5193119269062608582418deba7af82844159aJohannes Berg			  bool beacon)
865484e23749e78d5a4f56928efaf3c4b0d862b7a6Johannes Berg{
870c1ad2cac1cb54db38fd4cc1822965071ee83f6eJohannes Berg	struct cfg80211_bss *cbss;
88c2b13452b283f9c4a5b02a6b53ed6416ebf4c03cJohannes Berg	struct ieee80211_bss *bss;
89f0b058b61711ebf5be94d6865ca7b2c259b71d37Stanislaw Gruszka	int clen, srlen;
902a5193119269062608582418deba7af82844159aJohannes Berg	s32 signal = 0;
912a5193119269062608582418deba7af82844159aJohannes Berg
9277965c970d7da9c9b6349ff2b1d9adecf54c403bJohannes Berg	if (local->hw.flags & IEEE80211_HW_SIGNAL_DBM)
932a5193119269062608582418deba7af82844159aJohannes Berg		signal = rx_status->signal * 100;
9477965c970d7da9c9b6349ff2b1d9adecf54c403bJohannes Berg	else if (local->hw.flags & IEEE80211_HW_SIGNAL_UNSPEC)
952a5193119269062608582418deba7af82844159aJohannes Berg		signal = (rx_status->signal * 100) / local->hw.max_signal;
962a5193119269062608582418deba7af82844159aJohannes Berg
970c1ad2cac1cb54db38fd4cc1822965071ee83f6eJohannes Berg	cbss = cfg80211_inform_bss_frame(local->hw.wiphy, channel,
980c1ad2cac1cb54db38fd4cc1822965071ee83f6eJohannes Berg					 mgmt, len, signal, GFP_ATOMIC);
995484e23749e78d5a4f56928efaf3c4b0d862b7a6Johannes Berg
1000c1ad2cac1cb54db38fd4cc1822965071ee83f6eJohannes Berg	if (!cbss)
10100d3f14cf9f12c21428121026a5e1d5f65926447Johannes Berg		return NULL;
10200d3f14cf9f12c21428121026a5e1d5f65926447Johannes Berg
1030c1ad2cac1cb54db38fd4cc1822965071ee83f6eJohannes Berg	cbss->free_priv = ieee80211_rx_bss_free;
1040c1ad2cac1cb54db38fd4cc1822965071ee83f6eJohannes Berg	bss = (void *)cbss->priv;
1055484e23749e78d5a4f56928efaf3c4b0d862b7a6Johannes Berg
1065484e23749e78d5a4f56928efaf3c4b0d862b7a6Johannes Berg	/* save the ERP value so that it is available at association time */
1075484e23749e78d5a4f56928efaf3c4b0d862b7a6Johannes Berg	if (elems->erp_info && elems->erp_info_len >= 1) {
1085484e23749e78d5a4f56928efaf3c4b0d862b7a6Johannes Berg		bss->erp_value = elems->erp_info[0];
1095484e23749e78d5a4f56928efaf3c4b0d862b7a6Johannes Berg		bss->has_erp_value = 1;
1105484e23749e78d5a4f56928efaf3c4b0d862b7a6Johannes Berg	}
1115484e23749e78d5a4f56928efaf3c4b0d862b7a6Johannes Berg
1125484e23749e78d5a4f56928efaf3c4b0d862b7a6Johannes Berg	if (elems->tim) {
1135484e23749e78d5a4f56928efaf3c4b0d862b7a6Johannes Berg		struct ieee80211_tim_ie *tim_ie =
1145484e23749e78d5a4f56928efaf3c4b0d862b7a6Johannes Berg			(struct ieee80211_tim_ie *)elems->tim;
1155484e23749e78d5a4f56928efaf3c4b0d862b7a6Johannes Berg		bss->dtim_period = tim_ie->dtim_period;
1165484e23749e78d5a4f56928efaf3c4b0d862b7a6Johannes Berg	}
1175484e23749e78d5a4f56928efaf3c4b0d862b7a6Johannes Berg
118e5b900d228b76d445a4240d9aeb3cd8f79205a91Johannes Berg	/* If the beacon had no TIM IE, or it was invalid, use 1 */
119e5b900d228b76d445a4240d9aeb3cd8f79205a91Johannes Berg	if (beacon && !bss->dtim_period)
120e5b900d228b76d445a4240d9aeb3cd8f79205a91Johannes Berg		bss->dtim_period = 1;
121e5b900d228b76d445a4240d9aeb3cd8f79205a91Johannes Berg
122f0b058b61711ebf5be94d6865ca7b2c259b71d37Stanislaw Gruszka	/* replace old supported rates if we get new values */
123f0b058b61711ebf5be94d6865ca7b2c259b71d37Stanislaw Gruszka	srlen = 0;
1245484e23749e78d5a4f56928efaf3c4b0d862b7a6Johannes Berg	if (elems->supp_rates) {
125f0b058b61711ebf5be94d6865ca7b2c259b71d37Stanislaw Gruszka		clen = IEEE80211_MAX_SUPP_RATES;
1265484e23749e78d5a4f56928efaf3c4b0d862b7a6Johannes Berg		if (clen > elems->supp_rates_len)
1275484e23749e78d5a4f56928efaf3c4b0d862b7a6Johannes Berg			clen = elems->supp_rates_len;
128f0b058b61711ebf5be94d6865ca7b2c259b71d37Stanislaw Gruszka		memcpy(bss->supp_rates, elems->supp_rates, clen);
129f0b058b61711ebf5be94d6865ca7b2c259b71d37Stanislaw Gruszka		srlen += clen;
1305484e23749e78d5a4f56928efaf3c4b0d862b7a6Johannes Berg	}
1315484e23749e78d5a4f56928efaf3c4b0d862b7a6Johannes Berg	if (elems->ext_supp_rates) {
132f0b058b61711ebf5be94d6865ca7b2c259b71d37Stanislaw Gruszka		clen = IEEE80211_MAX_SUPP_RATES - srlen;
1335484e23749e78d5a4f56928efaf3c4b0d862b7a6Johannes Berg		if (clen > elems->ext_supp_rates_len)
1345484e23749e78d5a4f56928efaf3c4b0d862b7a6Johannes Berg			clen = elems->ext_supp_rates_len;
135f0b058b61711ebf5be94d6865ca7b2c259b71d37Stanislaw Gruszka		memcpy(bss->supp_rates + srlen, elems->ext_supp_rates, clen);
136f0b058b61711ebf5be94d6865ca7b2c259b71d37Stanislaw Gruszka		srlen += clen;
1375484e23749e78d5a4f56928efaf3c4b0d862b7a6Johannes Berg	}
138f0b058b61711ebf5be94d6865ca7b2c259b71d37Stanislaw Gruszka	if (srlen)
139f0b058b61711ebf5be94d6865ca7b2c259b71d37Stanislaw Gruszka		bss->supp_rates_len = srlen;
1405484e23749e78d5a4f56928efaf3c4b0d862b7a6Johannes Berg
1415484e23749e78d5a4f56928efaf3c4b0d862b7a6Johannes Berg	bss->wmm_used = elems->wmm_param || elems->wmm_info;
142ab13315af97919fae0e014748105fdc2e30afb2dKalle Valo	bss->uapsd_supported = is_uapsd_supported(elems);
1435484e23749e78d5a4f56928efaf3c4b0d862b7a6Johannes Berg
1445484e23749e78d5a4f56928efaf3c4b0d862b7a6Johannes Berg	if (!beacon)
1455484e23749e78d5a4f56928efaf3c4b0d862b7a6Johannes Berg		bss->last_probe_resp = jiffies;
1465484e23749e78d5a4f56928efaf3c4b0d862b7a6Johannes Berg
1475484e23749e78d5a4f56928efaf3c4b0d862b7a6Johannes Berg	return bss;
1485484e23749e78d5a4f56928efaf3c4b0d862b7a6Johannes Berg}
1490a51b27e956bd9580296c48191b78175ed8b5971Johannes Berg
15098c8fccfaea838e62ffde2f2e44568844e0e5472Johannes Bergieee80211_rx_result
151f1d58c2521eb160178b2151d6326d8dc5d7c8560Johannes Bergieee80211_scan_rx(struct ieee80211_sub_if_data *sdata, struct sk_buff *skb)
15298c8fccfaea838e62ffde2f2e44568844e0e5472Johannes Berg{
153f1d58c2521eb160178b2151d6326d8dc5d7c8560Johannes Berg	struct ieee80211_rx_status *rx_status = IEEE80211_SKB_RXCB(skb);
15498c8fccfaea838e62ffde2f2e44568844e0e5472Johannes Berg	struct ieee80211_mgmt *mgmt;
155c2b13452b283f9c4a5b02a6b53ed6416ebf4c03cJohannes Berg	struct ieee80211_bss *bss;
15698c8fccfaea838e62ffde2f2e44568844e0e5472Johannes Berg	u8 *elements;
15798c8fccfaea838e62ffde2f2e44568844e0e5472Johannes Berg	struct ieee80211_channel *channel;
15898c8fccfaea838e62ffde2f2e44568844e0e5472Johannes Berg	size_t baselen;
15998c8fccfaea838e62ffde2f2e44568844e0e5472Johannes Berg	int freq;
16098c8fccfaea838e62ffde2f2e44568844e0e5472Johannes Berg	__le16 fc;
16198c8fccfaea838e62ffde2f2e44568844e0e5472Johannes Berg	bool presp, beacon = false;
16298c8fccfaea838e62ffde2f2e44568844e0e5472Johannes Berg	struct ieee802_11_elems elems;
16398c8fccfaea838e62ffde2f2e44568844e0e5472Johannes Berg
16498c8fccfaea838e62ffde2f2e44568844e0e5472Johannes Berg	if (skb->len < 2)
16598c8fccfaea838e62ffde2f2e44568844e0e5472Johannes Berg		return RX_DROP_UNUSABLE;
16698c8fccfaea838e62ffde2f2e44568844e0e5472Johannes Berg
16798c8fccfaea838e62ffde2f2e44568844e0e5472Johannes Berg	mgmt = (struct ieee80211_mgmt *) skb->data;
16898c8fccfaea838e62ffde2f2e44568844e0e5472Johannes Berg	fc = mgmt->frame_control;
16998c8fccfaea838e62ffde2f2e44568844e0e5472Johannes Berg
17098c8fccfaea838e62ffde2f2e44568844e0e5472Johannes Berg	if (ieee80211_is_ctl(fc))
17198c8fccfaea838e62ffde2f2e44568844e0e5472Johannes Berg		return RX_CONTINUE;
17298c8fccfaea838e62ffde2f2e44568844e0e5472Johannes Berg
17398c8fccfaea838e62ffde2f2e44568844e0e5472Johannes Berg	if (skb->len < 24)
174306fe9384f06d31219778cece2d3c646146e7bb6Luciano Coelho		return RX_CONTINUE;
17598c8fccfaea838e62ffde2f2e44568844e0e5472Johannes Berg
17698c8fccfaea838e62ffde2f2e44568844e0e5472Johannes Berg	presp = ieee80211_is_probe_resp(fc);
17798c8fccfaea838e62ffde2f2e44568844e0e5472Johannes Berg	if (presp) {
17898c8fccfaea838e62ffde2f2e44568844e0e5472Johannes Berg		/* ignore ProbeResp to foreign address */
17947846c9b0c10808d9337d2e7d09361f3e0a0a71aJohannes Berg		if (memcmp(mgmt->da, sdata->vif.addr, ETH_ALEN))
18098c8fccfaea838e62ffde2f2e44568844e0e5472Johannes Berg			return RX_DROP_MONITOR;
18198c8fccfaea838e62ffde2f2e44568844e0e5472Johannes Berg
18298c8fccfaea838e62ffde2f2e44568844e0e5472Johannes Berg		presp = true;
18398c8fccfaea838e62ffde2f2e44568844e0e5472Johannes Berg		elements = mgmt->u.probe_resp.variable;
18498c8fccfaea838e62ffde2f2e44568844e0e5472Johannes Berg		baselen = offsetof(struct ieee80211_mgmt, u.probe_resp.variable);
18598c8fccfaea838e62ffde2f2e44568844e0e5472Johannes Berg	} else {
18698c8fccfaea838e62ffde2f2e44568844e0e5472Johannes Berg		beacon = ieee80211_is_beacon(fc);
18798c8fccfaea838e62ffde2f2e44568844e0e5472Johannes Berg		baselen = offsetof(struct ieee80211_mgmt, u.beacon.variable);
18898c8fccfaea838e62ffde2f2e44568844e0e5472Johannes Berg		elements = mgmt->u.beacon.variable;
18998c8fccfaea838e62ffde2f2e44568844e0e5472Johannes Berg	}
19098c8fccfaea838e62ffde2f2e44568844e0e5472Johannes Berg
19198c8fccfaea838e62ffde2f2e44568844e0e5472Johannes Berg	if (!presp && !beacon)
19298c8fccfaea838e62ffde2f2e44568844e0e5472Johannes Berg		return RX_CONTINUE;
19398c8fccfaea838e62ffde2f2e44568844e0e5472Johannes Berg
19498c8fccfaea838e62ffde2f2e44568844e0e5472Johannes Berg	if (baselen > skb->len)
19598c8fccfaea838e62ffde2f2e44568844e0e5472Johannes Berg		return RX_DROP_MONITOR;
19698c8fccfaea838e62ffde2f2e44568844e0e5472Johannes Berg
19798c8fccfaea838e62ffde2f2e44568844e0e5472Johannes Berg	ieee802_11_parse_elems(elements, skb->len - baselen, &elems);
19898c8fccfaea838e62ffde2f2e44568844e0e5472Johannes Berg
19998c8fccfaea838e62ffde2f2e44568844e0e5472Johannes Berg	if (elems.ds_params && elems.ds_params_len == 1)
20059eb21a6504731fc16db4cf9463065dd61093e08Bruno Randolf		freq = ieee80211_channel_to_frequency(elems.ds_params[0],
20159eb21a6504731fc16db4cf9463065dd61093e08Bruno Randolf						      rx_status->band);
20298c8fccfaea838e62ffde2f2e44568844e0e5472Johannes Berg	else
20398c8fccfaea838e62ffde2f2e44568844e0e5472Johannes Berg		freq = rx_status->freq;
20498c8fccfaea838e62ffde2f2e44568844e0e5472Johannes Berg
20598c8fccfaea838e62ffde2f2e44568844e0e5472Johannes Berg	channel = ieee80211_get_channel(sdata->local->hw.wiphy, freq);
20698c8fccfaea838e62ffde2f2e44568844e0e5472Johannes Berg
20798c8fccfaea838e62ffde2f2e44568844e0e5472Johannes Berg	if (!channel || channel->flags & IEEE80211_CHAN_DISABLED)
20898c8fccfaea838e62ffde2f2e44568844e0e5472Johannes Berg		return RX_DROP_MONITOR;
20998c8fccfaea838e62ffde2f2e44568844e0e5472Johannes Berg
21098c8fccfaea838e62ffde2f2e44568844e0e5472Johannes Berg	bss = ieee80211_bss_info_update(sdata->local, rx_status,
21198c8fccfaea838e62ffde2f2e44568844e0e5472Johannes Berg					mgmt, skb->len, &elems,
2122a5193119269062608582418deba7af82844159aJohannes Berg					channel, beacon);
213d048e503a2b01e771ee87921c24d89d7ec3f0c2fJouni Malinen	if (bss)
214d048e503a2b01e771ee87921c24d89d7ec3f0c2fJouni Malinen		ieee80211_rx_bss_put(sdata->local, bss);
21598c8fccfaea838e62ffde2f2e44568844e0e5472Johannes Berg
21607ef03ee8b280a536b38ccfe512b9556996f0492Johannes Berg	if (channel == sdata->local->oper_channel)
217b23b025fe246f3acc2988eb6d400df34c27cb8aeBen Greear		return RX_CONTINUE;
218b23b025fe246f3acc2988eb6d400df34c27cb8aeBen Greear
21998c8fccfaea838e62ffde2f2e44568844e0e5472Johannes Berg	dev_kfree_skb(skb);
22098c8fccfaea838e62ffde2f2e44568844e0e5472Johannes Berg	return RX_QUEUED;
22198c8fccfaea838e62ffde2f2e44568844e0e5472Johannes Berg}
22298c8fccfaea838e62ffde2f2e44568844e0e5472Johannes Berg
2234d36ec58239eec44d77839ef6c25108efcbbb58cJohannes Berg/* return false if no more work */
2244d36ec58239eec44d77839ef6c25108efcbbb58cJohannes Bergstatic bool ieee80211_prep_hw_scan(struct ieee80211_local *local)
2254d36ec58239eec44d77839ef6c25108efcbbb58cJohannes Berg{
2264d36ec58239eec44d77839ef6c25108efcbbb58cJohannes Berg	struct cfg80211_scan_request *req = local->scan_req;
2274d36ec58239eec44d77839ef6c25108efcbbb58cJohannes Berg	enum ieee80211_band band;
2284d36ec58239eec44d77839ef6c25108efcbbb58cJohannes Berg	int i, ielen, n_chans;
2294d36ec58239eec44d77839ef6c25108efcbbb58cJohannes Berg
2304d36ec58239eec44d77839ef6c25108efcbbb58cJohannes Berg	do {
2314d36ec58239eec44d77839ef6c25108efcbbb58cJohannes Berg		if (local->hw_scan_band == IEEE80211_NUM_BANDS)
2324d36ec58239eec44d77839ef6c25108efcbbb58cJohannes Berg			return false;
2334d36ec58239eec44d77839ef6c25108efcbbb58cJohannes Berg
2344d36ec58239eec44d77839ef6c25108efcbbb58cJohannes Berg		band = local->hw_scan_band;
2354d36ec58239eec44d77839ef6c25108efcbbb58cJohannes Berg		n_chans = 0;
2364d36ec58239eec44d77839ef6c25108efcbbb58cJohannes Berg		for (i = 0; i < req->n_channels; i++) {
2374d36ec58239eec44d77839ef6c25108efcbbb58cJohannes Berg			if (req->channels[i]->band == band) {
2384d36ec58239eec44d77839ef6c25108efcbbb58cJohannes Berg				local->hw_scan_req->channels[n_chans] =
2394d36ec58239eec44d77839ef6c25108efcbbb58cJohannes Berg							req->channels[i];
2404d36ec58239eec44d77839ef6c25108efcbbb58cJohannes Berg				n_chans++;
2414d36ec58239eec44d77839ef6c25108efcbbb58cJohannes Berg			}
2424d36ec58239eec44d77839ef6c25108efcbbb58cJohannes Berg		}
2434d36ec58239eec44d77839ef6c25108efcbbb58cJohannes Berg
2444d36ec58239eec44d77839ef6c25108efcbbb58cJohannes Berg		local->hw_scan_band++;
2454d36ec58239eec44d77839ef6c25108efcbbb58cJohannes Berg	} while (!n_chans);
2464d36ec58239eec44d77839ef6c25108efcbbb58cJohannes Berg
2474d36ec58239eec44d77839ef6c25108efcbbb58cJohannes Berg	local->hw_scan_req->n_channels = n_chans;
2484d36ec58239eec44d77839ef6c25108efcbbb58cJohannes Berg
2494d36ec58239eec44d77839ef6c25108efcbbb58cJohannes Berg	ielen = ieee80211_build_preq_ies(local, (u8 *)local->hw_scan_req->ie,
2508ee3108075c9e9e2701493a245a754b8b0db8e57Johannes Berg					 req->ie, req->ie_len, band,
25185a237fe308405ee38eb9c6733571c49902ec229Johannes Berg					 req->rates[band], 0);
2524d36ec58239eec44d77839ef6c25108efcbbb58cJohannes Berg	local->hw_scan_req->ie_len = ielen;
253dcd83976bea3ae3bc0822ed26cf200d9d6203121Johannes Berg	local->hw_scan_req->no_cck = req->no_cck;
2544d36ec58239eec44d77839ef6c25108efcbbb58cJohannes Berg
2554d36ec58239eec44d77839ef6c25108efcbbb58cJohannes Berg	return true;
2564d36ec58239eec44d77839ef6c25108efcbbb58cJohannes Berg}
2574d36ec58239eec44d77839ef6c25108efcbbb58cJohannes Berg
258d07bfd8b6f20a81d7ec65c50f35b053d9e3aa740Johannes Bergstatic void __ieee80211_scan_completed(struct ieee80211_hw *hw, bool aborted,
259e229f844d7223b7063bea1e649203ac521a58fe1Stanislaw Gruszka				       bool was_hw_scan)
2600a51b27e956bd9580296c48191b78175ed8b5971Johannes Berg{
2610a51b27e956bd9580296c48191b78175ed8b5971Johannes Berg	struct ieee80211_local *local = hw_to_local(hw);
2620a51b27e956bd9580296c48191b78175ed8b5971Johannes Berg
263e229f844d7223b7063bea1e649203ac521a58fe1Stanislaw Gruszka	lockdep_assert_held(&local->mtx);
2645bc75728fd43bb15b46f16ef465bcf9d487393cfJohannes Berg
2656d3560d4fc9c5b9fe1a07a63926ea70512c69c32Johannes Berg	/*
2666d3560d4fc9c5b9fe1a07a63926ea70512c69c32Johannes Berg	 * It's ok to abort a not-yet-running scan (that
2676d3560d4fc9c5b9fe1a07a63926ea70512c69c32Johannes Berg	 * we have one at all will be verified by checking
2686d3560d4fc9c5b9fe1a07a63926ea70512c69c32Johannes Berg	 * local->scan_req next), but not to complete it
2696d3560d4fc9c5b9fe1a07a63926ea70512c69c32Johannes Berg	 * successfully.
2706d3560d4fc9c5b9fe1a07a63926ea70512c69c32Johannes Berg	 */
2716d3560d4fc9c5b9fe1a07a63926ea70512c69c32Johannes Berg	if (WARN_ON(!local->scanning && !aborted))
2726d3560d4fc9c5b9fe1a07a63926ea70512c69c32Johannes Berg		aborted = true;
2735bc75728fd43bb15b46f16ef465bcf9d487393cfJohannes Berg
274e229f844d7223b7063bea1e649203ac521a58fe1Stanislaw Gruszka	if (WARN_ON(!local->scan_req))
275d07bfd8b6f20a81d7ec65c50f35b053d9e3aa740Johannes Berg		return;
276de95a54b1aebe5592cae971ca5e5d9ec6a381a17Johannes Berg
2774d36ec58239eec44d77839ef6c25108efcbbb58cJohannes Berg	if (was_hw_scan && !aborted && ieee80211_prep_hw_scan(local)) {
2786eb11a9a311a0f7e5b9b66c18f7498a26c9ec206Stanislaw Gruszka		int rc = drv_hw_scan(local, local->scan_sdata, local->hw_scan_req);
2796eb11a9a311a0f7e5b9b66c18f7498a26c9ec206Stanislaw Gruszka		if (rc == 0)
280d07bfd8b6f20a81d7ec65c50f35b053d9e3aa740Johannes Berg			return;
2814d36ec58239eec44d77839ef6c25108efcbbb58cJohannes Berg	}
2824d36ec58239eec44d77839ef6c25108efcbbb58cJohannes Berg
2834d36ec58239eec44d77839ef6c25108efcbbb58cJohannes Berg	kfree(local->hw_scan_req);
2844d36ec58239eec44d77839ef6c25108efcbbb58cJohannes Berg	local->hw_scan_req = NULL;
285f3b85252f081581a8f257545ed748062dce7798bJohannes Berg
2865ba63533bbf653631faab60f6988506160ec6ba4Johannes Berg	if (local->scan_req != local->int_scan_req)
2872a5193119269062608582418deba7af82844159aJohannes Berg		cfg80211_scan_done(local->scan_req, aborted);
2882a5193119269062608582418deba7af82844159aJohannes Berg	local->scan_req = NULL;
28915db0b7fd872b0312033666d3a82e1214a227ec0Johannes Berg	local->scan_sdata = NULL;
2902a5193119269062608582418deba7af82844159aJohannes Berg
291fbe9c429f195111bbf7f1630efa19aee295fd8e7Helmut Schaa	local->scanning = 0;
29258905ca5b11a0ff3860f55b789cbbf052f7158a7Johannes Berg	local->scan_channel = NULL;
293f3b85252f081581a8f257545ed748062dce7798bJohannes Berg
29407ef03ee8b280a536b38ccfe512b9556996f0492Johannes Berg	/* Set power back to normal operating levels. */
29507ef03ee8b280a536b38ccfe512b9556996f0492Johannes Berg	ieee80211_hw_config(local, 0);
296a0daa0e7592ada797d6835f11529097aabc27ad2Luis R. Rodriguez
297e229f844d7223b7063bea1e649203ac521a58fe1Stanislaw Gruszka	if (!was_hw_scan) {
298e229f844d7223b7063bea1e649203ac521a58fe1Stanislaw Gruszka		ieee80211_configure_filter(local);
299e229f844d7223b7063bea1e649203ac521a58fe1Stanislaw Gruszka		drv_sw_scan_complete(local);
300e76aadc572288a158ae18ae1c10fe395c7bca066Johannes Berg		ieee80211_offchannel_return(local, true);
301e229f844d7223b7063bea1e649203ac521a58fe1Stanislaw Gruszka	}
3020a51b27e956bd9580296c48191b78175ed8b5971Johannes Berg
3035cff20e6c5a6591a79d3b027af222870f52bb550Johannes Berg	ieee80211_recalc_idle(local);
304e229f844d7223b7063bea1e649203ac521a58fe1Stanislaw Gruszka
3050a51b27e956bd9580296c48191b78175ed8b5971Johannes Berg	ieee80211_mlme_notify_scan_completed(local);
306469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg	ieee80211_ibss_notify_scan_completed(local);
307472dbc45dc1966284de72d7de15690c17ed2cf33Johannes Berg	ieee80211_mesh_notify_scan_completed(local);
30881ac3462d346ee7aaf037a35156b0a7a354e98cfJohannes Berg	ieee80211_queue_work(&local->hw, &local->work_work);
3090a51b27e956bd9580296c48191b78175ed8b5971Johannes Berg}
3108789d459bc5e837bf37d261453df96ef54018d7bJohannes Berg
3118789d459bc5e837bf37d261453df96ef54018d7bJohannes Bergvoid ieee80211_scan_completed(struct ieee80211_hw *hw, bool aborted)
3128789d459bc5e837bf37d261453df96ef54018d7bJohannes Berg{
3138789d459bc5e837bf37d261453df96ef54018d7bJohannes Berg	struct ieee80211_local *local = hw_to_local(hw);
3148789d459bc5e837bf37d261453df96ef54018d7bJohannes Berg
3158789d459bc5e837bf37d261453df96ef54018d7bJohannes Berg	trace_api_scan_completed(local, aborted);
3168789d459bc5e837bf37d261453df96ef54018d7bJohannes Berg
3178789d459bc5e837bf37d261453df96ef54018d7bJohannes Berg	set_bit(SCAN_COMPLETED, &local->scanning);
3188789d459bc5e837bf37d261453df96ef54018d7bJohannes Berg	if (aborted)
3198789d459bc5e837bf37d261453df96ef54018d7bJohannes Berg		set_bit(SCAN_ABORTED, &local->scanning);
3208789d459bc5e837bf37d261453df96ef54018d7bJohannes Berg	ieee80211_queue_delayed_work(&local->hw, &local->scan_work, 0);
3218789d459bc5e837bf37d261453df96ef54018d7bJohannes Berg}
3220a51b27e956bd9580296c48191b78175ed8b5971Johannes BergEXPORT_SYMBOL(ieee80211_scan_completed);
3230a51b27e956bd9580296c48191b78175ed8b5971Johannes Berg
324f3b85252f081581a8f257545ed748062dce7798bJohannes Bergstatic int ieee80211_start_sw_scan(struct ieee80211_local *local)
325f3b85252f081581a8f257545ed748062dce7798bJohannes Berg{
326f3b85252f081581a8f257545ed748062dce7798bJohannes Berg	/*
327f3b85252f081581a8f257545ed748062dce7798bJohannes Berg	 * Hardware/driver doesn't support hw_scan, so use software
328f3b85252f081581a8f257545ed748062dce7798bJohannes Berg	 * scanning instead. First send a nullfunc frame with power save
329f3b85252f081581a8f257545ed748062dce7798bJohannes Berg	 * bit on so that AP will buffer the frames for us while we are not
330f3b85252f081581a8f257545ed748062dce7798bJohannes Berg	 * listening, then send probe requests to each channel and wait for
331f3b85252f081581a8f257545ed748062dce7798bJohannes Berg	 * the responses. After all channels are scanned, tune back to the
332f3b85252f081581a8f257545ed748062dce7798bJohannes Berg	 * original channel and send a nullfunc frame with power save bit
333f3b85252f081581a8f257545ed748062dce7798bJohannes Berg	 * off to trigger the AP to send us all the buffered frames.
334f3b85252f081581a8f257545ed748062dce7798bJohannes Berg	 *
335f3b85252f081581a8f257545ed748062dce7798bJohannes Berg	 * Note that while local->sw_scanning is true everything else but
336f3b85252f081581a8f257545ed748062dce7798bJohannes Berg	 * nullfunc frames and probe requests will be dropped in
337f3b85252f081581a8f257545ed748062dce7798bJohannes Berg	 * ieee80211_tx_h_check_assoc().
338f3b85252f081581a8f257545ed748062dce7798bJohannes Berg	 */
3392448798133d747ad339e57099e32a1d1e68aca1cJohannes Berg	drv_sw_scan_start(local);
340f3b85252f081581a8f257545ed748062dce7798bJohannes Berg
341df13cce53a7b28a81460e6bfc4857e9df4956141Helmut Schaa	local->leave_oper_channel_time = 0;
342977923b00c79185c11b4b47664f5ffa4c3820438Helmut Schaa	local->next_scan_state = SCAN_DECISION;
343f3b85252f081581a8f257545ed748062dce7798bJohannes Berg	local->scan_channel_idx = 0;
344f3b85252f081581a8f257545ed748062dce7798bJohannes Berg
34507ef03ee8b280a536b38ccfe512b9556996f0492Johannes Berg	ieee80211_offchannel_stop_vifs(local, true);
346a80f7c0b088187c8471b441d461e937991870661Johannes Berg
3473ac64beecd27400d12cc7afb4108eef26c499f6aJohannes Berg	ieee80211_configure_filter(local);
348f3b85252f081581a8f257545ed748062dce7798bJohannes Berg
34959bdf3b0fe7a183f18ce94696259c4c76abb4568Ben Greear	/* We need to set power level at maximum rate for scanning. */
35059bdf3b0fe7a183f18ce94696259c4c76abb4568Ben Greear	ieee80211_hw_config(local, 0);
35159bdf3b0fe7a183f18ce94696259c4c76abb4568Ben Greear
35242935ecaf4e784d0815afa9a7e5fe7e141157ca3Luis R. Rodriguez	ieee80211_queue_delayed_work(&local->hw,
35307ef03ee8b280a536b38ccfe512b9556996f0492Johannes Berg				     &local->scan_work, 0);
354f3b85252f081581a8f257545ed748062dce7798bJohannes Berg
355f3b85252f081581a8f257545ed748062dce7798bJohannes Berg	return 0;
356f3b85252f081581a8f257545ed748062dce7798bJohannes Berg}
357f3b85252f081581a8f257545ed748062dce7798bJohannes Berg
358f3b85252f081581a8f257545ed748062dce7798bJohannes Berg
359f3b85252f081581a8f257545ed748062dce7798bJohannes Bergstatic int __ieee80211_start_scan(struct ieee80211_sub_if_data *sdata,
360f3b85252f081581a8f257545ed748062dce7798bJohannes Berg				  struct cfg80211_scan_request *req)
361f3b85252f081581a8f257545ed748062dce7798bJohannes Berg{
362f3b85252f081581a8f257545ed748062dce7798bJohannes Berg	struct ieee80211_local *local = sdata->local;
363f3b85252f081581a8f257545ed748062dce7798bJohannes Berg	int rc;
364f3b85252f081581a8f257545ed748062dce7798bJohannes Berg
365e229f844d7223b7063bea1e649203ac521a58fe1Stanislaw Gruszka	lockdep_assert_held(&local->mtx);
366e229f844d7223b7063bea1e649203ac521a58fe1Stanislaw Gruszka
367f3b85252f081581a8f257545ed748062dce7798bJohannes Berg	if (local->scan_req)
368f3b85252f081581a8f257545ed748062dce7798bJohannes Berg		return -EBUSY;
369f3b85252f081581a8f257545ed748062dce7798bJohannes Berg
3706e7e6213e4956828927c30e3ef5a42812d00c650John W. Linville	if (!list_empty(&local->work_list)) {
3716e7e6213e4956828927c30e3ef5a42812d00c650John W. Linville		/* wait for the work to finish/time out */
372c0ce77b8323c1a0d4eeef97caf16c0ea971222a9Johannes Berg		local->scan_req = req;
373c0ce77b8323c1a0d4eeef97caf16c0ea971222a9Johannes Berg		local->scan_sdata = sdata;
374c0ce77b8323c1a0d4eeef97caf16c0ea971222a9Johannes Berg		return 0;
375c0ce77b8323c1a0d4eeef97caf16c0ea971222a9Johannes Berg	}
376c0ce77b8323c1a0d4eeef97caf16c0ea971222a9Johannes Berg
377f3b85252f081581a8f257545ed748062dce7798bJohannes Berg	if (local->ops->hw_scan) {
378f3b85252f081581a8f257545ed748062dce7798bJohannes Berg		u8 *ies;
379f3b85252f081581a8f257545ed748062dce7798bJohannes Berg
3804d36ec58239eec44d77839ef6c25108efcbbb58cJohannes Berg		local->hw_scan_req = kmalloc(
3814d36ec58239eec44d77839ef6c25108efcbbb58cJohannes Berg				sizeof(*local->hw_scan_req) +
3824d36ec58239eec44d77839ef6c25108efcbbb58cJohannes Berg				req->n_channels * sizeof(req->channels[0]) +
3834d36ec58239eec44d77839ef6c25108efcbbb58cJohannes Berg				2 + IEEE80211_MAX_SSID_LEN + local->scan_ies_len +
3844d36ec58239eec44d77839ef6c25108efcbbb58cJohannes Berg				req->ie_len, GFP_KERNEL);
3854d36ec58239eec44d77839ef6c25108efcbbb58cJohannes Berg		if (!local->hw_scan_req)
386f3b85252f081581a8f257545ed748062dce7798bJohannes Berg			return -ENOMEM;
387f3b85252f081581a8f257545ed748062dce7798bJohannes Berg
3884d36ec58239eec44d77839ef6c25108efcbbb58cJohannes Berg		local->hw_scan_req->ssids = req->ssids;
3894d36ec58239eec44d77839ef6c25108efcbbb58cJohannes Berg		local->hw_scan_req->n_ssids = req->n_ssids;
3904d36ec58239eec44d77839ef6c25108efcbbb58cJohannes Berg		ies = (u8 *)local->hw_scan_req +
3914d36ec58239eec44d77839ef6c25108efcbbb58cJohannes Berg			sizeof(*local->hw_scan_req) +
3924d36ec58239eec44d77839ef6c25108efcbbb58cJohannes Berg			req->n_channels * sizeof(req->channels[0]);
3934d36ec58239eec44d77839ef6c25108efcbbb58cJohannes Berg		local->hw_scan_req->ie = ies;
3944d36ec58239eec44d77839ef6c25108efcbbb58cJohannes Berg
3954d36ec58239eec44d77839ef6c25108efcbbb58cJohannes Berg		local->hw_scan_band = 0;
3966e7e6213e4956828927c30e3ef5a42812d00c650John W. Linville
3976e7e6213e4956828927c30e3ef5a42812d00c650John W. Linville		/*
3986e7e6213e4956828927c30e3ef5a42812d00c650John W. Linville		 * After allocating local->hw_scan_req, we must
3996e7e6213e4956828927c30e3ef5a42812d00c650John W. Linville		 * go through until ieee80211_prep_hw_scan(), so
4006e7e6213e4956828927c30e3ef5a42812d00c650John W. Linville		 * anything that might be changed here and leave
4016e7e6213e4956828927c30e3ef5a42812d00c650John W. Linville		 * this function early must not go after this
4026e7e6213e4956828927c30e3ef5a42812d00c650John W. Linville		 * allocation.
4036e7e6213e4956828927c30e3ef5a42812d00c650John W. Linville		 */
404f3b85252f081581a8f257545ed748062dce7798bJohannes Berg	}
405f3b85252f081581a8f257545ed748062dce7798bJohannes Berg
406f3b85252f081581a8f257545ed748062dce7798bJohannes Berg	local->scan_req = req;
407f3b85252f081581a8f257545ed748062dce7798bJohannes Berg	local->scan_sdata = sdata;
408f3b85252f081581a8f257545ed748062dce7798bJohannes Berg
409f3b85252f081581a8f257545ed748062dce7798bJohannes Berg	if (local->ops->hw_scan)
410fbe9c429f195111bbf7f1630efa19aee295fd8e7Helmut Schaa		__set_bit(SCAN_HW_SCANNING, &local->scanning);
411f3b85252f081581a8f257545ed748062dce7798bJohannes Berg	else
412fbe9c429f195111bbf7f1630efa19aee295fd8e7Helmut Schaa		__set_bit(SCAN_SW_SCANNING, &local->scanning);
4136e7e6213e4956828927c30e3ef5a42812d00c650John W. Linville
4145cff20e6c5a6591a79d3b027af222870f52bb550Johannes Berg	ieee80211_recalc_idle(local);
415f3b85252f081581a8f257545ed748062dce7798bJohannes Berg
4164d36ec58239eec44d77839ef6c25108efcbbb58cJohannes Berg	if (local->ops->hw_scan) {
4174d36ec58239eec44d77839ef6c25108efcbbb58cJohannes Berg		WARN_ON(!ieee80211_prep_hw_scan(local));
418a060bbfe4ee95d115e8f9705a66894ac34e2c475Johannes Berg		rc = drv_hw_scan(local, sdata, local->hw_scan_req);
4194d36ec58239eec44d77839ef6c25108efcbbb58cJohannes Berg	} else
420f3b85252f081581a8f257545ed748062dce7798bJohannes Berg		rc = ieee80211_start_sw_scan(local);
421f3b85252f081581a8f257545ed748062dce7798bJohannes Berg
422f3b85252f081581a8f257545ed748062dce7798bJohannes Berg	if (rc) {
4234d36ec58239eec44d77839ef6c25108efcbbb58cJohannes Berg		kfree(local->hw_scan_req);
4244d36ec58239eec44d77839ef6c25108efcbbb58cJohannes Berg		local->hw_scan_req = NULL;
425fbe9c429f195111bbf7f1630efa19aee295fd8e7Helmut Schaa		local->scanning = 0;
426f3b85252f081581a8f257545ed748062dce7798bJohannes Berg
4275cff20e6c5a6591a79d3b027af222870f52bb550Johannes Berg		ieee80211_recalc_idle(local);
4285cff20e6c5a6591a79d3b027af222870f52bb550Johannes Berg
429f3b85252f081581a8f257545ed748062dce7798bJohannes Berg		local->scan_req = NULL;
430f3b85252f081581a8f257545ed748062dce7798bJohannes Berg		local->scan_sdata = NULL;
431f3b85252f081581a8f257545ed748062dce7798bJohannes Berg	}
432f3b85252f081581a8f257545ed748062dce7798bJohannes Berg
433f3b85252f081581a8f257545ed748062dce7798bJohannes Berg	return rc;
434f3b85252f081581a8f257545ed748062dce7798bJohannes Berg}
435f3b85252f081581a8f257545ed748062dce7798bJohannes Berg
436df13cce53a7b28a81460e6bfc4857e9df4956141Helmut Schaastatic unsigned long
437df13cce53a7b28a81460e6bfc4857e9df4956141Helmut Schaaieee80211_scan_get_channel_time(struct ieee80211_channel *chan)
438df13cce53a7b28a81460e6bfc4857e9df4956141Helmut Schaa{
439df13cce53a7b28a81460e6bfc4857e9df4956141Helmut Schaa	/*
440df13cce53a7b28a81460e6bfc4857e9df4956141Helmut Schaa	 * TODO: channel switching also consumes quite some time,
441df13cce53a7b28a81460e6bfc4857e9df4956141Helmut Schaa	 * add that delay as well to get a better estimation
442df13cce53a7b28a81460e6bfc4857e9df4956141Helmut Schaa	 */
443df13cce53a7b28a81460e6bfc4857e9df4956141Helmut Schaa	if (chan->flags & IEEE80211_CHAN_PASSIVE_SCAN)
444df13cce53a7b28a81460e6bfc4857e9df4956141Helmut Schaa		return IEEE80211_PASSIVE_CHANNEL_TIME;
445df13cce53a7b28a81460e6bfc4857e9df4956141Helmut Schaa	return IEEE80211_PROBE_DELAY + IEEE80211_CHANNEL_TIME;
446df13cce53a7b28a81460e6bfc4857e9df4956141Helmut Schaa}
447df13cce53a7b28a81460e6bfc4857e9df4956141Helmut Schaa
448e229f844d7223b7063bea1e649203ac521a58fe1Stanislaw Gruszkastatic void ieee80211_scan_state_decision(struct ieee80211_local *local,
449e229f844d7223b7063bea1e649203ac521a58fe1Stanislaw Gruszka					  unsigned long *next_delay)
4507d3be3cc489176bc7bd23e673b0b4aef597af2b3Helmut Schaa{
451142b9f5074dc0d09dc0025739ad437723d7bf527Helmut Schaa	bool associated = false;
452df13cce53a7b28a81460e6bfc4857e9df4956141Helmut Schaa	bool tx_empty = true;
453df13cce53a7b28a81460e6bfc4857e9df4956141Helmut Schaa	bool bad_latency;
454df13cce53a7b28a81460e6bfc4857e9df4956141Helmut Schaa	bool listen_int_exceeded;
455df13cce53a7b28a81460e6bfc4857e9df4956141Helmut Schaa	unsigned long min_beacon_int = 0;
456142b9f5074dc0d09dc0025739ad437723d7bf527Helmut Schaa	struct ieee80211_sub_if_data *sdata;
457df13cce53a7b28a81460e6bfc4857e9df4956141Helmut Schaa	struct ieee80211_channel *next_chan;
458142b9f5074dc0d09dc0025739ad437723d7bf527Helmut Schaa
459df13cce53a7b28a81460e6bfc4857e9df4956141Helmut Schaa	/*
460df13cce53a7b28a81460e6bfc4857e9df4956141Helmut Schaa	 * check if at least one STA interface is associated,
461df13cce53a7b28a81460e6bfc4857e9df4956141Helmut Schaa	 * check if at least one STA interface has pending tx frames
462df13cce53a7b28a81460e6bfc4857e9df4956141Helmut Schaa	 * and grab the lowest used beacon interval
463df13cce53a7b28a81460e6bfc4857e9df4956141Helmut Schaa	 */
464142b9f5074dc0d09dc0025739ad437723d7bf527Helmut Schaa	mutex_lock(&local->iflist_mtx);
465142b9f5074dc0d09dc0025739ad437723d7bf527Helmut Schaa	list_for_each_entry(sdata, &local->interfaces, list) {
4669607e6b66a0d25ca63b70d54a4283fa13d8f7c9dJohannes Berg		if (!ieee80211_sdata_running(sdata))
467142b9f5074dc0d09dc0025739ad437723d7bf527Helmut Schaa			continue;
468142b9f5074dc0d09dc0025739ad437723d7bf527Helmut Schaa
469142b9f5074dc0d09dc0025739ad437723d7bf527Helmut Schaa		if (sdata->vif.type == NL80211_IFTYPE_STATION) {
470142b9f5074dc0d09dc0025739ad437723d7bf527Helmut Schaa			if (sdata->u.mgd.associated) {
471142b9f5074dc0d09dc0025739ad437723d7bf527Helmut Schaa				associated = true;
472df13cce53a7b28a81460e6bfc4857e9df4956141Helmut Schaa
473df13cce53a7b28a81460e6bfc4857e9df4956141Helmut Schaa				if (sdata->vif.bss_conf.beacon_int <
474df13cce53a7b28a81460e6bfc4857e9df4956141Helmut Schaa				    min_beacon_int || min_beacon_int == 0)
475df13cce53a7b28a81460e6bfc4857e9df4956141Helmut Schaa					min_beacon_int =
476df13cce53a7b28a81460e6bfc4857e9df4956141Helmut Schaa						sdata->vif.bss_conf.beacon_int;
477df13cce53a7b28a81460e6bfc4857e9df4956141Helmut Schaa
478df13cce53a7b28a81460e6bfc4857e9df4956141Helmut Schaa				if (!qdisc_all_tx_empty(sdata->dev)) {
479df13cce53a7b28a81460e6bfc4857e9df4956141Helmut Schaa					tx_empty = false;
480df13cce53a7b28a81460e6bfc4857e9df4956141Helmut Schaa					break;
481df13cce53a7b28a81460e6bfc4857e9df4956141Helmut Schaa				}
482142b9f5074dc0d09dc0025739ad437723d7bf527Helmut Schaa			}
483142b9f5074dc0d09dc0025739ad437723d7bf527Helmut Schaa		}
484142b9f5074dc0d09dc0025739ad437723d7bf527Helmut Schaa	}
485142b9f5074dc0d09dc0025739ad437723d7bf527Helmut Schaa	mutex_unlock(&local->iflist_mtx);
486142b9f5074dc0d09dc0025739ad437723d7bf527Helmut Schaa
487b23b025fe246f3acc2988eb6d400df34c27cb8aeBen Greear	next_chan = local->scan_req->channels[local->scan_channel_idx];
488b23b025fe246f3acc2988eb6d400df34c27cb8aeBen Greear
489a80f7c0b088187c8471b441d461e937991870661Johannes Berg	/*
49007ef03ee8b280a536b38ccfe512b9556996f0492Johannes Berg	 * we're currently scanning a different channel, let's
49107ef03ee8b280a536b38ccfe512b9556996f0492Johannes Berg	 * see if we can scan another channel without interfering
49207ef03ee8b280a536b38ccfe512b9556996f0492Johannes Berg	 * with the current traffic situation.
49307ef03ee8b280a536b38ccfe512b9556996f0492Johannes Berg	 *
49407ef03ee8b280a536b38ccfe512b9556996f0492Johannes Berg	 * Since we don't know if the AP has pending frames for us
49507ef03ee8b280a536b38ccfe512b9556996f0492Johannes Berg	 * we can only check for our tx queues and use the current
49607ef03ee8b280a536b38ccfe512b9556996f0492Johannes Berg	 * pm_qos requirements for rx. Hence, if no tx traffic occurs
49707ef03ee8b280a536b38ccfe512b9556996f0492Johannes Berg	 * at all we will scan as many channels in a row as the pm_qos
49807ef03ee8b280a536b38ccfe512b9556996f0492Johannes Berg	 * latency allows us to. Additionally we also check for the
49907ef03ee8b280a536b38ccfe512b9556996f0492Johannes Berg	 * currently negotiated listen interval to prevent losing
50007ef03ee8b280a536b38ccfe512b9556996f0492Johannes Berg	 * frames unnecessarily.
50107ef03ee8b280a536b38ccfe512b9556996f0492Johannes Berg	 *
50207ef03ee8b280a536b38ccfe512b9556996f0492Johannes Berg	 * Otherwise switch back to the operating channel.
503a80f7c0b088187c8471b441d461e937991870661Johannes Berg	 */
504a80f7c0b088187c8471b441d461e937991870661Johannes Berg
50507ef03ee8b280a536b38ccfe512b9556996f0492Johannes Berg	bad_latency = time_after(jiffies +
50607ef03ee8b280a536b38ccfe512b9556996f0492Johannes Berg			ieee80211_scan_get_channel_time(next_chan),
50707ef03ee8b280a536b38ccfe512b9556996f0492Johannes Berg			local->leave_oper_channel_time +
50807ef03ee8b280a536b38ccfe512b9556996f0492Johannes Berg			usecs_to_jiffies(pm_qos_request(PM_QOS_NETWORK_LATENCY)));
509df13cce53a7b28a81460e6bfc4857e9df4956141Helmut Schaa
51007ef03ee8b280a536b38ccfe512b9556996f0492Johannes Berg	listen_int_exceeded = time_after(jiffies +
51107ef03ee8b280a536b38ccfe512b9556996f0492Johannes Berg			ieee80211_scan_get_channel_time(next_chan),
51207ef03ee8b280a536b38ccfe512b9556996f0492Johannes Berg			local->leave_oper_channel_time +
51307ef03ee8b280a536b38ccfe512b9556996f0492Johannes Berg			usecs_to_jiffies(min_beacon_int * 1024) *
51407ef03ee8b280a536b38ccfe512b9556996f0492Johannes Berg			local->hw.conf.listen_interval);
515142b9f5074dc0d09dc0025739ad437723d7bf527Helmut Schaa
51607ef03ee8b280a536b38ccfe512b9556996f0492Johannes Berg	if (associated && (!tx_empty || bad_latency || listen_int_exceeded))
51707ef03ee8b280a536b38ccfe512b9556996f0492Johannes Berg		local->next_scan_state = SCAN_SUSPEND;
51807ef03ee8b280a536b38ccfe512b9556996f0492Johannes Berg	else
51907ef03ee8b280a536b38ccfe512b9556996f0492Johannes Berg		local->next_scan_state = SCAN_SET_CHANNEL;
520142b9f5074dc0d09dc0025739ad437723d7bf527Helmut Schaa
52107ef03ee8b280a536b38ccfe512b9556996f0492Johannes Berg	*next_delay = 0;
522142b9f5074dc0d09dc0025739ad437723d7bf527Helmut Schaa}
523142b9f5074dc0d09dc0025739ad437723d7bf527Helmut Schaa
5242fb3f028a9a46bd344329766257699b4acb36525Helmut Schaastatic void ieee80211_scan_state_set_channel(struct ieee80211_local *local,
5252fb3f028a9a46bd344329766257699b4acb36525Helmut Schaa					     unsigned long *next_delay)
5262fb3f028a9a46bd344329766257699b4acb36525Helmut Schaa{
5272fb3f028a9a46bd344329766257699b4acb36525Helmut Schaa	int skip;
5282fb3f028a9a46bd344329766257699b4acb36525Helmut Schaa	struct ieee80211_channel *chan;
5292fb3f028a9a46bd344329766257699b4acb36525Helmut Schaa
5307d3be3cc489176bc7bd23e673b0b4aef597af2b3Helmut Schaa	skip = 0;
5317d3be3cc489176bc7bd23e673b0b4aef597af2b3Helmut Schaa	chan = local->scan_req->channels[local->scan_channel_idx];
5327d3be3cc489176bc7bd23e673b0b4aef597af2b3Helmut Schaa
533584991dccfd347cd2e1675ab262998f6c335d3c0Johannes Berg	local->scan_channel = chan;
534b23b025fe246f3acc2988eb6d400df34c27cb8aeBen Greear
53507ef03ee8b280a536b38ccfe512b9556996f0492Johannes Berg	if (ieee80211_hw_config(local, IEEE80211_CONF_CHANGE_CHANNEL))
53607ef03ee8b280a536b38ccfe512b9556996f0492Johannes Berg		skip = 1;
5377d3be3cc489176bc7bd23e673b0b4aef597af2b3Helmut Schaa
5387d3be3cc489176bc7bd23e673b0b4aef597af2b3Helmut Schaa	/* advance state machine to next channel/band */
5397d3be3cc489176bc7bd23e673b0b4aef597af2b3Helmut Schaa	local->scan_channel_idx++;
5407d3be3cc489176bc7bd23e673b0b4aef597af2b3Helmut Schaa
5410ee9c13c7c92581ab005d80795cf65897213b249Helmut Schaa	if (skip) {
5420ee9c13c7c92581ab005d80795cf65897213b249Helmut Schaa		/* if we skip this channel return to the decision state */
5430ee9c13c7c92581ab005d80795cf65897213b249Helmut Schaa		local->next_scan_state = SCAN_DECISION;
5442fb3f028a9a46bd344329766257699b4acb36525Helmut Schaa		return;
5450ee9c13c7c92581ab005d80795cf65897213b249Helmut Schaa	}
5467d3be3cc489176bc7bd23e673b0b4aef597af2b3Helmut Schaa
5477d3be3cc489176bc7bd23e673b0b4aef597af2b3Helmut Schaa	/*
5487d3be3cc489176bc7bd23e673b0b4aef597af2b3Helmut Schaa	 * Probe delay is used to update the NAV, cf. 11.1.3.2.2
5497d3be3cc489176bc7bd23e673b0b4aef597af2b3Helmut Schaa	 * (which unfortunately doesn't say _why_ step a) is done,
5507d3be3cc489176bc7bd23e673b0b4aef597af2b3Helmut Schaa	 * but it waits for the probe delay or until a frame is
5517d3be3cc489176bc7bd23e673b0b4aef597af2b3Helmut Schaa	 * received - and the received frame would update the NAV).
5527d3be3cc489176bc7bd23e673b0b4aef597af2b3Helmut Schaa	 * For now, we do not support waiting until a frame is
5537d3be3cc489176bc7bd23e673b0b4aef597af2b3Helmut Schaa	 * received.
5547d3be3cc489176bc7bd23e673b0b4aef597af2b3Helmut Schaa	 *
5557d3be3cc489176bc7bd23e673b0b4aef597af2b3Helmut Schaa	 * In any case, it is not necessary for a passive scan.
5567d3be3cc489176bc7bd23e673b0b4aef597af2b3Helmut Schaa	 */
5577d3be3cc489176bc7bd23e673b0b4aef597af2b3Helmut Schaa	if (chan->flags & IEEE80211_CHAN_PASSIVE_SCAN ||
5587d3be3cc489176bc7bd23e673b0b4aef597af2b3Helmut Schaa	    !local->scan_req->n_ssids) {
5597d3be3cc489176bc7bd23e673b0b4aef597af2b3Helmut Schaa		*next_delay = IEEE80211_PASSIVE_CHANNEL_TIME;
560977923b00c79185c11b4b47664f5ffa4c3820438Helmut Schaa		local->next_scan_state = SCAN_DECISION;
5612fb3f028a9a46bd344329766257699b4acb36525Helmut Schaa		return;
5627d3be3cc489176bc7bd23e673b0b4aef597af2b3Helmut Schaa	}
5637d3be3cc489176bc7bd23e673b0b4aef597af2b3Helmut Schaa
5642fb3f028a9a46bd344329766257699b4acb36525Helmut Schaa	/* active scan, send probes */
5657d3be3cc489176bc7bd23e673b0b4aef597af2b3Helmut Schaa	*next_delay = IEEE80211_PROBE_DELAY;
566977923b00c79185c11b4b47664f5ffa4c3820438Helmut Schaa	local->next_scan_state = SCAN_SEND_PROBE;
5677d3be3cc489176bc7bd23e673b0b4aef597af2b3Helmut Schaa}
5687d3be3cc489176bc7bd23e673b0b4aef597af2b3Helmut Schaa
5697d3be3cc489176bc7bd23e673b0b4aef597af2b3Helmut Schaastatic void ieee80211_scan_state_send_probe(struct ieee80211_local *local,
5707d3be3cc489176bc7bd23e673b0b4aef597af2b3Helmut Schaa					    unsigned long *next_delay)
5717d3be3cc489176bc7bd23e673b0b4aef597af2b3Helmut Schaa{
5727d3be3cc489176bc7bd23e673b0b4aef597af2b3Helmut Schaa	int i;
5737d3be3cc489176bc7bd23e673b0b4aef597af2b3Helmut Schaa	struct ieee80211_sub_if_data *sdata = local->scan_sdata;
57485a237fe308405ee38eb9c6733571c49902ec229Johannes Berg	enum ieee80211_band band = local->hw.conf.channel->band;
5757d3be3cc489176bc7bd23e673b0b4aef597af2b3Helmut Schaa
5767d3be3cc489176bc7bd23e673b0b4aef597af2b3Helmut Schaa	for (i = 0; i < local->scan_req->n_ssids; i++)
5777d3be3cc489176bc7bd23e673b0b4aef597af2b3Helmut Schaa		ieee80211_send_probe_req(
5787d3be3cc489176bc7bd23e673b0b4aef597af2b3Helmut Schaa			sdata, NULL,
5797d3be3cc489176bc7bd23e673b0b4aef597af2b3Helmut Schaa			local->scan_req->ssids[i].ssid,
5807d3be3cc489176bc7bd23e673b0b4aef597af2b3Helmut Schaa			local->scan_req->ssids[i].ssid_len,
581a806c558e01747b499201d2667818f03d79ef1e3Paul Stewart			local->scan_req->ie, local->scan_req->ie_len,
582aad14ceb45f5ff12da2ab5b37a596e6f81566515Rajkumar Manoharan			local->scan_req->rates[band], false,
583aad14ceb45f5ff12da2ab5b37a596e6f81566515Rajkumar Manoharan			local->scan_req->no_cck);
5847d3be3cc489176bc7bd23e673b0b4aef597af2b3Helmut Schaa
5857d3be3cc489176bc7bd23e673b0b4aef597af2b3Helmut Schaa	/*
5867d3be3cc489176bc7bd23e673b0b4aef597af2b3Helmut Schaa	 * After sending probe requests, wait for probe responses
5877d3be3cc489176bc7bd23e673b0b4aef597af2b3Helmut Schaa	 * on the channel.
5887d3be3cc489176bc7bd23e673b0b4aef597af2b3Helmut Schaa	 */
5897d3be3cc489176bc7bd23e673b0b4aef597af2b3Helmut Schaa	*next_delay = IEEE80211_CHANNEL_TIME;
590977923b00c79185c11b4b47664f5ffa4c3820438Helmut Schaa	local->next_scan_state = SCAN_DECISION;
5917d3be3cc489176bc7bd23e673b0b4aef597af2b3Helmut Schaa}
5927d3be3cc489176bc7bd23e673b0b4aef597af2b3Helmut Schaa
59307ef03ee8b280a536b38ccfe512b9556996f0492Johannes Bergstatic void ieee80211_scan_state_suspend(struct ieee80211_local *local,
59407ef03ee8b280a536b38ccfe512b9556996f0492Johannes Berg					 unsigned long *next_delay)
59507ef03ee8b280a536b38ccfe512b9556996f0492Johannes Berg{
59607ef03ee8b280a536b38ccfe512b9556996f0492Johannes Berg	/* switch back to the operating channel */
59707ef03ee8b280a536b38ccfe512b9556996f0492Johannes Berg	local->scan_channel = NULL;
59807ef03ee8b280a536b38ccfe512b9556996f0492Johannes Berg	ieee80211_hw_config(local, IEEE80211_CONF_CHANGE_CHANNEL);
59907ef03ee8b280a536b38ccfe512b9556996f0492Johannes Berg
60007ef03ee8b280a536b38ccfe512b9556996f0492Johannes Berg	/*
60107ef03ee8b280a536b38ccfe512b9556996f0492Johannes Berg	 * Re-enable vifs and beaconing.  Leave PS
60207ef03ee8b280a536b38ccfe512b9556996f0492Johannes Berg	 * in off-channel state..will put that back
60307ef03ee8b280a536b38ccfe512b9556996f0492Johannes Berg	 * on-channel at the end of scanning.
60407ef03ee8b280a536b38ccfe512b9556996f0492Johannes Berg	 */
605e76aadc572288a158ae18ae1c10fe395c7bca066Johannes Berg	ieee80211_offchannel_return(local, false);
60607ef03ee8b280a536b38ccfe512b9556996f0492Johannes Berg
60707ef03ee8b280a536b38ccfe512b9556996f0492Johannes Berg	*next_delay = HZ / 5;
60807ef03ee8b280a536b38ccfe512b9556996f0492Johannes Berg	/* afterwards, resume scan & go to next channel */
60907ef03ee8b280a536b38ccfe512b9556996f0492Johannes Berg	local->next_scan_state = SCAN_RESUME;
61007ef03ee8b280a536b38ccfe512b9556996f0492Johannes Berg}
61107ef03ee8b280a536b38ccfe512b9556996f0492Johannes Berg
61207ef03ee8b280a536b38ccfe512b9556996f0492Johannes Bergstatic void ieee80211_scan_state_resume(struct ieee80211_local *local,
61307ef03ee8b280a536b38ccfe512b9556996f0492Johannes Berg					unsigned long *next_delay)
61407ef03ee8b280a536b38ccfe512b9556996f0492Johannes Berg{
61507ef03ee8b280a536b38ccfe512b9556996f0492Johannes Berg	/* PS already is in off-channel mode */
61607ef03ee8b280a536b38ccfe512b9556996f0492Johannes Berg	ieee80211_offchannel_stop_vifs(local, false);
61707ef03ee8b280a536b38ccfe512b9556996f0492Johannes Berg
61807ef03ee8b280a536b38ccfe512b9556996f0492Johannes Berg	if (local->ops->flush) {
61907ef03ee8b280a536b38ccfe512b9556996f0492Johannes Berg		drv_flush(local, false);
62007ef03ee8b280a536b38ccfe512b9556996f0492Johannes Berg		*next_delay = 0;
62107ef03ee8b280a536b38ccfe512b9556996f0492Johannes Berg	} else
62207ef03ee8b280a536b38ccfe512b9556996f0492Johannes Berg		*next_delay = HZ / 10;
62307ef03ee8b280a536b38ccfe512b9556996f0492Johannes Berg
62407ef03ee8b280a536b38ccfe512b9556996f0492Johannes Berg	/* remember when we left the operating channel */
62507ef03ee8b280a536b38ccfe512b9556996f0492Johannes Berg	local->leave_oper_channel_time = jiffies;
62607ef03ee8b280a536b38ccfe512b9556996f0492Johannes Berg
62707ef03ee8b280a536b38ccfe512b9556996f0492Johannes Berg	/* advance to the next channel to be scanned */
628de2ee84db6a0201278e35590821cd014cb71830aMohammed Shafi Shajakhan	local->next_scan_state = SCAN_SET_CHANNEL;
62907ef03ee8b280a536b38ccfe512b9556996f0492Johannes Berg}
63007ef03ee8b280a536b38ccfe512b9556996f0492Johannes Berg
631c2b13452b283f9c4a5b02a6b53ed6416ebf4c03cJohannes Bergvoid ieee80211_scan_work(struct work_struct *work)
6320a51b27e956bd9580296c48191b78175ed8b5971Johannes Berg{
6330a51b27e956bd9580296c48191b78175ed8b5971Johannes Berg	struct ieee80211_local *local =
6340a51b27e956bd9580296c48191b78175ed8b5971Johannes Berg		container_of(work, struct ieee80211_local, scan_work.work);
635d07bfd8b6f20a81d7ec65c50f35b053d9e3aa740Johannes Berg	struct ieee80211_sub_if_data *sdata;
6360a51b27e956bd9580296c48191b78175ed8b5971Johannes Berg	unsigned long next_delay = 0;
637d07bfd8b6f20a81d7ec65c50f35b053d9e3aa740Johannes Berg	bool aborted, hw_scan;
6380a51b27e956bd9580296c48191b78175ed8b5971Johannes Berg
639259b62e35bf44a97983f275de569929a7d2bd5ddStanislaw Gruszka	mutex_lock(&local->mtx);
6408789d459bc5e837bf37d261453df96ef54018d7bJohannes Berg
641d07bfd8b6f20a81d7ec65c50f35b053d9e3aa740Johannes Berg	sdata = local->scan_sdata;
642d07bfd8b6f20a81d7ec65c50f35b053d9e3aa740Johannes Berg
643259b62e35bf44a97983f275de569929a7d2bd5ddStanislaw Gruszka	if (test_and_clear_bit(SCAN_COMPLETED, &local->scanning)) {
6448789d459bc5e837bf37d261453df96ef54018d7bJohannes Berg		aborted = test_and_clear_bit(SCAN_ABORTED, &local->scanning);
645259b62e35bf44a97983f275de569929a7d2bd5ddStanislaw Gruszka		goto out_complete;
6468789d459bc5e837bf37d261453df96ef54018d7bJohannes Berg	}
6478789d459bc5e837bf37d261453df96ef54018d7bJohannes Berg
648259b62e35bf44a97983f275de569929a7d2bd5ddStanislaw Gruszka	if (!sdata || !local->scan_req)
649259b62e35bf44a97983f275de569929a7d2bd5ddStanislaw Gruszka		goto out;
650f3b85252f081581a8f257545ed748062dce7798bJohannes Berg
651fbe9c429f195111bbf7f1630efa19aee295fd8e7Helmut Schaa	if (local->scan_req && !local->scanning) {
652f3b85252f081581a8f257545ed748062dce7798bJohannes Berg		struct cfg80211_scan_request *req = local->scan_req;
653f3b85252f081581a8f257545ed748062dce7798bJohannes Berg		int rc;
654f3b85252f081581a8f257545ed748062dce7798bJohannes Berg
655f3b85252f081581a8f257545ed748062dce7798bJohannes Berg		local->scan_req = NULL;
65615db0b7fd872b0312033666d3a82e1214a227ec0Johannes Berg		local->scan_sdata = NULL;
657f3b85252f081581a8f257545ed748062dce7798bJohannes Berg
658f3b85252f081581a8f257545ed748062dce7798bJohannes Berg		rc = __ieee80211_start_scan(sdata, req);
659259b62e35bf44a97983f275de569929a7d2bd5ddStanislaw Gruszka		if (rc) {
6603aed49ef17c7bc8397420529ac976fe058818e3dStanislaw Gruszka			/* need to complete scan in cfg80211 */
6613aed49ef17c7bc8397420529ac976fe058818e3dStanislaw Gruszka			local->scan_req = req;
662259b62e35bf44a97983f275de569929a7d2bd5ddStanislaw Gruszka			aborted = true;
663259b62e35bf44a97983f275de569929a7d2bd5ddStanislaw Gruszka			goto out_complete;
664259b62e35bf44a97983f275de569929a7d2bd5ddStanislaw Gruszka		} else
665259b62e35bf44a97983f275de569929a7d2bd5ddStanislaw Gruszka			goto out;
666f3b85252f081581a8f257545ed748062dce7798bJohannes Berg	}
667f3b85252f081581a8f257545ed748062dce7798bJohannes Berg
6685bc75728fd43bb15b46f16ef465bcf9d487393cfJohannes Berg	/*
6695bc75728fd43bb15b46f16ef465bcf9d487393cfJohannes Berg	 * Avoid re-scheduling when the sdata is going away.
6705bc75728fd43bb15b46f16ef465bcf9d487393cfJohannes Berg	 */
6719607e6b66a0d25ca63b70d54a4283fa13d8f7c9dJohannes Berg	if (!ieee80211_sdata_running(sdata)) {
672259b62e35bf44a97983f275de569929a7d2bd5ddStanislaw Gruszka		aborted = true;
673259b62e35bf44a97983f275de569929a7d2bd5ddStanislaw Gruszka		goto out_complete;
674f3b85252f081581a8f257545ed748062dce7798bJohannes Berg	}
6750a51b27e956bd9580296c48191b78175ed8b5971Johannes Berg
676f502d09b750437a4ec9c63333acf1070fe7958afHelmut Schaa	/*
677f502d09b750437a4ec9c63333acf1070fe7958afHelmut Schaa	 * as long as no delay is required advance immediately
678f502d09b750437a4ec9c63333acf1070fe7958afHelmut Schaa	 * without scheduling a new work
679f502d09b750437a4ec9c63333acf1070fe7958afHelmut Schaa	 */
680f502d09b750437a4ec9c63333acf1070fe7958afHelmut Schaa	do {
681c29acf201007a6d73223f864f52406eb5ba19933Rajkumar Manoharan		if (!ieee80211_sdata_running(sdata)) {
682c29acf201007a6d73223f864f52406eb5ba19933Rajkumar Manoharan			aborted = true;
683c29acf201007a6d73223f864f52406eb5ba19933Rajkumar Manoharan			goto out_complete;
684c29acf201007a6d73223f864f52406eb5ba19933Rajkumar Manoharan		}
685c29acf201007a6d73223f864f52406eb5ba19933Rajkumar Manoharan
686977923b00c79185c11b4b47664f5ffa4c3820438Helmut Schaa		switch (local->next_scan_state) {
6872fb3f028a9a46bd344329766257699b4acb36525Helmut Schaa		case SCAN_DECISION:
688e229f844d7223b7063bea1e649203ac521a58fe1Stanislaw Gruszka			/* if no more bands/channels left, complete scan */
689e229f844d7223b7063bea1e649203ac521a58fe1Stanislaw Gruszka			if (local->scan_channel_idx >= local->scan_req->n_channels) {
690e229f844d7223b7063bea1e649203ac521a58fe1Stanislaw Gruszka				aborted = false;
691e229f844d7223b7063bea1e649203ac521a58fe1Stanislaw Gruszka				goto out_complete;
692e229f844d7223b7063bea1e649203ac521a58fe1Stanislaw Gruszka			}
693e229f844d7223b7063bea1e649203ac521a58fe1Stanislaw Gruszka			ieee80211_scan_state_decision(local, &next_delay);
694f502d09b750437a4ec9c63333acf1070fe7958afHelmut Schaa			break;
6952fb3f028a9a46bd344329766257699b4acb36525Helmut Schaa		case SCAN_SET_CHANNEL:
6962fb3f028a9a46bd344329766257699b4acb36525Helmut Schaa			ieee80211_scan_state_set_channel(local, &next_delay);
6972fb3f028a9a46bd344329766257699b4acb36525Helmut Schaa			break;
698f502d09b750437a4ec9c63333acf1070fe7958afHelmut Schaa		case SCAN_SEND_PROBE:
699f502d09b750437a4ec9c63333acf1070fe7958afHelmut Schaa			ieee80211_scan_state_send_probe(local, &next_delay);
700f502d09b750437a4ec9c63333acf1070fe7958afHelmut Schaa			break;
70107ef03ee8b280a536b38ccfe512b9556996f0492Johannes Berg		case SCAN_SUSPEND:
70207ef03ee8b280a536b38ccfe512b9556996f0492Johannes Berg			ieee80211_scan_state_suspend(local, &next_delay);
703142b9f5074dc0d09dc0025739ad437723d7bf527Helmut Schaa			break;
70407ef03ee8b280a536b38ccfe512b9556996f0492Johannes Berg		case SCAN_RESUME:
70507ef03ee8b280a536b38ccfe512b9556996f0492Johannes Berg			ieee80211_scan_state_resume(local, &next_delay);
706142b9f5074dc0d09dc0025739ad437723d7bf527Helmut Schaa			break;
707f502d09b750437a4ec9c63333acf1070fe7958afHelmut Schaa		}
708f502d09b750437a4ec9c63333acf1070fe7958afHelmut Schaa	} while (next_delay == 0);
7090a51b27e956bd9580296c48191b78175ed8b5971Johannes Berg
71042935ecaf4e784d0815afa9a7e5fe7e141157ca3Luis R. Rodriguez	ieee80211_queue_delayed_work(&local->hw, &local->scan_work, next_delay);
711d07bfd8b6f20a81d7ec65c50f35b053d9e3aa740Johannes Berg	goto out;
712259b62e35bf44a97983f275de569929a7d2bd5ddStanislaw Gruszka
713259b62e35bf44a97983f275de569929a7d2bd5ddStanislaw Gruszkaout_complete:
714e229f844d7223b7063bea1e649203ac521a58fe1Stanislaw Gruszka	hw_scan = test_bit(SCAN_HW_SCANNING, &local->scanning);
715d07bfd8b6f20a81d7ec65c50f35b053d9e3aa740Johannes Berg	__ieee80211_scan_completed(&local->hw, aborted, hw_scan);
716259b62e35bf44a97983f275de569929a7d2bd5ddStanislaw Gruszkaout:
717259b62e35bf44a97983f275de569929a7d2bd5ddStanislaw Gruszka	mutex_unlock(&local->mtx);
7180a51b27e956bd9580296c48191b78175ed8b5971Johannes Berg}
7190a51b27e956bd9580296c48191b78175ed8b5971Johannes Berg
720f3b85252f081581a8f257545ed748062dce7798bJohannes Bergint ieee80211_request_scan(struct ieee80211_sub_if_data *sdata,
721f3b85252f081581a8f257545ed748062dce7798bJohannes Berg			   struct cfg80211_scan_request *req)
7220a51b27e956bd9580296c48191b78175ed8b5971Johannes Berg{
723f3b85252f081581a8f257545ed748062dce7798bJohannes Berg	int res;
724de95a54b1aebe5592cae971ca5e5d9ec6a381a17Johannes Berg
725a1699b75a1db31a1da2f0fc610ee696d02a19280Johannes Berg	mutex_lock(&sdata->local->mtx);
726f3b85252f081581a8f257545ed748062dce7798bJohannes Berg	res = __ieee80211_start_scan(sdata, req);
727a1699b75a1db31a1da2f0fc610ee696d02a19280Johannes Berg	mutex_unlock(&sdata->local->mtx);
7280a51b27e956bd9580296c48191b78175ed8b5971Johannes Berg
729f3b85252f081581a8f257545ed748062dce7798bJohannes Berg	return res;
7300a51b27e956bd9580296c48191b78175ed8b5971Johannes Berg}
7310a51b27e956bd9580296c48191b78175ed8b5971Johannes Berg
732f3b85252f081581a8f257545ed748062dce7798bJohannes Bergint ieee80211_request_internal_scan(struct ieee80211_sub_if_data *sdata,
733be4a4b6a5d2f76393f545a2545fbaa1b65577e13Johannes Berg				    const u8 *ssid, u8 ssid_len,
734be4a4b6a5d2f76393f545a2545fbaa1b65577e13Johannes Berg				    struct ieee80211_channel *chan)
7350a51b27e956bd9580296c48191b78175ed8b5971Johannes Berg{
7360a51b27e956bd9580296c48191b78175ed8b5971Johannes Berg	struct ieee80211_local *local = sdata->local;
737f3b85252f081581a8f257545ed748062dce7798bJohannes Berg	int ret = -EBUSY;
738fb63bc41772259701a827e9a6117219a7393554fGertjan van Wingerde	enum ieee80211_band band;
7392a5193119269062608582418deba7af82844159aJohannes Berg
740a1699b75a1db31a1da2f0fc610ee696d02a19280Johannes Berg	mutex_lock(&local->mtx);
7410a51b27e956bd9580296c48191b78175ed8b5971Johannes Berg
742f3b85252f081581a8f257545ed748062dce7798bJohannes Berg	/* busy scanning */
743f3b85252f081581a8f257545ed748062dce7798bJohannes Berg	if (local->scan_req)
744f3b85252f081581a8f257545ed748062dce7798bJohannes Berg		goto unlock;
7459116dd01120e249dc2e84e6edecd7ad7f828680fJohannes Berg
746be4a4b6a5d2f76393f545a2545fbaa1b65577e13Johannes Berg	/* fill internal scan request */
747be4a4b6a5d2f76393f545a2545fbaa1b65577e13Johannes Berg	if (!chan) {
748be4a4b6a5d2f76393f545a2545fbaa1b65577e13Johannes Berg		int i, nchan = 0;
749be4a4b6a5d2f76393f545a2545fbaa1b65577e13Johannes Berg
750be4a4b6a5d2f76393f545a2545fbaa1b65577e13Johannes Berg		for (band = 0; band < IEEE80211_NUM_BANDS; band++) {
751be4a4b6a5d2f76393f545a2545fbaa1b65577e13Johannes Berg			if (!local->hw.wiphy->bands[band])
752be4a4b6a5d2f76393f545a2545fbaa1b65577e13Johannes Berg				continue;
753be4a4b6a5d2f76393f545a2545fbaa1b65577e13Johannes Berg			for (i = 0;
754be4a4b6a5d2f76393f545a2545fbaa1b65577e13Johannes Berg			     i < local->hw.wiphy->bands[band]->n_channels;
755be4a4b6a5d2f76393f545a2545fbaa1b65577e13Johannes Berg			     i++) {
756be4a4b6a5d2f76393f545a2545fbaa1b65577e13Johannes Berg				local->int_scan_req->channels[nchan] =
757be4a4b6a5d2f76393f545a2545fbaa1b65577e13Johannes Berg				    &local->hw.wiphy->bands[band]->channels[i];
758be4a4b6a5d2f76393f545a2545fbaa1b65577e13Johannes Berg				nchan++;
759be4a4b6a5d2f76393f545a2545fbaa1b65577e13Johannes Berg			}
760be4a4b6a5d2f76393f545a2545fbaa1b65577e13Johannes Berg		}
761be4a4b6a5d2f76393f545a2545fbaa1b65577e13Johannes Berg
762be4a4b6a5d2f76393f545a2545fbaa1b65577e13Johannes Berg		local->int_scan_req->n_channels = nchan;
763be4a4b6a5d2f76393f545a2545fbaa1b65577e13Johannes Berg	} else {
764be4a4b6a5d2f76393f545a2545fbaa1b65577e13Johannes Berg		local->int_scan_req->channels[0] = chan;
765be4a4b6a5d2f76393f545a2545fbaa1b65577e13Johannes Berg		local->int_scan_req->n_channels = 1;
766be4a4b6a5d2f76393f545a2545fbaa1b65577e13Johannes Berg	}
767be4a4b6a5d2f76393f545a2545fbaa1b65577e13Johannes Berg
768be4a4b6a5d2f76393f545a2545fbaa1b65577e13Johannes Berg	local->int_scan_req->ssids = &local->scan_ssid;
769be4a4b6a5d2f76393f545a2545fbaa1b65577e13Johannes Berg	local->int_scan_req->n_ssids = 1;
7705ba63533bbf653631faab60f6988506160ec6ba4Johannes Berg	memcpy(local->int_scan_req->ssids[0].ssid, ssid, IEEE80211_MAX_SSID_LEN);
7715ba63533bbf653631faab60f6988506160ec6ba4Johannes Berg	local->int_scan_req->ssids[0].ssid_len = ssid_len;
7729116dd01120e249dc2e84e6edecd7ad7f828680fJohannes Berg
7735ba63533bbf653631faab60f6988506160ec6ba4Johannes Berg	ret = __ieee80211_start_scan(sdata, sdata->local->int_scan_req);
774f3b85252f081581a8f257545ed748062dce7798bJohannes Berg unlock:
775a1699b75a1db31a1da2f0fc610ee696d02a19280Johannes Berg	mutex_unlock(&local->mtx);
776f3b85252f081581a8f257545ed748062dce7798bJohannes Berg	return ret;
7770a51b27e956bd9580296c48191b78175ed8b5971Johannes Berg}
7785bb644a0fd25a5e083ecbfaa92a211db99aa6ef7Johannes Berg
7794136c4224ccf1907d309e1cdfaefef9da97dbc5eStanislaw Gruszka/*
7804136c4224ccf1907d309e1cdfaefef9da97dbc5eStanislaw Gruszka * Only call this function when a scan can't be queued -- under RTNL.
7814136c4224ccf1907d309e1cdfaefef9da97dbc5eStanislaw Gruszka */
7825bb644a0fd25a5e083ecbfaa92a211db99aa6ef7Johannes Bergvoid ieee80211_scan_cancel(struct ieee80211_local *local)
7835bb644a0fd25a5e083ecbfaa92a211db99aa6ef7Johannes Berg{
7845bb644a0fd25a5e083ecbfaa92a211db99aa6ef7Johannes Berg	/*
785b856439b1b54358e580aaee5dbe683af5ada9403Eliad Peller	 * We are canceling software scan, or deferred scan that was not
7864136c4224ccf1907d309e1cdfaefef9da97dbc5eStanislaw Gruszka	 * yet really started (see __ieee80211_start_scan ).
7874136c4224ccf1907d309e1cdfaefef9da97dbc5eStanislaw Gruszka	 *
7884136c4224ccf1907d309e1cdfaefef9da97dbc5eStanislaw Gruszka	 * Regarding hardware scan:
7894136c4224ccf1907d309e1cdfaefef9da97dbc5eStanislaw Gruszka	 * - we can not call  __ieee80211_scan_completed() as when
7904136c4224ccf1907d309e1cdfaefef9da97dbc5eStanislaw Gruszka	 *   SCAN_HW_SCANNING bit is set this function change
7914136c4224ccf1907d309e1cdfaefef9da97dbc5eStanislaw Gruszka	 *   local->hw_scan_req to operate on 5G band, what race with
7924136c4224ccf1907d309e1cdfaefef9da97dbc5eStanislaw Gruszka	 *   driver which can use local->hw_scan_req
7934136c4224ccf1907d309e1cdfaefef9da97dbc5eStanislaw Gruszka	 *
7944136c4224ccf1907d309e1cdfaefef9da97dbc5eStanislaw Gruszka	 * - we can not cancel scan_work since driver can schedule it
7954136c4224ccf1907d309e1cdfaefef9da97dbc5eStanislaw Gruszka	 *   by ieee80211_scan_completed(..., true) to finish scan
7964136c4224ccf1907d309e1cdfaefef9da97dbc5eStanislaw Gruszka	 *
797b856439b1b54358e580aaee5dbe683af5ada9403Eliad Peller	 * Hence we only call the cancel_hw_scan() callback, but the low-level
798b856439b1b54358e580aaee5dbe683af5ada9403Eliad Peller	 * driver is still responsible for calling ieee80211_scan_completed()
799b856439b1b54358e580aaee5dbe683af5ada9403Eliad Peller	 * after the scan was completed/aborted.
8005bb644a0fd25a5e083ecbfaa92a211db99aa6ef7Johannes Berg	 */
8014136c4224ccf1907d309e1cdfaefef9da97dbc5eStanislaw Gruszka
802a1699b75a1db31a1da2f0fc610ee696d02a19280Johannes Berg	mutex_lock(&local->mtx);
803b856439b1b54358e580aaee5dbe683af5ada9403Eliad Peller	if (!local->scan_req)
804b856439b1b54358e580aaee5dbe683af5ada9403Eliad Peller		goto out;
805b856439b1b54358e580aaee5dbe683af5ada9403Eliad Peller
806b856439b1b54358e580aaee5dbe683af5ada9403Eliad Peller	if (test_bit(SCAN_HW_SCANNING, &local->scanning)) {
807b856439b1b54358e580aaee5dbe683af5ada9403Eliad Peller		if (local->ops->cancel_hw_scan)
808b856439b1b54358e580aaee5dbe683af5ada9403Eliad Peller			drv_cancel_hw_scan(local, local->scan_sdata);
809b856439b1b54358e580aaee5dbe683af5ada9403Eliad Peller		goto out;
8104136c4224ccf1907d309e1cdfaefef9da97dbc5eStanislaw Gruszka	}
811b856439b1b54358e580aaee5dbe683af5ada9403Eliad Peller
812b856439b1b54358e580aaee5dbe683af5ada9403Eliad Peller	/*
813b856439b1b54358e580aaee5dbe683af5ada9403Eliad Peller	 * If the work is currently running, it must be blocked on
814b856439b1b54358e580aaee5dbe683af5ada9403Eliad Peller	 * the mutex, but we'll set scan_sdata = NULL and it'll
815b856439b1b54358e580aaee5dbe683af5ada9403Eliad Peller	 * simply exit once it acquires the mutex.
816b856439b1b54358e580aaee5dbe683af5ada9403Eliad Peller	 */
817b856439b1b54358e580aaee5dbe683af5ada9403Eliad Peller	cancel_delayed_work(&local->scan_work);
818b856439b1b54358e580aaee5dbe683af5ada9403Eliad Peller	/* and clean up */
819b856439b1b54358e580aaee5dbe683af5ada9403Eliad Peller	__ieee80211_scan_completed(&local->hw, true, false);
820b856439b1b54358e580aaee5dbe683af5ada9403Eliad Pellerout:
821d07bfd8b6f20a81d7ec65c50f35b053d9e3aa740Johannes Berg	mutex_unlock(&local->mtx);
8225bb644a0fd25a5e083ecbfaa92a211db99aa6ef7Johannes Berg}
82379f460ca49d8d5700756ab7071c951311c7f29ccLuciano Coelho
82479f460ca49d8d5700756ab7071c951311c7f29ccLuciano Coelhoint ieee80211_request_sched_scan_start(struct ieee80211_sub_if_data *sdata,
82579f460ca49d8d5700756ab7071c951311c7f29ccLuciano Coelho				       struct cfg80211_sched_scan_request *req)
82679f460ca49d8d5700756ab7071c951311c7f29ccLuciano Coelho{
82779f460ca49d8d5700756ab7071c951311c7f29ccLuciano Coelho	struct ieee80211_local *local = sdata->local;
82879f460ca49d8d5700756ab7071c951311c7f29ccLuciano Coelho	int ret, i;
82979f460ca49d8d5700756ab7071c951311c7f29ccLuciano Coelho
83079f460ca49d8d5700756ab7071c951311c7f29ccLuciano Coelho	mutex_lock(&sdata->local->mtx);
83179f460ca49d8d5700756ab7071c951311c7f29ccLuciano Coelho
83279f460ca49d8d5700756ab7071c951311c7f29ccLuciano Coelho	if (local->sched_scanning) {
83379f460ca49d8d5700756ab7071c951311c7f29ccLuciano Coelho		ret = -EBUSY;
83479f460ca49d8d5700756ab7071c951311c7f29ccLuciano Coelho		goto out;
83579f460ca49d8d5700756ab7071c951311c7f29ccLuciano Coelho	}
83679f460ca49d8d5700756ab7071c951311c7f29ccLuciano Coelho
83779f460ca49d8d5700756ab7071c951311c7f29ccLuciano Coelho	if (!local->ops->sched_scan_start) {
83879f460ca49d8d5700756ab7071c951311c7f29ccLuciano Coelho		ret = -ENOTSUPP;
83979f460ca49d8d5700756ab7071c951311c7f29ccLuciano Coelho		goto out;
84079f460ca49d8d5700756ab7071c951311c7f29ccLuciano Coelho	}
84179f460ca49d8d5700756ab7071c951311c7f29ccLuciano Coelho
84279f460ca49d8d5700756ab7071c951311c7f29ccLuciano Coelho	for (i = 0; i < IEEE80211_NUM_BANDS; i++) {
84379f460ca49d8d5700756ab7071c951311c7f29ccLuciano Coelho		local->sched_scan_ies.ie[i] = kzalloc(2 +
84479f460ca49d8d5700756ab7071c951311c7f29ccLuciano Coelho						      IEEE80211_MAX_SSID_LEN +
8451186980dafcd14d0e257a4dd6990cefdc6f3e362Luciano Coelho						      local->scan_ies_len +
8461186980dafcd14d0e257a4dd6990cefdc6f3e362Luciano Coelho						      req->ie_len,
84779f460ca49d8d5700756ab7071c951311c7f29ccLuciano Coelho						      GFP_KERNEL);
84879f460ca49d8d5700756ab7071c951311c7f29ccLuciano Coelho		if (!local->sched_scan_ies.ie[i]) {
84979f460ca49d8d5700756ab7071c951311c7f29ccLuciano Coelho			ret = -ENOMEM;
85079f460ca49d8d5700756ab7071c951311c7f29ccLuciano Coelho			goto out_free;
85179f460ca49d8d5700756ab7071c951311c7f29ccLuciano Coelho		}
85279f460ca49d8d5700756ab7071c951311c7f29ccLuciano Coelho
85379f460ca49d8d5700756ab7071c951311c7f29ccLuciano Coelho		local->sched_scan_ies.len[i] =
85479f460ca49d8d5700756ab7071c951311c7f29ccLuciano Coelho			ieee80211_build_preq_ies(local,
85579f460ca49d8d5700756ab7071c951311c7f29ccLuciano Coelho						 local->sched_scan_ies.ie[i],
85679f460ca49d8d5700756ab7071c951311c7f29ccLuciano Coelho						 req->ie, req->ie_len, i,
85779f460ca49d8d5700756ab7071c951311c7f29ccLuciano Coelho						 (u32) -1, 0);
85879f460ca49d8d5700756ab7071c951311c7f29ccLuciano Coelho	}
85979f460ca49d8d5700756ab7071c951311c7f29ccLuciano Coelho
86079f460ca49d8d5700756ab7071c951311c7f29ccLuciano Coelho	ret = drv_sched_scan_start(local, sdata, req,
86179f460ca49d8d5700756ab7071c951311c7f29ccLuciano Coelho				   &local->sched_scan_ies);
86279f460ca49d8d5700756ab7071c951311c7f29ccLuciano Coelho	if (ret == 0) {
86379f460ca49d8d5700756ab7071c951311c7f29ccLuciano Coelho		local->sched_scanning = true;
86479f460ca49d8d5700756ab7071c951311c7f29ccLuciano Coelho		goto out;
86579f460ca49d8d5700756ab7071c951311c7f29ccLuciano Coelho	}
86679f460ca49d8d5700756ab7071c951311c7f29ccLuciano Coelho
86779f460ca49d8d5700756ab7071c951311c7f29ccLuciano Coelhoout_free:
86879f460ca49d8d5700756ab7071c951311c7f29ccLuciano Coelho	while (i > 0)
86979f460ca49d8d5700756ab7071c951311c7f29ccLuciano Coelho		kfree(local->sched_scan_ies.ie[--i]);
87079f460ca49d8d5700756ab7071c951311c7f29ccLuciano Coelhoout:
87179f460ca49d8d5700756ab7071c951311c7f29ccLuciano Coelho	mutex_unlock(&sdata->local->mtx);
87279f460ca49d8d5700756ab7071c951311c7f29ccLuciano Coelho	return ret;
87379f460ca49d8d5700756ab7071c951311c7f29ccLuciano Coelho}
87479f460ca49d8d5700756ab7071c951311c7f29ccLuciano Coelho
87585a9994a0a6cba1a6cc6af4bd3ebd85f778be0feLuciano Coelhoint ieee80211_request_sched_scan_stop(struct ieee80211_sub_if_data *sdata)
87679f460ca49d8d5700756ab7071c951311c7f29ccLuciano Coelho{
87779f460ca49d8d5700756ab7071c951311c7f29ccLuciano Coelho	struct ieee80211_local *local = sdata->local;
87879f460ca49d8d5700756ab7071c951311c7f29ccLuciano Coelho	int ret = 0, i;
87979f460ca49d8d5700756ab7071c951311c7f29ccLuciano Coelho
88079f460ca49d8d5700756ab7071c951311c7f29ccLuciano Coelho	mutex_lock(&sdata->local->mtx);
88179f460ca49d8d5700756ab7071c951311c7f29ccLuciano Coelho
88279f460ca49d8d5700756ab7071c951311c7f29ccLuciano Coelho	if (!local->ops->sched_scan_stop) {
88379f460ca49d8d5700756ab7071c951311c7f29ccLuciano Coelho		ret = -ENOTSUPP;
88479f460ca49d8d5700756ab7071c951311c7f29ccLuciano Coelho		goto out;
88579f460ca49d8d5700756ab7071c951311c7f29ccLuciano Coelho	}
88679f460ca49d8d5700756ab7071c951311c7f29ccLuciano Coelho
88779f460ca49d8d5700756ab7071c951311c7f29ccLuciano Coelho	if (local->sched_scanning) {
88879f460ca49d8d5700756ab7071c951311c7f29ccLuciano Coelho		for (i = 0; i < IEEE80211_NUM_BANDS; i++)
88979f460ca49d8d5700756ab7071c951311c7f29ccLuciano Coelho			kfree(local->sched_scan_ies.ie[i]);
89079f460ca49d8d5700756ab7071c951311c7f29ccLuciano Coelho
89185a9994a0a6cba1a6cc6af4bd3ebd85f778be0feLuciano Coelho		drv_sched_scan_stop(local, sdata);
89279f460ca49d8d5700756ab7071c951311c7f29ccLuciano Coelho		local->sched_scanning = false;
89379f460ca49d8d5700756ab7071c951311c7f29ccLuciano Coelho	}
89479f460ca49d8d5700756ab7071c951311c7f29ccLuciano Coelhoout:
89579f460ca49d8d5700756ab7071c951311c7f29ccLuciano Coelho	mutex_unlock(&sdata->local->mtx);
89679f460ca49d8d5700756ab7071c951311c7f29ccLuciano Coelho
89779f460ca49d8d5700756ab7071c951311c7f29ccLuciano Coelho	return ret;
89879f460ca49d8d5700756ab7071c951311c7f29ccLuciano Coelho}
89979f460ca49d8d5700756ab7071c951311c7f29ccLuciano Coelho
90079f460ca49d8d5700756ab7071c951311c7f29ccLuciano Coelhovoid ieee80211_sched_scan_results(struct ieee80211_hw *hw)
90179f460ca49d8d5700756ab7071c951311c7f29ccLuciano Coelho{
90279f460ca49d8d5700756ab7071c951311c7f29ccLuciano Coelho	struct ieee80211_local *local = hw_to_local(hw);
90379f460ca49d8d5700756ab7071c951311c7f29ccLuciano Coelho
90479f460ca49d8d5700756ab7071c951311c7f29ccLuciano Coelho	trace_api_sched_scan_results(local);
90579f460ca49d8d5700756ab7071c951311c7f29ccLuciano Coelho
90679f460ca49d8d5700756ab7071c951311c7f29ccLuciano Coelho	cfg80211_sched_scan_results(hw->wiphy);
90779f460ca49d8d5700756ab7071c951311c7f29ccLuciano Coelho}
90879f460ca49d8d5700756ab7071c951311c7f29ccLuciano CoelhoEXPORT_SYMBOL(ieee80211_sched_scan_results);
90979f460ca49d8d5700756ab7071c951311c7f29ccLuciano Coelho
91085a9994a0a6cba1a6cc6af4bd3ebd85f778be0feLuciano Coelhovoid ieee80211_sched_scan_stopped_work(struct work_struct *work)
91185a9994a0a6cba1a6cc6af4bd3ebd85f778be0feLuciano Coelho{
91285a9994a0a6cba1a6cc6af4bd3ebd85f778be0feLuciano Coelho	struct ieee80211_local *local =
91385a9994a0a6cba1a6cc6af4bd3ebd85f778be0feLuciano Coelho		container_of(work, struct ieee80211_local,
91485a9994a0a6cba1a6cc6af4bd3ebd85f778be0feLuciano Coelho			     sched_scan_stopped_work);
91585a9994a0a6cba1a6cc6af4bd3ebd85f778be0feLuciano Coelho	int i;
91685a9994a0a6cba1a6cc6af4bd3ebd85f778be0feLuciano Coelho
91785a9994a0a6cba1a6cc6af4bd3ebd85f778be0feLuciano Coelho	mutex_lock(&local->mtx);
91885a9994a0a6cba1a6cc6af4bd3ebd85f778be0feLuciano Coelho
91985a9994a0a6cba1a6cc6af4bd3ebd85f778be0feLuciano Coelho	if (!local->sched_scanning) {
92085a9994a0a6cba1a6cc6af4bd3ebd85f778be0feLuciano Coelho		mutex_unlock(&local->mtx);
92185a9994a0a6cba1a6cc6af4bd3ebd85f778be0feLuciano Coelho		return;
92285a9994a0a6cba1a6cc6af4bd3ebd85f778be0feLuciano Coelho	}
92385a9994a0a6cba1a6cc6af4bd3ebd85f778be0feLuciano Coelho
92485a9994a0a6cba1a6cc6af4bd3ebd85f778be0feLuciano Coelho	for (i = 0; i < IEEE80211_NUM_BANDS; i++)
92585a9994a0a6cba1a6cc6af4bd3ebd85f778be0feLuciano Coelho		kfree(local->sched_scan_ies.ie[i]);
92685a9994a0a6cba1a6cc6af4bd3ebd85f778be0feLuciano Coelho
92785a9994a0a6cba1a6cc6af4bd3ebd85f778be0feLuciano Coelho	local->sched_scanning = false;
92885a9994a0a6cba1a6cc6af4bd3ebd85f778be0feLuciano Coelho
92985a9994a0a6cba1a6cc6af4bd3ebd85f778be0feLuciano Coelho	mutex_unlock(&local->mtx);
93085a9994a0a6cba1a6cc6af4bd3ebd85f778be0feLuciano Coelho
93185a9994a0a6cba1a6cc6af4bd3ebd85f778be0feLuciano Coelho	cfg80211_sched_scan_stopped(local->hw.wiphy);
93285a9994a0a6cba1a6cc6af4bd3ebd85f778be0feLuciano Coelho}
93385a9994a0a6cba1a6cc6af4bd3ebd85f778be0feLuciano Coelho
93479f460ca49d8d5700756ab7071c951311c7f29ccLuciano Coelhovoid ieee80211_sched_scan_stopped(struct ieee80211_hw *hw)
93579f460ca49d8d5700756ab7071c951311c7f29ccLuciano Coelho{
93679f460ca49d8d5700756ab7071c951311c7f29ccLuciano Coelho	struct ieee80211_local *local = hw_to_local(hw);
93779f460ca49d8d5700756ab7071c951311c7f29ccLuciano Coelho
93879f460ca49d8d5700756ab7071c951311c7f29ccLuciano Coelho	trace_api_sched_scan_stopped(local);
93979f460ca49d8d5700756ab7071c951311c7f29ccLuciano Coelho
94085a9994a0a6cba1a6cc6af4bd3ebd85f778be0feLuciano Coelho	ieee80211_queue_work(&local->hw, &local->sched_scan_stopped_work);
94179f460ca49d8d5700756ab7071c951311c7f29ccLuciano Coelho}
94279f460ca49d8d5700756ab7071c951311c7f29ccLuciano CoelhoEXPORT_SYMBOL(ieee80211_sched_scan_stopped);
943