scan.c revision 4136c4224ccf1907d309e1cdfaefef9da97dbc5e
10a51b27e956bd9580296c48191b78175ed8b5971Johannes Berg/*
25484e23749e78d5a4f56928efaf3c4b0d862b7a6Johannes Berg * Scanning implementation
35484e23749e78d5a4f56928efaf3c4b0d862b7a6Johannes Berg *
40a51b27e956bd9580296c48191b78175ed8b5971Johannes Berg * Copyright 2003, Jouni Malinen <jkmaline@cc.hut.fi>
50a51b27e956bd9580296c48191b78175ed8b5971Johannes Berg * Copyright 2004, Instant802 Networks, Inc.
60a51b27e956bd9580296c48191b78175ed8b5971Johannes Berg * Copyright 2005, Devicescape Software, Inc.
70a51b27e956bd9580296c48191b78175ed8b5971Johannes Berg * Copyright 2006-2007	Jiri Benc <jbenc@suse.cz>
80a51b27e956bd9580296c48191b78175ed8b5971Johannes Berg * Copyright 2007, Michael Wu <flamingice@sourmilk.net>
90a51b27e956bd9580296c48191b78175ed8b5971Johannes Berg *
100a51b27e956bd9580296c48191b78175ed8b5971Johannes Berg * This program is free software; you can redistribute it and/or modify
110a51b27e956bd9580296c48191b78175ed8b5971Johannes Berg * it under the terms of the GNU General Public License version 2 as
120a51b27e956bd9580296c48191b78175ed8b5971Johannes Berg * published by the Free Software Foundation.
130a51b27e956bd9580296c48191b78175ed8b5971Johannes Berg */
140a51b27e956bd9580296c48191b78175ed8b5971Johannes Berg
150a51b27e956bd9580296c48191b78175ed8b5971Johannes Berg#include <linux/if_arp.h>
16078e1e60dd6c6b0d4bc8d58ccb80c008e8efc9ffJohannes Berg#include <linux/rtnetlink.h>
17df13cce53a7b28a81460e6bfc4857e9df4956141Helmut Schaa#include <linux/pm_qos_params.h>
18df13cce53a7b28a81460e6bfc4857e9df4956141Helmut Schaa#include <net/sch_generic.h>
195a0e3ad6af8660be21ca98a971cd00f331318c05Tejun Heo#include <linux/slab.h>
200a51b27e956bd9580296c48191b78175ed8b5971Johannes Berg#include <net/mac80211.h>
210a51b27e956bd9580296c48191b78175ed8b5971Johannes Berg
220a51b27e956bd9580296c48191b78175ed8b5971Johannes Berg#include "ieee80211_i.h"
232448798133d747ad339e57099e32a1d1e68aca1cJohannes Berg#include "driver-ops.h"
245484e23749e78d5a4f56928efaf3c4b0d862b7a6Johannes Berg#include "mesh.h"
250a51b27e956bd9580296c48191b78175ed8b5971Johannes Berg
260a51b27e956bd9580296c48191b78175ed8b5971Johannes Berg#define IEEE80211_PROBE_DELAY (HZ / 33)
270a51b27e956bd9580296c48191b78175ed8b5971Johannes Berg#define IEEE80211_CHANNEL_TIME (HZ / 33)
2896f7e73938da744e718ce4817dd3e7e424624654Helmut Schaa#define IEEE80211_PASSIVE_CHANNEL_TIME (HZ / 8)
290a51b27e956bd9580296c48191b78175ed8b5971Johannes Berg
30c2b13452b283f9c4a5b02a6b53ed6416ebf4c03cJohannes Bergstruct ieee80211_bss *
315484e23749e78d5a4f56928efaf3c4b0d862b7a6Johannes Bergieee80211_rx_bss_get(struct ieee80211_local *local, u8 *bssid, int freq,
325484e23749e78d5a4f56928efaf3c4b0d862b7a6Johannes Berg		     u8 *ssid, u8 ssid_len)
335484e23749e78d5a4f56928efaf3c4b0d862b7a6Johannes Berg{
340c1ad2cac1cb54db38fd4cc1822965071ee83f6eJohannes Berg	struct cfg80211_bss *cbss;
350c1ad2cac1cb54db38fd4cc1822965071ee83f6eJohannes Berg
360c1ad2cac1cb54db38fd4cc1822965071ee83f6eJohannes Berg	cbss = cfg80211_get_bss(local->hw.wiphy,
370c1ad2cac1cb54db38fd4cc1822965071ee83f6eJohannes Berg				ieee80211_get_channel(local->hw.wiphy, freq),
380c1ad2cac1cb54db38fd4cc1822965071ee83f6eJohannes Berg				bssid, ssid, ssid_len, 0, 0);
390c1ad2cac1cb54db38fd4cc1822965071ee83f6eJohannes Berg	if (!cbss)
400c1ad2cac1cb54db38fd4cc1822965071ee83f6eJohannes Berg		return NULL;
410c1ad2cac1cb54db38fd4cc1822965071ee83f6eJohannes Berg	return (void *)cbss->priv;
425484e23749e78d5a4f56928efaf3c4b0d862b7a6Johannes Berg}
435484e23749e78d5a4f56928efaf3c4b0d862b7a6Johannes Berg
4400d3f14cf9f12c21428121026a5e1d5f65926447Johannes Bergstatic void ieee80211_rx_bss_free(struct cfg80211_bss *cbss)
455484e23749e78d5a4f56928efaf3c4b0d862b7a6Johannes Berg{
460c1ad2cac1cb54db38fd4cc1822965071ee83f6eJohannes Berg	struct ieee80211_bss *bss = (void *)cbss->priv;
475484e23749e78d5a4f56928efaf3c4b0d862b7a6Johannes Berg
485484e23749e78d5a4f56928efaf3c4b0d862b7a6Johannes Berg	kfree(bss_mesh_id(bss));
495484e23749e78d5a4f56928efaf3c4b0d862b7a6Johannes Berg	kfree(bss_mesh_cfg(bss));
505484e23749e78d5a4f56928efaf3c4b0d862b7a6Johannes Berg}
515484e23749e78d5a4f56928efaf3c4b0d862b7a6Johannes Berg
525484e23749e78d5a4f56928efaf3c4b0d862b7a6Johannes Bergvoid ieee80211_rx_bss_put(struct ieee80211_local *local,
53c2b13452b283f9c4a5b02a6b53ed6416ebf4c03cJohannes Berg			  struct ieee80211_bss *bss)
545484e23749e78d5a4f56928efaf3c4b0d862b7a6Johannes Berg{
550c1ad2cac1cb54db38fd4cc1822965071ee83f6eJohannes Berg	if (!bss)
560c1ad2cac1cb54db38fd4cc1822965071ee83f6eJohannes Berg		return;
570c1ad2cac1cb54db38fd4cc1822965071ee83f6eJohannes Berg	cfg80211_put_bss(container_of((void *)bss, struct cfg80211_bss, priv));
585484e23749e78d5a4f56928efaf3c4b0d862b7a6Johannes Berg}
595484e23749e78d5a4f56928efaf3c4b0d862b7a6Johannes Berg
60ab13315af97919fae0e014748105fdc2e30afb2dKalle Valostatic bool is_uapsd_supported(struct ieee802_11_elems *elems)
61ab13315af97919fae0e014748105fdc2e30afb2dKalle Valo{
62ab13315af97919fae0e014748105fdc2e30afb2dKalle Valo	u8 qos_info;
63ab13315af97919fae0e014748105fdc2e30afb2dKalle Valo
64ab13315af97919fae0e014748105fdc2e30afb2dKalle Valo	if (elems->wmm_info && elems->wmm_info_len == 7
65ab13315af97919fae0e014748105fdc2e30afb2dKalle Valo	    && elems->wmm_info[5] == 1)
66ab13315af97919fae0e014748105fdc2e30afb2dKalle Valo		qos_info = elems->wmm_info[6];
67ab13315af97919fae0e014748105fdc2e30afb2dKalle Valo	else if (elems->wmm_param && elems->wmm_param_len == 24
68ab13315af97919fae0e014748105fdc2e30afb2dKalle Valo		 && elems->wmm_param[5] == 1)
69ab13315af97919fae0e014748105fdc2e30afb2dKalle Valo		qos_info = elems->wmm_param[6];
70ab13315af97919fae0e014748105fdc2e30afb2dKalle Valo	else
71ab13315af97919fae0e014748105fdc2e30afb2dKalle Valo		/* no valid wmm information or parameter element found */
72ab13315af97919fae0e014748105fdc2e30afb2dKalle Valo		return false;
73ab13315af97919fae0e014748105fdc2e30afb2dKalle Valo
74ab13315af97919fae0e014748105fdc2e30afb2dKalle Valo	return qos_info & IEEE80211_WMM_IE_AP_QOSINFO_UAPSD;
75ab13315af97919fae0e014748105fdc2e30afb2dKalle Valo}
76ab13315af97919fae0e014748105fdc2e30afb2dKalle Valo
77c2b13452b283f9c4a5b02a6b53ed6416ebf4c03cJohannes Bergstruct ieee80211_bss *
785484e23749e78d5a4f56928efaf3c4b0d862b7a6Johannes Bergieee80211_bss_info_update(struct ieee80211_local *local,
795484e23749e78d5a4f56928efaf3c4b0d862b7a6Johannes Berg			  struct ieee80211_rx_status *rx_status,
805484e23749e78d5a4f56928efaf3c4b0d862b7a6Johannes Berg			  struct ieee80211_mgmt *mgmt,
815484e23749e78d5a4f56928efaf3c4b0d862b7a6Johannes Berg			  size_t len,
825484e23749e78d5a4f56928efaf3c4b0d862b7a6Johannes Berg			  struct ieee802_11_elems *elems,
832a5193119269062608582418deba7af82844159aJohannes Berg			  struct ieee80211_channel *channel,
842a5193119269062608582418deba7af82844159aJohannes Berg			  bool beacon)
855484e23749e78d5a4f56928efaf3c4b0d862b7a6Johannes Berg{
860c1ad2cac1cb54db38fd4cc1822965071ee83f6eJohannes Berg	struct cfg80211_bss *cbss;
87c2b13452b283f9c4a5b02a6b53ed6416ebf4c03cJohannes Berg	struct ieee80211_bss *bss;
88f0b058b61711ebf5be94d6865ca7b2c259b71d37Stanislaw Gruszka	int clen, srlen;
892a5193119269062608582418deba7af82844159aJohannes Berg	s32 signal = 0;
902a5193119269062608582418deba7af82844159aJohannes Berg
9177965c970d7da9c9b6349ff2b1d9adecf54c403bJohannes Berg	if (local->hw.flags & IEEE80211_HW_SIGNAL_DBM)
922a5193119269062608582418deba7af82844159aJohannes Berg		signal = rx_status->signal * 100;
9377965c970d7da9c9b6349ff2b1d9adecf54c403bJohannes Berg	else if (local->hw.flags & IEEE80211_HW_SIGNAL_UNSPEC)
942a5193119269062608582418deba7af82844159aJohannes Berg		signal = (rx_status->signal * 100) / local->hw.max_signal;
952a5193119269062608582418deba7af82844159aJohannes Berg
960c1ad2cac1cb54db38fd4cc1822965071ee83f6eJohannes Berg	cbss = cfg80211_inform_bss_frame(local->hw.wiphy, channel,
970c1ad2cac1cb54db38fd4cc1822965071ee83f6eJohannes Berg					 mgmt, len, signal, GFP_ATOMIC);
985484e23749e78d5a4f56928efaf3c4b0d862b7a6Johannes Berg
990c1ad2cac1cb54db38fd4cc1822965071ee83f6eJohannes Berg	if (!cbss)
10000d3f14cf9f12c21428121026a5e1d5f65926447Johannes Berg		return NULL;
10100d3f14cf9f12c21428121026a5e1d5f65926447Johannes Berg
1020c1ad2cac1cb54db38fd4cc1822965071ee83f6eJohannes Berg	cbss->free_priv = ieee80211_rx_bss_free;
1030c1ad2cac1cb54db38fd4cc1822965071ee83f6eJohannes Berg	bss = (void *)cbss->priv;
1045484e23749e78d5a4f56928efaf3c4b0d862b7a6Johannes Berg
1055484e23749e78d5a4f56928efaf3c4b0d862b7a6Johannes Berg	/* save the ERP value so that it is available at association time */
1065484e23749e78d5a4f56928efaf3c4b0d862b7a6Johannes Berg	if (elems->erp_info && elems->erp_info_len >= 1) {
1075484e23749e78d5a4f56928efaf3c4b0d862b7a6Johannes Berg		bss->erp_value = elems->erp_info[0];
1085484e23749e78d5a4f56928efaf3c4b0d862b7a6Johannes Berg		bss->has_erp_value = 1;
1095484e23749e78d5a4f56928efaf3c4b0d862b7a6Johannes Berg	}
1105484e23749e78d5a4f56928efaf3c4b0d862b7a6Johannes Berg
1115484e23749e78d5a4f56928efaf3c4b0d862b7a6Johannes Berg	if (elems->tim) {
1125484e23749e78d5a4f56928efaf3c4b0d862b7a6Johannes Berg		struct ieee80211_tim_ie *tim_ie =
1135484e23749e78d5a4f56928efaf3c4b0d862b7a6Johannes Berg			(struct ieee80211_tim_ie *)elems->tim;
1145484e23749e78d5a4f56928efaf3c4b0d862b7a6Johannes Berg		bss->dtim_period = tim_ie->dtim_period;
1155484e23749e78d5a4f56928efaf3c4b0d862b7a6Johannes Berg	}
1165484e23749e78d5a4f56928efaf3c4b0d862b7a6Johannes Berg
117e5b900d228b76d445a4240d9aeb3cd8f79205a91Johannes Berg	/* If the beacon had no TIM IE, or it was invalid, use 1 */
118e5b900d228b76d445a4240d9aeb3cd8f79205a91Johannes Berg	if (beacon && !bss->dtim_period)
119e5b900d228b76d445a4240d9aeb3cd8f79205a91Johannes Berg		bss->dtim_period = 1;
120e5b900d228b76d445a4240d9aeb3cd8f79205a91Johannes Berg
121f0b058b61711ebf5be94d6865ca7b2c259b71d37Stanislaw Gruszka	/* replace old supported rates if we get new values */
122f0b058b61711ebf5be94d6865ca7b2c259b71d37Stanislaw Gruszka	srlen = 0;
1235484e23749e78d5a4f56928efaf3c4b0d862b7a6Johannes Berg	if (elems->supp_rates) {
124f0b058b61711ebf5be94d6865ca7b2c259b71d37Stanislaw Gruszka		clen = IEEE80211_MAX_SUPP_RATES;
1255484e23749e78d5a4f56928efaf3c4b0d862b7a6Johannes Berg		if (clen > elems->supp_rates_len)
1265484e23749e78d5a4f56928efaf3c4b0d862b7a6Johannes Berg			clen = elems->supp_rates_len;
127f0b058b61711ebf5be94d6865ca7b2c259b71d37Stanislaw Gruszka		memcpy(bss->supp_rates, elems->supp_rates, clen);
128f0b058b61711ebf5be94d6865ca7b2c259b71d37Stanislaw Gruszka		srlen += clen;
1295484e23749e78d5a4f56928efaf3c4b0d862b7a6Johannes Berg	}
1305484e23749e78d5a4f56928efaf3c4b0d862b7a6Johannes Berg	if (elems->ext_supp_rates) {
131f0b058b61711ebf5be94d6865ca7b2c259b71d37Stanislaw Gruszka		clen = IEEE80211_MAX_SUPP_RATES - srlen;
1325484e23749e78d5a4f56928efaf3c4b0d862b7a6Johannes Berg		if (clen > elems->ext_supp_rates_len)
1335484e23749e78d5a4f56928efaf3c4b0d862b7a6Johannes Berg			clen = elems->ext_supp_rates_len;
134f0b058b61711ebf5be94d6865ca7b2c259b71d37Stanislaw Gruszka		memcpy(bss->supp_rates + srlen, elems->ext_supp_rates, clen);
135f0b058b61711ebf5be94d6865ca7b2c259b71d37Stanislaw Gruszka		srlen += clen;
1365484e23749e78d5a4f56928efaf3c4b0d862b7a6Johannes Berg	}
137f0b058b61711ebf5be94d6865ca7b2c259b71d37Stanislaw Gruszka	if (srlen)
138f0b058b61711ebf5be94d6865ca7b2c259b71d37Stanislaw Gruszka		bss->supp_rates_len = srlen;
1395484e23749e78d5a4f56928efaf3c4b0d862b7a6Johannes Berg
1405484e23749e78d5a4f56928efaf3c4b0d862b7a6Johannes Berg	bss->wmm_used = elems->wmm_param || elems->wmm_info;
141ab13315af97919fae0e014748105fdc2e30afb2dKalle Valo	bss->uapsd_supported = is_uapsd_supported(elems);
1425484e23749e78d5a4f56928efaf3c4b0d862b7a6Johannes Berg
1435484e23749e78d5a4f56928efaf3c4b0d862b7a6Johannes Berg	if (!beacon)
1445484e23749e78d5a4f56928efaf3c4b0d862b7a6Johannes Berg		bss->last_probe_resp = jiffies;
1455484e23749e78d5a4f56928efaf3c4b0d862b7a6Johannes Berg
1465484e23749e78d5a4f56928efaf3c4b0d862b7a6Johannes Berg	return bss;
1475484e23749e78d5a4f56928efaf3c4b0d862b7a6Johannes Berg}
1480a51b27e956bd9580296c48191b78175ed8b5971Johannes Berg
14998c8fccfaea838e62ffde2f2e44568844e0e5472Johannes Bergieee80211_rx_result
150f1d58c2521eb160178b2151d6326d8dc5d7c8560Johannes Bergieee80211_scan_rx(struct ieee80211_sub_if_data *sdata, struct sk_buff *skb)
15198c8fccfaea838e62ffde2f2e44568844e0e5472Johannes Berg{
152f1d58c2521eb160178b2151d6326d8dc5d7c8560Johannes Berg	struct ieee80211_rx_status *rx_status = IEEE80211_SKB_RXCB(skb);
15398c8fccfaea838e62ffde2f2e44568844e0e5472Johannes Berg	struct ieee80211_mgmt *mgmt;
154c2b13452b283f9c4a5b02a6b53ed6416ebf4c03cJohannes Berg	struct ieee80211_bss *bss;
15598c8fccfaea838e62ffde2f2e44568844e0e5472Johannes Berg	u8 *elements;
15698c8fccfaea838e62ffde2f2e44568844e0e5472Johannes Berg	struct ieee80211_channel *channel;
15798c8fccfaea838e62ffde2f2e44568844e0e5472Johannes Berg	size_t baselen;
15898c8fccfaea838e62ffde2f2e44568844e0e5472Johannes Berg	int freq;
15998c8fccfaea838e62ffde2f2e44568844e0e5472Johannes Berg	__le16 fc;
16098c8fccfaea838e62ffde2f2e44568844e0e5472Johannes Berg	bool presp, beacon = false;
16198c8fccfaea838e62ffde2f2e44568844e0e5472Johannes Berg	struct ieee802_11_elems elems;
16298c8fccfaea838e62ffde2f2e44568844e0e5472Johannes Berg
16398c8fccfaea838e62ffde2f2e44568844e0e5472Johannes Berg	if (skb->len < 2)
16498c8fccfaea838e62ffde2f2e44568844e0e5472Johannes Berg		return RX_DROP_UNUSABLE;
16598c8fccfaea838e62ffde2f2e44568844e0e5472Johannes Berg
16698c8fccfaea838e62ffde2f2e44568844e0e5472Johannes Berg	mgmt = (struct ieee80211_mgmt *) skb->data;
16798c8fccfaea838e62ffde2f2e44568844e0e5472Johannes Berg	fc = mgmt->frame_control;
16898c8fccfaea838e62ffde2f2e44568844e0e5472Johannes Berg
16998c8fccfaea838e62ffde2f2e44568844e0e5472Johannes Berg	if (ieee80211_is_ctl(fc))
17098c8fccfaea838e62ffde2f2e44568844e0e5472Johannes Berg		return RX_CONTINUE;
17198c8fccfaea838e62ffde2f2e44568844e0e5472Johannes Berg
17298c8fccfaea838e62ffde2f2e44568844e0e5472Johannes Berg	if (skb->len < 24)
17398c8fccfaea838e62ffde2f2e44568844e0e5472Johannes Berg		return RX_DROP_MONITOR;
17498c8fccfaea838e62ffde2f2e44568844e0e5472Johannes Berg
17598c8fccfaea838e62ffde2f2e44568844e0e5472Johannes Berg	presp = ieee80211_is_probe_resp(fc);
17698c8fccfaea838e62ffde2f2e44568844e0e5472Johannes Berg	if (presp) {
17798c8fccfaea838e62ffde2f2e44568844e0e5472Johannes Berg		/* ignore ProbeResp to foreign address */
17847846c9b0c10808d9337d2e7d09361f3e0a0a71aJohannes Berg		if (memcmp(mgmt->da, sdata->vif.addr, ETH_ALEN))
17998c8fccfaea838e62ffde2f2e44568844e0e5472Johannes Berg			return RX_DROP_MONITOR;
18098c8fccfaea838e62ffde2f2e44568844e0e5472Johannes Berg
18198c8fccfaea838e62ffde2f2e44568844e0e5472Johannes Berg		presp = true;
18298c8fccfaea838e62ffde2f2e44568844e0e5472Johannes Berg		elements = mgmt->u.probe_resp.variable;
18398c8fccfaea838e62ffde2f2e44568844e0e5472Johannes Berg		baselen = offsetof(struct ieee80211_mgmt, u.probe_resp.variable);
18498c8fccfaea838e62ffde2f2e44568844e0e5472Johannes Berg	} else {
18598c8fccfaea838e62ffde2f2e44568844e0e5472Johannes Berg		beacon = ieee80211_is_beacon(fc);
18698c8fccfaea838e62ffde2f2e44568844e0e5472Johannes Berg		baselen = offsetof(struct ieee80211_mgmt, u.beacon.variable);
18798c8fccfaea838e62ffde2f2e44568844e0e5472Johannes Berg		elements = mgmt->u.beacon.variable;
18898c8fccfaea838e62ffde2f2e44568844e0e5472Johannes Berg	}
18998c8fccfaea838e62ffde2f2e44568844e0e5472Johannes Berg
19098c8fccfaea838e62ffde2f2e44568844e0e5472Johannes Berg	if (!presp && !beacon)
19198c8fccfaea838e62ffde2f2e44568844e0e5472Johannes Berg		return RX_CONTINUE;
19298c8fccfaea838e62ffde2f2e44568844e0e5472Johannes Berg
19398c8fccfaea838e62ffde2f2e44568844e0e5472Johannes Berg	if (baselen > skb->len)
19498c8fccfaea838e62ffde2f2e44568844e0e5472Johannes Berg		return RX_DROP_MONITOR;
19598c8fccfaea838e62ffde2f2e44568844e0e5472Johannes Berg
19698c8fccfaea838e62ffde2f2e44568844e0e5472Johannes Berg	ieee802_11_parse_elems(elements, skb->len - baselen, &elems);
19798c8fccfaea838e62ffde2f2e44568844e0e5472Johannes Berg
19898c8fccfaea838e62ffde2f2e44568844e0e5472Johannes Berg	if (elems.ds_params && elems.ds_params_len == 1)
19998c8fccfaea838e62ffde2f2e44568844e0e5472Johannes Berg		freq = ieee80211_channel_to_frequency(elems.ds_params[0]);
20098c8fccfaea838e62ffde2f2e44568844e0e5472Johannes Berg	else
20198c8fccfaea838e62ffde2f2e44568844e0e5472Johannes Berg		freq = rx_status->freq;
20298c8fccfaea838e62ffde2f2e44568844e0e5472Johannes Berg
20398c8fccfaea838e62ffde2f2e44568844e0e5472Johannes Berg	channel = ieee80211_get_channel(sdata->local->hw.wiphy, freq);
20498c8fccfaea838e62ffde2f2e44568844e0e5472Johannes Berg
20598c8fccfaea838e62ffde2f2e44568844e0e5472Johannes Berg	if (!channel || channel->flags & IEEE80211_CHAN_DISABLED)
20698c8fccfaea838e62ffde2f2e44568844e0e5472Johannes Berg		return RX_DROP_MONITOR;
20798c8fccfaea838e62ffde2f2e44568844e0e5472Johannes Berg
20898c8fccfaea838e62ffde2f2e44568844e0e5472Johannes Berg	bss = ieee80211_bss_info_update(sdata->local, rx_status,
20998c8fccfaea838e62ffde2f2e44568844e0e5472Johannes Berg					mgmt, skb->len, &elems,
2102a5193119269062608582418deba7af82844159aJohannes Berg					channel, beacon);
211d048e503a2b01e771ee87921c24d89d7ec3f0c2fJouni Malinen	if (bss)
212d048e503a2b01e771ee87921c24d89d7ec3f0c2fJouni Malinen		ieee80211_rx_bss_put(sdata->local, bss);
21398c8fccfaea838e62ffde2f2e44568844e0e5472Johannes Berg
21498c8fccfaea838e62ffde2f2e44568844e0e5472Johannes Berg	dev_kfree_skb(skb);
21598c8fccfaea838e62ffde2f2e44568844e0e5472Johannes Berg	return RX_QUEUED;
21698c8fccfaea838e62ffde2f2e44568844e0e5472Johannes Berg}
21798c8fccfaea838e62ffde2f2e44568844e0e5472Johannes Berg
2184d36ec58239eec44d77839ef6c25108efcbbb58cJohannes Berg/* return false if no more work */
2194d36ec58239eec44d77839ef6c25108efcbbb58cJohannes Bergstatic bool ieee80211_prep_hw_scan(struct ieee80211_local *local)
2204d36ec58239eec44d77839ef6c25108efcbbb58cJohannes Berg{
2214d36ec58239eec44d77839ef6c25108efcbbb58cJohannes Berg	struct cfg80211_scan_request *req = local->scan_req;
2224d36ec58239eec44d77839ef6c25108efcbbb58cJohannes Berg	enum ieee80211_band band;
2234d36ec58239eec44d77839ef6c25108efcbbb58cJohannes Berg	int i, ielen, n_chans;
2244d36ec58239eec44d77839ef6c25108efcbbb58cJohannes Berg
2254d36ec58239eec44d77839ef6c25108efcbbb58cJohannes Berg	do {
2264d36ec58239eec44d77839ef6c25108efcbbb58cJohannes Berg		if (local->hw_scan_band == IEEE80211_NUM_BANDS)
2274d36ec58239eec44d77839ef6c25108efcbbb58cJohannes Berg			return false;
2284d36ec58239eec44d77839ef6c25108efcbbb58cJohannes Berg
2294d36ec58239eec44d77839ef6c25108efcbbb58cJohannes Berg		band = local->hw_scan_band;
2304d36ec58239eec44d77839ef6c25108efcbbb58cJohannes Berg		n_chans = 0;
2314d36ec58239eec44d77839ef6c25108efcbbb58cJohannes Berg		for (i = 0; i < req->n_channels; i++) {
2324d36ec58239eec44d77839ef6c25108efcbbb58cJohannes Berg			if (req->channels[i]->band == band) {
2334d36ec58239eec44d77839ef6c25108efcbbb58cJohannes Berg				local->hw_scan_req->channels[n_chans] =
2344d36ec58239eec44d77839ef6c25108efcbbb58cJohannes Berg							req->channels[i];
2354d36ec58239eec44d77839ef6c25108efcbbb58cJohannes Berg				n_chans++;
2364d36ec58239eec44d77839ef6c25108efcbbb58cJohannes Berg			}
2374d36ec58239eec44d77839ef6c25108efcbbb58cJohannes Berg		}
2384d36ec58239eec44d77839ef6c25108efcbbb58cJohannes Berg
2394d36ec58239eec44d77839ef6c25108efcbbb58cJohannes Berg		local->hw_scan_band++;
2404d36ec58239eec44d77839ef6c25108efcbbb58cJohannes Berg	} while (!n_chans);
2414d36ec58239eec44d77839ef6c25108efcbbb58cJohannes Berg
2424d36ec58239eec44d77839ef6c25108efcbbb58cJohannes Berg	local->hw_scan_req->n_channels = n_chans;
2434d36ec58239eec44d77839ef6c25108efcbbb58cJohannes Berg
2444d36ec58239eec44d77839ef6c25108efcbbb58cJohannes Berg	ielen = ieee80211_build_preq_ies(local, (u8 *)local->hw_scan_req->ie,
245651b52254fc061f02d965524e71de4333a009a5aJouni Malinen					 req->ie, req->ie_len, band, (u32) -1,
246651b52254fc061f02d965524e71de4333a009a5aJouni Malinen					 0);
2474d36ec58239eec44d77839ef6c25108efcbbb58cJohannes Berg	local->hw_scan_req->ie_len = ielen;
2484d36ec58239eec44d77839ef6c25108efcbbb58cJohannes Berg
2494d36ec58239eec44d77839ef6c25108efcbbb58cJohannes Berg	return true;
2504d36ec58239eec44d77839ef6c25108efcbbb58cJohannes Berg}
2514d36ec58239eec44d77839ef6c25108efcbbb58cJohannes Berg
252e229f844d7223b7063bea1e649203ac521a58fe1Stanislaw Gruszkastatic bool __ieee80211_scan_completed(struct ieee80211_hw *hw, bool aborted,
253e229f844d7223b7063bea1e649203ac521a58fe1Stanislaw Gruszka				       bool was_hw_scan)
2540a51b27e956bd9580296c48191b78175ed8b5971Johannes Berg{
2550a51b27e956bd9580296c48191b78175ed8b5971Johannes Berg	struct ieee80211_local *local = hw_to_local(hw);
2560a51b27e956bd9580296c48191b78175ed8b5971Johannes Berg
257e229f844d7223b7063bea1e649203ac521a58fe1Stanislaw Gruszka	lockdep_assert_held(&local->mtx);
2585bc75728fd43bb15b46f16ef465bcf9d487393cfJohannes Berg
2596d3560d4fc9c5b9fe1a07a63926ea70512c69c32Johannes Berg	/*
2606d3560d4fc9c5b9fe1a07a63926ea70512c69c32Johannes Berg	 * It's ok to abort a not-yet-running scan (that
2616d3560d4fc9c5b9fe1a07a63926ea70512c69c32Johannes Berg	 * we have one at all will be verified by checking
2626d3560d4fc9c5b9fe1a07a63926ea70512c69c32Johannes Berg	 * local->scan_req next), but not to complete it
2636d3560d4fc9c5b9fe1a07a63926ea70512c69c32Johannes Berg	 * successfully.
2646d3560d4fc9c5b9fe1a07a63926ea70512c69c32Johannes Berg	 */
2656d3560d4fc9c5b9fe1a07a63926ea70512c69c32Johannes Berg	if (WARN_ON(!local->scanning && !aborted))
2666d3560d4fc9c5b9fe1a07a63926ea70512c69c32Johannes Berg		aborted = true;
2675bc75728fd43bb15b46f16ef465bcf9d487393cfJohannes Berg
268e229f844d7223b7063bea1e649203ac521a58fe1Stanislaw Gruszka	if (WARN_ON(!local->scan_req))
269e229f844d7223b7063bea1e649203ac521a58fe1Stanislaw Gruszka		return false;
270de95a54b1aebe5592cae971ca5e5d9ec6a381a17Johannes Berg
2714d36ec58239eec44d77839ef6c25108efcbbb58cJohannes Berg	if (was_hw_scan && !aborted && ieee80211_prep_hw_scan(local)) {
2724d36ec58239eec44d77839ef6c25108efcbbb58cJohannes Berg		ieee80211_queue_delayed_work(&local->hw,
2734d36ec58239eec44d77839ef6c25108efcbbb58cJohannes Berg					     &local->scan_work, 0);
274e229f844d7223b7063bea1e649203ac521a58fe1Stanislaw Gruszka		return false;
2754d36ec58239eec44d77839ef6c25108efcbbb58cJohannes Berg	}
2764d36ec58239eec44d77839ef6c25108efcbbb58cJohannes Berg
2774d36ec58239eec44d77839ef6c25108efcbbb58cJohannes Berg	kfree(local->hw_scan_req);
2784d36ec58239eec44d77839ef6c25108efcbbb58cJohannes Berg	local->hw_scan_req = NULL;
279f3b85252f081581a8f257545ed748062dce7798bJohannes Berg
2805ba63533bbf653631faab60f6988506160ec6ba4Johannes Berg	if (local->scan_req != local->int_scan_req)
2812a5193119269062608582418deba7af82844159aJohannes Berg		cfg80211_scan_done(local->scan_req, aborted);
2822a5193119269062608582418deba7af82844159aJohannes Berg	local->scan_req = NULL;
28315db0b7fd872b0312033666d3a82e1214a227ec0Johannes Berg	local->scan_sdata = NULL;
2842a5193119269062608582418deba7af82844159aJohannes Berg
285fbe9c429f195111bbf7f1630efa19aee295fd8e7Helmut Schaa	local->scanning = 0;
28658905ca5b11a0ff3860f55b789cbbf052f7158a7Johannes Berg	local->scan_channel = NULL;
287f3b85252f081581a8f257545ed748062dce7798bJohannes Berg
288e229f844d7223b7063bea1e649203ac521a58fe1Stanislaw Gruszka	return true;
289e229f844d7223b7063bea1e649203ac521a58fe1Stanislaw Gruszka}
2900a51b27e956bd9580296c48191b78175ed8b5971Johannes Berg
291e229f844d7223b7063bea1e649203ac521a58fe1Stanislaw Gruszkastatic void __ieee80211_scan_completed_finish(struct ieee80211_hw *hw,
292e229f844d7223b7063bea1e649203ac521a58fe1Stanislaw Gruszka					      bool was_hw_scan)
293e229f844d7223b7063bea1e649203ac521a58fe1Stanislaw Gruszka{
294e229f844d7223b7063bea1e649203ac521a58fe1Stanislaw Gruszka	struct ieee80211_local *local = hw_to_local(hw);
295a0daa0e7592ada797d6835f11529097aabc27ad2Luis R. Rodriguez
296e229f844d7223b7063bea1e649203ac521a58fe1Stanislaw Gruszka	ieee80211_hw_config(local, IEEE80211_CONF_CHANGE_CHANNEL);
297e229f844d7223b7063bea1e649203ac521a58fe1Stanislaw Gruszka	if (!was_hw_scan) {
298e229f844d7223b7063bea1e649203ac521a58fe1Stanislaw Gruszka		ieee80211_configure_filter(local);
299e229f844d7223b7063bea1e649203ac521a58fe1Stanislaw Gruszka		drv_sw_scan_complete(local);
300e229f844d7223b7063bea1e649203ac521a58fe1Stanislaw Gruszka		ieee80211_offchannel_return(local, true);
301e229f844d7223b7063bea1e649203ac521a58fe1Stanislaw Gruszka	}
3020a51b27e956bd9580296c48191b78175ed8b5971Johannes Berg
3037da7cc1d42d8ce02cca16df8c021e6d657f1f8fdJohannes Berg	mutex_lock(&local->mtx);
3045cff20e6c5a6591a79d3b027af222870f52bb550Johannes Berg	ieee80211_recalc_idle(local);
3057da7cc1d42d8ce02cca16df8c021e6d657f1f8fdJohannes Berg	mutex_unlock(&local->mtx);
306e229f844d7223b7063bea1e649203ac521a58fe1Stanislaw Gruszka
3070a51b27e956bd9580296c48191b78175ed8b5971Johannes Berg	ieee80211_mlme_notify_scan_completed(local);
308469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg	ieee80211_ibss_notify_scan_completed(local);
309472dbc45dc1966284de72d7de15690c17ed2cf33Johannes Berg	ieee80211_mesh_notify_scan_completed(local);
31081ac3462d346ee7aaf037a35156b0a7a354e98cfJohannes Berg	ieee80211_queue_work(&local->hw, &local->work_work);
3110a51b27e956bd9580296c48191b78175ed8b5971Johannes Berg}
3128789d459bc5e837bf37d261453df96ef54018d7bJohannes Berg
3138789d459bc5e837bf37d261453df96ef54018d7bJohannes Bergvoid ieee80211_scan_completed(struct ieee80211_hw *hw, bool aborted)
3148789d459bc5e837bf37d261453df96ef54018d7bJohannes Berg{
3158789d459bc5e837bf37d261453df96ef54018d7bJohannes Berg	struct ieee80211_local *local = hw_to_local(hw);
3168789d459bc5e837bf37d261453df96ef54018d7bJohannes Berg
3178789d459bc5e837bf37d261453df96ef54018d7bJohannes Berg	trace_api_scan_completed(local, aborted);
3188789d459bc5e837bf37d261453df96ef54018d7bJohannes Berg
3198789d459bc5e837bf37d261453df96ef54018d7bJohannes Berg	set_bit(SCAN_COMPLETED, &local->scanning);
3208789d459bc5e837bf37d261453df96ef54018d7bJohannes Berg	if (aborted)
3218789d459bc5e837bf37d261453df96ef54018d7bJohannes Berg		set_bit(SCAN_ABORTED, &local->scanning);
3228789d459bc5e837bf37d261453df96ef54018d7bJohannes Berg	ieee80211_queue_delayed_work(&local->hw, &local->scan_work, 0);
3238789d459bc5e837bf37d261453df96ef54018d7bJohannes Berg}
3240a51b27e956bd9580296c48191b78175ed8b5971Johannes BergEXPORT_SYMBOL(ieee80211_scan_completed);
3250a51b27e956bd9580296c48191b78175ed8b5971Johannes Berg
326f3b85252f081581a8f257545ed748062dce7798bJohannes Bergstatic int ieee80211_start_sw_scan(struct ieee80211_local *local)
327f3b85252f081581a8f257545ed748062dce7798bJohannes Berg{
328f3b85252f081581a8f257545ed748062dce7798bJohannes Berg	/*
329f3b85252f081581a8f257545ed748062dce7798bJohannes Berg	 * Hardware/driver doesn't support hw_scan, so use software
330f3b85252f081581a8f257545ed748062dce7798bJohannes Berg	 * scanning instead. First send a nullfunc frame with power save
331f3b85252f081581a8f257545ed748062dce7798bJohannes Berg	 * bit on so that AP will buffer the frames for us while we are not
332f3b85252f081581a8f257545ed748062dce7798bJohannes Berg	 * listening, then send probe requests to each channel and wait for
333f3b85252f081581a8f257545ed748062dce7798bJohannes Berg	 * the responses. After all channels are scanned, tune back to the
334f3b85252f081581a8f257545ed748062dce7798bJohannes Berg	 * original channel and send a nullfunc frame with power save bit
335f3b85252f081581a8f257545ed748062dce7798bJohannes Berg	 * off to trigger the AP to send us all the buffered frames.
336f3b85252f081581a8f257545ed748062dce7798bJohannes Berg	 *
337f3b85252f081581a8f257545ed748062dce7798bJohannes Berg	 * Note that while local->sw_scanning is true everything else but
338f3b85252f081581a8f257545ed748062dce7798bJohannes Berg	 * nullfunc frames and probe requests will be dropped in
339f3b85252f081581a8f257545ed748062dce7798bJohannes Berg	 * ieee80211_tx_h_check_assoc().
340f3b85252f081581a8f257545ed748062dce7798bJohannes Berg	 */
3412448798133d747ad339e57099e32a1d1e68aca1cJohannes Berg	drv_sw_scan_start(local);
342f3b85252f081581a8f257545ed748062dce7798bJohannes Berg
343b203ffc3a447eb8d9e6120b783ddee081b143061Jouni Malinen	ieee80211_offchannel_stop_beaconing(local);
344f3b85252f081581a8f257545ed748062dce7798bJohannes Berg
345df13cce53a7b28a81460e6bfc4857e9df4956141Helmut Schaa	local->leave_oper_channel_time = 0;
346977923b00c79185c11b4b47664f5ffa4c3820438Helmut Schaa	local->next_scan_state = SCAN_DECISION;
347f3b85252f081581a8f257545ed748062dce7798bJohannes Berg	local->scan_channel_idx = 0;
348f3b85252f081581a8f257545ed748062dce7798bJohannes Berg
349a80f7c0b088187c8471b441d461e937991870661Johannes Berg	drv_flush(local, false);
350a80f7c0b088187c8471b441d461e937991870661Johannes Berg
3513ac64beecd27400d12cc7afb4108eef26c499f6aJohannes Berg	ieee80211_configure_filter(local);
352f3b85252f081581a8f257545ed748062dce7798bJohannes Berg
35342935ecaf4e784d0815afa9a7e5fe7e141157ca3Luis R. Rodriguez	ieee80211_queue_delayed_work(&local->hw,
35442935ecaf4e784d0815afa9a7e5fe7e141157ca3Luis R. Rodriguez				     &local->scan_work,
35542935ecaf4e784d0815afa9a7e5fe7e141157ca3Luis R. Rodriguez				     IEEE80211_CHANNEL_TIME);
356f3b85252f081581a8f257545ed748062dce7798bJohannes Berg
357f3b85252f081581a8f257545ed748062dce7798bJohannes Berg	return 0;
358f3b85252f081581a8f257545ed748062dce7798bJohannes Berg}
359f3b85252f081581a8f257545ed748062dce7798bJohannes Berg
360f3b85252f081581a8f257545ed748062dce7798bJohannes Berg
361f3b85252f081581a8f257545ed748062dce7798bJohannes Bergstatic int __ieee80211_start_scan(struct ieee80211_sub_if_data *sdata,
362f3b85252f081581a8f257545ed748062dce7798bJohannes Berg				  struct cfg80211_scan_request *req)
363f3b85252f081581a8f257545ed748062dce7798bJohannes Berg{
364f3b85252f081581a8f257545ed748062dce7798bJohannes Berg	struct ieee80211_local *local = sdata->local;
365f3b85252f081581a8f257545ed748062dce7798bJohannes Berg	int rc;
366f3b85252f081581a8f257545ed748062dce7798bJohannes Berg
367e229f844d7223b7063bea1e649203ac521a58fe1Stanislaw Gruszka	lockdep_assert_held(&local->mtx);
368e229f844d7223b7063bea1e649203ac521a58fe1Stanislaw Gruszka
369f3b85252f081581a8f257545ed748062dce7798bJohannes Berg	if (local->scan_req)
370f3b85252f081581a8f257545ed748062dce7798bJohannes Berg		return -EBUSY;
371f3b85252f081581a8f257545ed748062dce7798bJohannes Berg
3726e7e6213e4956828927c30e3ef5a42812d00c650John W. Linville	if (!list_empty(&local->work_list)) {
3736e7e6213e4956828927c30e3ef5a42812d00c650John W. Linville		/* wait for the work to finish/time out */
374c0ce77b8323c1a0d4eeef97caf16c0ea971222a9Johannes Berg		local->scan_req = req;
375c0ce77b8323c1a0d4eeef97caf16c0ea971222a9Johannes Berg		local->scan_sdata = sdata;
376c0ce77b8323c1a0d4eeef97caf16c0ea971222a9Johannes Berg		return 0;
377c0ce77b8323c1a0d4eeef97caf16c0ea971222a9Johannes Berg	}
378c0ce77b8323c1a0d4eeef97caf16c0ea971222a9Johannes Berg
379f3b85252f081581a8f257545ed748062dce7798bJohannes Berg	if (local->ops->hw_scan) {
380f3b85252f081581a8f257545ed748062dce7798bJohannes Berg		u8 *ies;
381f3b85252f081581a8f257545ed748062dce7798bJohannes Berg
3824d36ec58239eec44d77839ef6c25108efcbbb58cJohannes Berg		local->hw_scan_req = kmalloc(
3834d36ec58239eec44d77839ef6c25108efcbbb58cJohannes Berg				sizeof(*local->hw_scan_req) +
3844d36ec58239eec44d77839ef6c25108efcbbb58cJohannes Berg				req->n_channels * sizeof(req->channels[0]) +
3854d36ec58239eec44d77839ef6c25108efcbbb58cJohannes Berg				2 + IEEE80211_MAX_SSID_LEN + local->scan_ies_len +
3864d36ec58239eec44d77839ef6c25108efcbbb58cJohannes Berg				req->ie_len, GFP_KERNEL);
3874d36ec58239eec44d77839ef6c25108efcbbb58cJohannes Berg		if (!local->hw_scan_req)
388f3b85252f081581a8f257545ed748062dce7798bJohannes Berg			return -ENOMEM;
389f3b85252f081581a8f257545ed748062dce7798bJohannes Berg
3904d36ec58239eec44d77839ef6c25108efcbbb58cJohannes Berg		local->hw_scan_req->ssids = req->ssids;
3914d36ec58239eec44d77839ef6c25108efcbbb58cJohannes Berg		local->hw_scan_req->n_ssids = req->n_ssids;
3924d36ec58239eec44d77839ef6c25108efcbbb58cJohannes Berg		ies = (u8 *)local->hw_scan_req +
3934d36ec58239eec44d77839ef6c25108efcbbb58cJohannes Berg			sizeof(*local->hw_scan_req) +
3944d36ec58239eec44d77839ef6c25108efcbbb58cJohannes Berg			req->n_channels * sizeof(req->channels[0]);
3954d36ec58239eec44d77839ef6c25108efcbbb58cJohannes Berg		local->hw_scan_req->ie = ies;
3964d36ec58239eec44d77839ef6c25108efcbbb58cJohannes Berg
3974d36ec58239eec44d77839ef6c25108efcbbb58cJohannes Berg		local->hw_scan_band = 0;
3986e7e6213e4956828927c30e3ef5a42812d00c650John W. Linville
3996e7e6213e4956828927c30e3ef5a42812d00c650John W. Linville		/*
4006e7e6213e4956828927c30e3ef5a42812d00c650John W. Linville		 * After allocating local->hw_scan_req, we must
4016e7e6213e4956828927c30e3ef5a42812d00c650John W. Linville		 * go through until ieee80211_prep_hw_scan(), so
4026e7e6213e4956828927c30e3ef5a42812d00c650John W. Linville		 * anything that might be changed here and leave
4036e7e6213e4956828927c30e3ef5a42812d00c650John W. Linville		 * this function early must not go after this
4046e7e6213e4956828927c30e3ef5a42812d00c650John W. Linville		 * allocation.
4056e7e6213e4956828927c30e3ef5a42812d00c650John W. Linville		 */
406f3b85252f081581a8f257545ed748062dce7798bJohannes Berg	}
407f3b85252f081581a8f257545ed748062dce7798bJohannes Berg
408f3b85252f081581a8f257545ed748062dce7798bJohannes Berg	local->scan_req = req;
409f3b85252f081581a8f257545ed748062dce7798bJohannes Berg	local->scan_sdata = sdata;
410f3b85252f081581a8f257545ed748062dce7798bJohannes Berg
411f3b85252f081581a8f257545ed748062dce7798bJohannes Berg	if (local->ops->hw_scan)
412fbe9c429f195111bbf7f1630efa19aee295fd8e7Helmut Schaa		__set_bit(SCAN_HW_SCANNING, &local->scanning);
413f3b85252f081581a8f257545ed748062dce7798bJohannes Berg	else
414fbe9c429f195111bbf7f1630efa19aee295fd8e7Helmut Schaa		__set_bit(SCAN_SW_SCANNING, &local->scanning);
4156e7e6213e4956828927c30e3ef5a42812d00c650John W. Linville
4165cff20e6c5a6591a79d3b027af222870f52bb550Johannes Berg	ieee80211_recalc_idle(local);
417f3b85252f081581a8f257545ed748062dce7798bJohannes Berg
4184d36ec58239eec44d77839ef6c25108efcbbb58cJohannes Berg	if (local->ops->hw_scan) {
4194d36ec58239eec44d77839ef6c25108efcbbb58cJohannes Berg		WARN_ON(!ieee80211_prep_hw_scan(local));
420a060bbfe4ee95d115e8f9705a66894ac34e2c475Johannes Berg		rc = drv_hw_scan(local, sdata, local->hw_scan_req);
4214d36ec58239eec44d77839ef6c25108efcbbb58cJohannes Berg	} else
422f3b85252f081581a8f257545ed748062dce7798bJohannes Berg		rc = ieee80211_start_sw_scan(local);
423f3b85252f081581a8f257545ed748062dce7798bJohannes Berg
424f3b85252f081581a8f257545ed748062dce7798bJohannes Berg	if (rc) {
4254d36ec58239eec44d77839ef6c25108efcbbb58cJohannes Berg		kfree(local->hw_scan_req);
4264d36ec58239eec44d77839ef6c25108efcbbb58cJohannes Berg		local->hw_scan_req = NULL;
427fbe9c429f195111bbf7f1630efa19aee295fd8e7Helmut Schaa		local->scanning = 0;
428f3b85252f081581a8f257545ed748062dce7798bJohannes Berg
4295cff20e6c5a6591a79d3b027af222870f52bb550Johannes Berg		ieee80211_recalc_idle(local);
4305cff20e6c5a6591a79d3b027af222870f52bb550Johannes Berg
431f3b85252f081581a8f257545ed748062dce7798bJohannes Berg		local->scan_req = NULL;
432f3b85252f081581a8f257545ed748062dce7798bJohannes Berg		local->scan_sdata = NULL;
433f3b85252f081581a8f257545ed748062dce7798bJohannes Berg	}
434f3b85252f081581a8f257545ed748062dce7798bJohannes Berg
435f3b85252f081581a8f257545ed748062dce7798bJohannes Berg	return rc;
436f3b85252f081581a8f257545ed748062dce7798bJohannes Berg}
437f3b85252f081581a8f257545ed748062dce7798bJohannes Berg
438df13cce53a7b28a81460e6bfc4857e9df4956141Helmut Schaastatic unsigned long
439df13cce53a7b28a81460e6bfc4857e9df4956141Helmut Schaaieee80211_scan_get_channel_time(struct ieee80211_channel *chan)
440df13cce53a7b28a81460e6bfc4857e9df4956141Helmut Schaa{
441df13cce53a7b28a81460e6bfc4857e9df4956141Helmut Schaa	/*
442df13cce53a7b28a81460e6bfc4857e9df4956141Helmut Schaa	 * TODO: channel switching also consumes quite some time,
443df13cce53a7b28a81460e6bfc4857e9df4956141Helmut Schaa	 * add that delay as well to get a better estimation
444df13cce53a7b28a81460e6bfc4857e9df4956141Helmut Schaa	 */
445df13cce53a7b28a81460e6bfc4857e9df4956141Helmut Schaa	if (chan->flags & IEEE80211_CHAN_PASSIVE_SCAN)
446df13cce53a7b28a81460e6bfc4857e9df4956141Helmut Schaa		return IEEE80211_PASSIVE_CHANNEL_TIME;
447df13cce53a7b28a81460e6bfc4857e9df4956141Helmut Schaa	return IEEE80211_PROBE_DELAY + IEEE80211_CHANNEL_TIME;
448df13cce53a7b28a81460e6bfc4857e9df4956141Helmut Schaa}
449df13cce53a7b28a81460e6bfc4857e9df4956141Helmut Schaa
450e229f844d7223b7063bea1e649203ac521a58fe1Stanislaw Gruszkastatic void ieee80211_scan_state_decision(struct ieee80211_local *local,
451e229f844d7223b7063bea1e649203ac521a58fe1Stanislaw Gruszka					  unsigned long *next_delay)
4527d3be3cc489176bc7bd23e673b0b4aef597af2b3Helmut Schaa{
453142b9f5074dc0d09dc0025739ad437723d7bf527Helmut Schaa	bool associated = false;
454df13cce53a7b28a81460e6bfc4857e9df4956141Helmut Schaa	bool tx_empty = true;
455df13cce53a7b28a81460e6bfc4857e9df4956141Helmut Schaa	bool bad_latency;
456df13cce53a7b28a81460e6bfc4857e9df4956141Helmut Schaa	bool listen_int_exceeded;
457df13cce53a7b28a81460e6bfc4857e9df4956141Helmut Schaa	unsigned long min_beacon_int = 0;
458142b9f5074dc0d09dc0025739ad437723d7bf527Helmut Schaa	struct ieee80211_sub_if_data *sdata;
459df13cce53a7b28a81460e6bfc4857e9df4956141Helmut Schaa	struct ieee80211_channel *next_chan;
460142b9f5074dc0d09dc0025739ad437723d7bf527Helmut Schaa
461df13cce53a7b28a81460e6bfc4857e9df4956141Helmut Schaa	/*
462df13cce53a7b28a81460e6bfc4857e9df4956141Helmut Schaa	 * check if at least one STA interface is associated,
463df13cce53a7b28a81460e6bfc4857e9df4956141Helmut Schaa	 * check if at least one STA interface has pending tx frames
464df13cce53a7b28a81460e6bfc4857e9df4956141Helmut Schaa	 * and grab the lowest used beacon interval
465df13cce53a7b28a81460e6bfc4857e9df4956141Helmut Schaa	 */
466142b9f5074dc0d09dc0025739ad437723d7bf527Helmut Schaa	mutex_lock(&local->iflist_mtx);
467142b9f5074dc0d09dc0025739ad437723d7bf527Helmut Schaa	list_for_each_entry(sdata, &local->interfaces, list) {
4689607e6b66a0d25ca63b70d54a4283fa13d8f7c9dJohannes Berg		if (!ieee80211_sdata_running(sdata))
469142b9f5074dc0d09dc0025739ad437723d7bf527Helmut Schaa			continue;
470142b9f5074dc0d09dc0025739ad437723d7bf527Helmut Schaa
471142b9f5074dc0d09dc0025739ad437723d7bf527Helmut Schaa		if (sdata->vif.type == NL80211_IFTYPE_STATION) {
472142b9f5074dc0d09dc0025739ad437723d7bf527Helmut Schaa			if (sdata->u.mgd.associated) {
473142b9f5074dc0d09dc0025739ad437723d7bf527Helmut Schaa				associated = true;
474df13cce53a7b28a81460e6bfc4857e9df4956141Helmut Schaa
475df13cce53a7b28a81460e6bfc4857e9df4956141Helmut Schaa				if (sdata->vif.bss_conf.beacon_int <
476df13cce53a7b28a81460e6bfc4857e9df4956141Helmut Schaa				    min_beacon_int || min_beacon_int == 0)
477df13cce53a7b28a81460e6bfc4857e9df4956141Helmut Schaa					min_beacon_int =
478df13cce53a7b28a81460e6bfc4857e9df4956141Helmut Schaa						sdata->vif.bss_conf.beacon_int;
479df13cce53a7b28a81460e6bfc4857e9df4956141Helmut Schaa
480df13cce53a7b28a81460e6bfc4857e9df4956141Helmut Schaa				if (!qdisc_all_tx_empty(sdata->dev)) {
481df13cce53a7b28a81460e6bfc4857e9df4956141Helmut Schaa					tx_empty = false;
482df13cce53a7b28a81460e6bfc4857e9df4956141Helmut Schaa					break;
483df13cce53a7b28a81460e6bfc4857e9df4956141Helmut Schaa				}
484142b9f5074dc0d09dc0025739ad437723d7bf527Helmut Schaa			}
485142b9f5074dc0d09dc0025739ad437723d7bf527Helmut Schaa		}
486142b9f5074dc0d09dc0025739ad437723d7bf527Helmut Schaa	}
487142b9f5074dc0d09dc0025739ad437723d7bf527Helmut Schaa	mutex_unlock(&local->iflist_mtx);
488142b9f5074dc0d09dc0025739ad437723d7bf527Helmut Schaa
489142b9f5074dc0d09dc0025739ad437723d7bf527Helmut Schaa	if (local->scan_channel) {
490142b9f5074dc0d09dc0025739ad437723d7bf527Helmut Schaa		/*
491142b9f5074dc0d09dc0025739ad437723d7bf527Helmut Schaa		 * we're currently scanning a different channel, let's
492df13cce53a7b28a81460e6bfc4857e9df4956141Helmut Schaa		 * see if we can scan another channel without interfering
493df13cce53a7b28a81460e6bfc4857e9df4956141Helmut Schaa		 * with the current traffic situation.
494df13cce53a7b28a81460e6bfc4857e9df4956141Helmut Schaa		 *
495df13cce53a7b28a81460e6bfc4857e9df4956141Helmut Schaa		 * Since we don't know if the AP has pending frames for us
496df13cce53a7b28a81460e6bfc4857e9df4956141Helmut Schaa		 * we can only check for our tx queues and use the current
497df13cce53a7b28a81460e6bfc4857e9df4956141Helmut Schaa		 * pm_qos requirements for rx. Hence, if no tx traffic occurs
498df13cce53a7b28a81460e6bfc4857e9df4956141Helmut Schaa		 * at all we will scan as many channels in a row as the pm_qos
499df13cce53a7b28a81460e6bfc4857e9df4956141Helmut Schaa		 * latency allows us to. Additionally we also check for the
500df13cce53a7b28a81460e6bfc4857e9df4956141Helmut Schaa		 * currently negotiated listen interval to prevent losing
501df13cce53a7b28a81460e6bfc4857e9df4956141Helmut Schaa		 * frames unnecessarily.
502df13cce53a7b28a81460e6bfc4857e9df4956141Helmut Schaa		 *
503df13cce53a7b28a81460e6bfc4857e9df4956141Helmut Schaa		 * Otherwise switch back to the operating channel.
504142b9f5074dc0d09dc0025739ad437723d7bf527Helmut Schaa		 */
505df13cce53a7b28a81460e6bfc4857e9df4956141Helmut Schaa		next_chan = local->scan_req->channels[local->scan_channel_idx];
506df13cce53a7b28a81460e6bfc4857e9df4956141Helmut Schaa
507df13cce53a7b28a81460e6bfc4857e9df4956141Helmut Schaa		bad_latency = time_after(jiffies +
508df13cce53a7b28a81460e6bfc4857e9df4956141Helmut Schaa				ieee80211_scan_get_channel_time(next_chan),
509df13cce53a7b28a81460e6bfc4857e9df4956141Helmut Schaa				local->leave_oper_channel_time +
510f8965467f366fd18f01feafb5db10512d7b4422cLinus Torvalds				usecs_to_jiffies(pm_qos_request(PM_QOS_NETWORK_LATENCY)));
511df13cce53a7b28a81460e6bfc4857e9df4956141Helmut Schaa
512df13cce53a7b28a81460e6bfc4857e9df4956141Helmut Schaa		listen_int_exceeded = time_after(jiffies +
513df13cce53a7b28a81460e6bfc4857e9df4956141Helmut Schaa				ieee80211_scan_get_channel_time(next_chan),
514df13cce53a7b28a81460e6bfc4857e9df4956141Helmut Schaa				local->leave_oper_channel_time +
515df13cce53a7b28a81460e6bfc4857e9df4956141Helmut Schaa				usecs_to_jiffies(min_beacon_int * 1024) *
516df13cce53a7b28a81460e6bfc4857e9df4956141Helmut Schaa				local->hw.conf.listen_interval);
517df13cce53a7b28a81460e6bfc4857e9df4956141Helmut Schaa
518df13cce53a7b28a81460e6bfc4857e9df4956141Helmut Schaa		if (associated && ( !tx_empty || bad_latency ||
519df13cce53a7b28a81460e6bfc4857e9df4956141Helmut Schaa		    listen_int_exceeded))
520977923b00c79185c11b4b47664f5ffa4c3820438Helmut Schaa			local->next_scan_state = SCAN_ENTER_OPER_CHANNEL;
521142b9f5074dc0d09dc0025739ad437723d7bf527Helmut Schaa		else
522977923b00c79185c11b4b47664f5ffa4c3820438Helmut Schaa			local->next_scan_state = SCAN_SET_CHANNEL;
523142b9f5074dc0d09dc0025739ad437723d7bf527Helmut Schaa	} else {
524142b9f5074dc0d09dc0025739ad437723d7bf527Helmut Schaa		/*
525142b9f5074dc0d09dc0025739ad437723d7bf527Helmut Schaa		 * we're on the operating channel currently, let's
526142b9f5074dc0d09dc0025739ad437723d7bf527Helmut Schaa		 * leave that channel now to scan another one
527142b9f5074dc0d09dc0025739ad437723d7bf527Helmut Schaa		 */
528977923b00c79185c11b4b47664f5ffa4c3820438Helmut Schaa		local->next_scan_state = SCAN_LEAVE_OPER_CHANNEL;
529142b9f5074dc0d09dc0025739ad437723d7bf527Helmut Schaa	}
530142b9f5074dc0d09dc0025739ad437723d7bf527Helmut Schaa
5312fb3f028a9a46bd344329766257699b4acb36525Helmut Schaa	*next_delay = 0;
5322fb3f028a9a46bd344329766257699b4acb36525Helmut Schaa}
5332fb3f028a9a46bd344329766257699b4acb36525Helmut Schaa
534142b9f5074dc0d09dc0025739ad437723d7bf527Helmut Schaastatic void ieee80211_scan_state_leave_oper_channel(struct ieee80211_local *local,
535142b9f5074dc0d09dc0025739ad437723d7bf527Helmut Schaa						    unsigned long *next_delay)
536142b9f5074dc0d09dc0025739ad437723d7bf527Helmut Schaa{
537b203ffc3a447eb8d9e6120b783ddee081b143061Jouni Malinen	ieee80211_offchannel_stop_station(local);
538142b9f5074dc0d09dc0025739ad437723d7bf527Helmut Schaa
539142b9f5074dc0d09dc0025739ad437723d7bf527Helmut Schaa	__set_bit(SCAN_OFF_CHANNEL, &local->scanning);
540142b9f5074dc0d09dc0025739ad437723d7bf527Helmut Schaa
541a80f7c0b088187c8471b441d461e937991870661Johannes Berg	/*
542a80f7c0b088187c8471b441d461e937991870661Johannes Berg	 * What if the nullfunc frames didn't arrive?
543a80f7c0b088187c8471b441d461e937991870661Johannes Berg	 */
544a80f7c0b088187c8471b441d461e937991870661Johannes Berg	drv_flush(local, false);
545a80f7c0b088187c8471b441d461e937991870661Johannes Berg	if (local->ops->flush)
546a80f7c0b088187c8471b441d461e937991870661Johannes Berg		*next_delay = 0;
547a80f7c0b088187c8471b441d461e937991870661Johannes Berg	else
548a80f7c0b088187c8471b441d461e937991870661Johannes Berg		*next_delay = HZ / 10;
549a80f7c0b088187c8471b441d461e937991870661Johannes Berg
550df13cce53a7b28a81460e6bfc4857e9df4956141Helmut Schaa	/* remember when we left the operating channel */
551df13cce53a7b28a81460e6bfc4857e9df4956141Helmut Schaa	local->leave_oper_channel_time = jiffies;
552df13cce53a7b28a81460e6bfc4857e9df4956141Helmut Schaa
553142b9f5074dc0d09dc0025739ad437723d7bf527Helmut Schaa	/* advance to the next channel to be scanned */
554977923b00c79185c11b4b47664f5ffa4c3820438Helmut Schaa	local->next_scan_state = SCAN_SET_CHANNEL;
555142b9f5074dc0d09dc0025739ad437723d7bf527Helmut Schaa}
556142b9f5074dc0d09dc0025739ad437723d7bf527Helmut Schaa
557142b9f5074dc0d09dc0025739ad437723d7bf527Helmut Schaastatic void ieee80211_scan_state_enter_oper_channel(struct ieee80211_local *local,
558142b9f5074dc0d09dc0025739ad437723d7bf527Helmut Schaa						    unsigned long *next_delay)
559142b9f5074dc0d09dc0025739ad437723d7bf527Helmut Schaa{
560142b9f5074dc0d09dc0025739ad437723d7bf527Helmut Schaa	/* switch back to the operating channel */
561142b9f5074dc0d09dc0025739ad437723d7bf527Helmut Schaa	local->scan_channel = NULL;
562142b9f5074dc0d09dc0025739ad437723d7bf527Helmut Schaa	ieee80211_hw_config(local, IEEE80211_CONF_CHANGE_CHANNEL);
563142b9f5074dc0d09dc0025739ad437723d7bf527Helmut Schaa
564142b9f5074dc0d09dc0025739ad437723d7bf527Helmut Schaa	/*
565b203ffc3a447eb8d9e6120b783ddee081b143061Jouni Malinen	 * Only re-enable station mode interface now; beaconing will be
566b203ffc3a447eb8d9e6120b783ddee081b143061Jouni Malinen	 * re-enabled once the full scan has been completed.
567142b9f5074dc0d09dc0025739ad437723d7bf527Helmut Schaa	 */
568b203ffc3a447eb8d9e6120b783ddee081b143061Jouni Malinen	ieee80211_offchannel_return(local, false);
569142b9f5074dc0d09dc0025739ad437723d7bf527Helmut Schaa
570142b9f5074dc0d09dc0025739ad437723d7bf527Helmut Schaa	__clear_bit(SCAN_OFF_CHANNEL, &local->scanning);
571142b9f5074dc0d09dc0025739ad437723d7bf527Helmut Schaa
572142b9f5074dc0d09dc0025739ad437723d7bf527Helmut Schaa	*next_delay = HZ / 5;
573977923b00c79185c11b4b47664f5ffa4c3820438Helmut Schaa	local->next_scan_state = SCAN_DECISION;
574142b9f5074dc0d09dc0025739ad437723d7bf527Helmut Schaa}
575142b9f5074dc0d09dc0025739ad437723d7bf527Helmut Schaa
5762fb3f028a9a46bd344329766257699b4acb36525Helmut Schaastatic void ieee80211_scan_state_set_channel(struct ieee80211_local *local,
5772fb3f028a9a46bd344329766257699b4acb36525Helmut Schaa					     unsigned long *next_delay)
5782fb3f028a9a46bd344329766257699b4acb36525Helmut Schaa{
5792fb3f028a9a46bd344329766257699b4acb36525Helmut Schaa	int skip;
5802fb3f028a9a46bd344329766257699b4acb36525Helmut Schaa	struct ieee80211_channel *chan;
5812fb3f028a9a46bd344329766257699b4acb36525Helmut Schaa
5827d3be3cc489176bc7bd23e673b0b4aef597af2b3Helmut Schaa	skip = 0;
5837d3be3cc489176bc7bd23e673b0b4aef597af2b3Helmut Schaa	chan = local->scan_req->channels[local->scan_channel_idx];
5847d3be3cc489176bc7bd23e673b0b4aef597af2b3Helmut Schaa
585584991dccfd347cd2e1675ab262998f6c335d3c0Johannes Berg	local->scan_channel = chan;
586584991dccfd347cd2e1675ab262998f6c335d3c0Johannes Berg	if (ieee80211_hw_config(local, IEEE80211_CONF_CHANGE_CHANNEL))
5877d3be3cc489176bc7bd23e673b0b4aef597af2b3Helmut Schaa		skip = 1;
5887d3be3cc489176bc7bd23e673b0b4aef597af2b3Helmut Schaa
5897d3be3cc489176bc7bd23e673b0b4aef597af2b3Helmut Schaa	/* advance state machine to next channel/band */
5907d3be3cc489176bc7bd23e673b0b4aef597af2b3Helmut Schaa	local->scan_channel_idx++;
5917d3be3cc489176bc7bd23e673b0b4aef597af2b3Helmut Schaa
5920ee9c13c7c92581ab005d80795cf65897213b249Helmut Schaa	if (skip) {
5930ee9c13c7c92581ab005d80795cf65897213b249Helmut Schaa		/* if we skip this channel return to the decision state */
5940ee9c13c7c92581ab005d80795cf65897213b249Helmut Schaa		local->next_scan_state = SCAN_DECISION;
5952fb3f028a9a46bd344329766257699b4acb36525Helmut Schaa		return;
5960ee9c13c7c92581ab005d80795cf65897213b249Helmut Schaa	}
5977d3be3cc489176bc7bd23e673b0b4aef597af2b3Helmut Schaa
5987d3be3cc489176bc7bd23e673b0b4aef597af2b3Helmut Schaa	/*
5997d3be3cc489176bc7bd23e673b0b4aef597af2b3Helmut Schaa	 * Probe delay is used to update the NAV, cf. 11.1.3.2.2
6007d3be3cc489176bc7bd23e673b0b4aef597af2b3Helmut Schaa	 * (which unfortunately doesn't say _why_ step a) is done,
6017d3be3cc489176bc7bd23e673b0b4aef597af2b3Helmut Schaa	 * but it waits for the probe delay or until a frame is
6027d3be3cc489176bc7bd23e673b0b4aef597af2b3Helmut Schaa	 * received - and the received frame would update the NAV).
6037d3be3cc489176bc7bd23e673b0b4aef597af2b3Helmut Schaa	 * For now, we do not support waiting until a frame is
6047d3be3cc489176bc7bd23e673b0b4aef597af2b3Helmut Schaa	 * received.
6057d3be3cc489176bc7bd23e673b0b4aef597af2b3Helmut Schaa	 *
6067d3be3cc489176bc7bd23e673b0b4aef597af2b3Helmut Schaa	 * In any case, it is not necessary for a passive scan.
6077d3be3cc489176bc7bd23e673b0b4aef597af2b3Helmut Schaa	 */
6087d3be3cc489176bc7bd23e673b0b4aef597af2b3Helmut Schaa	if (chan->flags & IEEE80211_CHAN_PASSIVE_SCAN ||
6097d3be3cc489176bc7bd23e673b0b4aef597af2b3Helmut Schaa	    !local->scan_req->n_ssids) {
6107d3be3cc489176bc7bd23e673b0b4aef597af2b3Helmut Schaa		*next_delay = IEEE80211_PASSIVE_CHANNEL_TIME;
611977923b00c79185c11b4b47664f5ffa4c3820438Helmut Schaa		local->next_scan_state = SCAN_DECISION;
6122fb3f028a9a46bd344329766257699b4acb36525Helmut Schaa		return;
6137d3be3cc489176bc7bd23e673b0b4aef597af2b3Helmut Schaa	}
6147d3be3cc489176bc7bd23e673b0b4aef597af2b3Helmut Schaa
6152fb3f028a9a46bd344329766257699b4acb36525Helmut Schaa	/* active scan, send probes */
6167d3be3cc489176bc7bd23e673b0b4aef597af2b3Helmut Schaa	*next_delay = IEEE80211_PROBE_DELAY;
617977923b00c79185c11b4b47664f5ffa4c3820438Helmut Schaa	local->next_scan_state = SCAN_SEND_PROBE;
6187d3be3cc489176bc7bd23e673b0b4aef597af2b3Helmut Schaa}
6197d3be3cc489176bc7bd23e673b0b4aef597af2b3Helmut Schaa
6207d3be3cc489176bc7bd23e673b0b4aef597af2b3Helmut Schaastatic void ieee80211_scan_state_send_probe(struct ieee80211_local *local,
6217d3be3cc489176bc7bd23e673b0b4aef597af2b3Helmut Schaa					    unsigned long *next_delay)
6227d3be3cc489176bc7bd23e673b0b4aef597af2b3Helmut Schaa{
6237d3be3cc489176bc7bd23e673b0b4aef597af2b3Helmut Schaa	int i;
6247d3be3cc489176bc7bd23e673b0b4aef597af2b3Helmut Schaa	struct ieee80211_sub_if_data *sdata = local->scan_sdata;
6257d3be3cc489176bc7bd23e673b0b4aef597af2b3Helmut Schaa
6267d3be3cc489176bc7bd23e673b0b4aef597af2b3Helmut Schaa	for (i = 0; i < local->scan_req->n_ssids; i++)
6277d3be3cc489176bc7bd23e673b0b4aef597af2b3Helmut Schaa		ieee80211_send_probe_req(
6287d3be3cc489176bc7bd23e673b0b4aef597af2b3Helmut Schaa			sdata, NULL,
6297d3be3cc489176bc7bd23e673b0b4aef597af2b3Helmut Schaa			local->scan_req->ssids[i].ssid,
6307d3be3cc489176bc7bd23e673b0b4aef597af2b3Helmut Schaa			local->scan_req->ssids[i].ssid_len,
6317d3be3cc489176bc7bd23e673b0b4aef597af2b3Helmut Schaa			local->scan_req->ie, local->scan_req->ie_len);
6327d3be3cc489176bc7bd23e673b0b4aef597af2b3Helmut Schaa
6337d3be3cc489176bc7bd23e673b0b4aef597af2b3Helmut Schaa	/*
6347d3be3cc489176bc7bd23e673b0b4aef597af2b3Helmut Schaa	 * After sending probe requests, wait for probe responses
6357d3be3cc489176bc7bd23e673b0b4aef597af2b3Helmut Schaa	 * on the channel.
6367d3be3cc489176bc7bd23e673b0b4aef597af2b3Helmut Schaa	 */
6377d3be3cc489176bc7bd23e673b0b4aef597af2b3Helmut Schaa	*next_delay = IEEE80211_CHANNEL_TIME;
638977923b00c79185c11b4b47664f5ffa4c3820438Helmut Schaa	local->next_scan_state = SCAN_DECISION;
6397d3be3cc489176bc7bd23e673b0b4aef597af2b3Helmut Schaa}
6407d3be3cc489176bc7bd23e673b0b4aef597af2b3Helmut Schaa
641c2b13452b283f9c4a5b02a6b53ed6416ebf4c03cJohannes Bergvoid ieee80211_scan_work(struct work_struct *work)
6420a51b27e956bd9580296c48191b78175ed8b5971Johannes Berg{
6430a51b27e956bd9580296c48191b78175ed8b5971Johannes Berg	struct ieee80211_local *local =
6440a51b27e956bd9580296c48191b78175ed8b5971Johannes Berg		container_of(work, struct ieee80211_local, scan_work.work);
6450a51b27e956bd9580296c48191b78175ed8b5971Johannes Berg	struct ieee80211_sub_if_data *sdata = local->scan_sdata;
6460a51b27e956bd9580296c48191b78175ed8b5971Johannes Berg	unsigned long next_delay = 0;
647e229f844d7223b7063bea1e649203ac521a58fe1Stanislaw Gruszka	bool aborted, hw_scan, finish;
6480a51b27e956bd9580296c48191b78175ed8b5971Johannes Berg
649259b62e35bf44a97983f275de569929a7d2bd5ddStanislaw Gruszka	mutex_lock(&local->mtx);
6508789d459bc5e837bf37d261453df96ef54018d7bJohannes Berg
651259b62e35bf44a97983f275de569929a7d2bd5ddStanislaw Gruszka	if (test_and_clear_bit(SCAN_COMPLETED, &local->scanning)) {
6528789d459bc5e837bf37d261453df96ef54018d7bJohannes Berg		aborted = test_and_clear_bit(SCAN_ABORTED, &local->scanning);
653259b62e35bf44a97983f275de569929a7d2bd5ddStanislaw Gruszka		goto out_complete;
6548789d459bc5e837bf37d261453df96ef54018d7bJohannes Berg	}
6558789d459bc5e837bf37d261453df96ef54018d7bJohannes Berg
656259b62e35bf44a97983f275de569929a7d2bd5ddStanislaw Gruszka	if (!sdata || !local->scan_req)
657259b62e35bf44a97983f275de569929a7d2bd5ddStanislaw Gruszka		goto out;
658f3b85252f081581a8f257545ed748062dce7798bJohannes Berg
6594d36ec58239eec44d77839ef6c25108efcbbb58cJohannes Berg	if (local->hw_scan_req) {
660a060bbfe4ee95d115e8f9705a66894ac34e2c475Johannes Berg		int rc = drv_hw_scan(local, sdata, local->hw_scan_req);
661259b62e35bf44a97983f275de569929a7d2bd5ddStanislaw Gruszka		if (rc) {
662259b62e35bf44a97983f275de569929a7d2bd5ddStanislaw Gruszka			aborted = true;
663259b62e35bf44a97983f275de569929a7d2bd5ddStanislaw Gruszka			goto out_complete;
664259b62e35bf44a97983f275de569929a7d2bd5ddStanislaw Gruszka		} else
665259b62e35bf44a97983f275de569929a7d2bd5ddStanislaw Gruszka			goto out;
6664d36ec58239eec44d77839ef6c25108efcbbb58cJohannes Berg	}
6674d36ec58239eec44d77839ef6c25108efcbbb58cJohannes Berg
668fbe9c429f195111bbf7f1630efa19aee295fd8e7Helmut Schaa	if (local->scan_req && !local->scanning) {
669f3b85252f081581a8f257545ed748062dce7798bJohannes Berg		struct cfg80211_scan_request *req = local->scan_req;
670f3b85252f081581a8f257545ed748062dce7798bJohannes Berg		int rc;
671f3b85252f081581a8f257545ed748062dce7798bJohannes Berg
672f3b85252f081581a8f257545ed748062dce7798bJohannes Berg		local->scan_req = NULL;
67315db0b7fd872b0312033666d3a82e1214a227ec0Johannes Berg		local->scan_sdata = NULL;
674f3b85252f081581a8f257545ed748062dce7798bJohannes Berg
675f3b85252f081581a8f257545ed748062dce7798bJohannes Berg		rc = __ieee80211_start_scan(sdata, req);
676259b62e35bf44a97983f275de569929a7d2bd5ddStanislaw Gruszka		if (rc) {
677259b62e35bf44a97983f275de569929a7d2bd5ddStanislaw Gruszka			aborted = true;
678259b62e35bf44a97983f275de569929a7d2bd5ddStanislaw Gruszka			goto out_complete;
679259b62e35bf44a97983f275de569929a7d2bd5ddStanislaw Gruszka		} else
680259b62e35bf44a97983f275de569929a7d2bd5ddStanislaw Gruszka			goto out;
681f3b85252f081581a8f257545ed748062dce7798bJohannes Berg	}
682f3b85252f081581a8f257545ed748062dce7798bJohannes Berg
6835bc75728fd43bb15b46f16ef465bcf9d487393cfJohannes Berg	/*
6845bc75728fd43bb15b46f16ef465bcf9d487393cfJohannes Berg	 * Avoid re-scheduling when the sdata is going away.
6855bc75728fd43bb15b46f16ef465bcf9d487393cfJohannes Berg	 */
6869607e6b66a0d25ca63b70d54a4283fa13d8f7c9dJohannes Berg	if (!ieee80211_sdata_running(sdata)) {
687259b62e35bf44a97983f275de569929a7d2bd5ddStanislaw Gruszka		aborted = true;
688259b62e35bf44a97983f275de569929a7d2bd5ddStanislaw Gruszka		goto out_complete;
689f3b85252f081581a8f257545ed748062dce7798bJohannes Berg	}
6900a51b27e956bd9580296c48191b78175ed8b5971Johannes Berg
691259b62e35bf44a97983f275de569929a7d2bd5ddStanislaw Gruszka	mutex_unlock(&local->mtx);
692259b62e35bf44a97983f275de569929a7d2bd5ddStanislaw Gruszka
693f502d09b750437a4ec9c63333acf1070fe7958afHelmut Schaa	/*
694f502d09b750437a4ec9c63333acf1070fe7958afHelmut Schaa	 * as long as no delay is required advance immediately
695f502d09b750437a4ec9c63333acf1070fe7958afHelmut Schaa	 * without scheduling a new work
696f502d09b750437a4ec9c63333acf1070fe7958afHelmut Schaa	 */
697f502d09b750437a4ec9c63333acf1070fe7958afHelmut Schaa	do {
698977923b00c79185c11b4b47664f5ffa4c3820438Helmut Schaa		switch (local->next_scan_state) {
6992fb3f028a9a46bd344329766257699b4acb36525Helmut Schaa		case SCAN_DECISION:
700e229f844d7223b7063bea1e649203ac521a58fe1Stanislaw Gruszka			/* if no more bands/channels left, complete scan */
701e229f844d7223b7063bea1e649203ac521a58fe1Stanislaw Gruszka			if (local->scan_channel_idx >= local->scan_req->n_channels) {
702e229f844d7223b7063bea1e649203ac521a58fe1Stanislaw Gruszka				aborted = false;
703e229f844d7223b7063bea1e649203ac521a58fe1Stanislaw Gruszka				goto out_complete;
704e229f844d7223b7063bea1e649203ac521a58fe1Stanislaw Gruszka			}
705e229f844d7223b7063bea1e649203ac521a58fe1Stanislaw Gruszka			ieee80211_scan_state_decision(local, &next_delay);
706f502d09b750437a4ec9c63333acf1070fe7958afHelmut Schaa			break;
7072fb3f028a9a46bd344329766257699b4acb36525Helmut Schaa		case SCAN_SET_CHANNEL:
7082fb3f028a9a46bd344329766257699b4acb36525Helmut Schaa			ieee80211_scan_state_set_channel(local, &next_delay);
7092fb3f028a9a46bd344329766257699b4acb36525Helmut Schaa			break;
710f502d09b750437a4ec9c63333acf1070fe7958afHelmut Schaa		case SCAN_SEND_PROBE:
711f502d09b750437a4ec9c63333acf1070fe7958afHelmut Schaa			ieee80211_scan_state_send_probe(local, &next_delay);
712f502d09b750437a4ec9c63333acf1070fe7958afHelmut Schaa			break;
713142b9f5074dc0d09dc0025739ad437723d7bf527Helmut Schaa		case SCAN_LEAVE_OPER_CHANNEL:
714142b9f5074dc0d09dc0025739ad437723d7bf527Helmut Schaa			ieee80211_scan_state_leave_oper_channel(local, &next_delay);
715142b9f5074dc0d09dc0025739ad437723d7bf527Helmut Schaa			break;
716142b9f5074dc0d09dc0025739ad437723d7bf527Helmut Schaa		case SCAN_ENTER_OPER_CHANNEL:
717142b9f5074dc0d09dc0025739ad437723d7bf527Helmut Schaa			ieee80211_scan_state_enter_oper_channel(local, &next_delay);
718142b9f5074dc0d09dc0025739ad437723d7bf527Helmut Schaa			break;
719f502d09b750437a4ec9c63333acf1070fe7958afHelmut Schaa		}
720f502d09b750437a4ec9c63333acf1070fe7958afHelmut Schaa	} while (next_delay == 0);
7210a51b27e956bd9580296c48191b78175ed8b5971Johannes Berg
72242935ecaf4e784d0815afa9a7e5fe7e141157ca3Luis R. Rodriguez	ieee80211_queue_delayed_work(&local->hw, &local->scan_work, next_delay);
723259b62e35bf44a97983f275de569929a7d2bd5ddStanislaw Gruszka	return;
724259b62e35bf44a97983f275de569929a7d2bd5ddStanislaw Gruszka
725259b62e35bf44a97983f275de569929a7d2bd5ddStanislaw Gruszkaout_complete:
726e229f844d7223b7063bea1e649203ac521a58fe1Stanislaw Gruszka	hw_scan = test_bit(SCAN_HW_SCANNING, &local->scanning);
727e229f844d7223b7063bea1e649203ac521a58fe1Stanislaw Gruszka	finish = __ieee80211_scan_completed(&local->hw, aborted, hw_scan);
728259b62e35bf44a97983f275de569929a7d2bd5ddStanislaw Gruszka	mutex_unlock(&local->mtx);
729e229f844d7223b7063bea1e649203ac521a58fe1Stanislaw Gruszka	if (finish)
730e229f844d7223b7063bea1e649203ac521a58fe1Stanislaw Gruszka		__ieee80211_scan_completed_finish(&local->hw, hw_scan);
731259b62e35bf44a97983f275de569929a7d2bd5ddStanislaw Gruszka	return;
732259b62e35bf44a97983f275de569929a7d2bd5ddStanislaw Gruszka
733259b62e35bf44a97983f275de569929a7d2bd5ddStanislaw Gruszkaout:
734259b62e35bf44a97983f275de569929a7d2bd5ddStanislaw Gruszka	mutex_unlock(&local->mtx);
7350a51b27e956bd9580296c48191b78175ed8b5971Johannes Berg}
7360a51b27e956bd9580296c48191b78175ed8b5971Johannes Berg
737f3b85252f081581a8f257545ed748062dce7798bJohannes Bergint ieee80211_request_scan(struct ieee80211_sub_if_data *sdata,
738f3b85252f081581a8f257545ed748062dce7798bJohannes Berg			   struct cfg80211_scan_request *req)
7390a51b27e956bd9580296c48191b78175ed8b5971Johannes Berg{
740f3b85252f081581a8f257545ed748062dce7798bJohannes Berg	int res;
741de95a54b1aebe5592cae971ca5e5d9ec6a381a17Johannes Berg
742a1699b75a1db31a1da2f0fc610ee696d02a19280Johannes Berg	mutex_lock(&sdata->local->mtx);
743f3b85252f081581a8f257545ed748062dce7798bJohannes Berg	res = __ieee80211_start_scan(sdata, req);
744a1699b75a1db31a1da2f0fc610ee696d02a19280Johannes Berg	mutex_unlock(&sdata->local->mtx);
7450a51b27e956bd9580296c48191b78175ed8b5971Johannes Berg
746f3b85252f081581a8f257545ed748062dce7798bJohannes Berg	return res;
7470a51b27e956bd9580296c48191b78175ed8b5971Johannes Berg}
7480a51b27e956bd9580296c48191b78175ed8b5971Johannes Berg
749f3b85252f081581a8f257545ed748062dce7798bJohannes Bergint ieee80211_request_internal_scan(struct ieee80211_sub_if_data *sdata,
750be4a4b6a5d2f76393f545a2545fbaa1b65577e13Johannes Berg				    const u8 *ssid, u8 ssid_len,
751be4a4b6a5d2f76393f545a2545fbaa1b65577e13Johannes Berg				    struct ieee80211_channel *chan)
7520a51b27e956bd9580296c48191b78175ed8b5971Johannes Berg{
7530a51b27e956bd9580296c48191b78175ed8b5971Johannes Berg	struct ieee80211_local *local = sdata->local;
754f3b85252f081581a8f257545ed748062dce7798bJohannes Berg	int ret = -EBUSY;
755fb63bc41772259701a827e9a6117219a7393554fGertjan van Wingerde	enum ieee80211_band band;
7562a5193119269062608582418deba7af82844159aJohannes Berg
757a1699b75a1db31a1da2f0fc610ee696d02a19280Johannes Berg	mutex_lock(&local->mtx);
7580a51b27e956bd9580296c48191b78175ed8b5971Johannes Berg
759f3b85252f081581a8f257545ed748062dce7798bJohannes Berg	/* busy scanning */
760f3b85252f081581a8f257545ed748062dce7798bJohannes Berg	if (local->scan_req)
761f3b85252f081581a8f257545ed748062dce7798bJohannes Berg		goto unlock;
7629116dd01120e249dc2e84e6edecd7ad7f828680fJohannes Berg
763be4a4b6a5d2f76393f545a2545fbaa1b65577e13Johannes Berg	/* fill internal scan request */
764be4a4b6a5d2f76393f545a2545fbaa1b65577e13Johannes Berg	if (!chan) {
765be4a4b6a5d2f76393f545a2545fbaa1b65577e13Johannes Berg		int i, nchan = 0;
766be4a4b6a5d2f76393f545a2545fbaa1b65577e13Johannes Berg
767be4a4b6a5d2f76393f545a2545fbaa1b65577e13Johannes Berg		for (band = 0; band < IEEE80211_NUM_BANDS; band++) {
768be4a4b6a5d2f76393f545a2545fbaa1b65577e13Johannes Berg			if (!local->hw.wiphy->bands[band])
769be4a4b6a5d2f76393f545a2545fbaa1b65577e13Johannes Berg				continue;
770be4a4b6a5d2f76393f545a2545fbaa1b65577e13Johannes Berg			for (i = 0;
771be4a4b6a5d2f76393f545a2545fbaa1b65577e13Johannes Berg			     i < local->hw.wiphy->bands[band]->n_channels;
772be4a4b6a5d2f76393f545a2545fbaa1b65577e13Johannes Berg			     i++) {
773be4a4b6a5d2f76393f545a2545fbaa1b65577e13Johannes Berg				local->int_scan_req->channels[nchan] =
774be4a4b6a5d2f76393f545a2545fbaa1b65577e13Johannes Berg				    &local->hw.wiphy->bands[band]->channels[i];
775be4a4b6a5d2f76393f545a2545fbaa1b65577e13Johannes Berg				nchan++;
776be4a4b6a5d2f76393f545a2545fbaa1b65577e13Johannes Berg			}
777be4a4b6a5d2f76393f545a2545fbaa1b65577e13Johannes Berg		}
778be4a4b6a5d2f76393f545a2545fbaa1b65577e13Johannes Berg
779be4a4b6a5d2f76393f545a2545fbaa1b65577e13Johannes Berg		local->int_scan_req->n_channels = nchan;
780be4a4b6a5d2f76393f545a2545fbaa1b65577e13Johannes Berg	} else {
781be4a4b6a5d2f76393f545a2545fbaa1b65577e13Johannes Berg		local->int_scan_req->channels[0] = chan;
782be4a4b6a5d2f76393f545a2545fbaa1b65577e13Johannes Berg		local->int_scan_req->n_channels = 1;
783be4a4b6a5d2f76393f545a2545fbaa1b65577e13Johannes Berg	}
784be4a4b6a5d2f76393f545a2545fbaa1b65577e13Johannes Berg
785be4a4b6a5d2f76393f545a2545fbaa1b65577e13Johannes Berg	local->int_scan_req->ssids = &local->scan_ssid;
786be4a4b6a5d2f76393f545a2545fbaa1b65577e13Johannes Berg	local->int_scan_req->n_ssids = 1;
7875ba63533bbf653631faab60f6988506160ec6ba4Johannes Berg	memcpy(local->int_scan_req->ssids[0].ssid, ssid, IEEE80211_MAX_SSID_LEN);
7885ba63533bbf653631faab60f6988506160ec6ba4Johannes Berg	local->int_scan_req->ssids[0].ssid_len = ssid_len;
7899116dd01120e249dc2e84e6edecd7ad7f828680fJohannes Berg
7905ba63533bbf653631faab60f6988506160ec6ba4Johannes Berg	ret = __ieee80211_start_scan(sdata, sdata->local->int_scan_req);
791f3b85252f081581a8f257545ed748062dce7798bJohannes Berg unlock:
792a1699b75a1db31a1da2f0fc610ee696d02a19280Johannes Berg	mutex_unlock(&local->mtx);
793f3b85252f081581a8f257545ed748062dce7798bJohannes Berg	return ret;
7940a51b27e956bd9580296c48191b78175ed8b5971Johannes Berg}
7955bb644a0fd25a5e083ecbfaa92a211db99aa6ef7Johannes Berg
7964136c4224ccf1907d309e1cdfaefef9da97dbc5eStanislaw Gruszka/*
7974136c4224ccf1907d309e1cdfaefef9da97dbc5eStanislaw Gruszka * Only call this function when a scan can't be queued -- under RTNL.
7984136c4224ccf1907d309e1cdfaefef9da97dbc5eStanislaw Gruszka */
7995bb644a0fd25a5e083ecbfaa92a211db99aa6ef7Johannes Bergvoid ieee80211_scan_cancel(struct ieee80211_local *local)
8005bb644a0fd25a5e083ecbfaa92a211db99aa6ef7Johannes Berg{
8014136c4224ccf1907d309e1cdfaefef9da97dbc5eStanislaw Gruszka	bool abortscan, finish;
8025bb644a0fd25a5e083ecbfaa92a211db99aa6ef7Johannes Berg
8035bb644a0fd25a5e083ecbfaa92a211db99aa6ef7Johannes Berg	/*
8044136c4224ccf1907d309e1cdfaefef9da97dbc5eStanislaw Gruszka	 * We are only canceling software scan, or deferred scan that was not
8054136c4224ccf1907d309e1cdfaefef9da97dbc5eStanislaw Gruszka	 * yet really started (see __ieee80211_start_scan ).
8064136c4224ccf1907d309e1cdfaefef9da97dbc5eStanislaw Gruszka	 *
8074136c4224ccf1907d309e1cdfaefef9da97dbc5eStanislaw Gruszka	 * Regarding hardware scan:
8084136c4224ccf1907d309e1cdfaefef9da97dbc5eStanislaw Gruszka	 * - we can not call  __ieee80211_scan_completed() as when
8094136c4224ccf1907d309e1cdfaefef9da97dbc5eStanislaw Gruszka	 *   SCAN_HW_SCANNING bit is set this function change
8104136c4224ccf1907d309e1cdfaefef9da97dbc5eStanislaw Gruszka	 *   local->hw_scan_req to operate on 5G band, what race with
8114136c4224ccf1907d309e1cdfaefef9da97dbc5eStanislaw Gruszka	 *   driver which can use local->hw_scan_req
8124136c4224ccf1907d309e1cdfaefef9da97dbc5eStanislaw Gruszka	 *
8134136c4224ccf1907d309e1cdfaefef9da97dbc5eStanislaw Gruszka	 * - we can not cancel scan_work since driver can schedule it
8144136c4224ccf1907d309e1cdfaefef9da97dbc5eStanislaw Gruszka	 *   by ieee80211_scan_completed(..., true) to finish scan
8154136c4224ccf1907d309e1cdfaefef9da97dbc5eStanislaw Gruszka	 *
8164136c4224ccf1907d309e1cdfaefef9da97dbc5eStanislaw Gruszka	 * Hence low lever driver is responsible for canceling HW scan.
8175bb644a0fd25a5e083ecbfaa92a211db99aa6ef7Johannes Berg	 */
8184136c4224ccf1907d309e1cdfaefef9da97dbc5eStanislaw Gruszka
819a1699b75a1db31a1da2f0fc610ee696d02a19280Johannes Berg	mutex_lock(&local->mtx);
8204136c4224ccf1907d309e1cdfaefef9da97dbc5eStanislaw Gruszka	abortscan = local->scan_req && !test_bit(SCAN_HW_SCANNING, &local->scanning);
821e229f844d7223b7063bea1e649203ac521a58fe1Stanislaw Gruszka	if (abortscan)
822e229f844d7223b7063bea1e649203ac521a58fe1Stanislaw Gruszka		finish = __ieee80211_scan_completed(&local->hw, true, false);
823a1699b75a1db31a1da2f0fc610ee696d02a19280Johannes Berg	mutex_unlock(&local->mtx);
8245bb644a0fd25a5e083ecbfaa92a211db99aa6ef7Johannes Berg
8254136c4224ccf1907d309e1cdfaefef9da97dbc5eStanislaw Gruszka	if (abortscan) {
8264136c4224ccf1907d309e1cdfaefef9da97dbc5eStanislaw Gruszka		/* The scan is canceled, but stop work from being pending */
8274136c4224ccf1907d309e1cdfaefef9da97dbc5eStanislaw Gruszka		cancel_delayed_work_sync(&local->scan_work);
8284136c4224ccf1907d309e1cdfaefef9da97dbc5eStanislaw Gruszka		if (finish)
8294136c4224ccf1907d309e1cdfaefef9da97dbc5eStanislaw Gruszka			__ieee80211_scan_completed_finish(&local->hw, false);
8304136c4224ccf1907d309e1cdfaefef9da97dbc5eStanislaw Gruszka	}
8315bb644a0fd25a5e083ecbfaa92a211db99aa6ef7Johannes Berg}
832