assoc.c 19.0 KB
Newer Older
1 2 3 4 5 6 7 8 9 10 11 12 13 14 15
/* Copyright (C) 2006, Red Hat, Inc. */

#include <linux/bitops.h>
#include <net/ieee80211.h>

#include "assoc.h"
#include "join.h"
#include "decl.h"
#include "hostcmd.h"
#include "host.h"


static const u8 bssid_any[ETH_ALEN] = { 0xFF, 0xFF, 0xFF, 0xFF, 0xFF, 0xFF };
static const u8 bssid_off[ETH_ALEN] = { 0x00, 0x00, 0x00, 0x00, 0x00, 0x00 };

16 17 18 19 20 21 22 23 24 25 26 27 28 29 30 31 32 33 34 35 36 37 38 39 40 41 42 43 44 45 46 47 48 49 50 51 52 53 54 55 56 57 58 59 60 61 62 63 64 65
/* From ieee80211_module.c */
static const char *libertas_escape_essid(const char *essid, u8 essid_len)
{
	static char escaped[IW_ESSID_MAX_SIZE * 2 + 1];
	const char *s = essid;
	char *d = escaped;

	if (ieee80211_is_empty_essid(essid, essid_len))
		return "";

	essid_len = min(essid_len, (u8) IW_ESSID_MAX_SIZE);
	while (essid_len--) {
		if (*s == '\0') {
			*d++ = '\\';
			*d++ = '0';
			s++;
		} else {
			*d++ = *s++;
		}
	}
	*d = '\0';
	return escaped;
}

static void print_assoc_req(const char * extra, struct assoc_request * assoc_req)
{
	lbs_deb_assoc(
	       "#### Association Request: %s\n"
	       "       flags:      0x%08lX\n"
	       "       SSID:       '%s'\n"
	       "       channel:    %d\n"
	       "       band:       %d\n"
	       "       mode:       %d\n"
	       "       BSSID:      " MAC_FMT "\n"
	       "       WPA:        %d\n"
	       "       WPA2:       %d\n"
	       "       WEP status: %d\n"
	       "       auth:       %d\n"
	       "       auth_alg:   %d\n"
	       "       encmode:    %d\n",
	       extra, assoc_req->flags,
	       libertas_escape_essid(assoc_req->ssid.ssid, assoc_req->ssid.ssidlength),
	       assoc_req->channel, assoc_req->band, assoc_req->mode,
	       MAC_ARG(assoc_req->bssid), assoc_req->secinfo.WPAenabled,
	       assoc_req->secinfo.WPA2enabled, assoc_req->secinfo.WEPstatus,
	       assoc_req->secinfo.authmode, assoc_req->secinfo.auth1xalg,
	       assoc_req->secinfo.Encryptionmode);
}


66 67 68 69 70
static int assoc_helper_essid(wlan_private *priv,
                              struct assoc_request * assoc_req)
{
	wlan_adapter *adapter = priv->adapter;
	int ret = 0;
71
	struct bss_descriptor * bss;
72

73
	lbs_deb_enter(LBS_DEB_ASSOC);
74

75 76 77 78
	/* FIXME: take channel into account when picking SSIDs if a channel
	 * is set.
	 */

79
	lbs_deb_assoc("New SSID requested: %s\n", assoc_req->ssid.ssid);
80
	if (assoc_req->mode == IW_MODE_INFRA) {
81
		if (adapter->prescan) {
82
			libertas_send_specific_SSID_scan(priv, &assoc_req->ssid, 0);
83 84
		}

85
		bss = libertas_find_SSID_in_list(adapter, &assoc_req->ssid,
86
				NULL, IW_MODE_INFRA);
87 88
		if (bss != NULL) {
			lbs_deb_assoc("SSID found in scan list, associating\n");
89 90
			memcpy(&assoc_req->bss, bss, sizeof(struct bss_descriptor));
			ret = wlan_associate(priv, assoc_req);
91
		} else {
92
			lbs_deb_assoc("SSID '%s' not found; cannot associate\n",
93 94
				assoc_req->ssid.ssid);
		}
95
	} else if (assoc_req->mode == IW_MODE_ADHOC) {
96 97 98
		/* Scan for the network, do not save previous results.  Stale
		 *   scan data will cause us to join a non-existant adhoc network
		 */
99
		libertas_send_specific_SSID_scan(priv, &assoc_req->ssid, 1);
100 101

		/* Search for the requested SSID in the scan table */
102
		bss = libertas_find_SSID_in_list(adapter, &assoc_req->ssid, NULL,
103
				IW_MODE_ADHOC);
104 105
		if (bss != NULL) {
			lbs_deb_assoc("SSID found joining\n");
106 107
			memcpy(&assoc_req->bss, bss, sizeof(struct bss_descriptor));
			libertas_join_adhoc_network(priv, assoc_req);
108 109
		} else {
			/* else send START command */
110
			lbs_deb_assoc("SSID not found in list, so creating adhoc"
111
				" with SSID '%s'\n", assoc_req->ssid.ssid);
112 113 114
			memcpy(&assoc_req->bss.ssid, &assoc_req->ssid,
				sizeof(struct WLAN_802_11_SSID));
			libertas_start_adhoc_network(priv, assoc_req);
115 116 117
		}
	}

118
	lbs_deb_leave_args(LBS_DEB_ASSOC, "ret %d", ret);
119 120 121 122 123 124 125 126
	return ret;
}


