mlme.c 123.2 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/moduleparam.h>
20
#include <linux/rtnetlink.h>
21
#include <linux/pm_qos.h>
22
#include <linux/crc32.h>
23
#include <linux/slab.h>
24
#include <linux/export.h>
25
#include <net/mac80211.h>
26
#include <asm/unaligned.h>
J
Johannes Berg 已提交
27

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

33
#define IEEE80211_AUTH_TIMEOUT		(HZ / 5)
34
#define IEEE80211_AUTH_TIMEOUT_LONG	(HZ / 2)
35 36 37 38
#define IEEE80211_AUTH_TIMEOUT_SHORT	(HZ / 10)
#define IEEE80211_AUTH_MAX_TRIES	3
#define IEEE80211_AUTH_WAIT_ASSOC	(HZ * 5)
#define IEEE80211_ASSOC_TIMEOUT		(HZ / 5)
39
#define IEEE80211_ASSOC_TIMEOUT_LONG	(HZ / 2)
40 41
#define IEEE80211_ASSOC_TIMEOUT_SHORT	(HZ / 10)
#define IEEE80211_ASSOC_MAX_TRIES	3
J
Johannes Berg 已提交
42

43 44 45 46 47 48 49 50 51
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 已提交
52 53

/*
54 55 56 57 58 59
 * 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 已提交
60
 */
61 62 63 64
static int beacon_loss_count = 7;
module_param(beacon_loss_count, int, 0644);
MODULE_PARM_DESC(beacon_loss_count,
		 "Number of beacon intervals before we decide beacon was lost.");
65

J
Johannes Berg 已提交
66 67 68 69
/*
 * Time the connection can be idle before we probe
 * it to see if we can still talk to the AP.
 */
70
#define IEEE80211_CONNECTION_IDLE_TIME	(30 * HZ)
J
Johannes Berg 已提交
71 72 73 74 75
/*
 * Time we wait for a probe response after sending
 * a probe request because of beacon loss or for
 * checking the connection still works.
 */
76 77 78 79 80
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).");
81

82 83 84 85 86 87 88
/*
 * 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

89 90 91 92 93 94
/*
 * 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

J
Johannes Berg 已提交
95 96 97 98 99 100 101 102 103 104
/*
 * 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.
 */
105 106
static void run_again(struct ieee80211_sub_if_data *sdata,
		      unsigned long timeout)
J
Johannes Berg 已提交
107
{
108
	sdata_assert_lock(sdata);
J
Johannes Berg 已提交
109

110 111 112
	if (!timer_pending(&sdata->u.mgd.timer) ||
	    time_before(timeout, sdata->u.mgd.timer.expires))
		mod_timer(&sdata->u.mgd.timer, timeout);
J
Johannes Berg 已提交
113 114
}

115
void ieee80211_sta_reset_beacon_monitor(struct ieee80211_sub_if_data *sdata)
J
Johannes Berg 已提交
116
{
117
	if (sdata->vif.driver_flags & IEEE80211_VIF_BEACON_FILTER)
J
Johannes Berg 已提交
118 119
		return;

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

J
Johannes Berg 已提交
123
	mod_timer(&sdata->u.mgd.bcn_mon_timer,
124
		  round_jiffies_up(jiffies + sdata->u.mgd.beacon_timeout));
J
Johannes Berg 已提交
125 126
}

127 128
void ieee80211_sta_reset_conn_monitor(struct ieee80211_sub_if_data *sdata)
{
129 130
	struct ieee80211_if_managed *ifmgd = &sdata->u.mgd;

131 132 133
	if (unlikely(!sdata->u.mgd.associated))
		return;

134 135 136 137 138
	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));
139 140

	ifmgd->probe_send_count = 0;
141 142
}

143
static int ecw2cw(int ecw)
J
Johannes Berg 已提交
144
{
145
	return (1 << ecw) - 1;
J
Johannes Berg 已提交
146 147
}

148 149 150 151 152 153
static u32
ieee80211_determine_chantype(struct ieee80211_sub_if_data *sdata,
			     struct ieee80211_supported_band *sband,
			     struct ieee80211_channel *channel,
			     const struct ieee80211_ht_operation *ht_oper,
			     const struct ieee80211_vht_operation *vht_oper,
154
			     struct cfg80211_chan_def *chandef, bool tracking)
155
{
156
	struct ieee80211_if_managed *ifmgd = &sdata->u.mgd;
157 158 159 160 161 162 163 164 165 166 167 168 169 170 171 172 173 174
	struct cfg80211_chan_def vht_chandef;
	u32 ht_cfreq, ret;

	chandef->chan = channel;
	chandef->width = NL80211_CHAN_WIDTH_20_NOHT;
	chandef->center_freq1 = channel->center_freq;
	chandef->center_freq2 = 0;

	if (!ht_oper || !sband->ht_cap.ht_supported) {
		ret = IEEE80211_STA_DISABLE_HT | IEEE80211_STA_DISABLE_VHT;
		goto out;
	}

	chandef->width = NL80211_CHAN_WIDTH_20;

	ht_cfreq = ieee80211_channel_to_frequency(ht_oper->primary_chan,
						  channel->band);
	/* check that channel matches the right operating channel */
175
	if (!tracking && channel->center_freq != ht_cfreq) {
176 177 178 179 180 181 182
		/*
		 * It's possible that some APs are confused here;
		 * Netgear WNDR3700 sometimes reports 4 higher than
		 * the actual channel in association responses, but
		 * since we look at probe response/beacon data here
		 * it should be OK.
		 */
183 184 185 186
		sdata_info(sdata,
			   "Wrong control channel: center-freq: %d ht-cfreq: %d ht->primary_chan: %d band: %d - Disabling HT\n",
			   channel->center_freq, ht_cfreq,
			   ht_oper->primary_chan, channel->band);
187 188 189 190 191 192 193 194 195 196 197 198 199 200 201 202 203 204 205
		ret = IEEE80211_STA_DISABLE_HT | IEEE80211_STA_DISABLE_VHT;
		goto out;
	}

	/* check 40 MHz support, if we have it */
	if (sband->ht_cap.cap & IEEE80211_HT_CAP_SUP_WIDTH_20_40) {
		switch (ht_oper->ht_param & IEEE80211_HT_PARAM_CHA_SEC_OFFSET) {
		case IEEE80211_HT_PARAM_CHA_SEC_ABOVE:
			chandef->width = NL80211_CHAN_WIDTH_40;
			chandef->center_freq1 += 10;
			break;
		case IEEE80211_HT_PARAM_CHA_SEC_BELOW:
			chandef->width = NL80211_CHAN_WIDTH_40;
			chandef->center_freq1 -= 10;
			break;
		}
	} else {
		/* 40 MHz (and 80 MHz) must be supported for VHT */
		ret = IEEE80211_STA_DISABLE_VHT;
206 207
		/* also mark 40 MHz disabled */
		ret |= IEEE80211_STA_DISABLE_40MHZ;
208 209 210 211 212 213 214 215 216 217 218 219 220 221 222 223 224 225 226 227 228 229 230 231 232 233
		goto out;
	}

	if (!vht_oper || !sband->vht_cap.vht_supported) {
		ret = IEEE80211_STA_DISABLE_VHT;
		goto out;
	}

	vht_chandef.chan = channel;
	vht_chandef.center_freq1 =
		ieee80211_channel_to_frequency(vht_oper->center_freq_seg1_idx,
					       channel->band);
	vht_chandef.center_freq2 = 0;

	switch (vht_oper->chan_width) {
	case IEEE80211_VHT_CHANWIDTH_USE_HT:
		vht_chandef.width = chandef->width;
		break;
	case IEEE80211_VHT_CHANWIDTH_80MHZ:
		vht_chandef.width = NL80211_CHAN_WIDTH_80;
		break;
	case IEEE80211_VHT_CHANWIDTH_160MHZ:
		vht_chandef.width = NL80211_CHAN_WIDTH_160;
		break;
	case IEEE80211_VHT_CHANWIDTH_80P80MHZ:
		vht_chandef.width = NL80211_CHAN_WIDTH_80P80;
234 235 236 237
		vht_chandef.center_freq2 =
			ieee80211_channel_to_frequency(
				vht_oper->center_freq_seg2_idx,
				channel->band);
238 239
		break;
	default:
240
		if (!(ifmgd->flags & IEEE80211_STA_DISABLE_VHT))
241 242 243
			sdata_info(sdata,
				   "AP VHT operation IE has invalid channel width (%d), disable VHT\n",
				   vht_oper->chan_width);
244 245 246 247 248
		ret = IEEE80211_STA_DISABLE_VHT;
		goto out;
	}

	if (!cfg80211_chandef_valid(&vht_chandef)) {
249
		if (!(ifmgd->flags & IEEE80211_STA_DISABLE_VHT))
250 251
			sdata_info(sdata,
				   "AP VHT information is invalid, disable VHT\n");
252 253 254 255 256 257 258 259 260 261
		ret = IEEE80211_STA_DISABLE_VHT;
		goto out;
	}

	if (cfg80211_chandef_identical(chandef, &vht_chandef)) {
		ret = 0;
		goto out;
	}

	if (!cfg80211_chandef_compatible(chandef, &vht_chandef)) {
262
		if (!(ifmgd->flags & IEEE80211_STA_DISABLE_VHT))
263 264
			sdata_info(sdata,
				   "AP VHT information doesn't match HT, disable VHT\n");
265 266 267 268 269 270 271 272 273
		ret = IEEE80211_STA_DISABLE_VHT;
		goto out;
	}

	*chandef = vht_chandef;

	ret = 0;

out:
274 275 276 277
	/* don't print the message below for VHT mismatch if VHT is disabled */
	if (ret & IEEE80211_STA_DISABLE_VHT)
		vht_chandef = *chandef;

278 279 280 281 282 283 284 285
	/*
	 * Ignore the DISABLED flag when we're already connected and only
	 * tracking the APs beacon for bandwidth changes - otherwise we
	 * might get disconnected here if we connect to an AP, update our
	 * regulatory information based on the AP's country IE and the
	 * information we have is wrong/outdated and disables the channel
	 * that we're actually using for the connection to the AP.
	 */
286
	while (!cfg80211_chandef_usable(sdata->local->hw.wiphy, chandef,
287 288
					tracking ? 0 :
						   IEEE80211_CHAN_DISABLED)) {
289 290 291
		if (WARN_ON(chandef->width == NL80211_CHAN_WIDTH_20_NOHT)) {
			ret = IEEE80211_STA_DISABLE_HT |
			      IEEE80211_STA_DISABLE_VHT;
292
			break;
293 294
		}

295
		ret |= ieee80211_chandef_downgrade(chandef);
296 297
	}

298
	if (chandef->width != vht_chandef.width && !tracking)
299 300 301 302 303 304 305
		sdata_info(sdata,
			   "capabilities/regulatory prevented using AP HT/VHT configuration, downgraded\n");

	WARN_ON_ONCE(!cfg80211_chandef_valid(chandef));
	return ret;
}

306 307 308 309 310
static int ieee80211_config_bw(struct ieee80211_sub_if_data *sdata,
			       struct sta_info *sta,
			       const struct ieee80211_ht_operation *ht_oper,
			       const struct ieee80211_vht_operation *vht_oper,
			       const u8 *bssid, u32 *changed)
311 312
{
	struct ieee80211_local *local = sdata->local;
313
	struct ieee80211_if_managed *ifmgd = &sdata->u.mgd;
314
	struct ieee80211_supported_band *sband;
J
Johannes Berg 已提交
315
	struct ieee80211_channel *chan;
316
	struct cfg80211_chan_def chandef;
317
	u16 ht_opmode;
318 319 320
	u32 flags;
	enum ieee80211_sta_rx_bandwidth new_sta_bw;
	int ret;
321

322 323
	/* if HT was/is disabled, don't track any bandwidth changes */
	if (ifmgd->flags & IEEE80211_STA_DISABLE_HT || !ht_oper)
324 325
		return 0;

326 327 328 329 330 331 332
	/* don't check VHT if we associated as non-VHT station */
	if (ifmgd->flags & IEEE80211_STA_DISABLE_VHT)
		vht_oper = NULL;

	if (WARN_ON_ONCE(!sta))
		return -EINVAL;

333 334 335 336 337 338 339 340 341 342
	/*
	 * if bss configuration changed store the new one -
	 * this may be applicable even if channel is identical
	 */
	ht_opmode = le16_to_cpu(ht_oper->operation_mode);
	if (sdata->vif.bss_conf.ht_operation_mode != ht_opmode) {
		*changed |= BSS_CHANGED_HT;
		sdata->vif.bss_conf.ht_operation_mode = ht_opmode;
	}

343
	chan = sdata->vif.bss_conf.chandef.chan;
J
Johannes Berg 已提交
344
	sband = local->hw.wiphy->bands[chan->band];
345

346 347
	/* calculate new channel (type) based on HT/VHT operation IEs */
	flags = ieee80211_determine_chantype(sdata, sband, chan, ht_oper,
348
					     vht_oper, &chandef, true);
349 350 351 352 353 354 355 356 357 358

	/*
	 * Downgrade the new channel if we associated with restricted
	 * capabilities. For example, if we associated as a 20 MHz STA
	 * to a 40 MHz AP (due to regulatory, capabilities or config
	 * reasons) then switching to a 40 MHz channel now won't do us
	 * any good -- we couldn't use it with the AP.
	 */
	if (ifmgd->flags & IEEE80211_STA_DISABLE_80P80MHZ &&
	    chandef.width == NL80211_CHAN_WIDTH_80P80)
359
		flags |= ieee80211_chandef_downgrade(&chandef);
360 361
	if (ifmgd->flags & IEEE80211_STA_DISABLE_160MHZ &&
	    chandef.width == NL80211_CHAN_WIDTH_160)
362
		flags |= ieee80211_chandef_downgrade(&chandef);
363 364
	if (ifmgd->flags & IEEE80211_STA_DISABLE_40MHZ &&
	    chandef.width > NL80211_CHAN_WIDTH_20)
365
		flags |= ieee80211_chandef_downgrade(&chandef);
366 367 368 369 370 371 372 373 374 375 376 377 378 379 380 381 382 383 384 385 386 387 388 389 390 391

	if (cfg80211_chandef_identical(&chandef, &sdata->vif.bss_conf.chandef))
		return 0;

	sdata_info(sdata,
		   "AP %pM changed bandwidth, new config is %d MHz, width %d (%d/%d MHz)\n",
		   ifmgd->bssid, chandef.chan->center_freq, chandef.width,
		   chandef.center_freq1, chandef.center_freq2);

	if (flags != (ifmgd->flags & (IEEE80211_STA_DISABLE_HT |
				      IEEE80211_STA_DISABLE_VHT |
				      IEEE80211_STA_DISABLE_40MHZ |
				      IEEE80211_STA_DISABLE_80P80MHZ |
				      IEEE80211_STA_DISABLE_160MHZ)) ||
	    !cfg80211_chandef_valid(&chandef)) {
		sdata_info(sdata,
			   "AP %pM changed bandwidth in a way we can't support - disconnect\n",
			   ifmgd->bssid);
		return -EINVAL;
	}

	switch (chandef.width) {
	case NL80211_CHAN_WIDTH_20_NOHT:
	case NL80211_CHAN_WIDTH_20:
		new_sta_bw = IEEE80211_STA_RX_BW_20;
		break;
392
	case NL80211_CHAN_WIDTH_40:
393
		new_sta_bw = IEEE80211_STA_RX_BW_40;
394
		break;
395 396 397 398 399 400
	case NL80211_CHAN_WIDTH_80:
		new_sta_bw = IEEE80211_STA_RX_BW_80;
		break;
	case NL80211_CHAN_WIDTH_80P80:
	case NL80211_CHAN_WIDTH_160:
		new_sta_bw = IEEE80211_STA_RX_BW_160;
401
		break;
402 403
	default:
		return -EINVAL;
404
	}
405

406 407
	if (new_sta_bw > sta->cur_max_bandwidth)
		new_sta_bw = sta->cur_max_bandwidth;
408

409 410 411 412 413
	if (new_sta_bw < sta->sta.bandwidth) {
		sta->sta.bandwidth = new_sta_bw;
		rate_control_rate_update(local, sband, sta,
					 IEEE80211_RC_BW_CHANGED);
	}
414

415 416 417 418 419 420 421
	ret = ieee80211_vif_change_bandwidth(sdata, &chandef, changed);
	if (ret) {
		sdata_info(sdata,
			   "AP %pM changed bandwidth to incompatible one - disconnect\n",
			   ifmgd->bssid);
		return ret;
	}
422

423 424 425 426
	if (new_sta_bw > sta->sta.bandwidth) {
		sta->sta.bandwidth = new_sta_bw;
		rate_control_rate_update(local, sband, sta,
					 IEEE80211_RC_BW_CHANGED);
427
	}
428

429
	return 0;
430 431
}

J
Johannes Berg 已提交
432 433
/* frame sending functions */

J
Johannes Berg 已提交
434
static void ieee80211_add_ht_ie(struct ieee80211_sub_if_data *sdata,
435
				struct sk_buff *skb, u8 ap_ht_param,
J
Johannes Berg 已提交
436 437 438 439 440 441 442 443 444 445 446 447 448 449 450 451 452
				struct ieee80211_supported_band *sband,
				struct ieee80211_channel *channel,
				enum ieee80211_smps_mode smps)
{
	u8 *pos;
	u32 flags = channel->flags;
	u16 cap;
	struct ieee80211_sta_ht_cap ht_cap;

	BUILD_BUG_ON(sizeof(ht_cap) != sizeof(sband->ht_cap));

	memcpy(&ht_cap, &sband->ht_cap, sizeof(ht_cap));
	ieee80211_apply_htcap_overrides(sdata, &ht_cap);

	/* determine capability flags */
	cap = ht_cap.cap;

453
	switch (ap_ht_param & IEEE80211_HT_PARAM_CHA_SEC_OFFSET) {
J
Johannes Berg 已提交
454 455 456 457 458 459 460 461 462 463 464 465 466 467
	case IEEE80211_HT_PARAM_CHA_SEC_ABOVE:
		if (flags & IEEE80211_CHAN_NO_HT40PLUS) {
			cap &= ~IEEE80211_HT_CAP_SUP_WIDTH_20_40;
			cap &= ~IEEE80211_HT_CAP_SGI_40;
		}
		break;
	case IEEE80211_HT_PARAM_CHA_SEC_BELOW:
		if (flags & IEEE80211_CHAN_NO_HT40MINUS) {
			cap &= ~IEEE80211_HT_CAP_SUP_WIDTH_20_40;
			cap &= ~IEEE80211_HT_CAP_SGI_40;
		}
		break;
	}

468 469 470 471 472 473 474 475 476 477
	/*
	 * If 40 MHz was disabled associate as though we weren't
	 * capable of 40 MHz -- some broken APs will never fall
	 * back to trying to transmit in 20 MHz.
	 */
	if (sdata->u.mgd.flags & IEEE80211_STA_DISABLE_40MHZ) {
		cap &= ~IEEE80211_HT_CAP_SUP_WIDTH_20_40;
		cap &= ~IEEE80211_HT_CAP_SGI_40;
	}

J
Johannes Berg 已提交
478 479 480 481 482 483 484 485 486 487 488 489 490 491 492 493 494 495 496 497 498 499 500 501 502
	/* set SM PS mode properly */
	cap &= ~IEEE80211_HT_CAP_SM_PS;
	switch (smps) {
	case IEEE80211_SMPS_AUTOMATIC:
	case IEEE80211_SMPS_NUM_MODES:
		WARN_ON(1);
	case IEEE80211_SMPS_OFF:
		cap |= WLAN_HT_CAP_SM_PS_DISABLED <<
			IEEE80211_HT_CAP_SM_PS_SHIFT;
		break;
	case IEEE80211_SMPS_STATIC:
		cap |= WLAN_HT_CAP_SM_PS_STATIC <<
			IEEE80211_HT_CAP_SM_PS_SHIFT;
		break;
	case IEEE80211_SMPS_DYNAMIC:
		cap |= WLAN_HT_CAP_SM_PS_DYNAMIC <<
			IEEE80211_HT_CAP_SM_PS_SHIFT;
		break;
	}

	/* reserve and fill IE */
	pos = skb_put(skb, sizeof(struct ieee80211_ht_cap) + 2);
	ieee80211_ie_build_ht_cap(pos, &ht_cap, cap);
}

503 504
static void ieee80211_add_vht_ie(struct ieee80211_sub_if_data *sdata,
				 struct sk_buff *skb,
505 506
				 struct ieee80211_supported_band *sband,
				 struct ieee80211_vht_cap *ap_vht_cap)
507 508 509 510
{
	u8 *pos;
	u32 cap;
	struct ieee80211_sta_vht_cap vht_cap;
511
	u32 mask, ap_bf_sts, our_bf_sts;
512 513 514 515

	BUILD_BUG_ON(sizeof(vht_cap) != sizeof(sband->vht_cap));

	memcpy(&vht_cap, &sband->vht_cap, sizeof(vht_cap));
516
	ieee80211_apply_vhtcap_overrides(sdata, &vht_cap);
517 518 519 520

	/* determine capability flags */
	cap = vht_cap.cap;

J
Johannes Berg 已提交
521 522 523 524 525 526 527 528 529 530
	if (sdata->u.mgd.flags & IEEE80211_STA_DISABLE_80P80MHZ) {
		cap &= ~IEEE80211_VHT_CAP_SUPP_CHAN_WIDTH_160_80PLUS80MHZ;
		cap |= IEEE80211_VHT_CAP_SUPP_CHAN_WIDTH_160MHZ;
	}

	if (sdata->u.mgd.flags & IEEE80211_STA_DISABLE_160MHZ) {
		cap &= ~IEEE80211_VHT_CAP_SHORT_GI_160;
		cap &= ~IEEE80211_VHT_CAP_SUPP_CHAN_WIDTH_160MHZ;
	}

531 532 533 534 535 536 537 538
	/*
	 * Some APs apparently get confused if our capabilities are better
	 * than theirs, so restrict what we advertise in the assoc request.
	 */
	if (!(ap_vht_cap->vht_cap_info &
			cpu_to_le32(IEEE80211_VHT_CAP_SU_BEAMFORMER_CAPABLE)))
		cap &= ~IEEE80211_VHT_CAP_SU_BEAMFORMEE_CAPABLE;

539 540 541 542 543 544 545 546 547 548
	mask = IEEE80211_VHT_CAP_BEAMFORMEE_STS_MASK;

	ap_bf_sts = le32_to_cpu(ap_vht_cap->vht_cap_info) & mask;
	our_bf_sts = cap & mask;

	if (ap_bf_sts < our_bf_sts) {
		cap &= ~mask;
		cap |= ap_bf_sts;
	}

549
	/* reserve and fill IE */
M
Mahesh Palivela 已提交
550
	pos = skb_put(skb, sizeof(struct ieee80211_vht_cap) + 2);
551 552 553
	ieee80211_ie_build_vht_cap(pos, &vht_cap, cap);
}

