wext.c 54.8 KB
Newer Older
1 2 3 4 5 6 7 8 9 10 11 12 13 14 15 16 17 18 19
/**
  * 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>

#include <net/ieee80211.h>
#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
static inline void lbs_cancel_association_work(struct lbs_private *priv)
34 35
{
	cancel_delayed_work(&priv->assoc_work);
36 37
	kfree(priv->pending_assoc_req);
	priv->pending_assoc_req = NULL;
38 39 40
}


41 42 43
/**
 *  @brief Find the channel frequency power info with specific channel
 *
44
 *  @param priv 	A pointer to struct lbs_private structure
45 46 47 48
 *  @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.
 */
49
struct chan_freq_power *lbs_find_cfp_by_band_and_channel(
50
	struct lbs_private *priv,
51 52
	u8 band,
	u16 channel)
53 54 55 56 57
{
	struct chan_freq_power *cfp = NULL;
	struct region_channel *rc;
	int i, j;

58 59
	for (j = 0; !cfp && (j < ARRAY_SIZE(priv->region_channel)); j++) {
		rc = &priv->region_channel[j];
60

61 62
		if (priv->enable11d)
			rc = &priv->universal_channel[j];
63 64 65 66 67 68 69 70 71 72 73 74 75
		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)
76
		lbs_deb_wext("lbs_find_cfp_by_band_and_channel: can't find "
77
		       "cfp by band %d / channel %d\n", band, channel);
78 79 80 81 82 83 84

	return cfp;
}

/**
 *  @brief Find the channel frequency power info with specific frequency
 *
85
 *  @param priv 	A pointer to struct lbs_private structure
86 87 88 89
 *  @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.
 */
90
static struct chan_freq_power *find_cfp_by_band_and_freq(
91
	struct lbs_private *priv,
92 93
	u8 band,
	u32 freq)
94 95 96 97 98
{
	struct chan_freq_power *cfp = NULL;
	struct region_channel *rc;
	int i, j;

99 100
	for (j = 0; !cfp && (j < ARRAY_SIZE(priv->region_channel)); j++) {
		rc = &priv->region_channel[j];
101

102 103
		if (priv->enable11d)
			rc = &priv->universal_channel[j];
104 105 106 107 108 109 110 111 112 113 114 115 116
		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)
117 118
		lbs_deb_wext("find_cfp_by_band_and_freql: can't find cfp by "
		       "band %d / freq %d\n", band, freq);
119 120 121 122 123

	return cfp;
}

/**
124
 *  @brief Copy active data rates based on adapter mode and status
125
 *
126
 *  @param priv              A pointer to struct lbs_private structure
127 128
 *  @param rate		        The buf to return the active rates
 */
129
static void copy_active_data_rates(struct lbs_private *priv, u8 *rates)
130
{
131
	lbs_deb_enter(LBS_DEB_WEXT);
132

133 134
	if ((priv->connect_status != LBS_CONNECTED) &&
		(priv->mesh_connect_status != LBS_CONNECTED))
135
		memcpy(rates, lbs_bg_rates, MAX_RATES);
136
	else
137
		memcpy(rates, priv->curbssparams.rates, MAX_RATES);
138

139
	lbs_deb_leave(LBS_DEB_WEXT);
140 141
}

142
static int lbs_get_name(struct net_device *dev, struct iw_request_info *info,
143 144 145
			 char *cwrq, char *extra)
{

146
	lbs_deb_enter(LBS_DEB_WEXT);
147

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

151
	lbs_deb_leave(LBS_DEB_WEXT);
152 153 154
	return 0;
}

155
static int lbs_get_freq(struct net_device *dev, struct iw_request_info *info,
156 157
			 struct iw_freq *fwrq, char *extra)
{
158
	struct lbs_private *priv = dev->priv;
159 160
	struct chan_freq_power *cfp;

161
	lbs_deb_enter(LBS_DEB_WEXT);
162

163 164
	cfp = lbs_find_cfp_by_band_and_channel(priv, 0,
					   priv->curbssparams.channel);
165 166

	if (!cfp) {
167
		if (priv->curbssparams.channel)
168
			lbs_deb_wext("invalid channel %d\n",
169
			       priv->curbssparams.channel);
170 171 172 173 174 175
		return -EINVAL;
	}

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

176 177
	lbs_deb_wext("freq %u\n", fwrq->m);
	lbs_deb_leave(LBS_DEB_WEXT);
178 179 180
	return 0;
}

181
static int lbs_get_wap(struct net_device *dev, struct iw_request_info *info,
182 183
			struct sockaddr *awrq, char *extra)
{
184
	struct lbs_private *priv = dev->priv;
185

186
	lbs_deb_enter(LBS_DEB_WEXT);
187

188 189
	if (priv->connect_status == LBS_CONNECTED) {
		memcpy(awrq->sa_data, priv->curbssparams.bssid, ETH_ALEN);
190 191 192 193 194
	} else {
		memset(awrq->sa_data, 0, ETH_ALEN);
	}
	awrq->sa_family = ARPHRD_ETHER;

195
	lbs_deb_leave(LBS_DEB_WEXT);
196 197 198
	return 0;
}

199
static int lbs_set_nick(struct net_device *dev, struct iw_request_info *info,
200 201
			 struct iw_point *dwrq, char *extra)
{
202
	struct lbs_private *priv = dev->priv;
203

204
	lbs_deb_enter(LBS_DEB_WEXT);
205 206 207 208 209 210 211 212 213

	/*
	 * Check the size of the string
	 */

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

214 215 216 217
	mutex_lock(&priv->lock);
	memset(priv->nodename, 0, sizeof(priv->nodename));
	memcpy(priv->nodename, extra, dwrq->length);
	mutex_unlock(&priv->lock);
218

219
	lbs_deb_leave(LBS_DEB_WEXT);
220 221 222
	return 0;
}

223
static int lbs_get_nick(struct net_device *dev, struct iw_request_info *info,
224 225
			 struct iw_point *dwrq, char *extra)
{
226
	struct lbs_private *priv = dev->priv;
227

228
	lbs_deb_enter(LBS_DEB_WEXT);
229

230 231
	dwrq->length = strlen(priv->nodename);
	memcpy(extra, priv->nodename, dwrq->length);
232
	extra[dwrq->length] = '\0';
233

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

236
	lbs_deb_leave(LBS_DEB_WEXT);
237 238 239
	return 0;
}

240 241 242
static int mesh_get_nick(struct net_device *dev, struct iw_request_info *info,
			 struct iw_point *dwrq, char *extra)
{
243
	struct lbs_private *priv = dev->priv;
244 245 246 247 248

	lbs_deb_enter(LBS_DEB_WEXT);

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

249
	if (priv->mesh_connect_status == LBS_CONNECTED) {
250 251
		strncpy(extra, "Mesh", 12);
		extra[12] = '\0';
252
		dwrq->length = strlen(extra);
253 254 255 256
	}

	else {
		extra[0] = '\0';
257
		dwrq->length = 0;
258 259 260 261 262
	}

	lbs_deb_leave(LBS_DEB_WEXT);
	return 0;
}
263

264
static int lbs_set_rts(struct net_device *dev, struct iw_request_info *info,
265 266 267
			struct iw_param *vwrq, char *extra)
{
	int ret = 0;
268
	struct lbs_private *priv = dev->priv;
269
	u32 val = vwrq->value;
270

271
	lbs_deb_enter(LBS_DEB_WEXT);
272

273 274
	if (vwrq->disabled)
		val = MRVDRV_RTS_MAX_VALUE;
275

276 277 278 279
	if (val < MRVDRV_RTS_MIN_VALUE || val > MRVDRV_RTS_MAX_VALUE)
		return -EINVAL;

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

281
	lbs_deb_leave_args(LBS_DEB_WEXT, "ret %d", ret);
282 283 284
	return ret;
}