static int assoc_helper_bssid(wlan_private *priv,
                              struct assoc_request * assoc_req)
{
	wlan_adapter *adapter = priv->adapter;
127 128
	int ret = 0;
	struct bss_descriptor * bss;
129

130
	lbs_deb_enter_args(LBS_DEB_ASSOC, "BSSID" MAC_FMT "\n",
131 132 133
		MAC_ARG(assoc_req->bssid));

	/* Search for index position in list for requested MAC */
134
	bss = libertas_find_BSSID_in_list(adapter, assoc_req->bssid,
135
			    assoc_req->mode);
136
	if (bss == NULL) {
137
		lbs_deb_assoc("ASSOC: WAP: BSSID " MAC_FMT " not found, "
138 139 140 141
			"cannot associate.\n", MAC_ARG(assoc_req->bssid));
		goto out;
	}

142
	memcpy(&assoc_req->bss, bss, sizeof(struct bss_descriptor));
143
	if (assoc_req->mode == IW_MODE_INFRA) {
144
		ret = wlan_associate(priv, assoc_req);
145
		lbs_deb_assoc("ASSOC: wlan_associate(bssid) returned %d\n", ret);
146
	} else if (assoc_req->mode == IW_MODE_ADHOC) {
147
		libertas_join_adhoc_network(priv, assoc_req);
148 149 150
	}

out:
151
	lbs_deb_leave_args(LBS_DEB_ASSOC, "ret %d", ret);
152 153 154 155 156 157 158 159 160 161 162 163 164 165 166 167 168
	return ret;
}


static int assoc_helper_associate(wlan_private *priv,
                                  struct assoc_request * assoc_req)
{
	int ret = 0, done = 0;

	/* If we're given and 'any' BSSID, try associating based on SSID */

	if (test_bit(ASSOC_FLAG_BSSID, &assoc_req->flags)) {
		if (memcmp(bssid_any, assoc_req->bssid, ETH_ALEN)
		    && memcmp(bssid_off, assoc_req->bssid, ETH_ALEN)) {
			ret = assoc_helper_bssid(priv, assoc_req);
			done = 1;
			if (ret) {
169
				lbs_deb_assoc("ASSOC: bssid: ret = %d\n", ret);
170 171 172 173 174 175 176
			}
		}
	}

	if (!done && test_bit(ASSOC_FLAG_SSID, &assoc_req->flags)) {
		ret = assoc_helper_essid(priv, assoc_req);
		if (ret) {
177
			lbs_deb_assoc("ASSOC: bssid: ret = %d\n", ret);
178 179 180 181 182 183 184 185 186 187 188 189 190
		}
	}

	return ret;
}


