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

14
#include <linux/delay.h>
15 16 17 18
#include <linux/if_ether.h>
#include <linux/skbuff.h>
#include <linux/if_arp.h>
#include <linux/etherdevice.h>
19
#include <linux/rtnetlink.h>
20
#include <net/mac80211.h>
21
#include <asm/unaligned.h>
Johannes Berg's avatar
Johannes Berg committed
22

23
#include "ieee80211_i.h"
Johannes Berg's avatar
Johannes Berg committed
24 25
#include "rate.h"
#include "led.h"
26

27
#define IEEE80211_ASSOC_SCANS_MAX_TRIES 2
28 29 30 31 32
#define IEEE80211_AUTH_TIMEOUT (HZ / 5)
#define IEEE80211_AUTH_MAX_TRIES 3
#define IEEE80211_ASSOC_TIMEOUT (HZ / 5)
#define IEEE80211_ASSOC_MAX_TRIES 3
#define IEEE80211_MONITORING_INTERVAL (2 * HZ)
33
#define IEEE80211_PROBE_IDLE_TIME (60 * HZ)
34 35
#define IEEE80211_RETRY_AUTH_INTERVAL (1 * HZ)

36 37
/* utils */
static int ecw2cw(int ecw)
Johannes Berg's avatar
Johannes Berg committed
38
{
39
	return (1 << ecw) - 1;
Johannes Berg's avatar
Johannes Berg committed
40 41
}

42
static u8 *ieee80211_bss_get_ie(struct ieee80211_bss *bss, u8 ie)
43 44 45
{
	u8 *end, *pos;

46
	pos = bss->cbss.information_elements;
47 48
	if (pos == NULL)
		return NULL;
49
	end = pos + bss->cbss.len_information_elements;
50 51 52 53 54 55 56 57 58 59 60 61

	while (pos + 1 < end) {
		if (pos + 2 + pos[1] > end)
			break;
		if (pos[0] == ie)
			return pos;
		pos += 2 + pos[1];
	}

	return NULL;
}

62
static int ieee80211_compatible_rates(struct ieee80211_bss *bss,
63
				      struct ieee80211_supported_band *sband,
64
				      u32 *rates)
65 66 67 68 69 70 71 72 73 74 75 76 77 78 79 80 81 82
{
	int i, j, count;
	*rates = 0;
	count = 0;
	for (i = 0; i < bss->supp_rates_len; i++) {
		int rate = (bss->supp_rates[i] & 0x7F) * 5;

		for (j = 0; j < sband->n_bitrates; j++)
			if (sband->bitrates[j].bitrate == rate) {
				*rates |= BIT(j);
				count++;
				break;
			}
	}

	return count;
}

83 84 85 86 87 88 89 90 91 92 93 94 95 96 97 98 99 100 101 102 103 104 105 106 107 108 109 110 111 112 113 114 115 116 117 118 119 120 121 122 123 124 125 126 127 128 129 130 131 132 133 134 135 136 137 138 139 140 141 142 143 144 145 146 147 148 149 150 151 152 153 154 155 156 157 158 159 160 161 162 163 164 165
/*
 * ieee80211_enable_ht should be called only after the operating band
 * has been determined as ht configuration depends on the hw's
 * HT abilities for a specific band.
 */
static u32 ieee80211_enable_ht(struct ieee80211_sub_if_data *sdata,
			       struct ieee80211_ht_info *hti,
			       u16 ap_ht_cap_flags)
{
	struct ieee80211_local *local = sdata->local;
	struct ieee80211_supported_band *sband;
	struct ieee80211_if_managed *ifmgd = &sdata->u.mgd;
	struct ieee80211_bss_ht_conf ht;
	struct sta_info *sta;
	u32 changed = 0;
	bool enable_ht = true, ht_changed;
	enum nl80211_channel_type channel_type = NL80211_CHAN_NO_HT;

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

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

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

	/* check that channel matches the right operating channel */
	if (local->hw.conf.channel->center_freq !=
	    ieee80211_channel_to_frequency(hti->control_chan))
		enable_ht = false;

	if (enable_ht) {
		channel_type = NL80211_CHAN_HT20;

		if (!(ap_ht_cap_flags & IEEE80211_HT_CAP_40MHZ_INTOLERANT) &&
		    (sband->ht_cap.cap & IEEE80211_HT_CAP_SUP_WIDTH_20_40) &&
		    (hti->ht_param & IEEE80211_HT_PARAM_CHAN_WIDTH_ANY)) {
			switch(hti->ht_param & IEEE80211_HT_PARAM_CHA_SEC_OFFSET) {
			case IEEE80211_HT_PARAM_CHA_SEC_ABOVE:
				channel_type = NL80211_CHAN_HT40PLUS;
				break;
			case IEEE80211_HT_PARAM_CHA_SEC_BELOW:
				channel_type = NL80211_CHAN_HT40MINUS;
				break;
			}
		}
	}

	ht_changed = conf_is_ht(&local->hw.conf) != enable_ht ||
		     channel_type != local->hw.conf.channel_type;

	local->oper_channel_type = channel_type;

	if (ht_changed) {
                /* channel_type change automatically detected */
		ieee80211_hw_config(local, 0);

		rcu_read_lock();

		sta = sta_info_get(local, ifmgd->bssid);
		if (sta)
			rate_control_rate_update(local, sband, sta,
						 IEEE80211_RC_HT_CHANGED);

		rcu_read_unlock();

        }

	/* disable HT */
	if (!enable_ht)
		return 0;

	ht.operation_mode = le16_to_cpu(hti->operation_mode);

	/* if bss configuration changed store the new one */
	if (memcmp(&sdata->vif.bss_conf.ht, &ht, sizeof(ht))) {
		changed |= BSS_CHANGED_HT;
		sdata->vif.bss_conf.ht = ht;
	}

	return changed;
}