J
Johannes Berg 已提交
554 555 556 557 558 559 560 561 562
static void ieee80211_send_assoc(struct ieee80211_sub_if_data *sdata)
{
	struct ieee80211_local *local = sdata->local;
	struct ieee80211_if_managed *ifmgd = &sdata->u.mgd;
	struct ieee80211_mgd_assoc_data *assoc_data = ifmgd->assoc_data;
	struct sk_buff *skb;
	struct ieee80211_mgmt *mgmt;
	u8 *pos, qos_info;
	size_t offset = 0, noffset;
563
	int i, count, rates_len, supp_rates_len, shift;
J
Johannes Berg 已提交
564 565
	u16 capab;
	struct ieee80211_supported_band *sband;
J
Johannes Berg 已提交
566 567
	struct ieee80211_chanctx_conf *chanctx_conf;
	struct ieee80211_channel *chan;
568
	u32 rate_flags, rates = 0;
J
Johannes Berg 已提交
569

570
	sdata_assert_lock(sdata);
J
Johannes Berg 已提交
571

J
Johannes Berg 已提交
572 573 574 575 576 577
	rcu_read_lock();
	chanctx_conf = rcu_dereference(sdata->vif.chanctx_conf);
	if (WARN_ON(!chanctx_conf)) {
		rcu_read_unlock();
		return;
	}
578
	chan = chanctx_conf->def.chan;
579
	rate_flags = ieee80211_chandef_rate_flags(&chanctx_conf->def);
J
Johannes Berg 已提交
580 581
	rcu_read_unlock();
	sband = local->hw.wiphy->bands[chan->band];
582
	shift = ieee80211_vif_get_shift(&sdata->vif);
J
Johannes Berg 已提交
583 584 585 586 587 588 589 590

	if (assoc_data->supp_rates_len) {
		/*
		 * Get all rates supported by the device and the AP as
		 * some APs don't like getting a superset of their rates
		 * in the association request (e.g. D-Link DAP 1353 in
		 * b-only mode)...
		 */
591 592 593 594
		rates_len = ieee80211_parse_bitrates(&chanctx_conf->def, sband,
						     assoc_data->supp_rates,
						     assoc_data->supp_rates_len,
						     &rates);
J
Johannes Berg 已提交
595 596 597 598 599 600
	} else {
		/*
		 * In case AP not provide any supported rates information
		 * before association, we send information element(s) with
		 * all rates that we support.
		 */
601 602 603 604 605 606 607 608
		rates_len = 0;
		for (i = 0; i < sband->n_bitrates; i++) {
			if ((rate_flags & sband->bitrates[i].flags)
			    != rate_flags)
				continue;
			rates |= BIT(i);
			rates_len++;
		}
J
Johannes Berg 已提交
609 610 611 612 613 614 615 616 617
	}

	skb = alloc_skb(local->hw.extra_tx_headroom +
			sizeof(*mgmt) + /* bit too much but doesn't matter */
			2 + assoc_data->ssid_len + /* SSID */
			4 + rates_len + /* (extended) rates */
			4 + /* power capability */
			2 + 2 * sband->n_channels + /* supported channels */
			2 + sizeof(struct ieee80211_ht_cap) + /* HT */
M
Mahesh Palivela 已提交
618
			2 + sizeof(struct ieee80211_vht_cap) + /* VHT */
J
Johannes Berg 已提交
619 620 621 622 623 624 625 626 627 628 629 630 631 632 633 634 635 636 637 638 639 640 641 642 643 644 645 646 647 648 649 650 651 652 653 654 655 656 657 658 659 660 661 662 663 664 665 666 667 668 669 670 671 672 673 674 675 676 677 678 679 680 681 682 683 684
			assoc_data->ie_len + /* extra IEs */
			9, /* WMM */
			GFP_KERNEL);
	if (!skb)
		return;

	skb_reserve(skb, local->hw.extra_tx_headroom);

	capab = WLAN_CAPABILITY_ESS;

	if (sband->band == IEEE80211_BAND_2GHZ) {
		if (!(local->hw.flags & IEEE80211_HW_2GHZ_SHORT_SLOT_INCAPABLE))
			capab |= WLAN_CAPABILITY_SHORT_SLOT_TIME;
		if (!(local->hw.flags & IEEE80211_HW_2GHZ_SHORT_PREAMBLE_INCAPABLE))
			capab |= WLAN_CAPABILITY_SHORT_PREAMBLE;
	}

	if (assoc_data->capability & WLAN_CAPABILITY_PRIVACY)
		capab |= WLAN_CAPABILITY_PRIVACY;

	if ((assoc_data->capability & WLAN_CAPABILITY_SPECTRUM_MGMT) &&
	    (local->hw.flags & IEEE80211_HW_SPECTRUM_MGMT))
		capab |= WLAN_CAPABILITY_SPECTRUM_MGMT;

	mgmt = (struct ieee80211_mgmt *) skb_put(skb, 24);
	memset(mgmt, 0, 24);
	memcpy(mgmt->da, assoc_data->bss->bssid, ETH_ALEN);
	memcpy(mgmt->sa, sdata->vif.addr, ETH_ALEN);
	memcpy(mgmt->bssid, assoc_data->bss->bssid, ETH_ALEN);

	if (!is_zero_ether_addr(assoc_data->prev_bssid)) {
		skb_put(skb, 10);
		mgmt->frame_control = cpu_to_le16(IEEE80211_FTYPE_MGMT |
						  IEEE80211_STYPE_REASSOC_REQ);
		mgmt->u.reassoc_req.capab_info = cpu_to_le16(capab);
		mgmt->u.reassoc_req.listen_interval =
				cpu_to_le16(local->hw.conf.listen_interval);
		memcpy(mgmt->u.reassoc_req.current_ap, assoc_data->prev_bssid,
		       ETH_ALEN);
	} else {
		skb_put(skb, 4);
		mgmt->frame_control = cpu_to_le16(IEEE80211_FTYPE_MGMT |
						  IEEE80211_STYPE_ASSOC_REQ);
		mgmt->u.assoc_req.capab_info = cpu_to_le16(capab);
		mgmt->u.assoc_req.listen_interval =
				cpu_to_le16(local->hw.conf.listen_interval);
	}

	/* SSID */
	pos = skb_put(skb, 2 + assoc_data->ssid_len);
	*pos++ = WLAN_EID_SSID;
	*pos++ = assoc_data->ssid_len;
	memcpy(pos, assoc_data->ssid, assoc_data->ssid_len);

	/* add all rates which were marked to be used above */
	supp_rates_len = rates_len;
	if (supp_rates_len > 8)
		supp_rates_len = 8;

	pos = skb_put(skb, supp_rates_len + 2);
	*pos++ = WLAN_EID_SUPP_RATES;
	*pos++ = supp_rates_len;

	count = 0;
	for (i = 0; i < sband->n_bitrates; i++) {
		if (BIT(i) & rates) {
685 686 687
			int rate = DIV_ROUND_UP(sband->bitrates[i].bitrate,
						5 * (1 << shift));
			*pos++ = (u8) rate;
J
Johannes Berg 已提交
688 689 690 691 692 693 694 695 696 697 698 699
			if (++count == 8)
				break;
		}
	}

	if (rates_len > count) {
		pos = skb_put(skb, rates_len - count + 2);
		*pos++ = WLAN_EID_EXT_SUPP_RATES;
		*pos++ = rates_len - count;

		for (i++; i < sband->n_bitrates; i++) {
			if (BIT(i) & rates) {
700 701 702 703
				int rate;
				rate = DIV_ROUND_UP(sband->bitrates[i].bitrate,
						    5 * (1 << shift));
				*pos++ = (u8) rate;
J
Johannes Berg 已提交
704 705 706 707 708 709 710 711 712 713
			}
		}
	}

	if (capab & WLAN_CAPABILITY_SPECTRUM_MGMT) {
		/* 1. power capabilities */
		pos = skb_put(skb, 4);
		*pos++ = WLAN_EID_PWR_CAPABILITY;
		*pos++ = 2;
		*pos++ = 0; /* min tx power */
714 715
		 /* max tx power */
		*pos++ = ieee80211_chandef_max_power(&chanctx_conf->def);
J
Johannes Berg 已提交
716 717 718 719 720 721 722 723 724 725 726 727 728 729

		/* 2. supported channels */
		/* TODO: get this in reg domain format */
		pos = skb_put(skb, 2 * sband->n_channels + 2);
		*pos++ = WLAN_EID_SUPPORTED_CHANNELS;
		*pos++ = 2 * sband->n_channels;
		for (i = 0; i < sband->n_channels; i++) {
			*pos++ = ieee80211_frequency_to_channel(
					sband->channels[i].center_freq);
			*pos++ = 1; /* one channel in the subband*/
		}
	}

	/* if present, add any custom IEs that go before HT */
730
	if (assoc_data->ie_len) {
J
Johannes Berg 已提交
731 732 733 734 735 736 737 738 739 740 741 742 743 744 745 746 747 748 749 750
		static const u8 before_ht[] = {
			WLAN_EID_SSID,
			WLAN_EID_SUPP_RATES,
			WLAN_EID_EXT_SUPP_RATES,
			WLAN_EID_PWR_CAPABILITY,
			WLAN_EID_SUPPORTED_CHANNELS,
			WLAN_EID_RSN,
			WLAN_EID_QOS_CAPA,
			WLAN_EID_RRM_ENABLED_CAPABILITIES,
			WLAN_EID_MOBILITY_DOMAIN,
			WLAN_EID_SUPPORTED_REGULATORY_CLASSES,
		};
		noffset = ieee80211_ie_split(assoc_data->ie, assoc_data->ie_len,
					     before_ht, ARRAY_SIZE(before_ht),
					     offset);
		pos = skb_put(skb, noffset - offset);
		memcpy(pos, assoc_data->ie + offset, noffset - offset);
		offset = noffset;
	}

J
Johannes Berg 已提交
751 752 753 754
	if (WARN_ON_ONCE((ifmgd->flags & IEEE80211_STA_DISABLE_HT) &&
			 !(ifmgd->flags & IEEE80211_STA_DISABLE_VHT)))
		ifmgd->flags |= IEEE80211_STA_DISABLE_VHT;

755
	if (!(ifmgd->flags & IEEE80211_STA_DISABLE_HT))
756
		ieee80211_add_ht_ie(sdata, skb, assoc_data->ap_ht_param,
757
				    sband, chan, sdata->smps_mode);
J
Johannes Berg 已提交
758

759
	if (!(ifmgd->flags & IEEE80211_STA_DISABLE_VHT))
760 761
		ieee80211_add_vht_ie(sdata, skb, sband,
				     &assoc_data->ap_vht_cap);
762

J
Johannes Berg 已提交
763
	/* if present, add any custom non-vendor IEs that go after HT */
764
	if (assoc_data->ie_len) {
J
Johannes Berg 已提交
765 766 767 768 769 770 771 772
		noffset = ieee80211_ie_split_vendor(assoc_data->ie,
						    assoc_data->ie_len,
						    offset);
		pos = skb_put(skb, noffset - offset);
		memcpy(pos, assoc_data->ie + offset, noffset - offset);
		offset = noffset;
	}

773 774
	if (assoc_data->wmm) {
		if (assoc_data->uapsd) {
775 776
			qos_info = ifmgd->uapsd_queues;
			qos_info |= (ifmgd->uapsd_max_sp_len <<
J
Johannes Berg 已提交
777 778 779 780 781 782 783 784 785 786 787 788 789 790 791 792 793 794
				     IEEE80211_WMM_IE_STA_QOSINFO_SP_SHIFT);
		} else {
			qos_info = 0;
		}

		pos = skb_put(skb, 9);
		*pos++ = WLAN_EID_VENDOR_SPECIFIC;
		*pos++ = 7; /* len */
		*pos++ = 0x00; /* Microsoft OUI 00:50:F2 */
		*pos++ = 0x50;
		*pos++ = 0xf2;
		*pos++ = 2; /* WME */
		*pos++ = 0; /* WME info */
		*pos++ = 1; /* WME ver */
		*pos++ = qos_info;
	}

	/* add any remaining custom (i.e. vendor specific here) IEs */
795
	if (assoc_data->ie_len) {
J
Johannes Berg 已提交
796 797 798 799 800
		noffset = assoc_data->ie_len;
		pos = skb_put(skb, noffset - offset);
		memcpy(pos, assoc_data->ie + offset, noffset - offset);
	}

J
Johannes Berg 已提交
801 802
	drv_mgd_prepare_tx(local, sdata);

J
Johannes Berg 已提交
803
	IEEE80211_SKB_CB(skb)->flags |= IEEE80211_TX_INTFL_DONT_ENCRYPT;
804 805 806
	if (local->hw.flags & IEEE80211_HW_REPORTS_TX_ACK_STATUS)
		IEEE80211_SKB_CB(skb)->flags |= IEEE80211_TX_CTL_REQ_TX_STATUS |
						IEEE80211_TX_INTFL_MLME_CONN_TX;
J
Johannes Berg 已提交
807 808 809
	ieee80211_tx_skb(sdata, skb);
}

810 811 812 813 814 815
void ieee80211_send_pspoll(struct ieee80211_local *local,
			   struct ieee80211_sub_if_data *sdata)
{
	struct ieee80211_pspoll *pspoll;
	struct sk_buff *skb;

816 817
	skb = ieee80211_pspoll_get(&local->hw, &sdata->vif);
	if (!skb)
818 819
		return;

820 821
	pspoll = (struct ieee80211_pspoll *) skb->data;
	pspoll->frame_control |= cpu_to_le16(IEEE80211_FCTL_PM);
822

823 824
	IEEE80211_SKB_CB(skb)->flags |= IEEE80211_TX_INTFL_DONT_ENCRYPT;
	ieee80211_tx_skb(sdata, skb);
825 826
}

827 828 829 830 831
void ieee80211_send_nullfunc(struct ieee80211_local *local,
			     struct ieee80211_sub_if_data *sdata,
			     int powersave)
{
	struct sk_buff *skb;
832
	struct ieee80211_hdr_3addr *nullfunc;
833
	struct ieee80211_if_managed *ifmgd = &sdata->u.mgd;
834

835 836
	skb = ieee80211_nullfunc_get(&local->hw, &sdata->vif);
	if (!skb)
837 838
		return;

839
	nullfunc = (struct ieee80211_hdr_3addr *) skb->data;
840
	if (powersave)
841
		nullfunc->frame_control |= cpu_to_le16(IEEE80211_FCTL_PM);
842

843 844
	IEEE80211_SKB_CB(skb)->flags |= IEEE80211_TX_INTFL_DONT_ENCRYPT |
					IEEE80211_TX_INTFL_OFFCHAN_TX_OK;
845 846 847 848

	if (local->hw.flags & IEEE80211_HW_REPORTS_TX_ACK_STATUS)
		IEEE80211_SKB_CB(skb)->flags |= IEEE80211_TX_CTL_REQ_TX_STATUS;

849
	if (ifmgd->flags & IEEE80211_STA_CONNECTION_POLL)
850 851
		IEEE80211_SKB_CB(skb)->flags |= IEEE80211_TX_CTL_USE_MINRATE;

852
	ieee80211_tx_skb(sdata, skb);
853 854
}

855 856 857 858 859 860 861 862 863 864 865
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);
866
	if (!skb)
867
		return;
868

869 870 871 872 873 874 875 876 877 878 879 880 881 882 883 884
	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);
}

885 886 887 888 889
/* 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);
890
	struct ieee80211_local *local = sdata->local;
891
	struct ieee80211_if_managed *ifmgd = &sdata->u.mgd;
892 893
	u32 changed = 0;
	int ret;
894

895
	if (!ieee80211_sdata_running(sdata))
896 897
		return;

898
	sdata_lock(sdata);
899 900
	if (!ifmgd->associated)
		goto out;
901

902
	mutex_lock(&local->mtx);
903
	ret = ieee80211_vif_change_channel(sdata, &changed);
904
	mutex_unlock(&local->mtx);
905 906 907 908 909 910 911
	if (ret) {
		sdata_info(sdata,
			   "vif channel switch failed, disconnecting\n");
		ieee80211_queue_work(&sdata->local->hw,
				     &ifmgd->csa_connection_drop_work);
		goto out;
	}
912

913
	if (!local->use_chanctx) {
914
		local->_oper_chandef = sdata->csa_chandef;
915 916 917 918 919 920 921
		/* Call "hw_config" only if doing sw channel switch.
		 * Otherwise update the channel directly
		 */
		if (!local->ops->channel_switch)
			ieee80211_hw_config(local, 0);
		else
			local->hw.conf.chandef = local->_oper_chandef;
922
	}
923

924
	/* XXX: shouldn't really modify cfg80211-owned data! */
925
	ifmgd->associated->channel = sdata->csa_chandef.chan;
926

927
	/* XXX: wait for a beacon first? */
928
	ieee80211_wake_queues_by_reason(&local->hw,
929
					IEEE80211_MAX_QUEUE_MAP,
930
					IEEE80211_QUEUE_STOP_REASON_CSA);
931 932 933

	ieee80211_bss_info_change_notify(sdata, changed);

934
 out:
935
	sdata->vif.csa_active = false;
936
	ifmgd->flags &= ~IEEE80211_STA_CSA_RECEIVED;
937
	sdata_unlock(sdata);
938 939
}

940 941
void ieee80211_chswitch_done(struct ieee80211_vif *vif, bool success)
{
J
Johannes Berg 已提交
942 943
	struct ieee80211_sub_if_data *sdata = vif_to_sdata(vif);
	struct ieee80211_if_managed *ifmgd = &sdata->u.mgd;
944 945 946

	trace_api_chswitch_done(sdata, success);
	if (!success) {
947 948 949 950 951 952
		sdata_info(sdata,
			   "driver channel switch failed, disconnecting\n");
		ieee80211_queue_work(&sdata->local->hw,
				     &ifmgd->csa_connection_drop_work);
	} else {
		ieee80211_queue_work(&sdata->local->hw, &ifmgd->chswitch_work);
953 954 955 956
	}
}
EXPORT_SYMBOL(ieee80211_chswitch_done);

957 958 959 960
static void ieee80211_chswitch_timer(unsigned long data)
{
	struct ieee80211_sub_if_data *sdata =
		(struct ieee80211_sub_if_data *) data;
961

962
	ieee80211_queue_work(&sdata->local->hw, &sdata->u.mgd.chswitch_work);
963 964
}

965
static void
J
Johannes Berg 已提交
966
ieee80211_sta_process_chanswitch(struct ieee80211_sub_if_data *sdata,
967 968
				 u64 timestamp, struct ieee802_11_elems *elems,
				 bool beacon)
969
{
970
	struct ieee80211_local *local = sdata->local;
971
	struct ieee80211_if_managed *ifmgd = &sdata->u.mgd;
972
	struct cfg80211_bss *cbss = ifmgd->associated;
J
Johannes Berg 已提交
973
	struct ieee80211_chanctx *chanctx;
974
	enum ieee80211_band current_band;
975
	struct ieee80211_csa_ie csa_ie;
976
	int res;
977

978
	sdata_assert_lock(sdata);
979

980
	if (!cbss)
981 982
		return;

983
	if (local->scanning)
984 985
		return;

986
	/* disregard subsequent announcements if we are already processing */
987 988 989
	if (ifmgd->flags & IEEE80211_STA_CSA_RECEIVED)
		return;

990
	current_band = cbss->channel->band;
991
	memset(&csa_ie, 0, sizeof(csa_ie));
992 993
	res = ieee80211_parse_ch_switch_ie(sdata, elems, beacon, current_band,
					   ifmgd->flags,
994
					   ifmgd->associated->bssid, &csa_ie);
995
	if (res	< 0)
996
		ieee80211_queue_work(&local->hw,
997
				     &ifmgd->csa_connection_drop_work);
998
	if (res)
999
		return;
1000

1001
	if (!cfg80211_chandef_usable(local->hw.wiphy, &csa_ie.chandef,
1002 1003 1004
				     IEEE80211_CHAN_DISABLED)) {
		sdata_info(sdata,
			   "AP %pM switches to unsupported channel (%d MHz, width:%d, CF1/2: %d/%d MHz), disconnecting\n",
1005
			   ifmgd->associated->bssid,
1006 1007 1008
			   csa_ie.chandef.chan->center_freq,
			   csa_ie.chandef.width, csa_ie.chandef.center_freq1,
			   csa_ie.chandef.center_freq2);
1009 1010 1011 1012 1013
		ieee80211_queue_work(&local->hw,
				     &ifmgd->csa_connection_drop_work);
		return;
	}

1014 1015
	ifmgd->flags |= IEEE80211_STA_CSA_RECEIVED;

1016
	mutex_lock(&local->chanctx_mtx);
1017
	if (local->use_chanctx) {
1018 1019 1020 1021 1022 1023 1024 1025 1026 1027 1028 1029 1030
		u32 num_chanctx = 0;
		list_for_each_entry(chanctx, &local->chanctx_list, list)
		       num_chanctx++;

		if (num_chanctx > 1 ||
		    !(local->hw.flags & IEEE80211_HW_CHANCTX_STA_CSA)) {
			sdata_info(sdata,
				   "not handling chan-switch with channel contexts\n");
			ieee80211_queue_work(&local->hw,
					     &ifmgd->csa_connection_drop_work);
			mutex_unlock(&local->chanctx_mtx);
			return;
		}
J
Johannes Berg 已提交
1031 1032 1033
	}

	if (WARN_ON(!rcu_access_pointer(sdata->vif.chanctx_conf))) {
1034 1035
		ieee80211_queue_work(&local->hw,
				     &ifmgd->csa_connection_drop_work);
1036
		mutex_unlock(&local->chanctx_mtx);
J
Johannes Berg 已提交
1037 1038 1039 1040 1041 1042 1043
		return;
	}
	chanctx = container_of(rcu_access_pointer(sdata->vif.chanctx_conf),
			       struct ieee80211_chanctx, conf);
	if (chanctx->refcount > 1) {
		sdata_info(sdata,
			   "channel switch with multiple interfaces on the same channel, disconnecting\n");
1044
		ieee80211_queue_work(&local->hw,
J
Johannes Berg 已提交
1045
				     &ifmgd->csa_connection_drop_work);
1046
		mutex_unlock(&local->chanctx_mtx);
J
Johannes Berg 已提交
1047 1048
		return;
	}
1049
	mutex_unlock(&local->chanctx_mtx);
J
Johannes Berg 已提交
1050

1051
	sdata->csa_chandef = csa_ie.chandef;
1052
	sdata->vif.csa_active = true;
J
Johannes Berg 已提交
1053

1054
	if (csa_ie.mode)
1055
		ieee80211_stop_queues_by_reason(&local->hw,
1056
				IEEE80211_MAX_QUEUE_MAP,
1057 1058
				IEEE80211_QUEUE_STOP_REASON_CSA);

1059
	if (local->ops->channel_switch) {
1060
		/* use driver's channel switch callback */
1061 1062
		struct ieee80211_channel_switch ch_switch = {
			.timestamp = timestamp,
1063 1064 1065
			.block_tx = csa_ie.mode,
			.chandef = csa_ie.chandef,
			.count = csa_ie.count,
1066 1067
		};

1068
		drv_channel_switch(local, &ch_switch);
1069 1070 1071 1072
		return;
	}

	/* channel switch handled in software */
1073
	if (csa_ie.count <= 1)
1074
		ieee80211_queue_work(&local->hw, &ifmgd->chswitch_work);
1075
	else
1076
		mod_timer(&ifmgd->chswitch_timer,
1077
			  TU_TO_EXP_TIME(csa_ie.count * cbss->beacon_interval));
1078 1079
}

1080 1081 1082 1083
static u32 ieee80211_handle_pwr_constr(struct ieee80211_sub_if_data *sdata,
				       struct ieee80211_channel *channel,
				       const u8 *country_ie, u8 country_ie_len,
				       const u8 *pwr_constr_elem)
1084
{
1085 1086 1087 1088
	struct ieee80211_country_ie_triplet *triplet;
	int chan = ieee80211_frequency_to_channel(channel->center_freq);
	int i, chan_pwr, chan_increment, new_ap_level;
	bool have_chan_pwr = false;
1089

1090 1091
	/* Invalid IE */
	if (country_ie_len % 2 || country_ie_len < IEEE80211_COUNTRY_IE_MIN_LEN)
1092
		return 0;
1093

1094 1095 1096 1097 1098 1099 1100 1101 1102 1103 1104 1105 1106 1107
	triplet = (void *)(country_ie + 3);
	country_ie_len -= 3;

	switch (channel->band) {
	default:
		WARN_ON_ONCE(1);
		/* fall through */
	case IEEE80211_BAND_2GHZ:
	case IEEE80211_BAND_60GHZ:
		chan_increment = 1;
		break;
	case IEEE80211_BAND_5GHZ:
		chan_increment = 4;
		break;
1108
	}
1109 1110 1111 1112 1113 1114 1115 1116 1117 1118 1119 1120 1121 1122 1123 1124 1125 1126 1127 1128 1129 1130 1131 1132

	/* find channel */
	while (country_ie_len >= 3) {
		u8 first_channel = triplet->chans.first_channel;

		if (first_channel >= IEEE80211_COUNTRY_EXTENSION_ID)
			goto next;

		for (i = 0; i < triplet->chans.num_channels; i++) {
			if (first_channel + i * chan_increment == chan) {
				have_chan_pwr = true;
				chan_pwr = triplet->chans.max_power;
				break;
			}
		}
		if (have_chan_pwr)
			break;

 next:
		triplet++;
		country_ie_len -= 3;
	}

	if (!have_chan_pwr)
1133
		return 0;
1134 1135 1136

	new_ap_level = max_t(int, 0, chan_pwr - *pwr_constr_elem);

1137 1138
	if (sdata->ap_power_level == new_ap_level)
		return 0;
1139 1140 1141 1142 1143

	sdata_info(sdata,
		   "Limiting TX power to %d (%d - %d) dBm as advertised by %pM\n",
		   new_ap_level, chan_pwr, *pwr_constr_elem,
		   sdata->u.mgd.bssid);
1144 1145 1146 1147
	sdata->ap_power_level = new_ap_level;
	if (__ieee80211_recalc_txpower(sdata))
		return BSS_CHANGED_TXPOWER;
	return 0;
1148 1149
}