static int assoc_helper_mode(wlan_private *priv,
                             struct assoc_request * assoc_req)
{
	wlan_adapter *adapter = priv->adapter;
	int ret = 0;

191
	lbs_deb_enter(LBS_DEB_ASSOC);
192

193 194
	if (assoc_req->mode == adapter->mode)
		goto done;
195

196
	if (assoc_req->mode == IW_MODE_INFRA) {
197 198 199 200 201
		if (adapter->psstate != PS_STATE_FULL_POWER)
			libertas_ps_wakeup(priv, cmd_option_waitforrsp);
		adapter->psmode = wlan802_11powermodecam;
	}

202
	adapter->mode = assoc_req->mode;
203 204 205 206
	ret = libertas_prepare_and_send_command(priv,
				    cmd_802_11_snmp_mib,
				    0, cmd_option_waitforrsp,
				    OID_802_11_INFRASTRUCTURE_MODE,
207
				    (void *) (size_t) assoc_req->mode);
208

209 210
done:
	lbs_deb_leave_args(LBS_DEB_ASSOC, "ret %d", ret);
211 212 213 214
	return ret;
}


215 216 217 218 219 220 221 222 223 224 225 226 227 228 229 230 231 232 233 234 235 236 237 238 239 240 241 242 243 244 245 246 247 248 249 250 251 252 253 254 255 256 257 258 259 260 261 262 263 264 265 266 267 268 269 270 271 272 273 274 275 276 277
static int update_channel(wlan_private * priv)
{
	/* the channel in f/w could be out of sync, get the current channel */
	return libertas_prepare_and_send_command(priv, cmd_802_11_rf_channel,
				    cmd_opt_802_11_rf_channel_get,
				    cmd_option_waitforrsp, 0, NULL);
}

static int assoc_helper_channel(wlan_private *priv,
                                struct assoc_request * assoc_req)
{
	wlan_adapter *adapter = priv->adapter;
	int ret = 0;

	lbs_deb_enter(LBS_DEB_ASSOC);

	ret = update_channel(priv);
	if (ret < 0) {
		lbs_deb_assoc("ASSOC: channel: error getting channel.");
	}

	if (assoc_req->channel == adapter->curbssparams.channel)
		goto done;

	lbs_deb_assoc("ASSOC: channel: %d -> %d\n",
	       adapter->curbssparams.channel, assoc_req->channel);

	ret = libertas_prepare_and_send_command(priv, cmd_802_11_rf_channel,
				cmd_opt_802_11_rf_channel_set,
				cmd_option_waitforrsp, 0, &assoc_req->channel);
	if (ret < 0) {
		lbs_deb_assoc("ASSOC: channel: error setting channel.");
	}

	ret = update_channel(priv);
	if (ret < 0) {
		lbs_deb_assoc("ASSOC: channel: error getting channel.");
	}

	if (assoc_req->channel != adapter->curbssparams.channel) {
		lbs_deb_assoc("ASSOC: channel: failed to update channel to %d",
		              assoc_req->channel);
		goto done;
	}

	if (   assoc_req->secinfo.wep_enabled
	    &&   (assoc_req->wep_keys[0].len
	       || assoc_req->wep_keys[1].len
	       || assoc_req->wep_keys[2].len
	       || assoc_req->wep_keys[3].len)) {
		/* Make sure WEP keys are re-sent to firmware */
		set_bit(ASSOC_FLAG_WEP_KEYS, &assoc_req->flags);
	}

	/* Must restart/rejoin adhoc networks after channel change */
	set_bit(ASSOC_FLAG_SSID, &assoc_req->flags);

done:
	lbs_deb_leave_args(LBS_DEB_ASSOC, "ret %d", ret);
	return ret;
}


278 279 280 281 282 283 284
static int assoc_helper_wep_keys(wlan_private *priv,
                                 struct assoc_request * assoc_req)
{
	wlan_adapter *adapter = priv->adapter;
	int i;
	int ret = 0;

285
	lbs_deb_enter(LBS_DEB_ASSOC);
286 287 288 289 290 291 292 293 294 295 296 297 298 299 300 301 302 303 304 305 306 307 308

	/* Set or remove WEP keys */
	if (   assoc_req->wep_keys[0].len
	    || assoc_req->wep_keys[1].len
	    || assoc_req->wep_keys[2].len
	    || assoc_req->wep_keys[3].len) {
		ret = libertas_prepare_and_send_command(priv,
					    cmd_802_11_set_wep,
					    cmd_act_add,
					    cmd_option_waitforrsp,
					    0, assoc_req);
	} else {
		ret = libertas_prepare_and_send_command(priv,
					    cmd_802_11_set_wep,
					    cmd_act_remove,
					    cmd_option_waitforrsp,
					    0, NULL);
	}

	if (ret)
		goto out;