166 167
/* frame sending functions */

168
static void ieee80211_send_assoc(struct ieee80211_sub_if_data *sdata)
169
{
170
	struct ieee80211_if_managed *ifmgd = &sdata->u.mgd;
171 172 173
	struct ieee80211_local *local = sdata->local;
	struct sk_buff *skb;
	struct ieee80211_mgmt *mgmt;
174
	u8 *pos, *ies, *ht_ie;
175 176
	int i, len, count, rates_len, supp_rates_len;
	u16 capab;
177
	struct ieee80211_bss *bss;
178 179
	int wmm = 0;
	struct ieee80211_supported_band *sband;
180
	u32 rates = 0;
181 182

	skb = dev_alloc_skb(local->hw.extra_tx_headroom +
183
			    sizeof(*mgmt) + 200 + ifmgd->extra_ie_len +
184
			    ifmgd->ssid_len);
185 186 187 188 189 190 191 192 193
	if (!skb) {
		printk(KERN_DEBUG "%s: failed to allocate buffer for assoc "
		       "frame\n", sdata->dev->name);
		return;
	}
	skb_reserve(skb, local->hw.extra_tx_headroom);

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

194
	capab = ifmgd->capab;
195 196 197 198 199 200 201 202

	if (local->hw.conf.channel->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;
	}

203
	bss = ieee80211_rx_bss_get(local, ifmgd->bssid,
204
				   local->hw.conf.channel->center_freq,
205
				   ifmgd->ssid, ifmgd->ssid_len);
206
	if (bss) {
207
		if (bss->cbss.capability & WLAN_CAPABILITY_PRIVACY)
208 209 210 211 212 213 214 215 216 217
			capab |= WLAN_CAPABILITY_PRIVACY;
		if (bss->wmm_used)
			wmm = 1;

		/* 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) */
		rates_len = ieee80211_compatible_rates(bss, sband, &rates);

218
		if ((bss->cbss.capability & WLAN_CAPABILITY_SPECTRUM_MGMT) &&
219 220 221 222 223 224 225 226 227 228 229
		    (local->hw.flags & IEEE80211_HW_SPECTRUM_MGMT))
			capab |= WLAN_CAPABILITY_SPECTRUM_MGMT;

		ieee80211_rx_bss_put(local, bss);
	} else {
		rates = ~0;
		rates_len = sband->n_bitrates;
	}

	mgmt = (struct ieee80211_mgmt *) skb_put(skb, 24);
	memset(mgmt, 0, 24);
230
	memcpy(mgmt->da, ifmgd->bssid, ETH_ALEN);
231
	memcpy(mgmt->sa, sdata->dev->dev_addr, ETH_ALEN);
232
	memcpy(mgmt->bssid, ifmgd->bssid, ETH_ALEN);
233

234
	if (ifmgd->flags & IEEE80211_STA_PREV_BSSID_SET) {
235 236 237 238 239 240
		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);
241
		memcpy(mgmt->u.reassoc_req.current_ap, ifmgd->prev_bssid,
242 243 244 245 246 247
		       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);
248
		mgmt->u.assoc_req.listen_interval =
249 250 251 252
				cpu_to_le16(local->hw.conf.listen_interval);
	}

	/* SSID */
253
	ies = pos = skb_put(skb, 2 + ifmgd->ssid_len);
254
	*pos++ = WLAN_EID_SSID;
255 256
	*pos++ = ifmgd->ssid_len;
	memcpy(pos, ifmgd->ssid, ifmgd->ssid_len);
257 258 259 260 261 262 263 264 265 266 267 268 269 270 271 272 273 274 275 276 277 278 279 280 281 282 283 284 285 286 287 288 289 290 291 292 293 294 295 296 297 298 299 300 301 302 303 304 305 306 307 308 309 310

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

	len = sband->n_bitrates;
	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) {
			int rate = sband->bitrates[i].bitrate;
			*pos++ = (u8) (rate / 5);
			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) {
				int rate = sband->bitrates[i].bitrate;
				*pos++ = (u8) (rate / 5);
			}
		}
	}

	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 */
		*pos++ = local->hw.conf.channel->max_power; /* max tx power */

		/* 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*/
		}
	}

311 312 313
	if (ifmgd->extra_ie) {
		pos = skb_put(skb, ifmgd->extra_ie_len);
		memcpy(pos, ifmgd->extra_ie, ifmgd->extra_ie_len);
314 315
	}

316
	if (wmm && (ifmgd->flags & IEEE80211_STA_WMM_ENABLED)) {
317 318 319 320 321 322 323 324 325 326 327 328 329
		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++ = 0;
	}

	/* wmm support is a must to HT */
330 331 332 333 334 335
	/*
	 * 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.
	 */
