wext.c 57.3 KB
Newer Older
1 2 3 4 5 6 7 8 9 10
/**
  * This file contains ioctl functions
  */
#include <linux/ctype.h>
#include <linux/delay.h>
#include <linux/if.h>
#include <linux/if_arp.h>
#include <linux/wireless.h>
#include <linux/bitops.h>

11
#include <net/lib80211.h>
12 13 14 15 16 17 18 19
#include <net/iw_handler.h>

#include "host.h"
#include "radiotap.h"
#include "decl.h"
#include "defs.h"
#include "dev.h"
#include "wext.h"
20
#include "scan.h"
21
#include "assoc.h"
22
#include "cmd.h"
23 24


25
static inline void lbs_postpone_association_work(struct lbs_private *priv)
26
{
27
	if (priv->surpriseremoved)
28 29 30 31 32
		return;
	cancel_delayed_work(&priv->assoc_work);
	queue_delayed_work(priv->work_thread, &priv->assoc_work, HZ / 2);
}

33 34 35 36 37 38 39 40
static inline void lbs_do_association_work(struct lbs_private *priv)
{
	if (priv->surpriseremoved)
		return;
	cancel_delayed_work(&priv->assoc_work);
	queue_delayed_work(priv->work_thread, &priv->assoc_work, 0);
}

41
static inline void lbs_cancel_association_work(struct lbs_private *priv)
42 43
{
	cancel_delayed_work(&priv->assoc_work);
44 45
	kfree(priv->pending_assoc_req);
	priv->pending_assoc_req = NULL;
46 47
}

48 49 50 51 52 53 54 55 56
void lbs_send_disconnect_notification(struct lbs_private *priv)
{
	union iwreq_data wrqu;

	memset(wrqu.ap_addr.sa_data, 0x00, ETH_ALEN);
	wrqu.ap_addr.sa_family = ARPHRD_ETHER;
	wireless_send_event(priv->dev, SIOCGIWAP, &wrqu, NULL);
}

57 58 59 60 61 62 63 64 65 66 67 68 69 70 71 72 73 74 75 76 77 78 79 80
void lbs_send_iwevcustom_event(struct lbs_private *priv, s8 *str)
{
	union iwreq_data iwrq;
	u8 buf[50];

	lbs_deb_enter(LBS_DEB_WEXT);

	memset(&iwrq, 0, sizeof(union iwreq_data));
	memset(buf, 0, sizeof(buf));

	snprintf(buf, sizeof(buf) - 1, "%s", str);

	iwrq.data.length = strlen(buf) + 1 + IW_EV_LCP_LEN;

	/* Send Event to upper layer */
	lbs_deb_wext("event indication string %s\n", (char *)buf);
	lbs_deb_wext("event indication length %d\n", iwrq.data.length);
	lbs_deb_wext("sending wireless event IWEVCUSTOM for %s\n", str);

	wireless_send_event(priv->dev, IWEVCUSTOM, &iwrq, buf);

	lbs_deb_leave(LBS_DEB_WEXT);
}

81 82 83
/**
 *  @brief Find the channel frequency power info with specific channel
 *
84
 *  @param priv 	A pointer to struct lbs_private structure
85 86 87 88
 *  @param band		it can be BAND_A, BAND_G or BAND_B
 *  @param channel      the channel for looking
 *  @return 	   	A pointer to struct chan_freq_power structure or NULL if not find.
 */
89
struct chan_freq_power *lbs_find_cfp_by_band_and_channel(
90
	struct lbs_private *priv,
91 92
	u8 band,
	u16 channel)
93 94 95 96 97
{
	struct chan_freq_power *cfp = NULL;
	struct region_channel *rc;
	int i, j;

98 99
	for (j = 0; !cfp && (j < ARRAY_SIZE(priv->region_channel)); j++) {
		rc = &priv->region_channel[j];
100 101 102 103 104 105 106 107 108 109 110 111 112 113

		if (!rc->valid || !rc->CFP)
			continue;
		if (rc->band != band)
			continue;
		for (i = 0; i < rc->nrcfp; i++) {
			if (rc->CFP[i].channel == channel) {
				cfp = &rc->CFP[i];
				break;
			}
		}
	}

	if (!cfp && channel)
114
		lbs_deb_wext("lbs_find_cfp_by_band_and_channel: can't find "
115
		       "cfp by band %d / channel %d\n", band, channel);
116 117 118 119 120 121 122

	return cfp;
}

/**
 *  @brief Find the channel frequency power info with specific frequency
 *
123
 *  @param priv 	A pointer to struct lbs_private structure
124 125 126 127
 *  @param band		it can be BAND_A, BAND_G or BAND_B
 *  @param freq	        the frequency for looking
 *  @return 	   	A pointer to struct chan_freq_power structure or NULL if not find.
 */
128
static struct chan_freq_power *find_cfp_by_band_and_freq(
129
	struct lbs_private *priv,
130 131
	u8 band,
	u32 freq)
132 133 134 135 136
{
	struct chan_freq_power *cfp = NULL;
	struct region_channel *rc;
	int i, j;

137 138
	for (j = 0; !cfp && (j < ARRAY_SIZE(priv->region_channel)); j++) {
		rc = &priv->region_channel[j];
139 140 141 142 143 144 145 146 147 148 149 150 151 152

		if (!rc->valid || !rc->CFP)
			continue;
		if (rc->band != band)
			continue;
		for (i = 0; i < rc->nrcfp; i++) {
			if (rc->CFP[i].freq == freq) {
				cfp = &rc->CFP[i];
				break;
			}
		}
	}

	if (!cfp && freq)
153 154
		lbs_deb_wext("find_cfp_by_band_and_freql: can't find cfp by "
		       "band %d / freq %d\n", band, freq);
155 156 157 158 159

	return cfp;
}

/**
160
 *  @brief Copy active data rates based on adapter mode and status
161
 *
162
 *  @param priv              A pointer to struct lbs_private structure
163 164
 *  @param rate		        The buf to return the active rates
 */
165
static void copy_active_data_rates(struct lbs_private *priv, u8 *rates)
166
{
167
	lbs_deb_enter(LBS_DEB_WEXT);
168

169 170
	if ((priv->connect_status != LBS_CONNECTED) &&
		(priv->mesh_connect_status != LBS_CONNECTED))
171
		memcpy(rates, lbs_bg_rates, MAX_RATES);
172
	else
173
		memcpy(rates, priv->curbssparams.rates, MAX_RATES);
174

175
	lbs_deb_leave(LBS_DEB_WEXT);
176 177
}

178
static int lbs_get_name(struct net_device *dev, struct iw_request_info *info,
179 180 181
			 char *cwrq, char *extra)
{

182
	lbs_deb_enter(LBS_DEB_WEXT);
183

184 185
	/* We could add support for 802.11n here as needed. Jean II */
	snprintf(cwrq, IFNAMSIZ, "IEEE 802.11b/g");
186

187
	lbs_deb_leave(LBS_DEB_WEXT);
188 189 190
	return 0;
}

191
static int lbs_get_freq(struct net_device *dev, struct iw_request_info *info,
192 193
			 struct iw_freq *fwrq, char *extra)
{
194
	struct lbs_private *priv = dev->ml_priv;
195 196
	struct chan_freq_power *cfp;

197
	lbs_deb_enter(LBS_DEB_WEXT);
198

199
	cfp = lbs_find_cfp_by_band_and_channel(priv, 0,
200
					   priv->channel);
201 202

	if (!cfp) {
203
		if (priv->channel)
204
			lbs_deb_wext("invalid channel %d\n",
205
			       priv->channel);
206 207 208 209 210 211
		return -EINVAL;
	}

	fwrq->m = (long)cfp->freq * 100000;
	fwrq->e = 1;

212 213
	lbs_deb_wext("freq %u\n", fwrq->m);
	lbs_deb_leave(LBS_DEB_WEXT);
214 215 216
	return 0;
}

217
static int lbs_get_wap(struct net_device *dev, struct iw_request_info *info,
218 219
			struct sockaddr *awrq, char *extra)
{
220
	struct lbs_private *priv = dev->ml_priv;
221

222
	lbs_deb_enter(LBS_DEB_WEXT);
223

224 225
	if (priv->connect_status == LBS_CONNECTED) {
		memcpy(awrq->sa_data, priv->curbssparams.bssid, ETH_ALEN);
226 227 228 229 230
	} else {
		memset(awrq->sa_data, 0, ETH_ALEN);
	}
	awrq->sa_family = ARPHRD_ETHER;

231
	lbs_deb_leave(LBS_DEB_WEXT);
232 233 234
	return 0;
}

235
static int lbs_set_nick(struct net_device *dev, struct iw_request_info *info,
236 237
			 struct iw_point *dwrq, char *extra)
{
238
	struct lbs_private *priv = dev->ml_priv;
239

240
	lbs_deb_enter(LBS_DEB_WEXT);
241 242 243 244 245 246 247 248 249

	/*
	 * Check the size of the string
	 */

	if (dwrq->length > 16) {
		return -E2BIG;
	}

250 251 252 253
	mutex_lock(&priv->lock);
	memset(priv->nodename, 0, sizeof(priv->nodename));
	memcpy(priv->nodename, extra, dwrq->length);
	mutex_unlock(&priv->lock);
254

255
	lbs_deb_leave(LBS_DEB_WEXT);
256 257 258
	return 0;
}

259
static int lbs_get_nick(struct net_device *dev, struct iw_request_info *info,
260 261
			 struct iw_point *dwrq, char *extra)
{
262
	struct lbs_private *priv = dev->ml_priv;
263

264
	lbs_deb_enter(LBS_DEB_WEXT);
265

266 267
	dwrq->length = strlen(priv->nodename);
	memcpy(extra, priv->nodename, dwrq->length);
268
	extra[dwrq->length] = '\0';
269

270
	dwrq->flags = 1;	/* active */
271

272
	lbs_deb_leave(LBS_DEB_WEXT);
273 274 275
	return 0;
}

276 277 278
static int mesh_get_nick(struct net_device *dev, struct iw_request_info *info,
			 struct iw_point *dwrq, char *extra)
{
279
	struct lbs_private *priv = dev->ml_priv;
280 281 282 283 284

	lbs_deb_enter(LBS_DEB_WEXT);

	/* Use nickname to indicate that mesh is on */

285
	if (priv->mesh_connect_status == LBS_CONNECTED) {
286 287
		strncpy(extra, "Mesh", 12);
		extra[12] = '\0';
288
		dwrq->length = strlen(extra);
289 290 291 292
	}

	else {
		extra[0] = '\0';
293
		dwrq->length = 0;
294 295 296 297 298
	}

	lbs_deb_leave(LBS_DEB_WEXT);
	return 0;
}
299

300
static int lbs_set_rts(struct net_device *dev, struct iw_request_info *info,
301 302 303
			struct iw_param *vwrq, char *extra)
{
	int ret = 0;
304
	struct lbs_private *priv = dev->ml_priv;
305
	u32 val = vwrq->value;
306

307
	lbs_deb_enter(LBS_DEB_WEXT);
308

309 310
	if (vwrq->disabled)
		val = MRVDRV_RTS_MAX_VALUE;
311

312
	if (val > MRVDRV_RTS_MAX_VALUE) /* min rts value is 0 */
313 314 315
		return -EINVAL;

	ret = lbs_set_snmp_mib(priv, SNMP_MIB_OID_RTS_THRESHOLD, (u16) val);
316

317
	lbs_deb_leave_args(LBS_DEB_WEXT, "ret %d", ret);
318 319 320
	return ret;
}

321
static int lbs_get_rts(struct net_device *dev, struct iw_request_info *info,
322 323
			struct iw_param *vwrq, char *extra)
{
324
	struct lbs_private *priv = dev->ml_priv;
325 326
	int ret = 0;
	u16 val = 0;
327

328
	lbs_deb_enter(LBS_DEB_WEXT);
329

330
	ret = lbs_get_snmp_mib(priv, SNMP_MIB_OID_RTS_THRESHOLD, &val);
331 332
	if (ret)
		goto out;
333

334
	vwrq->value = val;
335
	vwrq->disabled = val > MRVDRV_RTS_MAX_VALUE; /* min rts value is 0 */
336 337
	vwrq->fixed = 1;

338 339 340
out:
	lbs_deb_leave_args(LBS_DEB_WEXT, "ret %d", ret);
	return ret;
341 342
}