285
static int lbs_get_rts(struct net_device *dev, struct iw_request_info *info,
286 287
			struct iw_param *vwrq, char *extra)
{
288
	struct lbs_private *priv = dev->priv;
289 290
	int ret = 0;
	u16 val = 0;
291

292
	lbs_deb_enter(LBS_DEB_WEXT);
293

294
	ret = lbs_get_snmp_mib(priv, SNMP_MIB_OID_RTS_THRESHOLD, &val);
295 296
	if (ret)
		goto out;
297

298 299 300
	vwrq->value = val;
	vwrq->disabled = ((val < MRVDRV_RTS_MIN_VALUE)
			  || (val > MRVDRV_RTS_MAX_VALUE));
301 302
	vwrq->fixed = 1;

303 304 305
out:
	lbs_deb_leave_args(LBS_DEB_WEXT, "ret %d", ret);
	return ret;
306 307
}

308
static int lbs_set_frag(struct net_device *dev, struct iw_request_info *info,
309 310
			 struct iw_param *vwrq, char *extra)
{
311
	struct lbs_private *priv = dev->priv;
312 313
	int ret = 0;
	u32 val = vwrq->value;
314

315
	lbs_deb_enter(LBS_DEB_WEXT);
316

317 318 319 320 321
	if (vwrq->disabled)
		val = MRVDRV_FRAG_MAX_VALUE;

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

323
	ret = lbs_set_snmp_mib(priv, SNMP_MIB_OID_FRAG_THRESHOLD, (u16) val);
324 325

	lbs_deb_leave_args(LBS_DEB_WEXT, "ret %d", ret);
326 327 328
	return ret;
}

329
static int lbs_get_frag(struct net_device *dev, struct iw_request_info *info,
330 331
			 struct iw_param *vwrq, char *extra)
{
332
	struct lbs_private *priv = dev->priv;
333 334
	int ret = 0;
	u16 val = 0;
335

336
	lbs_deb_enter(LBS_DEB_WEXT);
337

338
	ret = lbs_get_snmp_mib(priv, SNMP_MIB_OID_FRAG_THRESHOLD, &val);
339 340
	if (ret)
		goto out;
341

342 343 344
	vwrq->value = val;
	vwrq->disabled = ((val < MRVDRV_FRAG_MIN_VALUE)
			  || (val > MRVDRV_FRAG_MAX_VALUE));
345 346
	vwrq->fixed = 1;

347 348
out:
	lbs_deb_leave_args(LBS_DEB_WEXT, "ret %d", ret);
349 350 351
	return ret;
}

352
static int lbs_get_mode(struct net_device *dev,
353 354
			 struct iw_request_info *info, u32 * uwrq, char *extra)
{
355
	struct lbs_private *priv = dev->priv;
356

357
	lbs_deb_enter(LBS_DEB_WEXT);
358

359
	*uwrq = priv->mode;
360

361
	lbs_deb_leave(LBS_DEB_WEXT);
362 363 364
	return 0;
}

365 366 367 368 369 370
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);

371
	*uwrq = IW_MODE_REPEAT;
372 373 374 375 376

	lbs_deb_leave(LBS_DEB_WEXT);
	return 0;
}

377
static int lbs_get_txpow(struct net_device *dev,
378 379 380
			  struct iw_request_info *info,
			  struct iw_param *vwrq, char *extra)
{
381
	struct lbs_private *priv = dev->priv;
382
	s16 curlevel = 0;
383
	int ret = 0;
384

385
	lbs_deb_enter(LBS_DEB_WEXT);
386

387 388 389 390 391 392 393
	if (!priv->radio_on) {
		lbs_deb_wext("tx power off\n");
		vwrq->value = 0;
		vwrq->disabled = 1;
		goto out;
	}

394
	ret = lbs_get_tx_power(priv, &curlevel, NULL, NULL);
395 396
	if (ret)
		goto out;
397

398 399
	lbs_deb_wext("tx power level %d dbm\n", curlevel);
	priv->txpower_cur = curlevel;
400

401
	vwrq->value = curlevel;
402
	vwrq->fixed = 1;
403 404
	vwrq->disabled = 0;
	vwrq->flags = IW_TXPOW_DBM;
405

406 407 408
out:
	lbs_deb_leave_args(LBS_DEB_WEXT, "ret %d", ret);
	return ret;
409 410
}

411
static int lbs_set_retry(struct net_device *dev, struct iw_request_info *info,
412 413
			  struct iw_param *vwrq, char *extra)
{
414
	struct lbs_private *priv = dev->priv;
415 416
	int ret = 0;
	u16 slimit = 0, llimit = 0;
417

418
	lbs_deb_enter(LBS_DEB_WEXT);
419

420 421 422 423 424
        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 */
425 426
#define TX_RETRY_MIN 0
#define TX_RETRY_MAX 14
427 428
	if (vwrq->value < TX_RETRY_MIN || vwrq->value > TX_RETRY_MAX)
		return -EINVAL;
429

430 431 432 433 434 435 436
	/* 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 */
437

438 439 440 441 442 443
	if (llimit) {
		ret = lbs_set_snmp_mib(priv, SNMP_MIB_OID_LONG_RETRY_LIMIT,
				       llimit);
		if (ret)
			goto out;
	}
444

445 446 447 448 449
	if (slimit) {
		/* txretrycount follows the short retry limit */
		priv->txretrycount = slimit;
		ret = lbs_set_snmp_mib(priv, SNMP_MIB_OID_SHORT_RETRY_LIMIT,
				       slimit);
450 451
		if (ret)
			goto out;
452 453
	}

454 455 456
out:
	lbs_deb_leave_args(LBS_DEB_WEXT, "ret %d", ret);
	return ret;
457 458
}

459
static int lbs_get_retry(struct net_device *dev, struct iw_request_info *info,
460 461
			  struct iw_param *vwrq, char *extra)
{
462
	struct lbs_private *priv = dev->priv;
463
	int ret = 0;
464
	u16 val = 0;
465

466 467
	lbs_deb_enter(LBS_DEB_WEXT);

468
	vwrq->disabled = 0;
469 470 471 472 473 474 475 476 477 478 479 480 481 482 483 484

	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;
485
		/* Subtract 1 to convert try count to retry count */
486 487
		vwrq->value = val - 1;
		vwrq->flags = IW_RETRY_LIMIT | IW_RETRY_SHORT;
488 489
	}

490 491 492
out:
	lbs_deb_leave_args(LBS_DEB_WEXT, "ret %d", ret);
	return ret;
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
}

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
 */
534
static int lbs_get_range(struct net_device *dev, struct iw_request_info *info,
535 536 537
			  struct iw_point *dwrq, char *extra)
{
	int i, j;
538
	struct lbs_private *priv = dev->priv;
539 540
	struct iw_range *range = (struct iw_range *)extra;
	struct chan_freq_power *cfp;
541
	u8 rates[MAX_RATES + 1];
542 543 544

	u8 flag = 0;

545
	lbs_deb_enter(LBS_DEB_WEXT);
546 547 548 549 550 551 552 553

	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));
554
	copy_active_data_rates(priv, rates);
555 556 557
	range->num_bitrates = strnlen(rates, IW_MAX_BITRATES);
	for (i = 0; i < range->num_bitrates; i++)
		range->bitrate[i] = rates[i] * 500000;
558
	range->num_bitrates = i;
559
	lbs_deb_wext("IW_MAX_BITRATES %d, num_bitrates %d\n", IW_MAX_BITRATES,
560 561 562
	       range->num_bitrates);

	range->num_frequency = 0;
563 564 565

	range->scan_capa = IW_SCAN_CAPA_ESSID;