336
	if (wmm && (ifmgd->flags & IEEE80211_STA_WMM_ENABLED) &&
337 338
	    sband->ht_cap.ht_supported &&
	    (ht_ie = ieee80211_bss_get_ie(bss, WLAN_EID_HT_INFORMATION)) &&
339
	    ht_ie[1] >= sizeof(struct ieee80211_ht_info) &&
340
	    (!(ifmgd->flags & IEEE80211_STA_TKIP_WEP_USED))) {
341 342 343
		struct ieee80211_ht_info *ht_info =
			(struct ieee80211_ht_info *)(ht_ie + 2);
		u16 cap = sband->ht_cap.cap;
344 345 346
		__le16 tmp;
		u32 flags = local->hw.conf.channel->flags;

347 348
		switch (ht_info->ht_param & IEEE80211_HT_PARAM_CHA_SEC_OFFSET) {
		case IEEE80211_HT_PARAM_CHA_SEC_ABOVE:
349
			if (flags & IEEE80211_CHAN_NO_FAT_ABOVE) {
350
				cap &= ~IEEE80211_HT_CAP_SUP_WIDTH_20_40;
351 352 353
				cap &= ~IEEE80211_HT_CAP_SGI_40;
			}
			break;
354
		case IEEE80211_HT_PARAM_CHA_SEC_BELOW:
355
			if (flags & IEEE80211_CHAN_NO_FAT_BELOW) {
356
				cap &= ~IEEE80211_HT_CAP_SUP_WIDTH_20_40;
357 358 359 360 361 362 363 364 365 366 367 368 369
				cap &= ~IEEE80211_HT_CAP_SGI_40;
			}
			break;
		}

		tmp = cpu_to_le16(cap);
		pos = skb_put(skb, sizeof(struct ieee80211_ht_cap)+2);
		*pos++ = WLAN_EID_HT_CAPABILITY;
		*pos++ = sizeof(struct ieee80211_ht_cap);
		memset(pos, 0, sizeof(struct ieee80211_ht_cap));
		memcpy(pos, &tmp, sizeof(u16));
		pos += sizeof(u16);
		/* TODO: needs a define here for << 2 */
370 371 372
		*pos++ = sband->ht_cap.ampdu_factor |
			 (sband->ht_cap.ampdu_density << 2);
		memcpy(pos, &sband->ht_cap.mcs, sizeof(sband->ht_cap.mcs));
373 374
	}

375 376 377 378 379
	kfree(ifmgd->assocreq_ies);
	ifmgd->assocreq_ies_len = (skb->data + skb->len) - ies;
	ifmgd->assocreq_ies = kmalloc(ifmgd->assocreq_ies_len, GFP_KERNEL);
	if (ifmgd->assocreq_ies)
		memcpy(ifmgd->assocreq_ies, ies, ifmgd->assocreq_ies_len);
380

381
	ieee80211_tx_skb(sdata, skb, 0);
382 383 384
}


385 386
static void ieee80211_send_deauth_disassoc(struct ieee80211_sub_if_data *sdata,
					   u16 stype, u16 reason)
387 388
{
	struct ieee80211_local *local = sdata->local;
389
	struct ieee80211_if_managed *ifmgd = &sdata->u.mgd;
390 391
	struct sk_buff *skb;
	struct ieee80211_mgmt *mgmt;
392

393
	skb = dev_alloc_skb(local->hw.extra_tx_headroom + sizeof(*mgmt));
394
	if (!skb) {
395 396
		printk(KERN_DEBUG "%s: failed to allocate buffer for "
		       "deauth/disassoc frame\n", sdata->dev->name);
397 398 399 400 401 402
		return;
	}
	skb_reserve(skb, local->hw.extra_tx_headroom);

	mgmt = (struct ieee80211_mgmt *) skb_put(skb, 24);
	memset(mgmt, 0, 24);
403
	memcpy(mgmt->da, ifmgd->bssid, ETH_ALEN);
404
	memcpy(mgmt->sa, sdata->dev->dev_addr, ETH_ALEN);
405
	memcpy(mgmt->bssid, ifmgd->bssid, ETH_ALEN);
406
	mgmt->frame_control = cpu_to_le16(IEEE80211_FTYPE_MGMT | stype);
407
	skb_put(skb, 2);
408
	/* u.deauth.reason_code == u.disassoc.reason_code */
409 410
	mgmt->u.deauth.reason_code = cpu_to_le16(reason);

411 412 413 414
	if (stype == IEEE80211_STYPE_DEAUTH)
		cfg80211_send_deauth(sdata->dev, (u8 *) mgmt, skb->len);
	else
		cfg80211_send_disassoc(sdata->dev, (u8 *) mgmt, skb->len);
415
	ieee80211_tx_skb(sdata, skb, ifmgd->flags & IEEE80211_STA_MFP_ENABLED);
416 417
}

418 419 420
void ieee80211_send_pspoll(struct ieee80211_local *local,
			   struct ieee80211_sub_if_data *sdata)
{
421
	struct ieee80211_if_managed *ifmgd = &sdata->u.mgd;
422 423 424 425 426 427 428 429 430 431 432 433 434 435 436 437
	struct ieee80211_pspoll *pspoll;
	struct sk_buff *skb;
	u16 fc;

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

	pspoll = (struct ieee80211_pspoll *) skb_put(skb, sizeof(*pspoll));
	memset(pspoll, 0, sizeof(*pspoll));
	fc = IEEE80211_FTYPE_CTL | IEEE80211_STYPE_PSPOLL | IEEE80211_FCTL_PM;
	pspoll->frame_control = cpu_to_le16(fc);
438
	pspoll->aid = cpu_to_le16(ifmgd->aid);
439 440 441 442

	/* aid in PS-Poll has its two MSBs each set to 1 */
	pspoll->aid |= cpu_to_le16(1 << 15 | 1 << 14);

443
	memcpy(pspoll->bssid, ifmgd->bssid, ETH_ALEN);
444 445 446 447 448
	memcpy(pspoll->ta, sdata->dev->dev_addr, ETH_ALEN);

	ieee80211_tx_skb(sdata, skb, 0);
}