343
static int lbs_set_frag(struct net_device *dev, struct iw_request_info *info,
344 345
			 struct iw_param *vwrq, char *extra)
{
346
	struct lbs_private *priv = dev->ml_priv;
347 348
	int ret = 0;
	u32 val = vwrq->value;
349

350
	lbs_deb_enter(LBS_DEB_WEXT);
351

352 353 354 355 356
	if (vwrq->disabled)
		val = MRVDRV_FRAG_MAX_VALUE;

	if (val < MRVDRV_FRAG_MIN_VALUE || val > MRVDRV_FRAG_MAX_VALUE)
		return -EINVAL;
357

358
	ret = lbs_set_snmp_mib(priv, SNMP_MIB_OID_FRAG_THRESHOLD, (u16) val);
359 360

	lbs_deb_leave_args(LBS_DEB_WEXT, "ret %d", ret);
361 362 363
	return ret;
}

364
static int lbs_get_frag(struct net_device *dev, struct iw_request_info *info,
365 366
			 struct iw_param *vwrq, char *extra)
{
367
	struct lbs_private *priv = dev->ml_priv;
368 369
	int ret = 0;
	u16 val = 0;
370

371
	lbs_deb_enter(LBS_DEB_WEXT);
372

373
	ret = lbs_get_snmp_mib(priv, SNMP_MIB_OID_FRAG_THRESHOLD, &val);
374 375
	if (ret)
		goto out;
376

377 378 379
	vwrq->value = val;
	vwrq->disabled = ((val < MRVDRV_FRAG_MIN_VALUE)
			  || (val > MRVDRV_FRAG_MAX_VALUE));
380 381
	vwrq->fixed = 1;

382 383
out:
	lbs_deb_leave_args(LBS_DEB_WEXT, "ret %d", ret);
384 385 386
	return ret;
}

387
static int lbs_get_mode(struct net_device *dev,
388 389
			 struct iw_request_info *info, u32 * uwrq, char *extra)
{
390
	struct lbs_private *priv = dev->ml_priv;
391

392
	lbs_deb_enter(LBS_DEB_WEXT);
393

394
	*uwrq = priv->mode;
395

396
	lbs_deb_leave(LBS_DEB_WEXT);
397 398 399
	return 0;
}

400 401 402 403 404 405
static int mesh_wlan_get_mode(struct net_device *dev,
		              struct iw_request_info *info, u32 * uwrq,
			      char *extra)
{
	lbs_deb_enter(LBS_DEB_WEXT);

406
	*uwrq = IW_MODE_REPEAT;
407 408 409 410 411

	lbs_deb_leave(LBS_DEB_WEXT);
	return 0;
}

412
static int lbs_get_txpow(struct net_device *dev,
413 414 415
			  struct iw_request_info *info,
			  struct iw_param *vwrq, char *extra)
{
416
	struct lbs_private *priv = dev->ml_priv;
417
	s16 curlevel = 0;
418
	int ret = 0;
419

420
	lbs_deb_enter(LBS_DEB_WEXT);
421

422 423 424 425 426 427 428
	if (!priv->radio_on) {
		lbs_deb_wext("tx power off\n");
		vwrq->value = 0;
		vwrq->disabled = 1;
		goto out;
	}

429
	ret = lbs_get_tx_power(priv, &curlevel, NULL, NULL);
430 431
	if (ret)
		goto out;
432

433 434
	lbs_deb_wext("tx power level %d dbm\n", curlevel);
	priv->txpower_cur = curlevel;
435

436
	vwrq->value = curlevel;
437
	vwrq->fixed = 1;
438 439
	vwrq->disabled = 0;
	vwrq->flags = IW_TXPOW_DBM;
440

441 442 443
out:
	lbs_deb_leave_args(LBS_DEB_WEXT, "ret %d", ret);
	return ret;
444 445
}

446
static int lbs_set_retry(struct net_device *dev, struct iw_request_info *info,
447 448
			  struct iw_param *vwrq, char *extra)
{
449
	struct lbs_private *priv = dev->ml_priv;
450 451
	int ret = 0;
	u16 slimit = 0, llimit = 0;
452

453
	lbs_deb_enter(LBS_DEB_WEXT);
454

455 456 457 458 459
        if ((vwrq->flags & IW_RETRY_TYPE) != IW_RETRY_LIMIT)
                return -EOPNOTSUPP;

	/* The MAC has a 4-bit Total_Tx_Count register
	   Total_Tx_Count = 1 + Tx_Retry_Count */
460 461
#define TX_RETRY_MIN 0
#define TX_RETRY_MAX 14
462 463
	if (vwrq->value < TX_RETRY_MIN || vwrq->value > TX_RETRY_MAX)
		return -EINVAL;
464

465 466 467 468 469 470 471
	/* Add 1 to convert retry count to try count */
	if (vwrq->flags & IW_RETRY_SHORT)
		slimit = (u16) (vwrq->value + 1);
	else if (vwrq->flags & IW_RETRY_LONG)
		llimit = (u16) (vwrq->value + 1);
	else
		slimit = llimit = (u16) (vwrq->value + 1); /* set both */
472

473 474 475 476 477 478
	if (llimit) {
		ret = lbs_set_snmp_mib(priv, SNMP_MIB_OID_LONG_RETRY_LIMIT,
				       llimit);
		if (ret)
			goto out;
	}
479

480 481 482 483 484
	if (slimit) {
		/* txretrycount follows the short retry limit */
		priv->txretrycount = slimit;
		ret = lbs_set_snmp_mib(priv, SNMP_MIB_OID_SHORT_RETRY_LIMIT,
				       slimit);
485 486
		if (ret)
			goto out;
487 488
	}

489 490 491
out:
	lbs_deb_leave_args(LBS_DEB_WEXT, "ret %d", ret);
	return ret;
492 493
}

494
static int lbs_get_retry(struct net_device *dev, struct iw_request_info *info,
495 496
			  struct iw_param *vwrq, char *extra)
{
497
	struct lbs_private *priv = dev->ml_priv;
498
	int ret = 0;
499
	u16 val = 0;
500

501 502
	lbs_deb_enter(LBS_DEB_WEXT);

503
	vwrq->disabled = 0;
504 505 506 507 508 509 510 511 512 513 514 515 516 517 518 519

	if (vwrq->flags & IW_RETRY_LONG) {
		ret = lbs_get_snmp_mib(priv, SNMP_MIB_OID_LONG_RETRY_LIMIT, &val);
		if (ret)
			goto out;

		/* Subtract 1 to convert try count to retry count */
		vwrq->value = val - 1;
		vwrq->flags = IW_RETRY_LIMIT | IW_RETRY_LONG;
	} else {
		ret = lbs_get_snmp_mib(priv, SNMP_MIB_OID_SHORT_RETRY_LIMIT, &val);
		if (ret)
			goto out;

		/* txretry count follows the short retry limit */
		priv->txretrycount = val;
520
		/* Subtract 1 to convert try count to retry count */
521 522
		vwrq->value = val - 1;
		vwrq->flags = IW_RETRY_LIMIT | IW_RETRY_SHORT;
523 524
	}

525 526 527
out:
	lbs_deb_leave_args(LBS_DEB_WEXT, "ret %d", ret);
	return ret;
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
}

static inline void sort_channels(struct iw_freq *freq, int num)
{
	int i, j;
	struct iw_freq temp;

	for (i = 0; i < num; i++)
		for (j = i + 1; j < num; j++)
			if (freq[i].i > freq[j].i) {
				temp.i = freq[i].i;
				temp.m = freq[i].m;

				freq[i].i = freq[j].i;
				freq[i].m = freq[j].m;

				freq[j].i = temp.i;
				freq[j].m = temp.m;
			}
}

/* data rate listing
	MULTI_BANDS:
		abg		a	b	b/g
   Infra 	G(12)		A(8)	B(4)	G(12)
   Adhoc 	A+B(12)		A(8)	B(4)	B(4)

	non-MULTI_BANDS:
					b	b/g
   Infra 	     		    	B(4)	G(12)
   Adhoc 	      		    	B(4)	B(4)
 */
/**
 *  @brief Get Range Info
 *
 *  @param dev                  A pointer to net_device structure
 *  @param info			A pointer to iw_request_info structure
 *  @param vwrq 		A pointer to iw_param structure
 *  @param extra		A pointer to extra data buf
 *  @return 	   		0 --success, otherwise fail
 */
569
static int lbs_get_range(struct net_device *dev, struct iw_request_info *info,
570 571 572
			  struct iw_point *dwrq, char *extra)
{
	int i, j;
573
	struct lbs_private *priv = dev->ml_priv;
574 575
	struct iw_range *range = (struct iw_range *)extra;
	struct chan_freq_power *cfp;
576
	u8 rates[MAX_RATES + 1];
577

578
	lbs_deb_enter(LBS_DEB_WEXT);
579 580 581 582 583 584 585 586

	dwrq->length = sizeof(struct iw_range);
	memset(range, 0, sizeof(struct iw_range));

	range->min_nwid = 0;
	range->max_nwid = 0;

	memset(rates, 0, sizeof(rates));
587
	copy_active_data_rates(priv, rates);
588 589 590
	range->num_bitrates = strnlen(rates, IW_MAX_BITRATES);
	for (i = 0; i < range->num_bitrates; i++)
		range->bitrate[i] = rates[i] * 500000;
591
	range->num_bitrates = i;
592
	lbs_deb_wext("IW_MAX_BITRATES %d, num_bitrates %d\n", IW_MAX_BITRATES,
593 594 595
	       range->num_bitrates);

	range->num_frequency = 0;
596 597 598

	range->scan_capa = IW_SCAN_CAPA_ESSID;

H
Holger Schurig 已提交
599 600 601
	for (j = 0; (range->num_frequency < IW_MAX_FREQUENCIES)
	     && (j < ARRAY_SIZE(priv->region_channel)); j++) {
		cfp = priv->region_channel[j].CFP;
602
		for (i = 0; (range->num_frequency < IW_MAX_FREQUENCIES)
H
Holger Schurig 已提交
603 604 605 606 607
		     && priv->region_channel[j].valid
		     && cfp
		     && (i < priv->region_channel[j].nrcfp); i++) {
			range->freq[range->num_frequency].i =
			    (long)cfp->channel;
608
			range->freq[range->num_frequency].m =
H
Holger Schurig 已提交
609
			    (long)cfp->freq * 100000;
610
			range->freq[range->num_frequency].e = 1;
H
Holger Schurig 已提交
611
			cfp++;
612 613 614 615
			range->num_frequency++;
		}
	}

616
	lbs_deb_wext("IW_MAX_FREQUENCIES %d, num_frequency %d\n",
617 618 619 620 621 622 623 624 625 626 627 628 629 630 631 632 633 634 635 636 637 638 639 640 641
	       IW_MAX_FREQUENCIES, range->num_frequency);

	range->num_channels = range->num_frequency;

	sort_channels(&range->freq[0], range->num_frequency);

	/*
	 * Set an indication of the max TCP throughput in bit/s that we can
	 * expect using this interface
	 */
	if (i > 2)
		range->throughput = 5000 * 1000;
	else
		range->throughput = 1500 * 1000;

	range->min_rts = MRVDRV_RTS_MIN_VALUE;
	range->max_rts = MRVDRV_RTS_MAX_VALUE;
	range->min_frag = MRVDRV_FRAG_MIN_VALUE;
	range->max_frag = MRVDRV_FRAG_MAX_VALUE;

	range->encoding_size[0] = 5;
	range->encoding_size[1] = 13;
	range->num_encoding_sizes = 2;
	range->max_encoding_tokens = 4;

642 643 644 645
	/*
	 * Right now we support only "iwconfig ethX power on|off"
	 */
	range->pm_capa = IW_POWER_ON;
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

	/*
	 * Minimum version we recommend
	 */
	range->we_version_source = 15;

	/*
	 * Version we are compiled with
	 */
	range->we_version_compiled = WIRELESS_EXT;

	range->retry_capa = IW_RETRY_LIMIT;
	range->retry_flags = IW_RETRY_LIMIT | IW_RETRY_MAX;

