mlme.c 73.4 KB
Newer Older
1 2
/*
 * BSS client mode implementation
3
 * Copyright 2003-2008, Jouni Malinen <j@w1.fi>
4 5 6 7 8 9 10 11 12 13
 * Copyright 2004, Instant802 Networks, Inc.
 * Copyright 2005, Devicescape Software, Inc.
 * Copyright 2006-2007	Jiri Benc <jbenc@suse.cz>
 * Copyright 2007, Michael Wu <flamingice@sourmilk.net>
 *
 * This program is free software; you can redistribute it and/or modify
 * it under the terms of the GNU General Public License version 2 as
 * published by the Free Software Foundation.
 */

14
#include <linux/delay.h>
15 16 17 18
#include <linux/if_ether.h>
#include <linux/skbuff.h>
#include <linux/if_arp.h>
#include <linux/etherdevice.h>
19
#include <linux/rtnetlink.h>
20
#include <linux/pm_qos_params.h>
21
#include <linux/crc32.h>
22
#include <linux/slab.h>
23
#include <net/mac80211.h>
24
#include <asm/unaligned.h>
J
Johannes Berg 已提交
25

26
#include "ieee80211_i.h"
27
#include "driver-ops.h"
J
Johannes Berg 已提交
28 29
#include "rate.h"
#include "led.h"
30

31 32 33 34 35 36 37 38 39
static int max_nullfunc_tries = 2;
module_param(max_nullfunc_tries, int, 0644);
MODULE_PARM_DESC(max_nullfunc_tries,
		 "Maximum nullfunc tx tries before disconnecting (reason 4).");

static int max_probe_tries = 5;
module_param(max_probe_tries, int, 0644);
MODULE_PARM_DESC(max_probe_tries,
		 "Maximum probe tries before disconnecting (reason 4).");
J
Johannes Berg 已提交
40 41

/*
42 43 44 45 46 47
 * Beacon loss timeout is calculated as N frames times the
 * advertised beacon interval.  This may need to be somewhat
 * higher than what hardware might detect to account for
 * delays in the host processing frames. But since we also
 * probe on beacon miss before declaring the connection lost
 * default to what we want.
J
Johannes Berg 已提交
48
 */
49 50
#define IEEE80211_BEACON_LOSS_COUNT	7

J
Johannes Berg 已提交
51 52 53 54
/*
 * Time the connection can be idle before we probe
 * it to see if we can still talk to the AP.
 */
55
#define IEEE80211_CONNECTION_IDLE_TIME	(30 * HZ)
J
Johannes Berg 已提交
56 57 58 59 60
/*
 * Time we wait for a probe response after sending
 * a probe request because of beacon loss or for
 * checking the connection still works.
 */
61 62 63 64 65
static int probe_wait_ms = 500;
module_param(probe_wait_ms, int, 0644);
MODULE_PARM_DESC(probe_wait_ms,
		 "Maximum time(ms) to wait for probe response"
		 " before disconnecting (reason 4).");
66

67 68 69 70 71 72 73
/*
 * Weight given to the latest Beacon frame when calculating average signal
 * strength for Beacon frames received in the current BSS. This must be
 * between 1 and 15.
 */
#define IEEE80211_SIGNAL_AVE_WEIGHT	3

74 75 76 77 78 79
/*
 * How many Beacon frames need to have been used in average signal strength
 * before starting to indicate signal change events.
 */
#define IEEE80211_SIGNAL_AVE_MIN_COUNT	4

80 81 82
#define TMR_RUNNING_TIMER	0
#define TMR_RUNNING_CHANSW	1

83 84 85 86 87 88 89 90 91 92 93 94 95 96 97 98 99
/*
 * All cfg80211 functions have to be called outside a locked
 * section so that they can acquire a lock themselves... This
 * is much simpler than queuing up things in cfg80211, but we
 * do need some indirection for that here.
 */
enum rx_mgmt_action {
	/* no action required */
	RX_MGMT_NONE,

	/* caller must call cfg80211_send_deauth() */
	RX_MGMT_CFG80211_DEAUTH,

	/* caller must call cfg80211_send_disassoc() */
	RX_MGMT_CFG80211_DISASSOC,
};

100
/* utils */
101 102
static inline void ASSERT_MGD_MTX(struct ieee80211_if_managed *ifmgd)
{
103
	lockdep_assert_held(&ifmgd->mtx);
104 105
}

J
Johannes Berg 已提交
106 107 108 109 110 111 112 113 114 115 116 117 118 119 120 121 122 123 124 125
/*
 * We can have multiple work items (and connection probing)
 * scheduling this timer, but we need to take care to only
 * reschedule it when it should fire _earlier_ than it was
 * asked for before, or if it's not pending right now. This
 * function ensures that. Note that it then is required to
 * run this function for all timeouts after the first one
 * has happened -- the work that runs from this timer will
 * do that.
 */
static void run_again(struct ieee80211_if_managed *ifmgd,
			     unsigned long timeout)
{
	ASSERT_MGD_MTX(ifmgd);

	if (!timer_pending(&ifmgd->timer) ||
	    time_before(timeout, ifmgd->timer.expires))
		mod_timer(&ifmgd->timer, timeout);
}

126
void ieee80211_sta_reset_beacon_monitor(struct ieee80211_sub_if_data *sdata)
J
Johannes Berg 已提交
127 128 129 130 131
{
	if (sdata->local->hw.flags & IEEE80211_HW_BEACON_FILTER)
		return;

	mod_timer(&sdata->u.mgd.bcn_mon_timer,
132
		  round_jiffies_up(jiffies + sdata->u.mgd.beacon_timeout));
J
Johannes Berg 已提交
133 134
}

135 136
void ieee80211_sta_reset_conn_monitor(struct ieee80211_sub_if_data *sdata)
{
137 138
	struct ieee80211_if_managed *ifmgd = &sdata->u.mgd;

139 140 141
	if (unlikely(!sdata->u.mgd.associated))
		return;

142 143 144 145 146
	if (sdata->local->hw.flags & IEEE80211_HW_CONNECTION_MONITOR)
		return;

	mod_timer(&sdata->u.mgd.conn_mon_timer,
		  round_jiffies_up(jiffies + IEEE80211_CONNECTION_IDLE_TIME));
147 148

	ifmgd->probe_send_count = 0;
149 150
}

151
static int ecw2cw(int ecw)
J
Johannes Berg 已提交
152
{
153
	return (1 << ecw) - 1;
J
Johannes Berg 已提交
154 155
}

156 157 158 159 160 161 162
/*
 * ieee80211_enable_ht should be called only after the operating band
 * has been determined as ht configuration depends on the hw's
 * HT abilities for a specific band.
 */
static u32 ieee80211_enable_ht(struct ieee80211_sub_if_data *sdata,
			       struct ieee80211_ht_info *hti,
163
			       const u8 *bssid, u16 ap_ht_cap_flags)
164 165 166 167 168
{
	struct ieee80211_local *local = sdata->local;
	struct ieee80211_supported_band *sband;
	struct sta_info *sta;
	u32 changed = 0;
169
	int hti_cfreq;
170
	u16 ht_opmode;
171 172
	bool enable_ht = true;
	enum nl80211_channel_type prev_chantype;
173 174 175 176
	enum nl80211_channel_type channel_type = NL80211_CHAN_NO_HT;

	sband = local->hw.wiphy->bands[local->hw.conf.channel->band];

177 178
	prev_chantype = sdata->vif.bss_conf.channel_type;

179 180 181 182
	/* HT is not supported */
	if (!sband->ht_cap.ht_supported)
		enable_ht = false;

183 184 185 186 187 188 189 190 191 192 193 194 195 196 197 198 199 200 201 202 203
	if (enable_ht) {
		hti_cfreq = ieee80211_channel_to_frequency(hti->control_chan,
							   sband->band);
		/* check that channel matches the right operating channel */
		if (local->hw.conf.channel->center_freq != hti_cfreq) {
			/* Some APs mess this up, evidently.
			 * Netgear WNDR3700 sometimes reports 4 higher than
			 * the actual channel, for instance.
			 */
			printk(KERN_DEBUG
			       "%s: Wrong control channel in association"
			       " response: configured center-freq: %d"
			       " hti-cfreq: %d  hti->control_chan: %d"
			       " band: %d.  Disabling HT.\n",
			       sdata->name,
			       local->hw.conf.channel->center_freq,
			       hti_cfreq, hti->control_chan,
			       sband->band);
			enable_ht = false;
		}
	}
204 205 206 207 208 209 210 211 212

	if (enable_ht) {
		channel_type = NL80211_CHAN_HT20;

		if (!(ap_ht_cap_flags & IEEE80211_HT_CAP_40MHZ_INTOLERANT) &&
		    (sband->ht_cap.cap & IEEE80211_HT_CAP_SUP_WIDTH_20_40) &&
		    (hti->ht_param & IEEE80211_HT_PARAM_CHAN_WIDTH_ANY)) {
			switch(hti->ht_param & IEEE80211_HT_PARAM_CHA_SEC_OFFSET) {
			case IEEE80211_HT_PARAM_CHA_SEC_ABOVE:
213 214 215
				if (!(local->hw.conf.channel->flags &
				    IEEE80211_CHAN_NO_HT40PLUS))
					channel_type = NL80211_CHAN_HT40PLUS;
216 217
				break;
			case IEEE80211_HT_PARAM_CHA_SEC_BELOW:
218 219 220
				if (!(local->hw.conf.channel->flags &
				    IEEE80211_CHAN_NO_HT40MINUS))
					channel_type = NL80211_CHAN_HT40MINUS;
221 222 223 224 225
				break;
			}
		}
	}

226 227
	if (local->tmp_channel)
		local->tmp_channel_type = channel_type;
228

229 230 231 232 233
	if (!ieee80211_set_channel_type(local, sdata, channel_type)) {
		/* can only fail due to HT40+/- mismatch */
		channel_type = NL80211_CHAN_HT20;
		WARN_ON(!ieee80211_set_channel_type(local, sdata, channel_type));
	}
234

235 236
	/* channel_type change automatically detected */
	ieee80211_hw_config(local, 0);
237

238
	if (prev_chantype != channel_type) {
239
		rcu_read_lock();
240
		sta = sta_info_get(sdata, bssid);
241 242
		if (sta)
			rate_control_rate_update(local, sband, sta,
243
						 IEEE80211_RC_HT_CHANGED,
244
						 channel_type);
245
		rcu_read_unlock();
246
	}
247

248
	ht_opmode = le16_to_cpu(hti->operation_mode);
249 250

	/* if bss configuration changed store the new one */
251 252 253
	if (sdata->ht_opmode_valid != enable_ht ||
	    sdata->vif.bss_conf.ht_operation_mode != ht_opmode ||
	    prev_chantype != channel_type) {
254
		changed |= BSS_CHANGED_HT;
255
		sdata->vif.bss_conf.ht_operation_mode = ht_opmode;
256
		sdata->ht_opmode_valid = enable_ht;
257 258 259 260 261
	}

	return changed;
}

J
Johannes Berg 已提交
262 263
/* frame sending functions */

264
static void ieee80211_send_deauth_disassoc(struct ieee80211_sub_if_data *sdata,
J
Johannes Berg 已提交
265
					   const u8 *bssid, u16 stype, u16 reason,
266
					   void *cookie, bool send_frame)
267 268
{
	struct ieee80211_local *local = sdata->local;
269
	struct ieee80211_if_managed *ifmgd = &sdata->u.mgd;
270 271
	struct sk_buff *skb;
	struct ieee80211_mgmt *mgmt;
272

273
	skb = dev_alloc_skb(local->hw.extra_tx_headroom + sizeof(*mgmt));
274
	if (!skb) {
275
		printk(KERN_DEBUG "%s: failed to allocate buffer for "
276
		       "deauth/disassoc frame\n", sdata->name);
277 278 279 280 281 282
		return;
	}
	skb_reserve(skb, local->hw.extra_tx_headroom);

	mgmt = (struct ieee80211_mgmt *) skb_put(skb, 24);
	memset(mgmt, 0, 24);
283
	memcpy(mgmt->da, bssid, ETH_ALEN);
284
	memcpy(mgmt->sa, sdata->vif.addr, ETH_ALEN);
285
	memcpy(mgmt->bssid, bssid, ETH_ALEN);
286
	mgmt->frame_control = cpu_to_le16(IEEE80211_FTYPE_MGMT | stype);
287
	skb_put(skb, 2);
288
	/* u.deauth.reason_code == u.disassoc.reason_code */
289 290
	mgmt->u.deauth.reason_code = cpu_to_le16(reason);

291
	if (stype == IEEE80211_STYPE_DEAUTH)
292 293 294 295
		if (cookie)
			__cfg80211_send_deauth(sdata->dev, (u8 *)mgmt, skb->len);
		else
			cfg80211_send_deauth(sdata->dev, (u8 *)mgmt, skb->len);
296
	else
297 298 299 300
		if (cookie)
			__cfg80211_send_disassoc(sdata->dev, (u8 *)mgmt, skb->len);
		else
			cfg80211_send_disassoc(sdata->dev, (u8 *)mgmt, skb->len);
301 302
	if (!(ifmgd->flags & IEEE80211_STA_MFP_ENABLED))
		IEEE80211_SKB_CB(skb)->flags |= IEEE80211_TX_INTFL_DONT_ENCRYPT;
303 304 305 306 307

	if (send_frame)
		ieee80211_tx_skb(sdata, skb);
	else
		kfree_skb(skb);
308 309
}

310 311 312 313 314 315
void ieee80211_send_pspoll(struct ieee80211_local *local,
			   struct ieee80211_sub_if_data *sdata)
{
	struct ieee80211_pspoll *pspoll;
	struct sk_buff *skb;

316 317
	skb = ieee80211_pspoll_get(&local->hw, &sdata->vif);
	if (!skb)
318 319
		return;

320 321
	pspoll = (struct ieee80211_pspoll *) skb->data;
	pspoll->frame_control |= cpu_to_le16(IEEE80211_FCTL_PM);
322

323 324
	IEEE80211_SKB_CB(skb)->flags |= IEEE80211_TX_INTFL_DONT_ENCRYPT;
	ieee80211_tx_skb(sdata, skb);
325 326
}

327 328 329 330 331
void ieee80211_send_nullfunc(struct ieee80211_local *local,
			     struct ieee80211_sub_if_data *sdata,
			     int powersave)
{
	struct sk_buff *skb;
332
	struct ieee80211_hdr_3addr *nullfunc;
333

334 335
	skb = ieee80211_nullfunc_get(&local->hw, &sdata->vif);
	if (!skb)
336 337
		return;

338
	nullfunc = (struct ieee80211_hdr_3addr *) skb->data;
339
	if (powersave)
340
		nullfunc->frame_control |= cpu_to_le16(IEEE80211_FCTL_PM);
341

342 343
	IEEE80211_SKB_CB(skb)->flags |= IEEE80211_TX_INTFL_DONT_ENCRYPT;
	ieee80211_tx_skb(sdata, skb);
344 345
}

346 347 348 349 350 351 352 353 354 355 356 357 358 359 360 361 362 363 364 365 366 367 368 369 370 371 372 373 374 375 376 377
static void ieee80211_send_4addr_nullfunc(struct ieee80211_local *local,
					  struct ieee80211_sub_if_data *sdata)
{
	struct sk_buff *skb;
	struct ieee80211_hdr *nullfunc;
	__le16 fc;

	if (WARN_ON(sdata->vif.type != NL80211_IFTYPE_STATION))
		return;