449 450 451 452 453 454 455 456 457 458 459 460 461 462 463 464 465 466 467 468 469 470 471 472 473 474 475 476 477 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 503 504 505 506 507 508 509 510 511 512 513 514 515 516 517 518 519 520 521 522 523 524 525 526 527 528 529 530 531 532 533 534 535 536 537 538 539 540 541 542 543 544 545 546 547 548 549 550 551 552 553 554 555 556 557 558 559 560 561 562 563 564 565 566 567 568 569 570 571 572 573 574 575 576 577 578 579 580 581 582 583 584 585 586 587
void ieee80211_send_nullfunc(struct ieee80211_local *local,
			     struct ieee80211_sub_if_data *sdata,
			     int powersave)
{
	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 + 24);
	if (!skb) {
		printk(KERN_DEBUG "%s: failed to allocate buffer for nullfunc "
		       "frame\n", sdata->dev->name);
		return;
	}
	skb_reserve(skb, local->hw.extra_tx_headroom);

	nullfunc = (struct ieee80211_hdr *) skb_put(skb, 24);
	memset(nullfunc, 0, 24);
	fc = cpu_to_le16(IEEE80211_FTYPE_DATA | IEEE80211_STYPE_NULLFUNC |
			 IEEE80211_FCTL_TODS);
	if (powersave)
		fc |= cpu_to_le16(IEEE80211_FCTL_PM);
	nullfunc->frame_control = fc;
	memcpy(nullfunc->addr1, sdata->u.mgd.bssid, ETH_ALEN);
	memcpy(nullfunc->addr2, sdata->dev->dev_addr, ETH_ALEN);
	memcpy(nullfunc->addr3, sdata->u.mgd.bssid, ETH_ALEN);

	ieee80211_tx_skb(sdata, skb, 0);
}

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

	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);
		conf->flags |= IEEE80211_CONF_PS;
		ieee80211_hw_config(local, IEEE80211_CONF_CHANGE_PS);
	}
}

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

	if (local->ps_sdata) {
		if (!(local->ps_sdata->u.mgd.flags & IEEE80211_STA_ASSOCIATED))
			return;

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

/* need to hold RTNL or interface lock */
void ieee80211_recalc_ps(struct ieee80211_local *local)
{
	struct ieee80211_sub_if_data *sdata, *found = NULL;
	int count = 0;

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

	list_for_each_entry(sdata, &local->interfaces, list) {
		if (!netif_running(sdata->dev))
			continue;
		if (sdata->vif.type != NL80211_IFTYPE_STATION)
			continue;
		found = sdata;
		count++;
	}

	if (count == 1 && found->u.mgd.powersave)
		local->ps_sdata = found;
	else
		local->ps_sdata = NULL;

	ieee80211_change_ps(local);
}

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

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

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

void ieee80211_dynamic_ps_enable_work(struct work_struct *work)
{
	struct ieee80211_local *local =
		container_of(work, struct ieee80211_local,
			     dynamic_ps_enable_work);
	struct ieee80211_sub_if_data *sdata = local->ps_sdata;

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

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

	if (local->hw.flags & IEEE80211_HW_PS_NULLFUNC_STACK)
		ieee80211_send_nullfunc(local, sdata, 1);

	local->hw.conf.flags |= IEEE80211_CONF_PS;
	ieee80211_hw_config(local, IEEE80211_CONF_CHANGE_PS);
}

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

	queue_work(local->hw.workqueue, &local->dynamic_ps_enable_work);
}

Johannes Berg's avatar
Johannes Berg committed
588
/* MLME */
589
static void ieee80211_sta_wmm_params(struct ieee80211_local *local,
590
				     struct ieee80211_if_managed *ifmgd,
591 592 593 594 595 596 597
				     u8 *wmm_param, size_t wmm_param_len)
{
	struct ieee80211_tx_queue_params params;
	size_t left;
	int count;
	u8 *pos;

598
	if (!(ifmgd->flags & IEEE80211_STA_WMM_ENABLED))
599 600 601 602 603
		return;

	if (!wmm_param)
		return;

604 605 606
	if (wmm_param_len < 8 || wmm_param[5] /* version */ != 1)
		return;
	count = wmm_param[6] & 0x0f;
607
	if (count == ifmgd->wmm_last_param_set)
608
		return;
609
	ifmgd->wmm_last_param_set = count;
610 611 612 613 614 615 616 617 618 619 620 621 622

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

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

	local->wmm_acm = 0;
	for (; left >= 4; left -= 4, pos += 4) {
		int aci = (pos[0] >> 5) & 0x03;
		int acm = (pos[0] >> 4) & 0x01;
		int queue;

		switch (aci) {
623
		case 1: /* AC_BK */
Johannes Berg's avatar
Johannes Berg committed
624
			queue = 3;
Johannes Berg's avatar
Johannes Berg committed
625
			if (acm)
626
				local->wmm_acm |= BIT(1) | BIT(2); /* BK/- */
627
			break;
628
		case 2: /* AC_VI */
Johannes Berg's avatar
Johannes Berg committed
629
			queue = 1;
Johannes Berg's avatar
Johannes Berg committed
630
			if (acm)
631
				local->wmm_acm |= BIT(4) | BIT(5); /* CL/VI */
632
			break;
633
		case 3: /* AC_VO */
Johannes Berg's avatar
Johannes Berg committed
634
			queue = 0;
Johannes Berg's avatar
Johannes Berg committed
635
			if (acm)
636
				local->wmm_acm |= BIT(6) | BIT(7); /* VO/NC */
637
			break;
638
		case 0: /* AC_BE */
639
		default:
Johannes Berg's avatar
Johannes Berg committed
640
			queue = 2;
Johannes Berg's avatar
Johannes Berg committed
641
			if (acm)
642
				local->wmm_acm |= BIT(0) | BIT(3); /* BE/EE */
643 644 645 646 647 648
			break;
		}

		params.aifs = pos[0] & 0x0f;
		params.cw_max = ecw2cw((pos[1] & 0xf0) >> 4);
		params.cw_min = ecw2cw(pos[1] & 0x0f);
649
		params.txop = get_unaligned_le16(pos + 2);
650
#ifdef CONFIG_MAC80211_VERBOSE_DEBUG
651
		printk(KERN_DEBUG "%s: WMM queue=%d aci=%d acm=%d aifs=%d "
652
		       "cWmin=%d cWmax=%d txop=%d\n",
653
		       local->mdev->name, queue, aci, acm, params.aifs, params.cw_min,
654 655
		       params.cw_max, params.txop);
#endif
656 657
		if (local->ops->conf_tx &&
		    local->ops->conf_tx(local_to_hw(local), queue, &params)) {
658
			printk(KERN_DEBUG "%s: failed to set TX queue "
659
			       "parameters for queue %d\n", local->mdev->name, queue);
660 661 662 663
		}
	}
}