566 567 568
	if (priv->enable11d &&
	    (priv->connect_status == LBS_CONNECTED ||
	    priv->mesh_connect_status == LBS_CONNECTED)) {
569 570 571 572
		u8 chan_no;
		u8 band;

		struct parsed_region_chan_11d *parsed_region_chan =
573
		    &priv->parsed_region_chan;
574 575

		if (parsed_region_chan == NULL) {
576 577
			lbs_deb_wext("11d: parsed_region_chan is NULL\n");
			goto out;
578 579
		}
		band = parsed_region_chan->band;
580
		lbs_deb_wext("band %d, nr_char %d\n", band,
581 582 583 584 585
		       parsed_region_chan->nr_chan);

		for (i = 0; (range->num_frequency < IW_MAX_FREQUENCIES)
		     && (i < parsed_region_chan->nr_chan); i++) {
			chan_no = parsed_region_chan->chanpwr[i].chan;
586
			lbs_deb_wext("chan_no %d\n", chan_no);
587 588
			range->freq[range->num_frequency].i = (long)chan_no;
			range->freq[range->num_frequency].m =
589
			    (long)lbs_chan_2_freq(chan_no) * 100000;
590 591 592 593 594 595 596
			range->freq[range->num_frequency].e = 1;
			range->num_frequency++;
		}
		flag = 1;
	}
	if (!flag) {
		for (j = 0; (range->num_frequency < IW_MAX_FREQUENCIES)
597 598
		     && (j < ARRAY_SIZE(priv->region_channel)); j++) {
			cfp = priv->region_channel[j].CFP;
599
			for (i = 0; (range->num_frequency < IW_MAX_FREQUENCIES)
600
			     && priv->region_channel[j].valid
601
			     && cfp
602
			     && (i < priv->region_channel[j].nrcfp); i++) {
603 604 605 606 607 608 609 610 611 612 613
				range->freq[range->num_frequency].i =
				    (long)cfp->channel;
				range->freq[range->num_frequency].m =
				    (long)cfp->freq * 100000;
				range->freq[range->num_frequency].e = 1;
				cfp++;
				range->num_frequency++;
			}
		}
	}

614
	lbs_deb_wext("IW_MAX_FREQUENCIES %d, num_frequency %d\n",
615 616 617 618 619 620 621 622 623 624 625 626 627 628 629 630 631 632 633 634 635 636 637 638 639
	       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;

640 641 642 643
	/*
	 * Right now we support only "iwconfig ethX power on|off"
	 */
	range->pm_capa = IW_POWER_ON;
644 645 646 647 648 649 650 651 652 653 654 655 656 657 658 659 660 661 662 663 664 665 666 667 668 669 670 671 672 673 674 675 676

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

677
	/* Setup the supported power level ranges */
678
	memset(range->txpower, 0, sizeof(range->txpower));
679 680 681 682
	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;
683 684 685 686 687 688

	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;

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

696 697
out:
	lbs_deb_leave(LBS_DEB_WEXT);
698 699 700
	return 0;
}

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

706
	lbs_deb_enter(LBS_DEB_WEXT);
707

708 709 710 711 712 713 714
	if (!priv->ps_supported) {
		if (vwrq->disabled)
			return 0;
		else
			return -EINVAL;
	}

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

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

		return 0;
	}

	if ((vwrq->flags & IW_POWER_TYPE) == IW_POWER_TIMEOUT) {
729 730
		lbs_deb_wext(
		       "setting power timeout is not supported\n");
731 732
		return -EINVAL;
	} else if ((vwrq->flags & IW_POWER_TYPE) == IW_POWER_PERIOD) {
733
		lbs_deb_wext("setting power period not supported\n");
734 735 736
		return -EINVAL;
	}

737
	if (priv->psmode != LBS802_11POWERMODECAM) {
738 739 740
		return 0;
	}

741
	priv->psmode = LBS802_11POWERMODEMAX_PSP;
742

743
	if (priv->connect_status == LBS_CONNECTED) {
744
		lbs_ps_sleep(priv, CMD_OPTION_WAITFORRSP);
745 746
	}

747
	lbs_deb_leave(LBS_DEB_WEXT);
748 749 750
	return 0;
}

751
static int lbs_get_power(struct net_device *dev, struct iw_request_info *info,
752 753
			  struct iw_param *vwrq, char *extra)
{
754
	struct lbs_private *priv = dev->priv;
755

756
	lbs_deb_enter(LBS_DEB_WEXT);
757 758

	vwrq->value = 0;
759 760 761
	vwrq->flags = 0;
	vwrq->disabled = priv->psmode == LBS802_11POWERMODECAM
		|| priv->connect_status == LBS_DISCONNECTED;
762

763
	lbs_deb_leave(LBS_DEB_WEXT);
764 765 766
	return 0;
}

767
static struct iw_statistics *lbs_get_wireless_stats(struct net_device *dev)
768 769 770 771 772 773 774 775 776
{
	enum {
		POOR = 30,
		FAIR = 60,
		GOOD = 80,
		VERY_GOOD = 90,
		EXCELLENT = 95,
		PERFECT = 100
	};
777
	struct lbs_private *priv = dev->priv;
778 779 780 781 782 783
	u32 rssi_qual;
	u32 tx_qual;
	u32 quality = 0;
	int stats_valid = 0;
	u8 rssi;
	u32 tx_retries;
784
	struct cmd_ds_802_11_get_log log;
785

786
	lbs_deb_enter(LBS_DEB_WEXT);
787

788
	priv->wstats.status = priv->mode;
789 790

	/* If we're not associated, all quality values are meaningless */
791 792
	if ((priv->connect_status != LBS_CONNECTED) &&
	    (priv->mesh_connect_status != LBS_CONNECTED))
793 794 795 796
		goto out;

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

800
	if (priv->NF[TYPE_BEACON][TYPE_NOAVG] == 0) {
801 802 803
		priv->wstats.qual.noise = MRVDRV_NF_DEFAULT_SCAN_VALUE;
	} else {
		priv->wstats.qual.noise =
804
		    CAL_NF(priv->NF[TYPE_BEACON][TYPE_NOAVG]);
805 806
	}

807 808
	lbs_deb_wext("signal level %#x\n", priv->wstats.qual.level);
	lbs_deb_wext("noise %#x\n", priv->wstats.qual.noise);
809 810 811 812 813 814 815 816 817 818 819 820 821 822 823 824 825 826 827

	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 */
	priv->wstats.discard.retries = priv->stats.tx_errors;

828 829 830 831 832
	memset(&log, 0, sizeof(log));
	log.hdr.size = cpu_to_le16(sizeof(log));
	lbs_cmd_with_response(priv, CMD_802_11_GET_LOG, &log);

	tx_retries = le32_to_cpu(log.retry);
833 834 835 836 837 838 839 840 841 842 843 844 845 846 847

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

848
	priv->wstats.discard.code = le32_to_cpu(log.wepundecryptable);
849
	priv->wstats.discard.retries = tx_retries;
850
	priv->wstats.discard.misc = le32_to_cpu(log.ackfailure);
851 852

	/* Calculate quality */
853
	priv->wstats.qual.qual = min_t(u8, quality, 100);
854 855 856 857
	priv->wstats.qual.updated = IW_QUAL_ALL_UPDATED | IW_QUAL_DBM;
	stats_valid = 1;

	/* update stats asynchronously for future calls */
858
	lbs_prepare_and_send_command(priv, CMD_802_11_RSSI, 0,
859 860 861 862 863 864 865 866 867 868 869 870 871
					0, 0, NULL);
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;
	}

872
	lbs_deb_leave(LBS_DEB_WEXT);
873 874 875 876 877
	return &priv->wstats;


}

878
static int lbs_set_freq(struct net_device *dev, struct iw_request_info *info,
879 880
		  struct iw_freq *fwrq, char *extra)
{
881
	int ret = -EINVAL;
882
	struct lbs_private *priv = dev->priv;
883
	struct chan_freq_power *cfp;
884
	struct assoc_request * assoc_req;
885

886
	lbs_deb_enter(LBS_DEB_WEXT);
887

888 889
	mutex_lock(&priv->lock);
	assoc_req = lbs_get_association_request(priv);
890 891 892 893
	if (!assoc_req) {
		ret = -ENOMEM;
		goto out;
	}
894

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

899
		cfp = find_cfp_by_band_and_freq(priv, 0, f);
900
		if (!cfp) {
901
			lbs_deb_wext("invalid freq %ld\n", f);
902
			goto out;
903 904 905
		}

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

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

914
	cfp = lbs_find_cfp_by_band_and_channel(priv, 0, fwrq->m);
915 916
	if (!cfp) {
		goto out;
917 918
	}

919 920 921
	assoc_req->channel = fwrq->m;
	ret = 0;

922
out:
923 924
	if (ret == 0) {
		set_bit(ASSOC_FLAG_CHANNEL, &assoc_req->flags);
925
		lbs_postpone_association_work(priv);
926
	} else {
927
		lbs_cancel_association_work(priv);
928
	}
929
	mutex_unlock(&priv->lock);
930 931 932