	/* enable/disable the MAC's WEP packet filter */
309
	if (assoc_req->secinfo.wep_enabled)
310 311 312 313 314 315 316 317 318 319 320 321 322 323 324 325 326 327 328
		adapter->currentpacketfilter |= cmd_act_mac_wep_enable;
	else
		adapter->currentpacketfilter &= ~cmd_act_mac_wep_enable;
	ret = libertas_set_mac_packet_filter(priv);
	if (ret)
		goto out;

	mutex_lock(&adapter->lock);

	/* Copy WEP keys into adapter wep key fields */
	for (i = 0; i < 4; i++) {
		memcpy(&adapter->wep_keys[i], &assoc_req->wep_keys[i],
			sizeof(struct WLAN_802_11_KEY));
	}
	adapter->wep_tx_keyidx = assoc_req->wep_tx_keyidx;

	mutex_unlock(&adapter->lock);

out:
329
	lbs_deb_leave_args(LBS_DEB_ASSOC, "ret %d", ret);
330 331 332 333 334 335 336 337 338
	return ret;
}

static int assoc_helper_secinfo(wlan_private *priv,
                                struct assoc_request * assoc_req)
{
	wlan_adapter *adapter = priv->adapter;
	int ret = 0;

339
	lbs_deb_enter(LBS_DEB_ASSOC);
340 341 342 343 344 345

	memcpy(&adapter->secinfo, &assoc_req->secinfo,
		sizeof(struct wlan_802_11_security));

	ret = libertas_set_mac_packet_filter(priv);

346
	lbs_deb_leave_args(LBS_DEB_ASSOC, "ret %d", ret);
347 348 349 350 351 352 353 354 355
	return ret;
}


static int assoc_helper_wpa_keys(wlan_private *priv,
                                 struct assoc_request * assoc_req)
{
	int ret = 0;

356
	lbs_deb_enter(LBS_DEB_ASSOC);
357 358 359 360 361 362 363 364 365 366 367 368 369 370 371 372 373

	/* enable/Disable RSN */
	ret = libertas_prepare_and_send_command(priv,
				    cmd_802_11_enable_rsn,
				    cmd_act_set,
				    cmd_option_waitforrsp,
				    0, assoc_req);
	if (ret)
		goto out;

	ret = libertas_prepare_and_send_command(priv,
				    cmd_802_11_key_material,
				    cmd_act_set,
				    cmd_option_waitforrsp,
				    0, assoc_req);

out:
374
	lbs_deb_leave_args(LBS_DEB_ASSOC, "ret %d", ret);
375 376 377 378 379 380 381 382 383 384
	return ret;
}


static int assoc_helper_wpa_ie(wlan_private *priv,
                               struct assoc_request * assoc_req)
{
	wlan_adapter *adapter = priv->adapter;
	int ret = 0;

385
	lbs_deb_enter(LBS_DEB_ASSOC);
386 387 388 389 390 391 392 393 394

	if (assoc_req->secinfo.WPAenabled || assoc_req->secinfo.WPA2enabled) {
		memcpy(&adapter->wpa_ie, &assoc_req->wpa_ie, assoc_req->wpa_ie_len);
		adapter->wpa_ie_len = assoc_req->wpa_ie_len;
	} else {
		memset(&adapter->wpa_ie, 0, MAX_WPA_IE_LEN);
		adapter->wpa_ie_len = 0;
	}

395
	lbs_deb_leave_args(LBS_DEB_ASSOC, "ret %d", ret);
396 397 398 399 400 401 402 403 404 405 406
	return ret;
}


static int should_deauth_infrastructure(wlan_adapter *adapter,
                                        struct assoc_request * assoc_req)
{
	if (adapter->connect_status != libertas_connected)
		return 0;

	if (test_bit(ASSOC_FLAG_SSID, &assoc_req->flags)) {
407
		lbs_deb_assoc("Deauthenticating due to new SSID in "
408 409 410 411 412
			" configuration request.\n");
		return 1;
	}

	if (test_bit(ASSOC_FLAG_SECINFO, &assoc_req->flags)) {
413
		if (adapter->secinfo.auth_mode != assoc_req->secinfo.auth_mode) {
414
			lbs_deb_assoc("Deauthenticating due to updated security "
415 416 417 418 419 420
				"info in configuration request.\n");
			return 1;
		}
	}