	skb = dev_alloc_skb(local->hw.extra_tx_headroom + 30);
	if (!skb) {
		printk(KERN_DEBUG "%s: failed to allocate buffer for 4addr "
		       "nullfunc frame\n", sdata->name);
		return;
	}
	skb_reserve(skb, local->hw.extra_tx_headroom);

	nullfunc = (struct ieee80211_hdr *) skb_put(skb, 30);
	memset(nullfunc, 0, 30);
	fc = cpu_to_le16(IEEE80211_FTYPE_DATA | IEEE80211_STYPE_NULLFUNC |
			 IEEE80211_FCTL_FROMDS | IEEE80211_FCTL_TODS);
	nullfunc->frame_control = fc;
	memcpy(nullfunc->addr1, sdata->u.mgd.bssid, ETH_ALEN);
	memcpy(nullfunc->addr2, sdata->vif.addr, ETH_ALEN);
	memcpy(nullfunc->addr3, sdata->u.mgd.bssid, ETH_ALEN);
	memcpy(nullfunc->addr4, sdata->vif.addr, ETH_ALEN);

	IEEE80211_SKB_CB(skb)->flags |= IEEE80211_TX_INTFL_DONT_ENCRYPT;
	ieee80211_tx_skb(sdata, skb);
}

378 379 380 381 382 383 384
/* spectrum management related things */
static void ieee80211_chswitch_work(struct work_struct *work)
{
	struct ieee80211_sub_if_data *sdata =
		container_of(work, struct ieee80211_sub_if_data, u.mgd.chswitch_work);
	struct ieee80211_if_managed *ifmgd = &sdata->u.mgd;

385
	if (!ieee80211_sdata_running(sdata))
386 387
		return;

388 389 390
	mutex_lock(&ifmgd->mtx);
	if (!ifmgd->associated)
		goto out;
391 392

	sdata->local->oper_channel = sdata->local->csa_channel;
393 394 395 396 397
	if (!sdata->local->ops->channel_switch) {
		/* call "hw_config" only if doing sw channel switch */
		ieee80211_hw_config(sdata->local,
			IEEE80211_CONF_CHANGE_CHANNEL);
	}
398

399
	/* XXX: shouldn't really modify cfg80211-owned data! */
400
	ifmgd->associated->channel = sdata->local->oper_channel;
401 402 403

	ieee80211_wake_queues_by_reason(&sdata->local->hw,
					IEEE80211_QUEUE_STOP_REASON_CSA);
404 405 406
 out:
	ifmgd->flags &= ~IEEE80211_STA_CSA_RECEIVED;
	mutex_unlock(&ifmgd->mtx);
407 408
}

409 410 411 412 413 414 415 416 417 418 419 420 421 422 423 424 425 426 427 428 429 430 431
void ieee80211_chswitch_done(struct ieee80211_vif *vif, bool success)
{
	struct ieee80211_sub_if_data *sdata;
	struct ieee80211_if_managed *ifmgd;

	sdata = vif_to_sdata(vif);
	ifmgd = &sdata->u.mgd;

	trace_api_chswitch_done(sdata, success);
	if (!success) {
		/*
		 * If the channel switch was not successful, stay
		 * around on the old channel. We currently lack
		 * good handling of this situation, possibly we
		 * should just drop the association.
		 */
		sdata->local->csa_channel = sdata->local->oper_channel;
	}

	ieee80211_queue_work(&sdata->local->hw, &ifmgd->chswitch_work);
}
EXPORT_SYMBOL(ieee80211_chswitch_done);

432 433 434 435 436 437
static void ieee80211_chswitch_timer(unsigned long data)
{
	struct ieee80211_sub_if_data *sdata =
		(struct ieee80211_sub_if_data *) data;
	struct ieee80211_if_managed *ifmgd = &sdata->u.mgd;

438 439 440 441 442
	if (sdata->local->quiescing) {
		set_bit(TMR_RUNNING_CHANSW, &ifmgd->timers_running);
		return;
	}

443
	ieee80211_queue_work(&sdata->local->hw, &ifmgd->chswitch_work);
444 445 446 447
}

void ieee80211_sta_process_chanswitch(struct ieee80211_sub_if_data *sdata,
				      struct ieee80211_channel_sw_ie *sw_elem,
448 449
				      struct ieee80211_bss *bss,
				      u64 timestamp)
450
{
451 452
	struct cfg80211_bss *cbss =
		container_of((void *)bss, struct cfg80211_bss, priv);
453 454
	struct ieee80211_channel *new_ch;
	struct ieee80211_if_managed *ifmgd = &sdata->u.mgd;
455 456
	int new_freq = ieee80211_channel_to_frequency(sw_elem->new_ch_num,
						      cbss->channel->band);
457

458 459 460
	ASSERT_MGD_MTX(ifmgd);

	if (!ifmgd->associated)
461 462
		return;

463
	if (sdata->local->scanning)
464 465 466 467 468 469 470 471 472 473 474 475 476 477
		return;

	/* Disregard subsequent beacons if we are already running a timer
	   processing a CSA */

	if (ifmgd->flags & IEEE80211_STA_CSA_RECEIVED)
		return;

	new_ch = ieee80211_get_channel(sdata->local->hw.wiphy, new_freq);
	if (!new_ch || new_ch->flags & IEEE80211_CHAN_DISABLED)
		return;

	sdata->local->csa_channel = new_ch;

478 479 480 481 482 483 484 485 486 487 488 489 490 491 492 493 494 495
	if (sdata->local->ops->channel_switch) {
		/* use driver's channel switch callback */
		struct ieee80211_channel_switch ch_switch;
		memset(&ch_switch, 0, sizeof(ch_switch));
		ch_switch.timestamp = timestamp;
		if (sw_elem->mode) {
			ch_switch.block_tx = true;
			ieee80211_stop_queues_by_reason(&sdata->local->hw,
					IEEE80211_QUEUE_STOP_REASON_CSA);
		}
		ch_switch.channel = new_ch;
		ch_switch.count = sw_elem->count;
		ifmgd->flags |= IEEE80211_STA_CSA_RECEIVED;
		drv_channel_switch(sdata->local, &ch_switch);
		return;
	}

	/* channel switch handled in software */
496
	if (sw_elem->count <= 1) {
497
		ieee80211_queue_work(&sdata->local->hw, &ifmgd->chswitch_work);
498
	} else {
499 500
		if (sw_elem->mode)
			ieee80211_stop_queues_by_reason(&sdata->local->hw,
501 502 503 504 505
					IEEE80211_QUEUE_STOP_REASON_CSA);
		ifmgd->flags |= IEEE80211_STA_CSA_RECEIVED;
		mod_timer(&ifmgd->chswitch_timer,
			  jiffies +
			  msecs_to_jiffies(sw_elem->count *
506
					   cbss->beacon_interval));
507 508 509 510 511 512 513 514 515 516 517 518 519 520 521 522 523 524 525 526 527 528 529
	}
}

static void ieee80211_handle_pwr_constr(struct ieee80211_sub_if_data *sdata,
					u16 capab_info, u8 *pwr_constr_elem,
					u8 pwr_constr_elem_len)
{
	struct ieee80211_conf *conf = &sdata->local->hw.conf;

	if (!(capab_info & WLAN_CAPABILITY_SPECTRUM_MGMT))
		return;

	/* Power constraint IE length should be 1 octet */
	if (pwr_constr_elem_len != 1)
		return;

	if ((*pwr_constr_elem <= conf->channel->max_power) &&
	    (*pwr_constr_elem != sdata->local->power_constr_level)) {
		sdata->local->power_constr_level = *pwr_constr_elem;
		ieee80211_hw_config(sdata->local, 0);
	}
}

530 531 532 533 534 535 536 537 538 539 540 541 542 543 544 545 546 547 548 549 550 551 552 553 554 555 556 557 558 559 560 561 562
void ieee80211_enable_dyn_ps(struct ieee80211_vif *vif)
{
	struct ieee80211_sub_if_data *sdata = vif_to_sdata(vif);
	struct ieee80211_local *local = sdata->local;
	struct ieee80211_conf *conf = &local->hw.conf;

	WARN_ON(sdata->vif.type != NL80211_IFTYPE_STATION ||
		!(local->hw.flags & IEEE80211_HW_SUPPORTS_PS) ||
		(local->hw.flags & IEEE80211_HW_SUPPORTS_DYNAMIC_PS));

	local->disable_dynamic_ps = false;
	conf->dynamic_ps_timeout = local->dynamic_ps_user_timeout;
}
EXPORT_SYMBOL(ieee80211_enable_dyn_ps);

void ieee80211_disable_dyn_ps(struct ieee80211_vif *vif)
{
	struct ieee80211_sub_if_data *sdata = vif_to_sdata(vif);
	struct ieee80211_local *local = sdata->local;
	struct ieee80211_conf *conf = &local->hw.conf;

	WARN_ON(sdata->vif.type != NL80211_IFTYPE_STATION ||
		!(local->hw.flags & IEEE80211_HW_SUPPORTS_PS) ||
		(local->hw.flags & IEEE80211_HW_SUPPORTS_DYNAMIC_PS));

	local->disable_dynamic_ps = true;
	conf->dynamic_ps_timeout = 0;
	del_timer_sync(&local->dynamic_ps_timer);
	ieee80211_queue_work(&local->hw,
			     &local->dynamic_ps_enable_work);
}
EXPORT_SYMBOL(ieee80211_disable_dyn_ps);

563 564 565 566 567 568
/* powersave */
static void ieee80211_enable_ps(struct ieee80211_local *local,
				struct ieee80211_sub_if_data *sdata)
{
	struct ieee80211_conf *conf = &local->hw.conf;

J
Johannes Berg 已提交
569 570 571 572
	/*
	 * If we are scanning right now then the parameters will
	 * take effect when scan finishes.
	 */
573
	if (local->scanning)
J
Johannes Berg 已提交
574 575
		return;

576 577 578 579 580 581 582
	if (conf->dynamic_ps_timeout > 0 &&
	    !(local->hw.flags & IEEE80211_HW_SUPPORTS_DYNAMIC_PS)) {
		mod_timer(&local->dynamic_ps_timer, jiffies +
			  msecs_to_jiffies(conf->dynamic_ps_timeout));
	} else {
		if (local->hw.flags & IEEE80211_HW_PS_NULLFUNC_STACK)
			ieee80211_send_nullfunc(local, sdata, 1);
583

584 585 586 587 588 589
		if ((local->hw.flags & IEEE80211_HW_PS_NULLFUNC_STACK) &&
		    (local->hw.flags & IEEE80211_HW_REPORTS_TX_ACK_STATUS))
			return;

		conf->flags |= IEEE80211_CONF_PS;
		ieee80211_hw_config(local, IEEE80211_CONF_CHANGE_PS);
590 591 592 593 594 595 596 597 598 599 600 601 602 603 604 605 606
	}
}

static void ieee80211_change_ps(struct ieee80211_local *local)
{
	struct ieee80211_conf *conf = &local->hw.conf;

	if (local->ps_sdata) {
		ieee80211_enable_ps(local, local->ps_sdata);
	} else if (conf->flags & IEEE80211_CONF_PS) {
		conf->flags &= ~IEEE80211_CONF_PS;
		ieee80211_hw_config(local, IEEE80211_CONF_CHANGE_PS);
		del_timer_sync(&local->dynamic_ps_timer);
		cancel_work_sync(&local->dynamic_ps_enable_work);
	}
}

607 608 609 610 611 612 613 614 615 616 617 618 619 620 621 622 623 624 625 626 627 628 629 630 631 632 633 634 635 636 637
static bool ieee80211_powersave_allowed(struct ieee80211_sub_if_data *sdata)
{
	struct ieee80211_if_managed *mgd = &sdata->u.mgd;
	struct sta_info *sta = NULL;
	u32 sta_flags = 0;

	if (!mgd->powersave)
		return false;

	if (!mgd->associated)
		return false;

	if (!mgd->associated->beacon_ies)
		return false;

	if (mgd->flags & (IEEE80211_STA_BEACON_POLL |
			  IEEE80211_STA_CONNECTION_POLL))
		return false;

	rcu_read_lock();
	sta = sta_info_get(sdata, mgd->bssid);
	if (sta)
		sta_flags = get_sta_flags(sta);
	rcu_read_unlock();

	if (!(sta_flags & WLAN_STA_AUTHORIZED))
		return false;

	return true;
}

638
/* need to hold RTNL or interface lock */
639
void ieee80211_recalc_ps(struct ieee80211_local *local, s32 latency)
640 641 642
{
	struct ieee80211_sub_if_data *sdata, *found = NULL;
	int count = 0;
643
	int timeout;
644 645 646 647 648 649

	if (!(local->hw.flags & IEEE80211_HW_SUPPORTS_PS)) {
		local->ps_sdata = NULL;
		return;
	}

J
Johannes Berg 已提交
650 651 652 653 654
	if (!list_empty(&local->work_list)) {
		local->ps_sdata = NULL;
		goto change;
	}

655
	list_for_each_entry(sdata, &local->interfaces, list) {
656
		if (!ieee80211_sdata_running(sdata))
657
			continue;
658 659 660 661 662 663 664 665
		if (sdata->vif.type == NL80211_IFTYPE_AP) {
			/* If an AP vif is found, then disable PS
			 * by setting the count to zero thereby setting
			 * ps_sdata to NULL.
			 */
			count = 0;
			break;
		}
666 667 668 669 670 671
		if (sdata->vif.type != NL80211_IFTYPE_STATION)
			continue;
		found = sdata;
		count++;
	}

672
	if (count == 1 && ieee80211_powersave_allowed(found)) {
673
		struct ieee80211_conf *conf = &local->hw.conf;
674 675 676
		s32 beaconint_us;

		if (latency < 0)
M
Mark Gross 已提交
677
			latency = pm_qos_request(PM_QOS_NETWORK_LATENCY);
678 679 680 681

		beaconint_us = ieee80211_tu_to_usec(
					found->vif.bss_conf.beacon_int);

682
		timeout = local->dynamic_ps_forced_timeout;
683 684
		if (timeout < 0) {
			/*
685 686
			 * Go to full PSM if the user configures a very low
			 * latency requirement.
687 688 689
			 * The 2000 second value is there for compatibility
			 * until the PM_QOS_NETWORK_LATENCY is configured
			 * with real values.
690
			 */
691 692
			if (latency > (1900 * USEC_PER_MSEC) &&
			    latency != (2000 * USEC_PER_SEC))
693
				timeout = 0;
694 695
			else
				timeout = 100;
696
		}
697 698 699 700
		local->dynamic_ps_user_timeout = timeout;
		if (!local->disable_dynamic_ps)
			conf->dynamic_ps_timeout =
				local->dynamic_ps_user_timeout;
701

702
		if (beaconint_us > latency) {
703
			local->ps_sdata = NULL;
704
		} else {
705
			struct ieee80211_bss *bss;
706
			int maxslp = 1;
707
			u8 dtimper;
708

709 710 711 712 713 714 715
			bss = (void *)found->u.mgd.associated->priv;
			dtimper = bss->dtim_period;

			/* If the TIM IE is invalid, pretend the value is 1 */
			if (!dtimper)
				dtimper = 1;
			else if (dtimper > 1)
716 717 718
				maxslp = min_t(int, dtimper,
						    latency / beaconint_us);

719
			local->hw.conf.max_sleep_period = maxslp;
720
			local->hw.conf.ps_dtim_period = dtimper;
721
			local->ps_sdata = found;
722
		}
723
	} else {
724
		local->ps_sdata = NULL;
725
	}
726

J
Johannes Berg 已提交
727
 change:
728 729 730 731 732 733 734 735 736 737 738 739 740 741 742 743 744 745 746 747 748 749 750 751
	ieee80211_change_ps(local);
}