	range->min_retry = TX_RETRY_MIN;
	range->max_retry = TX_RETRY_MAX;

	/*
	 * Set the qual, level and noise range values
	 */
	range->max_qual.qual = 100;
	range->max_qual.level = 0;
	range->max_qual.noise = 0;
	range->max_qual.updated = IW_QUAL_ALL_UPDATED | IW_QUAL_DBM;

	range->avg_qual.qual = 70;
	/* TODO: Find real 'good' to 'bad' threshold value for RSSI */
	range->avg_qual.level = 0;
	range->avg_qual.noise = 0;
	range->avg_qual.updated = IW_QUAL_ALL_UPDATED | IW_QUAL_DBM;

	range->sensitivity = 0;

679
	/* Setup the supported power level ranges */
680
	memset(range->txpower, 0, sizeof(range->txpower));
681 682 683 684
	range->txpower_capa = IW_TXPOW_DBM | IW_TXPOW_RANGE;
	range->txpower[0] = priv->txpower_min;
	range->txpower[1] = priv->txpower_max;
	range->num_txpower = 2;
685 686 687 688 689 690

	range->event_capa[0] = (IW_EVENT_CAPA_K_0 |
				IW_EVENT_CAPA_MASK(SIOCGIWAP) |
				IW_EVENT_CAPA_MASK(SIOCGIWSCAN));
	range->event_capa[1] = IW_EVENT_CAPA_K_1;

691
	if (priv->fwcapinfo & FW_CAPINFO_WPA) {
692 693 694 695 696 697
		range->enc_capa =   IW_ENC_CAPA_WPA
		                  | IW_ENC_CAPA_WPA2
		                  | IW_ENC_CAPA_CIPHER_TKIP
		                  | IW_ENC_CAPA_CIPHER_CCMP;
	}

698
	lbs_deb_leave(LBS_DEB_WEXT);
699 700 701
	return 0;
}

702
static int lbs_set_power(struct net_device *dev, struct iw_request_info *info,
703 704
			  struct iw_param *vwrq, char *extra)
{
705
	struct lbs_private *priv = dev->ml_priv;
706
	int ret = 0;
707

708
	lbs_deb_enter(LBS_DEB_WEXT);
709

710
	if (!(priv->fwcapinfo & FW_CAPINFO_PS)) {
711 712 713 714 715 716
		if (vwrq->disabled)
			return 0;
		else
			return -EINVAL;
	}

717 718 719 720 721
	/* PS is currently supported only in Infrastructure mode
	 * Remove this check if it is to be supported in IBSS mode also
	 */

	if (vwrq->disabled) {
722 723
		priv->psmode = LBS802_11POWERMODECAM;
		if (priv->psstate != PS_STATE_FULL_POWER) {
724
			lbs_ps_wakeup(priv, CMD_OPTION_WAITFORRSP);
725 726 727 728 729 730
		}

		return 0;
	}

	if ((vwrq->flags & IW_POWER_TYPE) == IW_POWER_TIMEOUT) {
731 732
		lbs_deb_wext(
		       "setting power timeout is not supported\n");
733 734
		return -EINVAL;
	} else if ((vwrq->flags & IW_POWER_TYPE) == IW_POWER_PERIOD) {
735 736 737 738 739 740 741 742 743 744 745 746 747 748 749 750 751 752 753 754 755 756 757 758 759 760 761 762 763 764 765 766 767 768 769 770 771 772 773 774 775 776 777 778 779 780 781 782
		vwrq->value = vwrq->value / 1000;
		if (!priv->enter_deep_sleep) {
			lbs_pr_err("deep sleep feature is not implemented "
					"for this interface driver\n");
			return -EINVAL;
		}

		if (priv->connect_status == LBS_CONNECTED) {
			if ((priv->is_auto_deep_sleep_enabled) &&
						(vwrq->value == -1000)) {
				lbs_exit_auto_deep_sleep(priv);
				return 0;
			} else {
				lbs_pr_err("can't use deep sleep cmd in "
						"connected state\n");
				return -EINVAL;
			}
		}

		if ((vwrq->value < 0) && (vwrq->value != -1000)) {
			lbs_pr_err("unknown option\n");
			return -EINVAL;
		}

		if (vwrq->value > 0) {
			if (!priv->is_auto_deep_sleep_enabled) {
				priv->is_activity_detected = 0;
				priv->auto_deep_sleep_timeout = vwrq->value;
				lbs_enter_auto_deep_sleep(priv);
			} else {
				priv->auto_deep_sleep_timeout = vwrq->value;
				lbs_deb_debugfs("auto deep sleep: "
						"already enabled\n");
			}
			return 0;
		} else {
			if (priv->is_auto_deep_sleep_enabled) {
				lbs_exit_auto_deep_sleep(priv);
				/* Try to exit deep sleep if auto */
				/*deep sleep disabled */
				ret = lbs_set_deep_sleep(priv, 0);
			}
			if (vwrq->value == 0)
				ret = lbs_set_deep_sleep(priv, 1);
			else if (vwrq->value == -1000)
				ret = lbs_set_deep_sleep(priv, 0);
			return ret;
		}
783 784
	}

785
	if (priv->psmode != LBS802_11POWERMODECAM) {
786 787 788
		return 0;
	}

789
	priv->psmode = LBS802_11POWERMODEMAX_PSP;
790

791
	if (priv->connect_status == LBS_CONNECTED) {
792
		lbs_ps_sleep(priv, CMD_OPTION_WAITFORRSP);
793 794
	}

795
	lbs_deb_leave(LBS_DEB_WEXT);
796

797 798 799
	return 0;
}

800
static int lbs_get_power(struct net_device *dev, struct iw_request_info *info,
801 802
			  struct iw_param *vwrq, char *extra)
{
803
	struct lbs_private *priv = dev->ml_priv;
804

805
	lbs_deb_enter(LBS_DEB_WEXT);
806 807

	vwrq->value = 0;
808 809 810
	vwrq->flags = 0;
	vwrq->disabled = priv->psmode == LBS802_11POWERMODECAM
		|| priv->connect_status == LBS_DISCONNECTED;
811

812
	lbs_deb_leave(LBS_DEB_WEXT);
813 814 815
	return 0;
}

816
static struct iw_statistics *lbs_get_wireless_stats(struct net_device *dev)
817 818 819 820 821 822 823 824 825
{
	enum {
		POOR = 30,
		FAIR = 60,
		GOOD = 80,
		VERY_GOOD = 90,
		EXCELLENT = 95,
		PERFECT = 100
	};
826
	struct lbs_private *priv = dev->ml_priv;
827 828 829
	u32 rssi_qual;
	u32 tx_qual;
	u32 quality = 0;
830
	int ret, stats_valid = 0;
831 832
	u8 rssi;
	u32 tx_retries;
833
	struct cmd_ds_802_11_get_log log;
834

835
	lbs_deb_enter(LBS_DEB_WEXT);
836

837
	priv->wstats.status = priv->mode;
838 839

	/* If we're not associated, all quality values are meaningless */
840 841
	if ((priv->connect_status != LBS_CONNECTED) &&
	    (priv->mesh_connect_status != LBS_CONNECTED))
842 843 844 845
		goto out;

	/* Quality by RSSI */
	priv->wstats.qual.level =
846 847
	    CAL_RSSI(priv->SNR[TYPE_BEACON][TYPE_NOAVG],
	     priv->NF[TYPE_BEACON][TYPE_NOAVG]);
848

849
	if (priv->NF[TYPE_BEACON][TYPE_NOAVG] == 0) {
850 851 852
		priv->wstats.qual.noise = MRVDRV_NF_DEFAULT_SCAN_VALUE;
	} else {
		priv->wstats.qual.noise =
853
		    CAL_NF(priv->NF[TYPE_BEACON][TYPE_NOAVG]);
854 855
	}

856 857
	lbs_deb_wext("signal level %#x\n", priv->wstats.qual.level);
	lbs_deb_wext("noise %#x\n", priv->wstats.qual.noise);
858 859 860 861 862 863 864 865 866 867 868 869 870 871 872 873 874

	rssi = priv->wstats.qual.level - priv->wstats.qual.noise;
	if (rssi < 15)
		rssi_qual = rssi * POOR / 10;
	else if (rssi < 20)
		rssi_qual = (rssi - 15) * (FAIR - POOR) / 5 + POOR;
	else if (rssi < 30)
		rssi_qual = (rssi - 20) * (GOOD - FAIR) / 5 + FAIR;
	else if (rssi < 40)
		rssi_qual = (rssi - 30) * (VERY_GOOD - GOOD) /
		    10 + GOOD;
	else
		rssi_qual = (rssi - 40) * (PERFECT - VERY_GOOD) /
		    10 + VERY_GOOD;
	quality = rssi_qual;

	/* Quality by TX errors */
875
	priv->wstats.discard.retries = dev->stats.tx_errors;
876

877 878
	memset(&log, 0, sizeof(log));
	log.hdr.size = cpu_to_le16(sizeof(log));
879 880 881
	ret = lbs_cmd_with_response(priv, CMD_802_11_GET_LOG, &log);
	if (ret)
		goto out;
882 883

	tx_retries = le32_to_cpu(log.retry);
884 885 886 887 888 889 890 891 892 893 894 895 896 897 898

	if (tx_retries > 75)
		tx_qual = (90 - tx_retries) * POOR / 15;
	else if (tx_retries > 70)
		tx_qual = (75 - tx_retries) * (FAIR - POOR) / 5 + POOR;
	else if (tx_retries > 65)
		tx_qual = (70 - tx_retries) * (GOOD - FAIR) / 5 + FAIR;
	else if (tx_retries > 50)
		tx_qual = (65 - tx_retries) * (VERY_GOOD - GOOD) /
		    15 + GOOD;
	else
		tx_qual = (50 - tx_retries) *
		    (PERFECT - VERY_GOOD) / 50 + VERY_GOOD;
	quality = min(quality, tx_qual);

899
	priv->wstats.discard.code = le32_to_cpu(log.wepundecryptable);
900
	priv->wstats.discard.retries = tx_retries;
901
	priv->wstats.discard.misc = le32_to_cpu(log.ackfailure);
902 903

	/* Calculate quality */
904
	priv->wstats.qual.qual = min_t(u8, quality, 100);
905 906 907 908
	priv->wstats.qual.updated = IW_QUAL_ALL_UPDATED | IW_QUAL_DBM;
	stats_valid = 1;

	/* update stats asynchronously for future calls */
909
	ret = lbs_prepare_and_send_command(priv, CMD_802_11_RSSI, 0,
910
					0, 0, NULL);
911 912
	if (ret)
		lbs_pr_err("RSSI command failed\n");
913 914 915 916 917 918 919 920 921 922 923 924
out:
	if (!stats_valid) {
		priv->wstats.miss.beacon = 0;
		priv->wstats.discard.retries = 0;
		priv->wstats.qual.qual = 0;
		priv->wstats.qual.level = 0;
		priv->wstats.qual.noise = 0;
		priv->wstats.qual.updated = IW_QUAL_ALL_UPDATED;
		priv->wstats.qual.updated |= IW_QUAL_NOISE_INVALID |
		    IW_QUAL_QUAL_INVALID | IW_QUAL_LEVEL_INVALID;
	}

925
	lbs_deb_leave(LBS_DEB_WEXT);
926 927 928 929 930
	return &priv->wstats;


}