	if (test_bit(ASSOC_FLAG_BSSID, &assoc_req->flags)) {
421
		lbs_deb_assoc("Deauthenticating due to new BSSID in "
422 423 424 425 426 427
			" configuration request.\n");
		return 1;
	}

	/* FIXME: deal with 'auto' mode somehow */
	if (test_bit(ASSOC_FLAG_MODE, &assoc_req->flags)) {
428
		if (assoc_req->mode != IW_MODE_INFRA)
429 430 431 432 433 434 435 436 437 438 439 440 441 442 443 444
			return 1;
	}

	return 0;
}


static int should_stop_adhoc(wlan_adapter *adapter,
                             struct assoc_request * assoc_req)
{
	if (adapter->connect_status != libertas_connected)
		return 0;

	if (adapter->curbssparams.ssid.ssidlength != assoc_req->ssid.ssidlength)
		return 1;
	if (memcmp(adapter->curbssparams.ssid.ssid, assoc_req->ssid.ssid,
445
			adapter->curbssparams.ssid.ssidlength))
446 447 448 449
		return 1;

	/* FIXME: deal with 'auto' mode somehow */
	if (test_bit(ASSOC_FLAG_MODE, &assoc_req->flags)) {
450
		if (assoc_req->mode != IW_MODE_ADHOC)
451 452 453
			return 1;
	}

454 455 456 457 458
	if (test_bit(ASSOC_FLAG_CHANNEL, &assoc_req->flags)) {
		if (assoc_req->channel != adapter->curbssparams.channel)
			return 1;
	}

459 460 461 462
	return 0;
}