1150 1151 1152 1153 1154 1155
/* 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 已提交
1156 1157 1158 1159
	/*
	 * If we are scanning right now then the parameters will
	 * take effect when scan finishes.
	 */
1160
	if (local->scanning)
J
Johannes Berg 已提交
1161 1162
		return;

1163 1164 1165 1166 1167 1168 1169
	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);
1170

1171 1172 1173 1174 1175 1176
		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);
1177 1178 1179 1180 1181 1182 1183 1184 1185 1186 1187 1188 1189 1190 1191 1192 1193
	}
}

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);
	}
}

1194 1195 1196 1197
static bool ieee80211_powersave_allowed(struct ieee80211_sub_if_data *sdata)
{
	struct ieee80211_if_managed *mgd = &sdata->u.mgd;
	struct sta_info *sta = NULL;
J
Johannes Berg 已提交
1198
	bool authorized = false;
1199 1200 1201 1202

	if (!mgd->powersave)
		return false;

1203 1204 1205
	if (mgd->broken_ap)
		return false;

1206 1207 1208
	if (!mgd->associated)
		return false;

1209
	if (mgd->flags & IEEE80211_STA_CONNECTION_POLL)
1210 1211
		return false;

1212
	if (!mgd->have_beacon)
1213 1214
		return false;

1215 1216 1217
	rcu_read_lock();
	sta = sta_info_get(sdata, mgd->bssid);
	if (sta)
J
Johannes Berg 已提交
1218
		authorized = test_sta_flag(sta, WLAN_STA_AUTHORIZED);
1219 1220
	rcu_read_unlock();

J
Johannes Berg 已提交
1221
	return authorized;
1222 1223
}

1224
/* need to hold RTNL or interface lock */
1225
void ieee80211_recalc_ps(struct ieee80211_local *local, s32 latency)
1226 1227 1228
{
	struct ieee80211_sub_if_data *sdata, *found = NULL;
	int count = 0;
1229
	int timeout;
1230 1231 1232 1233 1234 1235 1236

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

	list_for_each_entry(sdata, &local->interfaces, list) {
1237
		if (!ieee80211_sdata_running(sdata))
1238
			continue;
1239 1240 1241 1242 1243 1244 1245 1246
		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;
		}
1247 1248 1249 1250 1251 1252
		if (sdata->vif.type != NL80211_IFTYPE_STATION)
			continue;
		found = sdata;
		count++;
	}

1253
	if (count == 1 && ieee80211_powersave_allowed(found)) {
1254 1255 1256
		s32 beaconint_us;

		if (latency < 0)
M
Mark Gross 已提交
1257
			latency = pm_qos_request(PM_QOS_NETWORK_LATENCY);
1258 1259 1260 1261

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

1262
		timeout = local->dynamic_ps_forced_timeout;
1263 1264
		if (timeout < 0) {
			/*
1265 1266
			 * Go to full PSM if the user configures a very low
			 * latency requirement.
1267 1268 1269
			 * The 2000 second value is there for compatibility
			 * until the PM_QOS_NETWORK_LATENCY is configured
			 * with real values.
1270
			 */
1271 1272
			if (latency > (1900 * USEC_PER_MSEC) &&
			    latency != (2000 * USEC_PER_SEC))
1273
				timeout = 0;
1274 1275
			else
				timeout = 100;
1276
		}
1277
		local->hw.conf.dynamic_ps_timeout = timeout;
1278

1279
		if (beaconint_us > latency) {
1280
			local->ps_sdata = NULL;
1281 1282
		} else {
			int maxslp = 1;
1283
			u8 dtimper = found->u.mgd.dtim_period;
1284 1285 1286 1287 1288

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

1292
			local->hw.conf.max_sleep_period = maxslp;
1293
			local->hw.conf.ps_dtim_period = dtimper;
1294
			local->ps_sdata = found;
1295
		}
1296
	} else {
1297
		local->ps_sdata = NULL;
1298
	}
1299 1300 1301 1302

	ieee80211_change_ps(local);
}

E
Eliad Peller 已提交
1303 1304 1305 1306 1307 1308 1309 1310 1311 1312
void ieee80211_recalc_ps_vif(struct ieee80211_sub_if_data *sdata)
{
	bool ps_allowed = ieee80211_powersave_allowed(sdata);

	if (sdata->vif.bss_conf.ps != ps_allowed) {
		sdata->vif.bss_conf.ps = ps_allowed;
		ieee80211_bss_info_change_notify(sdata, BSS_CHANGED_PS);
	}
}

1313 1314 1315 1316 1317 1318 1319 1320 1321 1322 1323 1324
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,
1325
					IEEE80211_MAX_QUEUE_MAP,
1326 1327 1328 1329 1330 1331 1332 1333 1334
					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;
1335
	struct ieee80211_if_managed *ifmgd;
1336 1337
	unsigned long flags;
	int q;
1338 1339 1340 1341 1342

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

1343 1344
	ifmgd = &sdata->u.mgd;

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

1348
	if (local->hw.conf.dynamic_ps_timeout > 0) {
1349 1350
		/* don't enter PS if TX frames are pending */
		if (drv_tx_frames_pending(local)) {
1351 1352 1353 1354 1355
			mod_timer(&local->dynamic_ps_timer, jiffies +
				  msecs_to_jiffies(
				  local->hw.conf.dynamic_ps_timeout));
			return;
		}
1356 1357 1358 1359 1360 1361 1362 1363 1364 1365 1366 1367 1368 1369 1370 1371 1372 1373

		/*
		 * transmission can be stopped by others which leads to
		 * dynamic_ps_timer expiry. Postpone 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);
1374 1375
	}

1376
	if ((local->hw.flags & IEEE80211_HW_PS_NULLFUNC_STACK) &&
1377
	    !(ifmgd->flags & IEEE80211_STA_NULLFUNC_ACKED)) {
1378
		if (drv_tx_frames_pending(local)) {
1379 1380 1381
			mod_timer(&local->dynamic_ps_timer, jiffies +
				  msecs_to_jiffies(
				  local->hw.conf.dynamic_ps_timeout));
1382
		} else {
1383 1384
			ieee80211_send_nullfunc(local, sdata, 1);
			/* Flush to get the tx status of nullfunc frame */
1385
			ieee80211_flush_queues(local, sdata);
1386
		}
1387 1388
	}

1389 1390
	if (!((local->hw.flags & IEEE80211_HW_REPORTS_TX_ACK_STATUS) &&
	      (local->hw.flags & IEEE80211_HW_PS_NULLFUNC_STACK)) ||
1391 1392 1393 1394 1395
	    (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);
	}
1396 1397 1398 1399 1400 1401
}

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

1402
	if (local->quiescing || local->suspended)
1403 1404
		return;

1405
	ieee80211_queue_work(&local->hw, &local->dynamic_ps_enable_work);
1406 1407
}

1408 1409 1410 1411 1412 1413 1414
void ieee80211_dfs_cac_timer_work(struct work_struct *work)
{
	struct delayed_work *delayed_work =
		container_of(work, struct delayed_work, work);
	struct ieee80211_sub_if_data *sdata =
		container_of(delayed_work, struct ieee80211_sub_if_data,
			     dfs_cac_timer_work);
1415
	struct cfg80211_chan_def chandef = sdata->vif.bss_conf.chandef;
1416

1417 1418 1419 1420 1421 1422 1423 1424
	mutex_lock(&sdata->local->mtx);
	if (sdata->wdev.cac_started) {
		ieee80211_vif_release_channel(sdata);
		cfg80211_cac_event(sdata->dev, &chandef,
				   NL80211_RADAR_CAC_FINISHED,
				   GFP_KERNEL);
	}
	mutex_unlock(&sdata->local->mtx);
1425 1426
}

J
Johannes Berg 已提交
1427
/* MLME */
1428
static bool ieee80211_sta_wmm_params(struct ieee80211_local *local,
1429
				     struct ieee80211_sub_if_data *sdata,
J
Johannes Berg 已提交
1430
				     const u8 *wmm_param, size_t wmm_param_len)
1431 1432
{
	struct ieee80211_tx_queue_params params;
1433
	struct ieee80211_if_managed *ifmgd = &sdata->u.mgd;
1434 1435
	size_t left;
	int count;
J
Johannes Berg 已提交
1436 1437
	const u8 *pos;
	u8 uapsd_queues = 0;
1438

1439
	if (!local->ops->conf_tx)
1440
		return false;
1441

J
Johannes Berg 已提交
1442
	if (local->hw.queues < IEEE80211_NUM_ACS)
1443
		return false;
1444 1445

	if (!wmm_param)
1446
		return false;
1447

1448
	if (wmm_param_len < 8 || wmm_param[5] /* version */ != 1)
1449
		return false;
K
Kalle Valo 已提交
1450 1451

	if (ifmgd->flags & IEEE80211_STA_UAPSD_ENABLED)
1452
		uapsd_queues = ifmgd->uapsd_queues;
K
Kalle Valo 已提交
1453

1454
	count = wmm_param[6] & 0x0f;
1455
	if (count == ifmgd->wmm_last_param_set)
1456
		return false;
1457
	ifmgd->wmm_last_param_set = count;
1458 1459 1460 1461 1462 1463

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

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

Y
Yoni Divinsky 已提交
1464
	sdata->wmm_acm = 0;
1465 1466 1467
	for (; left >= 4; left -= 4, pos += 4) {
		int aci = (pos[0] >> 5) & 0x03;
		int acm = (pos[0] >> 4) & 0x01;
K
Kalle Valo 已提交
1468
		bool uapsd = false;
1469 1470 1471
		int queue;

		switch (aci) {
1472
		case 1: /* AC_BK */
J
Johannes Berg 已提交
1473
			queue = 3;
J
Johannes Berg 已提交
1474
			if (acm)
Y
Yoni Divinsky 已提交
1475
				sdata->wmm_acm |= BIT(1) | BIT(2); /* BK/- */
K
Kalle Valo 已提交
1476 1477
			if (uapsd_queues & IEEE80211_WMM_IE_STA_QOSINFO_AC_BK)
				uapsd = true;
1478
			break;
1479
		case 2: /* AC_VI */
J
Johannes Berg 已提交
1480
			queue = 1;
J
Johannes Berg 已提交
1481
			if (acm)
Y
Yoni Divinsky 已提交
1482
				sdata->wmm_acm |= BIT(4) | BIT(5); /* CL/VI */
K
Kalle Valo 已提交
1483 1484
			if (uapsd_queues & IEEE80211_WMM_IE_STA_QOSINFO_AC_VI)
				uapsd = true;
1485
			break;
1486
		case 3: /* AC_VO */
J
Johannes Berg 已提交
1487
			queue = 0;
J
Johannes Berg 已提交
1488
			if (acm)
Y
Yoni Divinsky 已提交
1489
				sdata->wmm_acm |= BIT(6) | BIT(7); /* VO/NC */
K
Kalle Valo 已提交
1490 1491
			if (uapsd_queues & IEEE80211_WMM_IE_STA_QOSINFO_AC_VO)
				uapsd = true;
1492
			break;
1493
		case 0: /* AC_BE */
1494
		default:
J
Johannes Berg 已提交
1495
			queue = 2;
J
Johannes Berg 已提交
1496
			if (acm)
Y
Yoni Divinsky 已提交
1497
				sdata->wmm_acm |= BIT(0) | BIT(3); /* BE/EE */
K
Kalle Valo 已提交
1498 1499
			if (uapsd_queues & IEEE80211_WMM_IE_STA_QOSINFO_AC_BE)
				uapsd = true;
1500 1501 1502 1503 1504 1505
			break;
		}

		params.aifs = pos[0] & 0x0f;
		params.cw_max = ecw2cw((pos[1] & 0xf0) >> 4);
		params.cw_min = ecw2cw(pos[1] & 0x0f);
1506
		params.txop = get_unaligned_le16(pos + 2);
1507
		params.acm = acm;
K
Kalle Valo 已提交
1508 1509
		params.uapsd = uapsd;

J
Johannes Berg 已提交
1510 1511 1512 1513 1514
		mlme_dbg(sdata,
			 "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);
1515 1516
		sdata->tx_conf[queue] = params;
		if (drv_conf_tx(local, sdata, queue, &params))
J
Johannes Berg 已提交
1517 1518 1519
			sdata_err(sdata,
				  "failed to set TX queue parameters for queue %d\n",
				  queue);
1520
	}
1521 1522

	/* enable WMM or activate new settings */
1523
	sdata->vif.bss_conf.qos = true;
1524
	return true;
1525 1526
}

1527 1528 1529 1530
static void __ieee80211_stop_poll(struct ieee80211_sub_if_data *sdata)
{
	lockdep_assert_held(&sdata->local->mtx);

1531
	sdata->u.mgd.flags &= ~IEEE80211_STA_CONNECTION_POLL;
1532 1533 1534 1535 1536 1537 1538 1539 1540 1541
	ieee80211_run_deferred_scan(sdata->local);
}

static void ieee80211_stop_poll(struct ieee80211_sub_if_data *sdata)
{
	mutex_lock(&sdata->local->mtx);
	__ieee80211_stop_poll(sdata);
	mutex_unlock(&sdata->local->mtx);
}

J
Johannes Berg 已提交
1542 1543
static u32 ieee80211_handle_bss_capability(struct ieee80211_sub_if_data *sdata,
					   u16 capab, bool erp_valid, u8 erp)
1544
{
J
Johannes Berg 已提交
1545
	struct ieee80211_bss_conf *bss_conf = &sdata->vif.bss_conf;
1546
	u32 changed = 0;
J
Johannes Berg 已提交
1547 1548 1549 1550 1551 1552 1553 1554 1555 1556 1557 1558 1559
	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);
J
Johannes Berg 已提交
1560
	if (ieee80211_get_sdata_band(sdata) == IEEE80211_BAND_5GHZ)
1561
		use_short_slot = true;
1562

1563 1564 1565
	if (use_protection != bss_conf->use_cts_prot) {
		bss_conf->use_cts_prot = use_protection;
		changed |= BSS_CHANGED_ERP_CTS_PROT;
1566
	}
1567

1568 1569
	if (use_short_preamble != bss_conf->use_short_preamble) {
		bss_conf->use_short_preamble = use_short_preamble;
1570
		changed |= BSS_CHANGED_ERP_PREAMBLE;
1571
	}
1572

J
Johannes Berg 已提交
1573 1574 1575
	if (use_short_slot != bss_conf->use_short_slot) {
		bss_conf->use_short_slot = use_short_slot;
		changed |= BSS_CHANGED_ERP_SLOT;
1576 1577 1578 1579 1580
	}

	return changed;
}

1581
static void ieee80211_set_associated(struct ieee80211_sub_if_data *sdata,
1582
				     struct cfg80211_bss *cbss,
J
Johannes Berg 已提交
1583
				     u32 bss_info_changed)
1584
{
1585
	struct ieee80211_bss *bss = (void *)cbss->priv;
1586
	struct ieee80211_local *local = sdata->local;
1587
	struct ieee80211_bss_conf *bss_conf = &sdata->vif.bss_conf;
1588

J
Johannes Berg 已提交
1589
	bss_info_changed |= BSS_CHANGED_ASSOC;
1590
	bss_info_changed |= ieee80211_handle_bss_capability(sdata,
1591
		bss_conf->assoc_capability, bss->has_erp_value, bss->erp_value);
1592

1593
	sdata->u.mgd.beacon_timeout = usecs_to_jiffies(ieee80211_tu_to_usec(
1594
		beacon_loss_count * bss_conf->beacon_int));
1595

1596 1597
	sdata->u.mgd.associated = cbss;
	memcpy(sdata->u.mgd.bssid, cbss->bssid, ETH_ALEN);
1598

1599 1600
	sdata->u.mgd.flags |= IEEE80211_STA_RESET_SIGNAL_AVE;

1601
	if (sdata->vif.p2p) {
1602
		const struct cfg80211_bss_ies *ies;
1603

1604 1605 1606 1607 1608 1609 1610 1611
		rcu_read_lock();
		ies = rcu_dereference(cbss->ies);
		if (ies) {
			int ret;

			ret = cfg80211_get_p2p_attr(
					ies->data, ies->len,
					IEEE80211_P2P_ATTR_ABSENCE_NOTICE,
J
Janusz Dziedzic 已提交
1612 1613
					(u8 *) &bss_conf->p2p_noa_attr,
					sizeof(bss_conf->p2p_noa_attr));
1614
			if (ret >= 2) {
J
Janusz Dziedzic 已提交
1615 1616
				sdata->u.mgd.p2p_noa_index =
					bss_conf->p2p_noa_attr.index;
1617 1618
				bss_info_changed |= BSS_CHANGED_P2P_PS;
			}
1619
		}
1620
		rcu_read_unlock();
1621 1622
	}

J
Johannes Berg 已提交
1623
	/* just to be sure */
1624
	ieee80211_stop_poll(sdata);
J
Johannes Berg 已提交
1625

1626
	ieee80211_led_assoc(local, 1);
1627

1628
	if (sdata->u.mgd.have_beacon) {
1629 1630 1631 1632 1633 1634 1635
		/*
		 * If the AP is buggy we may get here with no DTIM period
		 * known, so assume it's 1 which is the only safe assumption
		 * in that case, although if the TIM IE is broken powersave
		 * probably just won't work at all.
		 */
		bss_conf->dtim_period = sdata->u.mgd.dtim_period ?: 1;
1636
		bss_conf->beacon_rate = bss->beacon_rate;
1637
		bss_info_changed |= BSS_CHANGED_BEACON_INFO;
1638
	} else {
1639
		bss_conf->beacon_rate = NULL;
1640
		bss_conf->dtim_period = 0;
1641
	}
1642

1643
	bss_conf->assoc = 1;
1644

1645
	/* Tell the driver to monitor connection quality (if supported) */
1646
	if (sdata->vif.driver_flags & IEEE80211_VIF_SUPPORTS_CQM_RSSI &&
1647
	    bss_conf->cqm_rssi_thold)
1648 1649
		bss_info_changed |= BSS_CHANGED_CQM;

1650
	/* Enable ARP filtering */
1651
	if (bss_conf->arp_addr_cnt)
1652 1653
		bss_info_changed |= BSS_CHANGED_ARP_FILTER;

J
Johannes Berg 已提交
1654
	ieee80211_bss_info_change_notify(sdata, bss_info_changed);
1655

J
Johannes Berg 已提交
1656 1657 1658
	mutex_lock(&local->iflist_mtx);
	ieee80211_recalc_ps(local, -1);
	mutex_unlock(&local->iflist_mtx);
1659

1660
	ieee80211_recalc_smps(sdata);
E
Eliad Peller 已提交
1661 1662
	ieee80211_recalc_ps_vif(sdata);

1663
	netif_carrier_on(sdata->dev);
1664 1665
}

1666
static void ieee80211_set_disassoc(struct ieee80211_sub_if_data *sdata,
1667 1668
				   u16 stype, u16 reason, bool tx,
				   u8 *frame_buf)
1669
{
1670
	struct ieee80211_if_managed *ifmgd = &sdata->u.mgd;
1671
	struct ieee80211_local *local = sdata->local;
1672
	u32 changed = 0;
1673

1674
	sdata_assert_lock(sdata);
1675

1676 1677 1678
	if (WARN_ON_ONCE(tx && !frame_buf))
		return;

J
Johannes Berg 已提交
1679 1680 1681
	if (WARN_ON(!ifmgd->associated))
		return;

1682 1683
	ieee80211_stop_poll(sdata);

1684
	ifmgd->associated = NULL;
1685 1686
	netif_carrier_off(sdata->dev);

1687 1688 1689 1690 1691 1692 1693 1694 1695 1696 1697
	/*
	 * if we want to get out of ps before disassoc (why?) we have
	 * to do it before sending disassoc, as otherwise the null-packet
	 * won't be valid.
	 */
	if (local->hw.conf.flags & IEEE80211_CONF_PS) {
		local->hw.conf.flags &= ~IEEE80211_CONF_PS;
		ieee80211_hw_config(local, IEEE80211_CONF_CHANGE_PS);
	}
	local->ps_sdata = NULL;

E
Eliad Peller 已提交
1698 1699 1700
	/* disable per-vif ps */
	ieee80211_recalc_ps_vif(sdata);

1701 1702
	/* flush out any pending frame (e.g. DELBA) before deauth/disassoc */
	if (tx)
1703
		ieee80211_flush_queues(local, sdata);
1704

1705 1706
	/* deauthenticate/disassociate now */
	if (tx || frame_buf)
1707 1708
		ieee80211_send_deauth_disassoc(sdata, ifmgd->bssid, stype,
					       reason, tx, frame_buf);
1709 1710 1711

	/* flush out frame */
	if (tx)
1712
		ieee80211_flush_queues(local, sdata);
1713

1714 1715 1716
	/* clear bssid only after building the needed mgmt frames */
	memset(ifmgd->bssid, 0, ETH_ALEN);

1717
	/* remove AP and TDLS peers */
1718
	sta_info_flush(sdata);
1719 1720

	/* finally reset all BSS / config parameters */
1721 1722 1723
	changed |= ieee80211_reset_erp_info(sdata);

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

J
Janusz Dziedzic 已提交
1727 1728 1729
	ifmgd->p2p_noa_index = -1;
	memset(&sdata->vif.bss_conf.p2p_noa_attr, 0,
	       sizeof(sdata->vif.bss_conf.p2p_noa_attr));
1730

1731
	/* on the next assoc, re-program HT/VHT parameters */
B
Ben Greear 已提交
1732 1733
	memset(&ifmgd->ht_capa, 0, sizeof(ifmgd->ht_capa));
	memset(&ifmgd->ht_capa_mask, 0, sizeof(ifmgd->ht_capa_mask));
1734 1735
	memset(&ifmgd->vht_capa, 0, sizeof(ifmgd->vht_capa));
	memset(&ifmgd->vht_capa_mask, 0, sizeof(ifmgd->vht_capa_mask));
1736

1737
	sdata->ap_power_level = IEEE80211_UNSET_POWER_LEVEL;
1738

1739 1740 1741
	del_timer_sync(&local->dynamic_ps_timer);
	cancel_work_sync(&local->dynamic_ps_enable_work);

1742
	/* Disable ARP filtering */
1743
	if (sdata->vif.bss_conf.arp_addr_cnt)
1744 1745
		changed |= BSS_CHANGED_ARP_FILTER;

1746 1747 1748
	sdata->vif.bss_conf.qos = false;
	changed |= BSS_CHANGED_QOS;

1749 1750
	/* The BSSID (not really interesting) and HT changed */
	changed |= BSS_CHANGED_BSSID | BSS_CHANGED_HT;
J
Johannes Berg 已提交
1751
	ieee80211_bss_info_change_notify(sdata, changed);
1752

1753 1754 1755
	/* disassociated - set to defaults now */
	ieee80211_set_wmm_default(sdata, false);

1756 1757 1758 1759
	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);
1760

1761
	sdata->vif.bss_conf.dtim_period = 0;
1762 1763
	sdata->vif.bss_conf.beacon_rate = NULL;

1764
	ifmgd->have_beacon = false;
1765

1766
	ifmgd->flags = 0;
1767
	mutex_lock(&local->mtx);
1768
	ieee80211_vif_release_channel(sdata);
1769
	mutex_unlock(&local->mtx);
1770 1771

	sdata->encrypt_headroom = IEEE80211_ENCRYPT_HEADROOM;
1772
}
1773

1774 1775 1776 1777 1778 1779 1780 1781
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 已提交
1782 1783
	 * data idle periods for sending the periodic probe request to the
	 * AP we're connected to.
1784
	 */
J
Johannes Berg 已提交
1785 1786 1787
	if (is_multicast_ether_addr(hdr->addr1))
		return;