931
static int lbs_set_freq(struct net_device *dev, struct iw_request_info *info,
932 933
		  struct iw_freq *fwrq, char *extra)
{
934
	int ret = -EINVAL;
935
	struct lbs_private *priv = dev->ml_priv;
936
	struct chan_freq_power *cfp;
937
	struct assoc_request * assoc_req;
938

939
	lbs_deb_enter(LBS_DEB_WEXT);
940

941 942
	mutex_lock(&priv->lock);
	assoc_req = lbs_get_association_request(priv);
943 944 945 946
	if (!assoc_req) {
		ret = -ENOMEM;
		goto out;
	}
947

948 949
	/* If setting by frequency, convert to a channel */
	if (fwrq->e == 1) {
950 951
		long f = fwrq->m / 100000;

952
		cfp = find_cfp_by_band_and_freq(priv, 0, f);
953
		if (!cfp) {
954
			lbs_deb_wext("invalid freq %ld\n", f);
955
			goto out;
956 957 958
		}

		fwrq->e = 0;
959
		fwrq->m = (int) cfp->channel;
960 961
	}

962
	/* Setting by channel number */
963
	if (fwrq->m > 1000 || fwrq->e > 0) {
964 965
		goto out;
	}
966

967
	cfp = lbs_find_cfp_by_band_and_channel(priv, 0, fwrq->m);
968 969
	if (!cfp) {
		goto out;
970 971
	}

972 973 974
	assoc_req->channel = fwrq->m;
	ret = 0;

975
out:
976 977
	if (ret == 0) {
		set_bit(ASSOC_FLAG_CHANNEL, &assoc_req->flags);
978
		lbs_postpone_association_work(priv);
979
	} else {
980
		lbs_cancel_association_work(priv);
981
	}
982
	mutex_unlock(&priv->lock);
983 984 985

	lbs_deb_leave_args(LBS_DEB_WEXT, "ret %d", ret);
	return ret;
986 987
}

988 989 990 991
static int lbs_mesh_set_freq(struct net_device *dev,
			     struct iw_request_info *info,
			     struct iw_freq *fwrq, char *extra)
{
992
	struct lbs_private *priv = dev->ml_priv;
993 994 995 996 997 998 999 1000 1001 1002 1003 1004 1005 1006 1007 1008 1009 1010 1011 1012 1013 1014 1015 1016 1017 1018 1019 1020 1021
	struct chan_freq_power *cfp;
	int ret = -EINVAL;

	lbs_deb_enter(LBS_DEB_WEXT);

	/* If setting by frequency, convert to a channel */
	if (fwrq->e == 1) {
		long f = fwrq->m / 100000;

		cfp = find_cfp_by_band_and_freq(priv, 0, f);
		if (!cfp) {
			lbs_deb_wext("invalid freq %ld\n", f);
			goto out;
		}

		fwrq->e = 0;
		fwrq->m = (int) cfp->channel;
	}

	/* Setting by channel number */
	if (fwrq->m > 1000 || fwrq->e > 0) {
		goto out;
	}

	cfp = lbs_find_cfp_by_band_and_channel(priv, 0, fwrq->m);
	if (!cfp) {
		goto out;
	}

1022
	if (fwrq->m != priv->channel) {
1023 1024
		lbs_deb_wext("mesh channel change forces eth disconnect\n");
		if (priv->mode == IW_MODE_INFRA)
1025 1026 1027
			lbs_cmd_80211_deauthenticate(priv,
						     priv->curbssparams.bssid,
						     WLAN_REASON_DEAUTH_LEAVING);
1028
		else if (priv->mode == IW_MODE_ADHOC)
1029
			lbs_adhoc_stop(priv);
1030
	}
1031
	lbs_mesh_config(priv, CMD_ACT_MESH_CONFIG_START, fwrq->m);
1032
	lbs_update_channel(priv);
1033 1034 1035 1036 1037 1038 1039
	ret = 0;

out:
	lbs_deb_leave_args(LBS_DEB_WEXT, "ret %d", ret);
	return ret;
}

1040
static int lbs_set_rate(struct net_device *dev, struct iw_request_info *info,
1041 1042
		  struct iw_param *vwrq, char *extra)
{
1043
	struct lbs_private *priv = dev->ml_priv;
1044
	u8 new_rate = 0;
1045 1046
	int ret = -EINVAL;
	u8 rates[MAX_RATES + 1];
1047

1048
	lbs_deb_enter(LBS_DEB_WEXT);
1049

1050
	lbs_deb_wext("vwrq->value %d\n", vwrq->value);
1051 1052 1053 1054
	lbs_deb_wext("vwrq->fixed %d\n", vwrq->fixed);

	if (vwrq->fixed && vwrq->value == -1)
		goto out;
1055

1056
	/* Auto rate? */
1057 1058 1059
	priv->enablehwauto = !vwrq->fixed;

	if (vwrq->value == -1)
1060
		priv->cur_rate = 0;
1061
	else {
1062 1063
		if (vwrq->value % 100000)
			goto out;
1064

1065 1066 1067
		new_rate = vwrq->value / 500000;
		priv->cur_rate = new_rate;
		/* the rest is only needed for lbs_set_data_rate() */
1068
		memset(rates, 0, sizeof(rates));
1069
		copy_active_data_rates(priv, rates);
1070 1071 1072 1073
		if (!memchr(rates, new_rate, sizeof(rates))) {
			lbs_pr_alert("fixed data rate 0x%X out of range\n",
				new_rate);
			goto out;
1074
		}
1075 1076 1077 1078 1079 1080 1081 1082 1083 1084 1085 1086
		if (priv->fwrelease < 0x09000000) {
			ret = lbs_set_power_adapt_cfg(priv, 0,
					POW_ADAPT_DEFAULT_P0,
					POW_ADAPT_DEFAULT_P1,
					POW_ADAPT_DEFAULT_P2);
			if (ret)
				goto out;
		}
		ret = lbs_set_tpc_cfg(priv, 0, TPC_DEFAULT_P0, TPC_DEFAULT_P1,
				TPC_DEFAULT_P2, 1);
		if (ret)
			goto out;
1087 1088
	}

1089 1090 1091 1092 1093 1094
	/* Try the newer command first (Firmware Spec 5.1 and above) */
	ret = lbs_cmd_802_11_rate_adapt_rateset(priv, CMD_ACT_SET);

	/* Fallback to older version */
	if (ret)
		ret = lbs_set_data_rate(priv, new_rate);
1095

1096
out:
1097
	lbs_deb_leave_args(LBS_DEB_WEXT, "ret %d", ret);
1098 1099 1100
	return ret;
}

1101
static int lbs_get_rate(struct net_device *dev, struct iw_request_info *info,
1102 1103
		  struct iw_param *vwrq, char *extra)
{
1104
	struct lbs_private *priv = dev->ml_priv;
1105

1106
	lbs_deb_enter(LBS_DEB_WEXT);
1107

1108 1109
	if (priv->connect_status == LBS_CONNECTED) {
		vwrq->value = priv->cur_rate * 500000;
1110

1111
		if (priv->enablehwauto)
1112 1113 1114 1115
			vwrq->fixed = 0;
		else
			vwrq->fixed = 1;

1116
	} else {
1117 1118
		vwrq->fixed = 0;
		vwrq->value = 0;
1119 1120
	}

1121
	lbs_deb_leave(LBS_DEB_WEXT);
1122 1123 1124
	return 0;
}

1125
static int lbs_set_mode(struct net_device *dev,
1126 1127 1128
		  struct iw_request_info *info, u32 * uwrq, char *extra)
{
	int ret = 0;
1129
	struct lbs_private *priv = dev->ml_priv;
1130 1131
	struct assoc_request * assoc_req;

1132
	lbs_deb_enter(LBS_DEB_WEXT);
1133

1134 1135 1136
	if (   (*uwrq != IW_MODE_ADHOC)
	    && (*uwrq != IW_MODE_INFRA)
	    && (*uwrq != IW_MODE_AUTO)) {
1137
		lbs_deb_wext("Invalid mode: 0x%x\n", *uwrq);
1138 1139
		ret = -EINVAL;
		goto out;
1140 1141
	}

1142 1143
	mutex_lock(&priv->lock);
	assoc_req = lbs_get_association_request(priv);
1144 1145
	if (!assoc_req) {
		ret = -ENOMEM;
1146
		lbs_cancel_association_work(priv);
1147
	} else {
1148
		assoc_req->mode = *uwrq;
1149
		set_bit(ASSOC_FLAG_MODE, &assoc_req->flags);
1150
		lbs_postpone_association_work(priv);
1151
		lbs_deb_wext("Switching to mode: 0x%x\n", *uwrq);
1152
	}
1153
	mutex_unlock(&priv->lock);
1154

1155
out:
1156
	lbs_deb_leave_args(LBS_DEB_WEXT, "ret %d", ret);
1157 1158 1159 1160 1161 1162 1163 1164 1165 1166 1167 1168 1169
	return ret;
}


/**
 *  @brief Get Encryption key
 *
 *  @param dev                  A pointer to net_device structure
 *  @param info			A pointer to iw_request_info structure
 *  @param vwrq 		A pointer to iw_param structure
 *  @param extra		A pointer to extra data buf
 *  @return 	   		0 --success, otherwise fail
 */
1170
static int lbs_get_encode(struct net_device *dev,
1171 1172 1173
			   struct iw_request_info *info,
			   struct iw_point *dwrq, u8 * extra)
{
1174
	struct lbs_private *priv = dev->ml_priv;
1175 1176
	int index = (dwrq->flags & IW_ENCODE_INDEX) - 1;

1177
	lbs_deb_enter(LBS_DEB_WEXT);
1178

1179
	lbs_deb_wext("flags 0x%x, index %d, length %d, wep_tx_keyidx %d\n",
1180
	       dwrq->flags, index, dwrq->length, priv->wep_tx_keyidx);
1181 1182 1183 1184

	dwrq->flags = 0;

	/* Authentication method */
1185
	switch (priv->secinfo.auth_mode) {
1186
	case IW_AUTH_ALG_OPEN_SYSTEM:
1187 1188 1189
		dwrq->flags = IW_ENCODE_OPEN;
		break;

1190 1191
	case IW_AUTH_ALG_SHARED_KEY:
	case IW_AUTH_ALG_LEAP:
1192 1193 1194 1195 1196 1197 1198 1199 1200
		dwrq->flags = IW_ENCODE_RESTRICTED;
		break;
	default:
		dwrq->flags = IW_ENCODE_DISABLED | IW_ENCODE_OPEN;
		break;
	}

	memset(extra, 0, 16);

1201
	mutex_lock(&priv->lock);
1202 1203 1204

	/* Default to returning current transmit key */
	if (index < 0)
1205
		index = priv->wep_tx_keyidx;
1206

1207 1208 1209 1210
	if ((priv->wep_keys[index].len) && priv->secinfo.wep_enabled) {
		memcpy(extra, priv->wep_keys[index].key,
		       priv->wep_keys[index].len);
		dwrq->length = priv->wep_keys[index].len;
1211 1212 1213 1214

		dwrq->flags |= (index + 1);
		/* Return WEP enabled */
		dwrq->flags &= ~IW_ENCODE_DISABLED;
1215 1216
	} else if ((priv->secinfo.WPAenabled)
		   || (priv->secinfo.WPA2enabled)) {
1217 1218
		/* return WPA enabled */
		dwrq->flags &= ~IW_ENCODE_DISABLED;
1219
		dwrq->flags |= IW_ENCODE_NOKEY;
1220 1221 1222 1223
	} else {
		dwrq->flags |= IW_ENCODE_DISABLED;
	}

1224
	mutex_unlock(&priv->lock);
1225

1226
	lbs_deb_wext("key: %02x:%02x:%02x:%02x:%02x:%02x, keylen %d\n",
1227 1228 1229
	       extra[0], extra[1], extra[2],
	       extra[3], extra[4], extra[5], dwrq->length);

1230
	lbs_deb_wext("return flags 0x%x\n", dwrq->flags);
1231

1232
	lbs_deb_leave(LBS_DEB_WEXT);
1233 1234 1235 1236 1237 1238 1239 1240 1241 1242 1243 1244 1245
	return 0;
}

/**
 *  @brief Set Encryption key (internal)
 *
 *  @param priv			A pointer to private card structure
 *  @param key_material		A pointer to key material
 *  @param key_length		length of key material
 *  @param index		key index to set
 *  @param set_tx_key		Force set TX key (1 = yes, 0 = no)
 *  @return 	   		0 --success, otherwise fail
 */