void ieee80211_dynamic_ps_disable_work(struct work_struct *work)
{
	struct ieee80211_local *local =
		container_of(work, struct ieee80211_local,
			     dynamic_ps_disable_work);

	if (local->hw.conf.flags & IEEE80211_CONF_PS) {
		local->hw.conf.flags &= ~IEEE80211_CONF_PS;
		ieee80211_hw_config(local, IEEE80211_CONF_CHANGE_PS);
	}

	ieee80211_wake_queues_by_reason(&local->hw,
					IEEE80211_QUEUE_STOP_REASON_PS);
}

void ieee80211_dynamic_ps_enable_work(struct work_struct *work)
{
	struct ieee80211_local *local =
		container_of(work, struct ieee80211_local,
			     dynamic_ps_enable_work);
	struct ieee80211_sub_if_data *sdata = local->ps_sdata;
752
	struct ieee80211_if_managed *ifmgd = &sdata->u.mgd;
753 754
	unsigned long flags;
	int q;
755 756 757 758 759 760 761 762

	/* can only happen when PS was just disabled anyway */
	if (!sdata)
		return;

	if (local->hw.conf.flags & IEEE80211_CONF_PS)
		return;

763 764 765 766 767 768 769 770 771 772 773 774 775 776 777 778 779 780
	/*
	 * transmission can be stopped by others which leads to
	 * dynamic_ps_timer expiry. Postpond the ps timer if it
	 * is not the actual idle state.
	 */
	spin_lock_irqsave(&local->queue_stop_reason_lock, flags);
	for (q = 0; q < local->hw.queues; q++) {
		if (local->queue_stop_reasons[q]) {
			spin_unlock_irqrestore(&local->queue_stop_reason_lock,
					       flags);
			mod_timer(&local->dynamic_ps_timer, jiffies +
				  msecs_to_jiffies(
				  local->hw.conf.dynamic_ps_timeout));
			return;
		}
	}
	spin_unlock_irqrestore(&local->queue_stop_reason_lock, flags);

781
	if ((local->hw.flags & IEEE80211_HW_PS_NULLFUNC_STACK) &&
782 783
	    (!(ifmgd->flags & IEEE80211_STA_NULLFUNC_ACKED))) {
		netif_tx_stop_all_queues(sdata->dev);
784

785 786 787 788 789 790 791 792 793
		if (drv_tx_frames_pending(local))
			mod_timer(&local->dynamic_ps_timer, jiffies +
				  msecs_to_jiffies(
				  local->hw.conf.dynamic_ps_timeout));
		else {
			ieee80211_send_nullfunc(local, sdata, 1);
			/* Flush to get the tx status of nullfunc frame */
			drv_flush(local, false);
		}
794 795
	}

796 797
	if (!((local->hw.flags & IEEE80211_HW_REPORTS_TX_ACK_STATUS) &&
	      (local->hw.flags & IEEE80211_HW_PS_NULLFUNC_STACK)) ||
798 799 800 801 802
	    (ifmgd->flags & IEEE80211_STA_NULLFUNC_ACKED)) {
		ifmgd->flags &= ~IEEE80211_STA_NULLFUNC_ACKED;
		local->hw.conf.flags |= IEEE80211_CONF_PS;
		ieee80211_hw_config(local, IEEE80211_CONF_CHANGE_PS);
	}
803

804
	netif_tx_wake_all_queues(sdata->dev);
805 806 807 808 809 810
}

void ieee80211_dynamic_ps_timer(unsigned long data)
{
	struct ieee80211_local *local = (void *) data;

811
	if (local->quiescing || local->suspended)
812 813
		return;

814
	ieee80211_queue_work(&local->hw, &local->dynamic_ps_enable_work);
815 816
}

J
Johannes Berg 已提交
817
/* MLME */
818
static void ieee80211_sta_wmm_params(struct ieee80211_local *local,
819
				     struct ieee80211_sub_if_data *sdata,
820 821 822
				     u8 *wmm_param, size_t wmm_param_len)
{
	struct ieee80211_tx_queue_params params;
823
	struct ieee80211_if_managed *ifmgd = &sdata->u.mgd;
824 825
	size_t left;
	int count;
K
Kalle Valo 已提交
826
	u8 *pos, uapsd_queues = 0;
827

828 829 830
	if (!local->ops->conf_tx)
		return;

J
Johannes Berg 已提交
831
	if (local->hw.queues < 4)
832 833 834 835 836
		return;

	if (!wmm_param)
		return;

837 838
	if (wmm_param_len < 8 || wmm_param[5] /* version */ != 1)
		return;
K
Kalle Valo 已提交
839 840

	if (ifmgd->flags & IEEE80211_STA_UAPSD_ENABLED)
841
		uapsd_queues = local->uapsd_queues;
K
Kalle Valo 已提交
842

843
	count = wmm_param[6] & 0x0f;
844
	if (count == ifmgd->wmm_last_param_set)
845
		return;
846
	ifmgd->wmm_last_param_set = count;
847 848 849 850 851 852 853 854 855 856

	pos = wmm_param + 8;
	left = wmm_param_len - 8;

	memset(&params, 0, sizeof(params));

	local->wmm_acm = 0;
	for (; left >= 4; left -= 4, pos += 4) {
		int aci = (pos[0] >> 5) & 0x03;
		int acm = (pos[0] >> 4) & 0x01;
K
Kalle Valo 已提交
857
		bool uapsd = false;
858 859 860
		int queue;

		switch (aci) {
861
		case 1: /* AC_BK */
J
Johannes Berg 已提交
862
			queue = 3;
J
Johannes Berg 已提交
863
			if (acm)
864
				local->wmm_acm |= BIT(1) | BIT(2); /* BK/- */
K
Kalle Valo 已提交
865 866
			if (uapsd_queues & IEEE80211_WMM_IE_STA_QOSINFO_AC_BK)
				uapsd = true;
867
			break;
868
		case 2: /* AC_VI */
J
Johannes Berg 已提交
869
			queue = 1;
J
Johannes Berg 已提交
870
			if (acm)
871
				local->wmm_acm |= BIT(4) | BIT(5); /* CL/VI */
K
Kalle Valo 已提交
872 873
			if (uapsd_queues & IEEE80211_WMM_IE_STA_QOSINFO_AC_VI)
				uapsd = true;
874
			break;
875
		case 3: /* AC_VO */
J
Johannes Berg 已提交
876
			queue = 0;
J
Johannes Berg 已提交
877
			if (acm)
878
				local->wmm_acm |= BIT(6) | BIT(7); /* VO/NC */
K
Kalle Valo 已提交
879 880
			if (uapsd_queues & IEEE80211_WMM_IE_STA_QOSINFO_AC_VO)
				uapsd = true;
881
			break;
882
		case 0: /* AC_BE */
883
		default:
J
Johannes Berg 已提交
884
			queue = 2;
J
Johannes Berg 已提交
885
			if (acm)
886
				local->wmm_acm |= BIT(0) | BIT(3); /* BE/EE */
K
Kalle Valo 已提交
887 888
			if (uapsd_queues & IEEE80211_WMM_IE_STA_QOSINFO_AC_BE)
				uapsd = true;
889 890 891 892 893 894
			break;
		}

		params.aifs = pos[0] & 0x0f;
		params.cw_max = ecw2cw((pos[1] & 0xf0) >> 4);
		params.cw_min = ecw2cw(pos[1] & 0x0f);
895
		params.txop = get_unaligned_le16(pos + 2);
K
Kalle Valo 已提交
896 897
		params.uapsd = uapsd;

898
#ifdef CONFIG_MAC80211_VERBOSE_DEBUG
J
Joe Perches 已提交
899 900 901 902 903 904
		wiphy_debug(local->hw.wiphy,
			    "WMM queue=%d aci=%d acm=%d aifs=%d "
			    "cWmin=%d cWmax=%d txop=%d uapsd=%d\n",
			    queue, aci, acm,
			    params.aifs, params.cw_min, params.cw_max,
			    params.txop, params.uapsd);
905
#endif
906
		if (drv_conf_tx(local, queue, &params))
J
Joe Perches 已提交
907 908 909
			wiphy_debug(local->hw.wiphy,
				    "failed to set TX queue parameters for queue %d\n",
				    queue);
910
	}
911 912

	/* enable WMM or activate new settings */
913 914
	sdata->vif.bss_conf.qos = true;
	ieee80211_bss_info_change_notify(sdata, BSS_CHANGED_QOS);
915 916
}

J
Johannes Berg 已提交
917 918
static u32 ieee80211_handle_bss_capability(struct ieee80211_sub_if_data *sdata,
					   u16 capab, bool erp_valid, u8 erp)
919
{
J
Johannes Berg 已提交
920
	struct ieee80211_bss_conf *bss_conf = &sdata->vif.bss_conf;
921
	u32 changed = 0;
J
Johannes Berg 已提交
922 923 924 925 926 927 928 929 930 931 932 933 934
	bool use_protection;
	bool use_short_preamble;
	bool use_short_slot;

	if (erp_valid) {
		use_protection = (erp & WLAN_ERP_USE_PROTECTION) != 0;
		use_short_preamble = (erp & WLAN_ERP_BARKER_PREAMBLE) == 0;
	} else {
		use_protection = false;
		use_short_preamble = !!(capab & WLAN_CAPABILITY_SHORT_PREAMBLE);
	}

	use_short_slot = !!(capab & WLAN_CAPABILITY_SHORT_SLOT_TIME);
935 936
	if (sdata->local->hw.conf.channel->band == IEEE80211_BAND_5GHZ)
		use_short_slot = true;
937

938 939 940
	if (use_protection != bss_conf->use_cts_prot) {
		bss_conf->use_cts_prot = use_protection;
		changed |= BSS_CHANGED_ERP_CTS_PROT;
941
	}
942

943 944
	if (use_short_preamble != bss_conf->use_short_preamble) {
		bss_conf->use_short_preamble = use_short_preamble;
945
		changed |= BSS_CHANGED_ERP_PREAMBLE;
946
	}
947

J
Johannes Berg 已提交
948 949 950
	if (use_short_slot != bss_conf->use_short_slot) {
		bss_conf->use_short_slot = use_short_slot;
		changed |= BSS_CHANGED_ERP_SLOT;
951 952 953 954 955
	}

	return changed;
}

956
static void ieee80211_set_associated(struct ieee80211_sub_if_data *sdata,
957
				     struct cfg80211_bss *cbss,
J
Johannes Berg 已提交
958
				     u32 bss_info_changed)
959
{
960
	struct ieee80211_bss *bss = (void *)cbss->priv;
961
	struct ieee80211_local *local = sdata->local;
962
	struct ieee80211_bss_conf *bss_conf = &sdata->vif.bss_conf;
963

J
Johannes Berg 已提交
964
	bss_info_changed |= BSS_CHANGED_ASSOC;
965
	/* set timing information */
966 967
	bss_conf->beacon_int = cbss->beacon_interval;
	bss_conf->timestamp = cbss->tsf;
968

969 970
	bss_info_changed |= BSS_CHANGED_BEACON_INT;
	bss_info_changed |= ieee80211_handle_bss_capability(sdata,
971
		cbss->capability, bss->has_erp_value, bss->erp_value);
972

973 974 975
	sdata->u.mgd.beacon_timeout = usecs_to_jiffies(ieee80211_tu_to_usec(
		IEEE80211_BEACON_LOSS_COUNT * bss_conf->beacon_int));

976 977
	sdata->u.mgd.associated = cbss;
	memcpy(sdata->u.mgd.bssid, cbss->bssid, ETH_ALEN);
978

979 980
	sdata->u.mgd.flags |= IEEE80211_STA_RESET_SIGNAL_AVE;

J
Johannes Berg 已提交
981 982 983 984
	/* just to be sure */
	sdata->u.mgd.flags &= ~(IEEE80211_STA_CONNECTION_POLL |
				IEEE80211_STA_BEACON_POLL);

985
	ieee80211_led_assoc(local, 1);
986

987 988 989 990 991
	if (local->hw.flags & IEEE80211_HW_NEED_DTIM_PERIOD)
		bss_conf->dtim_period = bss->dtim_period;
	else
		bss_conf->dtim_period = 0;

992
	bss_conf->assoc = 1;
993 994 995 996 997
	/*
	 * For now just always ask the driver to update the basic rateset
	 * when we have associated, we aren't checking whether it actually
	 * changed or not.
	 */
J
Johannes Berg 已提交
998
	bss_info_changed |= BSS_CHANGED_BASIC_RATES;
999 1000 1001 1002

	/* And the BSSID changed - we're associated now */
	bss_info_changed |= BSS_CHANGED_BSSID;

1003 1004
	/* Tell the driver to monitor connection quality (if supported) */
	if ((local->hw.flags & IEEE80211_HW_SUPPORTS_CQM_RSSI) &&
1005
	    bss_conf->cqm_rssi_thold)
1006 1007
		bss_info_changed |= BSS_CHANGED_CQM;

1008 1009 1010 1011 1012 1013
	/* Enable ARP filtering */
	if (bss_conf->arp_filter_enabled != sdata->arp_filter_state) {
		bss_conf->arp_filter_enabled = sdata->arp_filter_state;
		bss_info_changed |= BSS_CHANGED_ARP_FILTER;
	}

J
Johannes Berg 已提交
1014
	ieee80211_bss_info_change_notify(sdata, bss_info_changed);
1015

J
Johannes Berg 已提交
1016 1017
	mutex_lock(&local->iflist_mtx);
	ieee80211_recalc_ps(local, -1);
1018
	ieee80211_recalc_smps(local);
J
Johannes Berg 已提交
1019
	mutex_unlock(&local->iflist_mtx);
1020

1021
	netif_tx_start_all_queues(sdata->dev);
1022
	netif_carrier_on(sdata->dev);
1023 1024
}

1025
static void ieee80211_set_disassoc(struct ieee80211_sub_if_data *sdata,
1026
				   bool remove_sta, bool tx)