1788
	ieee80211_sta_reset_conn_monitor(sdata);
1789
}
1790

1791 1792 1793
static void ieee80211_reset_ap_probe(struct ieee80211_sub_if_data *sdata)
{
	struct ieee80211_if_managed *ifmgd = &sdata->u.mgd;
1794
	struct ieee80211_local *local = sdata->local;
1795

1796
	mutex_lock(&local->mtx);
1797 1798
	if (!(ifmgd->flags & IEEE80211_STA_CONNECTION_POLL))
		goto out;
1799

1800
	__ieee80211_stop_poll(sdata);
1801 1802 1803 1804

	mutex_lock(&local->iflist_mtx);
	ieee80211_recalc_ps(local, -1);
	mutex_unlock(&local->iflist_mtx);
1805 1806

	if (sdata->local->hw.flags & IEEE80211_HW_CONNECTION_MONITOR)
1807
		goto out;
1808 1809 1810 1811 1812 1813 1814 1815 1816 1817 1818

	/*
	 * 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));
1819 1820
out:
	mutex_unlock(&local->mtx);
1821 1822 1823
}

void ieee80211_sta_tx_notify(struct ieee80211_sub_if_data *sdata,
1824
			     struct ieee80211_hdr *hdr, bool ack)
1825
{
F
Felix Fietkau 已提交
1826
	if (!ieee80211_is_data(hdr->frame_control))
1827 1828 1829 1830
	    return;

	if (ieee80211_is_nullfunc(hdr->frame_control) &&
	    sdata->u.mgd.probe_send_count > 0) {
1831
		if (ack)
1832
			ieee80211_sta_reset_conn_monitor(sdata);
1833 1834
		else
			sdata->u.mgd.nullfunc_failed = true;
1835
		ieee80211_queue_work(&sdata->local->hw, &sdata->work);
1836
		return;
1837
	}
1838 1839 1840

	if (ack)
		ieee80211_sta_reset_conn_monitor(sdata);
1841 1842
}

1843 1844 1845 1846
static void ieee80211_mgd_probe_ap_send(struct ieee80211_sub_if_data *sdata)
{
	struct ieee80211_if_managed *ifmgd = &sdata->u.mgd;
	const u8 *ssid;
1847
	u8 *dst = ifmgd->associated->bssid;
1848
	u8 unicast_limit = max(1, max_probe_tries - 3);
1849 1850 1851 1852 1853 1854 1855 1856

	/*
	 * 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;
1857

1858 1859 1860 1861 1862 1863 1864
	/*
	 * 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.
	 */
1865 1866
	ifmgd->probe_send_count++;

1867 1868
	if (sdata->local->hw.flags & IEEE80211_HW_REPORTS_TX_ACK_STATUS) {
		ifmgd->nullfunc_failed = false;
1869
		ieee80211_send_nullfunc(sdata->local, sdata, 0);
1870
	} else {
1871 1872
		int ssid_len;

1873
		rcu_read_lock();
1874
		ssid = ieee80211_bss_get_ie(ifmgd->associated, WLAN_EID_SSID);
1875 1876 1877 1878 1879 1880
		if (WARN_ON_ONCE(ssid == NULL))
			ssid_len = 0;
		else
			ssid_len = ssid[1];

		ieee80211_send_probe_req(sdata, dst, ssid + 2, ssid_len, NULL,
1881
					 0, (u32) -1, true, 0,
J
Johannes Berg 已提交
1882
					 ifmgd->associated->channel, false);
1883
		rcu_read_unlock();
1884
	}
1885

1886
	ifmgd->probe_timeout = jiffies + msecs_to_jiffies(probe_wait_ms);
1887
	run_again(sdata, ifmgd->probe_timeout);
1888
	if (sdata->local->hw.flags & IEEE80211_HW_REPORTS_TX_ACK_STATUS)
1889
		ieee80211_flush_queues(sdata->local, sdata);
1890 1891
}

J
Johannes Berg 已提交
1892 1893
static void ieee80211_mgd_probe_ap(struct ieee80211_sub_if_data *sdata,
				   bool beacon)
1894 1895
{
	struct ieee80211_if_managed *ifmgd = &sdata->u.mgd;
J
Johannes Berg 已提交
1896
	bool already = false;
1897

1898
	if (!ieee80211_sdata_running(sdata))
1899 1900
		return;

1901
	sdata_lock(sdata);
1902 1903 1904 1905

	if (!ifmgd->associated)
		goto out;

1906 1907 1908 1909 1910 1911 1912
	mutex_lock(&sdata->local->mtx);

	if (sdata->local->tmp_channel || sdata->local->scanning) {
		mutex_unlock(&sdata->local->mtx);
		goto out;
	}

1913
	if (beacon) {
J
Johannes Berg 已提交
1914
		mlme_dbg_ratelimited(sdata,
1915 1916
				     "detected beacon loss from AP (missed %d beacons) - probing\n",
				     beacon_loss_count);
J
Johannes Berg 已提交
1917

1918 1919 1920 1921
		ieee80211_cqm_rssi_notify(&sdata->vif,
					  NL80211_CQM_RSSI_BEACON_LOSS_EVENT,
					  GFP_KERNEL);
	}
1922

J
Johannes Berg 已提交
1923 1924 1925 1926 1927 1928 1929 1930 1931 1932 1933
	/*
	 * 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!
	 */
1934
	if (ifmgd->flags & IEEE80211_STA_CONNECTION_POLL)
J
Johannes Berg 已提交
1935 1936
		already = true;

E
Eliad Peller 已提交
1937 1938
	ifmgd->flags |= IEEE80211_STA_CONNECTION_POLL;

1939 1940
	mutex_unlock(&sdata->local->mtx);

J
Johannes Berg 已提交
1941 1942 1943
	if (already)
		goto out;

1944 1945 1946 1947
	mutex_lock(&sdata->local->iflist_mtx);
	ieee80211_recalc_ps(sdata->local, -1);
	mutex_unlock(&sdata->local->iflist_mtx);

1948 1949
	ifmgd->probe_send_count = 0;
	ieee80211_mgd_probe_ap_send(sdata);
1950
 out:
1951
	sdata_unlock(sdata);
1952 1953
}

1954 1955 1956 1957 1958
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;
1959
	struct cfg80211_bss *cbss;
1960 1961
	struct sk_buff *skb;
	const u8 *ssid;
1962
	int ssid_len;
1963 1964 1965 1966

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

1967
	sdata_assert_lock(sdata);
1968

1969 1970 1971 1972 1973 1974 1975
	if (ifmgd->associated)
		cbss = ifmgd->associated;
	else if (ifmgd->auth_data)
		cbss = ifmgd->auth_data->bss;
	else if (ifmgd->assoc_data)
		cbss = ifmgd->assoc_data->bss;
	else
1976 1977
		return NULL;

1978
	rcu_read_lock();
1979
	ssid = ieee80211_bss_get_ie(cbss, WLAN_EID_SSID);
1980 1981 1982 1983 1984
	if (WARN_ON_ONCE(ssid == NULL))
		ssid_len = 0;
	else
		ssid_len = ssid[1];

1985
	skb = ieee80211_build_probe_req(sdata, cbss->bssid,
J
Johannes Berg 已提交
1986
					(u32) -1, cbss->channel,
1987
					ssid + 2, ssid_len,
1988
					NULL, 0, true);
1989
	rcu_read_unlock();
1990 1991 1992 1993 1994

	return skb;
}
EXPORT_SYMBOL(ieee80211_ap_probereq_get);

1995
static void __ieee80211_disconnect(struct ieee80211_sub_if_data *sdata)
1996 1997
{
	struct ieee80211_if_managed *ifmgd = &sdata->u.mgd;
1998
	u8 frame_buf[IEEE80211_DEAUTH_FRAME_LEN];
1999

2000
	sdata_lock(sdata);
2001
	if (!ifmgd->associated) {
2002
		sdata_unlock(sdata);
2003 2004 2005
		return;
	}

2006 2007
	ieee80211_set_disassoc(sdata, IEEE80211_STYPE_DEAUTH,
			       WLAN_REASON_DISASSOC_DUE_TO_INACTIVITY,
2008
			       true, frame_buf);
2009
	ifmgd->flags &= ~IEEE80211_STA_CSA_RECEIVED;
2010
	sdata->vif.csa_active = false;
2011
	ieee80211_wake_queues_by_reason(&sdata->local->hw,
2012
					IEEE80211_MAX_QUEUE_MAP,
2013
					IEEE80211_QUEUE_STOP_REASON_CSA);
2014

2015 2016
	cfg80211_tx_mlme_mgmt(sdata->dev, frame_buf,
			      IEEE80211_DEAUTH_FRAME_LEN);
2017
	sdata_unlock(sdata);
2018 2019
}

2020
static void ieee80211_beacon_connection_loss_work(struct work_struct *work)
J
Johannes Berg 已提交
2021 2022 2023
{
	struct ieee80211_sub_if_data *sdata =
		container_of(work, struct ieee80211_sub_if_data,
2024
			     u.mgd.beacon_connection_loss_work);
2025 2026 2027 2028
	struct ieee80211_if_managed *ifmgd = &sdata->u.mgd;
	struct sta_info *sta;

	if (ifmgd->associated) {
2029
		rcu_read_lock();
2030 2031 2032
		sta = sta_info_get(sdata, ifmgd->bssid);
		if (sta)
			sta->beacon_loss_count++;
2033
		rcu_read_unlock();
2034
	}
J
Johannes Berg 已提交
2035

2036
	if (ifmgd->connection_loss) {
2037 2038
		sdata_info(sdata, "Connection to AP %pM lost\n",
			   ifmgd->bssid);
2039
		__ieee80211_disconnect(sdata);
2040
	} else {
2041
		ieee80211_mgd_probe_ap(sdata, true);
2042 2043 2044 2045 2046 2047 2048 2049 2050
	}
}

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

2051
	__ieee80211_disconnect(sdata);
J
Johannes Berg 已提交
2052 2053
}

2054 2055 2056
void ieee80211_beacon_loss(struct ieee80211_vif *vif)
{
	struct ieee80211_sub_if_data *sdata = vif_to_sdata(vif);
2057
	struct ieee80211_hw *hw = &sdata->local->hw;
2058

J
Johannes Berg 已提交
2059 2060
	trace_api_beacon_loss(sdata);

2061
	sdata->u.mgd.connection_loss = false;
2062
	ieee80211_queue_work(hw, &sdata->u.mgd.beacon_connection_loss_work);
2063 2064 2065
}
EXPORT_SYMBOL(ieee80211_beacon_loss);

2066 2067 2068 2069 2070
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 已提交
2071 2072
	trace_api_connection_loss(sdata);

2073
	sdata->u.mgd.connection_loss = true;
2074 2075 2076 2077 2078
	ieee80211_queue_work(hw, &sdata->u.mgd.beacon_connection_loss_work);
}
EXPORT_SYMBOL(ieee80211_connection_loss);


J
Johannes Berg 已提交
2079 2080 2081 2082 2083
static void ieee80211_destroy_auth_data(struct ieee80211_sub_if_data *sdata,
					bool assoc)
{
	struct ieee80211_mgd_auth_data *auth_data = sdata->u.mgd.auth_data;

2084
	sdata_assert_lock(sdata);
J
Johannes Berg 已提交
2085 2086 2087 2088 2089 2090

	if (!assoc) {
		sta_info_destroy_addr(sdata, auth_data->bss->bssid);

		memset(sdata->u.mgd.bssid, 0, ETH_ALEN);
		ieee80211_bss_info_change_notify(sdata, BSS_CHANGED_BSSID);
2091
		sdata->u.mgd.flags = 0;
2092
		mutex_lock(&sdata->local->mtx);
J
Johannes Berg 已提交
2093
		ieee80211_vif_release_channel(sdata);
2094
		mutex_unlock(&sdata->local->mtx);
J
Johannes Berg 已提交
2095 2096
	}

2097
	cfg80211_put_bss(sdata->local->hw.wiphy, auth_data->bss);
J
Johannes Berg 已提交
2098 2099 2100 2101 2102 2103 2104
	kfree(auth_data);
	sdata->u.mgd.auth_data = NULL;
}

static void ieee80211_auth_challenge(struct ieee80211_sub_if_data *sdata,
				     struct ieee80211_mgmt *mgmt, size_t len)
{
2105
	struct ieee80211_local *local = sdata->local;
J
Johannes Berg 已提交
2106 2107 2108
	struct ieee80211_mgd_auth_data *auth_data = sdata->u.mgd.auth_data;
	u8 *pos;
	struct ieee802_11_elems elems;
2109
	u32 tx_flags = 0;
J
Johannes Berg 已提交
2110 2111

	pos = mgmt->u.auth.variable;
2112
	ieee802_11_parse_elems(pos, len - (pos - (u8 *) mgmt), false, &elems);
J
Johannes Berg 已提交
2113 2114 2115
	if (!elems.challenge)
		return;
	auth_data->expected_transaction = 4;
J
Johannes Berg 已提交
2116
	drv_mgd_prepare_tx(sdata->local, sdata);
2117 2118 2119
	if (local->hw.flags & IEEE80211_HW_REPORTS_TX_ACK_STATUS)
		tx_flags = IEEE80211_TX_CTL_REQ_TX_STATUS |
			   IEEE80211_TX_INTFL_MLME_CONN_TX;
2120
	ieee80211_send_auth(sdata, 3, auth_data->algorithm, 0,
J
Johannes Berg 已提交
2121 2122 2123
			    elems.challenge - 2, elems.challenge_len + 2,
			    auth_data->bss->bssid, auth_data->bss->bssid,
			    auth_data->key, auth_data->key_len,
2124
			    auth_data->key_idx, tx_flags);
J
Johannes Berg 已提交
2125 2126
}

2127 2128
static void ieee80211_rx_mgmt_auth(struct ieee80211_sub_if_data *sdata,
				   struct ieee80211_mgmt *mgmt, size_t len)
J
Johannes Berg 已提交
2129 2130 2131 2132 2133 2134
{
	struct ieee80211_if_managed *ifmgd = &sdata->u.mgd;
	u8 bssid[ETH_ALEN];
	u16 auth_alg, auth_transaction, status_code;
	struct sta_info *sta;

2135
	sdata_assert_lock(sdata);
J
Johannes Berg 已提交
2136 2137

	if (len < 24 + 6)
2138
		return;
J
Johannes Berg 已提交
2139 2140

	if (!ifmgd->auth_data || ifmgd->auth_data->done)
2141
		return;
J
Johannes Berg 已提交
2142 2143 2144

	memcpy(bssid, ifmgd->auth_data->bss->bssid, ETH_ALEN);

2145
	if (!ether_addr_equal(bssid, mgmt->bssid))
2146
		return;
J
Johannes Berg 已提交
2147 2148 2149 2150 2151 2152

	auth_alg = le16_to_cpu(mgmt->u.auth.auth_alg);
	auth_transaction = le16_to_cpu(mgmt->u.auth.auth_transaction);
	status_code = le16_to_cpu(mgmt->u.auth.status_code);

	if (auth_alg != ifmgd->auth_data->algorithm ||
2153 2154 2155 2156 2157
	    auth_transaction != ifmgd->auth_data->expected_transaction) {
		sdata_info(sdata, "%pM unexpected authentication state: alg %d (expected %d) transact %d (expected %d)\n",
			   mgmt->sa, auth_alg, ifmgd->auth_data->algorithm,
			   auth_transaction,
			   ifmgd->auth_data->expected_transaction);
2158
		return;
2159
	}
J
Johannes Berg 已提交
2160 2161

	if (status_code != WLAN_STATUS_SUCCESS) {
J
Johannes Berg 已提交
2162 2163
		sdata_info(sdata, "%pM denied authentication (status %d)\n",
			   mgmt->sa, status_code);
2164
		ieee80211_destroy_auth_data(sdata, false);
2165
		cfg80211_rx_mlme_mgmt(sdata->dev, (u8 *)mgmt, len);
2166
		return;
J
Johannes Berg 已提交
2167 2168 2169 2170 2171 2172
	}

	switch (ifmgd->auth_data->algorithm) {
	case WLAN_AUTH_OPEN:
	case WLAN_AUTH_LEAP:
	case WLAN_AUTH_FT:
2173
	case WLAN_AUTH_SAE:
J
Johannes Berg 已提交
2174 2175 2176 2177 2178
		break;
	case WLAN_AUTH_SHARED_KEY:
		if (ifmgd->auth_data->expected_transaction != 4) {
			ieee80211_auth_challenge(sdata, mgmt, len);
			/* need another frame */
2179
			return;
J
Johannes Berg 已提交
2180 2181 2182 2183 2184
		}
		break;
	default:
		WARN_ONCE(1, "invalid auth alg %d",
			  ifmgd->auth_data->algorithm);
2185
		return;
J
Johannes Berg 已提交
2186 2187
	}

J
Johannes Berg 已提交
2188
	sdata_info(sdata, "authenticated\n");
J
Johannes Berg 已提交
2189 2190
	ifmgd->auth_data->done = true;
	ifmgd->auth_data->timeout = jiffies + IEEE80211_AUTH_WAIT_ASSOC;
2191
	ifmgd->auth_data->timeout_started = true;
2192
	run_again(sdata, ifmgd->auth_data->timeout);
J
Johannes Berg 已提交
2193

2194 2195 2196 2197 2198 2199
	if (ifmgd->auth_data->algorithm == WLAN_AUTH_SAE &&
	    ifmgd->auth_data->expected_transaction != 2) {
		/*
		 * Report auth frame to user space for processing since another
		 * round of Authentication frames is still needed.
		 */
2200
		cfg80211_rx_mlme_mgmt(sdata->dev, (u8 *)mgmt, len);
2201
		return;
2202 2203
	}

J
Johannes Berg 已提交
2204 2205 2206 2207 2208 2209 2210 2211
	/* move station state to auth */
	mutex_lock(&sdata->local->sta_mtx);
	sta = sta_info_get(sdata, bssid);
	if (!sta) {
		WARN_ONCE(1, "%s: STA %pM not found", sdata->name, bssid);
		goto out_err;
	}
	if (sta_info_move_state(sta, IEEE80211_STA_AUTH)) {
J
Johannes Berg 已提交
2212
		sdata_info(sdata, "failed moving %pM to auth\n", bssid);
J
Johannes Berg 已提交
2213 2214 2215 2216
		goto out_err;
	}
	mutex_unlock(&sdata->local->sta_mtx);

2217
	cfg80211_rx_mlme_mgmt(sdata->dev, (u8 *)mgmt, len);
2218
	return;
J
Johannes Berg 已提交
2219 2220 2221 2222 2223 2224
 out_err:
	mutex_unlock(&sdata->local->sta_mtx);
	/* ignore frame -- wait for timeout */
}


2225 2226
static void ieee80211_rx_mgmt_deauth(struct ieee80211_sub_if_data *sdata,
				     struct ieee80211_mgmt *mgmt, size_t len)
2227
{
2228
	struct ieee80211_if_managed *ifmgd = &sdata->u.mgd;
2229
	const u8 *bssid = NULL;
2230 2231
	u16 reason_code;

2232
	sdata_assert_lock(sdata);
J
Johannes Berg 已提交
2233

2234
	if (len < 24 + 2)
2235
		return;
2236

J
Johannes Berg 已提交
2237
	if (!ifmgd->associated ||
2238
	    !ether_addr_equal(mgmt->bssid, ifmgd->associated->bssid))
2239
		return;
2240

2241
	bssid = ifmgd->associated->bssid;
2242 2243 2244

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

J
Johannes Berg 已提交
2245 2246
	sdata_info(sdata, "deauthenticated from %pM (Reason: %u)\n",
		   bssid, reason_code);
2247

2248 2249
	ieee80211_set_disassoc(sdata, 0, 0, false, NULL);

2250
	cfg80211_rx_mlme_mgmt(sdata->dev, (u8 *)mgmt, len);
2251 2252 2253
}


2254 2255
static void ieee80211_rx_mgmt_disassoc(struct ieee80211_sub_if_data *sdata,
				       struct ieee80211_mgmt *mgmt, size_t len)
2256
{
2257
	struct ieee80211_if_managed *ifmgd = &sdata->u.mgd;
2258 2259
	u16 reason_code;

2260
	sdata_assert_lock(sdata);
2261

J
Johannes Berg 已提交
2262
	if (len < 24 + 2)
2263
		return;
2264

J
Johannes Berg 已提交
2265
	if (!ifmgd->associated ||
2266
	    !ether_addr_equal(mgmt->bssid, ifmgd->associated->bssid))
2267
		return;
2268 2269 2270

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

J
Johannes Berg 已提交
2271 2272
	sdata_info(sdata, "disassociated from %pM (Reason: %u)\n",
		   mgmt->sa, reason_code);
2273

2274 2275
	ieee80211_set_disassoc(sdata, 0, 0, false, NULL);

2276
	cfg80211_rx_mlme_mgmt(sdata->dev, (u8 *)mgmt, len);
2277 2278
}

2279 2280 2281 2282
static void ieee80211_get_rates(struct ieee80211_supported_band *sband,
				u8 *supp_rates, unsigned int supp_rates_len,
				u32 *rates, u32 *basic_rates,
				bool *have_higher_than_11mbit,
2283 2284
				int *min_rate, int *min_rate_index,
				int shift, u32 rate_flags)
2285 2286 2287 2288
{
	int i, j;

	for (i = 0; i < supp_rates_len; i++) {
2289
		int rate = supp_rates[i] & 0x7f;
2290 2291
		bool is_basic = !!(supp_rates[i] & 0x80);

2292
		if ((rate * 5 * (1 << shift)) > 110)
2293 2294 2295 2296 2297 2298 2299 2300 2301 2302 2303 2304 2305 2306 2307
			*have_higher_than_11mbit = true;

		/*
		 * BSS_MEMBERSHIP_SELECTOR_HT_PHY is defined in 802.11n-2009
		 * 7.3.2.2 as a magic value instead of a rate. Hence, skip it.
		 *
		 * Note: Even through the membership selector and the basic
		 *	 rate flag share the same bit, they are not exactly
		 *	 the same.
		 */
		if (!!(supp_rates[i] & 0x80) &&
		    (supp_rates[i] & 0x7f) == BSS_MEMBERSHIP_SELECTOR_HT_PHY)
			continue;

		for (j = 0; j < sband->n_bitrates; j++) {
2308 2309 2310 2311 2312 2313 2314 2315 2316
			struct ieee80211_rate *br;
			int brate;

			br = &sband->bitrates[j];
			if ((rate_flags & br->flags) != rate_flags)
				continue;

			brate = DIV_ROUND_UP(br->bitrate, (1 << shift) * 5);
			if (brate == rate) {
2317 2318 2319
				*rates |= BIT(j);
				if (is_basic)
					*basic_rates |= BIT(j);
2320 2321
				if ((rate * 5) < *min_rate) {
					*min_rate = rate * 5;
2322 2323 2324 2325 2326 2327 2328
					*min_rate_index = j;
				}
				break;
			}
		}
	}
}
2329

J
Johannes Berg 已提交
2330 2331 2332 2333 2334
static void ieee80211_destroy_assoc_data(struct ieee80211_sub_if_data *sdata,
					 bool assoc)
{
	struct ieee80211_mgd_assoc_data *assoc_data = sdata->u.mgd.assoc_data;

2335
	sdata_assert_lock(sdata);
J
Johannes Berg 已提交
2336 2337 2338 2339 2340 2341

	if (!assoc) {
		sta_info_destroy_addr(sdata, assoc_data->bss->bssid);

		memset(sdata->u.mgd.bssid, 0, ETH_ALEN);
		ieee80211_bss_info_change_notify(sdata, BSS_CHANGED_BSSID);
2342
		sdata->u.mgd.flags = 0;
2343
		mutex_lock(&sdata->local->mtx);
J
Johannes Berg 已提交
2344
		ieee80211_vif_release_channel(sdata);
2345
		mutex_unlock(&sdata->local->mtx);
J
Johannes Berg 已提交
2346 2347 2348 2349 2350 2351 2352 2353
	}

	kfree(assoc_data);
	sdata->u.mgd.assoc_data = NULL;
}

static bool ieee80211_assoc_success(struct ieee80211_sub_if_data *sdata,
				    struct cfg80211_bss *cbss,
J
Johannes Berg 已提交
2354
				    struct ieee80211_mgmt *mgmt, size_t len)