463
void libertas_association_worker(struct work_struct *work)
464 465 466 467 468 469 470
{
	wlan_private *priv = container_of(work, wlan_private, assoc_work.work);
	wlan_adapter *adapter = priv->adapter;
	struct assoc_request * assoc_req = NULL;
	int ret = 0;
	int find_any_ssid = 0;

471
	lbs_deb_enter(LBS_DEB_ASSOC);
472 473

	mutex_lock(&adapter->lock);
474 475 476
	assoc_req = adapter->pending_assoc_req;
	adapter->pending_assoc_req = NULL;
	adapter->in_progress_assoc_req = assoc_req;
477 478
	mutex_unlock(&adapter->lock);

479 480
	if (!assoc_req)
		goto done;
481

482
	print_assoc_req(__func__, assoc_req);
483 484 485 486 487 488 489 490 491 492 493 494 495 496

	/* If 'any' SSID was specified, find an SSID to associate with */
	if (test_bit(ASSOC_FLAG_SSID, &assoc_req->flags)
	    && !assoc_req->ssid.ssidlength)
		find_any_ssid = 1;

	/* But don't use 'any' SSID if there's a valid locked BSSID to use */
	if (test_bit(ASSOC_FLAG_BSSID, &assoc_req->flags)) {
		if (memcmp(&assoc_req->bssid, bssid_any, ETH_ALEN)
		    && memcmp(&assoc_req->bssid, bssid_off, ETH_ALEN))
			find_any_ssid = 0;
	}

	if (find_any_ssid) {
497
		u8 new_mode;
498 499 500 501

		ret = libertas_find_best_network_SSID(priv, &assoc_req->ssid,
				assoc_req->mode, &new_mode);
		if (ret) {
502
			lbs_deb_assoc("Could not find best network\n");
503 504 505 506 507
			ret = -ENETUNREACH;
			goto out;
		}

		/* Ensure we switch to the mode of the AP */
508
		if (assoc_req->mode == IW_MODE_AUTO) {
509 510 511 512 513 514 515 516 517
			set_bit(ASSOC_FLAG_MODE, &assoc_req->flags);
			assoc_req->mode = new_mode;
		}
	}

	/*
	 * Check if the attributes being changing require deauthentication
	 * from the currently associated infrastructure access point.
	 */
518
	if (adapter->mode == IW_MODE_INFRA) {
519 520 521
		if (should_deauth_infrastructure(adapter, assoc_req)) {
			ret = libertas_send_deauthentication(priv);
			if (ret) {
522
				lbs_deb_assoc("Deauthentication due to new "
523 524 525 526
					"configuration request failed: %d\n",
					ret);
			}
		}
527
	} else if (adapter->mode == IW_MODE_ADHOC) {
528 529 530
		if (should_stop_adhoc(adapter, assoc_req)) {
			ret = libertas_stop_adhoc_network(priv);
			if (ret) {
531
				lbs_deb_assoc("Teardown of AdHoc network due to "
532 533 534 535 536 537 538 539 540 541 542
					"new configuration request failed: %d\n",
					ret);
			}

		}
	}

	/* Send the various configuration bits to the firmware */
	if (test_bit(ASSOC_FLAG_MODE, &assoc_req->flags)) {
		ret = assoc_helper_mode(priv, assoc_req);
		if (ret) {
543
lbs_deb_assoc("ASSOC(:%d) mode: ret = %d\n", __LINE__, ret);
544 545 546 547
			goto out;
		}
	}

548 549 550 551 552 553 554 555 556
	if (test_bit(ASSOC_FLAG_CHANNEL, &assoc_req->flags)) {
		ret = assoc_helper_channel(priv, assoc_req);
		if (ret) {
			lbs_deb_assoc("ASSOC(:%d) channel: ret = %d\n",
			              __LINE__, ret);
			goto out;
		}
	}

557 558 559 560
	if (   test_bit(ASSOC_FLAG_WEP_KEYS, &assoc_req->flags)
	    || test_bit(ASSOC_FLAG_WEP_TX_KEYIDX, &assoc_req->flags)) {
		ret = assoc_helper_wep_keys(priv, assoc_req);
		if (ret) {
561
lbs_deb_assoc("ASSOC(:%d) wep_keys: ret = %d\n", __LINE__, ret);
562 563 564 565 566 567 568
			goto out;
		}
	}

	if (test_bit(ASSOC_FLAG_SECINFO, &assoc_req->flags)) {
		ret = assoc_helper_secinfo(priv, assoc_req);
		if (ret) {
569
lbs_deb_assoc("ASSOC(:%d) secinfo: ret = %d\n", __LINE__, ret);
570 571 572 573 574 575 576
			goto out;
		}
	}

	if (test_bit(ASSOC_FLAG_WPA_IE, &assoc_req->flags)) {
		ret = assoc_helper_wpa_ie(priv, assoc_req);
		if (ret) {
577
lbs_deb_assoc("ASSOC(:%d) wpa_ie: ret = %d\n", __LINE__, ret);
578 579 580 581 582 583 584 585
			goto out;
		}
	}

	if (test_bit(ASSOC_FLAG_WPA_MCAST_KEY, &assoc_req->flags)
	    || test_bit(ASSOC_FLAG_WPA_UCAST_KEY, &assoc_req->flags)) {
		ret = assoc_helper_wpa_keys(priv, assoc_req);
		if (ret) {
586
lbs_deb_assoc("ASSOC(:%d) wpa_keys: ret = %d\n", __LINE__, ret);
587 588 589 590 591 592 593 594 595 596 597 598 599
			goto out;
		}
	}

	/* SSID/BSSID should be the _last_ config option set, because they
	 * trigger the association attempt.
	 */
	if (test_bit(ASSOC_FLAG_BSSID, &assoc_req->flags)
	    || test_bit(ASSOC_FLAG_SSID, &assoc_req->flags)) {
		int success = 1;

		ret = assoc_helper_associate(priv, assoc_req);
		if (ret) {
600
			lbs_deb_assoc("ASSOC: association attempt unsuccessful: %d\n",
601 602 603 604 605
				ret);
			success = 0;
		}

		if (adapter->connect_status != libertas_connected) {
606
			lbs_deb_assoc("ASSOC: assoication attempt unsuccessful, "
607 608 609 610 611
				"not connected.\n");
			success = 0;
		}

		if (success) {
612
			lbs_deb_assoc("ASSOC: association attempt successful. "
613
				"Associated to '%s' (" MAC_FMT ")\n",
614 615 616
				libertas_escape_essid(adapter->curbssparams.ssid.ssid,
				             adapter->curbssparams.ssid.ssidlength),
				MAC_ARG(adapter->curbssparams.bssid));
617 618 619 620 621 622 623 624 625 626 627 628 629 630 631
			libertas_prepare_and_send_command(priv,
				cmd_802_11_rssi,
				0, cmd_option_waitforrsp, 0, NULL);

			libertas_prepare_and_send_command(priv,
				cmd_802_11_get_log,
				0, cmd_option_waitforrsp, 0, NULL);
		} else {

			ret = -1;
		}
	}

out:
	if (ret) {
632
		lbs_deb_assoc("ASSOC: reconfiguration attempt unsuccessful: %d\n",
633 634
			ret);
	}
635 636 637 638

	mutex_lock(&adapter->lock);
	adapter->in_progress_assoc_req = NULL;
	mutex_unlock(&adapter->lock);
639
	kfree(assoc_req);
640 641 642

done:
	lbs_deb_leave(LBS_DEB_ASSOC);
643 644 645 646 647 648 649 650 651 652
}