1027
{
1028
	struct ieee80211_if_managed *ifmgd = &sdata->u.mgd;
1029 1030
	struct ieee80211_local *local = sdata->local;
	struct sta_info *sta;
1031
	u32 changed = 0, config_changed = 0;
J
Johannes Berg 已提交
1032
	u8 bssid[ETH_ALEN];
1033

1034 1035
	ASSERT_MGD_MTX(ifmgd);

J
Johannes Berg 已提交
1036 1037 1038
	if (WARN_ON(!ifmgd->associated))
		return;

1039
	memcpy(bssid, ifmgd->associated->bssid, ETH_ALEN);
J
Johannes Berg 已提交
1040

1041 1042 1043 1044 1045 1046 1047 1048 1049 1050 1051 1052 1053 1054 1055 1056
	ifmgd->associated = NULL;
	memset(ifmgd->bssid, 0, ETH_ALEN);

	/*
	 * we need to commit the associated = NULL change because the
	 * scan code uses that to determine whether this iface should
	 * go to/wake up from powersave or not -- and could otherwise
	 * wake the queues erroneously.
	 */
	smp_mb();

	/*
	 * Thus, we can only afterwards stop the queues -- to account
	 * for the case where another CPU is finishing a scan at this
	 * time -- we don't want the scan code to enable queues.
	 */
1057

1058
	netif_tx_stop_all_queues(sdata->dev);
1059 1060
	netif_carrier_off(sdata->dev);

1061
	mutex_lock(&local->sta_mtx);
1062
	sta = sta_info_get(sdata, bssid);
1063
	if (sta) {
1064
		set_sta_flags(sta, WLAN_STA_BLOCK_BA);
1065
		ieee80211_sta_tear_down_BA_sessions(sta, tx);
1066
	}
1067
	mutex_unlock(&local->sta_mtx);
1068

1069 1070 1071
	changed |= ieee80211_reset_erp_info(sdata);

	ieee80211_led_assoc(local, 0);
J
Johannes Berg 已提交
1072 1073
	changed |= BSS_CHANGED_ASSOC;
	sdata->vif.bss_conf.assoc = false;
1074

1075 1076
	ieee80211_set_wmm_default(sdata);

1077
	/* channel(_type) changes are handled by ieee80211_hw_config */
1078
	WARN_ON(!ieee80211_set_channel_type(local, sdata, NL80211_CHAN_NO_HT));
1079

1080 1081 1082
	/* on the next assoc, re-program HT parameters */
	sdata->ht_opmode_valid = false;

1083 1084
	local->power_constr_level = 0;

1085 1086 1087
	del_timer_sync(&local->dynamic_ps_timer);
	cancel_work_sync(&local->dynamic_ps_enable_work);

1088 1089 1090 1091
	if (local->hw.conf.flags & IEEE80211_CONF_PS) {
		local->hw.conf.flags &= ~IEEE80211_CONF_PS;
		config_changed |= IEEE80211_CONF_CHANGE_PS;
	}
1092
	local->ps_sdata = NULL;
J
Johannes Berg 已提交
1093

1094
	ieee80211_hw_config(local, config_changed);
1095

1096 1097 1098 1099 1100 1101
	/* Disable ARP filtering */
	if (sdata->vif.bss_conf.arp_filter_enabled) {
		sdata->vif.bss_conf.arp_filter_enabled = false;
		changed |= BSS_CHANGED_ARP_FILTER;
	}

1102 1103
	/* The BSSID (not really interesting) and HT changed */
	changed |= BSS_CHANGED_BSSID | BSS_CHANGED_HT;
J
Johannes Berg 已提交
1104
	ieee80211_bss_info_change_notify(sdata, changed);
1105

1106 1107
	if (remove_sta)
		sta_info_destroy_addr(sdata, bssid);
1108 1109 1110 1111 1112

	del_timer_sync(&sdata->u.mgd.conn_mon_timer);
	del_timer_sync(&sdata->u.mgd.bcn_mon_timer);
	del_timer_sync(&sdata->u.mgd.timer);
	del_timer_sync(&sdata->u.mgd.chswitch_timer);
1113
}
1114

1115 1116 1117 1118 1119 1120 1121 1122
void ieee80211_sta_rx_notify(struct ieee80211_sub_if_data *sdata,
			     struct ieee80211_hdr *hdr)
{
	/*
	 * We can postpone the mgd.timer whenever receiving unicast frames
	 * from AP because we know that the connection is working both ways
	 * at that time. But multicast frames (and hence also beacons) must
	 * be ignored here, because we need to trigger the timer during
J
Johannes Berg 已提交
1123 1124
	 * data idle periods for sending the periodic probe request to the
	 * AP we're connected to.
1125
	 */
J
Johannes Berg 已提交
1126 1127 1128
	if (is_multicast_ether_addr(hdr->addr1))
		return;

1129
	ieee80211_sta_reset_conn_monitor(sdata);
1130
}
1131

1132 1133 1134 1135 1136 1137 1138 1139 1140 1141 1142 1143 1144 1145 1146 1147 1148 1149 1150 1151 1152 1153 1154 1155 1156 1157 1158 1159 1160 1161
static void ieee80211_reset_ap_probe(struct ieee80211_sub_if_data *sdata)
{
	struct ieee80211_if_managed *ifmgd = &sdata->u.mgd;

	if (!(ifmgd->flags & (IEEE80211_STA_BEACON_POLL |
			      IEEE80211_STA_CONNECTION_POLL)))
	    return;

	ifmgd->flags &= ~(IEEE80211_STA_CONNECTION_POLL |
			  IEEE80211_STA_BEACON_POLL);
	mutex_lock(&sdata->local->iflist_mtx);
	ieee80211_recalc_ps(sdata->local, -1);
	mutex_unlock(&sdata->local->iflist_mtx);

	if (sdata->local->hw.flags & IEEE80211_HW_CONNECTION_MONITOR)
		return;

	/*
	 * We've received a probe response, but are not sure whether
	 * we have or will be receiving any beacons or data, so let's
	 * schedule the timers again, just in case.
	 */
	ieee80211_sta_reset_beacon_monitor(sdata);

	mod_timer(&ifmgd->conn_mon_timer,
		  round_jiffies_up(jiffies +
				   IEEE80211_CONNECTION_IDLE_TIME));
}

void ieee80211_sta_tx_notify(struct ieee80211_sub_if_data *sdata,
1162
			     struct ieee80211_hdr *hdr, bool ack)
1163
{
F
Felix Fietkau 已提交
1164
	if (!ieee80211_is_data(hdr->frame_control))
1165 1166
	    return;

1167 1168
	if (ack)
		ieee80211_sta_reset_conn_monitor(sdata);
1169 1170 1171

	if (ieee80211_is_nullfunc(hdr->frame_control) &&
	    sdata->u.mgd.probe_send_count > 0) {
1172 1173 1174 1175
		if (ack)
			sdata->u.mgd.probe_send_count = 0;
		else
			sdata->u.mgd.nullfunc_failed = true;
1176 1177 1178 1179
		ieee80211_queue_work(&sdata->local->hw, &sdata->work);
	}
}

1180 1181 1182 1183
static void ieee80211_mgd_probe_ap_send(struct ieee80211_sub_if_data *sdata)
{
	struct ieee80211_if_managed *ifmgd = &sdata->u.mgd;
	const u8 *ssid;
1184
	u8 *dst = ifmgd->associated->bssid;
1185
	u8 unicast_limit = max(1, max_probe_tries - 3);
1186 1187 1188 1189 1190 1191 1192 1193

	/*
	 * Try sending broadcast probe requests for the last three
	 * probe requests after the first ones failed since some
	 * buggy APs only support broadcast probe requests.
	 */
	if (ifmgd->probe_send_count >= unicast_limit)
		dst = NULL;
1194

1195 1196 1197 1198 1199 1200 1201
	/*
	 * When the hardware reports an accurate Tx ACK status, it's
	 * better to send a nullfunc frame instead of a probe request,
	 * as it will kick us off the AP quickly if we aren't associated
	 * anymore. The timeout will be reset if the frame is ACKed by
	 * the AP.
	 */
1202 1203
	if (sdata->local->hw.flags & IEEE80211_HW_REPORTS_TX_ACK_STATUS) {
		ifmgd->nullfunc_failed = false;
1204
		ieee80211_send_nullfunc(sdata->local, sdata, 0);
1205
	} else {
1206 1207 1208
		ssid = ieee80211_bss_get_ie(ifmgd->associated, WLAN_EID_SSID);
		ieee80211_send_probe_req(sdata, dst, ssid + 2, ssid[1], NULL, 0);
	}
1209 1210

	ifmgd->probe_send_count++;
1211
	ifmgd->probe_timeout = jiffies + msecs_to_jiffies(probe_wait_ms);
1212 1213 1214
	run_again(ifmgd, ifmgd->probe_timeout);
}

J
Johannes Berg 已提交
1215 1216
static void ieee80211_mgd_probe_ap(struct ieee80211_sub_if_data *sdata,
				   bool beacon)
1217 1218
{
	struct ieee80211_if_managed *ifmgd = &sdata->u.mgd;
J
Johannes Berg 已提交
1219
	bool already = false;
1220

1221
	if (!ieee80211_sdata_running(sdata))
1222 1223
		return;

1224 1225 1226
	if (sdata->local->scanning)
		return;

1227 1228 1229
	if (sdata->local->tmp_channel)
		return;

1230 1231 1232 1233 1234
	mutex_lock(&ifmgd->mtx);

	if (!ifmgd->associated)
		goto out;

1235
#ifdef CONFIG_MAC80211_VERBOSE_DEBUG
J
Johannes Berg 已提交
1236 1237
	if (beacon && net_ratelimit())
		printk(KERN_DEBUG "%s: detected beacon loss from AP "
1238
		       "- sending probe request\n", sdata->name);
1239
#endif
1240

J
Johannes Berg 已提交
1241 1242 1243 1244 1245 1246 1247 1248 1249 1250 1251 1252 1253 1254 1255 1256 1257 1258 1259 1260 1261 1262 1263
	/*
	 * The driver/our work has already reported this event or the
	 * connection monitoring has kicked in and we have already sent
	 * a probe request. Or maybe the AP died and the driver keeps
	 * reporting until we disassociate...
	 *
	 * In either case we have to ignore the current call to this
	 * function (except for setting the correct probe reason bit)
	 * because otherwise we would reset the timer every time and
	 * never check whether we received a probe response!
	 */
	if (ifmgd->flags & (IEEE80211_STA_BEACON_POLL |
			    IEEE80211_STA_CONNECTION_POLL))
		already = true;

	if (beacon)
		ifmgd->flags |= IEEE80211_STA_BEACON_POLL;
	else
		ifmgd->flags |= IEEE80211_STA_CONNECTION_POLL;

	if (already)
		goto out;

1264 1265 1266 1267
	mutex_lock(&sdata->local->iflist_mtx);
	ieee80211_recalc_ps(sdata->local, -1);
	mutex_unlock(&sdata->local->iflist_mtx);

1268 1269
	ifmgd->probe_send_count = 0;
	ieee80211_mgd_probe_ap_send(sdata);
1270 1271
 out:
	mutex_unlock(&ifmgd->mtx);
1272 1273
}

1274 1275 1276 1277 1278 1279 1280 1281 1282 1283 1284 1285 1286 1287 1288 1289 1290 1291 1292 1293 1294 1295 1296 1297
struct sk_buff *ieee80211_ap_probereq_get(struct ieee80211_hw *hw,
					  struct ieee80211_vif *vif)
{
	struct ieee80211_sub_if_data *sdata = vif_to_sdata(vif);
	struct ieee80211_if_managed *ifmgd = &sdata->u.mgd;
	struct sk_buff *skb;
	const u8 *ssid;

	if (WARN_ON(sdata->vif.type != NL80211_IFTYPE_STATION))
		return NULL;

	ASSERT_MGD_MTX(ifmgd);

	if (!ifmgd->associated)
		return NULL;

	ssid = ieee80211_bss_get_ie(ifmgd->associated, WLAN_EID_SSID);
	skb = ieee80211_build_probe_req(sdata, ifmgd->associated->bssid,
					ssid + 2, ssid[1], NULL, 0);

	return skb;
}
EXPORT_SYMBOL(ieee80211_ap_probereq_get);

1298 1299 1300 1301 1302 1303 1304 1305 1306 1307 1308 1309 1310 1311
static void __ieee80211_connection_loss(struct ieee80211_sub_if_data *sdata)
{
	struct ieee80211_if_managed *ifmgd = &sdata->u.mgd;
	struct ieee80211_local *local = sdata->local;
	u8 bssid[ETH_ALEN];

	mutex_lock(&ifmgd->mtx);
	if (!ifmgd->associated) {
		mutex_unlock(&ifmgd->mtx);
		return;
	}

	memcpy(bssid, ifmgd->associated->bssid, ETH_ALEN);

1312 1313
	printk(KERN_DEBUG "%s: Connection to AP %pM lost.\n",
	       sdata->name, bssid);
1314

1315
	ieee80211_set_disassoc(sdata, true, true);
1316
	mutex_unlock(&ifmgd->mtx);
1317 1318 1319 1320

	mutex_lock(&local->mtx);
	ieee80211_recalc_idle(local);
	mutex_unlock(&local->mtx);
1321 1322 1323 1324 1325 1326 1327
	/*
	 * must be outside lock due to cfg80211,
	 * but that's not a problem.
	 */
	ieee80211_send_deauth_disassoc(sdata, bssid,
				       IEEE80211_STYPE_DEAUTH,
				       WLAN_REASON_DISASSOC_DUE_TO_INACTIVITY,
1328
				       NULL, true);
1329 1330 1331
}

void ieee80211_beacon_connection_loss_work(struct work_struct *work)
J
Johannes Berg 已提交
1332 1333 1334
{
	struct ieee80211_sub_if_data *sdata =
		container_of(work, struct ieee80211_sub_if_data,
1335
			     u.mgd.beacon_connection_loss_work);
J
Johannes Berg 已提交
1336

1337 1338 1339 1340
	if (sdata->local->hw.flags & IEEE80211_HW_CONNECTION_MONITOR)
		__ieee80211_connection_loss(sdata);
	else
		ieee80211_mgd_probe_ap(sdata, true);
J
Johannes Berg 已提交
1341 1342
}

1343 1344 1345
void ieee80211_beacon_loss(struct ieee80211_vif *vif)
{
	struct ieee80211_sub_if_data *sdata = vif_to_sdata(vif);
1346
	struct ieee80211_hw *hw = &sdata->local->hw;
1347

J
Johannes Berg 已提交
1348 1349
	trace_api_beacon_loss(sdata);

1350 1351
	WARN_ON(hw->flags & IEEE80211_HW_CONNECTION_MONITOR);
	ieee80211_queue_work(hw, &sdata->u.mgd.beacon_connection_loss_work);
1352 1353 1354
}
EXPORT_SYMBOL(ieee80211_beacon_loss);

1355 1356 1357 1358 1359
void ieee80211_connection_loss(struct ieee80211_vif *vif)
{
	struct ieee80211_sub_if_data *sdata = vif_to_sdata(vif);
	struct ieee80211_hw *hw = &sdata->local->hw;

J
Johannes Berg 已提交
1360 1361
	trace_api_connection_loss(sdata);

1362 1363 1364 1365 1366 1367
	WARN_ON(!(hw->flags & IEEE80211_HW_CONNECTION_MONITOR));
	ieee80211_queue_work(hw, &sdata->u.mgd.beacon_connection_loss_work);
}
EXPORT_SYMBOL(ieee80211_connection_loss);


1368 1369 1370
static enum rx_mgmt_action __must_check
ieee80211_rx_mgmt_deauth(struct ieee80211_sub_if_data *sdata,
			 struct ieee80211_mgmt *mgmt, size_t len)
1371
{
1372
	struct ieee80211_if_managed *ifmgd = &sdata->u.mgd;
1373
	const u8 *bssid = NULL;
1374 1375
	u16 reason_code;

1376
	if (len < 24 + 2)
1377
		return RX_MGMT_NONE;
1378

1379 1380
	ASSERT_MGD_MTX(ifmgd);

1381
	bssid = ifmgd->associated->bssid;
1382 1383 1384

	reason_code = le16_to_cpu(mgmt->u.deauth.reason_code);

1385
	printk(KERN_DEBUG "%s: deauthenticated from %pM (Reason: %u)\n",
1386
			sdata->name, bssid, reason_code);
1387

1388
	ieee80211_set_disassoc(sdata, true, false);
1389
	mutex_lock(&sdata->local->mtx);
1390
	ieee80211_recalc_idle(sdata->local);
1391
	mutex_unlock(&sdata->local->mtx);
1392

1393
	return RX_MGMT_CFG80211_DEAUTH;
1394 1395 1396
}


1397 1398 1399
static enum rx_mgmt_action __must_check
ieee80211_rx_mgmt_disassoc(struct ieee80211_sub_if_data *sdata,
			   struct ieee80211_mgmt *mgmt, size_t len)