1246
static int lbs_set_wep_key(struct assoc_request *assoc_req,
1247 1248 1249 1250 1251
			    const char *key_material,
			    u16 key_length,
			    u16 index,
			    int set_tx_key)
{
1252
	int ret = 0;
1253
	struct enc_key *pkey;
1254

1255
	lbs_deb_enter(LBS_DEB_WEXT);
1256 1257 1258

	/* Paranoid validation of key index */
	if (index > 3) {
1259 1260
		ret = -EINVAL;
		goto out;
1261 1262 1263 1264
	}

	/* validate max key length */
	if (key_length > KEY_LEN_WEP_104) {
1265 1266
		ret = -EINVAL;
		goto out;
1267 1268 1269 1270 1271
	}

	pkey = &assoc_req->wep_keys[index];

	if (key_length > 0) {
1272
		memset(pkey, 0, sizeof(struct enc_key));
1273 1274 1275 1276 1277 1278 1279 1280 1281 1282 1283
		pkey->type = KEY_TYPE_ID_WEP;

		/* Standardize the key length */
		pkey->len = (key_length > KEY_LEN_WEP_40) ?
		                KEY_LEN_WEP_104 : KEY_LEN_WEP_40;
		memcpy(pkey->key, key_material, key_length);
	}

	if (set_tx_key) {
		/* Ensure the chosen key is valid */
		if (!pkey->len) {
1284 1285 1286
			lbs_deb_wext("key not set, so cannot enable it\n");
			ret = -EINVAL;
			goto out;
1287 1288 1289 1290
		}
		assoc_req->wep_tx_keyidx = index;
	}

1291
	assoc_req->secinfo.wep_enabled = 1;
1292

1293 1294 1295
out:
	lbs_deb_leave_args(LBS_DEB_WEXT, "ret %d", ret);
	return ret;
1296 1297 1298 1299 1300 1301 1302 1303 1304 1305 1306 1307 1308 1309 1310 1311 1312 1313 1314 1315 1316 1317 1318 1319
}

static int validate_key_index(u16 def_index, u16 raw_index,
			      u16 *out_index, u16 *is_default)
{
	if (!out_index || !is_default)
		return -EINVAL;

	/* Verify index if present, otherwise use default TX key index */
	if (raw_index > 0) {
		if (raw_index > 4)
			return -EINVAL;
		*out_index = raw_index - 1;
	} else {
		*out_index = def_index;
		*is_default = 1;
	}
	return 0;
}

static void disable_wep(struct assoc_request *assoc_req)
{
	int i;

1320 1321
	lbs_deb_enter(LBS_DEB_WEXT);

1322
	/* Set Open System auth mode */
1323
	assoc_req->secinfo.auth_mode = IW_AUTH_ALG_OPEN_SYSTEM;
1324 1325

	/* Clear WEP keys and mark WEP as disabled */
1326
	assoc_req->secinfo.wep_enabled = 0;
1327 1328 1329 1330 1331
	for (i = 0; i < 4; i++)
		assoc_req->wep_keys[i].len = 0;

	set_bit(ASSOC_FLAG_SECINFO, &assoc_req->flags);
	set_bit(ASSOC_FLAG_WEP_KEYS, &assoc_req->flags);
1332 1333 1334 1335 1336 1337 1338 1339

	lbs_deb_leave(LBS_DEB_WEXT);
}

static void disable_wpa(struct assoc_request *assoc_req)
{
	lbs_deb_enter(LBS_DEB_WEXT);

1340
	memset(&assoc_req->wpa_mcast_key, 0, sizeof (struct enc_key));
1341 1342 1343
	assoc_req->wpa_mcast_key.flags = KEY_INFO_WPA_MCAST;
	set_bit(ASSOC_FLAG_WPA_MCAST_KEY, &assoc_req->flags);

1344
	memset(&assoc_req->wpa_unicast_key, 0, sizeof (struct enc_key));
1345 1346 1347 1348 1349 1350 1351 1352
	assoc_req->wpa_unicast_key.flags = KEY_INFO_WPA_UNICAST;
	set_bit(ASSOC_FLAG_WPA_UCAST_KEY, &assoc_req->flags);

	assoc_req->secinfo.WPAenabled = 0;
	assoc_req->secinfo.WPA2enabled = 0;
	set_bit(ASSOC_FLAG_SECINFO, &assoc_req->flags);

	lbs_deb_leave(LBS_DEB_WEXT);
1353 1354 1355 1356 1357 1358 1359 1360 1361 1362 1363
}

/**
 *  @brief Set Encryption key
 *
 *  @param dev                  A pointer to net_device structure
 *  @param info			A pointer to iw_request_info structure
 *  @param vwrq 		A pointer to iw_param structure
 *  @param extra		A pointer to extra data buf
 *  @return 	   		0 --success, otherwise fail
 */
1364
static int lbs_set_encode(struct net_device *dev,
1365 1366 1367 1368
		    struct iw_request_info *info,
		    struct iw_point *dwrq, char *extra)
{
	int ret = 0;
1369
	struct lbs_private *priv = dev->ml_priv;
1370 1371 1372
	struct assoc_request * assoc_req;
	u16 is_default = 0, index = 0, set_tx_key = 0;

1373
	lbs_deb_enter(LBS_DEB_WEXT);
1374

1375 1376
	mutex_lock(&priv->lock);
	assoc_req = lbs_get_association_request(priv);
1377 1378 1379 1380 1381 1382 1383
	if (!assoc_req) {
		ret = -ENOMEM;
		goto out;
	}

	if (dwrq->flags & IW_ENCODE_DISABLED) {
		disable_wep (assoc_req);
1384
		disable_wpa (assoc_req);
1385 1386 1387 1388 1389 1390 1391 1392 1393 1394 1395 1396 1397 1398
		goto out;
	}

	ret = validate_key_index(assoc_req->wep_tx_keyidx,
	                         (dwrq->flags & IW_ENCODE_INDEX),
	                         &index, &is_default);
	if (ret) {
		ret = -EINVAL;
		goto out;
	}

	/* If WEP isn't enabled, or if there is no key data but a valid
	 * index, set the TX key.
	 */
1399
	if (!assoc_req->secinfo.wep_enabled || (dwrq->length == 0 && !is_default))
1400 1401
		set_tx_key = 1;

1402
	ret = lbs_set_wep_key(assoc_req, extra, dwrq->length, index, set_tx_key);
1403 1404 1405 1406 1407 1408 1409 1410 1411
	if (ret)
		goto out;

	if (dwrq->length)
		set_bit(ASSOC_FLAG_WEP_KEYS, &assoc_req->flags);
	if (set_tx_key)
		set_bit(ASSOC_FLAG_WEP_TX_KEYIDX, &assoc_req->flags);

	if (dwrq->flags & IW_ENCODE_RESTRICTED) {
1412
		assoc_req->secinfo.auth_mode = IW_AUTH_ALG_SHARED_KEY;
1413
	} else if (dwrq->flags & IW_ENCODE_OPEN) {
1414
		assoc_req->secinfo.auth_mode = IW_AUTH_ALG_OPEN_SYSTEM;
1415 1416 1417 1418 1419
	}

out:
	if (ret == 0) {
		set_bit(ASSOC_FLAG_SECINFO, &assoc_req->flags);
1420
		lbs_postpone_association_work(priv);
1421
	} else {
1422
		lbs_cancel_association_work(priv);
1423
	}
1424
	mutex_unlock(&priv->lock);
1425

1426
	lbs_deb_leave_args(LBS_DEB_WEXT, "ret %d", ret);
1427 1428 1429 1430 1431 1432 1433 1434 1435 1436 1437 1438
	return ret;
}

/**
 *  @brief Get Extended Encryption key (WPA/802.1x and WEP)
 *
 *  @param dev                  A pointer to net_device structure
 *  @param info			A pointer to iw_request_info structure
 *  @param vwrq 		A pointer to iw_param structure
 *  @param extra		A pointer to extra data buf
 *  @return 	   		0 on success, otherwise failure
 */
1439
static int lbs_get_encodeext(struct net_device *dev,
1440 1441 1442 1443 1444
			      struct iw_request_info *info,
			      struct iw_point *dwrq,
			      char *extra)
{
	int ret = -EINVAL;
1445
	struct lbs_private *priv = dev->ml_priv;
1446 1447 1448
	struct iw_encode_ext *ext = (struct iw_encode_ext *)extra;
	int index, max_key_len;

1449
	lbs_deb_enter(LBS_DEB_WEXT);
1450 1451 1452 1453 1454 1455 1456 1457 1458 1459 1460

	max_key_len = dwrq->length - sizeof(*ext);
	if (max_key_len < 0)
		goto out;

	index = dwrq->flags & IW_ENCODE_INDEX;
	if (index) {
		if (index < 1 || index > 4)
			goto out;
		index--;
	} else {
1461
		index = priv->wep_tx_keyidx;
1462 1463
	}

R
Roel Kluin 已提交
1464
	if (!(ext->ext_flags & IW_ENCODE_EXT_GROUP_KEY) &&
1465
	    ext->alg != IW_ENCODE_ALG_WEP) {
1466
		if (index != 0 || priv->mode != IW_MODE_INFRA)
1467 1468 1469 1470 1471 1472
			goto out;
	}

	dwrq->flags = index + 1;
	memset(ext, 0, sizeof(*ext));

1473 1474 1475
	if (   !priv->secinfo.wep_enabled
	    && !priv->secinfo.WPAenabled
	    && !priv->secinfo.WPA2enabled) {
1476 1477 1478 1479 1480 1481
		ext->alg = IW_ENCODE_ALG_NONE;
		ext->key_len = 0;
		dwrq->flags |= IW_ENCODE_DISABLED;
	} else {
		u8 *key = NULL;

1482 1483 1484
		if (   priv->secinfo.wep_enabled
		    && !priv->secinfo.WPAenabled
		    && !priv->secinfo.WPA2enabled) {
1485
			/* WEP */
1486
			ext->alg = IW_ENCODE_ALG_WEP;
1487 1488 1489 1490 1491
			ext->key_len = priv->wep_keys[index].len;
			key = &priv->wep_keys[index].key[0];
		} else if (   !priv->secinfo.wep_enabled
		           && (priv->secinfo.WPAenabled ||
		               priv->secinfo.WPA2enabled)) {
1492
			/* WPA */
1493
			struct enc_key * pkey = NULL;
1494

1495 1496 1497 1498 1499 1500
			if (   priv->wpa_mcast_key.len
			    && (priv->wpa_mcast_key.flags & KEY_INFO_WPA_ENABLED))
				pkey = &priv->wpa_mcast_key;
			else if (   priv->wpa_unicast_key.len
			         && (priv->wpa_unicast_key.flags & KEY_INFO_WPA_ENABLED))
				pkey = &priv->wpa_unicast_key;
1501 1502 1503 1504 1505 1506 1507 1508 1509 1510 1511 1512 1513

			if (pkey) {
				if (pkey->type == KEY_TYPE_ID_AES) {
					ext->alg = IW_ENCODE_ALG_CCMP;
				} else {
					ext->alg = IW_ENCODE_ALG_TKIP;
				}
				ext->key_len = pkey->len;
				key = &pkey->key[0];
			} else {
				ext->alg = IW_ENCODE_ALG_TKIP;
				ext->key_len = 0;
			}
1514 1515 1516 1517 1518 1519 1520 1521 1522 1523 1524 1525 1526 1527 1528 1529 1530 1531
		} else {
			goto out;
		}

		if (ext->key_len > max_key_len) {
			ret = -E2BIG;
			goto out;
		}

		if (ext->key_len)
			memcpy(ext->key, key, ext->key_len);
		else
			dwrq->flags |= IW_ENCODE_NOKEY;
		dwrq->flags |= IW_ENCODE_ENABLED;
	}
	ret = 0;

out:
1532
	lbs_deb_leave_args(LBS_DEB_WEXT, "ret %d", ret);
1533 1534 1535 1536 1537 1538 1539 1540 1541 1542 1543 1544
	return ret;
}

/**
 *  @brief Set Encryption key Extended (WPA/802.1x and WEP)
 *
 *  @param dev                  A pointer to net_device structure
 *  @param info			A pointer to iw_request_info structure
 *  @param vwrq 		A pointer to iw_param structure
 *  @param extra		A pointer to extra data buf
 *  @return 	   		0 --success, otherwise fail
 */