	lbs_deb_leave_args(LBS_DEB_WEXT, "ret %d", ret);
	return ret;
933 934
}

935 936 937 938 939 940 941 942 943 944 945 946 947 948 949 950 951 952 953 954 955 956 957 958 959 960 961 962 963 964 965 966 967 968 969 970 971
static int lbs_mesh_set_freq(struct net_device *dev,
			     struct iw_request_info *info,
			     struct iw_freq *fwrq, char *extra)
{
	struct lbs_private *priv = dev->priv;
	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;
	}

	if (fwrq->m != priv->curbssparams.channel) {
		lbs_deb_wext("mesh channel change forces eth disconnect\n");
		if (priv->mode == IW_MODE_INFRA)
972 973 974
			lbs_cmd_80211_deauthenticate(priv,
						     priv->curbssparams.bssid,
						     WLAN_REASON_DEAUTH_LEAVING);
975
		else if (priv->mode == IW_MODE_ADHOC)
976
			lbs_adhoc_stop(priv);
977
	}
978
	lbs_mesh_config(priv, CMD_ACT_MESH_CONFIG_START, fwrq->m);
979
	lbs_update_channel(priv);
980 981 982 983 984 985 986
	ret = 0;

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

987
static int lbs_set_rate(struct net_device *dev, struct iw_request_info *info,
988 989
		  struct iw_param *vwrq, char *extra)
{
990
	struct lbs_private *priv = dev->priv;
991
	u8 new_rate = 0;
992 993
	int ret = -EINVAL;
	u8 rates[MAX_RATES + 1];
994

995 996
	lbs_deb_enter(LBS_DEB_WEXT);
	lbs_deb_wext("vwrq->value %d\n", vwrq->value);
997 998 999 1000
	lbs_deb_wext("vwrq->fixed %d\n", vwrq->fixed);

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

1002
	/* Auto rate? */
1003 1004 1005
	priv->enablehwauto = !vwrq->fixed;

	if (vwrq->value == -1)
1006
		priv->cur_rate = 0;
1007
	else {
1008 1009
		if (vwrq->value % 100000)
			goto out;
1010

1011 1012 1013
		new_rate = vwrq->value / 500000;
		priv->cur_rate = new_rate;
		/* the rest is only needed for lbs_set_data_rate() */
1014
		memset(rates, 0, sizeof(rates));
1015
		copy_active_data_rates(priv, rates);
1016 1017 1018 1019
		if (!memchr(rates, new_rate, sizeof(rates))) {
			lbs_pr_alert("fixed data rate 0x%X out of range\n",
				new_rate);
			goto out;
1020 1021 1022
		}
	}

1023 1024 1025 1026 1027 1028
	/* 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);
1029

1030
out:
1031
	lbs_deb_leave_args(LBS_DEB_WEXT, "ret %d", ret);
1032 1033 1034
	return ret;
}

1035
static int lbs_get_rate(struct net_device *dev, struct iw_request_info *info,
1036 1037
		  struct iw_param *vwrq, char *extra)
{
1038
	struct lbs_private *priv = dev->priv;
1039

1040
	lbs_deb_enter(LBS_DEB_WEXT);
1041

1042 1043
	if (priv->connect_status == LBS_CONNECTED) {
		vwrq->value = priv->cur_rate * 500000;
1044

1045
		if (priv->enablehwauto)
1046 1047 1048 1049
			vwrq->fixed = 0;
		else
			vwrq->fixed = 1;

1050
	} else {
1051 1052
		vwrq->fixed = 0;
		vwrq->value = 0;
1053 1054
	}

1055
	lbs_deb_leave(LBS_DEB_WEXT);
1056 1057 1058
	return 0;
}

1059
static int lbs_set_mode(struct net_device *dev,
1060 1061 1062
		  struct iw_request_info *info, u32 * uwrq, char *extra)
{
	int ret = 0;
1063
	struct lbs_private *priv = dev->priv;
1064 1065
	struct assoc_request * assoc_req;

1066
	lbs_deb_enter(LBS_DEB_WEXT);
1067

1068 1069 1070
	if (   (*uwrq != IW_MODE_ADHOC)
	    && (*uwrq != IW_MODE_INFRA)
	    && (*uwrq != IW_MODE_AUTO)) {
1071
		lbs_deb_wext("Invalid mode: 0x%x\n", *uwrq);
1072 1073
		ret = -EINVAL;
		goto out;
1074 1075
	}

1076 1077
	mutex_lock(&priv->lock);
	assoc_req = lbs_get_association_request(priv);
1078 1079
	if (!assoc_req) {
		ret = -ENOMEM;
1080
		lbs_cancel_association_work(priv);
1081
	} else {
1082
		assoc_req->mode = *uwrq;
1083
		set_bit(ASSOC_FLAG_MODE, &assoc_req->flags);
1084
		lbs_postpone_association_work(priv);
1085
		lbs_deb_wext("Switching to mode: 0x%x\n", *uwrq);
1086
	}
1087
	mutex_unlock(&priv->lock);
1088

1089
out:
1090
	lbs_deb_leave_args(LBS_DEB_WEXT, "ret %d", ret);
1091 1092 1093 1094 1095 1096 1097 1098 1099 1100 1101 1102 1103
	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
 */
1104
static int lbs_get_encode(struct net_device *dev,
1105 1106 1107
			   struct iw_request_info *info,
			   struct iw_point *dwrq, u8 * extra)
{
1108
	struct lbs_private *priv = dev->priv;
1109 1110
	int index = (dwrq->flags & IW_ENCODE_INDEX) - 1;

1111
	lbs_deb_enter(LBS_DEB_WEXT);
1112

1113
	lbs_deb_wext("flags 0x%x, index %d, length %d, wep_tx_keyidx %d\n",
1114
	       dwrq->flags, index, dwrq->length, priv->wep_tx_keyidx);
1115 1116 1117 1118

	dwrq->flags = 0;

	/* Authentication method */
1119
	switch (priv->secinfo.auth_mode) {
1120
	case IW_AUTH_ALG_OPEN_SYSTEM:
1121 1122 1123
		dwrq->flags = IW_ENCODE_OPEN;
		break;

1124 1125
	case IW_AUTH_ALG_SHARED_KEY:
	case IW_AUTH_ALG_LEAP:
1126 1127 1128 1129 1130 1131 1132 1133 1134
		dwrq->flags = IW_ENCODE_RESTRICTED;
		break;
	default:
		dwrq->flags = IW_ENCODE_DISABLED | IW_ENCODE_OPEN;
		break;
	}

	memset(extra, 0, 16);

1135
	mutex_lock(&priv->lock);
1136 1137 1138

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

1141 1142 1143 1144
	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;
1145 1146 1147 1148