1400
{
1401
	struct ieee80211_if_managed *ifmgd = &sdata->u.mgd;
1402 1403
	u16 reason_code;

1404
	if (len < 24 + 2)
1405
		return RX_MGMT_NONE;
1406

1407 1408 1409 1410 1411
	ASSERT_MGD_MTX(ifmgd);

	if (WARN_ON(!ifmgd->associated))
		return RX_MGMT_NONE;

1412
	if (WARN_ON(memcmp(ifmgd->associated->bssid, mgmt->sa, ETH_ALEN)))
1413
		return RX_MGMT_NONE;
1414 1415 1416

	reason_code = le16_to_cpu(mgmt->u.disassoc.reason_code);

1417
	printk(KERN_DEBUG "%s: disassociated from %pM (Reason: %u)\n",
1418
			sdata->name, mgmt->sa, reason_code);
1419

1420
	ieee80211_set_disassoc(sdata, true, false);
1421
	mutex_lock(&sdata->local->mtx);
1422
	ieee80211_recalc_idle(sdata->local);
1423
	mutex_unlock(&sdata->local->mtx);
1424
	return RX_MGMT_CFG80211_DISASSOC;
1425 1426 1427
}


J
Johannes Berg 已提交
1428 1429
static bool ieee80211_assoc_success(struct ieee80211_work *wk,
				    struct ieee80211_mgmt *mgmt, size_t len)
1430
{
J
Johannes Berg 已提交
1431
	struct ieee80211_sub_if_data *sdata = wk->sdata;
1432
	struct ieee80211_if_managed *ifmgd = &sdata->u.mgd;
1433
	struct ieee80211_local *local = sdata->local;
1434
	struct ieee80211_supported_band *sband;
1435
	struct sta_info *sta;
1436
	struct cfg80211_bss *cbss = wk->assoc.bss;
J
Johannes Berg 已提交
1437
	u8 *pos;
1438
	u32 rates, basic_rates;
J
Johannes Berg 已提交
1439
	u16 capab_info, aid;
1440
	struct ieee802_11_elems elems;
J
Johannes Berg 已提交
1441
	struct ieee80211_bss_conf *bss_conf = &sdata->vif.bss_conf;
J
Johannes Berg 已提交
1442
	u32 changed = 0;
1443 1444
	int i, j, err;
	bool have_higher_than_11mbit = false;
J
Johannes Berg 已提交
1445
	u16 ap_ht_cap_flags;
1446

J
Johannes Berg 已提交
1447
	/* AssocResp and ReassocResp have identical structure */
1448 1449

	aid = le16_to_cpu(mgmt->u.assoc_resp.aid);
J
Johannes Berg 已提交
1450
	capab_info = le16_to_cpu(mgmt->u.assoc_resp.capab_info);
1451

1452 1453
	if ((aid & (BIT(15) | BIT(14))) != (BIT(15) | BIT(14)))
		printk(KERN_DEBUG "%s: invalid aid value %d; bits 15:14 not "
1454
		       "set\n", sdata->name, aid);
1455 1456
	aid &= ~(BIT(15) | BIT(14));

J
Johannes Berg 已提交
1457 1458 1459
	pos = mgmt->u.assoc_resp.variable;
	ieee802_11_parse_elems(pos, len - (pos - (u8 *) mgmt), &elems);

1460 1461
	if (!elems.supp_rates) {
		printk(KERN_DEBUG "%s: no SuppRates element in AssocResp\n",
1462
		       sdata->name);
J
Johannes Berg 已提交
1463
		return false;
1464 1465
	}

1466
	ifmgd->aid = aid;
1467

1468
	sta = sta_info_alloc(sdata, cbss->bssid, GFP_KERNEL);
1469
	if (!sta) {
1470 1471
		printk(KERN_DEBUG "%s: failed to alloc STA entry for"
		       " the AP\n", sdata->name);
J
Johannes Berg 已提交
1472
		return false;
1473
	}
1474

1475 1476 1477 1478 1479
	set_sta_flags(sta, WLAN_STA_AUTH | WLAN_STA_ASSOC |
			   WLAN_STA_ASSOC_AP);
	if (!(ifmgd->flags & IEEE80211_STA_CONTROL_PORT))
		set_sta_flags(sta, WLAN_STA_AUTHORIZED);

J
Johannes Berg 已提交
1480 1481
	rates = 0;
	basic_rates = 0;
1482
	sband = local->hw.wiphy->bands[wk->chan->band];
1483

J
Johannes Berg 已提交
1484 1485
	for (i = 0; i < elems.supp_rates_len; i++) {
		int rate = (elems.supp_rates[i] & 0x7f) * 5;
1486
		bool is_basic = !!(elems.supp_rates[i] & 0x80);
1487

J
Johannes Berg 已提交
1488 1489 1490 1491
		if (rate > 110)
			have_higher_than_11mbit = true;

		for (j = 0; j < sband->n_bitrates; j++) {
1492
			if (sband->bitrates[j].bitrate == rate) {
J
Johannes Berg 已提交
1493
				rates |= BIT(j);
1494 1495 1496 1497
				if (is_basic)
					basic_rates |= BIT(j);
				break;
			}
1498 1499 1500
		}
	}

J
Johannes Berg 已提交
1501 1502
	for (i = 0; i < elems.ext_supp_rates_len; i++) {
		int rate = (elems.ext_supp_rates[i] & 0x7f) * 5;
1503
		bool is_basic = !!(elems.ext_supp_rates[i] & 0x80);
1504

J
Johannes Berg 已提交
1505 1506
		if (rate > 110)
			have_higher_than_11mbit = true;
1507

J
Johannes Berg 已提交
1508
		for (j = 0; j < sband->n_bitrates; j++) {
1509
			if (sband->bitrates[j].bitrate == rate) {
J
Johannes Berg 已提交
1510
				rates |= BIT(j);
1511 1512 1513 1514
				if (is_basic)
					basic_rates |= BIT(j);
				break;
			}
J
Johannes Berg 已提交
1515
		}
1516
	}
1517

1518
	sta->sta.supp_rates[wk->chan->band] = rates;
J
Johannes Berg 已提交
1519
	sdata->vif.bss_conf.basic_rates = basic_rates;
J
Johannes Berg 已提交
1520 1521

	/* cf. IEEE 802.11 9.2.12 */
1522
	if (wk->chan->band == IEEE80211_BAND_2GHZ &&
J
Johannes Berg 已提交
1523 1524 1525 1526
	    have_higher_than_11mbit)
		sdata->flags |= IEEE80211_SDATA_OPERATING_GMODE;
	else
		sdata->flags &= ~IEEE80211_SDATA_OPERATING_GMODE;
1527

1528
	if (elems.ht_cap_elem && !(ifmgd->flags & IEEE80211_STA_DISABLE_11N))
J
Johannes Berg 已提交
1529
		ieee80211_ht_cap_ie_to_sta_ht_cap(sband,
J
Johannes Berg 已提交
1530
				elems.ht_cap_elem, &sta->sta.ht_cap);
J
Johannes Berg 已提交
1531 1532

	ap_ht_cap_flags = sta->sta.ht_cap.cap;
1533

1534
	rate_control_rate_init(sta);
1535

1536
	if (ifmgd->flags & IEEE80211_STA_MFP_ENABLED)
1537 1538
		set_sta_flags(sta, WLAN_STA_MFP);

1539
	if (elems.wmm_param)
J
Johannes Berg 已提交
1540
		set_sta_flags(sta, WLAN_STA_WME);
1541

1542 1543 1544 1545 1546
	err = sta_info_insert(sta);
	sta = NULL;
	if (err) {
		printk(KERN_DEBUG "%s: failed to insert STA entry for"
		       " the AP (error %d)\n", sdata->name, err);
1547
		return false;
1548 1549
	}

1550 1551 1552 1553 1554 1555 1556 1557
	/*
	 * Always handle WMM once after association regardless
	 * of the first value the AP uses. Setting -1 here has
	 * that effect because the AP values is an unsigned
	 * 4-bit value.
	 */
	ifmgd->wmm_last_param_set = -1;

1558
	if (elems.wmm_param)
1559
		ieee80211_sta_wmm_params(local, sdata, elems.wmm_param,
J
Johannes Berg 已提交
1560
					 elems.wmm_param_len);
1561 1562
	else
		ieee80211_set_wmm_default(sdata);
1563

1564 1565
	local->oper_channel = wk->chan;

J
Johannes Berg 已提交
1566
	if (elems.ht_info_elem && elems.wmm_param &&
J
Johannes Berg 已提交
1567
	    (sdata->local->hw.queues >= 4) &&
1568
	    !(ifmgd->flags & IEEE80211_STA_DISABLE_11N))
J
Johannes Berg 已提交
1569
		changed |= ieee80211_enable_ht(sdata, elems.ht_info_elem,
1570
					       cbss->bssid, ap_ht_cap_flags);
J
Johannes Berg 已提交
1571

J
Johannes Berg 已提交
1572 1573 1574 1575
	/* set AID and assoc capability,
	 * ieee80211_set_associated() will tell the driver */
	bss_conf->aid = aid;
	bss_conf->assoc_capability = capab_info;
1576
	ieee80211_set_associated(sdata, cbss, changed);
1577

1578 1579 1580 1581 1582 1583 1584
	/*
	 * If we're using 4-addr mode, let the AP know that we're
	 * doing so, so that it can create the STA VLAN on its side
	 */
	if (ifmgd->use_4addr)
		ieee80211_send_4addr_nullfunc(local, sdata);

1585
	/*
J
Johannes Berg 已提交
1586 1587
	 * Start timer to probe the connection to the AP now.
	 * Also start the timer that will detect beacon loss.
1588
	 */
J
Johannes Berg 已提交
1589
	ieee80211_sta_rx_notify(sdata, (struct ieee80211_hdr *)mgmt);
1590
	ieee80211_sta_reset_beacon_monitor(sdata);
1591

J
Johannes Berg 已提交
1592
	return true;
1593 1594 1595
}


1596 1597 1598 1599 1600 1601 1602 1603 1604
static void ieee80211_rx_bss_info(struct ieee80211_sub_if_data *sdata,
				  struct ieee80211_mgmt *mgmt,
				  size_t len,
				  struct ieee80211_rx_status *rx_status,
				  struct ieee802_11_elems *elems,
				  bool beacon)
{
	struct ieee80211_local *local = sdata->local;
	int freq;
1605
	struct ieee80211_bss *bss;
1606
	struct ieee80211_channel *channel;
1607 1608 1609 1610 1611 1612 1613
	bool need_ps = false;

	if (sdata->u.mgd.associated) {
		bss = (void *)sdata->u.mgd.associated->priv;
		/* not previously set so we may need to recalc */
		need_ps = !bss->dtim_period;
	}
1614 1615

	if (elems->ds_params && elems->ds_params_len == 1)
1616 1617
		freq = ieee80211_channel_to_frequency(elems->ds_params[0],
						      rx_status->band);
1618 1619 1620 1621 1622 1623 1624 1625 1626
	else
		freq = rx_status->freq;

	channel = ieee80211_get_channel(local->hw.wiphy, freq);

	if (!channel || channel->flags & IEEE80211_CHAN_DISABLED)
		return;

	bss = ieee80211_bss_info_update(local, rx_status, mgmt, len, elems,
1627
					channel, beacon);
1628 1629 1630 1631
	if (bss)
		ieee80211_rx_bss_put(local, bss);

	if (!sdata->u.mgd.associated)
1632 1633
		return;

1634 1635 1636 1637 1638 1639
	if (need_ps) {
		mutex_lock(&local->iflist_mtx);
		ieee80211_recalc_ps(local, -1);
		mutex_unlock(&local->iflist_mtx);
	}

S
Sujith 已提交
1640
	if (elems->ch_switch_elem && (elems->ch_switch_elem_len == 3) &&
1641
	    (memcmp(mgmt->bssid, sdata->u.mgd.associated->bssid,
1642
							ETH_ALEN) == 0)) {
S
Sujith 已提交
1643 1644
		struct ieee80211_channel_sw_ie *sw_elem =
			(struct ieee80211_channel_sw_ie *)elems->ch_switch_elem;
1645 1646
		ieee80211_sta_process_chanswitch(sdata, sw_elem,
						 bss, rx_status->mactime);
S
Sujith 已提交
1647
	}
1648 1649 1650
}


1651
static void ieee80211_rx_mgmt_probe_resp(struct ieee80211_sub_if_data *sdata,
J
Johannes Berg 已提交
1652
					 struct sk_buff *skb)
1653
{
J
Johannes Berg 已提交
1654
	struct ieee80211_mgmt *mgmt = (void *)skb->data;
1655
	struct ieee80211_if_managed *ifmgd;
J
Johannes Berg 已提交
1656 1657
	struct ieee80211_rx_status *rx_status = (void *) skb->cb;
	size_t baselen, len = skb->len;
1658 1659
	struct ieee802_11_elems elems;

1660 1661
	ifmgd = &sdata->u.mgd;

1662 1663
	ASSERT_MGD_MTX(ifmgd);

1664
	if (memcmp(mgmt->da, sdata->vif.addr, ETH_ALEN))
1665 1666
		return; /* ignore ProbeResp to foreign address */

1667 1668 1669 1670 1671 1672 1673
	baselen = (u8 *) mgmt->u.probe_resp.variable - (u8 *) mgmt;
	if (baselen > len)
		return;

	ieee802_11_parse_elems(mgmt->u.probe_resp.variable, len - baselen,
				&elems);

1674
	ieee80211_rx_bss_info(sdata, mgmt, len, rx_status, &elems, false);
1675

1676
	if (ifmgd->associated &&
1677 1678
	    memcmp(mgmt->bssid, ifmgd->associated->bssid, ETH_ALEN) == 0)
		ieee80211_reset_ap_probe(sdata);
1679 1680
}

1681 1682 1683 1684 1685 1686 1687 1688 1689 1690 1691 1692 1693 1694
/*
 * This is the canonical list of information elements we care about,
 * the filter code also gives us all changes to the Microsoft OUI
 * (00:50:F2) vendor IE which is used for WMM which we need to track.
 *
 * We implement beacon filtering in software since that means we can
 * avoid processing the frame here and in cfg80211, and userspace
 * will not be able to tell whether the hardware supports it or not.
 *
 * XXX: This list needs to be dynamic -- userspace needs to be able to
 *	add items it requires. It also needs to be able to tell us to
 *	look out for other vendor IEs.
 */
static const u64 care_about_ies =
1695 1696 1697 1698 1699 1700
	(1ULL << WLAN_EID_COUNTRY) |
	(1ULL << WLAN_EID_ERP_INFO) |
	(1ULL << WLAN_EID_CHANNEL_SWITCH) |
	(1ULL << WLAN_EID_PWR_CONSTRAINT) |
	(1ULL << WLAN_EID_HT_CAPABILITY) |
	(1ULL << WLAN_EID_HT_INFORMATION);
1701

1702
static void ieee80211_rx_mgmt_beacon(struct ieee80211_sub_if_data *sdata,
1703 1704 1705 1706
				     struct ieee80211_mgmt *mgmt,
				     size_t len,
				     struct ieee80211_rx_status *rx_status)
{
1707
	struct ieee80211_if_managed *ifmgd = &sdata->u.mgd;
1708
	struct ieee80211_bss_conf *bss_conf = &sdata->vif.bss_conf;
1709 1710
	size_t baselen;
	struct ieee802_11_elems elems;
1711
	struct ieee80211_local *local = sdata->local;
1712
	u32 changed = 0;
1713
	bool erp_valid, directed_tim = false;
J
Johannes Berg 已提交
1714
	u8 erp_value = 0;
1715
	u32 ncrc;
1716 1717 1718
	u8 *bssid;