664
static bool ieee80211_check_tim(struct ieee802_11_elems *elems, u16 aid)
665 666 667 668 669
{
	u8 mask;
	u8 index, indexn1, indexn2;
	struct ieee80211_tim_ie *tim = (struct ieee80211_tim_ie *) elems->tim;

670 671 672
	if (unlikely(!tim || elems->tim_len < 4))
		return false;

673 674 675 676 677 678 679 680 681 682 683 684 685 686 687
	aid &= 0x3fff;
	index = aid / 8;
	mask  = 1 << (aid & 7);

	indexn1 = tim->bitmap_ctrl & 0xfe;
	indexn2 = elems->tim_len + indexn1 - 4;

	if (index < indexn1 || index > indexn2)
		return false;

	index -= indexn1;

	return !!(tim->virtual_map[index] & mask);
}

688 689
static u32 ieee80211_handle_bss_capability(struct ieee80211_sub_if_data *sdata,
					   u16 capab, bool erp_valid, u8 erp)
690
{
691
	struct ieee80211_bss_conf *bss_conf = &sdata->vif.bss_conf;
692
#ifdef CONFIG_MAC80211_VERBOSE_DEBUG
693
	struct ieee80211_if_managed *ifmgd = &sdata->u.mgd;
694
#endif
695
	u32 changed = 0;
696 697 698 699 700 701 702 703 704 705 706 707 708
	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);
709

710
	if (use_protection != bss_conf->use_cts_prot) {
711
#ifdef CONFIG_MAC80211_VERBOSE_DEBUG
712
		if (net_ratelimit()) {
713
			printk(KERN_DEBUG "%s: CTS protection %s (BSSID=%pM)\n",
714
			       sdata->dev->name,
715
			       use_protection ? "enabled" : "disabled",
716
			       ifmgd->bssid);
717
		}
718
#endif
719 720
		bss_conf->use_cts_prot = use_protection;
		changed |= BSS_CHANGED_ERP_CTS_PROT;
721
	}
722

723
	if (use_short_preamble != bss_conf->use_short_preamble) {
724
#ifdef CONFIG_MAC80211_VERBOSE_DEBUG
725 726
		if (net_ratelimit()) {
			printk(KERN_DEBUG "%s: switched to %s barker preamble"
727
			       " (BSSID=%pM)\n",
728
			       sdata->dev->name,
729
			       use_short_preamble ? "short" : "long",
730
			       ifmgd->bssid);
731
		}
732
#endif
733
		bss_conf->use_short_preamble = use_short_preamble;
734
		changed |= BSS_CHANGED_ERP_PREAMBLE;
735
	}
736

737 738 739
	if (use_short_slot != bss_conf->use_short_slot) {
#ifdef CONFIG_MAC80211_VERBOSE_DEBUG
		if (net_ratelimit()) {
740 741
			printk(KERN_DEBUG "%s: switched to %s slot time"
			       " (BSSID=%pM)\n",
742 743
			       sdata->dev->name,
			       use_short_slot ? "short" : "long",
744
			       ifmgd->bssid);
745 746 747 748
		}
#endif
		bss_conf->use_short_slot = use_short_slot;
		changed |= BSS_CHANGED_ERP_SLOT;
749 750 751 752 753
	}

	return changed;
}

754
static void ieee80211_sta_send_apinfo(struct ieee80211_sub_if_data *sdata)
755 756
{
	union iwreq_data wrqu;
757

758
	memset(&wrqu, 0, sizeof(wrqu));
759 760
	if (sdata->u.mgd.flags & IEEE80211_STA_ASSOCIATED)
		memcpy(wrqu.ap_addr.sa_data, sdata->u.mgd.bssid, ETH_ALEN);
761 762 763 764
	wrqu.ap_addr.sa_family = ARPHRD_ETHER;
	wireless_send_event(sdata->dev, SIOCGIWAP, &wrqu, NULL);
}