/*
 * Caller MUST hold any necessary locks
 */
struct assoc_request * wlan_get_association_request(wlan_adapter *adapter)
{
	struct assoc_request * assoc_req;

653 654 655 656
	if (!adapter->pending_assoc_req) {
		adapter->pending_assoc_req = kzalloc(sizeof(struct assoc_request),
		                                     GFP_KERNEL);
		if (!adapter->pending_assoc_req) {
657 658 659 660 661 662 663 664 665
			lbs_pr_info("Not enough memory to allocate association"
				" request!\n");
			return NULL;
		}
	}

	/* Copy current configuration attributes to the association request,
	 * but don't overwrite any that are already set.
	 */
666
	assoc_req = adapter->pending_assoc_req;
667
	if (!test_bit(ASSOC_FLAG_SSID, &assoc_req->flags)) {
668 669
		memcpy(&assoc_req->ssid, &adapter->curbssparams.ssid,
		       sizeof(struct WLAN_802_11_SSID));
670 671 672 673 674
	}

	if (!test_bit(ASSOC_FLAG_CHANNEL, &assoc_req->flags))
		assoc_req->channel = adapter->curbssparams.channel;

675 676 677
	if (!test_bit(ASSOC_FLAG_BAND, &assoc_req->flags))
		assoc_req->band = adapter->curbssparams.band;

678
	if (!test_bit(ASSOC_FLAG_MODE, &assoc_req->flags))
679
		assoc_req->mode = adapter->mode;
680 681 682 683 684 685 686 687 688 689 690 691 692 693 694 695 696 697 698 699 700 701 702 703 704 705 706 707 708 709 710 711 712 713 714 715 716 717

	if (!test_bit(ASSOC_FLAG_BSSID, &assoc_req->flags)) {
		memcpy(&assoc_req->bssid, adapter->curbssparams.bssid,
			ETH_ALEN);
	}

	if (!test_bit(ASSOC_FLAG_WEP_KEYS, &assoc_req->flags)) {
		int i;
		for (i = 0; i < 4; i++) {
			memcpy(&assoc_req->wep_keys[i], &adapter->wep_keys[i],
				sizeof(struct WLAN_802_11_KEY));
		}
	}

	if (!test_bit(ASSOC_FLAG_WEP_TX_KEYIDX, &assoc_req->flags))
		assoc_req->wep_tx_keyidx = adapter->wep_tx_keyidx;

	if (!test_bit(ASSOC_FLAG_WPA_MCAST_KEY, &assoc_req->flags)) {
		memcpy(&assoc_req->wpa_mcast_key, &adapter->wpa_mcast_key,
			sizeof(struct WLAN_802_11_KEY));
	}

	if (!test_bit(ASSOC_FLAG_WPA_UCAST_KEY, &assoc_req->flags)) {
		memcpy(&assoc_req->wpa_unicast_key, &adapter->wpa_unicast_key,
			sizeof(struct WLAN_802_11_KEY));
	}

	if (!test_bit(ASSOC_FLAG_SECINFO, &assoc_req->flags)) {
		memcpy(&assoc_req->secinfo, &adapter->secinfo,
			sizeof(struct wlan_802_11_security));
	}

	if (!test_bit(ASSOC_FLAG_WPA_IE, &assoc_req->flags)) {
		memcpy(&assoc_req->wpa_ie, &adapter->wpa_ie,
			MAX_WPA_IE_LEN);
		assoc_req->wpa_ie_len = adapter->wpa_ie_len;
	}

718 719
	print_assoc_req(__func__, assoc_req);

720 721
	return assoc_req;
}