	ASSERT_MGD_MTX(ifmgd);
1719

1720 1721 1722 1723 1724
	/* Process beacon from the current BSS */
	baselen = (u8 *) mgmt->u.beacon.variable - (u8 *) mgmt;
	if (baselen > len)
		return;

1725
	if (rx_status->freq != local->hw.conf.channel->center_freq)
1726 1727
		return;

J
Johannes Berg 已提交
1728 1729 1730 1731 1732
	/*
	 * We might have received a number of frames, among them a
	 * disassoc frame and a beacon...
	 */
	if (!ifmgd->associated)
1733 1734
		return;

1735
	bssid = ifmgd->associated->bssid;
1736

J
Johannes Berg 已提交
1737 1738 1739 1740 1741
	/*
	 * And in theory even frames from a different AP we were just
	 * associated to a split-second ago!
	 */
	if (memcmp(bssid, mgmt->bssid, ETH_ALEN) != 0)
1742 1743
		return;

1744 1745 1746 1747
	/* Track average RSSI from the Beacon frames of the current AP */
	ifmgd->last_beacon_signal = rx_status->signal;
	if (ifmgd->flags & IEEE80211_STA_RESET_SIGNAL_AVE) {
		ifmgd->flags &= ~IEEE80211_STA_RESET_SIGNAL_AVE;
1748
		ifmgd->ave_beacon_signal = rx_status->signal * 16;
1749
		ifmgd->last_cqm_event_signal = 0;
1750
		ifmgd->count_beacon_signal = 1;
1751 1752 1753 1754 1755
	} else {
		ifmgd->ave_beacon_signal =
			(IEEE80211_SIGNAL_AVE_WEIGHT * rx_status->signal * 16 +
			 (16 - IEEE80211_SIGNAL_AVE_WEIGHT) *
			 ifmgd->ave_beacon_signal) / 16;
1756
		ifmgd->count_beacon_signal++;
1757 1758
	}
	if (bss_conf->cqm_rssi_thold &&
1759
	    ifmgd->count_beacon_signal >= IEEE80211_SIGNAL_AVE_MIN_COUNT &&
1760 1761 1762 1763 1764 1765 1766 1767 1768 1769 1770 1771 1772 1773 1774 1775 1776 1777 1778 1779 1780 1781
	    !(local->hw.flags & IEEE80211_HW_SUPPORTS_CQM_RSSI)) {
		int sig = ifmgd->ave_beacon_signal / 16;
		int last_event = ifmgd->last_cqm_event_signal;
		int thold = bss_conf->cqm_rssi_thold;
		int hyst = bss_conf->cqm_rssi_hyst;
		if (sig < thold &&
		    (last_event == 0 || sig < last_event - hyst)) {
			ifmgd->last_cqm_event_signal = sig;
			ieee80211_cqm_rssi_notify(
				&sdata->vif,
				NL80211_CQM_RSSI_THRESHOLD_EVENT_LOW,
				GFP_KERNEL);
		} else if (sig > thold &&
			   (last_event == 0 || sig > last_event + hyst)) {
			ifmgd->last_cqm_event_signal = sig;
			ieee80211_cqm_rssi_notify(
				&sdata->vif,
				NL80211_CQM_RSSI_THRESHOLD_EVENT_HIGH,
				GFP_KERNEL);
		}
	}

J
Johannes Berg 已提交
1782
	if (ifmgd->flags & IEEE80211_STA_BEACON_POLL) {
1783 1784 1785
#ifdef CONFIG_MAC80211_VERBOSE_DEBUG
		if (net_ratelimit()) {
			printk(KERN_DEBUG "%s: cancelling probereq poll due "
1786
			       "to a received beacon\n", sdata->name);
1787 1788
		}
#endif
J
Johannes Berg 已提交
1789
		ifmgd->flags &= ~IEEE80211_STA_BEACON_POLL;
1790 1791 1792
		mutex_lock(&local->iflist_mtx);
		ieee80211_recalc_ps(local, -1);
		mutex_unlock(&local->iflist_mtx);
1793 1794
	}

J
Johannes Berg 已提交
1795 1796 1797 1798
	/*
	 * Push the beacon loss detection into the future since
	 * we are processing a beacon from the AP just now.
	 */
1799
	ieee80211_sta_reset_beacon_monitor(sdata);
J
Johannes Berg 已提交
1800

1801 1802 1803 1804 1805 1806
	ncrc = crc32_be(0, (void *)&mgmt->u.beacon.beacon_int, 4);
	ncrc = ieee802_11_parse_elems_crc(mgmt->u.beacon.variable,
					  len - baselen, &elems,
					  care_about_ies, ncrc);

	if (local->hw.flags & IEEE80211_HW_PS_NULLFUNC_STACK)
1807 1808
		directed_tim = ieee80211_check_tim(elems.tim, elems.tim_len,
						   ifmgd->aid);
1809

1810
	if (ncrc != ifmgd->beacon_crc || !ifmgd->beacon_crc_valid) {
1811 1812
		ieee80211_rx_bss_info(sdata, mgmt, len, rx_status, &elems,
				      true);
1813

1814
		ieee80211_sta_wmm_params(local, sdata, elems.wmm_param,
1815 1816
					 elems.wmm_param_len);
	}
1817

1818
	if (local->hw.flags & IEEE80211_HW_PS_NULLFUNC_STACK) {
1819
		if (directed_tim) {
1820 1821 1822 1823 1824 1825 1826 1827 1828 1829 1830 1831 1832 1833 1834 1835 1836 1837
			if (local->hw.conf.dynamic_ps_timeout > 0) {
				local->hw.conf.flags &= ~IEEE80211_CONF_PS;
				ieee80211_hw_config(local,
						    IEEE80211_CONF_CHANGE_PS);
				ieee80211_send_nullfunc(local, sdata, 0);
			} else {
				local->pspolling = true;

				/*
				 * Here is assumed that the driver will be
				 * able to send ps-poll frame and receive a
				 * response even though power save mode is
				 * enabled, but some drivers might require
				 * to disable power save here. This needs
				 * to be investigated.
				 */
				ieee80211_send_pspoll(local, sdata);
			}
1838 1839
		}
	}
J
Johannes Berg 已提交
1840

1841
	if (ncrc == ifmgd->beacon_crc && ifmgd->beacon_crc_valid)
1842 1843
		return;
	ifmgd->beacon_crc = ncrc;
1844
	ifmgd->beacon_crc_valid = true;
1845

J
Johannes Berg 已提交
1846 1847 1848 1849 1850
	if (elems.erp_info && elems.erp_info_len >= 1) {
		erp_valid = true;
		erp_value = elems.erp_info[0];
	} else {
		erp_valid = false;
1851
	}
J
Johannes Berg 已提交
1852 1853 1854
	changed |= ieee80211_handle_bss_capability(sdata,
			le16_to_cpu(mgmt->u.beacon.capab_info),
			erp_valid, erp_value);
1855

1856

1857
	if (elems.ht_cap_elem && elems.ht_info_elem && elems.wmm_param &&
1858
	    !(ifmgd->flags & IEEE80211_STA_DISABLE_11N)) {
J
Johannes Berg 已提交
1859 1860 1861 1862 1863 1864
		struct sta_info *sta;
		struct ieee80211_supported_band *sband;
		u16 ap_ht_cap_flags;

		rcu_read_lock();

1865
		sta = sta_info_get(sdata, bssid);
1866
		if (WARN_ON(!sta)) {
J
Johannes Berg 已提交
1867 1868 1869 1870 1871 1872 1873 1874 1875 1876 1877 1878 1879 1880
			rcu_read_unlock();
			return;
		}

		sband = local->hw.wiphy->bands[local->hw.conf.channel->band];

		ieee80211_ht_cap_ie_to_sta_ht_cap(sband,
				elems.ht_cap_elem, &sta->sta.ht_cap);

		ap_ht_cap_flags = sta->sta.ht_cap.cap;

		rcu_read_unlock();

		changed |= ieee80211_enable_ht(sdata, elems.ht_info_elem,
1881
					       bssid, ap_ht_cap_flags);
1882 1883
	}

1884
	/* Note: country IE parsing is done for us by cfg80211 */
1885
	if (elems.country_elem) {
1886 1887 1888 1889 1890 1891
		/* TODO: IBSS also needs this */
		if (elems.pwr_constr_elem)
			ieee80211_handle_pwr_constr(sdata,
				le16_to_cpu(mgmt->u.probe_resp.capab_info),
				elems.pwr_constr_elem,
				elems.pwr_constr_elem_len);
1892 1893
	}

1894
	ieee80211_bss_info_change_notify(sdata, changed);
1895 1896
}

1897 1898
void ieee80211_sta_rx_queued_mgmt(struct ieee80211_sub_if_data *sdata,
				  struct sk_buff *skb)
1899
{
1900
	struct ieee80211_if_managed *ifmgd = &sdata->u.mgd;
1901 1902
	struct ieee80211_rx_status *rx_status;
	struct ieee80211_mgmt *mgmt;
1903
	enum rx_mgmt_action rma = RX_MGMT_NONE;
1904 1905 1906 1907 1908 1909
	u16 fc;

	rx_status = (struct ieee80211_rx_status *) skb->cb;
	mgmt = (struct ieee80211_mgmt *) skb->data;
	fc = le16_to_cpu(mgmt->frame_control);

1910 1911 1912
	mutex_lock(&ifmgd->mtx);

	if (ifmgd->associated &&
1913
	    memcmp(ifmgd->associated->bssid, mgmt->bssid, ETH_ALEN) == 0) {
1914 1915 1916 1917 1918 1919
		switch (fc & IEEE80211_FCTL_STYPE) {
		case IEEE80211_STYPE_BEACON:
			ieee80211_rx_mgmt_beacon(sdata, mgmt, skb->len,
						 rx_status);
			break;
		case IEEE80211_STYPE_PROBE_RESP:
J
Johannes Berg 已提交
1920
			ieee80211_rx_mgmt_probe_resp(sdata, skb);
1921 1922
			break;
		case IEEE80211_STYPE_DEAUTH:
1923
			rma = ieee80211_rx_mgmt_deauth(sdata, mgmt, skb->len);
1924 1925 1926 1927 1928
			break;
		case IEEE80211_STYPE_DISASSOC:
			rma = ieee80211_rx_mgmt_disassoc(sdata, mgmt, skb->len);
			break;
		case IEEE80211_STYPE_ACTION:
1929 1930 1931 1932 1933 1934 1935 1936
			switch (mgmt->u.action.category) {
			case WLAN_CATEGORY_SPECTRUM_MGMT:
				ieee80211_sta_process_chanswitch(sdata,
						&mgmt->u.action.u.chan_switch.sw_elem,
						(void *)ifmgd->associated->priv,
						rx_status->mactime);
				break;
			}
1937 1938 1939 1940 1941 1942 1943 1944
		}
		mutex_unlock(&ifmgd->mtx);

		switch (rma) {
		case RX_MGMT_NONE:
			/* no action */
			break;
		case RX_MGMT_CFG80211_DEAUTH:
1945
			cfg80211_send_deauth(sdata->dev, (u8 *)mgmt, skb->len);
1946 1947
			break;
		case RX_MGMT_CFG80211_DISASSOC:
1948
			cfg80211_send_disassoc(sdata->dev, (u8 *)mgmt, skb->len);
1949 1950 1951 1952
			break;
		default:
			WARN(1, "unexpected: %d", rma);
		}
1953
		return;
1954 1955 1956 1957
	}

	mutex_unlock(&ifmgd->mtx);

1958
	if (skb->len >= 24 + 2 /* mgmt + deauth reason */ &&
1959 1960 1961 1962
	    (fc & IEEE80211_FCTL_STYPE) == IEEE80211_STYPE_DEAUTH) {
		struct ieee80211_local *local = sdata->local;
		struct ieee80211_work *wk;

1963
		mutex_lock(&local->mtx);
1964 1965 1966 1967
		list_for_each_entry(wk, &local->work_list, list) {
			if (wk->sdata != sdata)
				continue;

1968 1969
			if (wk->type != IEEE80211_WORK_ASSOC &&
			    wk->type != IEEE80211_WORK_ASSOC_BEACON_WAIT)
1970 1971 1972 1973 1974 1975 1976 1977 1978 1979 1980 1981 1982 1983 1984 1985 1986 1987 1988 1989 1990 1991 1992 1993 1994
				continue;

			if (memcmp(mgmt->bssid, wk->filter_ta, ETH_ALEN))
				continue;
			if (memcmp(mgmt->sa, wk->filter_ta, ETH_ALEN))
				continue;

			/*
			 * Printing the message only here means we can't
			 * spuriously print it, but it also means that it
			 * won't be printed when the frame comes in before
			 * we even tried to associate or in similar cases.
			 *
			 * Ultimately, I suspect cfg80211 should print the
			 * messages instead.
			 */
			printk(KERN_DEBUG
			       "%s: deauthenticated from %pM (Reason: %u)\n",
			       sdata->name, mgmt->bssid,
			       le16_to_cpu(mgmt->u.deauth.reason_code));

			list_del_rcu(&wk->list);
			free_work(wk);
			break;
		}
1995
		mutex_unlock(&local->mtx);
1996

1997
		cfg80211_send_deauth(sdata->dev, (u8 *)mgmt, skb->len);
1998
	}
1999 2000
}

J
Johannes Berg 已提交
2001
static void ieee80211_sta_timer(unsigned long data)
2002
{
J
Johannes Berg 已提交
2003 2004
	struct ieee80211_sub_if_data *sdata =
		(struct ieee80211_sub_if_data *) data;
2005
	struct ieee80211_if_managed *ifmgd = &sdata->u.mgd;
J
Johannes Berg 已提交
2006
	struct ieee80211_local *local = sdata->local;
2007

2008 2009 2010 2011 2012
	if (local->quiescing) {
		set_bit(TMR_RUNNING_TIMER, &ifmgd->timers_running);
		return;
	}

J
Johannes Berg 已提交
2013
	ieee80211_queue_work(&local->hw, &sdata->work);
2014 2015
}

2016 2017 2018 2019 2020 2021 2022 2023 2024 2025 2026 2027 2028 2029 2030 2031 2032 2033 2034 2035 2036 2037 2038 2039 2040
static void ieee80211_sta_connection_lost(struct ieee80211_sub_if_data *sdata,
					  u8 *bssid)
{
	struct ieee80211_local *local = sdata->local;
	struct ieee80211_if_managed *ifmgd = &sdata->u.mgd;

	ifmgd->flags &= ~(IEEE80211_STA_CONNECTION_POLL |
			  IEEE80211_STA_BEACON_POLL);

	ieee80211_set_disassoc(sdata, true, true);
	mutex_unlock(&ifmgd->mtx);
	mutex_lock(&local->mtx);
	ieee80211_recalc_idle(local);
	mutex_unlock(&local->mtx);
	/*
	 * must be outside lock due to cfg80211,
	 * but that's not a problem.
	 */
	ieee80211_send_deauth_disassoc(sdata, bssid,
			IEEE80211_STYPE_DEAUTH,
			WLAN_REASON_DISASSOC_DUE_TO_INACTIVITY,
			NULL, true);
	mutex_lock(&ifmgd->mtx);
}