1545
static int lbs_set_encodeext(struct net_device *dev,
1546 1547 1548 1549 1550
			      struct iw_request_info *info,
			      struct iw_point *dwrq,
			      char *extra)
{
	int ret = 0;
1551
	struct lbs_private *priv = dev->ml_priv;
1552 1553 1554 1555
	struct iw_encode_ext *ext = (struct iw_encode_ext *)extra;
	int alg = ext->alg;
	struct assoc_request * assoc_req;

1556
	lbs_deb_enter(LBS_DEB_WEXT);
1557

1558 1559
	mutex_lock(&priv->lock);
	assoc_req = lbs_get_association_request(priv);
1560 1561 1562 1563 1564 1565 1566
	if (!assoc_req) {
		ret = -ENOMEM;
		goto out;
	}

	if ((alg == IW_ENCODE_ALG_NONE) || (dwrq->flags & IW_ENCODE_DISABLED)) {
		disable_wep (assoc_req);
1567
		disable_wpa (assoc_req);
1568 1569 1570 1571 1572 1573 1574 1575 1576 1577 1578 1579
	} else if (alg == IW_ENCODE_ALG_WEP) {
		u16 is_default = 0, index, set_tx_key = 0;

		ret = validate_key_index(assoc_req->wep_tx_keyidx,
		                         (dwrq->flags & IW_ENCODE_INDEX),
		                         &index, &is_default);
		if (ret)
			goto out;

		/* If WEP isn't enabled, or if there is no key data but a valid
		 * index, or if the set-TX-key flag was passed, set the TX key.
		 */
1580
		if (   !assoc_req->secinfo.wep_enabled
1581 1582 1583 1584 1585
		    || (dwrq->length == 0 && !is_default)
		    || (ext->ext_flags & IW_ENCODE_EXT_SET_TX_KEY))
			set_tx_key = 1;

		/* Copy key to driver */
1586
		ret = lbs_set_wep_key(assoc_req, ext->key, ext->key_len, index,
1587 1588 1589 1590 1591
					set_tx_key);
		if (ret)
			goto out;

		if (dwrq->flags & IW_ENCODE_RESTRICTED) {
1592
			assoc_req->secinfo.auth_mode = IW_AUTH_ALG_SHARED_KEY;
1593
		} else if (dwrq->flags & IW_ENCODE_OPEN) {
1594
			assoc_req->secinfo.auth_mode = IW_AUTH_ALG_OPEN_SYSTEM;
1595 1596 1597 1598 1599 1600 1601 1602 1603
		}

		/* Mark the various WEP bits as modified */
		set_bit(ASSOC_FLAG_SECINFO, &assoc_req->flags);
		if (dwrq->length)
			set_bit(ASSOC_FLAG_WEP_KEYS, &assoc_req->flags);
		if (set_tx_key)
			set_bit(ASSOC_FLAG_WEP_TX_KEYIDX, &assoc_req->flags);
	} else if ((alg == IW_ENCODE_ALG_TKIP) || (alg == IW_ENCODE_ALG_CCMP)) {
1604
		struct enc_key * pkey;
1605 1606 1607 1608 1609 1610

		/* validate key length */
		if (((alg == IW_ENCODE_ALG_TKIP)
			&& (ext->key_len != KEY_LEN_WPA_TKIP))
		    || ((alg == IW_ENCODE_ALG_CCMP)
		        && (ext->key_len != KEY_LEN_WPA_AES))) {
1611
				lbs_deb_wext("invalid size %d for key of alg "
1612
				       "type %d\n",
1613 1614 1615 1616 1617 1618
				       ext->key_len,
				       alg);
				ret = -EINVAL;
				goto out;
		}

1619
		if (ext->ext_flags & IW_ENCODE_EXT_GROUP_KEY) {
1620
			pkey = &assoc_req->wpa_mcast_key;
1621 1622
			set_bit(ASSOC_FLAG_WPA_MCAST_KEY, &assoc_req->flags);
		} else {
1623
			pkey = &assoc_req->wpa_unicast_key;
1624 1625
			set_bit(ASSOC_FLAG_WPA_UCAST_KEY, &assoc_req->flags);
		}
1626

1627
		memset(pkey, 0, sizeof (struct enc_key));
1628 1629
		memcpy(pkey->key, ext->key, ext->key_len);
		pkey->len = ext->key_len;
1630 1631
		if (pkey->len)
			pkey->flags |= KEY_INFO_WPA_ENABLED;
1632

1633
		/* Do this after zeroing key structure */
1634 1635 1636 1637 1638 1639
		if (ext->ext_flags & IW_ENCODE_EXT_GROUP_KEY) {
			pkey->flags |= KEY_INFO_WPA_MCAST;
		} else {
			pkey->flags |= KEY_INFO_WPA_UNICAST;
		}

1640
		if (alg == IW_ENCODE_ALG_TKIP) {
1641
			pkey->type = KEY_TYPE_ID_TKIP;
1642
		} else if (alg == IW_ENCODE_ALG_CCMP) {
1643
			pkey->type = KEY_TYPE_ID_AES;
1644
		}
1645 1646 1647 1648 1649 1650 1651 1652 1653

		/* If WPA isn't enabled yet, do that now */
		if (   assoc_req->secinfo.WPAenabled == 0
		    && assoc_req->secinfo.WPA2enabled == 0) {
			assoc_req->secinfo.WPAenabled = 1;
			assoc_req->secinfo.WPA2enabled = 1;
			set_bit(ASSOC_FLAG_SECINFO, &assoc_req->flags);
		}

1654 1655 1656
		/* Only disable wep if necessary: can't waste time here. */
		if (priv->mac_control & CMD_ACT_MAC_WEP_ENABLE)
			disable_wep(assoc_req);
1657 1658 1659
	}

out:
1660 1661 1662 1663 1664 1665 1666 1667 1668 1669 1670 1671 1672 1673
	if (ret == 0) {
		/* 802.1x and WPA rekeying must happen as quickly as possible,
		 * especially during the 4-way handshake; thus if in
		 * infrastructure mode, and either (a) 802.1x is enabled or
		 * (b) WPA is being used, set the key right away.
		 */
		if (assoc_req->mode == IW_MODE_INFRA &&
		    ((assoc_req->secinfo.key_mgmt & IW_AUTH_KEY_MGMT_802_1X) ||
		     (assoc_req->secinfo.key_mgmt & IW_AUTH_KEY_MGMT_PSK) ||
		      assoc_req->secinfo.WPAenabled ||
		      assoc_req->secinfo.WPA2enabled)) {
			lbs_do_association_work(priv);
		} else
			lbs_postpone_association_work(priv);
1674
	} else {
1675
		lbs_cancel_association_work(priv);
1676
	}
1677
	mutex_unlock(&priv->lock);
1678

1679
	lbs_deb_leave_args(LBS_DEB_WEXT, "ret %d", ret);
1680 1681 1682 1683
	return ret;
}


1684
static int lbs_set_genie(struct net_device *dev,
1685 1686 1687 1688
			  struct iw_request_info *info,
			  struct iw_point *dwrq,
			  char *extra)
{
1689
	struct lbs_private *priv = dev->ml_priv;
1690 1691 1692
	int ret = 0;
	struct assoc_request * assoc_req;

1693
	lbs_deb_enter(LBS_DEB_WEXT);
1694

1695 1696
	mutex_lock(&priv->lock);
	assoc_req = lbs_get_association_request(priv);
1697 1698 1699 1700 1701 1702 1703 1704 1705 1706 1707 1708 1709 1710 1711
	if (!assoc_req) {
		ret = -ENOMEM;
		goto out;
	}

	if (dwrq->length > MAX_WPA_IE_LEN ||
	    (dwrq->length && extra == NULL)) {
		ret = -EINVAL;
		goto out;
	}

	if (dwrq->length) {
		memcpy(&assoc_req->wpa_ie[0], extra, dwrq->length);
		assoc_req->wpa_ie_len = dwrq->length;
	} else {
1712
		memset(&assoc_req->wpa_ie[0], 0, sizeof(priv->wpa_ie));
1713 1714 1715 1716 1717 1718
		assoc_req->wpa_ie_len = 0;
	}

out:
	if (ret == 0) {
		set_bit(ASSOC_FLAG_WPA_IE, &assoc_req->flags);
1719
		lbs_postpone_association_work(priv);
1720
	} else {
1721
		lbs_cancel_association_work(priv);
1722
	}
1723
	mutex_unlock(&priv->lock);
1724

1725
	lbs_deb_leave_args(LBS_DEB_WEXT, "ret %d", ret);
1726 1727 1728
	return ret;
}

1729
static int lbs_get_genie(struct net_device *dev,
1730 1731 1732 1733
			  struct iw_request_info *info,
			  struct iw_point *dwrq,
			  char *extra)
{
1734
	int ret = 0;
1735
	struct lbs_private *priv = dev->ml_priv;
1736

1737
	lbs_deb_enter(LBS_DEB_WEXT);
1738

1739
	if (priv->wpa_ie_len == 0) {
1740
		dwrq->length = 0;
1741
		goto out;
1742 1743
	}

1744
	if (dwrq->length < priv->wpa_ie_len) {
1745 1746
		ret = -E2BIG;
		goto out;
1747 1748
	}

1749 1750
	dwrq->length = priv->wpa_ie_len;
	memcpy(extra, &priv->wpa_ie[0], priv->wpa_ie_len);
1751

1752 1753 1754
out:
	lbs_deb_leave_args(LBS_DEB_WEXT, "ret %d", ret);
	return ret;
1755 1756 1757
}


1758
static int lbs_set_auth(struct net_device *dev,
1759 1760 1761 1762
			 struct iw_request_info *info,
			 struct iw_param *dwrq,
			 char *extra)
{
1763
	struct lbs_private *priv = dev->ml_priv;
1764 1765 1766 1767
	struct assoc_request * assoc_req;
	int ret = 0;
	int updated = 0;

1768
	lbs_deb_enter(LBS_DEB_WEXT);
1769

1770 1771
	mutex_lock(&priv->lock);
	assoc_req = lbs_get_association_request(priv);
1772 1773 1774 1775 1776 1777
	if (!assoc_req) {
		ret = -ENOMEM;
		goto out;
	}

	switch (dwrq->flags & IW_AUTH_INDEX) {
1778 1779
	case IW_AUTH_PRIVACY_INVOKED:
	case IW_AUTH_RX_UNENCRYPTED_EAPOL:
1780 1781 1782
	case IW_AUTH_TKIP_COUNTERMEASURES:
	case IW_AUTH_CIPHER_PAIRWISE:
	case IW_AUTH_CIPHER_GROUP:
1783
	case IW_AUTH_DROP_UNENCRYPTED:
1784 1785 1786 1787 1788
		/*
		 * libertas does not use these parameters
		 */
		break;

1789 1790 1791 1792 1793
	case IW_AUTH_KEY_MGMT:
		assoc_req->secinfo.key_mgmt = dwrq->value;
		updated = 1;
		break;

1794 1795 1796 1797
	case IW_AUTH_WPA_VERSION:
		if (dwrq->value & IW_AUTH_WPA_VERSION_DISABLED) {
			assoc_req->secinfo.WPAenabled = 0;
			assoc_req->secinfo.WPA2enabled = 0;
1798
			disable_wpa (assoc_req);
1799 1800 1801
		}
		if (dwrq->value & IW_AUTH_WPA_VERSION_WPA) {
			assoc_req->secinfo.WPAenabled = 1;
1802
			assoc_req->secinfo.wep_enabled = 0;
1803
			assoc_req->secinfo.auth_mode = IW_AUTH_ALG_OPEN_SYSTEM;
1804 1805 1806
		}
		if (dwrq->value & IW_AUTH_WPA_VERSION_WPA2) {
			assoc_req->secinfo.WPA2enabled = 1;
1807
			assoc_req->secinfo.wep_enabled = 0;
1808
			assoc_req->secinfo.auth_mode = IW_AUTH_ALG_OPEN_SYSTEM;
1809 1810 1811 1812 1813 1814
		}
		updated = 1;
		break;

	case IW_AUTH_80211_AUTH_ALG:
		if (dwrq->value & IW_AUTH_ALG_SHARED_KEY) {
1815
			assoc_req->secinfo.auth_mode = IW_AUTH_ALG_SHARED_KEY;
1816
		} else if (dwrq->value & IW_AUTH_ALG_OPEN_SYSTEM) {
1817
			assoc_req->secinfo.auth_mode = IW_AUTH_ALG_OPEN_SYSTEM;
1818
		} else if (dwrq->value & IW_AUTH_ALG_LEAP) {
1819
			assoc_req->secinfo.auth_mode = IW_AUTH_ALG_LEAP;
1820 1821 1822 1823 1824 1825 1826 1827 1828 1829 1830 1831
		} else {
			ret = -EINVAL;
		}
		updated = 1;
		break;

	case IW_AUTH_WPA_ENABLED:
		if (dwrq->value) {
			if (!assoc_req->secinfo.WPAenabled &&
			    !assoc_req->secinfo.WPA2enabled) {
				assoc_req->secinfo.WPAenabled = 1;
				assoc_req->secinfo.WPA2enabled = 1;
1832
				assoc_req->secinfo.wep_enabled = 0;
1833
				assoc_req->secinfo.auth_mode = IW_AUTH_ALG_OPEN_SYSTEM;
1834 1835 1836 1837
			}
		} else {
			assoc_req->secinfo.WPAenabled = 0;
			assoc_req->secinfo.WPA2enabled = 0;
1838
			disable_wpa (assoc_req);
1839 1840 1841 1842 1843 1844 1845 1846 1847 1848 1849 1850 1851
		}
		updated = 1;
		break;

	default:
		ret = -EOPNOTSUPP;
		break;
	}

out:
	if (ret == 0) {
		if (updated)
			set_bit(ASSOC_FLAG_SECINFO, &assoc_req->flags);
1852
		lbs_postpone_association_work(priv);
1853
	} else if (ret != -EOPNOTSUPP) {
1854
		lbs_cancel_association_work(priv);
1855
	}
1856
	mutex_unlock(&priv->lock);
1857

1858
	lbs_deb_leave_args(LBS_DEB_WEXT, "ret %d", ret);
1859 1860 1861
	return ret;
}