2355
{
2356
	struct ieee80211_if_managed *ifmgd = &sdata->u.mgd;
2357
	struct ieee80211_local *local = sdata->local;
2358
	struct ieee80211_supported_band *sband;
2359
	struct sta_info *sta;
J
Johannes Berg 已提交
2360 2361
	u8 *pos;
	u16 capab_info, aid;
2362
	struct ieee802_11_elems elems;
J
Johannes Berg 已提交
2363
	struct ieee80211_bss_conf *bss_conf = &sdata->vif.bss_conf;
2364 2365
	const struct cfg80211_bss_ies *bss_ies = NULL;
	struct ieee80211_mgd_assoc_data *assoc_data = ifmgd->assoc_data;
J
Johannes Berg 已提交
2366
	u32 changed = 0;
2367
	int err;
2368
	bool ret;
2369

J
Johannes Berg 已提交
2370
	/* AssocResp and ReassocResp have identical structure */
2371 2372

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

2375
	if ((aid & (BIT(15) | BIT(14))) != (BIT(15) | BIT(14)))
J
Johannes Berg 已提交
2376 2377
		sdata_info(sdata, "invalid AID value 0x%x; bits 15:14 not set\n",
			   aid);
2378 2379
	aid &= ~(BIT(15) | BIT(14));

2380 2381 2382
	ifmgd->broken_ap = false;

	if (aid == 0 || aid > IEEE80211_MAX_AID) {
J
Johannes Berg 已提交
2383 2384
		sdata_info(sdata, "invalid AID value %d (out of range), turn off PS\n",
			   aid);
2385 2386 2387 2388
		aid = 0;
		ifmgd->broken_ap = true;
	}

J
Johannes Berg 已提交
2389
	pos = mgmt->u.assoc_resp.variable;
2390
	ieee802_11_parse_elems(pos, len - (pos - (u8 *) mgmt), false, &elems);
J
Johannes Berg 已提交
2391

2392
	if (!elems.supp_rates) {
J
Johannes Berg 已提交
2393
		sdata_info(sdata, "no SuppRates element in AssocResp\n");
J
Johannes Berg 已提交
2394
		return false;
2395 2396
	}

2397
	ifmgd->aid = aid;
2398

2399 2400 2401 2402 2403 2404 2405 2406 2407 2408 2409 2410 2411 2412 2413 2414 2415 2416 2417 2418 2419 2420 2421 2422 2423 2424 2425 2426 2427 2428 2429 2430 2431 2432 2433 2434 2435 2436 2437 2438 2439 2440 2441 2442 2443 2444 2445 2446 2447 2448 2449 2450 2451 2452 2453 2454 2455 2456 2457 2458 2459 2460 2461
	/*
	 * Some APs are erroneously not including some information in their
	 * (re)association response frames. Try to recover by using the data
	 * from the beacon or probe response. This seems to afflict mobile
	 * 2G/3G/4G wifi routers, reported models include the "Onda PN51T",
	 * "Vodafone PocketWiFi 2", "ZTE MF60" and a similar T-Mobile device.
	 */
	if ((assoc_data->wmm && !elems.wmm_param) ||
	    (!(ifmgd->flags & IEEE80211_STA_DISABLE_HT) &&
	     (!elems.ht_cap_elem || !elems.ht_operation)) ||
	    (!(ifmgd->flags & IEEE80211_STA_DISABLE_VHT) &&
	     (!elems.vht_cap_elem || !elems.vht_operation))) {
		const struct cfg80211_bss_ies *ies;
		struct ieee802_11_elems bss_elems;

		rcu_read_lock();
		ies = rcu_dereference(cbss->ies);
		if (ies)
			bss_ies = kmemdup(ies, sizeof(*ies) + ies->len,
					  GFP_ATOMIC);
		rcu_read_unlock();
		if (!bss_ies)
			return false;

		ieee802_11_parse_elems(bss_ies->data, bss_ies->len,
				       false, &bss_elems);
		if (assoc_data->wmm &&
		    !elems.wmm_param && bss_elems.wmm_param) {
			elems.wmm_param = bss_elems.wmm_param;
			sdata_info(sdata,
				   "AP bug: WMM param missing from AssocResp\n");
		}

		/*
		 * Also check if we requested HT/VHT, otherwise the AP doesn't
		 * have to include the IEs in the (re)association response.
		 */
		if (!elems.ht_cap_elem && bss_elems.ht_cap_elem &&
		    !(ifmgd->flags & IEEE80211_STA_DISABLE_HT)) {
			elems.ht_cap_elem = bss_elems.ht_cap_elem;
			sdata_info(sdata,
				   "AP bug: HT capability missing from AssocResp\n");
		}
		if (!elems.ht_operation && bss_elems.ht_operation &&
		    !(ifmgd->flags & IEEE80211_STA_DISABLE_HT)) {
			elems.ht_operation = bss_elems.ht_operation;
			sdata_info(sdata,
				   "AP bug: HT operation missing from AssocResp\n");
		}
		if (!elems.vht_cap_elem && bss_elems.vht_cap_elem &&
		    !(ifmgd->flags & IEEE80211_STA_DISABLE_VHT)) {
			elems.vht_cap_elem = bss_elems.vht_cap_elem;
			sdata_info(sdata,
				   "AP bug: VHT capa missing from AssocResp\n");
		}
		if (!elems.vht_operation && bss_elems.vht_operation &&
		    !(ifmgd->flags & IEEE80211_STA_DISABLE_VHT)) {
			elems.vht_operation = bss_elems.vht_operation;
			sdata_info(sdata,
				   "AP bug: VHT operation missing from AssocResp\n");
		}
	}

2462 2463 2464 2465 2466 2467 2468
	/*
	 * We previously checked these in the beacon/probe response, so
	 * they should be present here. This is just a safety net.
	 */
	if (!(ifmgd->flags & IEEE80211_STA_DISABLE_HT) &&
	    (!elems.wmm_param || !elems.ht_cap_elem || !elems.ht_operation)) {
		sdata_info(sdata,
2469 2470 2471
			   "HT AP is missing WMM params or HT capability/operation\n");
		ret = false;
		goto out;
2472 2473 2474 2475 2476
	}

	if (!(ifmgd->flags & IEEE80211_STA_DISABLE_VHT) &&
	    (!elems.vht_cap_elem || !elems.vht_operation)) {
		sdata_info(sdata,
2477 2478 2479
			   "VHT AP is missing VHT capability/operation\n");
		ret = false;
		goto out;
2480 2481
	}

2482 2483 2484 2485 2486
	mutex_lock(&sdata->local->sta_mtx);
	/*
	 * station info was already allocated and inserted before
	 * the association and should be available to us
	 */
2487
	sta = sta_info_get(sdata, cbss->bssid);
2488 2489
	if (WARN_ON(!sta)) {
		mutex_unlock(&sdata->local->sta_mtx);
2490 2491
		ret = false;
		goto out;
2492
	}
2493

J
Johannes Berg 已提交
2494
	sband = local->hw.wiphy->bands[ieee80211_get_sdata_band(sdata)];
2495

2496
	/* Set up internal HT/VHT capabilities */
2497
	if (elems.ht_cap_elem && !(ifmgd->flags & IEEE80211_STA_DISABLE_HT))
B
Ben Greear 已提交
2498
		ieee80211_ht_cap_ie_to_sta_ht_cap(sdata, sband,
2499
						  elems.ht_cap_elem, sta);
2500

M
Mahesh Palivela 已提交
2501 2502
	if (elems.vht_cap_elem && !(ifmgd->flags & IEEE80211_STA_DISABLE_VHT))
		ieee80211_vht_cap_ie_to_sta_vht_cap(sdata, sband,
2503
						    elems.vht_cap_elem, sta);
M
Mahesh Palivela 已提交
2504

2505 2506 2507 2508 2509 2510
	/*
	 * Some APs, e.g. Netgear WNDR3700, report invalid HT operation data
	 * in their association response, so ignore that data for our own
	 * configuration. If it changed since the last beacon, we'll get the
	 * next beacon and update then.
	 */
2511

2512 2513 2514 2515 2516 2517 2518 2519 2520 2521 2522 2523 2524 2525 2526
	/*
	 * If an operating mode notification IE is present, override the
	 * NSS calculation (that would be done in rate_control_rate_init())
	 * and use the # of streams from that element.
	 */
	if (elems.opmode_notif &&
	    !(*elems.opmode_notif & IEEE80211_OPMODE_NOTIF_RX_NSS_TYPE_BF)) {
		u8 nss;

		nss = *elems.opmode_notif & IEEE80211_OPMODE_NOTIF_RX_NSS_MASK;
		nss >>= IEEE80211_OPMODE_NOTIF_RX_NSS_SHIFT;
		nss += 1;
		sta->sta.rx_nss = nss;
	}

2527
	rate_control_rate_init(sta);
2528

2529
	if (ifmgd->flags & IEEE80211_STA_MFP_ENABLED)
J
Johannes Berg 已提交
2530
		set_sta_flag(sta, WLAN_STA_MFP);
2531

2532
	if (elems.wmm_param)
J
Johannes Berg 已提交
2533
		set_sta_flag(sta, WLAN_STA_WME);
2534

2535
	err = sta_info_move_state(sta, IEEE80211_STA_ASSOC);
2536 2537 2538
	if (!err && !(ifmgd->flags & IEEE80211_STA_CONTROL_PORT))
		err = sta_info_move_state(sta, IEEE80211_STA_AUTHORIZED);
	if (err) {
J
Johannes Berg 已提交
2539 2540 2541
		sdata_info(sdata,
			   "failed to move station %pM to desired state\n",
			   sta->sta.addr);
2542 2543
		WARN_ON(__sta_info_destroy(sta));
		mutex_unlock(&sdata->local->sta_mtx);
2544 2545
		ret = false;
		goto out;
2546 2547
	}

2548
	mutex_unlock(&sdata->local->sta_mtx);
2549

2550 2551 2552 2553 2554 2555 2556 2557
	/*
	 * 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;

2558
	if (!(ifmgd->flags & IEEE80211_STA_DISABLE_WMM) && elems.wmm_param)
2559
		ieee80211_sta_wmm_params(local, sdata, elems.wmm_param,
J
Johannes Berg 已提交
2560
					 elems.wmm_param_len);
2561
	else
2562 2563
		ieee80211_set_wmm_default(sdata, false);
	changed |= BSS_CHANGED_QOS;
2564

J
Johannes Berg 已提交
2565 2566 2567 2568
	/* set AID and assoc capability,
	 * ieee80211_set_associated() will tell the driver */
	bss_conf->aid = aid;
	bss_conf->assoc_capability = capab_info;
2569
	ieee80211_set_associated(sdata, cbss, changed);
2570

2571 2572 2573 2574 2575 2576 2577
	/*
	 * 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);

2578
	/*
J
Johannes Berg 已提交
2579 2580
	 * Start timer to probe the connection to the AP now.
	 * Also start the timer that will detect beacon loss.
2581
	 */
J
Johannes Berg 已提交
2582
	ieee80211_sta_rx_notify(sdata, (struct ieee80211_hdr *)mgmt);
2583
	ieee80211_sta_reset_beacon_monitor(sdata);
2584

2585 2586 2587 2588
	ret = true;
 out:
	kfree(bss_ies);
	return ret;
2589 2590
}

2591 2592 2593
static void ieee80211_rx_mgmt_assoc_resp(struct ieee80211_sub_if_data *sdata,
					 struct ieee80211_mgmt *mgmt,
					 size_t len)
J
Johannes Berg 已提交
2594 2595 2596 2597 2598 2599 2600
{
	struct ieee80211_if_managed *ifmgd = &sdata->u.mgd;
	struct ieee80211_mgd_assoc_data *assoc_data = ifmgd->assoc_data;
	u16 capab_info, status_code, aid;
	struct ieee802_11_elems elems;
	u8 *pos;
	bool reassoc;
2601
	struct cfg80211_bss *bss;
J
Johannes Berg 已提交
2602

2603
	sdata_assert_lock(sdata);
J
Johannes Berg 已提交
2604 2605

	if (!assoc_data)
2606
		return;
2607
	if (!ether_addr_equal(assoc_data->bss->bssid, mgmt->bssid))
2608
		return;
J
Johannes Berg 已提交
2609 2610 2611 2612 2613 2614 2615

	/*
	 * AssocResp and ReassocResp have identical structure, so process both
	 * of them in this function.
	 */

	if (len < 24 + 6)
2616
		return;
J
Johannes Berg 已提交
2617 2618 2619 2620 2621 2622

	reassoc = ieee80211_is_reassoc_req(mgmt->frame_control);
	capab_info = le16_to_cpu(mgmt->u.assoc_resp.capab_info);
	status_code = le16_to_cpu(mgmt->u.assoc_resp.status_code);
	aid = le16_to_cpu(mgmt->u.assoc_resp.aid);

J
Johannes Berg 已提交
2623 2624 2625 2626
	sdata_info(sdata,
		   "RX %sssocResp from %pM (capab=0x%x status=%d aid=%d)\n",
		   reassoc ? "Rea" : "A", mgmt->sa,
		   capab_info, status_code, (u16)(aid & ~(BIT(15) | BIT(14))));
J
Johannes Berg 已提交
2627 2628

	pos = mgmt->u.assoc_resp.variable;
2629
	ieee802_11_parse_elems(pos, len - (pos - (u8 *) mgmt), false, &elems);
J
Johannes Berg 已提交
2630 2631

	if (status_code == WLAN_STATUS_ASSOC_REJECTED_TEMPORARILY &&
2632 2633
	    elems.timeout_int &&
	    elems.timeout_int->type == WLAN_TIMEOUT_ASSOC_COMEBACK) {
J
Johannes Berg 已提交
2634
		u32 tu, ms;
2635
		tu = le32_to_cpu(elems.timeout_int->value);
J
Johannes Berg 已提交
2636
		ms = tu * 1024 / 1000;
J
Johannes Berg 已提交
2637 2638 2639
		sdata_info(sdata,
			   "%pM rejected association temporarily; comeback duration %u TU (%u ms)\n",
			   mgmt->sa, tu, ms);
J
Johannes Berg 已提交
2640
		assoc_data->timeout = jiffies + msecs_to_jiffies(ms);
2641
		assoc_data->timeout_started = true;
J
Johannes Berg 已提交
2642
		if (ms > IEEE80211_ASSOC_TIMEOUT)
2643 2644
			run_again(sdata, assoc_data->timeout);
		return;
J
Johannes Berg 已提交
2645 2646
	}

2647
	bss = assoc_data->bss;
J
Johannes Berg 已提交
2648 2649

	if (status_code != WLAN_STATUS_SUCCESS) {
J
Johannes Berg 已提交
2650 2651
		sdata_info(sdata, "%pM denied association (code=%d)\n",
			   mgmt->sa, status_code);
J
Johannes Berg 已提交
2652 2653
		ieee80211_destroy_assoc_data(sdata, false);
	} else {
2654
		if (!ieee80211_assoc_success(sdata, bss, mgmt, len)) {
J
Johannes Berg 已提交
2655
			/* oops -- internal error -- send timeout for now */
2656
			ieee80211_destroy_assoc_data(sdata, false);
2657
			cfg80211_assoc_timeout(sdata->dev, bss);
2658
			return;
J
Johannes Berg 已提交
2659
		}
2660
		sdata_info(sdata, "associated\n");
2661 2662 2663 2664 2665 2666 2667

		/*
		 * destroy assoc_data afterwards, as otherwise an idle
		 * recalc after assoc_data is NULL but before associated
		 * is set can cause the interface to go idle
		 */
		ieee80211_destroy_assoc_data(sdata, true);
J
Johannes Berg 已提交
2668 2669
	}

2670
	cfg80211_rx_assoc_resp(sdata->dev, bss, (u8 *)mgmt, len);
J
Johannes Berg 已提交
2671
}
J
Johannes Berg 已提交
2672

2673
static void ieee80211_rx_bss_info(struct ieee80211_sub_if_data *sdata,
J
Johannes Berg 已提交
2674
				  struct ieee80211_mgmt *mgmt, size_t len,
2675
				  struct ieee80211_rx_status *rx_status,
2676
				  struct ieee802_11_elems *elems)
2677 2678 2679
{
	struct ieee80211_local *local = sdata->local;
	int freq;
2680
	struct ieee80211_bss *bss;
2681
	struct ieee80211_channel *channel;
2682

2683
	sdata_assert_lock(sdata);
2684

2685
	if (elems->ds_params)
2686 2687
		freq = ieee80211_channel_to_frequency(elems->ds_params[0],
						      rx_status->band);
2688 2689 2690 2691 2692 2693 2694 2695 2696
	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,
2697
					channel);
2698
	if (bss) {
2699
		ieee80211_rx_bss_put(local, bss);
2700 2701
		sdata->vif.bss_conf.beacon_rate = bss->beacon_rate;
	}
2702 2703 2704
}


2705
static void ieee80211_rx_mgmt_probe_resp(struct ieee80211_sub_if_data *sdata,
J
Johannes Berg 已提交
2706
					 struct sk_buff *skb)
2707
{
J
Johannes Berg 已提交
2708
	struct ieee80211_mgmt *mgmt = (void *)skb->data;
2709
	struct ieee80211_if_managed *ifmgd;
J
Johannes Berg 已提交
2710 2711
	struct ieee80211_rx_status *rx_status = (void *) skb->cb;
	size_t baselen, len = skb->len;
2712 2713
	struct ieee802_11_elems elems;

2714 2715
	ifmgd = &sdata->u.mgd;

2716
	sdata_assert_lock(sdata);
2717

2718
	if (!ether_addr_equal(mgmt->da, sdata->vif.addr))
2719 2720
		return; /* ignore ProbeResp to foreign address */

2721 2722 2723 2724 2725
	baselen = (u8 *) mgmt->u.probe_resp.variable - (u8 *) mgmt;
	if (baselen > len)
		return;

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

2728
	ieee80211_rx_bss_info(sdata, mgmt, len, rx_status, &elems);
2729

2730
	if (ifmgd->associated &&
2731
	    ether_addr_equal(mgmt->bssid, ifmgd->associated->bssid))
2732
		ieee80211_reset_ap_probe(sdata);
J
Johannes Berg 已提交
2733 2734

	if (ifmgd->auth_data && !ifmgd->auth_data->bss->proberesp_ies &&
2735
	    ether_addr_equal(mgmt->bssid, ifmgd->auth_data->bss->bssid)) {
J
Johannes Berg 已提交
2736
		/* got probe response, continue with auth */
J
Johannes Berg 已提交
2737
		sdata_info(sdata, "direct probe responded\n");
J
Johannes Berg 已提交
2738 2739
		ifmgd->auth_data->tries = 0;
		ifmgd->auth_data->timeout = jiffies;
2740
		ifmgd->auth_data->timeout_started = true;
2741
		run_again(sdata, ifmgd->auth_data->timeout);
J
Johannes Berg 已提交
2742
	}
2743 2744
}

2745 2746 2747 2748 2749 2750 2751 2752 2753 2754 2755 2756 2757 2758
/*
 * 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 =
2759 2760 2761 2762 2763
	(1ULL << WLAN_EID_COUNTRY) |
	(1ULL << WLAN_EID_ERP_INFO) |
	(1ULL << WLAN_EID_CHANNEL_SWITCH) |
	(1ULL << WLAN_EID_PWR_CONSTRAINT) |
	(1ULL << WLAN_EID_HT_CAPABILITY) |
2764
	(1ULL << WLAN_EID_HT_OPERATION);
2765

2766 2767 2768
static void ieee80211_rx_mgmt_beacon(struct ieee80211_sub_if_data *sdata,
				     struct ieee80211_mgmt *mgmt, size_t len,
				     struct ieee80211_rx_status *rx_status)
2769
{
2770
	struct ieee80211_if_managed *ifmgd = &sdata->u.mgd;
2771
	struct ieee80211_bss_conf *bss_conf = &sdata->vif.bss_conf;
2772 2773
	size_t baselen;
	struct ieee802_11_elems elems;
2774
	struct ieee80211_local *local = sdata->local;
J
Johannes Berg 已提交
2775 2776
	struct ieee80211_chanctx_conf *chanctx_conf;
	struct ieee80211_channel *chan;
2777
	struct sta_info *sta;
2778
	u32 changed = 0;
2779
	bool erp_valid;
J
Johannes Berg 已提交
2780
	u8 erp_value = 0;
2781
	u32 ncrc;
2782
	u8 *bssid;
2783
	u8 deauth_buf[IEEE80211_DEAUTH_FRAME_LEN];
2784

2785
	sdata_assert_lock(sdata);
2786

2787 2788 2789
	/* Process beacon from the current BSS */
	baselen = (u8 *) mgmt->u.beacon.variable - (u8 *) mgmt;
	if (baselen > len)
2790
		return;
2791

J
Johannes Berg 已提交
2792 2793 2794 2795
	rcu_read_lock();
	chanctx_conf = rcu_dereference(sdata->vif.chanctx_conf);
	if (!chanctx_conf) {
		rcu_read_unlock();
2796
		return;
J
Johannes Berg 已提交
2797 2798
	}

2799
	if (rx_status->freq != chanctx_conf->def.chan->center_freq) {
J
Johannes Berg 已提交
2800
		rcu_read_unlock();
2801
		return;
J
Johannes Berg 已提交
2802
	}
2803
	chan = chanctx_conf->def.chan;
J
Johannes Berg 已提交
2804
	rcu_read_unlock();
2805

2806
	if (ifmgd->assoc_data && ifmgd->assoc_data->need_beacon &&
2807
	    ether_addr_equal(mgmt->bssid, ifmgd->assoc_data->bss->bssid)) {
J
Johannes Berg 已提交
2808
		ieee802_11_parse_elems(mgmt->u.beacon.variable,
2809
				       len - baselen, false, &elems);
2810

2811
		ieee80211_rx_bss_info(sdata, mgmt, len, rx_status, &elems);
2812 2813 2814 2815
		if (elems.tim && !elems.parse_error) {
			const struct ieee80211_tim_ie *tim_ie = elems.tim;
			ifmgd->dtim_period = tim_ie->dtim_period;
		}
2816
		ifmgd->have_beacon = true;
2817
		ifmgd->assoc_data->need_beacon = false;
2818 2819 2820 2821 2822 2823 2824 2825 2826 2827 2828
		if (local->hw.flags & IEEE80211_HW_TIMING_BEACON_ONLY) {
			sdata->vif.bss_conf.sync_tsf =
				le64_to_cpu(mgmt->u.beacon.timestamp);
			sdata->vif.bss_conf.sync_device_ts =
				rx_status->device_timestamp;
			if (elems.tim)
				sdata->vif.bss_conf.sync_dtim_count =
					elems.tim->dtim_count;
			else
				sdata->vif.bss_conf.sync_dtim_count = 0;
		}
J
Johannes Berg 已提交
2829 2830
		/* continue assoc process */
		ifmgd->assoc_data->timeout = jiffies;
2831
		ifmgd->assoc_data->timeout_started = true;
2832 2833
		run_again(sdata, ifmgd->assoc_data->timeout);
		return;
J
Johannes Berg 已提交
2834
	}
2835

J
Johannes Berg 已提交
2836
	if (!ifmgd->associated ||
2837
	    !ether_addr_equal(mgmt->bssid, ifmgd->associated->bssid))
2838
		return;
J
Johannes Berg 已提交
2839
	bssid = ifmgd->associated->bssid;
2840

2841 2842 2843 2844
	/* 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;
2845
		ifmgd->ave_beacon_signal = rx_status->signal * 16;
2846
		ifmgd->last_cqm_event_signal = 0;
2847
		ifmgd->count_beacon_signal = 1;
2848
		ifmgd->last_ave_beacon_signal = 0;
2849 2850 2851 2852 2853
	} else {
		ifmgd->ave_beacon_signal =
			(IEEE80211_SIGNAL_AVE_WEIGHT * rx_status->signal * 16 +
			 (16 - IEEE80211_SIGNAL_AVE_WEIGHT) *
			 ifmgd->ave_beacon_signal) / 16;
2854
		ifmgd->count_beacon_signal++;
2855
	}
2856 2857 2858 2859 2860 2861 2862 2863 2864 2865 2866 2867 2868

	if (ifmgd->rssi_min_thold != ifmgd->rssi_max_thold &&
	    ifmgd->count_beacon_signal >= IEEE80211_SIGNAL_AVE_MIN_COUNT) {
		int sig = ifmgd->ave_beacon_signal;
		int last_sig = ifmgd->last_ave_beacon_signal;

		/*
		 * if signal crosses either of the boundaries, invoke callback
		 * with appropriate parameters
		 */
		if (sig > ifmgd->rssi_max_thold &&
		    (last_sig <= ifmgd->rssi_min_thold || last_sig == 0)) {
			ifmgd->last_ave_beacon_signal = sig;
2869
			drv_rssi_callback(local, sdata, RSSI_EVENT_HIGH);
2870 2871 2872 2873
		} else if (sig < ifmgd->rssi_min_thold &&
			   (last_sig >= ifmgd->rssi_max_thold ||
			   last_sig == 0)) {
			ifmgd->last_ave_beacon_signal = sig;
2874
			drv_rssi_callback(local, sdata, RSSI_EVENT_LOW);
2875 2876 2877
		}
	}