2041
void ieee80211_sta_work(struct ieee80211_sub_if_data *sdata)
J
Johannes Berg 已提交
2042 2043
{
	struct ieee80211_local *local = sdata->local;
2044
	struct ieee80211_if_managed *ifmgd = &sdata->u.mgd;
J
Johannes Berg 已提交
2045

2046 2047 2048
	/* then process the rest of the work */
	mutex_lock(&ifmgd->mtx);

J
Johannes Berg 已提交
2049 2050 2051
	if (ifmgd->flags & (IEEE80211_STA_BEACON_POLL |
			    IEEE80211_STA_CONNECTION_POLL) &&
	    ifmgd->associated) {
2052
		u8 bssid[ETH_ALEN];
2053
		int max_tries;
2054

2055
		memcpy(bssid, ifmgd->associated->bssid, ETH_ALEN);
2056

2057
		if (local->hw.flags & IEEE80211_HW_REPORTS_TX_ACK_STATUS)
2058
			max_tries = max_nullfunc_tries;
2059
		else
2060
			max_tries = max_probe_tries;
2061

2062 2063 2064
		/* ACK received for nullfunc probing frame */
		if (!ifmgd->probe_send_count)
			ieee80211_reset_ap_probe(sdata);
2065 2066 2067 2068 2069
		else if (ifmgd->nullfunc_failed) {
			if (ifmgd->probe_send_count < max_tries) {
#ifdef CONFIG_MAC80211_VERBOSE_DEBUG
				wiphy_debug(local->hw.wiphy,
					    "%s: No ack for nullfunc frame to"
2070
					    " AP %pM, try %d/%i\n",
2071
					    sdata->name, bssid,
2072
					    ifmgd->probe_send_count, max_tries);
2073 2074 2075 2076 2077 2078 2079
#endif
				ieee80211_mgd_probe_ap_send(sdata);
			} else {
#ifdef CONFIG_MAC80211_VERBOSE_DEBUG
				wiphy_debug(local->hw.wiphy,
					    "%s: No ack for nullfunc frame to"
					    " AP %pM, disconnecting.\n",
F
Felix Fietkau 已提交
2080
					    sdata->name, bssid);
2081 2082 2083 2084
#endif
				ieee80211_sta_connection_lost(sdata, bssid);
			}
		} else if (time_is_after_jiffies(ifmgd->probe_timeout))
J
Johannes Berg 已提交
2085
			run_again(ifmgd, ifmgd->probe_timeout);
2086 2087 2088 2089 2090 2091
		else if (local->hw.flags & IEEE80211_HW_REPORTS_TX_ACK_STATUS) {
#ifdef CONFIG_MAC80211_VERBOSE_DEBUG
			wiphy_debug(local->hw.wiphy,
				    "%s: Failed to send nullfunc to AP %pM"
				    " after %dms, disconnecting.\n",
				    sdata->name,
2092
				    bssid, probe_wait_ms);
2093 2094 2095
#endif
			ieee80211_sta_connection_lost(sdata, bssid);
		} else if (ifmgd->probe_send_count < max_tries) {
2096
#ifdef CONFIG_MAC80211_VERBOSE_DEBUG
2097 2098
			wiphy_debug(local->hw.wiphy,
				    "%s: No probe response from AP %pM"
2099
				    " after %dms, try %d/%i\n",
2100
				    sdata->name,
2101
				    bssid, probe_wait_ms,
2102
				    ifmgd->probe_send_count, max_tries);
2103 2104 2105
#endif
			ieee80211_mgd_probe_ap_send(sdata);
		} else {
J
Johannes Berg 已提交
2106 2107 2108 2109
			/*
			 * We actually lost the connection ... or did we?
			 * Let's make sure!
			 */
2110 2111 2112 2113
			wiphy_debug(local->hw.wiphy,
				    "%s: No probe response from AP %pM"
				    " after %dms, disconnecting.\n",
				    sdata->name,
2114
				    bssid, probe_wait_ms);
2115 2116

			ieee80211_sta_connection_lost(sdata, bssid);
J
Johannes Berg 已提交
2117 2118 2119
		}
	}

2120
	mutex_unlock(&ifmgd->mtx);
2121 2122
}

J
Johannes Berg 已提交
2123 2124 2125 2126 2127 2128 2129 2130 2131
static void ieee80211_sta_bcn_mon_timer(unsigned long data)
{
	struct ieee80211_sub_if_data *sdata =
		(struct ieee80211_sub_if_data *) data;
	struct ieee80211_local *local = sdata->local;

	if (local->quiescing)
		return;

2132 2133
	ieee80211_queue_work(&sdata->local->hw,
			     &sdata->u.mgd.beacon_connection_loss_work);
J
Johannes Berg 已提交
2134 2135 2136 2137 2138 2139 2140 2141 2142 2143 2144 2145
}

static void ieee80211_sta_conn_mon_timer(unsigned long data)
{
	struct ieee80211_sub_if_data *sdata =
		(struct ieee80211_sub_if_data *) data;
	struct ieee80211_if_managed *ifmgd = &sdata->u.mgd;
	struct ieee80211_local *local = sdata->local;

	if (local->quiescing)
		return;

2146
	ieee80211_queue_work(&local->hw, &ifmgd->monitor_work);
J
Johannes Berg 已提交
2147 2148 2149 2150 2151 2152 2153 2154 2155 2156 2157
}

static void ieee80211_sta_monitor_work(struct work_struct *work)
{
	struct ieee80211_sub_if_data *sdata =
		container_of(work, struct ieee80211_sub_if_data,
			     u.mgd.monitor_work);

	ieee80211_mgd_probe_ap(sdata, false);
}

J
Johannes Berg 已提交
2158 2159
static void ieee80211_restart_sta_timer(struct ieee80211_sub_if_data *sdata)
{
2160
	if (sdata->vif.type == NL80211_IFTYPE_STATION) {
J
Johannes Berg 已提交
2161 2162
		sdata->u.mgd.flags &= ~(IEEE80211_STA_BEACON_POLL |
					IEEE80211_STA_CONNECTION_POLL);
2163

J
Johannes Berg 已提交
2164
		/* let's probe the connection once */
2165
		ieee80211_queue_work(&sdata->local->hw,
J
Johannes Berg 已提交
2166 2167
			   &sdata->u.mgd.monitor_work);
		/* and do all the other regular work too */
J
Johannes Berg 已提交
2168
		ieee80211_queue_work(&sdata->local->hw, &sdata->work);
2169
	}
J
Johannes Berg 已提交
2170
}
2171

2172 2173 2174 2175 2176 2177 2178 2179 2180 2181 2182
#ifdef CONFIG_PM
void ieee80211_sta_quiesce(struct ieee80211_sub_if_data *sdata)
{
	struct ieee80211_if_managed *ifmgd = &sdata->u.mgd;

	/*
	 * we need to use atomic bitops for the running bits
	 * only because both timers might fire at the same
	 * time -- the code here is properly synchronised.
	 */

2183 2184
	cancel_work_sync(&ifmgd->request_smps_work);

2185
	cancel_work_sync(&ifmgd->beacon_connection_loss_work);
2186 2187 2188 2189 2190 2191
	if (del_timer_sync(&ifmgd->timer))
		set_bit(TMR_RUNNING_TIMER, &ifmgd->timers_running);

	cancel_work_sync(&ifmgd->chswitch_work);
	if (del_timer_sync(&ifmgd->chswitch_timer))
		set_bit(TMR_RUNNING_CHANSW, &ifmgd->timers_running);
J
Johannes Berg 已提交
2192 2193 2194 2195 2196

	cancel_work_sync(&ifmgd->monitor_work);
	/* these will just be re-established on connection */
	del_timer_sync(&ifmgd->conn_mon_timer);
	del_timer_sync(&ifmgd->bcn_mon_timer);
2197 2198 2199 2200 2201 2202 2203 2204 2205 2206
}

void ieee80211_sta_restart(struct ieee80211_sub_if_data *sdata)
{
	struct ieee80211_if_managed *ifmgd = &sdata->u.mgd;

	if (test_and_clear_bit(TMR_RUNNING_TIMER, &ifmgd->timers_running))
		add_timer(&ifmgd->timer);
	if (test_and_clear_bit(TMR_RUNNING_CHANSW, &ifmgd->timers_running))
		add_timer(&ifmgd->chswitch_timer);
2207
	ieee80211_sta_reset_beacon_monitor(sdata);
2208
	ieee80211_restart_sta_timer(sdata);
2209
	ieee80211_queue_work(&sdata->local->hw, &sdata->u.mgd.monitor_work);
2210 2211 2212
}
#endif

J
Johannes Berg 已提交
2213 2214
/* interface setup */
void ieee80211_sta_setup_sdata(struct ieee80211_sub_if_data *sdata)
2215
{
2216
	struct ieee80211_if_managed *ifmgd;
J
Johannes Berg 已提交
2217

2218
	ifmgd = &sdata->u.mgd;
J
Johannes Berg 已提交
2219
	INIT_WORK(&ifmgd->monitor_work, ieee80211_sta_monitor_work);
2220
	INIT_WORK(&ifmgd->chswitch_work, ieee80211_chswitch_work);
2221 2222
	INIT_WORK(&ifmgd->beacon_connection_loss_work,
		  ieee80211_beacon_connection_loss_work);
2223
	INIT_WORK(&ifmgd->request_smps_work, ieee80211_request_smps_work);
2224
	setup_timer(&ifmgd->timer, ieee80211_sta_timer,
S
Sujith 已提交
2225
		    (unsigned long) sdata);
J
Johannes Berg 已提交
2226 2227 2228 2229
	setup_timer(&ifmgd->bcn_mon_timer, ieee80211_sta_bcn_mon_timer,
		    (unsigned long) sdata);
	setup_timer(&ifmgd->conn_mon_timer, ieee80211_sta_conn_mon_timer,
		    (unsigned long) sdata);
2230
	setup_timer(&ifmgd->chswitch_timer, ieee80211_chswitch_timer,
J
Johannes Berg 已提交
2231 2232
		    (unsigned long) sdata);

2233
	ifmgd->flags = 0;
J
Johannes Berg 已提交
2234

2235
	mutex_init(&ifmgd->mtx);
2236 2237 2238 2239 2240

	if (sdata->local->hw.flags & IEEE80211_HW_SUPPORTS_DYNAMIC_SMPS)
		ifmgd->req_smps = IEEE80211_SMPS_AUTOMATIC;
	else
		ifmgd->req_smps = IEEE80211_SMPS_OFF;
2241 2242
}

2243 2244
/* scan finished notification */
void ieee80211_mlme_notify_scan_completed(struct ieee80211_local *local)
J
Johannes Berg 已提交
2245
{
2246
	struct ieee80211_sub_if_data *sdata = local->scan_sdata;
J
Johannes Berg 已提交
2247

2248 2249 2250 2251 2252 2253
	/* Restart STA timers */
	rcu_read_lock();
	list_for_each_entry_rcu(sdata, &local->interfaces, list)
		ieee80211_restart_sta_timer(sdata);
	rcu_read_unlock();
}
J
Johannes Berg 已提交
2254

2255 2256 2257 2258 2259 2260 2261
int ieee80211_max_network_latency(struct notifier_block *nb,
				  unsigned long data, void *dummy)
{
	s32 latency_usec = (s32) data;
	struct ieee80211_local *local =
		container_of(nb, struct ieee80211_local,
			     network_latency_notifier);
2262

2263 2264 2265
	mutex_lock(&local->iflist_mtx);
	ieee80211_recalc_ps(local, latency_usec);
	mutex_unlock(&local->iflist_mtx);
2266

2267
	return 0;
J
Johannes Berg 已提交
2268 2269
}

2270
/* config hooks */
J
Johannes Berg 已提交
2271 2272 2273 2274 2275 2276 2277 2278 2279 2280 2281 2282 2283 2284 2285 2286 2287 2288 2289 2290 2291 2292 2293
static enum work_done_result
ieee80211_probe_auth_done(struct ieee80211_work *wk,
			  struct sk_buff *skb)
{
	if (!skb) {
		cfg80211_send_auth_timeout(wk->sdata->dev, wk->filter_ta);
		return WORK_DONE_DESTROY;
	}

	if (wk->type == IEEE80211_WORK_AUTH) {
		cfg80211_send_rx_auth(wk->sdata->dev, skb->data, skb->len);
		return WORK_DONE_DESTROY;
	}

	mutex_lock(&wk->sdata->u.mgd.mtx);
	ieee80211_rx_mgmt_probe_resp(wk->sdata, skb);
	mutex_unlock(&wk->sdata->u.mgd.mtx);

	wk->type = IEEE80211_WORK_AUTH;
	wk->probe_auth.tries = 0;
	return WORK_DONE_REQUEUE;
}

2294 2295
int ieee80211_mgd_auth(struct ieee80211_sub_if_data *sdata,
		       struct cfg80211_auth_request *req)
J
Johannes Berg 已提交
2296
{
2297
	const u8 *ssid;
2298
	struct ieee80211_work *wk;
2299
	u16 auth_alg;
J
Johannes Berg 已提交
2300

2301 2302 2303
	if (req->local_state_change)
		return 0; /* no need to update mac80211 state */

2304 2305 2306 2307 2308
	switch (req->auth_type) {
	case NL80211_AUTHTYPE_OPEN_SYSTEM:
		auth_alg = WLAN_AUTH_OPEN;
		break;
	case NL80211_AUTHTYPE_SHARED_KEY:
2309 2310
		if (IS_ERR(sdata->local->wep_tx_tfm))
			return -EOPNOTSUPP;
2311 2312 2313 2314 2315 2316 2317 2318 2319 2320
		auth_alg = WLAN_AUTH_SHARED_KEY;
		break;
	case NL80211_AUTHTYPE_FT:
		auth_alg = WLAN_AUTH_FT;
		break;
	case NL80211_AUTHTYPE_NETWORK_EAP:
		auth_alg = WLAN_AUTH_LEAP;
		break;
	default:
		return -EOPNOTSUPP;
J
Johannes Berg 已提交
2321
	}
2322 2323 2324

	wk = kzalloc(sizeof(*wk) + req->ie_len, GFP_KERNEL);
	if (!wk)
J
Johannes Berg 已提交
2325
		return -ENOMEM;
2326

2327
	memcpy(wk->filter_ta, req->bss->bssid, ETH_ALEN);
2328 2329 2330 2331

	if (req->ie && req->ie_len) {
		memcpy(wk->ie, req->ie, req->ie_len);
		wk->ie_len = req->ie_len;
J
Johannes Berg 已提交
2332
	}
2333

J
Johannes Berg 已提交
2334
	if (req->key && req->key_len) {
J
Johannes Berg 已提交
2335 2336 2337
		wk->probe_auth.key_len = req->key_len;
		wk->probe_auth.key_idx = req->key_idx;
		memcpy(wk->probe_auth.key, req->key, req->key_len);
J
Johannes Berg 已提交
2338 2339
	}

2340
	ssid = ieee80211_bss_get_ie(req->bss, WLAN_EID_SSID);
J
Johannes Berg 已提交
2341 2342
	memcpy(wk->probe_auth.ssid, ssid + 2, ssid[1]);
	wk->probe_auth.ssid_len = ssid[1];
2343

J
Johannes Berg 已提交
2344 2345
	wk->probe_auth.algorithm = auth_alg;
	wk->probe_auth.privacy = req->bss->capability & WLAN_CAPABILITY_PRIVACY;
2346

2347 2348 2349 2350 2351
	/* if we already have a probe, don't probe again */
	if (req->bss->proberesp_ies)
		wk->type = IEEE80211_WORK_AUTH;
	else
		wk->type = IEEE80211_WORK_DIRECT_PROBE;
2352
	wk->chan = req->bss->channel;
2353
	wk->chan_type = NL80211_CHAN_NO_HT;
J
Johannes Berg 已提交
2354 2355
	wk->sdata = sdata;
	wk->done = ieee80211_probe_auth_done;
2356

J
Johannes Berg 已提交
2357
	ieee80211_add_work(wk);
J
Johannes Berg 已提交
2358
	return 0;
J
Johannes Berg 已提交
2359 2360
}