		dwrq->flags |= (index + 1);
		/* Return WEP enabled */
		dwrq->flags &= ~IW_ENCODE_DISABLED;
1149 1150
	} else if ((priv->secinfo.WPAenabled)
		   || (priv->secinfo.WPA2enabled)) {
1151 1152
		/* return WPA enabled */
		dwrq->flags &= ~IW_ENCODE_DISABLED;
1153
		dwrq->flags |= IW_ENCODE_NOKEY;
1154 1155 1156 1157
	} else {
		dwrq->flags |= IW_ENCODE_DISABLED;
	}

1158
	mutex_unlock(&priv->lock);
1159

1160
	lbs_deb_wext("key: %02x:%02x:%02x:%02x:%02x:%02x, keylen %d\n",
1161 1162 1163
	       extra[0], extra[1], extra[2],
	       extra[3], extra[4], extra[5], dwrq->length);

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

1166
	lbs_deb_leave(LBS_DEB_WEXT);
1167 1168 1169 1170 1171 1172 1173 1174 1175 1176 1177 1178 1179
	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
 */
1180
static int lbs_set_wep_key(struct assoc_request *assoc_req,
1181 1182 1183 1184 1185
			    const char *key_material,
			    u16 key_length,
			    u16 index,
			    int set_tx_key)
{
1186
	int ret = 0;
1187
	struct enc_key *pkey;
1188

1189
	lbs_deb_enter(LBS_DEB_WEXT);
1190 1191 1192

	/* Paranoid validation of key index */
	if (index > 3) {
1193 1194
		ret = -EINVAL;
		goto out;
1195 1196 1197 1198
	}

	/* validate max key length */
	if (key_length > KEY_LEN_WEP_104) {
1199 1200
		ret = -EINVAL;
		goto out;
1201 1202 1203 1204 1205
	}

	pkey = &assoc_req->wep_keys[index];

	if (key_length > 0) {
1206
		memset(pkey, 0, sizeof(struct enc_key));
1207 1208 1209 1210 1211 1212 1213 1214 1215 1216 1217
		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) {
1218 1219 1220
			lbs_deb_wext("key not set, so cannot enable it\n");
			ret = -EINVAL;
			goto out;
1221 1222 1223 1224
		}
		assoc_req->wep_tx_keyidx = index;
	}

1225
	assoc_req->secinfo.wep_enabled = 1;
1226

1227 1228 1229
out:
	lbs_deb_leave_args(LBS_DEB_WEXT, "ret %d", ret);
	return ret;
1230 1231 1232 1233 1234 1235 1236 1237 1238 1239 1240 1241 1242 1243 1244 1245 1246 1247 1248 1249 1250 1251 1252 1253
}

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;

1254 1255
	lbs_deb_enter(LBS_DEB_WEXT);

1256
	/* Set Open System auth mode */
1257
	assoc_req->secinfo.auth_mode = IW_AUTH_ALG_OPEN_SYSTEM;
1258 1259

	/* Clear WEP keys and mark WEP as disabled */
1260
	assoc_req->secinfo.wep_enabled = 0;
1261 1262 1263 1264 1265
	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);
1266 1267 1268 1269 1270 1271 1272 1273

	lbs_deb_leave(LBS_DEB_WEXT);
}

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

1274
	memset(&assoc_req->wpa_mcast_key, 0, sizeof (struct enc_key));
1275 1276 1277
	assoc_req->wpa_mcast_key.flags = KEY_INFO_WPA_MCAST;
	set_bit(ASSOC_FLAG_WPA_MCAST_KEY, &assoc_req->flags);

1278
	memset(&assoc_req->wpa_unicast_key, 0, sizeof (struct enc_key));
1279 1280 1281 1282 1283 1284 1285 1286
	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);
1287 1288 1289 1290 1291 1292 1293 1294 1295 1296 1297
}

/**
 *  @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
 */
1298
static int lbs_set_encode(struct net_device *dev,
1299 1300 1301 1302
		    struct iw_request_info *info,
		    struct iw_point *dwrq, char *extra)
{
	int ret = 0;
1303
	struct lbs_private *priv = dev->priv;
1304 1305 1306
	struct assoc_request * assoc_req;
	u16 is_default = 0, index = 0, set_tx_key = 0;

1307
	lbs_deb_enter(LBS_DEB_WEXT);
1308

1309 1310
	mutex_lock(&priv->lock);
	assoc_req = lbs_get_association_request(priv);
1311 1312 1313 1314 1315 1316 1317
	if (!assoc_req) {
		ret = -ENOMEM;
		goto out;
	}

	if (dwrq->flags & IW_ENCODE_DISABLED) {
		disable_wep (assoc_req);
1318
		disable_wpa (assoc_req);
1319 1320 1321 1322 1323 1324 1325 1326 1327 1328 1329 1330 1331 1332
		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.
	 */
1333
	if (!assoc_req->secinfo.wep_enabled || (dwrq->length == 0 && !is_default))
1334 1335
		set_tx_key = 1;

1336
	ret = lbs_set_wep_key(assoc_req, extra, dwrq->length, index, set_tx_key);
1337 1338 1339 1340 1341 1342 1343 1344 1345
	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) {
1346
		assoc_req->secinfo.auth_mode = IW_AUTH_ALG_SHARED_KEY;
1347
	} else if (dwrq->flags & IW_ENCODE_OPEN) {
1348
		assoc_req->secinfo.auth_mode = IW_AUTH_ALG_OPEN_SYSTEM;
1349 1350 1351 1352 1353
	}

out:
	if (ret == 0) {
		set_bit(ASSOC_FLAG_SECINFO, &assoc_req->flags);
1354
		lbs_postpone_association_work(priv);
1355
	} else {
1356
		lbs_cancel_association_work(priv);
1357
	}
1358
	mutex_unlock(&priv->lock);
1359

1360
	lbs_deb_leave_args(LBS_DEB_WEXT, "ret %d", ret);
1361 1362 1363 1364 1365 1366 1367 1368 1369 1370 1371 1372
	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
 */
1373
static int lbs_get_encodeext(struct net_device *dev,
1374 1375 1376 1377 1378
			      struct iw_request_info *info,
			      struct iw_point *dwrq,
			      char *extra)
{
	int ret = -EINVAL;
1379
	struct lbs_private *priv = dev->priv;
1380 1381 1382
	struct iw_encode_ext *ext = (struct iw_encode_ext *)extra;
	int index, max_key_len;

1383
	lbs_deb_enter(LBS_DEB_WEXT);
1384 1385 1386 1387 1388 1389 1390 1391 1392 1393 1394

	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 {
1395
		index = priv->wep_tx_keyidx;
1396 1397
	}

R
Roel Kluin 已提交
1398
	if (!(ext->ext_flags & IW_ENCODE_EXT_GROUP_KEY) &&
1399
	    ext->alg != IW_ENCODE_ALG_WEP) {
1400
		if (index != 0 || priv->mode != IW_MODE_INFRA)
1401 1402 1403 1404 1405 1406
			goto out;
	}

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

1407 1408 1409
	if (   !priv->secinfo.wep_enabled
	    && !priv->secinfo.WPAenabled
	    && !priv->secinfo.WPA2enabled) {
1410 1411 1412 1413 1414 1415
		ext->alg = IW_ENCODE_ALG_NONE;
		ext->key_len = 0;
		dwrq->flags |= IW_ENCODE_DISABLED;
	} else {
		u8 *key = NULL;

1416 1417 1418
		if (   priv->secinfo.wep_enabled
		    && !priv->secinfo.WPAenabled
		    && !priv->secinfo.WPA2enabled) {
1419
			/* WEP */
1420
			ext->alg = IW_ENCODE_ALG_WEP;
1421 1422 1423 1424 1425
			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)) {
1426
			/* WPA */
1427
			struct enc_key * pkey = NULL;
1428

1429 1430 1431 1432 1433 1434
			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;
1435 1436 1437 1438 1439 1440 1441 1442 1443 1444 1445 1446 1447

			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;
			}
1448 1449 1450 1451 1452 1453 1454 1455 1456 1457 1458 1459 1460 1461 1462 1463 1464 1465
		} 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:
1466
	lbs_deb_leave_args(LBS_DEB_WEXT, "ret %d", ret);
1467 1468 1469 1470 1471 1472 1473 1474 1475 1476 1477 1478
	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
 */
1479
static int lbs_set_encodeext(struct net_device *dev,
1480 1481 1482 1483 1484
			      struct iw_request_info *info,
			      struct iw_point *dwrq,
			      char *extra)
{
	int ret = 0;
1485
	struct lbs_private *priv = dev->priv;
1486 1487 1488 1489
	struct iw_encode_ext *ext = (struct iw_encode_ext *)extra;
	int alg = ext->alg;
	struct assoc_request * assoc_req;

1490
	lbs_deb_enter(LBS_DEB_WEXT);
1491

1492 1493
	mutex_lock(&priv->lock);
	assoc_req = lbs_get_association_request(priv);
1494 1495 1496 1497 1498 1499 1500
	if (!assoc_req) {
		ret = -ENOMEM;
		goto out;
	}

	if ((alg == IW_ENCODE_ALG_NONE) || (dwrq->flags & IW_ENCODE_DISABLED)) {
		disable_wep (assoc_req);
1501
		disable_wpa (assoc_req);
1502 1503 1504 1505 1506 1507 1508 1509 1510 1511 1512 1513
	} 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.
		 */
1514
		if (   !assoc_req->secinfo.wep_enabled
1515 1516 1517 1518 1519
		    || (dwrq->length == 0 && !is_default)
		    || (ext->ext_flags & IW_ENCODE_EXT_SET_TX_KEY))
			set_tx_key = 1;

		/* Copy key to driver */
1520
		ret = lbs_set_wep_key(assoc_req, ext->key, ext->key_len, index,
1521 1522 1523 1524 1525
					set_tx_key);
		if (ret)
			goto out;

		if (dwrq->flags & IW_ENCODE_RESTRICTED) {
1526
			assoc_req->secinfo.auth_mode = IW_AUTH_ALG_SHARED_KEY;
1527
		} else if (dwrq->flags & IW_ENCODE_OPEN) {
1528
			assoc_req->secinfo.auth_mode = IW_AUTH_ALG_OPEN_SYSTEM;
1529 1530 1531 1532 1533 1534 1535 1536 1537
		}

		/* 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)) {
1538
		struct enc_key * pkey;
1539 1540 1541 1542 1543 1544

		/* 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))) {
1545
				lbs_deb_wext("invalid size %d for key of alg "
1546
				       "type %d\n",
1547 1548 1549 1550 1551 1552
				       ext->key_len,
				       alg);
				ret = -EINVAL;
				goto out;
		}

1553
		if (ext->ext_flags & IW_ENCODE_EXT_GROUP_KEY) {
1554
			pkey = &assoc_req->wpa_mcast_key;
1555 1556
			set_bit(ASSOC_FLAG_WPA_MCAST_KEY, &assoc_req->flags);
		} else {
1557
			pkey = &assoc_req->wpa_unicast_key;
1558 1559
			set_bit(ASSOC_FLAG_WPA_UCAST_KEY, &assoc_req->flags);
		}
1560

1561
		memset(pkey, 0, sizeof (struct enc_key));
1562 1563
		memcpy(pkey->key, ext->key, ext->key_len);
		pkey->len = ext->key_len;
1564 1565
		if (pkey->len)
			pkey->flags |= KEY_INFO_WPA_ENABLED;
1566

1567
		/* Do this after zeroing key structure */
1568 1569 1570 1571 1572 1573
		if (ext->ext_flags & IW_ENCODE_EXT_GROUP_KEY) {
			pkey->flags |= KEY_INFO_WPA_MCAST;
		} else {
			pkey->flags |= KEY_INFO_WPA_UNICAST;
		}

1574
		if (alg == IW_ENCODE_ALG_TKIP) {
1575
			pkey->type = KEY_TYPE_ID_TKIP;
1576
		} else if (alg == IW_ENCODE_ALG_CCMP) {
1577
			pkey->type = KEY_TYPE_ID_AES;
1578
		}
1579 1580 1581 1582 1583 1584 1585 1586 1587 1588 1589 1590 1591 1592

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

		disable_wep (assoc_req);
	}

out:
	if (ret == 0) {
1593
		lbs_postpone_association_work(priv);
1594
	} else {
1595
		lbs_cancel_association_work(priv);
1596
	}
1597
	mutex_unlock(&priv->lock);
1598

1599
	lbs_deb_leave_args(LBS_DEB_WEXT, "ret %d", ret);
1600 1601 1602 1603
	return ret;
}