2878
	if (bss_conf->cqm_rssi_thold &&
2879
	    ifmgd->count_beacon_signal >= IEEE80211_SIGNAL_AVE_MIN_COUNT &&
2880
	    !(sdata->vif.driver_flags & IEEE80211_VIF_SUPPORTS_CQM_RSSI)) {
2881 2882 2883 2884 2885 2886 2887 2888 2889 2890 2891 2892 2893 2894 2895 2896 2897 2898 2899 2900 2901
		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);
		}
	}

2902
	if (ifmgd->flags & IEEE80211_STA_CONNECTION_POLL) {
J
Johannes Berg 已提交
2903
		mlme_dbg_ratelimited(sdata,
2904
				     "cancelling AP probe due to a received beacon\n");
2905
		ieee80211_reset_ap_probe(sdata);
2906 2907
	}

J
Johannes Berg 已提交
2908 2909 2910 2911
	/*
	 * Push the beacon loss detection into the future since
	 * we are processing a beacon from the AP just now.
	 */
2912
	ieee80211_sta_reset_beacon_monitor(sdata);
J
Johannes Berg 已提交
2913

2914 2915
	ncrc = crc32_be(0, (void *)&mgmt->u.beacon.beacon_int, 4);
	ncrc = ieee802_11_parse_elems_crc(mgmt->u.beacon.variable,
2916
					  len - baselen, false, &elems,
2917 2918
					  care_about_ies, ncrc);

2919
	if (local->hw.flags & IEEE80211_HW_PS_NULLFUNC_STACK) {
2920 2921 2922
		bool directed_tim = ieee80211_check_tim(elems.tim,
							elems.tim_len,
							ifmgd->aid);
2923
		if (directed_tim) {
2924
			if (local->hw.conf.dynamic_ps_timeout > 0) {
2925 2926 2927 2928 2929
				if (local->hw.conf.flags & IEEE80211_CONF_PS) {
					local->hw.conf.flags &= ~IEEE80211_CONF_PS;
					ieee80211_hw_config(local,
							    IEEE80211_CONF_CHANGE_PS);
				}
2930
				ieee80211_send_nullfunc(local, sdata, 0);
2931
			} else if (!local->pspolling && sdata->u.mgd.powersave) {
2932 2933 2934 2935 2936 2937 2938 2939 2940 2941 2942 2943
				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);
			}
2944 2945
		}
	}
J
Johannes Berg 已提交
2946

2947
	if (sdata->vif.p2p) {
J
Janusz Dziedzic 已提交
2948
		struct ieee80211_p2p_noa_attr noa = {};
2949 2950 2951 2952 2953
		int ret;

		ret = cfg80211_get_p2p_attr(mgmt->u.beacon.variable,
					    len - baselen,
					    IEEE80211_P2P_ATTR_ABSENCE_NOTICE,
2954
					    (u8 *) &noa, sizeof(noa));
J
Janusz Dziedzic 已提交
2955 2956 2957 2958 2959 2960 2961 2962 2963 2964 2965 2966 2967 2968 2969 2970
		if (ret >= 2) {
			if (sdata->u.mgd.p2p_noa_index != noa.index) {
				/* valid noa_attr and index changed */
				sdata->u.mgd.p2p_noa_index = noa.index;
				memcpy(&bss_conf->p2p_noa_attr, &noa, sizeof(noa));
				changed |= BSS_CHANGED_P2P_PS;
				/*
				 * make sure we update all information, the CRC
				 * mechanism doesn't look at P2P attributes.
				 */
				ifmgd->beacon_crc_valid = false;
			}
		} else if (sdata->u.mgd.p2p_noa_index != -1) {
			/* noa_attr not found and we had valid noa_attr before */
			sdata->u.mgd.p2p_noa_index = -1;
			memset(&bss_conf->p2p_noa_attr, 0, sizeof(bss_conf->p2p_noa_attr));
2971 2972 2973 2974 2975
			changed |= BSS_CHANGED_P2P_PS;
			ifmgd->beacon_crc_valid = false;
		}
	}

2976
	if (ncrc == ifmgd->beacon_crc && ifmgd->beacon_crc_valid)
2977
		return;
2978
	ifmgd->beacon_crc = ncrc;
2979
	ifmgd->beacon_crc_valid = true;
2980

2981
	ieee80211_rx_bss_info(sdata, mgmt, len, rx_status, &elems);
2982

2983 2984 2985
	ieee80211_sta_process_chanswitch(sdata, rx_status->mactime,
					 &elems, true);

2986 2987
	if (!(ifmgd->flags & IEEE80211_STA_DISABLE_WMM) &&
	    ieee80211_sta_wmm_params(local, sdata, elems.wmm_param,
2988 2989 2990
				     elems.wmm_param_len))
		changed |= BSS_CHANGED_QOS;

2991 2992
	/*
	 * If we haven't had a beacon before, tell the driver about the
2993
	 * DTIM period (and beacon timing if desired) now.
2994
	 */
2995
	if (!ifmgd->have_beacon) {
2996 2997 2998 2999 3000
		/* a few bogus AP send dtim_period = 0 or no TIM IE */
		if (elems.tim)
			bss_conf->dtim_period = elems.tim->dtim_period ?: 1;
		else
			bss_conf->dtim_period = 1;
3001 3002 3003 3004 3005 3006 3007 3008 3009 3010 3011 3012 3013

		if (local->hw.flags & IEEE80211_HW_TIMING_BEACON_ONLY) {
			sdata->vif.bss_conf.sync_tsf =
				le64_to_cpu(mgmt->u.beacon.timestamp);
			sdata->vif.bss_conf.sync_device_ts =
				rx_status->device_timestamp;
			if (elems.tim)
				sdata->vif.bss_conf.sync_dtim_count =
					elems.tim->dtim_count;
			else
				sdata->vif.bss_conf.sync_dtim_count = 0;
		}

3014 3015
		changed |= BSS_CHANGED_BEACON_INFO;
		ifmgd->have_beacon = true;
3016 3017 3018 3019 3020

		mutex_lock(&local->iflist_mtx);
		ieee80211_recalc_ps(local, -1);
		mutex_unlock(&local->iflist_mtx);

3021
		ieee80211_recalc_ps_vif(sdata);
3022 3023
	}

3024
	if (elems.erp_info) {
J
Johannes Berg 已提交
3025 3026 3027 3028
		erp_valid = true;
		erp_value = elems.erp_info[0];
	} else {
		erp_valid = false;
3029
	}
J
Johannes Berg 已提交
3030 3031 3032
	changed |= ieee80211_handle_bss_capability(sdata,
			le16_to_cpu(mgmt->u.beacon.capab_info),
			erp_valid, erp_value);
3033

3034
	mutex_lock(&local->sta_mtx);
3035 3036
	sta = sta_info_get(sdata, bssid);

3037 3038 3039 3040 3041 3042
	if (ieee80211_config_bw(sdata, sta, elems.ht_operation,
				elems.vht_operation, bssid, &changed)) {
		mutex_unlock(&local->sta_mtx);
		ieee80211_set_disassoc(sdata, IEEE80211_STYPE_DEAUTH,
				       WLAN_REASON_DEAUTH_LEAVING,
				       true, deauth_buf);
3043 3044
		cfg80211_tx_mlme_mgmt(sdata->dev, deauth_buf,
				      sizeof(deauth_buf));
3045
		return;
3046
	}
3047 3048 3049 3050

	if (sta && elems.opmode_notif)
		ieee80211_vht_handle_opmode(sdata, sta, *elems.opmode_notif,
					    rx_status->band, true);
3051
	mutex_unlock(&local->sta_mtx);
3052

3053 3054 3055
	if (elems.country_elem && elems.pwr_constr_elem &&
	    mgmt->u.probe_resp.capab_info &
				cpu_to_le16(WLAN_CAPABILITY_SPECTRUM_MGMT))
3056 3057 3058 3059
		changed |= ieee80211_handle_pwr_constr(sdata, chan,
						       elems.country_elem,
						       elems.country_elem_len,
						       elems.pwr_constr_elem);
3060

3061
	ieee80211_bss_info_change_notify(sdata, changed);
3062 3063
}

3064 3065
void ieee80211_sta_rx_queued_mgmt(struct ieee80211_sub_if_data *sdata,
				  struct sk_buff *skb)
3066 3067 3068 3069
{
	struct ieee80211_rx_status *rx_status;
	struct ieee80211_mgmt *mgmt;
	u16 fc;
3070 3071
	struct ieee802_11_elems elems;
	int ies_len;
3072 3073 3074 3075 3076

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

3077
	sdata_lock(sdata);
3078

J
Johannes Berg 已提交
3079 3080
	switch (fc & IEEE80211_FCTL_STYPE) {
	case IEEE80211_STYPE_BEACON:
3081
		ieee80211_rx_mgmt_beacon(sdata, mgmt, skb->len, rx_status);
J
Johannes Berg 已提交
3082 3083 3084 3085 3086
		break;
	case IEEE80211_STYPE_PROBE_RESP:
		ieee80211_rx_mgmt_probe_resp(sdata, skb);
		break;
	case IEEE80211_STYPE_AUTH:
3087
		ieee80211_rx_mgmt_auth(sdata, mgmt, skb->len);
J
Johannes Berg 已提交
3088 3089
		break;
	case IEEE80211_STYPE_DEAUTH:
3090
		ieee80211_rx_mgmt_deauth(sdata, mgmt, skb->len);
J
Johannes Berg 已提交
3091 3092
		break;
	case IEEE80211_STYPE_DISASSOC:
3093
		ieee80211_rx_mgmt_disassoc(sdata, mgmt, skb->len);
J
Johannes Berg 已提交
3094 3095 3096
		break;
	case IEEE80211_STYPE_ASSOC_RESP:
	case IEEE80211_STYPE_REASSOC_RESP:
3097
		ieee80211_rx_mgmt_assoc_resp(sdata, mgmt, skb->len);
J
Johannes Berg 已提交
3098 3099
		break;
	case IEEE80211_STYPE_ACTION:
3100
		if (mgmt->u.action.category == WLAN_CATEGORY_SPECTRUM_MGMT) {
3101 3102 3103
			ies_len = skb->len -
				  offsetof(struct ieee80211_mgmt,
					   u.action.u.chan_switch.variable);
3104 3105 3106 3107 3108 3109

			if (ies_len < 0)
				break;

			ieee802_11_parse_elems(
				mgmt->u.action.u.chan_switch.variable,
3110
				ies_len, true, &elems);
3111 3112 3113 3114

			if (elems.parse_error)
				break;

3115 3116
			ieee80211_sta_process_chanswitch(sdata,
							 rx_status->mactime,
3117
							 &elems, false);
3118 3119 3120 3121 3122 3123 3124 3125 3126 3127
		} else if (mgmt->u.action.category == WLAN_CATEGORY_PUBLIC) {
			ies_len = skb->len -
				  offsetof(struct ieee80211_mgmt,
					   u.action.u.ext_chan_switch.variable);

			if (ies_len < 0)
				break;

			ieee802_11_parse_elems(
				mgmt->u.action.u.ext_chan_switch.variable,
3128
				ies_len, true, &elems);
3129 3130 3131 3132 3133 3134 3135 3136

			if (elems.parse_error)
				break;

			/* for the handling code pretend this was also an IE */
			elems.ext_chansw_ie =
				&mgmt->u.action.u.ext_chan_switch.data;

J
Johannes Berg 已提交
3137
			ieee80211_sta_process_chanswitch(sdata,
3138
							 rx_status->mactime,
3139
							 &elems, false);
3140
		}
3141
		break;
3142
	}
3143
	sdata_unlock(sdata);
3144 3145
}

J
Johannes Berg 已提交
3146
static void ieee80211_sta_timer(unsigned long data)
3147
{
J
Johannes Berg 已提交
3148 3149
	struct ieee80211_sub_if_data *sdata =
		(struct ieee80211_sub_if_data *) data;
3150

3151
	ieee80211_queue_work(&sdata->local->hw, &sdata->work);
3152 3153
}

3154
static void ieee80211_sta_connection_lost(struct ieee80211_sub_if_data *sdata,
3155
					  u8 *bssid, u8 reason, bool tx)
3156
{
3157
	u8 frame_buf[IEEE80211_DEAUTH_FRAME_LEN];
3158

3159
	ieee80211_set_disassoc(sdata, IEEE80211_STYPE_DEAUTH, reason,
3160
			       tx, frame_buf);
3161

3162 3163
	cfg80211_tx_mlme_mgmt(sdata->dev, frame_buf,
			      IEEE80211_DEAUTH_FRAME_LEN);
3164 3165
}

J
Johannes Berg 已提交
3166 3167 3168 3169 3170
static int ieee80211_probe_auth(struct ieee80211_sub_if_data *sdata)
{
	struct ieee80211_local *local = sdata->local;
	struct ieee80211_if_managed *ifmgd = &sdata->u.mgd;
	struct ieee80211_mgd_auth_data *auth_data = ifmgd->auth_data;
3171
	u32 tx_flags = 0;
J
Johannes Berg 已提交
3172

3173
	sdata_assert_lock(sdata);
J
Johannes Berg 已提交
3174 3175 3176 3177 3178 3179 3180

	if (WARN_ON_ONCE(!auth_data))
		return -EINVAL;

	auth_data->tries++;

	if (auth_data->tries > IEEE80211_AUTH_MAX_TRIES) {
J
Johannes Berg 已提交
3181 3182
		sdata_info(sdata, "authentication with %pM timed out\n",
			   auth_data->bss->bssid);
J
Johannes Berg 已提交
3183 3184 3185 3186 3187 3188 3189 3190 3191 3192

		/*
		 * Most likely AP is not in the range so remove the
		 * bss struct for that AP.
		 */
		cfg80211_unlink_bss(local->hw.wiphy, auth_data->bss);

		return -ETIMEDOUT;
	}

J
Johannes Berg 已提交
3193 3194
	drv_mgd_prepare_tx(local, sdata);

J
Johannes Berg 已提交
3195
	if (auth_data->bss->proberesp_ies) {
3196 3197 3198
		u16 trans = 1;
		u16 status = 0;

J
Johannes Berg 已提交
3199 3200 3201
		sdata_info(sdata, "send auth to %pM (try %d/%d)\n",
			   auth_data->bss->bssid, auth_data->tries,
			   IEEE80211_AUTH_MAX_TRIES);
J
Johannes Berg 已提交
3202 3203

		auth_data->expected_transaction = 2;
3204 3205 3206 3207 3208 3209 3210

		if (auth_data->algorithm == WLAN_AUTH_SAE) {
			trans = auth_data->sae_trans;
			status = auth_data->sae_status;
			auth_data->expected_transaction = trans;
		}

3211 3212 3213 3214
		if (local->hw.flags & IEEE80211_HW_REPORTS_TX_ACK_STATUS)
			tx_flags = IEEE80211_TX_CTL_REQ_TX_STATUS |
				   IEEE80211_TX_INTFL_MLME_CONN_TX;

3215 3216
		ieee80211_send_auth(sdata, trans, auth_data->algorithm, status,
				    auth_data->data, auth_data->data_len,
J
Johannes Berg 已提交
3217
				    auth_data->bss->bssid,
3218 3219
				    auth_data->bss->bssid, NULL, 0, 0,
				    tx_flags);
J
Johannes Berg 已提交
3220 3221 3222
	} else {
		const u8 *ssidie;

J
Johannes Berg 已提交
3223 3224 3225
		sdata_info(sdata, "direct probe to %pM (try %d/%i)\n",
			   auth_data->bss->bssid, auth_data->tries,
			   IEEE80211_AUTH_MAX_TRIES);
J
Johannes Berg 已提交
3226

3227
		rcu_read_lock();
J
Johannes Berg 已提交
3228
		ssidie = ieee80211_bss_get_ie(auth_data->bss, WLAN_EID_SSID);
3229 3230
		if (!ssidie) {
			rcu_read_unlock();
J
Johannes Berg 已提交
3231
			return -EINVAL;
3232
		}
J
Johannes Berg 已提交
3233 3234 3235 3236 3237
		/*
		 * Direct probe is sent to broadcast address as some APs
		 * will not answer to direct packet in unassociated state.
		 */
		ieee80211_send_probe_req(sdata, NULL, ssidie + 2, ssidie[1],
3238
					 NULL, 0, (u32) -1, true, 0,
J
Johannes Berg 已提交
3239
					 auth_data->bss->channel, false);
3240
		rcu_read_unlock();
J
Johannes Berg 已提交
3241 3242
	}

3243
	if (tx_flags == 0) {
3244
		auth_data->timeout = jiffies + IEEE80211_AUTH_TIMEOUT;
3245
		auth_data->timeout_started = true;
3246
		run_again(sdata, auth_data->timeout);
3247
	} else {
3248 3249 3250 3251
		auth_data->timeout =
			round_jiffies_up(jiffies + IEEE80211_AUTH_TIMEOUT_LONG);
		auth_data->timeout_started = true;
		run_again(sdata, auth_data->timeout);
3252
	}
J
Johannes Berg 已提交
3253 3254 3255 3256 3257 3258 3259 3260 3261

	return 0;
}

static int ieee80211_do_assoc(struct ieee80211_sub_if_data *sdata)
{
	struct ieee80211_mgd_assoc_data *assoc_data = sdata->u.mgd.assoc_data;
	struct ieee80211_local *local = sdata->local;

3262
	sdata_assert_lock(sdata);
J
Johannes Berg 已提交
3263 3264 3265

	assoc_data->tries++;
	if (assoc_data->tries > IEEE80211_ASSOC_MAX_TRIES) {
J
Johannes Berg 已提交
3266 3267
		sdata_info(sdata, "association with %pM timed out\n",
			   assoc_data->bss->bssid);
J
Johannes Berg 已提交
3268 3269 3270 3271 3272 3273 3274 3275 3276 3277

		/*
		 * Most likely AP is not in the range so remove the
		 * bss struct for that AP.
		 */
		cfg80211_unlink_bss(local->hw.wiphy, assoc_data->bss);

		return -ETIMEDOUT;
	}

J
Johannes Berg 已提交
3278 3279 3280
	sdata_info(sdata, "associate with %pM (try %d/%d)\n",
		   assoc_data->bss->bssid, assoc_data->tries,
		   IEEE80211_ASSOC_MAX_TRIES);
J
Johannes Berg 已提交
3281 3282
	ieee80211_send_assoc(sdata);

3283 3284
	if (!(local->hw.flags & IEEE80211_HW_REPORTS_TX_ACK_STATUS)) {
		assoc_data->timeout = jiffies + IEEE80211_ASSOC_TIMEOUT;
3285
		assoc_data->timeout_started = true;
3286
		run_again(sdata, assoc_data->timeout);
3287
	} else {
3288 3289 3290 3291 3292
		assoc_data->timeout =
			round_jiffies_up(jiffies +
					 IEEE80211_ASSOC_TIMEOUT_LONG);
		assoc_data->timeout_started = true;
		run_again(sdata, assoc_data->timeout);
3293
	}
J
Johannes Berg 已提交
3294 3295 3296 3297

	return 0;
}

3298 3299 3300 3301 3302 3303 3304 3305 3306 3307 3308 3309
void ieee80211_mgd_conn_tx_status(struct ieee80211_sub_if_data *sdata,
				  __le16 fc, bool acked)
{
	struct ieee80211_local *local = sdata->local;

	sdata->u.mgd.status_fc = fc;
	sdata->u.mgd.status_acked = acked;
	sdata->u.mgd.status_received = true;

	ieee80211_queue_work(&local->hw, &sdata->work);
}

3310
void ieee80211_sta_work(struct ieee80211_sub_if_data *sdata)
J
Johannes Berg 已提交
3311 3312
{
	struct ieee80211_local *local = sdata->local;
3313
	struct ieee80211_if_managed *ifmgd = &sdata->u.mgd;
J
Johannes Berg 已提交
3314

3315
	sdata_lock(sdata);
3316

3317 3318 3319 3320 3321 3322 3323 3324 3325 3326
	if (ifmgd->status_received) {
		__le16 fc = ifmgd->status_fc;
		bool status_acked = ifmgd->status_acked;

		ifmgd->status_received = false;
		if (ifmgd->auth_data &&
		    (ieee80211_is_probe_req(fc) || ieee80211_is_auth(fc))) {
			if (status_acked) {
				ifmgd->auth_data->timeout =
					jiffies + IEEE80211_AUTH_TIMEOUT_SHORT;
3327
				run_again(sdata, ifmgd->auth_data->timeout);
3328 3329 3330
			} else {
				ifmgd->auth_data->timeout = jiffies - 1;
			}
3331
			ifmgd->auth_data->timeout_started = true;
3332 3333 3334 3335 3336 3337
		} else if (ifmgd->assoc_data &&
			   (ieee80211_is_assoc_req(fc) ||
			    ieee80211_is_reassoc_req(fc))) {
			if (status_acked) {
				ifmgd->assoc_data->timeout =
					jiffies + IEEE80211_ASSOC_TIMEOUT_SHORT;
3338
				run_again(sdata, ifmgd->assoc_data->timeout);
3339 3340 3341
			} else {
				ifmgd->assoc_data->timeout = jiffies - 1;
			}
3342
			ifmgd->assoc_data->timeout_started = true;
3343 3344 3345
		}
	}

3346
	if (ifmgd->auth_data && ifmgd->auth_data->timeout_started &&
J
Johannes Berg 已提交
3347 3348 3349 3350 3351 3352 3353 3354 3355 3356 3357 3358 3359 3360
	    time_after(jiffies, ifmgd->auth_data->timeout)) {
		if (ifmgd->auth_data->done) {
			/*
			 * ok ... we waited for assoc but userspace didn't,
			 * so let's just kill the auth data
			 */
			ieee80211_destroy_auth_data(sdata, false);
		} else if (ieee80211_probe_auth(sdata)) {
			u8 bssid[ETH_ALEN];

			memcpy(bssid, ifmgd->auth_data->bss->bssid, ETH_ALEN);

			ieee80211_destroy_auth_data(sdata, false);

3361
			cfg80211_auth_timeout(sdata->dev, bssid);
J
Johannes Berg 已提交
3362
		}
3363
	} else if (ifmgd->auth_data && ifmgd->auth_data->timeout_started)
3364
		run_again(sdata, ifmgd->auth_data->timeout);
J
Johannes Berg 已提交
3365

3366
	if (ifmgd->assoc_data && ifmgd->assoc_data->timeout_started &&
J
Johannes Berg 已提交
3367
	    time_after(jiffies, ifmgd->assoc_data->timeout)) {
3368
		if ((ifmgd->assoc_data->need_beacon && !ifmgd->have_beacon) ||
J
Johannes Berg 已提交
3369
		    ieee80211_do_assoc(sdata)) {
3370
			struct cfg80211_bss *bss = ifmgd->assoc_data->bss;
J
Johannes Berg 已提交
3371 3372

			ieee80211_destroy_assoc_data(sdata, false);
3373
			cfg80211_assoc_timeout(sdata->dev, bss);
J
Johannes Berg 已提交
3374
		}
3375
	} else if (ifmgd->assoc_data && ifmgd->assoc_data->timeout_started)
3376
		run_again(sdata, ifmgd->assoc_data->timeout);
J
Johannes Berg 已提交
3377

3378
	if (ifmgd->flags & IEEE80211_STA_CONNECTION_POLL &&
J
Johannes Berg 已提交
3379
	    ifmgd->associated) {
3380
		u8 bssid[ETH_ALEN];
3381
		int max_tries;
3382

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

3385
		if (local->hw.flags & IEEE80211_HW_REPORTS_TX_ACK_STATUS)
3386
			max_tries = max_nullfunc_tries;
3387
		else
3388
			max_tries = max_probe_tries;
3389

3390 3391 3392
		/* ACK received for nullfunc probing frame */
		if (!ifmgd->probe_send_count)
			ieee80211_reset_ap_probe(sdata);
3393 3394
		else if (ifmgd->nullfunc_failed) {
			if (ifmgd->probe_send_count < max_tries) {
J
Johannes Berg 已提交
3395 3396 3397 3398
				mlme_dbg(sdata,
					 "No ack for nullfunc frame to AP %pM, try %d/%i\n",
					 bssid, ifmgd->probe_send_count,
					 max_tries);
3399 3400
				ieee80211_mgd_probe_ap_send(sdata);
			} else {
J
Johannes Berg 已提交
3401 3402 3403
				mlme_dbg(sdata,
					 "No ack for nullfunc frame to AP %pM, disconnecting.\n",
					 bssid);
3404
				ieee80211_sta_connection_lost(sdata, bssid,
3405 3406
					WLAN_REASON_DISASSOC_DUE_TO_INACTIVITY,
					false);
3407 3408
			}
		} else if (time_is_after_jiffies(ifmgd->probe_timeout))
3409
			run_again(sdata, ifmgd->probe_timeout);
3410
		else if (local->hw.flags & IEEE80211_HW_REPORTS_TX_ACK_STATUS) {
J
Johannes Berg 已提交
3411 3412 3413
			mlme_dbg(sdata,
				 "Failed to send nullfunc to AP %pM after %dms, disconnecting\n",
				 bssid, probe_wait_ms);
3414
			ieee80211_sta_connection_lost(sdata, bssid,
3415
				WLAN_REASON_DISASSOC_DUE_TO_INACTIVITY, false);
3416
		} else if (ifmgd->probe_send_count < max_tries) {
J
Johannes Berg 已提交
3417 3418 3419 3420
			mlme_dbg(sdata,
				 "No probe response from AP %pM after %dms, try %d/%i\n",
				 bssid, probe_wait_ms,
				 ifmgd->probe_send_count, max_tries);
3421 3422
			ieee80211_mgd_probe_ap_send(sdata);
		} else {
J
Johannes Berg 已提交
3423 3424 3425 3426
			/*
			 * We actually lost the connection ... or did we?
			 * Let's make sure!
			 */
3427 3428 3429 3430
			wiphy_debug(local->hw.wiphy,
				    "%s: No probe response from AP %pM"
				    " after %dms, disconnecting.\n",
				    sdata->name,
3431
				    bssid, probe_wait_ms);
3432

3433
			ieee80211_sta_connection_lost(sdata, bssid,
3434
				WLAN_REASON_DISASSOC_DUE_TO_INACTIVITY, false);
J
Johannes Berg 已提交
3435 3436 3437
		}
	}

3438
	sdata_unlock(sdata);
3439 3440
}