765
static void ieee80211_sta_send_associnfo(struct ieee80211_sub_if_data *sdata)
766
{
767
	struct ieee80211_if_managed *ifmgd = &sdata->u.mgd;
768 769 770
	char *buf;
	size_t len;
	int i;
771 772
	union iwreq_data wrqu;

773
	if (!ifmgd->assocreq_ies && !ifmgd->assocresp_ies)
774 775
		return;

776 777
	buf = kmalloc(50 + 2 * (ifmgd->assocreq_ies_len +
				ifmgd->assocresp_ies_len), GFP_KERNEL);
778 779 780 781
	if (!buf)
		return;

	len = sprintf(buf, "ASSOCINFO(");
782
	if (ifmgd->assocreq_ies) {
783
		len += sprintf(buf + len, "ReqIEs=");
784
		for (i = 0; i < ifmgd->assocreq_ies_len; i++) {
785
			len += sprintf(buf + len, "%02x",
786
				       ifmgd->assocreq_ies[i]);
787
		}
788
	}
789 790
	if (ifmgd->assocresp_ies) {
		if (ifmgd->assocreq_ies)
791 792
			len += sprintf(buf + len, " ");
		len += sprintf(buf + len, "RespIEs=");
793
		for (i = 0; i < ifmgd->assocresp_ies_len; i++) {
794
			len += sprintf(buf + len, "%02x",
795
				       ifmgd->assocresp_ies[i]);
796
		}
797
	}
798 799 800 801
	len += sprintf(buf + len, ")");

	if (len > IW_CUSTOM_MAX) {
		len = sprintf(buf, "ASSOCRESPIE=");
802
		for (i = 0; i < ifmgd->assocresp_ies_len; i++) {
803
			len += sprintf(buf + len, "%02x",
804
				       ifmgd->assocresp_ies[i]);
805 806 807
		}
	}

808 809 810 811 812
	if (len <= IW_CUSTOM_MAX) {
		memset(&wrqu, 0, sizeof(wrqu));
		wrqu.data.length = len;
		wireless_send_event(sdata->dev, IWEVCUSTOM, &wrqu, buf);
	}
813 814

	kfree(buf);
815 816 817
}


818
static void ieee80211_set_associated(struct ieee80211_sub_if_data *sdata,
Johannes Berg's avatar
Johannes Berg committed
819
				     u32 bss_info_changed)
820
{
821
	struct ieee80211_if_managed *ifmgd = &sdata->u.mgd;
822
	struct ieee80211_local *local = sdata->local;
Tomas Winkler's avatar
Tomas Winkler committed
823
	struct ieee80211_conf *conf = &local_to_hw(local)->conf;
824

825
	struct ieee80211_bss *bss;
826

Johannes Berg's avatar
Johannes Berg committed
827
	bss_info_changed |= BSS_CHANGED_ASSOC;
828
	ifmgd->flags |= IEEE80211_STA_ASSOCIATED;
829

830
	bss = ieee80211_rx_bss_get(local, ifmgd->bssid,
831
				   conf->channel->center_freq,
832
				   ifmgd->ssid, ifmgd->ssid_len);
833 834
	if (bss) {
		/* set timing information */
835 836
		sdata->vif.bss_conf.beacon_int = bss->cbss.beacon_interval;
		sdata->vif.bss_conf.timestamp = bss->cbss.tsf;
837
		sdata->vif.bss_conf.dtim_period = bss->dtim_period;
838

Johannes Berg's avatar
Johannes Berg committed
839
		bss_info_changed |= ieee80211_handle_bss_capability(sdata,
840
			bss->cbss.capability, bss->has_erp_value, bss->erp_value);
841

842 843
		cfg80211_hold_bss(&bss->cbss);

844
		ieee80211_rx_bss_put(local, bss);
845 846
	}

847 848 849
	ifmgd->flags |= IEEE80211_STA_PREV_BSSID_SET;
	memcpy(ifmgd->prev_bssid, sdata->u.mgd.bssid, ETH_ALEN);
	ieee80211_sta_send_associnfo(sdata);
850

851
	ifmgd->last_probe = jiffies;
852
	ieee80211_led_assoc(local, 1);
853

854
	sdata->vif.bss_conf.assoc = 1;
855 856 857 858 859
	/*
	 * For now just always ask the driver to update the basic rateset
	 * when we have associated, we aren't checking whether it actually
	 * changed or not.
	 */
Johannes Berg's avatar
Johannes Berg committed
860 861
	bss_info_changed |= BSS_CHANGED_BASIC_RATES;
	ieee80211_bss_info_change_notify(sdata, bss_info_changed);
862

863 864 865
	/* will be same as sdata */
	if (local->ps_sdata)
		ieee80211_enable_ps(local, sdata);
866

867 868
	netif_tx_start_all_queues(sdata->dev);
	netif_carrier_on(sdata->dev);
869

870
	ieee80211_sta_send_apinfo(sdata);
871 872
}