1862
static int lbs_get_auth(struct net_device *dev,
1863 1864 1865 1866
			 struct iw_request_info *info,
			 struct iw_param *dwrq,
			 char *extra)
{
1867
	int ret = 0;
1868
	struct lbs_private *priv = dev->ml_priv;
1869

1870
	lbs_deb_enter(LBS_DEB_WEXT);
1871 1872

	switch (dwrq->flags & IW_AUTH_INDEX) {
1873 1874 1875 1876
	case IW_AUTH_KEY_MGMT:
		dwrq->value = priv->secinfo.key_mgmt;
		break;

1877 1878
	case IW_AUTH_WPA_VERSION:
		dwrq->value = 0;
1879
		if (priv->secinfo.WPAenabled)
1880
			dwrq->value |= IW_AUTH_WPA_VERSION_WPA;
1881
		if (priv->secinfo.WPA2enabled)
1882 1883 1884 1885 1886 1887
			dwrq->value |= IW_AUTH_WPA_VERSION_WPA2;
		if (!dwrq->value)
			dwrq->value |= IW_AUTH_WPA_VERSION_DISABLED;
		break;

	case IW_AUTH_80211_AUTH_ALG:
1888
		dwrq->value = priv->secinfo.auth_mode;
1889 1890 1891
		break;

	case IW_AUTH_WPA_ENABLED:
1892
		if (priv->secinfo.WPAenabled && priv->secinfo.WPA2enabled)
1893 1894 1895 1896
			dwrq->value = 1;
		break;

	default:
1897
		ret = -EOPNOTSUPP;
1898 1899
	}

1900 1901
	lbs_deb_leave_args(LBS_DEB_WEXT, "ret %d", ret);
	return ret;
1902 1903 1904
}


1905
static int lbs_set_txpow(struct net_device *dev, struct iw_request_info *info,
1906 1907 1908
		   struct iw_param *vwrq, char *extra)
{
	int ret = 0;
1909
	struct lbs_private *priv = dev->ml_priv;
1910
	s16 dbm = (s16) vwrq->value;
1911

1912
	lbs_deb_enter(LBS_DEB_WEXT);
1913 1914

	if (vwrq->disabled) {
1915
		lbs_set_radio(priv, RADIO_PREAMBLE_AUTO, 0);
1916
		goto out;
1917 1918
	}

1919
	if (vwrq->fixed == 0) {
1920 1921 1922 1923 1924 1925 1926 1927 1928 1929 1930 1931 1932 1933 1934
		/* User requests automatic tx power control, however there are
		 * many auto tx settings.  For now use firmware defaults until
		 * we come up with a good way to expose these to the user. */
		if (priv->fwrelease < 0x09000000) {
			ret = lbs_set_power_adapt_cfg(priv, 1,
					POW_ADAPT_DEFAULT_P0,
					POW_ADAPT_DEFAULT_P1,
					POW_ADAPT_DEFAULT_P2);
			if (ret)
				goto out;
		}
		ret = lbs_set_tpc_cfg(priv, 0, TPC_DEFAULT_P0, TPC_DEFAULT_P1,
				TPC_DEFAULT_P2, 1);
		if (ret)
			goto out;
1935 1936 1937 1938 1939 1940 1941 1942
		dbm = priv->txpower_max;
	} else {
		/* Userspace check in iwrange if it should use dBm or mW,
		 * therefore this should never happen... Jean II */
		if ((vwrq->flags & IW_TXPOW_TYPE) != IW_TXPOW_DBM) {
			ret = -EOPNOTSUPP;
			goto out;
		}
1943

1944 1945
		/* Validate requested power level against firmware allowed
		 * levels */
1946 1947 1948 1949
		if (priv->txpower_min && (dbm < priv->txpower_min)) {
			ret = -EINVAL;
			goto out;
		}
1950

1951 1952 1953 1954
		if (priv->txpower_max && (dbm > priv->txpower_max)) {
			ret = -EINVAL;
			goto out;
		}
1955 1956 1957 1958 1959 1960 1961 1962 1963 1964 1965 1966
		if (priv->fwrelease < 0x09000000) {
			ret = lbs_set_power_adapt_cfg(priv, 0,
					POW_ADAPT_DEFAULT_P0,
					POW_ADAPT_DEFAULT_P1,
					POW_ADAPT_DEFAULT_P2);
			if (ret)
				goto out;
		}
		ret = lbs_set_tpc_cfg(priv, 0, TPC_DEFAULT_P0, TPC_DEFAULT_P1,
				TPC_DEFAULT_P2, 1);
		if (ret)
			goto out;
1967
	}
1968

1969 1970 1971 1972 1973 1974
	/* If the radio was off, turn it on */
	if (!priv->radio_on) {
		ret = lbs_set_radio(priv, RADIO_PREAMBLE_AUTO, 1);
		if (ret)
			goto out;
	}
1975

1976
	lbs_deb_wext("txpower set %d dBm\n", dbm);
1977

1978
	ret = lbs_set_tx_power(priv, dbm);
1979

1980
out:
1981
	lbs_deb_leave_args(LBS_DEB_WEXT, "ret %d", ret);
1982 1983 1984
	return ret;
}

1985
static int lbs_get_essid(struct net_device *dev, struct iw_request_info *info,
1986 1987
		   struct iw_point *dwrq, char *extra)
{
1988
	struct lbs_private *priv = dev->ml_priv;
1989

1990 1991
	lbs_deb_enter(LBS_DEB_WEXT);

1992 1993 1994 1995 1996 1997 1998 1999
	/*
	 * Note : if dwrq->flags != 0, we should get the relevant SSID from
	 * the SSID list...
	 */

	/*
	 * Get the current SSID
	 */
2000 2001 2002 2003
	if (priv->connect_status == LBS_CONNECTED) {
		memcpy(extra, priv->curbssparams.ssid,
		       priv->curbssparams.ssid_len);
		extra[priv->curbssparams.ssid_len] = '\0';
2004 2005
	} else {
		memset(extra, 0, 32);
2006
		extra[priv->curbssparams.ssid_len] = '\0';
2007 2008 2009 2010 2011
	}
	/*
	 * If none, we may want to get the one that was set
	 */

2012
	dwrq->length = priv->curbssparams.ssid_len;
2013 2014 2015

	dwrq->flags = 1;	/* active */

2016
	lbs_deb_leave(LBS_DEB_WEXT);
2017 2018 2019
	return 0;
}

2020
static int lbs_set_essid(struct net_device *dev, struct iw_request_info *info,
2021 2022
		   struct iw_point *dwrq, char *extra)
{
2023
	struct lbs_private *priv = dev->ml_priv;
2024
	int ret = 0;
2025
	u8 ssid[IEEE80211_MAX_SSID_LEN];
2026
	u8 ssid_len = 0;
2027
	struct assoc_request * assoc_req;
2028
	int in_ssid_len = dwrq->length;
2029
	DECLARE_SSID_BUF(ssid_buf);
2030

2031
	lbs_deb_enter(LBS_DEB_WEXT);
2032

2033 2034 2035 2036 2037
	if (!priv->radio_on) {
		ret = -EINVAL;
		goto out;
	}

2038
	/* Check the size of the string */
2039
	if (in_ssid_len > IEEE80211_MAX_SSID_LEN) {
2040 2041 2042 2043
		ret = -E2BIG;
		goto out;
	}

2044
	memset(&ssid, 0, sizeof(ssid));
2045

2046
	if (!dwrq->flags || !in_ssid_len) {
2047 2048 2049
		/* "any" SSID requested; leave SSID blank */
	} else {
		/* Specific SSID requested */
2050 2051
		memcpy(&ssid, extra, in_ssid_len);
		ssid_len = in_ssid_len;
2052 2053
	}

2054 2055 2056 2057
	if (!ssid_len) {
		lbs_deb_wext("requested any SSID\n");
	} else {
		lbs_deb_wext("requested SSID '%s'\n",
2058
		             print_ssid(ssid_buf, ssid, ssid_len));
2059
	}
2060 2061

out:
2062
	mutex_lock(&priv->lock);
2063 2064
	if (ret == 0) {
		/* Get or create the current association request */
2065
		assoc_req = lbs_get_association_request(priv);
2066 2067 2068 2069
		if (!assoc_req) {
			ret = -ENOMEM;
		} else {
			/* Copy the SSID to the association request */
2070
			memcpy(&assoc_req->ssid, &ssid, IEEE80211_MAX_SSID_LEN);
2071
			assoc_req->ssid_len = ssid_len;
2072
			set_bit(ASSOC_FLAG_SSID, &assoc_req->flags);
2073
			lbs_postpone_association_work(priv);
2074 2075 2076 2077 2078
		}
	}

	/* Cancel the association request if there was an error */
	if (ret != 0) {
2079
		lbs_cancel_association_work(priv);
2080 2081
	}

2082
	mutex_unlock(&priv->lock);
2083

2084
	lbs_deb_leave_args(LBS_DEB_WEXT, "ret %d", ret);
2085 2086 2087
	return ret;
}

2088 2089 2090 2091
static int lbs_mesh_get_essid(struct net_device *dev,
			      struct iw_request_info *info,
			      struct iw_point *dwrq, char *extra)
{
2092
	struct lbs_private *priv = dev->ml_priv;
2093 2094 2095 2096 2097 2098 2099 2100 2101 2102 2103 2104 2105 2106 2107 2108 2109

	lbs_deb_enter(LBS_DEB_WEXT);

	memcpy(extra, priv->mesh_ssid, priv->mesh_ssid_len);

	dwrq->length = priv->mesh_ssid_len;

	dwrq->flags = 1;	/* active */

	lbs_deb_leave(LBS_DEB_WEXT);
	return 0;
}

static int lbs_mesh_set_essid(struct net_device *dev,
			      struct iw_request_info *info,
			      struct iw_point *dwrq, char *extra)
{
2110
	struct lbs_private *priv = dev->ml_priv;
2111 2112 2113 2114
	int ret = 0;

	lbs_deb_enter(LBS_DEB_WEXT);

2115 2116 2117 2118 2119
	if (!priv->radio_on) {
		ret = -EINVAL;
		goto out;
	}

2120
	/* Check the size of the string */
2121
	if (dwrq->length > IEEE80211_MAX_SSID_LEN) {
2122 2123 2124 2125 2126 2127 2128 2129 2130 2131 2132 2133 2134
		ret = -E2BIG;
		goto out;
	}