1604
static int lbs_set_genie(struct net_device *dev,
1605 1606 1607 1608
			  struct iw_request_info *info,
			  struct iw_point *dwrq,
			  char *extra)
{
1609
	struct lbs_private *priv = dev->priv;
1610 1611 1612
	int ret = 0;
	struct assoc_request * assoc_req;

1613
	lbs_deb_enter(LBS_DEB_WEXT);
1614

1615 1616
	mutex_lock(&priv->lock);
	assoc_req = lbs_get_association_request(priv);
1617 1618 1619 1620 1621 1622 1623 1624 1625 1626 1627 1628 1629 1630 1631
	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 {
1632
		memset(&assoc_req->wpa_ie[0], 0, sizeof(priv->wpa_ie));
1633 1634 1635 1636 1637 1638
		assoc_req->wpa_ie_len = 0;
	}

out:
	if (ret == 0) {
		set_bit(ASSOC_FLAG_WPA_IE, &assoc_req->flags);
1639
		lbs_postpone_association_work(priv);
1640
	} else {
1641
		lbs_cancel_association_work(priv);
1642
	}
1643
	mutex_unlock(&priv->lock);
1644

1645
	lbs_deb_leave_args(LBS_DEB_WEXT, "ret %d", ret);
1646 1647 1648
	return ret;
}

1649
static int lbs_get_genie(struct net_device *dev,
1650 1651 1652 1653
			  struct iw_request_info *info,
			  struct iw_point *dwrq,
			  char *extra)
{
1654
	int ret = 0;
1655
	struct lbs_private *priv = dev->priv;
1656

1657
	lbs_deb_enter(LBS_DEB_WEXT);
1658

1659
	if (priv->wpa_ie_len == 0) {
1660
		dwrq->length = 0;
1661
		goto out;
1662 1663
	}

1664
	if (dwrq->length < priv->wpa_ie_len) {
1665 1666
		ret = -E2BIG;
		goto out;
1667 1668
	}

1669 1670
	dwrq->length = priv->wpa_ie_len;
	memcpy(extra, &priv->wpa_ie[0], priv->wpa_ie_len);
1671

1672 1673 1674
out:
	lbs_deb_leave_args(LBS_DEB_WEXT, "ret %d", ret);
	return ret;
1675 1676 1677
}


1678
static int lbs_set_auth(struct net_device *dev,
1679 1680 1681 1682
			 struct iw_request_info *info,
			 struct iw_param *dwrq,
			 char *extra)
{
1683
	struct lbs_private *priv = dev->priv;
1684 1685 1686 1687
	struct assoc_request * assoc_req;
	int ret = 0;
	int updated = 0;

1688
	lbs_deb_enter(LBS_DEB_WEXT);
1689

1690 1691
	mutex_lock(&priv->lock);
	assoc_req = lbs_get_association_request(priv);
1692 1693 1694 1695 1696 1697 1698 1699 1700 1701
	if (!assoc_req) {
		ret = -ENOMEM;
		goto out;
	}

	switch (dwrq->flags & IW_AUTH_INDEX) {
	case IW_AUTH_TKIP_COUNTERMEASURES:
	case IW_AUTH_CIPHER_PAIRWISE:
	case IW_AUTH_CIPHER_GROUP:
	case IW_AUTH_KEY_MGMT:
1702
	case IW_AUTH_DROP_UNENCRYPTED:
1703 1704 1705 1706 1707 1708 1709 1710 1711
		/*
		 * libertas does not use these parameters
		 */
		break;

	case IW_AUTH_WPA_VERSION:
		if (dwrq->value & IW_AUTH_WPA_VERSION_DISABLED) {
			assoc_req->secinfo.WPAenabled = 0;
			assoc_req->secinfo.WPA2enabled = 0;
1712
			disable_wpa (assoc_req);
1713 1714 1715
		}
		if (dwrq->value & IW_AUTH_WPA_VERSION_WPA) {
			assoc_req->secinfo.WPAenabled = 1;
1716
			assoc_req->secinfo.wep_enabled = 0;
1717
			assoc_req->secinfo.auth_mode = IW_AUTH_ALG_OPEN_SYSTEM;
1718 1719 1720
		}
		if (dwrq->value & IW_AUTH_WPA_VERSION_WPA2) {
			assoc_req->secinfo.WPA2enabled = 1;
1721
			assoc_req->secinfo.wep_enabled = 0;
1722
			assoc_req->secinfo.auth_mode = IW_AUTH_ALG_OPEN_SYSTEM;
1723 1724 1725 1726 1727 1728
		}
		updated = 1;
		break;

	case IW_AUTH_80211_AUTH_ALG:
		if (dwrq->value & IW_AUTH_ALG_SHARED_KEY) {
1729
			assoc_req->secinfo.auth_mode = IW_AUTH_ALG_SHARED_KEY;
1730
		} else if (dwrq->value & IW_AUTH_ALG_OPEN_SYSTEM) {
1731
			assoc_req->secinfo.auth_mode = IW_AUTH_ALG_OPEN_SYSTEM;
1732
		} else if (dwrq->value & IW_AUTH_ALG_LEAP) {
1733
			assoc_req->secinfo.auth_mode = IW_AUTH_ALG_LEAP;
1734 1735 1736 1737 1738 1739 1740 1741 1742 1743 1744 1745
		} 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;
1746
				assoc_req->secinfo.wep_enabled = 0;
1747
				assoc_req->secinfo.auth_mode = IW_AUTH_ALG_OPEN_SYSTEM;
1748 1749 1750 1751
			}
		} else {
			assoc_req->secinfo.WPAenabled = 0;
			assoc_req->secinfo.WPA2enabled = 0;
1752
			disable_wpa (assoc_req);
1753 1754 1755 1756 1757 1758 1759 1760 1761 1762 1763 1764 1765
		}
		updated = 1;
		break;

	default:
		ret = -EOPNOTSUPP;
		break;
	}