J
Johannes Berg 已提交
3441 3442 3443 3444 3445 3446 3447 3448 3449
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;

3450
	sdata->u.mgd.connection_loss = false;
3451 3452
	ieee80211_queue_work(&sdata->local->hw,
			     &sdata->u.mgd.beacon_connection_loss_work);
J
Johannes Berg 已提交
3453 3454 3455 3456 3457 3458 3459 3460 3461 3462 3463 3464
}

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;

3465
	ieee80211_queue_work(&local->hw, &ifmgd->monitor_work);
J
Johannes Berg 已提交
3466 3467 3468 3469 3470 3471 3472 3473 3474 3475 3476
}

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 已提交
3477 3478
static void ieee80211_restart_sta_timer(struct ieee80211_sub_if_data *sdata)
{
3479 3480
	u32 flags;

3481
	if (sdata->vif.type == NL80211_IFTYPE_STATION) {
3482
		__ieee80211_stop_poll(sdata);
3483

J
Johannes Berg 已提交
3484
		/* let's probe the connection once */
3485 3486 3487 3488
		flags = sdata->local->hw.flags;
		if (!(flags & IEEE80211_HW_CONNECTION_MONITOR))
			ieee80211_queue_work(&sdata->local->hw,
					     &sdata->u.mgd.monitor_work);
J
Johannes Berg 已提交
3489
		/* and do all the other regular work too */
J
Johannes Berg 已提交
3490
		ieee80211_queue_work(&sdata->local->hw, &sdata->work);
3491
	}
J
Johannes Berg 已提交
3492
}
3493

3494 3495 3496 3497 3498
#ifdef CONFIG_PM
void ieee80211_sta_restart(struct ieee80211_sub_if_data *sdata)
{
	struct ieee80211_if_managed *ifmgd = &sdata->u.mgd;

3499
	sdata_lock(sdata);
3500
	if (!ifmgd->associated) {
3501
		sdata_unlock(sdata);
3502 3503 3504 3505 3506 3507 3508 3509 3510 3511
		return;
	}

	if (sdata->flags & IEEE80211_SDATA_DISCONNECT_RESUME) {
		sdata->flags &= ~IEEE80211_SDATA_DISCONNECT_RESUME;
		mlme_dbg(sdata, "driver requested disconnect after resume\n");
		ieee80211_sta_connection_lost(sdata,
					      ifmgd->associated->bssid,
					      WLAN_REASON_UNSPECIFIED,
					      true);
3512
		sdata_unlock(sdata);
3513 3514
		return;
	}
3515
	sdata_unlock(sdata);
3516 3517 3518
}
#endif

J
Johannes Berg 已提交
3519 3520
/* interface setup */
void ieee80211_sta_setup_sdata(struct ieee80211_sub_if_data *sdata)
3521
{
3522
	struct ieee80211_if_managed *ifmgd;
J
Johannes Berg 已提交
3523

3524
	ifmgd = &sdata->u.mgd;
J
Johannes Berg 已提交
3525
	INIT_WORK(&ifmgd->monitor_work, ieee80211_sta_monitor_work);
3526
	INIT_WORK(&ifmgd->chswitch_work, ieee80211_chswitch_work);
3527 3528
	INIT_WORK(&ifmgd->beacon_connection_loss_work,
		  ieee80211_beacon_connection_loss_work);
3529 3530
	INIT_WORK(&ifmgd->csa_connection_drop_work,
		  ieee80211_csa_connection_drop_work);
3531
	INIT_WORK(&ifmgd->request_smps_work, ieee80211_request_smps_mgd_work);
3532
	setup_timer(&ifmgd->timer, ieee80211_sta_timer,
S
Sujith 已提交
3533
		    (unsigned long) sdata);
J
Johannes Berg 已提交
3534 3535 3536 3537
	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);
3538
	setup_timer(&ifmgd->chswitch_timer, ieee80211_chswitch_timer,
J
Johannes Berg 已提交
3539 3540
		    (unsigned long) sdata);

3541
	ifmgd->flags = 0;
3542
	ifmgd->powersave = sdata->wdev.ps;
3543 3544
	ifmgd->uapsd_queues = sdata->local->hw.uapsd_queues;
	ifmgd->uapsd_max_sp_len = sdata->local->hw.uapsd_max_sp_len;
J
Janusz Dziedzic 已提交
3545
	ifmgd->p2p_noa_index = -1;
J
Johannes Berg 已提交
3546

3547 3548 3549 3550
	if (sdata->local->hw.flags & IEEE80211_HW_SUPPORTS_DYNAMIC_SMPS)
		ifmgd->req_smps = IEEE80211_SMPS_AUTOMATIC;
	else
		ifmgd->req_smps = IEEE80211_SMPS_OFF;
3551 3552
}

3553 3554
/* scan finished notification */
void ieee80211_mlme_notify_scan_completed(struct ieee80211_local *local)
J
Johannes Berg 已提交
3555
{
3556
	struct ieee80211_sub_if_data *sdata;
J
Johannes Berg 已提交
3557

3558 3559
	/* Restart STA timers */
	rcu_read_lock();
3560 3561 3562 3563
	list_for_each_entry_rcu(sdata, &local->interfaces, list) {
		if (ieee80211_sdata_running(sdata))
			ieee80211_restart_sta_timer(sdata);
	}
3564 3565
	rcu_read_unlock();
}
J
Johannes Berg 已提交
3566

3567 3568 3569 3570 3571 3572 3573
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);
3574

3575 3576 3577
	mutex_lock(&local->iflist_mtx);
	ieee80211_recalc_ps(local, latency_usec);
	mutex_unlock(&local->iflist_mtx);
3578

3579
	return 0;
J
Johannes Berg 已提交
3580 3581
}

J
Johannes Berg 已提交
3582 3583 3584 3585 3586 3587 3588 3589 3590 3591 3592 3593
static u8 ieee80211_ht_vht_rx_chains(struct ieee80211_sub_if_data *sdata,
				     struct cfg80211_bss *cbss)
{
	struct ieee80211_if_managed *ifmgd = &sdata->u.mgd;
	const u8 *ht_cap_ie, *vht_cap_ie;
	const struct ieee80211_ht_cap *ht_cap;
	const struct ieee80211_vht_cap *vht_cap;
	u8 chains = 1;

	if (ifmgd->flags & IEEE80211_STA_DISABLE_HT)
		return chains;

3594
	ht_cap_ie = ieee80211_bss_get_ie(cbss, WLAN_EID_HT_CAPABILITY);
J
Johannes Berg 已提交
3595 3596 3597 3598 3599 3600 3601 3602 3603 3604 3605 3606
	if (ht_cap_ie && ht_cap_ie[1] >= sizeof(*ht_cap)) {
		ht_cap = (void *)(ht_cap_ie + 2);
		chains = ieee80211_mcs_to_chains(&ht_cap->mcs);
		/*
		 * TODO: use "Tx Maximum Number Spatial Streams Supported" and
		 *	 "Tx Unequal Modulation Supported" fields.
		 */
	}

	if (ifmgd->flags & IEEE80211_STA_DISABLE_VHT)
		return chains;

3607
	vht_cap_ie = ieee80211_bss_get_ie(cbss, WLAN_EID_VHT_CAPABILITY);
J
Johannes Berg 已提交
3608 3609 3610 3611 3612 3613 3614 3615 3616 3617 3618 3619 3620 3621 3622 3623 3624 3625
	if (vht_cap_ie && vht_cap_ie[1] >= sizeof(*vht_cap)) {
		u8 nss;
		u16 tx_mcs_map;

		vht_cap = (void *)(vht_cap_ie + 2);
		tx_mcs_map = le16_to_cpu(vht_cap->supp_mcs.tx_mcs_map);
		for (nss = 8; nss > 0; nss--) {
			if (((tx_mcs_map >> (2 * (nss - 1))) & 3) !=
					IEEE80211_VHT_MCS_NOT_SUPPORTED)
				break;
		}
		/* TODO: use "Tx Highest Supported Long GI Data Rate" field? */
		chains = max(chains, nss);
	}

	return chains;
}

3626 3627
static int ieee80211_prep_channel(struct ieee80211_sub_if_data *sdata,
				  struct cfg80211_bss *cbss)
3628 3629 3630
{
	struct ieee80211_local *local = sdata->local;
	struct ieee80211_if_managed *ifmgd = &sdata->u.mgd;
3631
	const struct ieee80211_ht_operation *ht_oper = NULL;
J
Johannes Berg 已提交
3632
	const struct ieee80211_vht_operation *vht_oper = NULL;
3633
	struct ieee80211_supported_band *sband;
3634
	struct cfg80211_chan_def chandef;
J
Johannes Berg 已提交
3635
	int ret;
3636

3637 3638
	sband = local->hw.wiphy->bands[cbss->channel->band];

J
Johannes Berg 已提交
3639 3640 3641 3642
	ifmgd->flags &= ~(IEEE80211_STA_DISABLE_40MHZ |
			  IEEE80211_STA_DISABLE_80P80MHZ |
			  IEEE80211_STA_DISABLE_160MHZ);

3643 3644
	rcu_read_lock();

J
Johannes Berg 已提交
3645 3646
	if (!(ifmgd->flags & IEEE80211_STA_DISABLE_HT) &&
	    sband->ht_cap.ht_supported) {
3647
		const u8 *ht_oper_ie, *ht_cap;
3648

3649
		ht_oper_ie = ieee80211_bss_get_ie(cbss, WLAN_EID_HT_OPERATION);
3650 3651
		if (ht_oper_ie && ht_oper_ie[1] >= sizeof(*ht_oper))
			ht_oper = (void *)(ht_oper_ie + 2);
3652 3653 3654 3655 3656 3657

		ht_cap = ieee80211_bss_get_ie(cbss, WLAN_EID_HT_CAPABILITY);
		if (!ht_cap || ht_cap[1] < sizeof(struct ieee80211_ht_cap)) {
			ifmgd->flags |= IEEE80211_STA_DISABLE_HT;
			ht_oper = NULL;
		}
3658 3659
	}

J
Johannes Berg 已提交
3660 3661
	if (!(ifmgd->flags & IEEE80211_STA_DISABLE_VHT) &&
	    sband->vht_cap.vht_supported) {
3662
		const u8 *vht_oper_ie, *vht_cap;
J
Johannes Berg 已提交
3663

3664 3665
		vht_oper_ie = ieee80211_bss_get_ie(cbss,
						   WLAN_EID_VHT_OPERATION);
J
Johannes Berg 已提交
3666 3667 3668 3669
		if (vht_oper_ie && vht_oper_ie[1] >= sizeof(*vht_oper))
			vht_oper = (void *)(vht_oper_ie + 2);
		if (vht_oper && !ht_oper) {
			vht_oper = NULL;
J
Johannes Berg 已提交
3670
			sdata_info(sdata,
J
Johannes Berg 已提交
3671
				   "AP advertised VHT without HT, disabling both\n");
3672 3673
			ifmgd->flags |= IEEE80211_STA_DISABLE_HT;
			ifmgd->flags |= IEEE80211_STA_DISABLE_VHT;
3674
		}
3675 3676 3677 3678 3679 3680

		vht_cap = ieee80211_bss_get_ie(cbss, WLAN_EID_VHT_CAPABILITY);
		if (!vht_cap || vht_cap[1] < sizeof(struct ieee80211_vht_cap)) {
			ifmgd->flags |= IEEE80211_STA_DISABLE_VHT;
			vht_oper = NULL;
		}
3681 3682
	}

J
Johannes Berg 已提交
3683 3684 3685
	ifmgd->flags |= ieee80211_determine_chantype(sdata, sband,
						     cbss->channel,
						     ht_oper, vht_oper,
3686
						     &chandef, false);
3687

J
Johannes Berg 已提交
3688 3689
	sdata->needed_rx_chains = min(ieee80211_ht_vht_rx_chains(sdata, cbss),
				      local->rx_chains);
3690

3691 3692
	rcu_read_unlock();

3693 3694 3695
	/* will change later if needed */
	sdata->smps_mode = IEEE80211_SMPS_OFF;

3696
	mutex_lock(&local->mtx);
J
Johannes Berg 已提交
3697 3698 3699 3700 3701 3702 3703
	/*
	 * If this fails (possibly due to channel context sharing
	 * on incompatible channels, e.g. 80+80 and 160 sharing the
	 * same control channel) try to use a smaller bandwidth.
	 */
	ret = ieee80211_vif_use_channel(sdata, &chandef,
					IEEE80211_CHANCTX_SHARED);
3704 3705 3706 3707

	/* don't downgrade for 5 and 10 MHz channels, though. */
	if (chandef.width == NL80211_CHAN_WIDTH_5 ||
	    chandef.width == NL80211_CHAN_WIDTH_10)
3708
		goto out;
3709

3710
	while (ret && chandef.width != NL80211_CHAN_WIDTH_20_NOHT) {
3711
		ifmgd->flags |= ieee80211_chandef_downgrade(&chandef);
3712 3713 3714
		ret = ieee80211_vif_use_channel(sdata, &chandef,
						IEEE80211_CHANCTX_SHARED);
	}
3715 3716
 out:
	mutex_unlock(&local->mtx);
J
Johannes Berg 已提交
3717
	return ret;
3718 3719 3720 3721 3722 3723 3724 3725 3726 3727 3728 3729 3730 3731 3732 3733 3734 3735 3736 3737 3738 3739 3740 3741 3742 3743
}

static int ieee80211_prep_connection(struct ieee80211_sub_if_data *sdata,
				     struct cfg80211_bss *cbss, bool assoc)
{
	struct ieee80211_local *local = sdata->local;
	struct ieee80211_if_managed *ifmgd = &sdata->u.mgd;
	struct ieee80211_bss *bss = (void *)cbss->priv;
	struct sta_info *new_sta = NULL;
	bool have_sta = false;
	int err;

	if (WARN_ON(!ifmgd->auth_data && !ifmgd->assoc_data))
		return -EINVAL;

	if (assoc) {
		rcu_read_lock();
		have_sta = sta_info_get(sdata, cbss->bssid);
		rcu_read_unlock();
	}

	if (!have_sta) {
		new_sta = sta_info_alloc(sdata, cbss->bssid, GFP_KERNEL);
		if (!new_sta)
			return -ENOMEM;
	}
J
Johannes Berg 已提交
3744
	if (new_sta) {
3745 3746 3747
		u32 rates = 0, basic_rates = 0;
		bool have_higher_than_11mbit;
		int min_rate = INT_MAX, min_rate_index = -1;
3748
		struct ieee80211_chanctx_conf *chanctx_conf;
3749
		struct ieee80211_supported_band *sband;
J
Johannes Berg 已提交
3750
		const struct cfg80211_bss_ies *ies;
3751 3752
		int shift;
		u32 rate_flags;
3753 3754 3755 3756 3757 3758

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

		err = ieee80211_prep_channel(sdata, cbss);
		if (err) {
			sta_info_free(local, new_sta);
3759
			return -EINVAL;
3760
		}
3761 3762 3763 3764 3765 3766 3767 3768 3769 3770
		shift = ieee80211_vif_get_shift(&sdata->vif);

		rcu_read_lock();
		chanctx_conf = rcu_dereference(sdata->vif.chanctx_conf);
		if (WARN_ON(!chanctx_conf)) {
			rcu_read_unlock();
			return -EINVAL;
		}
		rate_flags = ieee80211_chandef_rate_flags(&chanctx_conf->def);
		rcu_read_unlock();
3771 3772 3773 3774 3775

		ieee80211_get_rates(sband, bss->supp_rates,
				    bss->supp_rates_len,
				    &rates, &basic_rates,
				    &have_higher_than_11mbit,
3776 3777
				    &min_rate, &min_rate_index,
				    shift, rate_flags);
3778 3779 3780 3781 3782 3783 3784 3785 3786 3787

		/*
		 * This used to be a workaround for basic rates missing
		 * in the association response frame. Now that we no
		 * longer use the basic rates from there, it probably
		 * doesn't happen any more, but keep the workaround so
		 * in case some *other* APs are buggy in different ways
		 * we can connect -- with a warning.
		 */
		if (!basic_rates && min_rate_index >= 0) {
J
Johannes Berg 已提交
3788 3789
			sdata_info(sdata,
				   "No basic rates, using min rate instead\n");
3790 3791 3792
			basic_rates = BIT(min_rate_index);
		}

J
Johannes Berg 已提交
3793
		new_sta->sta.supp_rates[cbss->channel->band] = rates;
3794 3795 3796
		sdata->vif.bss_conf.basic_rates = basic_rates;

		/* cf. IEEE 802.11 9.2.12 */
J
Johannes Berg 已提交
3797
		if (cbss->channel->band == IEEE80211_BAND_2GHZ &&
3798 3799 3800 3801 3802 3803 3804
		    have_higher_than_11mbit)
			sdata->flags |= IEEE80211_SDATA_OPERATING_GMODE;
		else
			sdata->flags &= ~IEEE80211_SDATA_OPERATING_GMODE;

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

3805 3806
		/* set timing information */
		sdata->vif.bss_conf.beacon_int = cbss->beacon_interval;
J
Johannes Berg 已提交
3807
		rcu_read_lock();
3808 3809 3810 3811 3812 3813 3814 3815 3816 3817 3818 3819 3820 3821 3822 3823 3824 3825 3826 3827 3828 3829 3830 3831 3832 3833
		ies = rcu_dereference(cbss->beacon_ies);
		if (ies) {
			const u8 *tim_ie;

			sdata->vif.bss_conf.sync_tsf = ies->tsf;
			sdata->vif.bss_conf.sync_device_ts =
				bss->device_ts_beacon;
			tim_ie = cfg80211_find_ie(WLAN_EID_TIM,
						  ies->data, ies->len);
			if (tim_ie && tim_ie[1] >= 2)
				sdata->vif.bss_conf.sync_dtim_count = tim_ie[2];
			else
				sdata->vif.bss_conf.sync_dtim_count = 0;
		} else if (!(local->hw.flags &
					IEEE80211_HW_TIMING_BEACON_ONLY)) {
			ies = rcu_dereference(cbss->proberesp_ies);
			/* must be non-NULL since beacon IEs were NULL */
			sdata->vif.bss_conf.sync_tsf = ies->tsf;
			sdata->vif.bss_conf.sync_device_ts =
				bss->device_ts_presp;
			sdata->vif.bss_conf.sync_dtim_count = 0;
		} else {
			sdata->vif.bss_conf.sync_tsf = 0;
			sdata->vif.bss_conf.sync_device_ts = 0;
			sdata->vif.bss_conf.sync_dtim_count = 0;
		}
J
Johannes Berg 已提交
3834
		rcu_read_unlock();
3835 3836

		/* tell driver about BSSID, basic rates and timing */
3837
		ieee80211_bss_info_change_notify(sdata,
3838 3839
			BSS_CHANGED_BSSID | BSS_CHANGED_BASIC_RATES |
			BSS_CHANGED_BEACON_INT);
3840 3841

		if (assoc)
J
Johannes Berg 已提交
3842
			sta_info_pre_move_state(new_sta, IEEE80211_STA_AUTH);
3843

J
Johannes Berg 已提交
3844 3845
		err = sta_info_insert(new_sta);
		new_sta = NULL;
3846
		if (err) {
J
Johannes Berg 已提交
3847 3848 3849
			sdata_info(sdata,
				   "failed to insert STA entry for the AP (error %d)\n",
				   err);
3850 3851 3852
			return err;
		}
	} else
3853
		WARN_ON_ONCE(!ether_addr_equal(ifmgd->bssid, cbss->bssid));
3854 3855 3856 3857

	return 0;
}

3858 3859 3860
/* config hooks */
int ieee80211_mgd_auth(struct ieee80211_sub_if_data *sdata,
		       struct cfg80211_auth_request *req)