873
static void ieee80211_direct_probe(struct ieee80211_sub_if_data *sdata)
874
{
875
	struct ieee80211_if_managed *ifmgd = &sdata->u.mgd;
876
	struct ieee80211_local *local = sdata->local;
877 878 879

	ifmgd->direct_probe_tries++;
	if (ifmgd->direct_probe_tries > IEEE80211_AUTH_MAX_TRIES) {
880
		printk(KERN_DEBUG "%s: direct probe to AP %pM timed out\n",
881 882 883
		       sdata->dev->name, ifmgd->bssid);
		ifmgd->state = IEEE80211_STA_MLME_DISABLED;
		ieee80211_sta_send_apinfo(sdata);
884 885 886 887 888

		/*
		 * Most likely AP is not in the range so remove the
		 * bss information associated to the AP
		 */
889
		ieee80211_rx_bss_remove(sdata, ifmgd->bssid,
890
				sdata->local->hw.conf.channel->center_freq,
891
				ifmgd->ssid, ifmgd->ssid_len);
892 893 894 895 896 897 898

		/*
		 * We might have a pending scan which had no chance to run yet
		 * due to state == IEEE80211_STA_MLME_DIRECT_PROBE.
		 * Hence, queue the STAs work again
		 */
		queue_work(local->hw.workqueue, &ifmgd->work);
899 900 901
		return;
	}

902
	printk(KERN_DEBUG "%s: direct probe to AP %pM try %d\n",
903 904
			sdata->dev->name, ifmgd->bssid,
			ifmgd->direct_probe_tries);
905

906
	ifmgd->state = IEEE80211_STA_MLME_DIRECT_PROBE;
907

908
	set_bit(IEEE80211_STA_REQ_DIRECT_PROBE, &ifmgd->request);
909 910 911 912 913

	/* 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,
914
				 ifmgd->ssid, ifmgd->ssid_len, NULL, 0);
915

916
	mod_timer(&ifmgd->timer, jiffies + IEEE80211_AUTH_TIMEOUT);
Johannes Berg's avatar
Johannes Berg committed
917
}
918

919

920
static void ieee80211_authenticate(struct ieee80211_sub_if_data *sdata)
921
{
922
	struct ieee80211_if_managed *ifmgd = &sdata->u.mgd;
923
	struct ieee80211_local *local = sdata->local;
924 925
	u8 *ies;
	size_t ies_len;
926 927 928

	ifmgd->auth_tries++;
	if (ifmgd->auth_tries > IEEE80211_AUTH_MAX_TRIES) {
929
		printk(KERN_DEBUG "%s: authentication with AP %pM"
930
		       " timed out\n",
931 932 933 934
		       sdata->dev->name, ifmgd->bssid);
		ifmgd->state = IEEE80211_STA_MLME_DISABLED;
		ieee80211_sta_send_apinfo(sdata);
		ieee80211_rx_bss_remove(sdata, ifmgd->bssid,
935
				sdata->local->hw.conf.channel->center_freq,
936
				ifmgd->ssid, ifmgd->ssid_len);
937 938 939 940 941 942 943

		/*
		 * We might have a pending scan which had no chance to run yet
		 * due to state == IEEE80211_STA_MLME_AUTHENTICATE.
		 * Hence, queue the STAs work again
		 */
		queue_work(local->hw.workqueue, &ifmgd->work);
944 945 946
		return;
	}

947
	ifmgd->state = IEEE80211_STA_MLME_AUTHENTICATE;
948
	printk(KERN_DEBUG "%s: authenticate with AP %pM\n",
949
	       sdata->dev->name, ifmgd->bssid);
950

951 952 953 954 955 956 957 958
	if (ifmgd->flags & IEEE80211_STA_EXT_SME) {
		ies = ifmgd->sme_auth_ie;
		ies_len = ifmgd->sme_auth_ie_len;
	} else {
		ies = NULL;
		ies_len = 0;
	}
	ieee80211_send_auth(sdata, 1, ifmgd->auth_alg, ies, ies_len,
959 960
			    ifmgd->bssid, 0);
	ifmgd->auth_transaction = 2;
961

962
	mod_timer(&ifmgd->timer, jiffies + IEEE80211_AUTH_TIMEOUT);
963 964
}

965 966 967 968
/*
 * The disassoc 'reason' argument can be either our own reason
 * if self disconnected or a reason code from the AP.
 */
969
static void ieee80211_set_disassoc(struct ieee80211_sub_if_data *sdata,
970 971
				   bool deauth, bool self_disconnected,
				   u16 reason)
972
{
973
	struct ieee80211_if_managed *ifmgd = &sdata->u.mgd;
974
	struct ieee80211_local *local = sdata->local;
975 976
	struct ieee80211_conf *conf = &local_to_hw(local)->conf;
	struct ieee80211_bss *bss;
977
	struct sta_info *sta;
978
	u32 changed = 0, config_changed = 0;
979 980 981

	rcu_read_lock();

982
	sta = sta_info_get(local, ifmgd->bssid);
983 984 985 986 987 988
	if (!sta) {
		rcu_read_unlock();
		return;
	}

	if (deauth) {
989 990
		ifmgd->direct_probe_tries = 0;
		ifmgd->auth_tries = 0;
991
	}
992 993
	ifmgd->assoc_scan_tries = 0;
	ifmgd->assoc_tries = 0;
994

995
	netif_tx_stop_all_queues(sdata->dev);
996 997
	netif_carrier_off(sdata->dev);

998
	ieee80211_sta_tear_down_BA_sessions(sta);
999

1000 1001 1002 1003 1004 1005 1006 1007 1008
	bss = ieee80211_rx_bss_get(local, ifmgd->bssid,
				   conf->channel->center_freq,
				   ifmgd->ssid, ifmgd->ssid_len);

	if (bss) {
		cfg80211_unhold_bss(&bss->cbss);
		ieee80211_rx_bss_put(local, bss);
	}

1009 1010
	if (self_disconnected) {
		if (deauth)
1011 1012
			ieee80211_send_deauth_disassoc(sdata,
				IEEE80211_STYPE_DEAUTH, reason);
1013
		else
1014 1015
			ieee80211_send_deauth_disassoc(sdata,
				IEEE80211_STYPE_DISASSOC, reason);
1016 1017
	}

1018
	ifmgd->flags &= ~IEEE80211_STA_ASSOCIATED;
1019 1020 1021
	changed |= ieee80211_reset_erp_info(sdata);

	ieee80211_led_assoc(local, 0);
Johannes Berg's avatar
Johannes Berg committed
1022 1023
	changed |= BSS_CHANGED_ASSOC;
	sdata->vif.bss_conf.assoc = false;
1024

1025
	ieee80211_sta_send_apinfo(sdata);
1026

1027
	if (self_disconnected || reason == WLAN_REASON_DISASSOC_STA_HAS_LEFT) {
1028 1029
		ifmgd->state = IEEE80211_STA_MLME_DISABLED;
		ieee80211_rx_bss_remove(sdata, ifmgd->bssid,
1030
				sdata->local->hw.conf.channel->center_freq,
1031
				ifmgd->ssid, ifmgd->ssid_len);
1032
	}
1033 1034 1035

	rcu_read_unlock();

1036
	/* channel(_type) changes are handled by ieee80211_hw_config */
Sujith's avatar
Sujith committed
1037
	local->oper_channel_type = NL80211_CHAN_NO_HT;
1038

1039 1040
	local->power_constr_level = 0;

1041 1042 1043
	del_timer_sync(&local->dynamic_ps_timer);
	cancel_work_sync(&local->dynamic_ps_enable_work);

1044 1045 1046 1047
	if (local->hw.conf.flags & IEEE80211_CONF_PS) {
		local->hw.conf.flags &= ~IEEE80211_CONF_PS;
		config_changed |= IEEE80211_CONF_CHANGE_PS;
	}
Johannes Berg's avatar
Johannes Berg committed
1048

1049
	ieee80211_hw_config(local, config_changed);
Johannes Berg's avatar
Johannes Berg committed
1050
	ieee80211_bss_info_change_notify(sdata, changed);
1051 1052 1053

	rcu_read_lock();

1054
	sta = sta_info_get(local, ifmgd->bssid);
1055 1056 1057 1058 1059 1060 1061 1062 1063 1064
	if (!sta) {
		rcu_read_unlock();
		return;
	}

	sta_info_unlink(&sta);

	rcu_read_unlock();

	sta_info_destroy(sta);
1065
}
1066