out:
	if (ret == 0) {
		if (updated)
			set_bit(ASSOC_FLAG_SECINFO, &assoc_req->flags);
1766
		lbs_postpone_association_work(priv);
1767
	} else if (ret != -EOPNOTSUPP) {
1768
		lbs_cancel_association_work(priv);
1769
	}
1770
	mutex_unlock(&priv->lock);
1771

1772
	lbs_deb_leave_args(LBS_DEB_WEXT, "ret %d", ret);
1773 1774 1775
	return ret;
}

1776
static int lbs_get_auth(struct net_device *dev,
1777 1778 1779 1780
			 struct iw_request_info *info,
			 struct iw_param *dwrq,
			 char *extra)
{
1781
	int ret = 0;
1782
	struct lbs_private *priv = dev->priv;
1783

1784
	lbs_deb_enter(LBS_DEB_WEXT);
1785 1786 1787 1788

	switch (dwrq->flags & IW_AUTH_INDEX) {
	case IW_AUTH_WPA_VERSION:
		dwrq->value = 0;
1789
		if (priv->secinfo.WPAenabled)
1790
			dwrq->value |= IW_AUTH_WPA_VERSION_WPA;
1791
		if (priv->secinfo.WPA2enabled)
1792 1793 1794 1795 1796 1797
			dwrq->value |= IW_AUTH_WPA_VERSION_WPA2;
		if (!dwrq->value)
			dwrq->value |= IW_AUTH_WPA_VERSION_DISABLED;
		break;

	case IW_AUTH_80211_AUTH_ALG:
1798
		dwrq->value = priv->secinfo.auth_mode;
1799 1800 1801
		break;

	case IW_AUTH_WPA_ENABLED:
1802
		if (priv->secinfo.WPAenabled && priv->secinfo.WPA2enabled)
1803 1804 1805 1806
			dwrq->value = 1;
		break;

	default:
1807
		ret = -EOPNOTSUPP;
1808 1809
	}

1810 1811
	lbs_deb_leave_args(LBS_DEB_WEXT, "ret %d", ret);
	return ret;
1812 1813 1814
}


1815
static int lbs_set_txpow(struct net_device *dev, struct iw_request_info *info,
1816 1817 1818
		   struct iw_param *vwrq, char *extra)
{
	int ret = 0;
1819
	struct lbs_private *priv = dev->priv;
1820
	s16 dbm = (s16) vwrq->value;
1821

1822
	lbs_deb_enter(LBS_DEB_WEXT);
1823 1824

	if (vwrq->disabled) {
1825
		lbs_set_radio(priv, RADIO_PREAMBLE_AUTO, 0);
1826
		goto out;
1827 1828
	}

1829
	if (vwrq->fixed == 0) {
1830 1831 1832 1833 1834 1835 1836 1837 1838 1839 1840 1841 1842 1843 1844
		/* 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;
1845 1846 1847 1848 1849 1850 1851 1852
		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;
		}
1853

1854 1855
		/* Validate requested power level against firmware allowed
		 * levels */
1856 1857 1858 1859
		if (priv->txpower_min && (dbm < priv->txpower_min)) {
			ret = -EINVAL;
			goto out;
		}
1860

1861 1862 1863 1864
		if (priv->txpower_max && (dbm > priv->txpower_max)) {
			ret = -EINVAL;
			goto out;
		}
1865 1866 1867 1868 1869 1870 1871 1872 1873 1874 1875 1876
		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;
1877
	}
1878

1879 1880 1881 1882 1883 1884
	/* 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;
	}
1885

1886
	lbs_deb_wext("txpower set %d dBm\n", dbm);
1887

1888
	ret = lbs_set_tx_power(priv, dbm);
1889

1890
out:
1891
	lbs_deb_leave_args(LBS_DEB_WEXT, "ret %d", ret);
1892 1893 1894
	return ret;
}

1895
static int lbs_get_essid(struct net_device *dev, struct iw_request_info *info,
1896 1897
		   struct iw_point *dwrq, char *extra)
{
1898
	struct lbs_private *priv = dev->priv;
1899

1900 1901
	lbs_deb_enter(LBS_DEB_WEXT);

1902 1903 1904 1905 1906 1907 1908 1909
	/*
	 * Note : if dwrq->flags != 0, we should get the relevant SSID from
	 * the SSID list...
	 */

	/*
	 * Get the current SSID
	 */
1910 1911 1912 1913
	if (priv->connect_status == LBS_CONNECTED) {
		memcpy(extra, priv->curbssparams.ssid,
		       priv->curbssparams.ssid_len);
		extra[priv->curbssparams.ssid_len] = '\0';
1914 1915
	} else {
		memset(extra, 0, 32);
1916
		extra[priv->curbssparams.ssid_len] = '\0';
1917 1918 1919 1920 1921
	}
	/*
	 * If none, we may want to get the one that was set
	 */

1922
	dwrq->length = priv->curbssparams.ssid_len;
1923 1924 1925

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

1926
	lbs_deb_leave(LBS_DEB_WEXT);
1927 1928 1929
	return 0;
}

1930
static int lbs_set_essid(struct net_device *dev, struct iw_request_info *info,
1931 1932
		   struct iw_point *dwrq, char *extra)
{
1933
	struct lbs_private *priv = dev->priv;
1934
	int ret = 0;
1935 1936
	u8 ssid[IW_ESSID_MAX_SIZE];
	u8 ssid_len = 0;
1937
	struct assoc_request * assoc_req;
1938
	int in_ssid_len = dwrq->length;
1939

1940
	lbs_deb_enter(LBS_DEB_WEXT);
1941

1942 1943 1944 1945 1946
	if (!priv->radio_on) {
		ret = -EINVAL;
		goto out;
	}

1947
	/* Check the size of the string */
1948
	if (in_ssid_len > IW_ESSID_MAX_SIZE) {
1949 1950 1951 1952
		ret = -E2BIG;
		goto out;
	}

1953
	memset(&ssid, 0, sizeof(ssid));
1954

1955
	if (!dwrq->flags || !in_ssid_len) {
1956 1957 1958
		/* "any" SSID requested; leave SSID blank */
	} else {
		/* Specific SSID requested */
1959 1960
		memcpy(&ssid, extra, in_ssid_len);
		ssid_len = in_ssid_len;
1961 1962
	}

1963 1964 1965 1966 1967 1968
	if (!ssid_len) {
		lbs_deb_wext("requested any SSID\n");
	} else {
		lbs_deb_wext("requested SSID '%s'\n",
		             escape_essid(ssid, ssid_len));
	}
1969 1970

out:
1971
	mutex_lock(&priv->lock);
1972 1973
	if (ret == 0) {
		/* Get or create the current association request */
1974
		assoc_req = lbs_get_association_request(priv);
1975 1976 1977 1978
		if (!assoc_req) {
			ret = -ENOMEM;
		} else {
			/* Copy the SSID to the association request */
1979 1980
			memcpy(&assoc_req->ssid, &ssid, IW_ESSID_MAX_SIZE);
			assoc_req->ssid_len = ssid_len;
1981
			set_bit(ASSOC_FLAG_SSID, &assoc_req->flags);
1982
			lbs_postpone_association_work(priv);
1983 1984 1985 1986 1987
		}
	}

