[PATCH] libertas: keep mesh autostart enabled while asleep
[deliverable/linux.git] / drivers / net / wireless / libertas / wext.c
CommitLineData
876c9d3a
MT
1/**
2 * This file contains ioctl functions
3 */
4#include <linux/ctype.h>
5#include <linux/delay.h>
6#include <linux/if.h>
7#include <linux/if_arp.h>
8#include <linux/wireless.h>
9#include <linux/bitops.h>
10
11#include <net/ieee80211.h>
12#include <net/iw_handler.h>
13
14#include "host.h"
15#include "radiotap.h"
16#include "decl.h"
17#include "defs.h"
18#include "dev.h"
19#include "join.h"
876c9d3a
MT
20#include "wext.h"
21#include "assoc.h"
22
23
24/**
25 * @brief Convert mw value to dbm value
26 *
27 * @param mw the value of mw
28 * @return the value of dbm
29 */
30static int mw_to_dbm(int mw)
31{
32 if (mw < 2)
33 return 0;
34 else if (mw < 3)
35 return 3;
36 else if (mw < 4)
37 return 5;
38 else if (mw < 6)
39 return 7;
40 else if (mw < 7)
41 return 8;
42 else if (mw < 8)
43 return 9;
44 else if (mw < 10)
45 return 10;
46 else if (mw < 13)
47 return 11;
48 else if (mw < 16)
49 return 12;
50 else if (mw < 20)
51 return 13;
52 else if (mw < 25)
53 return 14;
54 else if (mw < 32)
55 return 15;
56 else if (mw < 40)
57 return 16;
58 else if (mw < 50)
59 return 17;
60 else if (mw < 63)
61 return 18;
62 else if (mw < 79)
63 return 19;
64 else if (mw < 100)
65 return 20;
66 else
67 return 21;
68}
69
70/**
71 * @brief Find the channel frequency power info with specific channel
72 *
73 * @param adapter A pointer to wlan_adapter structure
74 * @param band it can be BAND_A, BAND_G or BAND_B
75 * @param channel the channel for looking
76 * @return A pointer to struct chan_freq_power structure or NULL if not find.
77 */
78struct chan_freq_power *libertas_find_cfp_by_band_and_channel(wlan_adapter * adapter,
79 u8 band, u16 channel)
80{
81 struct chan_freq_power *cfp = NULL;
82 struct region_channel *rc;
83 int count = sizeof(adapter->region_channel) /
84 sizeof(adapter->region_channel[0]);
85 int i, j;
86
87 for (j = 0; !cfp && (j < count); j++) {
88 rc = &adapter->region_channel[j];
89
90 if (adapter->enable11d)
91 rc = &adapter->universal_channel[j];
92 if (!rc->valid || !rc->CFP)
93 continue;
94 if (rc->band != band)
95 continue;
96 for (i = 0; i < rc->nrcfp; i++) {
97 if (rc->CFP[i].channel == channel) {
98 cfp = &rc->CFP[i];
99 break;
100 }
101 }
102 }
103
104 if (!cfp && channel)
9012b28a
HS
105 lbs_deb_wext("libertas_find_cfp_by_band_and_channel: can't find "
106 "cfp by band %d / channel %d\n", band, channel);
876c9d3a
MT
107
108 return cfp;
109}
110
111/**
112 * @brief Find the channel frequency power info with specific frequency
113 *
114 * @param adapter A pointer to wlan_adapter structure
115 * @param band it can be BAND_A, BAND_G or BAND_B
116 * @param freq the frequency for looking
117 * @return A pointer to struct chan_freq_power structure or NULL if not find.
118 */
119static struct chan_freq_power *find_cfp_by_band_and_freq(wlan_adapter * adapter,
120 u8 band, u32 freq)
121{
122 struct chan_freq_power *cfp = NULL;
123 struct region_channel *rc;
124 int count = sizeof(adapter->region_channel) /
125 sizeof(adapter->region_channel[0]);
126 int i, j;
127
128 for (j = 0; !cfp && (j < count); j++) {
129 rc = &adapter->region_channel[j];
130
131 if (adapter->enable11d)
132 rc = &adapter->universal_channel[j];
133 if (!rc->valid || !rc->CFP)
134 continue;
135 if (rc->band != band)
136 continue;
137 for (i = 0; i < rc->nrcfp; i++) {
138 if (rc->CFP[i].freq == freq) {
139 cfp = &rc->CFP[i];
140 break;
141 }
142 }
143 }
144
145 if (!cfp && freq)
9012b28a
HS
146 lbs_deb_wext("find_cfp_by_band_and_freql: can't find cfp by "
147 "band %d / freq %d\n", band, freq);
876c9d3a
MT
148
149 return cfp;
150}
151
876c9d3a
MT
152
153/**
154 * @brief Set Radio On/OFF
155 *
156 * @param priv A pointer to wlan_private structure
157 * @option Radio Option
158 * @return 0 --success, otherwise fail
159 */
ac558ca2 160static int wlan_radio_ioctl(wlan_private * priv, u8 option)
876c9d3a
MT
161{
162 int ret = 0;
163 wlan_adapter *adapter = priv->adapter;
164
9012b28a 165 lbs_deb_enter(LBS_DEB_WEXT);
876c9d3a
MT
166
167 if (adapter->radioon != option) {
9012b28a 168 lbs_deb_wext("switching radio %s\n", option ? "on" : "off");
876c9d3a
MT
169 adapter->radioon = option;
170
171 ret = libertas_prepare_and_send_command(priv,
0aef64d7
DW
172 CMD_802_11_RADIO_CONTROL,
173 CMD_ACT_SET,
174 CMD_OPTION_WAITFORRSP, 0, NULL);
876c9d3a
MT
175 }
176
9012b28a 177 lbs_deb_leave_args(LBS_DEB_WEXT, "ret %d", ret);
876c9d3a
MT
178 return ret;
179}
180
181/**
8c512765 182 * @brief Copy active data rates based on adapter mode and status
876c9d3a
MT
183 *
184 * @param adapter A pointer to wlan_adapter structure
185 * @param rate The buf to return the active rates
876c9d3a 186 */
8c512765 187static void copy_active_data_rates(wlan_adapter * adapter, u8 * rates)
876c9d3a 188{
9012b28a 189 lbs_deb_enter(LBS_DEB_WEXT);
876c9d3a 190
8c512765
DW
191 if (adapter->connect_status != LIBERTAS_CONNECTED)
192 memcpy(rates, libertas_bg_rates, MAX_RATES);
193 else
194 memcpy(rates, adapter->curbssparams.rates, MAX_RATES);
876c9d3a 195
8c512765 196 lbs_deb_leave(LBS_DEB_WEXT);
876c9d3a
MT
197}
198
199static int wlan_get_name(struct net_device *dev, struct iw_request_info *info,
200 char *cwrq, char *extra)
201{
202 const char *cp;
203 char comm[6] = { "COMM-" };
204 char mrvl[6] = { "MRVL-" };
205 int cnt;
206
9012b28a 207 lbs_deb_enter(LBS_DEB_WEXT);
876c9d3a
MT
208
209 strcpy(cwrq, mrvl);
210
211 cp = strstr(libertas_driver_version, comm);
212 if (cp == libertas_driver_version) //skip leading "COMM-"
213 cp = libertas_driver_version + strlen(comm);
214 else
215 cp = libertas_driver_version;
216
217 cnt = strlen(mrvl);
218 cwrq += cnt;
219 while (cnt < 16 && (*cp != '-')) {
220 *cwrq++ = toupper(*cp++);
221 cnt++;
222 }
223 *cwrq = '\0';
224
9012b28a 225 lbs_deb_leave(LBS_DEB_WEXT);
876c9d3a
MT
226 return 0;
227}
228
229static int wlan_get_freq(struct net_device *dev, struct iw_request_info *info,
230 struct iw_freq *fwrq, char *extra)
231{
232 wlan_private *priv = dev->priv;
233 wlan_adapter *adapter = priv->adapter;
234 struct chan_freq_power *cfp;
235
9012b28a 236 lbs_deb_enter(LBS_DEB_WEXT);
876c9d3a
MT
237
238 cfp = libertas_find_cfp_by_band_and_channel(adapter, 0,
239 adapter->curbssparams.channel);
240
241 if (!cfp) {
242 if (adapter->curbssparams.channel)
9012b28a 243 lbs_deb_wext("invalid channel %d\n",
876c9d3a
MT
244 adapter->curbssparams.channel);
245 return -EINVAL;
246 }
247
248 fwrq->m = (long)cfp->freq * 100000;
249 fwrq->e = 1;
250
9012b28a
HS
251 lbs_deb_wext("freq %u\n", fwrq->m);
252 lbs_deb_leave(LBS_DEB_WEXT);
876c9d3a
MT
253 return 0;
254}
255
256static int wlan_get_wap(struct net_device *dev, struct iw_request_info *info,
257 struct sockaddr *awrq, char *extra)
258{
259 wlan_private *priv = dev->priv;
260 wlan_adapter *adapter = priv->adapter;
261
9012b28a 262 lbs_deb_enter(LBS_DEB_WEXT);
876c9d3a 263
0aef64d7 264 if (adapter->connect_status == LIBERTAS_CONNECTED) {
876c9d3a
MT
265 memcpy(awrq->sa_data, adapter->curbssparams.bssid, ETH_ALEN);
266 } else {
267 memset(awrq->sa_data, 0, ETH_ALEN);
268 }
269 awrq->sa_family = ARPHRD_ETHER;
270
9012b28a 271 lbs_deb_leave(LBS_DEB_WEXT);
876c9d3a
MT
272 return 0;
273}
274
275static int wlan_set_nick(struct net_device *dev, struct iw_request_info *info,
276 struct iw_point *dwrq, char *extra)
277{
278 wlan_private *priv = dev->priv;
279 wlan_adapter *adapter = priv->adapter;
280
9012b28a 281 lbs_deb_enter(LBS_DEB_WEXT);
876c9d3a
MT
282
283 /*
284 * Check the size of the string
285 */
286
287 if (dwrq->length > 16) {
288 return -E2BIG;
289 }
290
291 mutex_lock(&adapter->lock);
292 memset(adapter->nodename, 0, sizeof(adapter->nodename));
293 memcpy(adapter->nodename, extra, dwrq->length);
294 mutex_unlock(&adapter->lock);
295
9012b28a 296 lbs_deb_leave(LBS_DEB_WEXT);
876c9d3a
MT
297 return 0;
298}
299
300static int wlan_get_nick(struct net_device *dev, struct iw_request_info *info,
301 struct iw_point *dwrq, char *extra)
302{
303 wlan_private *priv = dev->priv;
304 wlan_adapter *adapter = priv->adapter;
305
9012b28a 306 lbs_deb_enter(LBS_DEB_WEXT);
876c9d3a
MT
307
308 /*
309 * Get the Nick Name saved
310 */
311
312 mutex_lock(&adapter->lock);
313 strncpy(extra, adapter->nodename, 16);
314 mutex_unlock(&adapter->lock);
315
316 extra[16] = '\0';
317
318 /*
319 * If none, we may want to get the one that was set
320 */
321
322 /*
323 * Push it out !
324 */
325 dwrq->length = strlen(extra) + 1;
326
9012b28a 327 lbs_deb_leave(LBS_DEB_WEXT);
876c9d3a
MT
328 return 0;
329}
330
f5e05b69
LCCR
331static int mesh_get_nick(struct net_device *dev, struct iw_request_info *info,
332 struct iw_point *dwrq, char *extra)
333{
334 wlan_private *priv = dev->priv;
335 wlan_adapter *adapter = priv->adapter;
336
337 lbs_deb_enter(LBS_DEB_WEXT);
338
339 /* Use nickname to indicate that mesh is on */
340
0aef64d7 341 if (adapter->connect_status == LIBERTAS_CONNECTED) {
f5e05b69
LCCR
342 strncpy(extra, "Mesh", 12);
343 extra[12] = '\0';
344 dwrq->length = strlen(extra) + 1;
345 }
346
347 else {
348 extra[0] = '\0';
349 dwrq->length = 1 ;
350 }
351
352 lbs_deb_leave(LBS_DEB_WEXT);
353 return 0;
354}
876c9d3a
MT
355static int wlan_set_rts(struct net_device *dev, struct iw_request_info *info,
356 struct iw_param *vwrq, char *extra)
357{
358 int ret = 0;
359 wlan_private *priv = dev->priv;
360 wlan_adapter *adapter = priv->adapter;
981f187b 361 u32 rthr = vwrq->value;
876c9d3a 362
9012b28a 363 lbs_deb_enter(LBS_DEB_WEXT);
876c9d3a
MT
364
365 if (vwrq->disabled) {
366 adapter->rtsthsd = rthr = MRVDRV_RTS_MAX_VALUE;
367 } else {
368 if (rthr < MRVDRV_RTS_MIN_VALUE || rthr > MRVDRV_RTS_MAX_VALUE)
369 return -EINVAL;
370 adapter->rtsthsd = rthr;
371 }
372
0aef64d7
DW
373 ret = libertas_prepare_and_send_command(priv, CMD_802_11_SNMP_MIB,
374 CMD_ACT_SET, CMD_OPTION_WAITFORRSP,
876c9d3a
MT
375 OID_802_11_RTS_THRESHOLD, &rthr);
376
9012b28a 377 lbs_deb_leave_args(LBS_DEB_WEXT, "ret %d", ret);
876c9d3a
MT
378 return ret;
379}
380
381static int wlan_get_rts(struct net_device *dev, struct iw_request_info *info,
382 struct iw_param *vwrq, char *extra)
383{
384 int ret = 0;
385 wlan_private *priv = dev->priv;
386 wlan_adapter *adapter = priv->adapter;
387
9012b28a 388 lbs_deb_enter(LBS_DEB_WEXT);
876c9d3a
MT
389
390 adapter->rtsthsd = 0;
0aef64d7
DW
391 ret = libertas_prepare_and_send_command(priv, CMD_802_11_SNMP_MIB,
392 CMD_ACT_GET, CMD_OPTION_WAITFORRSP,
876c9d3a 393 OID_802_11_RTS_THRESHOLD, NULL);
9012b28a
HS
394 if (ret)
395 goto out;
876c9d3a
MT
396
397 vwrq->value = adapter->rtsthsd;
398 vwrq->disabled = ((vwrq->value < MRVDRV_RTS_MIN_VALUE)
399 || (vwrq->value > MRVDRV_RTS_MAX_VALUE));
400 vwrq->fixed = 1;
401
9012b28a
HS
402out:
403 lbs_deb_leave_args(LBS_DEB_WEXT, "ret %d", ret);
404 return ret;
876c9d3a
MT
405}
406
407static int wlan_set_frag(struct net_device *dev, struct iw_request_info *info,
408 struct iw_param *vwrq, char *extra)
409{
410 int ret = 0;
981f187b 411 u32 fthr = vwrq->value;
876c9d3a
MT
412 wlan_private *priv = dev->priv;
413 wlan_adapter *adapter = priv->adapter;
414
9012b28a 415 lbs_deb_enter(LBS_DEB_WEXT);
876c9d3a
MT
416
417 if (vwrq->disabled) {
418 adapter->fragthsd = fthr = MRVDRV_FRAG_MAX_VALUE;
419 } else {
420 if (fthr < MRVDRV_FRAG_MIN_VALUE
421 || fthr > MRVDRV_FRAG_MAX_VALUE)
422 return -EINVAL;
423 adapter->fragthsd = fthr;
424 }
425
0aef64d7
DW
426 ret = libertas_prepare_and_send_command(priv, CMD_802_11_SNMP_MIB,
427 CMD_ACT_SET, CMD_OPTION_WAITFORRSP,
876c9d3a 428 OID_802_11_FRAGMENTATION_THRESHOLD, &fthr);
9012b28a
HS
429
430 lbs_deb_leave_args(LBS_DEB_WEXT, "ret %d", ret);
876c9d3a
MT
431 return ret;
432}
433
434static int wlan_get_frag(struct net_device *dev, struct iw_request_info *info,
435 struct iw_param *vwrq, char *extra)
436{
437 int ret = 0;
438 wlan_private *priv = dev->priv;
439 wlan_adapter *adapter = priv->adapter;
440
9012b28a 441 lbs_deb_enter(LBS_DEB_WEXT);
876c9d3a
MT
442
443 adapter->fragthsd = 0;
444 ret = libertas_prepare_and_send_command(priv,
0aef64d7
DW
445 CMD_802_11_SNMP_MIB,
446 CMD_ACT_GET, CMD_OPTION_WAITFORRSP,
876c9d3a 447 OID_802_11_FRAGMENTATION_THRESHOLD, NULL);
9012b28a
HS
448 if (ret)
449 goto out;
876c9d3a
MT
450
451 vwrq->value = adapter->fragthsd;
452 vwrq->disabled = ((vwrq->value < MRVDRV_FRAG_MIN_VALUE)
453 || (vwrq->value > MRVDRV_FRAG_MAX_VALUE));
454 vwrq->fixed = 1;
455
9012b28a
HS
456out:
457 lbs_deb_leave_args(LBS_DEB_WEXT, "ret %d", ret);
876c9d3a
MT
458 return ret;
459}
460
461static int wlan_get_mode(struct net_device *dev,
462 struct iw_request_info *info, u32 * uwrq, char *extra)
463{
464 wlan_private *priv = dev->priv;
465 wlan_adapter *adapter = priv->adapter;
466
9012b28a 467 lbs_deb_enter(LBS_DEB_WEXT);
876c9d3a 468
0dc5a290 469 *uwrq = adapter->mode;
876c9d3a 470
9012b28a 471 lbs_deb_leave(LBS_DEB_WEXT);
876c9d3a
MT
472 return 0;
473}
474
f5e05b69
LCCR
475static int mesh_wlan_get_mode(struct net_device *dev,
476 struct iw_request_info *info, u32 * uwrq,
477 char *extra)
478{
479 lbs_deb_enter(LBS_DEB_WEXT);
480
481 *uwrq = IW_MODE_REPEAT ;
482
483 lbs_deb_leave(LBS_DEB_WEXT);
484 return 0;
485}
486
876c9d3a
MT
487static int wlan_get_txpow(struct net_device *dev,
488 struct iw_request_info *info,
489 struct iw_param *vwrq, char *extra)
490{
491 int ret = 0;
492 wlan_private *priv = dev->priv;
493 wlan_adapter *adapter = priv->adapter;
494
9012b28a 495 lbs_deb_enter(LBS_DEB_WEXT);
876c9d3a
MT
496
497 ret = libertas_prepare_and_send_command(priv,
0aef64d7
DW
498 CMD_802_11_RF_TX_POWER,
499 CMD_ACT_TX_POWER_OPT_GET,
500 CMD_OPTION_WAITFORRSP, 0, NULL);
876c9d3a 501
9012b28a
HS
502 if (ret)
503 goto out;
876c9d3a 504
9012b28a 505 lbs_deb_wext("tx power level %d dbm\n", adapter->txpowerlevel);
876c9d3a
MT
506 vwrq->value = adapter->txpowerlevel;
507 vwrq->fixed = 1;
508 if (adapter->radioon) {
509 vwrq->disabled = 0;
510 vwrq->flags = IW_TXPOW_DBM;
511 } else {
512 vwrq->disabled = 1;
513 }
514
9012b28a
HS
515out:
516 lbs_deb_leave_args(LBS_DEB_WEXT, "ret %d", ret);
517 return ret;
876c9d3a
MT
518}
519
520static int wlan_set_retry(struct net_device *dev, struct iw_request_info *info,
521 struct iw_param *vwrq, char *extra)
522{
523 int ret = 0;
524 wlan_private *priv = dev->priv;
525 wlan_adapter *adapter = priv->adapter;
526
9012b28a 527 lbs_deb_enter(LBS_DEB_WEXT);
876c9d3a
MT
528
529 if (vwrq->flags == IW_RETRY_LIMIT) {
530 /* The MAC has a 4-bit Total_Tx_Count register
531 Total_Tx_Count = 1 + Tx_Retry_Count */
532#define TX_RETRY_MIN 0
533#define TX_RETRY_MAX 14
534 if (vwrq->value < TX_RETRY_MIN || vwrq->value > TX_RETRY_MAX)
535 return -EINVAL;
536
537 /* Adding 1 to convert retry count to try count */
538 adapter->txretrycount = vwrq->value + 1;
539
0aef64d7
DW
540 ret = libertas_prepare_and_send_command(priv, CMD_802_11_SNMP_MIB,
541 CMD_ACT_SET,
542 CMD_OPTION_WAITFORRSP,
876c9d3a
MT
543 OID_802_11_TX_RETRYCOUNT, NULL);
544
9012b28a
HS
545 if (ret)
546 goto out;
876c9d3a
MT
547 } else {
548 return -EOPNOTSUPP;
549 }
550
9012b28a
HS
551out:
552 lbs_deb_leave_args(LBS_DEB_WEXT, "ret %d", ret);
553 return ret;
876c9d3a
MT
554}
555
556static int wlan_get_retry(struct net_device *dev, struct iw_request_info *info,
557 struct iw_param *vwrq, char *extra)
558{
559 wlan_private *priv = dev->priv;
560 wlan_adapter *adapter = priv->adapter;
561 int ret = 0;
562
9012b28a
HS
563 lbs_deb_enter(LBS_DEB_WEXT);
564
876c9d3a
MT
565 adapter->txretrycount = 0;
566 ret = libertas_prepare_and_send_command(priv,
0aef64d7
DW
567 CMD_802_11_SNMP_MIB,
568 CMD_ACT_GET, CMD_OPTION_WAITFORRSP,
876c9d3a 569 OID_802_11_TX_RETRYCOUNT, NULL);
9012b28a
HS
570 if (ret)
571 goto out;
572
876c9d3a
MT
573 vwrq->disabled = 0;
574 if (!vwrq->flags) {
575 vwrq->flags = IW_RETRY_LIMIT;
576 /* Subtract 1 to convert try count to retry count */
577 vwrq->value = adapter->txretrycount - 1;
578 }
579
9012b28a
HS
580out:
581 lbs_deb_leave_args(LBS_DEB_WEXT, "ret %d", ret);
582 return ret;
876c9d3a
MT
583}
584
585static inline void sort_channels(struct iw_freq *freq, int num)
586{
587 int i, j;
588 struct iw_freq temp;
589
590 for (i = 0; i < num; i++)
591 for (j = i + 1; j < num; j++)
592 if (freq[i].i > freq[j].i) {
593 temp.i = freq[i].i;
594 temp.m = freq[i].m;
595
596 freq[i].i = freq[j].i;
597 freq[i].m = freq[j].m;
598
599 freq[j].i = temp.i;
600 freq[j].m = temp.m;
601 }
602}
603
604/* data rate listing
605 MULTI_BANDS:
606 abg a b b/g
607 Infra G(12) A(8) B(4) G(12)
608 Adhoc A+B(12) A(8) B(4) B(4)
609
610 non-MULTI_BANDS:
611 b b/g
612 Infra B(4) G(12)
613 Adhoc B(4) B(4)
614 */
615/**
616 * @brief Get Range Info
617 *
618 * @param dev A pointer to net_device structure
619 * @param info A pointer to iw_request_info structure
620 * @param vwrq A pointer to iw_param structure
621 * @param extra A pointer to extra data buf
622 * @return 0 --success, otherwise fail
623 */
624static int wlan_get_range(struct net_device *dev, struct iw_request_info *info,
625 struct iw_point *dwrq, char *extra)
626{
627 int i, j;
628 wlan_private *priv = dev->priv;
629 wlan_adapter *adapter = priv->adapter;
630 struct iw_range *range = (struct iw_range *)extra;
631 struct chan_freq_power *cfp;
8c512765 632 u8 rates[MAX_RATES + 1];
876c9d3a
MT
633
634 u8 flag = 0;
635
9012b28a 636 lbs_deb_enter(LBS_DEB_WEXT);
876c9d3a
MT
637
638 dwrq->length = sizeof(struct iw_range);
639 memset(range, 0, sizeof(struct iw_range));
640
641 range->min_nwid = 0;
642 range->max_nwid = 0;
643
644 memset(rates, 0, sizeof(rates));
8c512765
DW
645 copy_active_data_rates(adapter, rates);
646 range->num_bitrates = strnlen(rates, IW_MAX_BITRATES);
647 for (i = 0; i < range->num_bitrates; i++)
648 range->bitrate[i] = rates[i] * 500000;
876c9d3a 649 range->num_bitrates = i;
9012b28a 650 lbs_deb_wext("IW_MAX_BITRATES %d, num_bitrates %d\n", IW_MAX_BITRATES,
876c9d3a
MT
651 range->num_bitrates);
652
653 range->num_frequency = 0;
654 if (priv->adapter->enable11d &&
0aef64d7 655 adapter->connect_status == LIBERTAS_CONNECTED) {
876c9d3a
MT
656 u8 chan_no;
657 u8 band;
658
659 struct parsed_region_chan_11d *parsed_region_chan =
660 &adapter->parsed_region_chan;
661
662 if (parsed_region_chan == NULL) {
9012b28a
HS
663 lbs_deb_wext("11d: parsed_region_chan is NULL\n");
664 goto out;
876c9d3a
MT
665 }
666 band = parsed_region_chan->band;
9012b28a 667 lbs_deb_wext("band %d, nr_char %d\n", band,
876c9d3a
MT
668 parsed_region_chan->nr_chan);
669
670 for (i = 0; (range->num_frequency < IW_MAX_FREQUENCIES)
671 && (i < parsed_region_chan->nr_chan); i++) {
672 chan_no = parsed_region_chan->chanpwr[i].chan;
9012b28a 673 lbs_deb_wext("chan_no %d\n", chan_no);
876c9d3a
MT
674 range->freq[range->num_frequency].i = (long)chan_no;
675 range->freq[range->num_frequency].m =
676 (long)libertas_chan_2_freq(chan_no, band) * 100000;
677 range->freq[range->num_frequency].e = 1;
678 range->num_frequency++;
679 }
680 flag = 1;
681 }
682 if (!flag) {
683 for (j = 0; (range->num_frequency < IW_MAX_FREQUENCIES)
684 && (j < sizeof(adapter->region_channel)
685 / sizeof(adapter->region_channel[0])); j++) {
686 cfp = adapter->region_channel[j].CFP;
687 for (i = 0; (range->num_frequency < IW_MAX_FREQUENCIES)
688 && adapter->region_channel[j].valid
689 && cfp
690 && (i < adapter->region_channel[j].nrcfp); i++) {
691 range->freq[range->num_frequency].i =
692 (long)cfp->channel;
693 range->freq[range->num_frequency].m =
694 (long)cfp->freq * 100000;
695 range->freq[range->num_frequency].e = 1;
696 cfp++;
697 range->num_frequency++;
698 }
699 }
700 }
701
9012b28a 702 lbs_deb_wext("IW_MAX_FREQUENCIES %d, num_frequency %d\n",
876c9d3a
MT
703 IW_MAX_FREQUENCIES, range->num_frequency);
704
705 range->num_channels = range->num_frequency;
706
707 sort_channels(&range->freq[0], range->num_frequency);
708
709 /*
710 * Set an indication of the max TCP throughput in bit/s that we can
711 * expect using this interface
712 */
713 if (i > 2)
714 range->throughput = 5000 * 1000;
715 else
716 range->throughput = 1500 * 1000;
717
718 range->min_rts = MRVDRV_RTS_MIN_VALUE;
719 range->max_rts = MRVDRV_RTS_MAX_VALUE;
720 range->min_frag = MRVDRV_FRAG_MIN_VALUE;
721 range->max_frag = MRVDRV_FRAG_MAX_VALUE;
722
723 range->encoding_size[0] = 5;
724 range->encoding_size[1] = 13;
725 range->num_encoding_sizes = 2;
726 range->max_encoding_tokens = 4;
727
728 range->min_pmp = 1000000;
729 range->max_pmp = 120000000;
730 range->min_pmt = 1000;
731 range->max_pmt = 1000000;
732 range->pmp_flags = IW_POWER_PERIOD;
733 range->pmt_flags = IW_POWER_TIMEOUT;
734 range->pm_capa = IW_POWER_PERIOD | IW_POWER_TIMEOUT | IW_POWER_ALL_R;
735
736 /*
737 * Minimum version we recommend
738 */
739 range->we_version_source = 15;
740
741 /*
742 * Version we are compiled with
743 */
744 range->we_version_compiled = WIRELESS_EXT;
745
746 range->retry_capa = IW_RETRY_LIMIT;
747 range->retry_flags = IW_RETRY_LIMIT | IW_RETRY_MAX;
748
749 range->min_retry = TX_RETRY_MIN;
750 range->max_retry = TX_RETRY_MAX;
751
752 /*
753 * Set the qual, level and noise range values
754 */
755 range->max_qual.qual = 100;
756 range->max_qual.level = 0;
757 range->max_qual.noise = 0;
758 range->max_qual.updated = IW_QUAL_ALL_UPDATED | IW_QUAL_DBM;
759
760 range->avg_qual.qual = 70;
761 /* TODO: Find real 'good' to 'bad' threshold value for RSSI */
762 range->avg_qual.level = 0;
763 range->avg_qual.noise = 0;
764 range->avg_qual.updated = IW_QUAL_ALL_UPDATED | IW_QUAL_DBM;
765
766 range->sensitivity = 0;
767
768 /*
769 * Setup the supported power level ranges
770 */
771 memset(range->txpower, 0, sizeof(range->txpower));
772 range->txpower[0] = 5;
773 range->txpower[1] = 7;
774 range->txpower[2] = 9;
775 range->txpower[3] = 11;
776 range->txpower[4] = 13;
777 range->txpower[5] = 15;
778 range->txpower[6] = 17;
779 range->txpower[7] = 19;
780
781 range->num_txpower = 8;
782 range->txpower_capa = IW_TXPOW_DBM;
783 range->txpower_capa |= IW_TXPOW_RANGE;
784
785 range->event_capa[0] = (IW_EVENT_CAPA_K_0 |
786 IW_EVENT_CAPA_MASK(SIOCGIWAP) |
787 IW_EVENT_CAPA_MASK(SIOCGIWSCAN));
788 range->event_capa[1] = IW_EVENT_CAPA_K_1;
789
790 if (adapter->fwcapinfo & FW_CAPINFO_WPA) {
791 range->enc_capa = IW_ENC_CAPA_WPA
792 | IW_ENC_CAPA_WPA2
793 | IW_ENC_CAPA_CIPHER_TKIP
794 | IW_ENC_CAPA_CIPHER_CCMP;
795 }
796
9012b28a
HS
797out:
798 lbs_deb_leave(LBS_DEB_WEXT);
876c9d3a
MT
799 return 0;
800}
801
802static int wlan_set_power(struct net_device *dev, struct iw_request_info *info,
803 struct iw_param *vwrq, char *extra)
804{
805 wlan_private *priv = dev->priv;
806 wlan_adapter *adapter = priv->adapter;
807
9012b28a 808 lbs_deb_enter(LBS_DEB_WEXT);
876c9d3a
MT
809
810 /* PS is currently supported only in Infrastructure mode
811 * Remove this check if it is to be supported in IBSS mode also
812 */
813
814 if (vwrq->disabled) {
0aef64d7 815 adapter->psmode = WLAN802_11POWERMODECAM;
876c9d3a 816 if (adapter->psstate != PS_STATE_FULL_POWER) {
0aef64d7 817 libertas_ps_wakeup(priv, CMD_OPTION_WAITFORRSP);
876c9d3a
MT
818 }
819
820 return 0;
821 }
822
823 if ((vwrq->flags & IW_POWER_TYPE) == IW_POWER_TIMEOUT) {
9012b28a
HS
824 lbs_deb_wext(
825 "setting power timeout is not supported\n");
876c9d3a
MT
826 return -EINVAL;
827 } else if ((vwrq->flags & IW_POWER_TYPE) == IW_POWER_PERIOD) {
9012b28a 828 lbs_deb_wext("setting power period not supported\n");
876c9d3a
MT
829 return -EINVAL;
830 }
831
0aef64d7 832 if (adapter->psmode != WLAN802_11POWERMODECAM) {
876c9d3a
MT
833 return 0;
834 }
835
0aef64d7 836 adapter->psmode = WLAN802_11POWERMODEMAX_PSP;
876c9d3a 837
0aef64d7
DW
838 if (adapter->connect_status == LIBERTAS_CONNECTED) {
839 libertas_ps_sleep(priv, CMD_OPTION_WAITFORRSP);
876c9d3a
MT
840 }
841
9012b28a 842 lbs_deb_leave(LBS_DEB_WEXT);
876c9d3a
MT
843 return 0;
844}
845
846static int wlan_get_power(struct net_device *dev, struct iw_request_info *info,
847 struct iw_param *vwrq, char *extra)
848{
849 wlan_private *priv = dev->priv;
850 wlan_adapter *adapter = priv->adapter;
851 int mode;
852
9012b28a 853 lbs_deb_enter(LBS_DEB_WEXT);
876c9d3a
MT
854
855 mode = adapter->psmode;
856
0aef64d7
DW
857 if ((vwrq->disabled = (mode == WLAN802_11POWERMODECAM))
858 || adapter->connect_status == LIBERTAS_DISCONNECTED)
9012b28a
HS
859 {
860 goto out;
876c9d3a
MT
861 }
862
863 vwrq->value = 0;
864
9012b28a
HS
865out:
866 lbs_deb_leave(LBS_DEB_WEXT);
876c9d3a
MT
867 return 0;
868}
869
876c9d3a
MT
870static struct iw_statistics *wlan_get_wireless_stats(struct net_device *dev)
871{
872 enum {
873 POOR = 30,
874 FAIR = 60,
875 GOOD = 80,
876 VERY_GOOD = 90,
877 EXCELLENT = 95,
878 PERFECT = 100
879 };
880 wlan_private *priv = dev->priv;
881 wlan_adapter *adapter = priv->adapter;
882 u32 rssi_qual;
883 u32 tx_qual;
884 u32 quality = 0;
885 int stats_valid = 0;
886 u8 rssi;
887 u32 tx_retries;
888
9012b28a 889 lbs_deb_enter(LBS_DEB_WEXT);
876c9d3a 890
0dc5a290 891 priv->wstats.status = adapter->mode;
876c9d3a
MT
892
893 /* If we're not associated, all quality values are meaningless */
0aef64d7 894 if (adapter->connect_status != LIBERTAS_CONNECTED)
876c9d3a
MT
895 goto out;
896
897 /* Quality by RSSI */
898 priv->wstats.qual.level =
899 CAL_RSSI(adapter->SNR[TYPE_BEACON][TYPE_NOAVG],
900 adapter->NF[TYPE_BEACON][TYPE_NOAVG]);
901
902 if (adapter->NF[TYPE_BEACON][TYPE_NOAVG] == 0) {
903 priv->wstats.qual.noise = MRVDRV_NF_DEFAULT_SCAN_VALUE;
904 } else {
905 priv->wstats.qual.noise =
906 CAL_NF(adapter->NF[TYPE_BEACON][TYPE_NOAVG]);
907 }
908
9012b28a
HS
909 lbs_deb_wext("signal level %#x\n", priv->wstats.qual.level);
910 lbs_deb_wext("noise %#x\n", priv->wstats.qual.noise);
876c9d3a
MT
911
912 rssi = priv->wstats.qual.level - priv->wstats.qual.noise;
913 if (rssi < 15)
914 rssi_qual = rssi * POOR / 10;
915 else if (rssi < 20)
916 rssi_qual = (rssi - 15) * (FAIR - POOR) / 5 + POOR;
917 else if (rssi < 30)
918 rssi_qual = (rssi - 20) * (GOOD - FAIR) / 5 + FAIR;
919 else if (rssi < 40)
920 rssi_qual = (rssi - 30) * (VERY_GOOD - GOOD) /
921 10 + GOOD;
922 else
923 rssi_qual = (rssi - 40) * (PERFECT - VERY_GOOD) /
924 10 + VERY_GOOD;
925 quality = rssi_qual;
926
927 /* Quality by TX errors */
928 priv->wstats.discard.retries = priv->stats.tx_errors;
929
981f187b 930 tx_retries = le16_to_cpu(adapter->logmsg.retry);
876c9d3a
MT
931
932 if (tx_retries > 75)
933 tx_qual = (90 - tx_retries) * POOR / 15;
934 else if (tx_retries > 70)
935 tx_qual = (75 - tx_retries) * (FAIR - POOR) / 5 + POOR;
936 else if (tx_retries > 65)
937 tx_qual = (70 - tx_retries) * (GOOD - FAIR) / 5 + FAIR;
938 else if (tx_retries > 50)
939 tx_qual = (65 - tx_retries) * (VERY_GOOD - GOOD) /
940 15 + GOOD;
941 else
942 tx_qual = (50 - tx_retries) *
943 (PERFECT - VERY_GOOD) / 50 + VERY_GOOD;
944 quality = min(quality, tx_qual);
945
981f187b
DW
946 priv->wstats.discard.code = le16_to_cpu(adapter->logmsg.wepundecryptable);
947 priv->wstats.discard.fragment = le16_to_cpu(adapter->logmsg.rxfrag);
876c9d3a 948 priv->wstats.discard.retries = tx_retries;
981f187b 949 priv->wstats.discard.misc = le16_to_cpu(adapter->logmsg.ackfailure);
876c9d3a
MT
950
951 /* Calculate quality */
cad9d9b1 952 priv->wstats.qual.qual = min_t(u8, quality, 100);
876c9d3a
MT
953 priv->wstats.qual.updated = IW_QUAL_ALL_UPDATED | IW_QUAL_DBM;
954 stats_valid = 1;
955
956 /* update stats asynchronously for future calls */
0aef64d7 957 libertas_prepare_and_send_command(priv, CMD_802_11_RSSI, 0,
876c9d3a 958 0, 0, NULL);
0aef64d7 959 libertas_prepare_and_send_command(priv, CMD_802_11_GET_LOG, 0,
876c9d3a
MT
960 0, 0, NULL);
961out:
962 if (!stats_valid) {
963 priv->wstats.miss.beacon = 0;
964 priv->wstats.discard.retries = 0;
965 priv->wstats.qual.qual = 0;
966 priv->wstats.qual.level = 0;
967 priv->wstats.qual.noise = 0;
968 priv->wstats.qual.updated = IW_QUAL_ALL_UPDATED;
969 priv->wstats.qual.updated |= IW_QUAL_NOISE_INVALID |
970 IW_QUAL_QUAL_INVALID | IW_QUAL_LEVEL_INVALID;
971 }
972
9012b28a 973 lbs_deb_leave(LBS_DEB_WEXT);
876c9d3a
MT
974 return &priv->wstats;
975
976
977}
978
979static int wlan_set_freq(struct net_device *dev, struct iw_request_info *info,
980 struct iw_freq *fwrq, char *extra)
981{
ef9a264b 982 int ret = -EINVAL;
876c9d3a
MT
983 wlan_private *priv = dev->priv;
984 wlan_adapter *adapter = priv->adapter;
876c9d3a 985 struct chan_freq_power *cfp;
ef9a264b 986 struct assoc_request * assoc_req;
876c9d3a 987
9012b28a 988 lbs_deb_enter(LBS_DEB_WEXT);
876c9d3a 989
ef9a264b
DW
990 mutex_lock(&adapter->lock);
991 assoc_req = wlan_get_association_request(adapter);
992 if (!assoc_req) {
993 ret = -ENOMEM;
994 goto out;
995 }
876c9d3a 996
ef9a264b
DW
997 /* If setting by frequency, convert to a channel */
998 if (fwrq->e == 1) {
876c9d3a 999 long f = fwrq->m / 100000;
876c9d3a
MT
1000
1001 cfp = find_cfp_by_band_and_freq(adapter, 0, f);
1002 if (!cfp) {
9012b28a 1003 lbs_deb_wext("invalid freq %ld\n", f);
ef9a264b 1004 goto out;
876c9d3a
MT
1005 }
1006
876c9d3a 1007 fwrq->e = 0;
ef9a264b 1008 fwrq->m = (int) cfp->channel;
876c9d3a
MT
1009 }
1010
ef9a264b 1011 /* Setting by channel number */
876c9d3a 1012 if (fwrq->m > 1000 || fwrq->e > 0) {
ef9a264b
DW
1013 goto out;
1014 }
876c9d3a 1015
ef9a264b
DW
1016 cfp = libertas_find_cfp_by_band_and_channel(adapter, 0, fwrq->m);
1017 if (!cfp) {
1018 goto out;
876c9d3a
MT
1019 }
1020
ef9a264b
DW
1021 assoc_req->channel = fwrq->m;
1022 ret = 0;
1023
9012b28a 1024out:
ef9a264b
DW
1025 if (ret == 0) {
1026 set_bit(ASSOC_FLAG_CHANNEL, &assoc_req->flags);
1027 wlan_postpone_association_work(priv);
1028 } else {
1029 wlan_cancel_association_work(priv);
1030 }
1031 mutex_unlock(&adapter->lock);
1032
1033 lbs_deb_leave_args(LBS_DEB_WEXT, "ret %d", ret);
1034 return ret;
876c9d3a
MT
1035}
1036
876c9d3a
MT
1037static int wlan_set_rate(struct net_device *dev, struct iw_request_info *info,
1038 struct iw_param *vwrq, char *extra)
1039{
1040 wlan_private *priv = dev->priv;
1041 wlan_adapter *adapter = priv->adapter;
8c512765 1042 u32 new_rate;
876c9d3a 1043 u16 action;
8c512765
DW
1044 int ret = -EINVAL;
1045 u8 rates[MAX_RATES + 1];
876c9d3a 1046
9012b28a 1047 lbs_deb_enter(LBS_DEB_WEXT);
9012b28a 1048 lbs_deb_wext("vwrq->value %d\n", vwrq->value);
876c9d3a 1049
8c512765 1050 /* Auto rate? */
876c9d3a 1051 if (vwrq->value == -1) {
8c512765
DW
1052 action = CMD_ACT_SET_TX_AUTO;
1053 adapter->auto_rate = 1;
1054 adapter->cur_rate = 0;
876c9d3a 1055 } else {
8c512765
DW
1056 if (vwrq->value % 100000)
1057 goto out;
876c9d3a
MT
1058
1059 memset(rates, 0, sizeof(rates));
8c512765
DW
1060 copy_active_data_rates(adapter, rates);
1061 new_rate = vwrq->value / 500000;
1062 if (!memchr(rates, new_rate, sizeof(rates))) {
1063 lbs_pr_alert("fixed data rate 0x%X out of range\n",
1064 new_rate);
1065 goto out;
876c9d3a
MT
1066 }
1067
8c512765 1068 adapter->cur_rate = new_rate;
ffcae953 1069 action = CMD_ACT_SET_TX_FIX_RATE;
8c512765 1070 adapter->auto_rate = 0;
876c9d3a
MT
1071 }
1072
0aef64d7
DW
1073 ret = libertas_prepare_and_send_command(priv, CMD_802_11_DATA_RATE,
1074 action, CMD_OPTION_WAITFORRSP, 0, NULL);
876c9d3a 1075
8c512765 1076out:
9012b28a 1077 lbs_deb_leave_args(LBS_DEB_WEXT, "ret %d", ret);
876c9d3a
MT
1078 return ret;
1079}
1080
1081static int wlan_get_rate(struct net_device *dev, struct iw_request_info *info,
1082 struct iw_param *vwrq, char *extra)
1083{
1084 wlan_private *priv = dev->priv;
1085 wlan_adapter *adapter = priv->adapter;
1086
9012b28a 1087 lbs_deb_enter(LBS_DEB_WEXT);
876c9d3a 1088
8c512765
DW
1089 if (adapter->connect_status == LIBERTAS_CONNECTED) {
1090 vwrq->value = adapter->cur_rate * 500000;
1091
1092 if (adapter->auto_rate)
1093 vwrq->fixed = 0;
1094 else
1095 vwrq->fixed = 1;
1096
876c9d3a 1097 } else {
8c512765
DW
1098 vwrq->fixed = 0;
1099 vwrq->value = 0;
876c9d3a
MT
1100 }
1101
9012b28a 1102 lbs_deb_leave(LBS_DEB_WEXT);
876c9d3a
MT
1103 return 0;
1104}
1105
1106static int wlan_set_mode(struct net_device *dev,
1107 struct iw_request_info *info, u32 * uwrq, char *extra)
1108{
1109 int ret = 0;
1110 wlan_private *priv = dev->priv;
1111 wlan_adapter *adapter = priv->adapter;
1112 struct assoc_request * assoc_req;
876c9d3a 1113
9012b28a 1114 lbs_deb_enter(LBS_DEB_WEXT);
876c9d3a 1115
0dc5a290
DW
1116 if ( (*uwrq != IW_MODE_ADHOC)
1117 && (*uwrq != IW_MODE_INFRA)
1118 && (*uwrq != IW_MODE_AUTO)) {
9012b28a 1119 lbs_deb_wext("Invalid mode: 0x%x\n", *uwrq);
0dc5a290
DW
1120 ret = -EINVAL;
1121 goto out;
876c9d3a
MT
1122 }
1123
1124 mutex_lock(&adapter->lock);
1125 assoc_req = wlan_get_association_request(adapter);
1126 if (!assoc_req) {
1127 ret = -ENOMEM;
0dc5a290 1128 wlan_cancel_association_work(priv);
876c9d3a 1129 } else {
0dc5a290 1130 assoc_req->mode = *uwrq;
876c9d3a
MT
1131 set_bit(ASSOC_FLAG_MODE, &assoc_req->flags);
1132 wlan_postpone_association_work(priv);
9012b28a 1133 lbs_deb_wext("Switching to mode: 0x%x\n", *uwrq);
876c9d3a
MT
1134 }
1135 mutex_unlock(&adapter->lock);
1136
0dc5a290 1137out:
9012b28a 1138 lbs_deb_leave_args(LBS_DEB_WEXT, "ret %d", ret);
876c9d3a
MT
1139 return ret;
1140}
1141
1142
1143/**
1144 * @brief Get Encryption key
1145 *
1146 * @param dev A pointer to net_device structure
1147 * @param info A pointer to iw_request_info structure
1148 * @param vwrq A pointer to iw_param structure
1149 * @param extra A pointer to extra data buf
1150 * @return 0 --success, otherwise fail
1151 */
1152static int wlan_get_encode(struct net_device *dev,
1153 struct iw_request_info *info,
1154 struct iw_point *dwrq, u8 * extra)
1155{
1156 wlan_private *priv = dev->priv;
1157 wlan_adapter *adapter = priv->adapter;
1158 int index = (dwrq->flags & IW_ENCODE_INDEX) - 1;
1159
9012b28a 1160 lbs_deb_enter(LBS_DEB_WEXT);
876c9d3a 1161
9012b28a 1162 lbs_deb_wext("flags 0x%x, index %d, length %d, wep_tx_keyidx %d\n",
876c9d3a
MT
1163 dwrq->flags, index, dwrq->length, adapter->wep_tx_keyidx);
1164
1165 dwrq->flags = 0;
1166
1167 /* Authentication method */
6affe785
DW
1168 switch (adapter->secinfo.auth_mode) {
1169 case IW_AUTH_ALG_OPEN_SYSTEM:
876c9d3a
MT
1170 dwrq->flags = IW_ENCODE_OPEN;
1171 break;
1172
6affe785
DW
1173 case IW_AUTH_ALG_SHARED_KEY:
1174 case IW_AUTH_ALG_LEAP:
876c9d3a
MT
1175 dwrq->flags = IW_ENCODE_RESTRICTED;
1176 break;
1177 default:
1178 dwrq->flags = IW_ENCODE_DISABLED | IW_ENCODE_OPEN;
1179 break;
1180 }
1181
889c05bd
DW
1182 if ( adapter->secinfo.wep_enabled
1183 || adapter->secinfo.WPAenabled
1184 || adapter->secinfo.WPA2enabled) {
876c9d3a
MT
1185 dwrq->flags &= ~IW_ENCODE_DISABLED;
1186 } else {
1187 dwrq->flags |= IW_ENCODE_DISABLED;
1188 }
1189
1190 memset(extra, 0, 16);
1191
1192 mutex_lock(&adapter->lock);
1193
1194 /* Default to returning current transmit key */
1195 if (index < 0)
1196 index = adapter->wep_tx_keyidx;
1197
889c05bd 1198 if ((adapter->wep_keys[index].len) && adapter->secinfo.wep_enabled) {
876c9d3a
MT
1199 memcpy(extra, adapter->wep_keys[index].key,
1200 adapter->wep_keys[index].len);
1201 dwrq->length = adapter->wep_keys[index].len;
1202
1203 dwrq->flags |= (index + 1);
1204 /* Return WEP enabled */
1205 dwrq->flags &= ~IW_ENCODE_DISABLED;
1206 } else if ((adapter->secinfo.WPAenabled)
1207 || (adapter->secinfo.WPA2enabled)) {
1208 /* return WPA enabled */
1209 dwrq->flags &= ~IW_ENCODE_DISABLED;
1210 } else {
1211 dwrq->flags |= IW_ENCODE_DISABLED;
1212 }
1213
1214 mutex_unlock(&adapter->lock);
1215
1216 dwrq->flags |= IW_ENCODE_NOKEY;
1217
9012b28a 1218 lbs_deb_wext("key: " MAC_FMT ", keylen %d\n",
876c9d3a
MT
1219 extra[0], extra[1], extra[2],
1220 extra[3], extra[4], extra[5], dwrq->length);
1221
9012b28a 1222 lbs_deb_wext("return flags 0x%x\n", dwrq->flags);
876c9d3a 1223
9012b28a 1224 lbs_deb_leave(LBS_DEB_WEXT);
876c9d3a
MT
1225 return 0;
1226}
1227
1228/**
1229 * @brief Set Encryption key (internal)
1230 *
1231 * @param priv A pointer to private card structure
1232 * @param key_material A pointer to key material
1233 * @param key_length length of key material
1234 * @param index key index to set
1235 * @param set_tx_key Force set TX key (1 = yes, 0 = no)
1236 * @return 0 --success, otherwise fail
1237 */
1238static int wlan_set_wep_key(struct assoc_request *assoc_req,
1239 const char *key_material,
1240 u16 key_length,
1241 u16 index,
1242 int set_tx_key)
1243{
9012b28a 1244 int ret = 0;
1443b653 1245 struct enc_key *pkey;
876c9d3a 1246
9012b28a 1247 lbs_deb_enter(LBS_DEB_WEXT);
876c9d3a
MT
1248
1249 /* Paranoid validation of key index */
1250 if (index > 3) {
9012b28a
HS
1251 ret = -EINVAL;
1252 goto out;
876c9d3a
MT
1253 }
1254
1255 /* validate max key length */
1256 if (key_length > KEY_LEN_WEP_104) {
9012b28a
HS
1257 ret = -EINVAL;
1258 goto out;
876c9d3a
MT
1259 }
1260
1261 pkey = &assoc_req->wep_keys[index];
1262
1263 if (key_length > 0) {
1443b653 1264 memset(pkey, 0, sizeof(struct enc_key));
876c9d3a
MT
1265 pkey->type = KEY_TYPE_ID_WEP;
1266
1267 /* Standardize the key length */
1268 pkey->len = (key_length > KEY_LEN_WEP_40) ?
1269 KEY_LEN_WEP_104 : KEY_LEN_WEP_40;
1270 memcpy(pkey->key, key_material, key_length);
1271 }
1272
1273 if (set_tx_key) {
1274 /* Ensure the chosen key is valid */
1275 if (!pkey->len) {
9012b28a
HS
1276 lbs_deb_wext("key not set, so cannot enable it\n");
1277 ret = -EINVAL;
1278 goto out;
876c9d3a
MT
1279 }
1280 assoc_req->wep_tx_keyidx = index;
1281 }
1282
889c05bd 1283 assoc_req->secinfo.wep_enabled = 1;
876c9d3a 1284
9012b28a
HS
1285out:
1286 lbs_deb_leave_args(LBS_DEB_WEXT, "ret %d", ret);
1287 return ret;
876c9d3a
MT
1288}
1289
1290static int validate_key_index(u16 def_index, u16 raw_index,
1291 u16 *out_index, u16 *is_default)
1292{
1293 if (!out_index || !is_default)
1294 return -EINVAL;
1295
1296 /* Verify index if present, otherwise use default TX key index */
1297 if (raw_index > 0) {
1298 if (raw_index > 4)
1299 return -EINVAL;
1300 *out_index = raw_index - 1;
1301 } else {
1302 *out_index = def_index;
1303 *is_default = 1;
1304 }
1305 return 0;
1306}
1307
1308static void disable_wep(struct assoc_request *assoc_req)
1309{
1310 int i;
1311
90a42210
DW
1312 lbs_deb_enter(LBS_DEB_WEXT);
1313
876c9d3a 1314 /* Set Open System auth mode */
6affe785 1315 assoc_req->secinfo.auth_mode = IW_AUTH_ALG_OPEN_SYSTEM;
876c9d3a
MT
1316
1317 /* Clear WEP keys and mark WEP as disabled */
889c05bd 1318 assoc_req->secinfo.wep_enabled = 0;
876c9d3a
MT
1319 for (i = 0; i < 4; i++)
1320 assoc_req->wep_keys[i].len = 0;
1321
1322 set_bit(ASSOC_FLAG_SECINFO, &assoc_req->flags);
1323 set_bit(ASSOC_FLAG_WEP_KEYS, &assoc_req->flags);
90a42210
DW
1324
1325 lbs_deb_leave(LBS_DEB_WEXT);
1326}
1327
1328static void disable_wpa(struct assoc_request *assoc_req)
1329{
1330 lbs_deb_enter(LBS_DEB_WEXT);
1331
1443b653 1332 memset(&assoc_req->wpa_mcast_key, 0, sizeof (struct enc_key));
90a42210
DW
1333 assoc_req->wpa_mcast_key.flags = KEY_INFO_WPA_MCAST;
1334 set_bit(ASSOC_FLAG_WPA_MCAST_KEY, &assoc_req->flags);
1335
1443b653 1336 memset(&assoc_req->wpa_unicast_key, 0, sizeof (struct enc_key));
90a42210
DW
1337 assoc_req->wpa_unicast_key.flags = KEY_INFO_WPA_UNICAST;
1338 set_bit(ASSOC_FLAG_WPA_UCAST_KEY, &assoc_req->flags);
1339
1340 assoc_req->secinfo.WPAenabled = 0;
1341 assoc_req->secinfo.WPA2enabled = 0;
1342 set_bit(ASSOC_FLAG_SECINFO, &assoc_req->flags);
1343
1344 lbs_deb_leave(LBS_DEB_WEXT);
876c9d3a
MT
1345}
1346
1347/**
1348 * @brief Set Encryption key
1349 *
1350 * @param dev A pointer to net_device structure
1351 * @param info A pointer to iw_request_info structure
1352 * @param vwrq A pointer to iw_param structure
1353 * @param extra A pointer to extra data buf
1354 * @return 0 --success, otherwise fail
1355 */
1356static int wlan_set_encode(struct net_device *dev,
1357 struct iw_request_info *info,
1358 struct iw_point *dwrq, char *extra)
1359{
1360 int ret = 0;
1361 wlan_private *priv = dev->priv;
1362 wlan_adapter *adapter = priv->adapter;
1363 struct assoc_request * assoc_req;
1364 u16 is_default = 0, index = 0, set_tx_key = 0;
1365
9012b28a 1366 lbs_deb_enter(LBS_DEB_WEXT);
876c9d3a
MT
1367
1368 mutex_lock(&adapter->lock);
1369 assoc_req = wlan_get_association_request(adapter);
1370 if (!assoc_req) {
1371 ret = -ENOMEM;
1372 goto out;
1373 }
1374
1375 if (dwrq->flags & IW_ENCODE_DISABLED) {
1376 disable_wep (assoc_req);
90a42210 1377 disable_wpa (assoc_req);
876c9d3a
MT
1378 goto out;
1379 }
1380
1381 ret = validate_key_index(assoc_req->wep_tx_keyidx,
1382 (dwrq->flags & IW_ENCODE_INDEX),
1383 &index, &is_default);
1384 if (ret) {
1385 ret = -EINVAL;
1386 goto out;
1387 }
1388
1389 /* If WEP isn't enabled, or if there is no key data but a valid
1390 * index, set the TX key.
1391 */
889c05bd 1392 if (!assoc_req->secinfo.wep_enabled || (dwrq->length == 0 && !is_default))
876c9d3a
MT
1393 set_tx_key = 1;
1394
1395 ret = wlan_set_wep_key(assoc_req, extra, dwrq->length, index, set_tx_key);
1396 if (ret)
1397 goto out;
1398
1399 if (dwrq->length)
1400 set_bit(ASSOC_FLAG_WEP_KEYS, &assoc_req->flags);
1401 if (set_tx_key)
1402 set_bit(ASSOC_FLAG_WEP_TX_KEYIDX, &assoc_req->flags);
1403
1404 if (dwrq->flags & IW_ENCODE_RESTRICTED) {
6affe785 1405 assoc_req->secinfo.auth_mode = IW_AUTH_ALG_SHARED_KEY;
876c9d3a 1406 } else if (dwrq->flags & IW_ENCODE_OPEN) {
6affe785 1407 assoc_req->secinfo.auth_mode = IW_AUTH_ALG_OPEN_SYSTEM;
876c9d3a
MT
1408 }
1409
1410out:
1411 if (ret == 0) {
1412 set_bit(ASSOC_FLAG_SECINFO, &assoc_req->flags);
1413 wlan_postpone_association_work(priv);
1414 } else {
1415 wlan_cancel_association_work(priv);
1416 }
1417 mutex_unlock(&adapter->lock);
1418
9012b28a 1419 lbs_deb_leave_args(LBS_DEB_WEXT, "ret %d", ret);
876c9d3a
MT
1420 return ret;
1421}
1422
1423/**
1424 * @brief Get Extended Encryption key (WPA/802.1x and WEP)
1425 *
1426 * @param dev A pointer to net_device structure
1427 * @param info A pointer to iw_request_info structure
1428 * @param vwrq A pointer to iw_param structure
1429 * @param extra A pointer to extra data buf
1430 * @return 0 on success, otherwise failure
1431 */
1432static int wlan_get_encodeext(struct net_device *dev,
1433 struct iw_request_info *info,
1434 struct iw_point *dwrq,
1435 char *extra)
1436{
1437 int ret = -EINVAL;
1438 wlan_private *priv = dev->priv;
1439 wlan_adapter *adapter = priv->adapter;
1440 struct iw_encode_ext *ext = (struct iw_encode_ext *)extra;
1441 int index, max_key_len;
1442
9012b28a 1443 lbs_deb_enter(LBS_DEB_WEXT);
876c9d3a
MT
1444
1445 max_key_len = dwrq->length - sizeof(*ext);
1446 if (max_key_len < 0)
1447 goto out;
1448
1449 index = dwrq->flags & IW_ENCODE_INDEX;
1450 if (index) {
1451 if (index < 1 || index > 4)
1452 goto out;
1453 index--;
1454 } else {
1455 index = adapter->wep_tx_keyidx;
1456 }
1457
1458 if (!ext->ext_flags & IW_ENCODE_EXT_GROUP_KEY &&
1459 ext->alg != IW_ENCODE_ALG_WEP) {
0dc5a290 1460 if (index != 0 || adapter->mode != IW_MODE_INFRA)
876c9d3a
MT
1461 goto out;
1462 }
1463
1464 dwrq->flags = index + 1;
1465 memset(ext, 0, sizeof(*ext));
1466
889c05bd
DW
1467 if ( !adapter->secinfo.wep_enabled
1468 && !adapter->secinfo.WPAenabled
1469 && !adapter->secinfo.WPA2enabled) {
876c9d3a
MT
1470 ext->alg = IW_ENCODE_ALG_NONE;
1471 ext->key_len = 0;
1472 dwrq->flags |= IW_ENCODE_DISABLED;
1473 } else {
1474 u8 *key = NULL;
1475
889c05bd 1476 if ( adapter->secinfo.wep_enabled
876c9d3a
MT
1477 && !adapter->secinfo.WPAenabled
1478 && !adapter->secinfo.WPA2enabled) {
90a42210 1479 /* WEP */
876c9d3a
MT
1480 ext->alg = IW_ENCODE_ALG_WEP;
1481 ext->key_len = adapter->wep_keys[index].len;
1482 key = &adapter->wep_keys[index].key[0];
889c05bd
DW
1483 } else if ( !adapter->secinfo.wep_enabled
1484 && (adapter->secinfo.WPAenabled ||
1485 adapter->secinfo.WPA2enabled)) {
876c9d3a 1486 /* WPA */
1443b653 1487 struct enc_key * pkey = NULL;
90a42210
DW
1488
1489 if ( adapter->wpa_mcast_key.len
1490 && (adapter->wpa_mcast_key.flags & KEY_INFO_WPA_ENABLED))
1491 pkey = &adapter->wpa_mcast_key;
1492 else if ( adapter->wpa_unicast_key.len
1493 && (adapter->wpa_unicast_key.flags & KEY_INFO_WPA_ENABLED))
1494 pkey = &adapter->wpa_unicast_key;
1495
1496 if (pkey) {
1497 if (pkey->type == KEY_TYPE_ID_AES) {
1498 ext->alg = IW_ENCODE_ALG_CCMP;
1499 } else {
1500 ext->alg = IW_ENCODE_ALG_TKIP;
1501 }
1502 ext->key_len = pkey->len;
1503 key = &pkey->key[0];
1504 } else {
1505 ext->alg = IW_ENCODE_ALG_TKIP;
1506 ext->key_len = 0;
1507 }
876c9d3a
MT
1508 } else {
1509 goto out;
1510 }
1511
1512 if (ext->key_len > max_key_len) {
1513 ret = -E2BIG;
1514 goto out;
1515 }
1516
1517 if (ext->key_len)
1518 memcpy(ext->key, key, ext->key_len);
1519 else
1520 dwrq->flags |= IW_ENCODE_NOKEY;
1521 dwrq->flags |= IW_ENCODE_ENABLED;
1522 }
1523 ret = 0;
1524
1525out:
9012b28a 1526 lbs_deb_leave_args(LBS_DEB_WEXT, "ret %d", ret);
876c9d3a
MT
1527 return ret;
1528}
1529
1530/**
1531 * @brief Set Encryption key Extended (WPA/802.1x and WEP)
1532 *
1533 * @param dev A pointer to net_device structure
1534 * @param info A pointer to iw_request_info structure
1535 * @param vwrq A pointer to iw_param structure
1536 * @param extra A pointer to extra data buf
1537 * @return 0 --success, otherwise fail
1538 */
1539static int wlan_set_encodeext(struct net_device *dev,
1540 struct iw_request_info *info,
1541 struct iw_point *dwrq,
1542 char *extra)
1543{
1544 int ret = 0;
1545 wlan_private *priv = dev->priv;
1546 wlan_adapter *adapter = priv->adapter;
1547 struct iw_encode_ext *ext = (struct iw_encode_ext *)extra;
1548 int alg = ext->alg;
1549 struct assoc_request * assoc_req;
1550
9012b28a 1551 lbs_deb_enter(LBS_DEB_WEXT);
876c9d3a
MT
1552
1553 mutex_lock(&adapter->lock);
1554 assoc_req = wlan_get_association_request(adapter);
1555 if (!assoc_req) {
1556 ret = -ENOMEM;
1557 goto out;
1558 }
1559
1560 if ((alg == IW_ENCODE_ALG_NONE) || (dwrq->flags & IW_ENCODE_DISABLED)) {
1561 disable_wep (assoc_req);
90a42210 1562 disable_wpa (assoc_req);
876c9d3a
MT
1563 } else if (alg == IW_ENCODE_ALG_WEP) {
1564 u16 is_default = 0, index, set_tx_key = 0;
1565
1566 ret = validate_key_index(assoc_req->wep_tx_keyidx,
1567 (dwrq->flags & IW_ENCODE_INDEX),
1568 &index, &is_default);
1569 if (ret)
1570 goto out;
1571
1572 /* If WEP isn't enabled, or if there is no key data but a valid
1573 * index, or if the set-TX-key flag was passed, set the TX key.
1574 */
889c05bd 1575 if ( !assoc_req->secinfo.wep_enabled
876c9d3a
MT
1576 || (dwrq->length == 0 && !is_default)
1577 || (ext->ext_flags & IW_ENCODE_EXT_SET_TX_KEY))
1578 set_tx_key = 1;
1579
1580 /* Copy key to driver */
1581 ret = wlan_set_wep_key (assoc_req, ext->key, ext->key_len, index,
1582 set_tx_key);
1583 if (ret)
1584 goto out;
1585
1586 if (dwrq->flags & IW_ENCODE_RESTRICTED) {
6affe785 1587 assoc_req->secinfo.auth_mode = IW_AUTH_ALG_SHARED_KEY;
876c9d3a 1588 } else if (dwrq->flags & IW_ENCODE_OPEN) {
6affe785 1589 assoc_req->secinfo.auth_mode = IW_AUTH_ALG_OPEN_SYSTEM;
876c9d3a
MT
1590 }
1591
1592 /* Mark the various WEP bits as modified */
1593 set_bit(ASSOC_FLAG_SECINFO, &assoc_req->flags);
1594 if (dwrq->length)
1595 set_bit(ASSOC_FLAG_WEP_KEYS, &assoc_req->flags);
1596 if (set_tx_key)
1597 set_bit(ASSOC_FLAG_WEP_TX_KEYIDX, &assoc_req->flags);
876c9d3a 1598 } else if ((alg == IW_ENCODE_ALG_TKIP) || (alg == IW_ENCODE_ALG_CCMP)) {
1443b653 1599 struct enc_key * pkey;
876c9d3a
MT
1600
1601 /* validate key length */
1602 if (((alg == IW_ENCODE_ALG_TKIP)
1603 && (ext->key_len != KEY_LEN_WPA_TKIP))
1604 || ((alg == IW_ENCODE_ALG_CCMP)
1605 && (ext->key_len != KEY_LEN_WPA_AES))) {
9012b28a
HS
1606 lbs_deb_wext("invalid size %d for key of alg"
1607 "type %d\n",
876c9d3a
MT
1608 ext->key_len,
1609 alg);
1610 ret = -EINVAL;
1611 goto out;
1612 }
1613
90a42210 1614 if (ext->ext_flags & IW_ENCODE_EXT_GROUP_KEY) {
876c9d3a 1615 pkey = &assoc_req->wpa_mcast_key;
90a42210
DW
1616 set_bit(ASSOC_FLAG_WPA_MCAST_KEY, &assoc_req->flags);
1617 } else {
876c9d3a 1618 pkey = &assoc_req->wpa_unicast_key;
90a42210
DW
1619 set_bit(ASSOC_FLAG_WPA_UCAST_KEY, &assoc_req->flags);
1620 }
876c9d3a 1621
1443b653 1622 memset(pkey, 0, sizeof (struct enc_key));
876c9d3a
MT
1623 memcpy(pkey->key, ext->key, ext->key_len);
1624 pkey->len = ext->key_len;
90a42210
DW
1625 if (pkey->len)
1626 pkey->flags |= KEY_INFO_WPA_ENABLED;
876c9d3a 1627
90a42210 1628 /* Do this after zeroing key structure */
876c9d3a
MT
1629 if (ext->ext_flags & IW_ENCODE_EXT_GROUP_KEY) {
1630 pkey->flags |= KEY_INFO_WPA_MCAST;
876c9d3a
MT
1631 } else {
1632 pkey->flags |= KEY_INFO_WPA_UNICAST;
876c9d3a
MT
1633 }
1634
90a42210 1635 if (alg == IW_ENCODE_ALG_TKIP) {
876c9d3a 1636 pkey->type = KEY_TYPE_ID_TKIP;
90a42210 1637 } else if (alg == IW_ENCODE_ALG_CCMP) {
876c9d3a 1638 pkey->type = KEY_TYPE_ID_AES;
90a42210 1639 }
876c9d3a
MT
1640
1641 /* If WPA isn't enabled yet, do that now */
1642 if ( assoc_req->secinfo.WPAenabled == 0
1643 && assoc_req->secinfo.WPA2enabled == 0) {
1644 assoc_req->secinfo.WPAenabled = 1;
1645 assoc_req->secinfo.WPA2enabled = 1;
1646 set_bit(ASSOC_FLAG_SECINFO, &assoc_req->flags);
1647 }
1648
1649 disable_wep (assoc_req);
1650 }
1651
1652out:
1653 if (ret == 0) {
1654 wlan_postpone_association_work(priv);
1655 } else {
1656 wlan_cancel_association_work(priv);
1657 }
1658 mutex_unlock(&adapter->lock);
1659
9012b28a 1660 lbs_deb_leave_args(LBS_DEB_WEXT, "ret %d", ret);
876c9d3a
MT
1661 return ret;
1662}
1663
1664
1665static int wlan_set_genie(struct net_device *dev,
1666 struct iw_request_info *info,
1667 struct iw_point *dwrq,
1668 char *extra)
1669{
1670 wlan_private *priv = dev->priv;
1671 wlan_adapter *adapter = priv->adapter;
1672 int ret = 0;
1673 struct assoc_request * assoc_req;
1674
9012b28a 1675 lbs_deb_enter(LBS_DEB_WEXT);
876c9d3a
MT
1676
1677 mutex_lock(&adapter->lock);
1678 assoc_req = wlan_get_association_request(adapter);
1679 if (!assoc_req) {
1680 ret = -ENOMEM;
1681 goto out;
1682 }
1683
1684 if (dwrq->length > MAX_WPA_IE_LEN ||
1685 (dwrq->length && extra == NULL)) {
1686 ret = -EINVAL;
1687 goto out;
1688 }
1689
1690 if (dwrq->length) {
1691 memcpy(&assoc_req->wpa_ie[0], extra, dwrq->length);
1692 assoc_req->wpa_ie_len = dwrq->length;
1693 } else {
1694 memset(&assoc_req->wpa_ie[0], 0, sizeof(adapter->wpa_ie));
1695 assoc_req->wpa_ie_len = 0;
1696 }
1697
1698out:
1699 if (ret == 0) {
1700 set_bit(ASSOC_FLAG_WPA_IE, &assoc_req->flags);
1701 wlan_postpone_association_work(priv);
1702 } else {
1703 wlan_cancel_association_work(priv);
1704 }
1705 mutex_unlock(&adapter->lock);
1706
9012b28a 1707 lbs_deb_leave_args(LBS_DEB_WEXT, "ret %d", ret);
876c9d3a
MT
1708 return ret;
1709}
1710
1711static int wlan_get_genie(struct net_device *dev,
1712 struct iw_request_info *info,
1713 struct iw_point *dwrq,
1714 char *extra)
1715{
9012b28a 1716 int ret = 0;
876c9d3a
MT
1717 wlan_private *priv = dev->priv;
1718 wlan_adapter *adapter = priv->adapter;
1719
9012b28a 1720 lbs_deb_enter(LBS_DEB_WEXT);
876c9d3a
MT
1721
1722 if (adapter->wpa_ie_len == 0) {
1723 dwrq->length = 0;
9012b28a 1724 goto out;
876c9d3a
MT
1725 }
1726
1727 if (dwrq->length < adapter->wpa_ie_len) {
9012b28a
HS
1728 ret = -E2BIG;
1729 goto out;
876c9d3a
MT
1730 }
1731
1732 dwrq->length = adapter->wpa_ie_len;
1733 memcpy(extra, &adapter->wpa_ie[0], adapter->wpa_ie_len);
1734
9012b28a
HS
1735out:
1736 lbs_deb_leave_args(LBS_DEB_WEXT, "ret %d", ret);
1737 return ret;
876c9d3a
MT
1738}
1739
1740
1741static int wlan_set_auth(struct net_device *dev,
1742 struct iw_request_info *info,
1743 struct iw_param *dwrq,
1744 char *extra)
1745{
1746 wlan_private *priv = dev->priv;
1747 wlan_adapter *adapter = priv->adapter;
1748 struct assoc_request * assoc_req;
1749 int ret = 0;
1750 int updated = 0;
1751
9012b28a 1752 lbs_deb_enter(LBS_DEB_WEXT);
876c9d3a
MT
1753
1754 mutex_lock(&adapter->lock);
1755 assoc_req = wlan_get_association_request(adapter);
1756 if (!assoc_req) {
1757 ret = -ENOMEM;
1758 goto out;
1759 }
1760
1761 switch (dwrq->flags & IW_AUTH_INDEX) {
1762 case IW_AUTH_TKIP_COUNTERMEASURES:
1763 case IW_AUTH_CIPHER_PAIRWISE:
1764 case IW_AUTH_CIPHER_GROUP:
1765 case IW_AUTH_KEY_MGMT:
90a42210 1766 case IW_AUTH_DROP_UNENCRYPTED:
876c9d3a
MT
1767 /*
1768 * libertas does not use these parameters
1769 */
1770 break;
1771
1772 case IW_AUTH_WPA_VERSION:
1773 if (dwrq->value & IW_AUTH_WPA_VERSION_DISABLED) {
1774 assoc_req->secinfo.WPAenabled = 0;
1775 assoc_req->secinfo.WPA2enabled = 0;
90a42210 1776 disable_wpa (assoc_req);
876c9d3a
MT
1777 }
1778 if (dwrq->value & IW_AUTH_WPA_VERSION_WPA) {
1779 assoc_req->secinfo.WPAenabled = 1;
889c05bd 1780 assoc_req->secinfo.wep_enabled = 0;
6affe785 1781 assoc_req->secinfo.auth_mode = IW_AUTH_ALG_OPEN_SYSTEM;
876c9d3a
MT
1782 }
1783 if (dwrq->value & IW_AUTH_WPA_VERSION_WPA2) {
1784 assoc_req->secinfo.WPA2enabled = 1;
889c05bd 1785 assoc_req->secinfo.wep_enabled = 0;
6affe785 1786 assoc_req->secinfo.auth_mode = IW_AUTH_ALG_OPEN_SYSTEM;
876c9d3a
MT
1787 }
1788 updated = 1;
1789 break;
1790
876c9d3a
MT
1791 case IW_AUTH_80211_AUTH_ALG:
1792 if (dwrq->value & IW_AUTH_ALG_SHARED_KEY) {
6affe785 1793 assoc_req->secinfo.auth_mode = IW_AUTH_ALG_SHARED_KEY;
876c9d3a 1794 } else if (dwrq->value & IW_AUTH_ALG_OPEN_SYSTEM) {
6affe785 1795 assoc_req->secinfo.auth_mode = IW_AUTH_ALG_OPEN_SYSTEM;
876c9d3a 1796 } else if (dwrq->value & IW_AUTH_ALG_LEAP) {
6affe785 1797 assoc_req->secinfo.auth_mode = IW_AUTH_ALG_LEAP;
876c9d3a
MT
1798 } else {
1799 ret = -EINVAL;
1800 }
1801 updated = 1;
1802 break;
1803
1804 case IW_AUTH_WPA_ENABLED:
1805 if (dwrq->value) {
1806 if (!assoc_req->secinfo.WPAenabled &&
1807 !assoc_req->secinfo.WPA2enabled) {
1808 assoc_req->secinfo.WPAenabled = 1;
1809 assoc_req->secinfo.WPA2enabled = 1;
889c05bd 1810 assoc_req->secinfo.wep_enabled = 0;
6affe785 1811 assoc_req->secinfo.auth_mode = IW_AUTH_ALG_OPEN_SYSTEM;
876c9d3a
MT
1812 }
1813 } else {
1814 assoc_req->secinfo.WPAenabled = 0;
1815 assoc_req->secinfo.WPA2enabled = 0;
90a42210 1816 disable_wpa (assoc_req);
876c9d3a
MT
1817 }
1818 updated = 1;
1819 break;
1820
1821 default:
1822 ret = -EOPNOTSUPP;
1823 break;
1824 }
1825
1826out:
1827 if (ret == 0) {
1828 if (updated)
1829 set_bit(ASSOC_FLAG_SECINFO, &assoc_req->flags);
1830 wlan_postpone_association_work(priv);
1831 } else if (ret != -EOPNOTSUPP) {
1832 wlan_cancel_association_work(priv);
1833 }
1834 mutex_unlock(&adapter->lock);
1835
9012b28a 1836 lbs_deb_leave_args(LBS_DEB_WEXT, "ret %d", ret);
876c9d3a
MT
1837 return ret;
1838}
1839
1840static int wlan_get_auth(struct net_device *dev,
1841 struct iw_request_info *info,
1842 struct iw_param *dwrq,
1843 char *extra)
1844{
9012b28a 1845 int ret = 0;
876c9d3a
MT
1846 wlan_private *priv = dev->priv;
1847 wlan_adapter *adapter = priv->adapter;
1848
9012b28a 1849 lbs_deb_enter(LBS_DEB_WEXT);
876c9d3a
MT
1850
1851 switch (dwrq->flags & IW_AUTH_INDEX) {
1852 case IW_AUTH_WPA_VERSION:
1853 dwrq->value = 0;
1854 if (adapter->secinfo.WPAenabled)
1855 dwrq->value |= IW_AUTH_WPA_VERSION_WPA;
1856 if (adapter->secinfo.WPA2enabled)
1857 dwrq->value |= IW_AUTH_WPA_VERSION_WPA2;
1858 if (!dwrq->value)
1859 dwrq->value |= IW_AUTH_WPA_VERSION_DISABLED;
1860 break;
1861
876c9d3a 1862 case IW_AUTH_80211_AUTH_ALG:
6affe785 1863 dwrq->value = adapter->secinfo.auth_mode;
876c9d3a
MT
1864 break;
1865
1866 case IW_AUTH_WPA_ENABLED:
1867 if (adapter->secinfo.WPAenabled && adapter->secinfo.WPA2enabled)
1868 dwrq->value = 1;
1869 break;
1870
1871 default:
9012b28a 1872 ret = -EOPNOTSUPP;
876c9d3a
MT
1873 }
1874
9012b28a
HS
1875 lbs_deb_leave_args(LBS_DEB_WEXT, "ret %d", ret);
1876 return ret;
876c9d3a
MT
1877}
1878
1879
1880static int wlan_set_txpow(struct net_device *dev, struct iw_request_info *info,
1881 struct iw_param *vwrq, char *extra)
1882{
1883 int ret = 0;
1884 wlan_private *priv = dev->priv;
1885 wlan_adapter *adapter = priv->adapter;
1886
1887 u16 dbm;
1888
9012b28a 1889 lbs_deb_enter(LBS_DEB_WEXT);
876c9d3a
MT
1890
1891 if (vwrq->disabled) {
1892 wlan_radio_ioctl(priv, RADIO_OFF);
1893 return 0;
1894 }
1895
0aef64d7 1896 adapter->preamble = CMD_TYPE_AUTO_PREAMBLE;
876c9d3a
MT
1897
1898 wlan_radio_ioctl(priv, RADIO_ON);
1899
1900 if ((vwrq->flags & IW_TXPOW_TYPE) == IW_TXPOW_MWATT) {
1901 dbm = (u16) mw_to_dbm(vwrq->value);
1902 } else
1903 dbm = (u16) vwrq->value;
1904
1905 /* auto tx power control */
1906
1907 if (vwrq->fixed == 0)
1908 dbm = 0xffff;
1909
9012b28a 1910 lbs_deb_wext("txpower set %d dbm\n", dbm);
876c9d3a
MT
1911
1912 ret = libertas_prepare_and_send_command(priv,
0aef64d7
DW
1913 CMD_802_11_RF_TX_POWER,
1914 CMD_ACT_TX_POWER_OPT_SET_LOW,
1915 CMD_OPTION_WAITFORRSP, 0, (void *)&dbm);
876c9d3a 1916
9012b28a 1917 lbs_deb_leave_args(LBS_DEB_WEXT, "ret %d", ret);
876c9d3a
MT
1918 return ret;
1919}
1920
1921static int wlan_get_essid(struct net_device *dev, struct iw_request_info *info,
1922 struct iw_point *dwrq, char *extra)
1923{
1924 wlan_private *priv = dev->priv;
1925 wlan_adapter *adapter = priv->adapter;
1926
9012b28a
HS
1927 lbs_deb_enter(LBS_DEB_WEXT);
1928
876c9d3a
MT
1929 /*
1930 * Note : if dwrq->flags != 0, we should get the relevant SSID from
1931 * the SSID list...
1932 */
1933
1934 /*
1935 * Get the current SSID
1936 */
0aef64d7 1937 if (adapter->connect_status == LIBERTAS_CONNECTED) {
d8efea25
DW
1938 memcpy(extra, adapter->curbssparams.ssid,
1939 adapter->curbssparams.ssid_len);
1940 extra[adapter->curbssparams.ssid_len] = '\0';
876c9d3a
MT
1941 } else {
1942 memset(extra, 0, 32);
d8efea25 1943 extra[adapter->curbssparams.ssid_len] = '\0';
876c9d3a
MT
1944 }
1945 /*
1946 * If none, we may want to get the one that was set
1947 */
1948
1949 /* To make the driver backward compatible with WPA supplicant v0.2.4 */
1950 if (dwrq->length == 32) /* check with WPA supplicant buffer size */
d8efea25 1951 dwrq->length = min_t(size_t, adapter->curbssparams.ssid_len,
876c9d3a
MT
1952 IW_ESSID_MAX_SIZE);
1953 else
d8efea25 1954 dwrq->length = adapter->curbssparams.ssid_len + 1;
876c9d3a
MT
1955
1956 dwrq->flags = 1; /* active */
1957
9012b28a 1958 lbs_deb_leave(LBS_DEB_WEXT);
876c9d3a
MT
1959 return 0;
1960}
1961
1962static int wlan_set_essid(struct net_device *dev, struct iw_request_info *info,
1963 struct iw_point *dwrq, char *extra)
1964{
1965 wlan_private *priv = dev->priv;
1966 wlan_adapter *adapter = priv->adapter;
1967 int ret = 0;
d8efea25
DW
1968 u8 ssid[IW_ESSID_MAX_SIZE];
1969 u8 ssid_len = 0;
876c9d3a 1970 struct assoc_request * assoc_req;
d8efea25 1971 int in_ssid_len = dwrq->length;
876c9d3a 1972
9012b28a 1973 lbs_deb_enter(LBS_DEB_WEXT);
876c9d3a
MT
1974
1975 /*
1976 * WE-20 and earlier NULL pad the end of the SSID and increment
1977 * SSID length so it can be used like a string. WE-21 and later don't,
1978 * but some userspace tools aren't able to cope with the change.
1979 */
d8efea25
DW
1980 if ((in_ssid_len > 0) && (extra[in_ssid_len - 1] == '\0'))
1981 in_ssid_len--;
876c9d3a
MT
1982
1983 /* Check the size of the string */
d8efea25 1984 if (in_ssid_len > IW_ESSID_MAX_SIZE) {
876c9d3a
MT
1985 ret = -E2BIG;
1986 goto out;
1987 }
1988
d8efea25 1989 memset(&ssid, 0, sizeof(ssid));
876c9d3a 1990
d8efea25 1991 if (!dwrq->flags || !in_ssid_len) {
876c9d3a
MT
1992 /* "any" SSID requested; leave SSID blank */
1993 } else {
1994 /* Specific SSID requested */
d8efea25
DW
1995 memcpy(&ssid, extra, in_ssid_len);
1996 ssid_len = in_ssid_len;
876c9d3a
MT
1997 }
1998
d8efea25
DW
1999 if (!ssid_len) {
2000 lbs_deb_wext("requested any SSID\n");
2001 } else {
2002 lbs_deb_wext("requested SSID '%s'\n",
2003 escape_essid(ssid, ssid_len));
2004 }
876c9d3a
MT
2005
2006out:
2007 mutex_lock(&adapter->lock);
2008 if (ret == 0) {
2009 /* Get or create the current association request */
2010 assoc_req = wlan_get_association_request(adapter);
2011 if (!assoc_req) {
2012 ret = -ENOMEM;
2013 } else {
2014 /* Copy the SSID to the association request */
d8efea25
DW
2015 memcpy(&assoc_req->ssid, &ssid, IW_ESSID_MAX_SIZE);
2016 assoc_req->ssid_len = ssid_len;
876c9d3a
MT
2017 set_bit(ASSOC_FLAG_SSID, &assoc_req->flags);
2018 wlan_postpone_association_work(priv);
2019 }
2020 }
2021
2022 /* Cancel the association request if there was an error */
2023 if (ret != 0) {
2024 wlan_cancel_association_work(priv);
2025 }
2026
2027 mutex_unlock(&adapter->lock);
2028
9012b28a 2029 lbs_deb_leave_args(LBS_DEB_WEXT, "ret %d", ret);
876c9d3a
MT
2030 return ret;
2031}
2032
2033/**
2034 * @brief Connect to the AP or Ad-hoc Network with specific bssid
2035 *
2036 * @param dev A pointer to net_device structure
2037 * @param info A pointer to iw_request_info structure
2038 * @param awrq A pointer to iw_param structure
2039 * @param extra A pointer to extra data buf
2040 * @return 0 --success, otherwise fail
2041 */
2042static int wlan_set_wap(struct net_device *dev, struct iw_request_info *info,
2043 struct sockaddr *awrq, char *extra)
2044{
2045 wlan_private *priv = dev->priv;
2046 wlan_adapter *adapter = priv->adapter;
2047 struct assoc_request * assoc_req;
2048 int ret = 0;
2049
9012b28a 2050 lbs_deb_enter(LBS_DEB_WEXT);
876c9d3a
MT
2051
2052 if (awrq->sa_family != ARPHRD_ETHER)
2053 return -EINVAL;
2054
9012b28a 2055 lbs_deb_wext("ASSOC: WAP: sa_data " MAC_FMT "\n", MAC_ARG(awrq->sa_data));
876c9d3a
MT
2056
2057 mutex_lock(&adapter->lock);
2058
2059 /* Get or create the current association request */
2060 assoc_req = wlan_get_association_request(adapter);
2061 if (!assoc_req) {
2062 wlan_cancel_association_work(priv);
2063 ret = -ENOMEM;
2064 } else {
2065 /* Copy the BSSID to the association request */
2066 memcpy(&assoc_req->bssid, awrq->sa_data, ETH_ALEN);
2067 set_bit(ASSOC_FLAG_BSSID, &assoc_req->flags);
2068 wlan_postpone_association_work(priv);
2069 }
2070
2071 mutex_unlock(&adapter->lock);
2072
2073 return ret;
2074}
2075
2076void libertas_get_fwversion(wlan_adapter * adapter, char *fwversion, int maxlen)
2077{
876c9d3a
MT
2078 char fwver[32];
2079
2080 mutex_lock(&adapter->lock);
876c9d3a 2081
e5b3d472
DW
2082 if (adapter->fwreleasenumber[3] == 0)
2083 sprintf(fwver, "%u.%u.%u",
2084 adapter->fwreleasenumber[2],
2085 adapter->fwreleasenumber[1],
2086 adapter->fwreleasenumber[0]);
876c9d3a
MT
2087 else
2088 sprintf(fwver, "%u.%u.%u.p%u",
e5b3d472
DW
2089 adapter->fwreleasenumber[2],
2090 adapter->fwreleasenumber[1],
2091 adapter->fwreleasenumber[0],
2092 adapter->fwreleasenumber[3]);
876c9d3a 2093
e5b3d472 2094 mutex_unlock(&adapter->lock);
876c9d3a
MT
2095 snprintf(fwversion, maxlen, fwver);
2096}
2097
2098
2099/*
2100 * iwconfig settable callbacks
2101 */
2102static const iw_handler wlan_handler[] = {
2103 (iw_handler) NULL, /* SIOCSIWCOMMIT */
2104 (iw_handler) wlan_get_name, /* SIOCGIWNAME */
2105 (iw_handler) NULL, /* SIOCSIWNWID */
2106 (iw_handler) NULL, /* SIOCGIWNWID */
2107 (iw_handler) wlan_set_freq, /* SIOCSIWFREQ */
2108 (iw_handler) wlan_get_freq, /* SIOCGIWFREQ */
2109 (iw_handler) wlan_set_mode, /* SIOCSIWMODE */
2110 (iw_handler) wlan_get_mode, /* SIOCGIWMODE */
2111 (iw_handler) NULL, /* SIOCSIWSENS */
2112 (iw_handler) NULL, /* SIOCGIWSENS */
2113 (iw_handler) NULL, /* SIOCSIWRANGE */
2114 (iw_handler) wlan_get_range, /* SIOCGIWRANGE */
2115 (iw_handler) NULL, /* SIOCSIWPRIV */
2116 (iw_handler) NULL, /* SIOCGIWPRIV */
2117 (iw_handler) NULL, /* SIOCSIWSTATS */
2118 (iw_handler) NULL, /* SIOCGIWSTATS */
2119 iw_handler_set_spy, /* SIOCSIWSPY */
2120 iw_handler_get_spy, /* SIOCGIWSPY */
2121 iw_handler_set_thrspy, /* SIOCSIWTHRSPY */
2122 iw_handler_get_thrspy, /* SIOCGIWTHRSPY */
2123 (iw_handler) wlan_set_wap, /* SIOCSIWAP */
2124 (iw_handler) wlan_get_wap, /* SIOCGIWAP */
2125 (iw_handler) NULL, /* SIOCSIWMLME */
2126 (iw_handler) NULL, /* SIOCGIWAPLIST - deprecated */
2127 (iw_handler) libertas_set_scan, /* SIOCSIWSCAN */
2128 (iw_handler) libertas_get_scan, /* SIOCGIWSCAN */
2129 (iw_handler) wlan_set_essid, /* SIOCSIWESSID */
2130 (iw_handler) wlan_get_essid, /* SIOCGIWESSID */
2131 (iw_handler) wlan_set_nick, /* SIOCSIWNICKN */
2132 (iw_handler) wlan_get_nick, /* SIOCGIWNICKN */
2133 (iw_handler) NULL, /* -- hole -- */
2134 (iw_handler) NULL, /* -- hole -- */
2135 (iw_handler) wlan_set_rate, /* SIOCSIWRATE */
2136 (iw_handler) wlan_get_rate, /* SIOCGIWRATE */
2137 (iw_handler) wlan_set_rts, /* SIOCSIWRTS */
2138 (iw_handler) wlan_get_rts, /* SIOCGIWRTS */
2139 (iw_handler) wlan_set_frag, /* SIOCSIWFRAG */
2140 (iw_handler) wlan_get_frag, /* SIOCGIWFRAG */
2141 (iw_handler) wlan_set_txpow, /* SIOCSIWTXPOW */
2142 (iw_handler) wlan_get_txpow, /* SIOCGIWTXPOW */
2143 (iw_handler) wlan_set_retry, /* SIOCSIWRETRY */
2144 (iw_handler) wlan_get_retry, /* SIOCGIWRETRY */
2145 (iw_handler) wlan_set_encode, /* SIOCSIWENCODE */
2146 (iw_handler) wlan_get_encode, /* SIOCGIWENCODE */
2147 (iw_handler) wlan_set_power, /* SIOCSIWPOWER */
2148 (iw_handler) wlan_get_power, /* SIOCGIWPOWER */
2149 (iw_handler) NULL, /* -- hole -- */
2150 (iw_handler) NULL, /* -- hole -- */
2151 (iw_handler) wlan_set_genie, /* SIOCSIWGENIE */
2152 (iw_handler) wlan_get_genie, /* SIOCGIWGENIE */
2153 (iw_handler) wlan_set_auth, /* SIOCSIWAUTH */
2154 (iw_handler) wlan_get_auth, /* SIOCGIWAUTH */
2155 (iw_handler) wlan_set_encodeext,/* SIOCSIWENCODEEXT */
2156 (iw_handler) wlan_get_encodeext,/* SIOCGIWENCODEEXT */
2157 (iw_handler) NULL, /* SIOCSIWPMKSA */
2158};
2159
f5e05b69
LCCR
2160static const iw_handler mesh_wlan_handler[] = {
2161 (iw_handler) NULL, /* SIOCSIWCOMMIT */
2162 (iw_handler) wlan_get_name, /* SIOCGIWNAME */
2163 (iw_handler) NULL, /* SIOCSIWNWID */
2164 (iw_handler) NULL, /* SIOCGIWNWID */
2165 (iw_handler) wlan_set_freq, /* SIOCSIWFREQ */
2166 (iw_handler) wlan_get_freq, /* SIOCGIWFREQ */
2167 (iw_handler) NULL, /* SIOCSIWMODE */
2168 (iw_handler) mesh_wlan_get_mode, /* SIOCGIWMODE */
2169 (iw_handler) NULL, /* SIOCSIWSENS */
2170 (iw_handler) NULL, /* SIOCGIWSENS */
2171 (iw_handler) NULL, /* SIOCSIWRANGE */
2172 (iw_handler) wlan_get_range, /* SIOCGIWRANGE */
2173 (iw_handler) NULL, /* SIOCSIWPRIV */
2174 (iw_handler) NULL, /* SIOCGIWPRIV */
2175 (iw_handler) NULL, /* SIOCSIWSTATS */
2176 (iw_handler) NULL, /* SIOCGIWSTATS */
2177 iw_handler_set_spy, /* SIOCSIWSPY */
2178 iw_handler_get_spy, /* SIOCGIWSPY */
2179 iw_handler_set_thrspy, /* SIOCSIWTHRSPY */
2180 iw_handler_get_thrspy, /* SIOCGIWTHRSPY */
2181 (iw_handler) NULL, /* SIOCSIWAP */
2182 (iw_handler) NULL, /* SIOCGIWAP */
2183 (iw_handler) NULL, /* SIOCSIWMLME */
2184 (iw_handler) NULL, /* SIOCGIWAPLIST - deprecated */
2185 (iw_handler) libertas_set_scan, /* SIOCSIWSCAN */
2186 (iw_handler) libertas_get_scan, /* SIOCGIWSCAN */
2187 (iw_handler) NULL, /* SIOCSIWESSID */
2188 (iw_handler) NULL, /* SIOCGIWESSID */
2189 (iw_handler) NULL, /* SIOCSIWNICKN */
2190 (iw_handler) mesh_get_nick, /* SIOCGIWNICKN */
2191 (iw_handler) NULL, /* -- hole -- */
2192 (iw_handler) NULL, /* -- hole -- */
2193 (iw_handler) wlan_set_rate, /* SIOCSIWRATE */
2194 (iw_handler) wlan_get_rate, /* SIOCGIWRATE */
2195 (iw_handler) wlan_set_rts, /* SIOCSIWRTS */
2196 (iw_handler) wlan_get_rts, /* SIOCGIWRTS */
2197 (iw_handler) wlan_set_frag, /* SIOCSIWFRAG */
2198 (iw_handler) wlan_get_frag, /* SIOCGIWFRAG */
2199 (iw_handler) wlan_set_txpow, /* SIOCSIWTXPOW */
2200 (iw_handler) wlan_get_txpow, /* SIOCGIWTXPOW */
2201 (iw_handler) wlan_set_retry, /* SIOCSIWRETRY */
2202 (iw_handler) wlan_get_retry, /* SIOCGIWRETRY */
2203 (iw_handler) wlan_set_encode, /* SIOCSIWENCODE */
2204 (iw_handler) wlan_get_encode, /* SIOCGIWENCODE */
2205 (iw_handler) wlan_set_power, /* SIOCSIWPOWER */
2206 (iw_handler) wlan_get_power, /* SIOCGIWPOWER */
2207 (iw_handler) NULL, /* -- hole -- */
2208 (iw_handler) NULL, /* -- hole -- */
2209 (iw_handler) wlan_set_genie, /* SIOCSIWGENIE */
2210 (iw_handler) wlan_get_genie, /* SIOCGIWGENIE */
2211 (iw_handler) wlan_set_auth, /* SIOCSIWAUTH */
2212 (iw_handler) wlan_get_auth, /* SIOCGIWAUTH */
2213 (iw_handler) wlan_set_encodeext,/* SIOCSIWENCODEEXT */
2214 (iw_handler) wlan_get_encodeext,/* SIOCGIWENCODEEXT */
2215 (iw_handler) NULL, /* SIOCSIWPMKSA */
2216};
876c9d3a
MT
2217struct iw_handler_def libertas_handler_def = {
2218 .num_standard = sizeof(wlan_handler) / sizeof(iw_handler),
876c9d3a 2219 .standard = (iw_handler *) wlan_handler,
876c9d3a
MT
2220 .get_wireless_stats = wlan_get_wireless_stats,
2221};
f5e05b69
LCCR
2222
2223struct iw_handler_def mesh_handler_def = {
2224 .num_standard = sizeof(mesh_wlan_handler) / sizeof(iw_handler),
f5e05b69 2225 .standard = (iw_handler *) mesh_wlan_handler,
f5e05b69
LCCR
2226 .get_wireless_stats = wlan_get_wireless_stats,
2227};
This page took 0.213397 seconds and 5 git commands to generate.