1067 1068 1069 1070 1071 1072 1073 1074
static int ieee80211_sta_wep_configured(struct ieee80211_sub_if_data *sdata)
{
	if (!sdata || !sdata->default_key ||
	    sdata->default_key->conf.alg != ALG_WEP)
		return 0;
	return 1;
}

1075
static int ieee80211_privacy_mismatch(struct ieee80211_sub_if_data *sdata)
1076
{
1077
	struct ieee80211_if_managed *ifmgd = &sdata->u.mgd;
1078
	struct ieee80211_local *local = sdata->local;
1079
	struct ieee80211_bss *bss;
1080 1081 1082
	int bss_privacy;
	int wep_privacy;
	int privacy_invoked;
1083

1084
	if (!ifmgd || (ifmgd->flags & IEEE80211_STA_EXT_SME))
1085 1086
		return 0;

1087
	bss = ieee80211_rx_bss_get(local, ifmgd->bssid,
1088
				   local->hw.conf.channel->center_freq,
1089
				   ifmgd->ssid, ifmgd->ssid_len);
1090 1091 1092
	if (!bss)
		return 0;

1093
	bss_privacy = !!(bss->cbss.capability & WLAN_CAPABILITY_PRIVACY);
1094
	wep_privacy = !!ieee80211_sta_wep_configured(sdata);
1095
	privacy_invoked = !!(ifmgd->flags & IEEE80211_STA_PRIVACY_INVOKED);
1096

1097
	ieee80211_rx_bss_put(local, bss);
1098

1099 1100 1101 1102
	if ((bss_privacy == wep_privacy) || (bss_privacy == privacy_invoked))
		return 0;

	return 1;
1103 1104
}

1105
static void ieee80211_associate(struct ieee80211_sub_if_data *sdata)
1106
{
1107
	struct ieee80211_if_managed *ifmgd = &sdata->u.mgd;
1108
	struct ieee80211_local *local = sdata->local;
1109 1110 1111

	ifmgd->assoc_tries++;
	if (ifmgd->assoc_tries > IEEE80211_ASSOC_MAX_TRIES) {
1112
		printk(KERN_DEBUG "%s: association with AP %pM"
1113
		       " timed out\n",
1114 1115 1116 1117
		       sdata->dev->name, ifmgd->bssid);
		ifmgd->state = IEEE80211_STA_MLME_DISABLED;
		ieee80211_sta_send_apinfo(sdata);
		ieee80211_rx_bss_remove(sdata, ifmgd->bssid,
1118
				sdata->local->hw.conf.channel->center_freq,
1119
				ifmgd->ssid, ifmgd->ssid_len);
1120 1121 1122 1123 1124 1125
		/*
		 * We might have a pending scan which had no chance to run yet
		 * due to state == IEEE80211_STA_MLME_ASSOCIATE.
		 * Hence, queue the STAs work again
		 */
		queue_work(local->hw.workqueue, &ifmgd->work);
1126 1127 1128
		return;
	}

1129
	ifmgd->state = IEEE80211_STA_MLME_ASSOCIATE;
1130
	printk(KERN_DEBUG "%s: associate with AP %pM\n",
1131 1132
	       sdata->dev->name, ifmgd->bssid);
	if (ieee80211_privacy_mismatch(sdata)) {
1133
		printk(KERN_DEBUG "%s: mismatch in privacy configuration and "
1134
		       "mixed-cell disabled - abort association\n", sdata->dev->name);
1135
		ifmgd->state = IEEE80211_STA_MLME_DISABLED;
1136 1137 1138
		return;
	}

1139
	ieee80211_send_assoc(sdata);
1140