	if (!dwrq->flags || !dwrq->length) {
		ret = -EINVAL;
		goto out;
	} else {
		/* Specific SSID requested */
		memcpy(priv->mesh_ssid, extra, dwrq->length);
		priv->mesh_ssid_len = dwrq->length;
	}

2135
	lbs_mesh_config(priv, CMD_ACT_MESH_CONFIG_START,
2136
			priv->channel);
2137 2138 2139 2140 2141
 out:
	lbs_deb_leave_args(LBS_DEB_WEXT, "ret %d", ret);
	return ret;
}

2142 2143 2144 2145 2146 2147 2148 2149 2150
/**
 *  @brief Connect to the AP or Ad-hoc Network with specific bssid
 *
 *  @param dev          A pointer to net_device structure
 *  @param info         A pointer to iw_request_info structure
 *  @param awrq         A pointer to iw_param structure
 *  @param extra        A pointer to extra data buf
 *  @return             0 --success, otherwise fail
 */
2151
static int lbs_set_wap(struct net_device *dev, struct iw_request_info *info,
2152 2153
		 struct sockaddr *awrq, char *extra)
{
2154
	struct lbs_private *priv = dev->ml_priv;
2155 2156 2157
	struct assoc_request * assoc_req;
	int ret = 0;

2158
	lbs_deb_enter(LBS_DEB_WEXT);
2159

2160 2161 2162
	if (!priv->radio_on)
		return -EINVAL;

2163 2164 2165
	if (awrq->sa_family != ARPHRD_ETHER)
		return -EINVAL;

J
Johannes Berg 已提交
2166
	lbs_deb_wext("ASSOC: WAP: sa_data %pM\n", awrq->sa_data);
2167

2168
	mutex_lock(&priv->lock);
2169 2170

	/* Get or create the current association request */
2171
	assoc_req = lbs_get_association_request(priv);
2172
	if (!assoc_req) {
2173
		lbs_cancel_association_work(priv);
2174 2175 2176 2177 2178
		ret = -ENOMEM;
	} else {
		/* Copy the BSSID to the association request */
		memcpy(&assoc_req->bssid, awrq->sa_data, ETH_ALEN);
		set_bit(ASSOC_FLAG_BSSID, &assoc_req->flags);
2179
		lbs_postpone_association_work(priv);
2180 2181
	}

2182
	mutex_unlock(&priv->lock);
2183 2184 2185 2186 2187 2188 2189

	return ret;
}

/*
 * iwconfig settable callbacks
 */
2190
static const iw_handler lbs_handler[] = {
2191
	(iw_handler) NULL,	/* SIOCSIWCOMMIT */
2192
	(iw_handler) lbs_get_name,	/* SIOCGIWNAME */
2193 2194
	(iw_handler) NULL,	/* SIOCSIWNWID */
	(iw_handler) NULL,	/* SIOCGIWNWID */
2195 2196 2197 2198
	(iw_handler) lbs_set_freq,	/* SIOCSIWFREQ */
	(iw_handler) lbs_get_freq,	/* SIOCGIWFREQ */
	(iw_handler) lbs_set_mode,	/* SIOCSIWMODE */
	(iw_handler) lbs_get_mode,	/* SIOCGIWMODE */
2199 2200 2201
	(iw_handler) NULL,	/* SIOCSIWSENS */
	(iw_handler) NULL,	/* SIOCGIWSENS */
	(iw_handler) NULL,	/* SIOCSIWRANGE */
2202
	(iw_handler) lbs_get_range,	/* SIOCGIWRANGE */
2203 2204 2205 2206 2207 2208 2209 2210
	(iw_handler) NULL,	/* SIOCSIWPRIV */
	(iw_handler) NULL,	/* SIOCGIWPRIV */
	(iw_handler) NULL,	/* SIOCSIWSTATS */
	(iw_handler) NULL,	/* SIOCGIWSTATS */
	iw_handler_set_spy,	/* SIOCSIWSPY */
	iw_handler_get_spy,	/* SIOCGIWSPY */
	iw_handler_set_thrspy,	/* SIOCSIWTHRSPY */
	iw_handler_get_thrspy,	/* SIOCGIWTHRSPY */
2211 2212
	(iw_handler) lbs_set_wap,	/* SIOCSIWAP */
	(iw_handler) lbs_get_wap,	/* SIOCGIWAP */
2213 2214
	(iw_handler) NULL,	/* SIOCSIWMLME */
	(iw_handler) NULL,	/* SIOCGIWAPLIST - deprecated */
2215 2216 2217 2218 2219 2220
	(iw_handler) lbs_set_scan,	/* SIOCSIWSCAN */
	(iw_handler) lbs_get_scan,	/* SIOCGIWSCAN */
	(iw_handler) lbs_set_essid,	/* SIOCSIWESSID */
	(iw_handler) lbs_get_essid,	/* SIOCGIWESSID */
	(iw_handler) lbs_set_nick,	/* SIOCSIWNICKN */
	(iw_handler) lbs_get_nick,	/* SIOCGIWNICKN */
2221 2222
	(iw_handler) NULL,	/* -- hole -- */
	(iw_handler) NULL,	/* -- hole -- */
2223 2224 2225 2226 2227 2228 2229 2230 2231 2232 2233 2234 2235 2236
	(iw_handler) lbs_set_rate,	/* SIOCSIWRATE */
	(iw_handler) lbs_get_rate,	/* SIOCGIWRATE */
	(iw_handler) lbs_set_rts,	/* SIOCSIWRTS */
	(iw_handler) lbs_get_rts,	/* SIOCGIWRTS */
	(iw_handler) lbs_set_frag,	/* SIOCSIWFRAG */
	(iw_handler) lbs_get_frag,	/* SIOCGIWFRAG */
	(iw_handler) lbs_set_txpow,	/* SIOCSIWTXPOW */
	(iw_handler) lbs_get_txpow,	/* SIOCGIWTXPOW */
	(iw_handler) lbs_set_retry,	/* SIOCSIWRETRY */
	(iw_handler) lbs_get_retry,	/* SIOCGIWRETRY */
	(iw_handler) lbs_set_encode,	/* SIOCSIWENCODE */
	(iw_handler) lbs_get_encode,	/* SIOCGIWENCODE */
	(iw_handler) lbs_set_power,	/* SIOCSIWPOWER */
	(iw_handler) lbs_get_power,	/* SIOCGIWPOWER */
2237 2238
	(iw_handler) NULL,	/* -- hole -- */
	(iw_handler) NULL,	/* -- hole -- */
2239 2240 2241 2242 2243 2244
	(iw_handler) lbs_set_genie,	/* SIOCSIWGENIE */
	(iw_handler) lbs_get_genie,	/* SIOCGIWGENIE */
	(iw_handler) lbs_set_auth,	/* SIOCSIWAUTH */
	(iw_handler) lbs_get_auth,	/* SIOCGIWAUTH */
	(iw_handler) lbs_set_encodeext,/* SIOCSIWENCODEEXT */
	(iw_handler) lbs_get_encodeext,/* SIOCGIWENCODEEXT */
2245 2246 2247
	(iw_handler) NULL,		/* SIOCSIWPMKSA */
};

2248 2249
static const iw_handler mesh_wlan_handler[] = {
	(iw_handler) NULL,	/* SIOCSIWCOMMIT */
2250
	(iw_handler) lbs_get_name,	/* SIOCGIWNAME */
2251 2252
	(iw_handler) NULL,	/* SIOCSIWNWID */
	(iw_handler) NULL,	/* SIOCGIWNWID */
2253
	(iw_handler) lbs_mesh_set_freq,	/* SIOCSIWFREQ */
2254
	(iw_handler) lbs_get_freq,	/* SIOCGIWFREQ */
2255 2256 2257 2258 2259
	(iw_handler) NULL,		/* SIOCSIWMODE */
	(iw_handler) mesh_wlan_get_mode,	/* SIOCGIWMODE */
	(iw_handler) NULL,	/* SIOCSIWSENS */
	(iw_handler) NULL,	/* SIOCGIWSENS */
	(iw_handler) NULL,	/* SIOCSIWRANGE */
2260
	(iw_handler) lbs_get_range,	/* SIOCGIWRANGE */
2261 2262 2263 2264 2265 2266 2267 2268 2269 2270 2271 2272
	(iw_handler) NULL,	/* SIOCSIWPRIV */
	(iw_handler) NULL,	/* SIOCGIWPRIV */
	(iw_handler) NULL,	/* SIOCSIWSTATS */
	(iw_handler) NULL,	/* SIOCGIWSTATS */
	iw_handler_set_spy,	/* SIOCSIWSPY */
	iw_handler_get_spy,	/* SIOCGIWSPY */
	iw_handler_set_thrspy,	/* SIOCSIWTHRSPY */
	iw_handler_get_thrspy,	/* SIOCGIWTHRSPY */
	(iw_handler) NULL,	/* SIOCSIWAP */
	(iw_handler) NULL,	/* SIOCGIWAP */
	(iw_handler) NULL,	/* SIOCSIWMLME */
	(iw_handler) NULL,	/* SIOCGIWAPLIST - deprecated */
2273 2274
	(iw_handler) lbs_set_scan,	/* SIOCSIWSCAN */
	(iw_handler) lbs_get_scan,	/* SIOCGIWSCAN */
2275 2276
	(iw_handler) lbs_mesh_set_essid,/* SIOCSIWESSID */
	(iw_handler) lbs_mesh_get_essid,/* SIOCGIWESSID */
2277 2278 2279 2280
	(iw_handler) NULL,		/* SIOCSIWNICKN */
	(iw_handler) mesh_get_nick,	/* SIOCGIWNICKN */
	(iw_handler) NULL,	/* -- hole -- */
	(iw_handler) NULL,	/* -- hole -- */
2281 2282 2283 2284 2285 2286 2287 2288 2289 2290 2291 2292 2293 2294
	(iw_handler) lbs_set_rate,	/* SIOCSIWRATE */
	(iw_handler) lbs_get_rate,	/* SIOCGIWRATE */
	(iw_handler) lbs_set_rts,	/* SIOCSIWRTS */
	(iw_handler) lbs_get_rts,	/* SIOCGIWRTS */
	(iw_handler) lbs_set_frag,	/* SIOCSIWFRAG */
	(iw_handler) lbs_get_frag,	/* SIOCGIWFRAG */
	(iw_handler) lbs_set_txpow,	/* SIOCSIWTXPOW */
	(iw_handler) lbs_get_txpow,	/* SIOCGIWTXPOW */
	(iw_handler) lbs_set_retry,	/* SIOCSIWRETRY */
	(iw_handler) lbs_get_retry,	/* SIOCGIWRETRY */
	(iw_handler) lbs_set_encode,	/* SIOCSIWENCODE */
	(iw_handler) lbs_get_encode,	/* SIOCGIWENCODE */
	(iw_handler) lbs_set_power,	/* SIOCSIWPOWER */
	(iw_handler) lbs_get_power,	/* SIOCGIWPOWER */
2295 2296
	(iw_handler) NULL,	/* -- hole -- */
	(iw_handler) NULL,	/* -- hole -- */
2297 2298 2299 2300 2301 2302
	(iw_handler) lbs_set_genie,	/* SIOCSIWGENIE */
	(iw_handler) lbs_get_genie,	/* SIOCGIWGENIE */
	(iw_handler) lbs_set_auth,	/* SIOCSIWAUTH */
	(iw_handler) lbs_get_auth,	/* SIOCGIWAUTH */
	(iw_handler) lbs_set_encodeext,/* SIOCSIWENCODEEXT */
	(iw_handler) lbs_get_encodeext,/* SIOCGIWENCODEEXT */
2303 2304
	(iw_handler) NULL,		/* SIOCSIWPMKSA */
};
2305 2306 2307 2308
struct iw_handler_def lbs_handler_def = {
	.num_standard	= ARRAY_SIZE(lbs_handler),
	.standard	= (iw_handler *) lbs_handler,
	.get_wireless_stats = lbs_get_wireless_stats,
2309
};
2310 2311

struct iw_handler_def mesh_handler_def = {
2312
	.num_standard	= ARRAY_SIZE(mesh_wlan_handler),
2313
	.standard	= (iw_handler *) mesh_wlan_handler,
2314
	.get_wireless_stats = lbs_get_wireless_stats,
2315
};