	/* Cancel the association request if there was an error */
	if (ret != 0) {
1988
		lbs_cancel_association_work(priv);
1989 1990
	}

1991
	mutex_unlock(&priv->lock);
1992

1993
	lbs_deb_leave_args(LBS_DEB_WEXT, "ret %d", ret);
1994 1995 1996
	return ret;
}

1997 1998 1999 2000 2001 2002 2003 2004 2005 2006 2007 2008 2009 2010 2011 2012 2013 2014 2015 2016 2017 2018 2019 2020 2021 2022 2023
static int lbs_mesh_get_essid(struct net_device *dev,
			      struct iw_request_info *info,
			      struct iw_point *dwrq, char *extra)
{
	struct lbs_private *priv = dev->priv;

	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)
{
	struct lbs_private *priv = dev->priv;
	int ret = 0;

	lbs_deb_enter(LBS_DEB_WEXT);

2024 2025 2026 2027 2028
	if (!priv->radio_on) {
		ret = -EINVAL;
		goto out;
	}

2029 2030 2031 2032 2033 2034 2035 2036 2037 2038 2039 2040 2041 2042 2043
	/* Check the size of the string */
	if (dwrq->length > IW_ESSID_MAX_SIZE) {
		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;
	}

2044 2045
	lbs_mesh_config(priv, CMD_ACT_MESH_CONFIG_START,
			priv->curbssparams.channel);
2046 2047 2048 2049 2050
 out:
	lbs_deb_leave_args(LBS_DEB_WEXT, "ret %d", ret);
	return ret;
}

2051 2052 2053 2054 2055 2056 2057 2058 2059
/**
 *  @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
 */
2060
static int lbs_set_wap(struct net_device *dev, struct iw_request_info *info,
2061 2062
		 struct sockaddr *awrq, char *extra)
{
2063
	struct lbs_private *priv = dev->priv;
2064 2065
	struct assoc_request * assoc_req;
	int ret = 0;
2066
	DECLARE_MAC_BUF(mac);
2067

2068
	lbs_deb_enter(LBS_DEB_WEXT);
2069

2070 2071 2072
	if (!priv->radio_on)
		return -EINVAL;

2073 2074 2075
	if (awrq->sa_family != ARPHRD_ETHER)
		return -EINVAL;

2076
	lbs_deb_wext("ASSOC: WAP: sa_data %s\n", print_mac(mac, awrq->sa_data));
2077

2078
	mutex_lock(&priv->lock);
2079 2080

	/* Get or create the current association request */
2081
	assoc_req = lbs_get_association_request(priv);
2082
	if (!assoc_req) {
2083
		lbs_cancel_association_work(priv);
2084 2085 2086 2087 2088
		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);
2089
		lbs_postpone_association_work(priv);
2090 2091
	}

2092
	mutex_unlock(&priv->lock);
2093 2094 2095 2096 2097 2098 2099

	return ret;
}

/*
 * iwconfig settable callbacks
 */
2100
static const iw_handler lbs_handler[] = {
2101
	(iw_handler) NULL,	/* SIOCSIWCOMMIT */
2102
	(iw_handler) lbs_get_name,	/* SIOCGIWNAME */
2103 2104
	(iw_handler) NULL,	/* SIOCSIWNWID */
	(iw_handler) NULL,	/* SIOCGIWNWID */
2105 2106 2107 2108
	(iw_handler) lbs_set_freq,	/* SIOCSIWFREQ */
	(iw_handler) lbs_get_freq,	/* SIOCGIWFREQ */
	(iw_handler) lbs_set_mode,	/* SIOCSIWMODE */
	(iw_handler) lbs_get_mode,	/* SIOCGIWMODE */
2109 2110 2111
	(iw_handler) NULL,	/* SIOCSIWSENS */
	(iw_handler) NULL,	/* SIOCGIWSENS */
	(iw_handler) NULL,	/* SIOCSIWRANGE */
2112
	(iw_handler) lbs_get_range,	/* SIOCGIWRANGE */
2113 2114 2115 2116 2117 2118 2119 2120
	(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 */
2121 2122
	(iw_handler) lbs_set_wap,	/* SIOCSIWAP */
	(iw_handler) lbs_get_wap,	/* SIOCGIWAP */
2123 2124
	(iw_handler) NULL,	/* SIOCSIWMLME */
	(iw_handler) NULL,	/* SIOCGIWAPLIST - deprecated */
2125 2126 2127 2128 2129 2130
	(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 */
2131 2132
	(iw_handler) NULL,	/* -- hole -- */
	(iw_handler) NULL,	/* -- hole -- */
2133 2134 2135 2136 2137 2138 2139 2140 2141 2142 2143 2144 2145 2146
	(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 */
2147 2148
	(iw_handler) NULL,	/* -- hole -- */
	(iw_handler) NULL,	/* -- hole -- */
2149 2150 2151 2152 2153 2154
	(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 */
2155 2156 2157
	(iw_handler) NULL,		/* SIOCSIWPMKSA */
};

2158 2159
static const iw_handler mesh_wlan_handler[] = {
	(iw_handler) NULL,	/* SIOCSIWCOMMIT */
2160
	(iw_handler) lbs_get_name,	/* SIOCGIWNAME */
2161 2162
	(iw_handler) NULL,	/* SIOCSIWNWID */
	(iw_handler) NULL,	/* SIOCGIWNWID */
2163
	(iw_handler) lbs_mesh_set_freq,	/* SIOCSIWFREQ */
2164
	(iw_handler) lbs_get_freq,	/* SIOCGIWFREQ */
2165 2166 2167 2168 2169
	(iw_handler) NULL,		/* SIOCSIWMODE */
	(iw_handler) mesh_wlan_get_mode,	/* SIOCGIWMODE */
	(iw_handler) NULL,	/* SIOCSIWSENS */
	(iw_handler) NULL,	/* SIOCGIWSENS */
	(iw_handler) NULL,	/* SIOCSIWRANGE */
2170
	(iw_handler) lbs_get_range,	/* SIOCGIWRANGE */
2171 2172 2173 2174 2175 2176 2177 2178 2179 2180 2181 2182
	(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 */
2183 2184
	(iw_handler) lbs_set_scan,	/* SIOCSIWSCAN */
	(iw_handler) lbs_get_scan,	/* SIOCGIWSCAN */
2185 2186
	(iw_handler) lbs_mesh_set_essid,/* SIOCSIWESSID */
	(iw_handler) lbs_mesh_get_essid,/* SIOCGIWESSID */
2187 2188 2189 2190
	(iw_handler) NULL,		/* SIOCSIWNICKN */
	(iw_handler) mesh_get_nick,	/* SIOCGIWNICKN */
	(iw_handler) NULL,	/* -- hole -- */
	(iw_handler) NULL,	/* -- hole -- */
2191 2192 2193 2194 2195 2196 2197 2198 2199 2200 2201 2202 2203 2204
	(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 */
2205 2206
	(iw_handler) NULL,	/* -- hole -- */
	(iw_handler) NULL,	/* -- hole -- */
2207 2208 2209 2210 2211 2212
	(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 */
2213 2214
	(iw_handler) NULL,		/* SIOCSIWPMKSA */
};
2215 2216 2217 2218
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,
2219
};
2220 2221

struct iw_handler_def mesh_handler_def = {
2222
	.num_standard	= ARRAY_SIZE(mesh_wlan_handler),
2223
	.standard	= (iw_handler *) mesh_wlan_handler,
2224
	.get_wireless_stats = lbs_get_wireless_stats,
2225
};