J
Johannes Berg 已提交
2361 2362 2363 2364
static enum work_done_result ieee80211_assoc_done(struct ieee80211_work *wk,
						  struct sk_buff *skb)
{
	struct ieee80211_mgmt *mgmt;
2365 2366
	struct ieee80211_rx_status *rx_status;
	struct ieee802_11_elems elems;
J
Johannes Berg 已提交
2367 2368 2369 2370 2371 2372 2373
	u16 status;

	if (!skb) {
		cfg80211_send_assoc_timeout(wk->sdata->dev, wk->filter_ta);
		return WORK_DONE_DESTROY;
	}

2374 2375 2376 2377 2378 2379 2380 2381 2382 2383 2384 2385 2386
	if (wk->type == IEEE80211_WORK_ASSOC_BEACON_WAIT) {
		mutex_lock(&wk->sdata->u.mgd.mtx);
		rx_status = (void *) skb->cb;
		ieee802_11_parse_elems(skb->data + 24 + 12, skb->len - 24 - 12, &elems);
		ieee80211_rx_bss_info(wk->sdata, (void *)skb->data, skb->len, rx_status,
				      &elems, true);
		mutex_unlock(&wk->sdata->u.mgd.mtx);

		wk->type = IEEE80211_WORK_ASSOC;
		/* not really done yet */
		return WORK_DONE_REQUEUE;
	}

J
Johannes Berg 已提交
2387 2388 2389 2390 2391 2392 2393 2394 2395 2396 2397 2398
	mgmt = (void *)skb->data;
	status = le16_to_cpu(mgmt->u.assoc_resp.status_code);

	if (status == WLAN_STATUS_SUCCESS) {
		mutex_lock(&wk->sdata->u.mgd.mtx);
		if (!ieee80211_assoc_success(wk, mgmt, skb->len)) {
			mutex_unlock(&wk->sdata->u.mgd.mtx);
			/* oops -- internal error -- send timeout for now */
			cfg80211_send_assoc_timeout(wk->sdata->dev,
						    wk->filter_ta);
			return WORK_DONE_DESTROY;
		}
2399 2400

		mutex_unlock(&wk->sdata->u.mgd.mtx);
J
Johannes Berg 已提交
2401 2402 2403 2404 2405 2406
	}

	cfg80211_send_rx_assoc(wk->sdata->dev, skb->data, skb->len);
	return WORK_DONE_DESTROY;
}

2407 2408
int ieee80211_mgd_assoc(struct ieee80211_sub_if_data *sdata,
			struct cfg80211_assoc_request *req)
2409
{
2410
	struct ieee80211_if_managed *ifmgd = &sdata->u.mgd;
2411
	struct ieee80211_bss *bss = (void *)req->bss->priv;
2412
	struct ieee80211_work *wk;
2413
	const u8 *ssid;
J
Johannes Berg 已提交
2414
	int i;
2415

2416
	mutex_lock(&ifmgd->mtx);
J
Johannes Berg 已提交
2417
	if (ifmgd->associated) {
2418 2419 2420 2421 2422 2423 2424 2425 2426 2427 2428 2429 2430
		if (!req->prev_bssid ||
		    memcmp(req->prev_bssid, ifmgd->associated->bssid,
			   ETH_ALEN)) {
			/*
			 * We are already associated and the request was not a
			 * reassociation request from the current BSS, so
			 * reject it.
			 */
			mutex_unlock(&ifmgd->mtx);
			return -EALREADY;
		}

		/* Trying to reassociate - clear previous association state */
2431
		ieee80211_set_disassoc(sdata, true, false);
J
Johannes Berg 已提交
2432 2433
	}
	mutex_unlock(&ifmgd->mtx);
2434

2435
	wk = kzalloc(sizeof(*wk) + req->ie_len, GFP_KERNEL);
J
Johannes Berg 已提交
2436 2437
	if (!wk)
		return -ENOMEM;
2438 2439

	ifmgd->flags &= ~IEEE80211_STA_DISABLE_11N;
2440
	ifmgd->flags &= ~IEEE80211_STA_NULLFUNC_ACKED;
2441

2442 2443
	ifmgd->beacon_crc_valid = false;

2444 2445 2446 2447 2448 2449 2450 2451 2452 2453 2454 2455 2456
	for (i = 0; i < req->crypto.n_ciphers_pairwise; i++)
		if (req->crypto.ciphers_pairwise[i] == WLAN_CIPHER_SUITE_WEP40 ||
		    req->crypto.ciphers_pairwise[i] == WLAN_CIPHER_SUITE_TKIP ||
		    req->crypto.ciphers_pairwise[i] == WLAN_CIPHER_SUITE_WEP104)
			ifmgd->flags |= IEEE80211_STA_DISABLE_11N;


	if (req->ie && req->ie_len) {
		memcpy(wk->ie, req->ie, req->ie_len);
		wk->ie_len = req->ie_len;
	} else
		wk->ie_len = 0;

2457
	wk->assoc.bss = req->bss;
2458

J
Johannes Berg 已提交
2459
	memcpy(wk->filter_ta, req->bss->bssid, ETH_ALEN);
2460

J
Johannes Berg 已提交
2461 2462 2463 2464 2465 2466 2467 2468 2469 2470
	/* new association always uses requested smps mode */
	if (ifmgd->req_smps == IEEE80211_SMPS_AUTOMATIC) {
		if (ifmgd->powersave)
			ifmgd->ap_smps = IEEE80211_SMPS_DYNAMIC;
		else
			ifmgd->ap_smps = IEEE80211_SMPS_OFF;
	} else
		ifmgd->ap_smps = ifmgd->req_smps;

	wk->assoc.smps = ifmgd->ap_smps;
J
Johannes Berg 已提交
2471 2472 2473 2474 2475 2476 2477
	/*
	 * IEEE802.11n does not allow TKIP/WEP as pairwise ciphers in HT mode.
	 * We still associate in non-HT mode (11a/b/g) if any one of these
	 * ciphers is configured as pairwise.
	 * We can set this to true for non-11n hardware, that'll be checked
	 * separately along with the peer capabilities.
	 */
J
Johannes Berg 已提交
2478
	wk->assoc.use_11n = !(ifmgd->flags & IEEE80211_STA_DISABLE_11N);
2479
	wk->assoc.capability = req->bss->capability;
2480 2481 2482
	wk->assoc.wmm_used = bss->wmm_used;
	wk->assoc.supp_rates = bss->supp_rates;
	wk->assoc.supp_rates_len = bss->supp_rates_len;
2483 2484
	wk->assoc.ht_information_ie =
		ieee80211_bss_get_ie(req->bss, WLAN_EID_HT_INFORMATION);
2485

K
Kalle Valo 已提交
2486 2487 2488 2489 2490 2491 2492 2493 2494
	if (bss->wmm_used && bss->uapsd_supported &&
	    (sdata->local->hw.flags & IEEE80211_HW_SUPPORTS_UAPSD)) {
		wk->assoc.uapsd_used = true;
		ifmgd->flags |= IEEE80211_STA_UAPSD_ENABLED;
	} else {
		wk->assoc.uapsd_used = false;
		ifmgd->flags &= ~IEEE80211_STA_UAPSD_ENABLED;
	}

2495
	ssid = ieee80211_bss_get_ie(req->bss, WLAN_EID_SSID);
2496 2497
	memcpy(wk->assoc.ssid, ssid + 2, ssid[1]);
	wk->assoc.ssid_len = ssid[1];
2498

2499
	if (req->prev_bssid)
2500
		memcpy(wk->assoc.prev_bssid, req->prev_bssid, ETH_ALEN);
2501

2502
	wk->chan = req->bss->channel;
2503
	wk->chan_type = NL80211_CHAN_NO_HT;
J
Johannes Berg 已提交
2504 2505
	wk->sdata = sdata;
	wk->done = ieee80211_assoc_done;
2506 2507 2508 2509 2510
	if (!bss->dtim_period &&
	    sdata->local->hw.flags & IEEE80211_HW_NEED_DTIM_PERIOD)
		wk->type = IEEE80211_WORK_ASSOC_BEACON_WAIT;
	else
		wk->type = IEEE80211_WORK_ASSOC;
2511 2512 2513 2514 2515 2516 2517 2518 2519 2520 2521 2522 2523 2524

	if (req->use_mfp) {
		ifmgd->mfp = IEEE80211_MFP_REQUIRED;
		ifmgd->flags |= IEEE80211_STA_MFP_ENABLED;
	} else {
		ifmgd->mfp = IEEE80211_MFP_DISABLED;
		ifmgd->flags &= ~IEEE80211_STA_MFP_ENABLED;
	}

	if (req->crypto.control_port)
		ifmgd->flags |= IEEE80211_STA_CONTROL_PORT;
	else
		ifmgd->flags &= ~IEEE80211_STA_CONTROL_PORT;

2525 2526 2527
	sdata->control_port_protocol = req->crypto.control_port_ethertype;
	sdata->control_port_no_encrypt = req->crypto.control_port_no_encrypt;

J
Johannes Berg 已提交
2528 2529
	ieee80211_add_work(wk);
	return 0;
2530 2531
}

2532
int ieee80211_mgd_deauth(struct ieee80211_sub_if_data *sdata,
J
Johannes Berg 已提交
2533 2534
			 struct cfg80211_deauth_request *req,
			 void *cookie)
2535
{
J
Johannes Berg 已提交
2536
	struct ieee80211_local *local = sdata->local;
2537
	struct ieee80211_if_managed *ifmgd = &sdata->u.mgd;
2538
	struct ieee80211_work *wk;
2539 2540
	u8 bssid[ETH_ALEN];
	bool assoc_bss = false;
2541

2542 2543
	mutex_lock(&ifmgd->mtx);

2544
	memcpy(bssid, req->bss->bssid, ETH_ALEN);
2545
	if (ifmgd->associated == req->bss) {
2546
		ieee80211_set_disassoc(sdata, false, true);
J
Johannes Berg 已提交
2547
		mutex_unlock(&ifmgd->mtx);
2548
		assoc_bss = true;
J
Johannes Berg 已提交
2549 2550
	} else {
		bool not_auth_yet = false;
2551

2552 2553
		mutex_unlock(&ifmgd->mtx);

2554
		mutex_lock(&local->mtx);
J
Johannes Berg 已提交
2555
		list_for_each_entry(wk, &local->work_list, list) {
J
Johannes Berg 已提交
2556
			if (wk->sdata != sdata)
J
Johannes Berg 已提交
2557
				continue;
J
Johannes Berg 已提交
2558 2559

			if (wk->type != IEEE80211_WORK_DIRECT_PROBE &&
2560
			    wk->type != IEEE80211_WORK_AUTH &&
2561 2562
			    wk->type != IEEE80211_WORK_ASSOC &&
			    wk->type != IEEE80211_WORK_ASSOC_BEACON_WAIT)
J
Johannes Berg 已提交
2563 2564
				continue;

J
Johannes Berg 已提交
2565 2566
			if (memcmp(req->bss->bssid, wk->filter_ta, ETH_ALEN))
				continue;
J
Johannes Berg 已提交
2567 2568 2569

			not_auth_yet = wk->type == IEEE80211_WORK_DIRECT_PROBE;
			list_del_rcu(&wk->list);
J
Johannes Berg 已提交
2570 2571 2572
			free_work(wk);
			break;
		}
2573
		mutex_unlock(&local->mtx);
J
Johannes Berg 已提交
2574 2575 2576 2577 2578 2579 2580 2581 2582 2583 2584 2585 2586 2587

		/*
		 * If somebody requests authentication and we haven't
		 * sent out an auth frame yet there's no need to send
		 * out a deauth frame either. If the state was PROBE,
		 * then this is the case. If it's AUTH we have sent a
		 * frame, and if it's IDLE we have completed the auth
		 * process already.
		 */
		if (not_auth_yet) {
			__cfg80211_auth_canceled(sdata->dev, bssid);
			return 0;
		}
	}
2588

2589
	printk(KERN_DEBUG "%s: deauthenticating from %pM by local choice (reason=%d)\n",
2590
	       sdata->name, bssid, req->reason_code);
2591

2592 2593 2594
	ieee80211_send_deauth_disassoc(sdata, bssid, IEEE80211_STYPE_DEAUTH,
				       req->reason_code, cookie,
				       !req->local_state_change);
2595 2596
	if (assoc_bss)
		sta_info_destroy_addr(sdata, bssid);
2597

2598
	mutex_lock(&sdata->local->mtx);
2599
	ieee80211_recalc_idle(sdata->local);
2600
	mutex_unlock(&sdata->local->mtx);
2601

2602 2603
	return 0;
}
2604

2605
int ieee80211_mgd_disassoc(struct ieee80211_sub_if_data *sdata,
J
Johannes Berg 已提交
2606 2607
			   struct cfg80211_disassoc_request *req,
			   void *cookie)
J
Johannes Berg 已提交
2608
{
2609
	struct ieee80211_if_managed *ifmgd = &sdata->u.mgd;
2610
	u8 bssid[ETH_ALEN];
J
Johannes Berg 已提交
2611

2612
	mutex_lock(&ifmgd->mtx);
2613

J
Johannes Berg 已提交
2614 2615 2616 2617 2618 2619
	/*
	 * cfg80211 should catch this ... but it's racy since
	 * we can receive a disassoc frame, process it, hand it
	 * to cfg80211 while that's in a locked section already
	 * trying to tell us that the user wants to disconnect.
	 */
2620
	if (ifmgd->associated != req->bss) {
2621 2622 2623 2624
		mutex_unlock(&ifmgd->mtx);
		return -ENOLINK;
	}

2625
	printk(KERN_DEBUG "%s: disassociating from %pM by local choice (reason=%d)\n",
2626
	       sdata->name, req->bss->bssid, req->reason_code);
2627

2628
	memcpy(bssid, req->bss->bssid, ETH_ALEN);
2629
	ieee80211_set_disassoc(sdata, false, true);
2630 2631

	mutex_unlock(&ifmgd->mtx);
2632

2633
	ieee80211_send_deauth_disassoc(sdata, req->bss->bssid,
J
Johannes Berg 已提交
2634
			IEEE80211_STYPE_DISASSOC, req->reason_code,
2635
			cookie, !req->local_state_change);
2636
	sta_info_destroy_addr(sdata, bssid);
2637

2638
	mutex_lock(&sdata->local->mtx);
2639
	ieee80211_recalc_idle(sdata->local);
2640
	mutex_unlock(&sdata->local->mtx);
2641

2642 2643
	return 0;
}
2644

2645 2646 2647 2648 2649 2650
void ieee80211_cqm_rssi_notify(struct ieee80211_vif *vif,
			       enum nl80211_cqm_rssi_threshold_event rssi_event,
			       gfp_t gfp)
{
	struct ieee80211_sub_if_data *sdata = vif_to_sdata(vif);

J
Johannes Berg 已提交
2651 2652
	trace_api_cqm_rssi_notify(sdata, rssi_event);

2653 2654 2655
	cfg80211_cqm_rssi_notify(sdata->dev, rssi_event, gfp);
}
EXPORT_SYMBOL(ieee80211_cqm_rssi_notify);
2656 2657 2658 2659 2660 2661 2662

unsigned char ieee80211_get_operstate(struct ieee80211_vif *vif)
{
	struct ieee80211_sub_if_data *sdata = vif_to_sdata(vif);
	return sdata->dev->operstate;
}
EXPORT_SYMBOL(ieee80211_get_operstate);