J
Johannes Berg 已提交
3861
{
J
Johannes Berg 已提交
3862 3863 3864
	struct ieee80211_local *local = sdata->local;
	struct ieee80211_if_managed *ifmgd = &sdata->u.mgd;
	struct ieee80211_mgd_auth_data *auth_data;
3865
	u16 auth_alg;
J
Johannes Berg 已提交
3866 3867 3868
	int err;

	/* prepare auth data structure */
J
Johannes Berg 已提交
3869

3870 3871 3872 3873 3874
	switch (req->auth_type) {
	case NL80211_AUTHTYPE_OPEN_SYSTEM:
		auth_alg = WLAN_AUTH_OPEN;
		break;
	case NL80211_AUTHTYPE_SHARED_KEY:
J
Johannes Berg 已提交
3875
		if (IS_ERR(local->wep_tx_tfm))
3876
			return -EOPNOTSUPP;
3877 3878 3879 3880 3881 3882 3883 3884
		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;
3885 3886 3887
	case NL80211_AUTHTYPE_SAE:
		auth_alg = WLAN_AUTH_SAE;
		break;
3888 3889
	default:
		return -EOPNOTSUPP;
J
Johannes Berg 已提交
3890
	}
3891

3892 3893
	auth_data = kzalloc(sizeof(*auth_data) + req->sae_data_len +
			    req->ie_len, GFP_KERNEL);
J
Johannes Berg 已提交
3894
	if (!auth_data)
J
Johannes Berg 已提交
3895
		return -ENOMEM;
3896

J
Johannes Berg 已提交
3897
	auth_data->bss = req->bss;
3898

3899 3900 3901 3902 3903 3904 3905 3906 3907
	if (req->sae_data_len >= 4) {
		__le16 *pos = (__le16 *) req->sae_data;
		auth_data->sae_trans = le16_to_cpu(pos[0]);
		auth_data->sae_status = le16_to_cpu(pos[1]);
		memcpy(auth_data->data, req->sae_data + 4,
		       req->sae_data_len - 4);
		auth_data->data_len += req->sae_data_len - 4;
	}

3908
	if (req->ie && req->ie_len) {
3909 3910 3911
		memcpy(&auth_data->data[auth_data->data_len],
		       req->ie, req->ie_len);
		auth_data->data_len += req->ie_len;
J
Johannes Berg 已提交
3912
	}
3913

J
Johannes Berg 已提交
3914
	if (req->key && req->key_len) {
J
Johannes Berg 已提交
3915 3916 3917
		auth_data->key_len = req->key_len;
		auth_data->key_idx = req->key_idx;
		memcpy(auth_data->key, req->key, req->key_len);
J
Johannes Berg 已提交
3918 3919
	}

J
Johannes Berg 已提交
3920
	auth_data->algorithm = auth_alg;
J
Johannes Berg 已提交
3921

J
Johannes Berg 已提交
3922
	/* try to authenticate/probe */
3923

J
Johannes Berg 已提交
3924 3925 3926 3927
	if ((ifmgd->auth_data && !ifmgd->auth_data->done) ||
	    ifmgd->assoc_data) {
		err = -EBUSY;
		goto err_free;
3928 3929
	}

J
Johannes Berg 已提交
3930 3931
	if (ifmgd->auth_data)
		ieee80211_destroy_auth_data(sdata, false);
3932

J
Johannes Berg 已提交
3933 3934
	/* prep auth_data so we don't go into idle on disassoc */
	ifmgd->auth_data = auth_data;
J
Johannes Berg 已提交
3935

3936 3937 3938 3939 3940 3941 3942
	if (ifmgd->associated) {
		u8 frame_buf[IEEE80211_DEAUTH_FRAME_LEN];

		ieee80211_set_disassoc(sdata, IEEE80211_STYPE_DEAUTH,
				       WLAN_REASON_UNSPECIFIED,
				       false, frame_buf);

3943 3944
		cfg80211_tx_mlme_mgmt(sdata->dev, frame_buf,
				      sizeof(frame_buf));
3945
	}
J
Johannes Berg 已提交
3946

J
Johannes Berg 已提交
3947
	sdata_info(sdata, "authenticate with %pM\n", req->bss->bssid);
3948

3949 3950
	err = ieee80211_prep_connection(sdata, req->bss, false);
	if (err)
J
Johannes Berg 已提交
3951
		goto err_clear;
J
Johannes Berg 已提交
3952

J
Johannes Berg 已提交
3953 3954 3955 3956 3957 3958 3959
	err = ieee80211_probe_auth(sdata);
	if (err) {
		sta_info_destroy_addr(sdata, req->bss->bssid);
		goto err_clear;
	}

	/* hold our own reference */
3960
	cfg80211_ref_bss(local->hw.wiphy, auth_data->bss);
3961
	return 0;
J
Johannes Berg 已提交
3962 3963

 err_clear:
3964 3965
	memset(ifmgd->bssid, 0, ETH_ALEN);
	ieee80211_bss_info_change_notify(sdata, BSS_CHANGED_BSSID);
J
Johannes Berg 已提交
3966 3967 3968 3969
	ifmgd->auth_data = NULL;
 err_free:
	kfree(auth_data);
	return err;
J
Johannes Berg 已提交
3970 3971
}

3972 3973 3974 3975 3976 3977 3978 3979 3980 3981 3982 3983 3984 3985 3986 3987 3988 3989 3990 3991 3992 3993 3994 3995 3996 3997 3998 3999 4000 4001 4002 4003 4004 4005 4006 4007 4008 4009
static bool ieee80211_usable_wmm_params(struct ieee80211_sub_if_data *sdata,
					const u8 *wmm_param, int len)
{
	const u8 *pos;
	size_t left;

	if (len < 8)
		return false;

	if (wmm_param[5] != 1 /* version */)
		return false;

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

	for (; left >= 4; left -= 4, pos += 4) {
		u8 aifsn = pos[0] & 0x0f;
		u8 ecwmin = pos[1] & 0x0f;
		u8 ecwmax = (pos[1] & 0xf0) >> 4;
		int aci = (pos[0] >> 5) & 0x03;

		if (aifsn < 2) {
			sdata_info(sdata,
				   "AP has invalid WMM params (AIFSN=%d for ACI %d), disabling WMM\n",
				   aifsn, aci);
			return false;
		}
		if (ecwmin > ecwmax) {
			sdata_info(sdata,
				   "AP has invalid WMM params (ECWmin/max=%d/%d for ACI %d), disabling WMM\n",
				   ecwmin, ecwmax, aci);
			return false;
		}
	}

	return true;
}

4010 4011
int ieee80211_mgd_assoc(struct ieee80211_sub_if_data *sdata,
			struct cfg80211_assoc_request *req)
4012
{
J
Johannes Berg 已提交
4013
	struct ieee80211_local *local = sdata->local;
4014
	struct ieee80211_if_managed *ifmgd = &sdata->u.mgd;
4015
	struct ieee80211_bss *bss = (void *)req->bss->priv;
J
Johannes Berg 已提交
4016
	struct ieee80211_mgd_assoc_data *assoc_data;
4017
	const struct cfg80211_bss_ies *beacon_ies;
J
Johannes Berg 已提交
4018
	struct ieee80211_supported_band *sband;
4019
	const u8 *ssidie, *ht_ie, *vht_ie;
4020
	int i, err;
4021

J
Johannes Berg 已提交
4022 4023 4024 4025
	assoc_data = kzalloc(sizeof(*assoc_data) + req->ie_len, GFP_KERNEL);
	if (!assoc_data)
		return -ENOMEM;

4026 4027 4028 4029 4030 4031 4032 4033 4034 4035 4036
	rcu_read_lock();
	ssidie = ieee80211_bss_get_ie(req->bss, WLAN_EID_SSID);
	if (!ssidie) {
		rcu_read_unlock();
		kfree(assoc_data);
		return -EINVAL;
	}
	memcpy(assoc_data->ssid, ssidie + 2, ssidie[1]);
	assoc_data->ssid_len = ssidie[1];
	rcu_read_unlock();

4037 4038 4039 4040 4041 4042 4043
	if (ifmgd->associated) {
		u8 frame_buf[IEEE80211_DEAUTH_FRAME_LEN];

		ieee80211_set_disassoc(sdata, IEEE80211_STYPE_DEAUTH,
				       WLAN_REASON_UNSPECIFIED,
				       false, frame_buf);

4044 4045
		cfg80211_tx_mlme_mgmt(sdata->dev, frame_buf,
				      sizeof(frame_buf));
4046
	}
J
Johannes Berg 已提交
4047 4048 4049 4050

	if (ifmgd->auth_data && !ifmgd->auth_data->done) {
		err = -EBUSY;
		goto err_free;
J
Johannes Berg 已提交
4051
	}
4052

J
Johannes Berg 已提交
4053 4054 4055 4056
	if (ifmgd->assoc_data) {
		err = -EBUSY;
		goto err_free;
	}
4057

J
Johannes Berg 已提交
4058 4059 4060 4061
	if (ifmgd->auth_data) {
		bool match;

		/* keep sta info, bssid if matching */
4062
		match = ether_addr_equal(ifmgd->bssid, req->bss->bssid);
J
Johannes Berg 已提交
4063
		ieee80211_destroy_auth_data(sdata, match);
4064 4065
	}

J
Johannes Berg 已提交
4066
	/* prepare assoc data */
4067

4068 4069
	ifmgd->beacon_crc_valid = false;

4070 4071 4072 4073 4074 4075 4076 4077 4078 4079 4080 4081 4082 4083 4084 4085 4086 4087 4088 4089 4090 4091 4092 4093 4094 4095 4096 4097 4098 4099 4100 4101 4102 4103 4104 4105
	assoc_data->wmm = bss->wmm_used &&
			  (local->hw.queues >= IEEE80211_NUM_ACS);
	if (assoc_data->wmm) {
		/* try to check validity of WMM params IE */
		const struct cfg80211_bss_ies *ies;
		const u8 *wp, *start, *end;

		rcu_read_lock();
		ies = rcu_dereference(req->bss->ies);
		start = ies->data;
		end = start + ies->len;

		while (true) {
			wp = cfg80211_find_vendor_ie(
				WLAN_OUI_MICROSOFT,
				WLAN_OUI_TYPE_MICROSOFT_WMM,
				start, end - start);
			if (!wp)
				break;
			start = wp + wp[1] + 2;
			/* if this IE is too short, try the next */
			if (wp[1] <= 4)
				continue;
			/* if this IE is WMM params, we found what we wanted */
			if (wp[6] == 1)
				break;
		}

		if (!wp || !ieee80211_usable_wmm_params(sdata, wp + 2,
							wp[1] - 2)) {
			assoc_data->wmm = false;
			ifmgd->flags |= IEEE80211_STA_DISABLE_WMM;
		}
		rcu_read_unlock();
	}

J
Johannes Berg 已提交
4106 4107 4108 4109 4110 4111 4112
	/*
	 * 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.
	 */
4113
	for (i = 0; i < req->crypto.n_ciphers_pairwise; i++) {
4114 4115
		if (req->crypto.ciphers_pairwise[i] == WLAN_CIPHER_SUITE_WEP40 ||
		    req->crypto.ciphers_pairwise[i] == WLAN_CIPHER_SUITE_TKIP ||
4116
		    req->crypto.ciphers_pairwise[i] == WLAN_CIPHER_SUITE_WEP104) {
4117
			ifmgd->flags |= IEEE80211_STA_DISABLE_HT;
4118
			ifmgd->flags |= IEEE80211_STA_DISABLE_VHT;
4119
			netdev_info(sdata->dev,
4120
				    "disabling HT/VHT due to WEP/TKIP use\n");
4121 4122
		}
	}
4123

4124
	if (req->flags & ASSOC_REQ_DISABLE_HT) {
4125
		ifmgd->flags |= IEEE80211_STA_DISABLE_HT;
4126 4127
		ifmgd->flags |= IEEE80211_STA_DISABLE_VHT;
	}
B
Ben Greear 已提交
4128

4129 4130 4131
	if (req->flags & ASSOC_REQ_DISABLE_VHT)
		ifmgd->flags |= IEEE80211_STA_DISABLE_VHT;

J
Johannes Berg 已提交
4132 4133 4134
	/* Also disable HT if we don't support it or the AP doesn't use WMM */
	sband = local->hw.wiphy->bands[req->bss->channel->band];
	if (!sband->ht_cap.ht_supported ||
4135 4136
	    local->hw.queues < IEEE80211_NUM_ACS || !bss->wmm_used ||
	    ifmgd->flags & IEEE80211_STA_DISABLE_WMM) {
4137
		ifmgd->flags |= IEEE80211_STA_DISABLE_HT;
4138 4139
		if (!bss->wmm_used &&
		    !(ifmgd->flags & IEEE80211_STA_DISABLE_WMM))
4140 4141
			netdev_info(sdata->dev,
				    "disabling HT as WMM/QoS is not supported by the AP\n");
4142
	}
J
Johannes Berg 已提交
4143

4144 4145
	/* disable VHT if we don't support it or the AP doesn't use WMM */
	if (!sband->vht_cap.vht_supported ||
4146 4147
	    local->hw.queues < IEEE80211_NUM_ACS || !bss->wmm_used ||
	    ifmgd->flags & IEEE80211_STA_DISABLE_WMM) {
4148
		ifmgd->flags |= IEEE80211_STA_DISABLE_VHT;
4149 4150
		if (!bss->wmm_used &&
		    !(ifmgd->flags & IEEE80211_STA_DISABLE_WMM))
4151 4152
			netdev_info(sdata->dev,
				    "disabling VHT as WMM/QoS is not supported by the AP\n");
4153 4154
	}

B
Ben Greear 已提交
4155 4156 4157 4158
	memcpy(&ifmgd->ht_capa, &req->ht_capa, sizeof(ifmgd->ht_capa));
	memcpy(&ifmgd->ht_capa_mask, &req->ht_capa_mask,
	       sizeof(ifmgd->ht_capa_mask));

4159 4160 4161 4162
	memcpy(&ifmgd->vht_capa, &req->vht_capa, sizeof(ifmgd->vht_capa));
	memcpy(&ifmgd->vht_capa_mask, &req->vht_capa_mask,
	       sizeof(ifmgd->vht_capa_mask));

4163
	if (req->ie && req->ie_len) {
J
Johannes Berg 已提交
4164 4165 4166
		memcpy(assoc_data->ie, req->ie, req->ie_len);
		assoc_data->ie_len = req->ie_len;
	}
4167

J
Johannes Berg 已提交
4168
	assoc_data->bss = req->bss;
4169

J
Johannes Berg 已提交
4170 4171
	if (ifmgd->req_smps == IEEE80211_SMPS_AUTOMATIC) {
		if (ifmgd->powersave)
4172
			sdata->smps_mode = IEEE80211_SMPS_DYNAMIC;
J
Johannes Berg 已提交
4173
		else
4174
			sdata->smps_mode = IEEE80211_SMPS_OFF;
J
Johannes Berg 已提交
4175
	} else
4176
		sdata->smps_mode = ifmgd->req_smps;
J
Johannes Berg 已提交
4177

J
Johannes Berg 已提交
4178 4179 4180
	assoc_data->capability = req->bss->capability;
	assoc_data->supp_rates = bss->supp_rates;
	assoc_data->supp_rates_len = bss->supp_rates_len;
4181

4182
	rcu_read_lock();
4183 4184 4185 4186 4187
	ht_ie = ieee80211_bss_get_ie(req->bss, WLAN_EID_HT_OPERATION);
	if (ht_ie && ht_ie[1] >= sizeof(struct ieee80211_ht_operation))
		assoc_data->ap_ht_param =
			((struct ieee80211_ht_operation *)(ht_ie + 2))->ht_param;
	else
4188
		ifmgd->flags |= IEEE80211_STA_DISABLE_HT;
4189 4190 4191 4192 4193 4194
	vht_ie = ieee80211_bss_get_ie(req->bss, WLAN_EID_VHT_CAPABILITY);
	if (vht_ie && vht_ie[1] >= sizeof(struct ieee80211_vht_cap))
		memcpy(&assoc_data->ap_vht_cap, vht_ie + 2,
		       sizeof(struct ieee80211_vht_cap));
	else
		ifmgd->flags |= IEEE80211_STA_DISABLE_VHT;
4195
	rcu_read_unlock();
4196

K
Kalle Valo 已提交
4197
	if (bss->wmm_used && bss->uapsd_supported &&
4198 4199
	    (sdata->local->hw.flags & IEEE80211_HW_SUPPORTS_UAPSD) &&
	    sdata->wmm_acm != 0xff) {
4200
		assoc_data->uapsd = true;
K
Kalle Valo 已提交
4201 4202
		ifmgd->flags |= IEEE80211_STA_UAPSD_ENABLED;
	} else {
4203
		assoc_data->uapsd = false;
K
Kalle Valo 已提交
4204 4205 4206
		ifmgd->flags &= ~IEEE80211_STA_UAPSD_ENABLED;
	}

4207
	if (req->prev_bssid)
J
Johannes Berg 已提交
4208
		memcpy(assoc_data->prev_bssid, req->prev_bssid, ETH_ALEN);
4209 4210 4211 4212 4213 4214 4215 4216 4217 4218 4219 4220 4221 4222

	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;

4223 4224
	sdata->control_port_protocol = req->crypto.control_port_ethertype;
	sdata->control_port_no_encrypt = req->crypto.control_port_no_encrypt;
4225 4226
	sdata->encrypt_headroom = ieee80211_cs_headroom(local, &req->crypto,
							sdata->vif.type);
4227

J
Johannes Berg 已提交
4228 4229 4230
	/* kick off associate process */

	ifmgd->assoc_data = assoc_data;
4231
	ifmgd->dtim_period = 0;
4232
	ifmgd->have_beacon = false;
J
Johannes Berg 已提交
4233

4234 4235 4236
	err = ieee80211_prep_connection(sdata, req->bss, true);
	if (err)
		goto err_clear;
J
Johannes Berg 已提交
4237

4238 4239
	rcu_read_lock();
	beacon_ies = rcu_dereference(req->bss->beacon_ies);
4240

4241 4242 4243 4244 4245 4246 4247 4248 4249
	if (sdata->local->hw.flags & IEEE80211_HW_NEED_DTIM_BEFORE_ASSOC &&
	    !beacon_ies) {
		/*
		 * Wait up to one beacon interval ...
		 * should this be more if we miss one?
		 */
		sdata_info(sdata, "waiting for beacon from %pM\n",
			   ifmgd->bssid);
		assoc_data->timeout = TU_TO_EXP_TIME(req->bss->beacon_interval);
4250
		assoc_data->timeout_started = true;
4251 4252 4253 4254 4255
		assoc_data->need_beacon = true;
	} else if (beacon_ies) {
		const u8 *tim_ie = cfg80211_find_ie(WLAN_EID_TIM,
						    beacon_ies->data,
						    beacon_ies->len);
4256 4257
		u8 dtim_count = 0;

4258 4259 4260 4261
		if (tim_ie && tim_ie[1] >= sizeof(struct ieee80211_tim_ie)) {
			const struct ieee80211_tim_ie *tim;
			tim = (void *)(tim_ie + 2);
			ifmgd->dtim_period = tim->dtim_period;
4262
			dtim_count = tim->dtim_count;
4263
		}
4264
		ifmgd->have_beacon = true;
J
Johannes Berg 已提交
4265
		assoc_data->timeout = jiffies;
4266
		assoc_data->timeout_started = true;
4267 4268 4269 4270 4271 4272 4273

		if (local->hw.flags & IEEE80211_HW_TIMING_BEACON_ONLY) {
			sdata->vif.bss_conf.sync_tsf = beacon_ies->tsf;
			sdata->vif.bss_conf.sync_device_ts =
				bss->device_ts_beacon;
			sdata->vif.bss_conf.sync_dtim_count = dtim_count;
		}
4274 4275
	} else {
		assoc_data->timeout = jiffies;
4276
		assoc_data->timeout_started = true;
J
Johannes Berg 已提交
4277
	}
4278 4279
	rcu_read_unlock();

4280
	run_again(sdata, assoc_data->timeout);
J
Johannes Berg 已提交
4281

P
Paul Stewart 已提交
4282 4283 4284 4285 4286 4287 4288 4289 4290 4291
	if (bss->corrupt_data) {
		char *corrupt_type = "data";
		if (bss->corrupt_data & IEEE80211_BSS_CORRUPT_BEACON) {
			if (bss->corrupt_data &
					IEEE80211_BSS_CORRUPT_PROBE_RESP)
				corrupt_type = "beacon and probe response";
			else
				corrupt_type = "beacon";
		} else if (bss->corrupt_data & IEEE80211_BSS_CORRUPT_PROBE_RESP)
			corrupt_type = "probe response";
J
Johannes Berg 已提交
4292 4293
		sdata_info(sdata, "associating with AP with corrupt %s\n",
			   corrupt_type);
P
Paul Stewart 已提交
4294 4295
	}

4296
	return 0;
J
Johannes Berg 已提交
4297
 err_clear:
4298 4299
	memset(ifmgd->bssid, 0, ETH_ALEN);
	ieee80211_bss_info_change_notify(sdata, BSS_CHANGED_BSSID);
J
Johannes Berg 已提交
4300 4301 4302 4303
	ifmgd->assoc_data = NULL;
 err_free:
	kfree(assoc_data);
	return err;
4304 4305
}

4306
int ieee80211_mgd_deauth(struct ieee80211_sub_if_data *sdata,
4307
			 struct cfg80211_deauth_request *req)
4308
{
4309
	struct ieee80211_if_managed *ifmgd = &sdata->u.mgd;
4310
	u8 frame_buf[IEEE80211_DEAUTH_FRAME_LEN];
4311
	bool tx = !req->local_state_change;
4312
	bool report_frame = false;
4313

J
Johannes Berg 已提交
4314 4315 4316
	sdata_info(sdata,
		   "deauthenticating from %pM by local choice (reason=%d)\n",
		   req->bssid, req->reason_code);
4317

4318
	if (ifmgd->auth_data) {
4319
		drv_mgd_prepare_tx(sdata->local, sdata);
4320 4321
		ieee80211_send_deauth_disassoc(sdata, req->bssid,
					       IEEE80211_STYPE_DEAUTH,
4322
					       req->reason_code, tx,
4323
					       frame_buf);
4324 4325
		ieee80211_destroy_auth_data(sdata, false);

4326
		report_frame = true;
4327
		goto out;
4328 4329
	}

4330 4331 4332 4333
	if (ifmgd->associated &&
	    ether_addr_equal(ifmgd->associated->bssid, req->bssid)) {
		ieee80211_set_disassoc(sdata, IEEE80211_STYPE_DEAUTH,
				       req->reason_code, tx, frame_buf);
4334
		report_frame = true;
4335
	}
4336

4337
 out:
4338
	if (report_frame)
4339 4340
		cfg80211_tx_mlme_mgmt(sdata->dev, frame_buf,
				      IEEE80211_DEAUTH_FRAME_LEN);
4341

4342 4343
	return 0;
}
4344

4345
int ieee80211_mgd_disassoc(struct ieee80211_sub_if_data *sdata,
4346
			   struct cfg80211_disassoc_request *req)
J
Johannes Berg 已提交
4347
{
4348
	struct ieee80211_if_managed *ifmgd = &sdata->u.mgd;
4349
	u8 bssid[ETH_ALEN];
4350
	u8 frame_buf[IEEE80211_DEAUTH_FRAME_LEN];
J
Johannes Berg 已提交
4351

J
Johannes Berg 已提交
4352 4353 4354 4355 4356 4357
	/*
	 * 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.
	 */
4358
	if (ifmgd->associated != req->bss)
4359 4360
		return -ENOLINK;

J
Johannes Berg 已提交
4361 4362 4363
	sdata_info(sdata,
		   "disassociating from %pM by local choice (reason=%d)\n",
		   req->bss->bssid, req->reason_code);
4364

4365
	memcpy(bssid, req->bss->bssid, ETH_ALEN);
4366 4367 4368
	ieee80211_set_disassoc(sdata, IEEE80211_STYPE_DISASSOC,
			       req->reason_code, !req->local_state_change,
			       frame_buf);
4369

4370 4371
	cfg80211_tx_mlme_mgmt(sdata->dev, frame_buf,
			      IEEE80211_DEAUTH_FRAME_LEN);
4372

4373 4374
	return 0;
}
4375

4376
void ieee80211_mgd_stop(struct ieee80211_sub_if_data *sdata)
4377 4378 4379
{
	struct ieee80211_if_managed *ifmgd = &sdata->u.mgd;

4380 4381 4382 4383 4384 4385 4386 4387 4388 4389 4390
	/*
	 * Make sure some work items will not run after this,
	 * they will not do anything but might not have been
	 * cancelled when disconnecting.
	 */
	cancel_work_sync(&ifmgd->monitor_work);
	cancel_work_sync(&ifmgd->beacon_connection_loss_work);
	cancel_work_sync(&ifmgd->request_smps_work);
	cancel_work_sync(&ifmgd->csa_connection_drop_work);
	cancel_work_sync(&ifmgd->chswitch_work);

4391
	sdata_lock(sdata);
4392 4393
	if (ifmgd->assoc_data) {
		struct cfg80211_bss *bss = ifmgd->assoc_data->bss;
4394
		ieee80211_destroy_assoc_data(sdata, false);
4395 4396
		cfg80211_assoc_timeout(sdata->dev, bss);
	}
4397 4398 4399
	if (ifmgd->auth_data)
		ieee80211_destroy_auth_data(sdata, false);
	del_timer_sync(&ifmgd->timer);
4400
	sdata_unlock(sdata);
4401 4402
}

4403 4404 4405 4406 4407 4408
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 已提交
4409 4410
	trace_api_cqm_rssi_notify(sdata, rssi_event);

4411 4412 4413
	cfg80211_cqm_rssi_notify(sdata->dev, rssi_event, gfp);
}
EXPORT_SYMBOL(ieee80211_cqm_rssi_notify);