?  search:
summary | log | graphiclog1 | graphiclog2 | commit | commitdiff | tree | refs | edit | fork
blame | history | raw | HEAD
Merge remote-tracking branch 'moduleh/module.h-split'
[linux-2.6/next.git] / drivers / staging / vt6656 / iwctl.c
blob2121205a912b2d0d1c921f416b5ad5097fc5e337
1 /*
2 * Copyright (c) 1996, 2003 VIA Networking Technologies, Inc.
3 * All rights reserved.
4 *
5 * This program is free software; you can redistribute it and/or modify
6 * it under the terms of the GNU General Public License as published by
7 * the Free Software Foundation; either version 2 of the License, or
8 * (at your option) any later version.
9 *
10 * This program is distributed in the hope that it will be useful,
11 * but WITHOUT ANY WARRANTY; without even the implied warranty of
12 * MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE. See the
13 * GNU General Public License for more details.
14 *
15 * You should have received a copy of the GNU General Public License along
16 * with this program; if not, write to the Free Software Foundation, Inc.,
17 * 51 Franklin Street, Fifth Floor, Boston, MA 02110-1301 USA.
18 *
19 * File: iwctl.c
20 *
21 * Purpose: wireless ext & ioctl functions
22 *
23 * Author: Lyndon Chen
24 *
25 * Date: July 5, 2006
26 *
27 * Functions:
28 *
29 * Revision History:
30 *
31 */
32
33 #include "device.h"
34 #include "ioctl.h"
35 #include "iocmd.h"
36 #include "mac.h"
37 #include "card.h"
38 #include "hostap.h"
39 #include "power.h"
40 #include "rf.h"
41
42 #ifdef WPA_SUPPLICANT_DRIVER_WEXT_SUPPORT
43 #include "iowpa.h"
44 #include "wpactl.h"
45 #endif
46
47 #include <net/iw_handler.h>
48
49
50 /*--------------------- Static Definitions -------------------------*/
51
52 #ifdef WPA_SUPPLICANT_DRIVER_WEXT_SUPPORT
53 #define SUPPORTED_WIRELESS_EXT 18
54 #else
55 #define SUPPORTED_WIRELESS_EXT 17
56 #endif
57
58 static const long frequency_list[] = {
59 2412, 2417, 2422, 2427, 2432, 2437, 2442, 2447, 2452, 2457, 2462, 2467, 2472, 2484,
60 4915, 4920, 4925, 4935, 4940, 4945, 4960, 4980,
61 5035, 5040, 5045, 5055, 5060, 5080, 5170, 5180, 5190, 5200, 5210, 5220, 5230, 5240,
62 5260, 5280, 5300, 5320, 5500, 5520, 5540, 5560, 5580, 5600, 5620, 5640, 5660, 5680,
63 5700, 5745, 5765, 5785, 5805, 5825
64 };
65
66
67 /*--------------------- Static Classes ----------------------------*/
68
69
70 //static int msglevel =MSG_LEVEL_DEBUG;
71 static int msglevel =MSG_LEVEL_INFO;
72
73
74 /*--------------------- Static Variables --------------------------*/
75 /*--------------------- Static Functions --------------------------*/
76
77 /*--------------------- Export Variables --------------------------*/
78
79 struct iw_statistics *iwctl_get_wireless_stats(struct net_device *dev)
80 {
81 PSDevice pDevice = netdev_priv(dev);
82 long ldBm;
83
84 pDevice->wstats.status = pDevice->eOPMode;
85 if(pDevice->scStatistic.LinkQuality > 100)
86 pDevice->scStatistic.LinkQuality = 100;
87 pDevice->wstats.qual.qual =(BYTE) pDevice->scStatistic.LinkQuality;
88 RFvRSSITodBm(pDevice, (BYTE)(pDevice->uCurrRSSI), &ldBm);
89 pDevice->wstats.qual.level = ldBm;
90 //pDevice->wstats.qual.level = 0x100 - pDevice->uCurrRSSI;
91 pDevice->wstats.qual.noise = 0;
92 pDevice->wstats.qual.updated = 1;
93 pDevice->wstats.discard.nwid = 0;
94 pDevice->wstats.discard.code = 0;
95 pDevice->wstats.discard.fragment = 0;
96 pDevice->wstats.discard.retries = pDevice->scStatistic.dwTsrErr;
97 pDevice->wstats.discard.misc = 0;
98 pDevice->wstats.miss.beacon = 0;
99
100 return &pDevice->wstats;
101 }
102
103
104
105 /*------------------------------------------------------------------*/
106
107
108 static int iwctl_commit(struct net_device *dev,
109 struct iw_request_info *info,
110 void *wrq,
111 char *extra)
112 {
113 DBG_PRT(MSG_LEVEL_DEBUG, KERN_INFO " SIOCSIWCOMMIT\n");
114
115 return 0;
116 }
117
118 /*
119 * Wireless Handler : get protocol name
120 */
121
122 int iwctl_giwname(struct net_device *dev,
123 struct iw_request_info *info,
124 char *wrq,
125 char *extra)
126 {
127 strcpy(wrq, "802.11-a/b/g");
128 return 0;
129 }
130
131 int iwctl_giwnwid(struct net_device *dev,
132 struct iw_request_info *info,
133 struct iw_param *wrq,
134 char *extra)
135 {
136 //wrq->value = 0x100;
137 //wrq->disabled = 0;
138 //wrq->fixed = 1;
139 //return 0;
140 return -EOPNOTSUPP;
141 }
142 /*
143 * Wireless Handler : set scan
144 */
145
146 int iwctl_siwscan(struct net_device *dev,
147 struct iw_request_info *info,
148 struct iw_point *wrq,
149 char *extra)
150 {
151 PSDevice pDevice = (PSDevice)netdev_priv(dev);
152 PSMgmtObject pMgmt = &(pDevice->sMgmtObj);
153 struct iw_scan_req *req = (struct iw_scan_req *)extra;
154 BYTE abyScanSSID[WLAN_IEHDR_LEN + WLAN_SSID_MAXLEN + 1];
155 PWLAN_IE_SSID pItemSSID=NULL;
156
157 if (!(pDevice->flags & DEVICE_FLAGS_OPENED))
158 return -EINVAL;
159
160 PRINT_K(" SIOCSIWSCAN \n");
161
162 if (pMgmt->eScanState == WMAC_IS_SCANNING) {
163 // In scanning..
164 PRINT_K("SIOCSIWSCAN(overlap??)-->In scanning...\n");
165 return -EAGAIN;
166 }
167
168 if(pDevice->byReAssocCount > 0) { //reject scan when re-associating!
169 //send scan event to wpa_Supplicant
170 union iwreq_data wrqu;
171 PRINT_K("wireless_send_event--->SIOCGIWSCAN(scan done)\n");
172 memset(&wrqu, 0, sizeof(wrqu));
173 wireless_send_event(pDevice->dev, SIOCGIWSCAN, &wrqu, NULL);
174 return 0;
175 }
176
177 spin_lock_irq(&pDevice->lock);
178
179 BSSvClearBSSList((void *) pDevice, pDevice->bLinkPass);
180
181 //mike add: active scan OR passive scan OR desire_ssid scan
182 if(wrq->length == sizeof(struct iw_scan_req)) {
183 if (wrq->flags & IW_SCAN_THIS_ESSID) { //desire_ssid scan
184 memset(abyScanSSID, 0, WLAN_IEHDR_LEN + WLAN_SSID_MAXLEN + 1);
185 pItemSSID = (PWLAN_IE_SSID)abyScanSSID;
186 pItemSSID->byElementID = WLAN_EID_SSID;
187 memcpy(pItemSSID->abySSID, req->essid, (int)req->essid_len);
188 if (pItemSSID->abySSID[req->essid_len - 1] == '\0') {
189 if(req->essid_len>0)
190 pItemSSID->len = req->essid_len - 1;
191 }
192 else
193 pItemSSID->len = req->essid_len;
194 pMgmt->eScanType = WMAC_SCAN_PASSIVE;
195 PRINT_K("SIOCSIWSCAN:[desired_ssid=%s,len=%d]\n",((PWLAN_IE_SSID)abyScanSSID)->abySSID,
196 ((PWLAN_IE_SSID)abyScanSSID)->len);
197 bScheduleCommand((void *) pDevice, WLAN_CMD_BSSID_SCAN, abyScanSSID);
198 spin_unlock_irq(&pDevice->lock);
199
200 return 0;
201 }
202 else if(req->scan_type == IW_SCAN_TYPE_PASSIVE) { //passive scan
203 pMgmt->eScanType = WMAC_SCAN_PASSIVE;
204 }
205 }
206 else { //active scan
207 pMgmt->eScanType = WMAC_SCAN_ACTIVE;
208 }
209
210 pMgmt->eScanType = WMAC_SCAN_PASSIVE;
211 //printk("SIOCSIWSCAN:WLAN_CMD_BSSID_SCAN\n");
212 bScheduleCommand((void *) pDevice, WLAN_CMD_BSSID_SCAN, NULL);
213 spin_unlock_irq(&pDevice->lock);
214
215 return 0;
216 }
217
218
219 /*
220 * Wireless Handler : get scan results
221 */
222
223 int iwctl_giwscan(struct net_device *dev,
224 struct iw_request_info *info,
225 struct iw_point *wrq,
226 char *extra)
227 {
228 int ii, jj, kk;
229 PSDevice pDevice = (PSDevice)netdev_priv(dev);
230 PSMgmtObject pMgmt = &(pDevice->sMgmtObj);
231 PKnownBSS pBSS;
232 PWLAN_IE_SSID pItemSSID;
233 PWLAN_IE_SUPP_RATES pSuppRates, pExtSuppRates;
234 char *current_ev = extra;
235 char *end_buf = extra + IW_SCAN_MAX_DATA;
236 char *current_val = NULL;
237 struct iw_event iwe;
238 long ldBm;
239 char buf[MAX_WPA_IE_LEN * 2 + 30];
240
241 DBG_PRT(MSG_LEVEL_DEBUG, KERN_INFO " SIOCGIWSCAN\n");
242
243 if (pMgmt->eScanState == WMAC_IS_SCANNING) {
244 // In scanning..
245 return -EAGAIN;
246 }
247 pBSS = &(pMgmt->sBSSList[0]);
248 for (ii = 0, jj = 0; jj < MAX_BSS_NUM ; jj++) {
249 if (current_ev >= end_buf)
250 break;
251 pBSS = &(pMgmt->sBSSList[jj]);
252 if (pBSS->bActive) {
253 //ADD mac address
254 memset(&iwe, 0, sizeof(iwe));
255 iwe.cmd = SIOCGIWAP;
256 iwe.u.ap_addr.sa_family = ARPHRD_ETHER;
257 memcpy(iwe.u.ap_addr.sa_data, pBSS->abyBSSID, WLAN_BSSID_LEN);
258 current_ev = iwe_stream_add_event(info,current_ev,end_buf, &iwe, IW_EV_ADDR_LEN);
259 //ADD ssid
260 memset(&iwe, 0, sizeof(iwe));
261 iwe.cmd = SIOCGIWESSID;
262 pItemSSID = (PWLAN_IE_SSID)pBSS->abySSID;
263 iwe.u.data.length = pItemSSID->len;
264 iwe.u.data.flags = 1;
265 current_ev = iwe_stream_add_point(info,current_ev,end_buf, &iwe, pItemSSID->abySSID);
266 //ADD mode
267 memset(&iwe, 0, sizeof(iwe));
268 iwe.cmd = SIOCGIWMODE;
269 if (WLAN_GET_CAP_INFO_ESS(pBSS->wCapInfo)) {
270 iwe.u.mode = IW_MODE_INFRA;
271 }
272 else {
273 iwe.u.mode = IW_MODE_ADHOC;
274 }
275 iwe.len = IW_EV_UINT_LEN;
276 current_ev = iwe_stream_add_event(info,current_ev, end_buf, &iwe, IW_EV_UINT_LEN);
277 //ADD frequency
278 pSuppRates = (PWLAN_IE_SUPP_RATES)pBSS->abySuppRates;
279 pExtSuppRates = (PWLAN_IE_SUPP_RATES)pBSS->abyExtSuppRates;
280 memset(&iwe, 0, sizeof(iwe));
281 iwe.cmd = SIOCGIWFREQ;
282 iwe.u.freq.m = pBSS->uChannel;
283 iwe.u.freq.e = 0;
284 iwe.u.freq.i = 0;
285 current_ev = iwe_stream_add_event(info,current_ev,end_buf, &iwe, IW_EV_FREQ_LEN);
286 {
287 int f = (int)pBSS->uChannel - 1;
288 if(f < 0)f = 0;
289 iwe.u.freq.m = frequency_list[f] * 100000;
290 iwe.u.freq.e = 1;
291 }
292 current_ev = iwe_stream_add_event(info,current_ev,end_buf, &iwe, IW_EV_FREQ_LEN);
293 //ADD quality
294 memset(&iwe, 0, sizeof(iwe));
295 iwe.cmd = IWEVQUAL;
296 RFvRSSITodBm(pDevice, (BYTE)(pBSS->uRSSI), &ldBm);
297 iwe.u.qual.level = ldBm;
298 iwe.u.qual.noise = 0;
299
300 if(-ldBm<50){
301 iwe.u.qual.qual = 100;
302 }else if(-ldBm > 90) {
303 iwe.u.qual.qual = 0;
304 }else {
305 iwe.u.qual.qual=(40-(-ldBm-50))*100/40;
306 }
307 iwe.u.qual.updated=7;
308
309 current_ev = iwe_stream_add_event(info,current_ev, end_buf, &iwe, IW_EV_QUAL_LEN);
310 //ADD encryption
311 memset(&iwe, 0, sizeof(iwe));
312 iwe.cmd = SIOCGIWENCODE;
313 iwe.u.data.length = 0;
314 if (WLAN_GET_CAP_INFO_PRIVACY(pBSS->wCapInfo)) {
315 iwe.u.data.flags =IW_ENCODE_ENABLED | IW_ENCODE_NOKEY;
316 }else {
317 iwe.u.data.flags = IW_ENCODE_DISABLED;
318 }
319 current_ev = iwe_stream_add_point(info,current_ev,end_buf, &iwe, pItemSSID->abySSID);
320
321 memset(&iwe, 0, sizeof(iwe));
322 iwe.cmd = SIOCGIWRATE;
323 iwe.u.bitrate.fixed = iwe.u.bitrate.disabled = 0;
324 current_val = current_ev + IW_EV_LCP_LEN;
325
326 for (kk = 0 ; kk < 12 ; kk++) {
327 if (pSuppRates->abyRates[kk] == 0)
328 break;
329 // Bit rate given in 500 kb/s units (+ 0x80)
330 iwe.u.bitrate.value = ((pSuppRates->abyRates[kk] & 0x7f) * 500000);
331 current_val = iwe_stream_add_value(info,current_ev, current_val, end_buf, &iwe, IW_EV_PARAM_LEN);
332 }
333 for (kk = 0 ; kk < 8 ; kk++) {
334 if (pExtSuppRates->abyRates[kk] == 0)
335 break;
336 // Bit rate given in 500 kb/s units (+ 0x80)
337 iwe.u.bitrate.value = ((pExtSuppRates->abyRates[kk] & 0x7f) * 500000);
338 current_val = iwe_stream_add_value(info,current_ev, current_val, end_buf, &iwe, IW_EV_PARAM_LEN);
339 }
340
341 if((current_val - current_ev) > IW_EV_LCP_LEN)
342 current_ev = current_val;
343
344 memset(&iwe, 0, sizeof(iwe));
345 iwe.cmd = IWEVCUSTOM;
346 sprintf(buf, "bcn_int=%d", pBSS->wBeaconInterval);
347 iwe.u.data.length = strlen(buf);
348 current_ev = iwe_stream_add_point(info,current_ev, end_buf, &iwe, buf);
349
350 if ((pBSS->wWPALen > 0) && (pBSS->wWPALen <= MAX_WPA_IE_LEN)) {
351 memset(&iwe, 0, sizeof(iwe));
352 iwe.cmd = IWEVGENIE;
353 iwe.u.data.length = pBSS->wWPALen;
354 current_ev = iwe_stream_add_point(info,current_ev, end_buf, &iwe, pBSS->byWPAIE);
355 }
356
357 if ((pBSS->wRSNLen > 0) && (pBSS->wRSNLen <= MAX_WPA_IE_LEN)) {
358 memset(&iwe, 0, sizeof(iwe));
359 iwe.cmd = IWEVGENIE;
360 iwe.u.data.length = pBSS->wRSNLen;
361 current_ev = iwe_stream_add_point(info,current_ev, end_buf, &iwe, pBSS->byRSNIE);
362 }
363
364 }
365 }// for
366
367 wrq->length = current_ev - extra;
368 return 0;
369
370 }
371
372
373 /*
374 * Wireless Handler : set frequence or channel
375 */
376
377 int iwctl_siwfreq(struct net_device *dev,
378 struct iw_request_info *info,
379 struct iw_freq *wrq,
380 char *extra)
381 {
382 PSDevice pDevice = (PSDevice)netdev_priv(dev);
383 int rc = 0;
384
385 DBG_PRT(MSG_LEVEL_DEBUG, KERN_INFO " SIOCSIWFREQ \n");
386
387 // If setting by frequency, convert to a channel
388 if((wrq->e == 1) &&
389 (wrq->m >= (int) 2.412e8) &&
390 (wrq->m <= (int) 2.487e8)) {
391 int f = wrq->m / 100000;
392 int c = 0;
393 while((c < 14) && (f != frequency_list[c]))
394 c++;
395 wrq->e = 0;
396 wrq->m = c + 1;
397 }
398 // Setting by channel number
399 if((wrq->m > 14) || (wrq->e > 0))
400 rc = -EOPNOTSUPP;
401 else {
402 int channel = wrq->m;
403 if((channel < 1) || (channel > 14)) {
404 DBG_PRT(MSG_LEVEL_DEBUG, KERN_INFO "%s: New channel value of %d is invalid!\n", dev->name, wrq->m);
405 rc = -EINVAL;
406 } else {
407 // Yes ! We can set it !!!
408 DBG_PRT(MSG_LEVEL_DEBUG, KERN_INFO " Set to channel = %d\n", channel);
409 pDevice->uChannel = channel;
410 }
411 }
412
413 return rc;
414 }
415
416 /*
417 * Wireless Handler : get frequence or channel
418 */
419
420 int iwctl_giwfreq(struct net_device *dev,
421 struct iw_request_info *info,
422 struct iw_freq *wrq,
423 char *extra)
424 {
425 PSDevice pDevice = (PSDevice)netdev_priv(dev);
426 PSMgmtObject pMgmt = &(pDevice->sMgmtObj);
427
428 DBG_PRT(MSG_LEVEL_DEBUG, KERN_INFO " SIOCGIWFREQ \n");
429
430 #ifdef WEXT_USECHANNELS
431 wrq->m = (int)pMgmt->uCurrChannel;
432 wrq->e = 0;
433 #else
434 {
435 int f = (int)pMgmt->uCurrChannel - 1;
436 if(f < 0)
437 f = 0;
438 wrq->m = frequency_list[f] * 100000;
439 wrq->e = 1;
440 }
441 #endif
442
443 return 0;
444 }
445
446 /*
447 * Wireless Handler : set operation mode
448 */
449
450 int iwctl_siwmode(struct net_device *dev,
451 struct iw_request_info *info,
452 __u32 *wmode,
453 char *extra)
454 {
455 PSDevice pDevice = (PSDevice)netdev_priv(dev);
456 PSMgmtObject pMgmt = &(pDevice->sMgmtObj);
457 int rc = 0;
458
459 DBG_PRT(MSG_LEVEL_DEBUG, KERN_INFO " SIOCSIWMODE \n");
460
461 if (pMgmt->eCurrMode == WMAC_MODE_ESS_AP && pDevice->bEnableHostapd) {
462 DBG_PRT(MSG_LEVEL_DEBUG, KERN_INFO"Can't set operation mode, hostapd is running \n");
463 return rc;
464 }
465
466 switch(*wmode) {
467
468 case IW_MODE_ADHOC:
469 if (pMgmt->eConfigMode != WMAC_CONFIG_IBSS_STA) {
470 pMgmt->eConfigMode = WMAC_CONFIG_IBSS_STA;
471 if (pDevice->flags & DEVICE_FLAGS_OPENED) {
472 pDevice->bCommit = TRUE;
473 }
474 }
475 DBG_PRT(MSG_LEVEL_DEBUG, KERN_INFO "set mode to ad-hoc \n");
476 break;
477 case IW_MODE_AUTO:
478 case IW_MODE_INFRA:
479 if (pMgmt->eConfigMode != WMAC_CONFIG_ESS_STA) {
480 pMgmt->eConfigMode = WMAC_CONFIG_ESS_STA;
481 if (pDevice->flags & DEVICE_FLAGS_OPENED) {
482 pDevice->bCommit = TRUE;
483 }
484 }
485 DBG_PRT(MSG_LEVEL_DEBUG, KERN_INFO "set mode to infrastructure \n");
486 break;
487 case IW_MODE_MASTER:
488
489 pMgmt->eConfigMode = WMAC_CONFIG_ESS_STA;
490 rc = -EOPNOTSUPP;
491 break;
492
493 if (pMgmt->eConfigMode != WMAC_CONFIG_AP) {
494 pMgmt->eConfigMode = WMAC_CONFIG_AP;
495 if (pDevice->flags & DEVICE_FLAGS_OPENED) {
496 pDevice->bCommit = TRUE;
497 }
498 }
499 DBG_PRT(MSG_LEVEL_DEBUG, KERN_INFO "set mode to Access Point \n");
500 break;
501
502 case IW_MODE_REPEAT:
503 pMgmt->eConfigMode = WMAC_CONFIG_ESS_STA;
504 rc = -EOPNOTSUPP;
505 break;
506 default:
507 rc = -EINVAL;
508 }
509
510 return rc;
511 }
512
513 /*
514 * Wireless Handler : get operation mode
515 */
516
517 int iwctl_giwmode(struct net_device *dev,
518 struct iw_request_info *info,
519 __u32 *wmode,
520 char *extra)
521 {
522 PSDevice pDevice = (PSDevice)netdev_priv(dev);
523 PSMgmtObject pMgmt = &(pDevice->sMgmtObj);
524
525
526 DBG_PRT(MSG_LEVEL_DEBUG, KERN_INFO " SIOCGIWMODE \n");
527 // If not managed, assume it's ad-hoc
528 switch (pMgmt->eConfigMode) {
529 case WMAC_CONFIG_ESS_STA:
530 *wmode = IW_MODE_INFRA;
531 break;
532 case WMAC_CONFIG_IBSS_STA:
533 *wmode = IW_MODE_ADHOC;
534 break;
535 case WMAC_CONFIG_AUTO:
536 *wmode = IW_MODE_INFRA;
537 break;
538 case WMAC_CONFIG_AP:
539 *wmode = IW_MODE_MASTER;
540 break;
541 default:
542 *wmode = IW_MODE_ADHOC;
543 }
544
545 return 0;
546 }
547
548
549 /*
550 * Wireless Handler : get capability range
551 */
552
553 int iwctl_giwrange(struct net_device *dev,
554 struct iw_request_info *info,
555 struct iw_point *wrq,
556 char *extra)
557 {
558 struct iw_range *range = (struct iw_range *) extra;
559 int i,k;
560 BYTE abySupportedRates[13]= {0x02, 0x04, 0x0B, 0x16, 0x0c, 0x12, 0x18, 0x24, 0x30, 0x48, 0x60, 0x6C, 0x90};
561
562 DBG_PRT(MSG_LEVEL_DEBUG, KERN_INFO " SIOCGIWRANGE\n");
563 if (wrq->pointer) {
564 wrq->length = sizeof(struct iw_range);
565 memset(range, 0, sizeof(struct iw_range));
566 range->min_nwid = 0x0000;
567 range->max_nwid = 0x0000;
568 range->num_channels = 14;
569 // Should be based on cap_rid.country to give only
570 // what the current card support
571 k = 0;
572 for (i = 0; i < 14; i++) {
573 range->freq[k].i = i + 1; // List index
574 range->freq[k].m = frequency_list[i] * 100000;
575 range->freq[k++].e = 1; // Values in table in MHz -> * 10^5 * 10
576 }
577 range->num_frequency = k;
578 // Hum... Should put the right values there
579 range->max_qual.qual = 100;
580 range->max_qual.level = 0;
581 range->max_qual.noise = 0;
582 range->sensitivity = 255;
583
584 for (i = 0 ; i < 13 ; i++) {
585 range->bitrate[i] = abySupportedRates[i] * 500000;
586 if(range->bitrate[i] == 0)
587 break;
588 }
589 range->num_bitrates = i;
590
591 // Set an indication of the max TCP throughput
592 // in bit/s that we can expect using this interface.
593 // May be use for QoS stuff... Jean II
594 if(i > 2)
595 range->throughput = 5 * 1000 * 1000;
596 else
597 range->throughput = 1.5 * 1000 * 1000;
598
599 range->min_rts = 0;
600 range->max_rts = 2312;
601 range->min_frag = 256;
602 range->max_frag = 2312;
603
604
605 // the encoding capabilities
606 range->num_encoding_sizes = 3;
607 // 64(40) bits WEP
608 range->encoding_size[0] = 5;
609 // 128(104) bits WEP
610 range->encoding_size[1] = 13;
611 // 256 bits for WPA-PSK
612 range->encoding_size[2] = 32;
613 // 4 keys are allowed
614 range->max_encoding_tokens = 4;
615
616 range->enc_capa = IW_ENC_CAPA_WPA | IW_ENC_CAPA_WPA2 |
617 IW_ENC_CAPA_CIPHER_TKIP | IW_ENC_CAPA_CIPHER_CCMP;
618
619 range->min_pmp = 0;
620 range->max_pmp = 1000000;// 1 secs
621 range->min_pmt = 0;
622 range->max_pmt = 1000000;// 1 secs
623 range->pmp_flags = IW_POWER_PERIOD;
624 range->pmt_flags = IW_POWER_TIMEOUT;
625 range->pm_capa = IW_POWER_PERIOD | IW_POWER_TIMEOUT | IW_POWER_ALL_R;
626
627 // Transmit Power - values are in mW
628
629 range->txpower[0] = 100;
630 range->num_txpower = 1;
631 range->txpower_capa = IW_TXPOW_MWATT;
632 range->we_version_source = SUPPORTED_WIRELESS_EXT;
633 range->we_version_compiled = WIRELESS_EXT;
634 range->retry_capa = IW_RETRY_LIMIT | IW_RETRY_LIFETIME;
635 range->retry_flags = IW_RETRY_LIMIT;
636 range->r_time_flags = IW_RETRY_LIFETIME;
637 range->min_retry = 1;
638 range->max_retry = 65535;
639 range->min_r_time = 1024;
640 range->max_r_time = 65535 * 1024;
641 // Experimental measurements - boundary 11/5.5 Mb/s
642 // Note : with or without the (local->rssi), results
643 // are somewhat different. - Jean II
644 range->avg_qual.qual = 6;
645 range->avg_qual.level = 176; // -80 dBm
646 range->avg_qual.noise = 0;
647 }
648
649
650 return 0;
651 }
652
653
654 /*
655 * Wireless Handler : set ap mac address
656 */
657
658 int iwctl_siwap(struct net_device *dev,
659 struct iw_request_info *info,
660 struct sockaddr *wrq,
661 char *extra)
662 {
663 PSDevice pDevice = (PSDevice)netdev_priv(dev);
664 PSMgmtObject pMgmt = &(pDevice->sMgmtObj);
665 int rc = 0;
666 BYTE ZeroBSSID[WLAN_BSSID_LEN]={0x00,0x00,0x00,0x00,0x00,0x00};
667
668 PRINT_K(" SIOCSIWAP \n");
669
670 if (wrq->sa_family != ARPHRD_ETHER)
671 rc = -EINVAL;
672 else {
673 memcpy(pMgmt->abyDesireBSSID, wrq->sa_data, 6);
674
675 //mike :add
676 if ((is_broadcast_ether_addr(pMgmt->abyDesireBSSID)) ||
677 (memcmp(pMgmt->abyDesireBSSID, ZeroBSSID, 6) == 0)){
678 PRINT_K("SIOCSIWAP:invalid desired BSSID return!\n");
679 return rc;
680 }
681 //mike add: if desired AP is hidden ssid(there are two same BSSID in list),
682 // then ignore,because you don't known which one to be connect with??
683 {
684 unsigned int ii, uSameBssidNum = 0;
685 for (ii = 0; ii < MAX_BSS_NUM; ii++) {
686 if (pMgmt->sBSSList[ii].bActive &&
687 !compare_ether_addr(pMgmt->sBSSList[ii].abyBSSID,
688 pMgmt->abyDesireBSSID)) {
689 uSameBssidNum++;
690 }
691 }
692 if(uSameBssidNum >= 2) { //hit: desired AP is in hidden ssid mode!!!
693 PRINT_K("SIOCSIWAP:ignore for desired AP in hidden mode\n");
694 return rc;
695 }
696 }
697
698 if (pDevice->flags & DEVICE_FLAGS_OPENED) {
699 pDevice->bCommit = TRUE;
700 }
701 }
702 return rc;
703 }
704
705 /*
706 * Wireless Handler : get ap mac address
707 */
708
709 int iwctl_giwap(struct net_device *dev,
710 struct iw_request_info *info,
711 struct sockaddr *wrq,
712 char *extra)
713 {
714 PSDevice pDevice = (PSDevice)netdev_priv(dev);
715 PSMgmtObject pMgmt = &(pDevice->sMgmtObj);
716
717
718 DBG_PRT(MSG_LEVEL_DEBUG, KERN_INFO " SIOCGIWAP \n");
719
720 memcpy(wrq->sa_data, pMgmt->abyCurrBSSID, 6);
721
722 //20080123-02,<Modify> by Einsn Liu
723 if ((pDevice->bLinkPass == FALSE) && (pMgmt->eCurrMode != WMAC_MODE_ESS_AP))
724 // if ((pDevice->bLinkPass == FALSE) && (pMgmt->eCurrMode == WMAC_MODE_ESS_STA))
725 memset(wrq->sa_data, 0, 6);
726
727 if (pMgmt->eCurrMode == WMAC_MODE_ESS_AP) {
728 memcpy(wrq->sa_data, pMgmt->abyCurrBSSID, 6);
729 }
730
731 wrq->sa_family = ARPHRD_ETHER;
732
733 return 0;
734
735 }
736
737
738 /*
739 * Wireless Handler : get ap list
740 */
741
742 int iwctl_giwaplist(struct net_device *dev,
743 struct iw_request_info *info,
744 struct iw_point *wrq,
745 char *extra)
746 {
747 int ii,jj, rc = 0;
748 struct sockaddr sock[IW_MAX_AP];
749 struct iw_quality qual[IW_MAX_AP];
750 PSDevice pDevice = (PSDevice)netdev_priv(dev);
751 PSMgmtObject pMgmt = &(pDevice->sMgmtObj);
752
753
754 DBG_PRT(MSG_LEVEL_DEBUG, KERN_INFO " SIOCGIWAPLIST \n");
755 // Only super-user can see AP list
756
757 if (!capable(CAP_NET_ADMIN)) {
758 rc = -EPERM;
759 return rc;
760 }
761
762 if (wrq->pointer) {
763
764 PKnownBSS pBSS = &(pMgmt->sBSSList[0]);
765
766 for (ii = 0, jj= 0; ii < MAX_BSS_NUM; ii++) {
767 pBSS = &(pMgmt->sBSSList[ii]);
768 if (!pBSS->bActive)
769 continue;
770 if ( jj >= IW_MAX_AP)
771 break;
772 memcpy(sock[jj].sa_data, pBSS->abyBSSID, 6);
773 sock[jj].sa_family = ARPHRD_ETHER;
774 qual[jj].level = pBSS->uRSSI;
775 qual[jj].qual = qual[jj].noise = 0;
776 qual[jj].updated = 2;
777 jj++;
778 }
779
780 wrq->flags = 1; // Should be define'd
781 wrq->length = jj;
782 memcpy(extra, sock, sizeof(struct sockaddr)*jj);
783 memcpy(extra + sizeof(struct sockaddr)*jj, qual, sizeof(struct iw_quality)*jj);
784 }
785
786 return rc;
787 }
788
789
790 /*
791 * Wireless Handler : set essid
792 */
793
794 int iwctl_siwessid(struct net_device *dev,
795 struct iw_request_info *info,
796 struct iw_point *wrq,
797 char *extra)
798 {
799 PSDevice pDevice = (PSDevice)netdev_priv(dev);
800 PSMgmtObject pMgmt = &(pDevice->sMgmtObj);
801 PWLAN_IE_SSID pItemSSID;
802
803 if (!(pDevice->flags & DEVICE_FLAGS_OPENED))
804 return -EINVAL;
805
806 DBG_PRT(MSG_LEVEL_DEBUG, KERN_INFO " SIOCSIWESSID :\n");
807
808 pDevice->fWPA_Authened = FALSE;
809 // Check if we asked for `any'
810 if(wrq->flags == 0) {
811 // Just send an empty SSID list
812 memset(pMgmt->abyDesireSSID, 0, WLAN_IEHDR_LEN + WLAN_SSID_MAXLEN + 1);
813 memset(pMgmt->abyDesireBSSID, 0xFF,6);
814 PRINT_K("set essid to 'any' \n");
815 #ifdef WPA_SUPPLICANT_DRIVER_WEXT_SUPPORT
816 //Unknown desired AP,so here need not associate??
817 return 0;
818 #endif
819 } else {
820 // Set the SSID
821 memset(pMgmt->abyDesireSSID, 0, WLAN_IEHDR_LEN + WLAN_SSID_MAXLEN + 1);
822 pItemSSID = (PWLAN_IE_SSID)pMgmt->abyDesireSSID;
823 pItemSSID->byElementID = WLAN_EID_SSID;
824
825 memcpy(pItemSSID->abySSID, extra, wrq->length);
826 if (pItemSSID->abySSID[wrq->length - 1] == '\0') {
827 if(wrq->length>0)
828 pItemSSID->len = wrq->length - 1;
829 }
830 else
831 pItemSSID->len = wrq->length;
832 PRINT_K("set essid to %s \n",pItemSSID->abySSID);
833
834 //mike:need clear desiredBSSID
835 if(pItemSSID->len==0) {
836 memset(pMgmt->abyDesireBSSID, 0xFF,6);
837 return 0;
838 }
839
840 #ifdef WPA_SUPPLICANT_DRIVER_WEXT_SUPPORT
841 //Wext wil order another command of siwap to link with desired AP,
842 //so here need not associate??
843 if(pDevice->bWPASuppWextEnabled == TRUE) {
844 /*******search if in hidden ssid mode ****/
845 {
846 PKnownBSS pCurr = NULL;
847 BYTE abyTmpDesireSSID[WLAN_IEHDR_LEN + WLAN_SSID_MAXLEN + 1];
848 unsigned int ii, uSameBssidNum = 0;
849
850 memcpy(abyTmpDesireSSID,pMgmt->abyDesireSSID,sizeof(abyTmpDesireSSID));
851 pCurr = BSSpSearchBSSList(pDevice,
852 NULL,
853 abyTmpDesireSSID,
854 pDevice->eConfigPHYMode
855 );
856
857 if (pCurr == NULL){
858 PRINT_K("SIOCSIWESSID:hidden ssid site survey before associate.......\n");
859 vResetCommandTimer((void *) pDevice);
860 pMgmt->eScanType = WMAC_SCAN_ACTIVE;
861 bScheduleCommand((void *) pDevice,
862 WLAN_CMD_BSSID_SCAN,
863 pMgmt->abyDesireSSID);
864 bScheduleCommand((void *) pDevice,
865 WLAN_CMD_SSID,
866 pMgmt->abyDesireSSID);
867 }
868 else { //mike:to find out if that desired SSID is a hidden-ssid AP ,
869 // by means of judging if there are two same BSSID exist in list ?
870 for (ii = 0; ii < MAX_BSS_NUM; ii++) {
871 if (pMgmt->sBSSList[ii].bActive &&
872 !compare_ether_addr(pMgmt->sBSSList[ii].abyBSSID,
873 pCurr->abyBSSID)) {
874 uSameBssidNum++;
875 }
876 }
877 if(uSameBssidNum >= 2) { //hit: desired AP is in hidden ssid mode!!!
878 PRINT_K("SIOCSIWESSID:hidden ssid directly associate.......\n");
879 vResetCommandTimer((void *) pDevice);
880 pMgmt->eScanType = WMAC_SCAN_PASSIVE; //this scan type,you'll submit scan result!
881 bScheduleCommand((void *) pDevice,
882 WLAN_CMD_BSSID_SCAN,
883 pMgmt->abyDesireSSID);
884 bScheduleCommand((void *) pDevice,
885 WLAN_CMD_SSID,
886 pMgmt->abyDesireSSID);
887 }
888 }
889 }
890 return 0;
891 }
892 #endif
893
894 DBG_PRT(MSG_LEVEL_DEBUG, KERN_INFO "set essid = %s \n", pItemSSID->abySSID);
895 }
896
897 if (pDevice->flags & DEVICE_FLAGS_OPENED) {
898 pDevice->bCommit = TRUE;
899 }
900
901
902 return 0;
903 }
904
905
906 /*
907 * Wireless Handler : get essid
908 */
909
910 int iwctl_giwessid(struct net_device *dev,
911 struct iw_request_info *info,
912 struct iw_point *wrq,
913 char *extra)
914 {
915
916 PSDevice pDevice = (PSDevice)netdev_priv(dev);
917 PSMgmtObject pMgmt = &(pDevice->sMgmtObj);
918 PWLAN_IE_SSID pItemSSID;
919
920 DBG_PRT(MSG_LEVEL_DEBUG, KERN_INFO " SIOCGIWESSID \n");
921
922 // Note : if wrq->u.data.flags != 0, we should
923 // get the relevant SSID from the SSID list...
924
925 // Get the current SSID
926 pItemSSID = (PWLAN_IE_SSID)pMgmt->abyCurrSSID;
927 //pItemSSID = (PWLAN_IE_SSID)pMgmt->abyDesireSSID;
928 memcpy(extra, pItemSSID->abySSID , pItemSSID->len);
929 extra[pItemSSID->len] = '\0';
930
931 wrq->length = pItemSSID->len;
932 wrq->flags = 1; // active
933
934 return 0;
935 }
936
937 /*
938 * Wireless Handler : set data rate
939 */
940
941 int iwctl_siwrate(struct net_device *dev,
942 struct iw_request_info *info,
943 struct iw_param *wrq,
944 char *extra)
945 {
946 PSDevice pDevice = (PSDevice)netdev_priv(dev);
947 int rc = 0;
948 u8 brate = 0;
949 int i;
950 BYTE abySupportedRates[13]= {0x02, 0x04, 0x0B, 0x16, 0x0c, 0x12, 0x18, 0x24, 0x30, 0x48, 0x60, 0x6C, 0x90};
951
952
953 DBG_PRT(MSG_LEVEL_DEBUG, KERN_INFO " SIOCSIWRATE \n");
954 if (!(pDevice->flags & DEVICE_FLAGS_OPENED)) {
955 rc = -EINVAL;
956 return rc;
957 }
958
959 // First : get a valid bit rate value
960
961 // Which type of value
962 if((wrq->value < 13) &&
963 (wrq->value >= 0)) {
964 // Setting by rate index
965 // Find value in the magic rate table
966 brate = wrq->value;
967 } else {
968 // Setting by frequency value
969 u8 normvalue = (u8) (wrq->value/500000);
970
971 // Check if rate is valid
972 for (i = 0 ; i < 13 ; i++) {
973 if(normvalue == abySupportedRates[i]) {
974 brate = i;
975 break;
976 }
977 }
978 }
979 // -1 designed the max rate (mostly auto mode)
980 if(wrq->value == -1) {
981 // Get the highest available rate
982 for (i = 0 ; i < 13 ; i++) {
983 if(abySupportedRates[i] == 0)
984 break;
985 }
986 if(i != 0)
987 brate = i - 1;
988
989 }
990 // Check that it is valid
991 // brate is index of abySupportedRates[]
992 if(brate > 13 ) {
993 rc = -EINVAL;
994 return rc;
995 }
996
997 // Now, check if we want a fixed or auto value
998 if(wrq->fixed != 0) {
999 // Fixed mode
1000 // One rate, fixed
1001 pDevice->bFixRate = TRUE;
1002 if ((pDevice->byBBType == BB_TYPE_11B)&& (brate > 3)) {
1003 pDevice->uConnectionRate = 3;
1004 }
1005 else {
1006 pDevice->uConnectionRate = brate;
1007 DBG_PRT(MSG_LEVEL_DEBUG, KERN_INFO "Fixed to Rate %d \n", pDevice->uConnectionRate);
1008 }
1009
1010 }
1011 else {
1012 pDevice->bFixRate = FALSE;
1013 pDevice->uConnectionRate = 13;
1014 }
1015
1016 return rc;
1017 }
1018
1019 /*
1020 * Wireless Handler : get data rate
1021 */
1022
1023 int iwctl_giwrate(struct net_device *dev,
1024 struct iw_request_info *info,
1025 struct iw_param *wrq,
1026 char *extra)
1027 {
1028 PSDevice pDevice = (PSDevice)netdev_priv(dev);
1029 PSMgmtObject pMgmt = &(pDevice->sMgmtObj);
1030
1031 DBG_PRT(MSG_LEVEL_DEBUG, KERN_INFO " SIOCGIWRATE \n");
1032 {
1033 BYTE abySupportedRates[13]= {0x02, 0x04, 0x0B, 0x16, 0x0c, 0x12, 0x18, 0x24, 0x30, 0x48, 0x60, 0x6C, 0x90};
1034 int brate = 0;
1035 if (pDevice->uConnectionRate < 13) {
1036 brate = abySupportedRates[pDevice->uConnectionRate];
1037 }else {
1038 if (pDevice->byBBType == BB_TYPE_11B)
1039 brate = 0x16;
1040 if (pDevice->byBBType == BB_TYPE_11G)
1041 brate = 0x6C;
1042 if (pDevice->byBBType == BB_TYPE_11A)
1043 brate = 0x6C;
1044 }
1045
1046 if (pMgmt->eCurrMode == WMAC_MODE_ESS_AP) {
1047 if (pDevice->byBBType == BB_TYPE_11B)
1048 brate = 0x16;
1049 if (pDevice->byBBType == BB_TYPE_11G)
1050 brate = 0x6C;
1051 if (pDevice->byBBType == BB_TYPE_11A)
1052 brate = 0x6C;
1053 }
1054 if (pDevice->uConnectionRate == 13)
1055 brate = abySupportedRates[pDevice->wCurrentRate];
1056 wrq->value = brate * 500000;
1057 // If more than one rate, set auto
1058 if (pDevice->bFixRate == TRUE)
1059 wrq->fixed = TRUE;
1060 }
1061
1062
1063 return 0;
1064 }
1065
1066
1067
1068 /*
1069 * Wireless Handler : set rts threshold
1070 */
1071
1072 int iwctl_siwrts(struct net_device *dev,
1073 struct iw_request_info *info,
1074 struct iw_param *wrq,
1075 char *extra)
1076 {
1077 PSDevice pDevice = (PSDevice)netdev_priv(dev);
1078 int rc = 0;
1079
1080 DBG_PRT(MSG_LEVEL_DEBUG, KERN_INFO " SIOCSIWRTS \n");
1081
1082 {
1083 int rthr = wrq->value;
1084 if(wrq->disabled)
1085 rthr = 2312;
1086 if((rthr < 0) || (rthr > 2312)) {
1087 rc = -EINVAL;
1088 }else {
1089 pDevice->wRTSThreshold = rthr;
1090 }
1091 }
1092
1093 return 0;
1094 }
1095
1096 /*
1097 * Wireless Handler : get rts
1098 */
1099
1100 int iwctl_giwrts(struct net_device *dev,
1101 struct iw_request_info *info,
1102 struct iw_param *wrq,
1103 char *extra)
1104 {
1105 PSDevice pDevice = (PSDevice)netdev_priv(dev);
1106
1107 DBG_PRT(MSG_LEVEL_DEBUG, KERN_INFO " SIOCGIWRTS \n");
1108 wrq->value = pDevice->wRTSThreshold;
1109 wrq->disabled = (wrq->value >= 2312);
1110 wrq->fixed = 1;
1111
1112 return 0;
1113 }
1114
1115 /*
1116 * Wireless Handler : set fragment threshold
1117 */
1118
1119 int iwctl_siwfrag(struct net_device *dev,
1120 struct iw_request_info *info,
1121 struct iw_param *wrq,
1122 char *extra)
1123 {
1124 PSDevice pDevice = (PSDevice)netdev_priv(dev);
1125 int rc = 0;
1126 int fthr = wrq->value;
1127
1128
1129 DBG_PRT(MSG_LEVEL_DEBUG, KERN_INFO " SIOCSIWFRAG \n");
1130
1131
1132 if (wrq->disabled)
1133 fthr = 2312;
1134 if((fthr < 256) || (fthr > 2312)) {
1135 rc = -EINVAL;
1136 }else {
1137 fthr &= ~0x1; // Get an even value
1138 pDevice->wFragmentationThreshold = (u16)fthr;
1139 }
1140
1141 return rc;
1142 }
1143
1144 /*
1145 * Wireless Handler : get fragment threshold
1146 */
1147
1148 int iwctl_giwfrag(struct net_device *dev,
1149 struct iw_request_info *info,
1150 struct iw_param *wrq,
1151 char *extra)
1152 {
1153 PSDevice pDevice = (PSDevice)netdev_priv(dev);
1154
1155 DBG_PRT(MSG_LEVEL_DEBUG, KERN_INFO " SIOCGIWFRAG \n");
1156 wrq->value = pDevice->wFragmentationThreshold;
1157 wrq->disabled = (wrq->value >= 2312);
1158 wrq->fixed = 1;
1159
1160 return 0;
1161 }
1162
1163
1164
1165 /*
1166 * Wireless Handler : set retry threshold
1167 */
1168 int iwctl_siwretry(struct net_device *dev,
1169 struct iw_request_info *info,
1170 struct iw_param *wrq,
1171 char *extra)
1172 {
1173 PSDevice pDevice = (PSDevice)netdev_priv(dev);
1174 int rc = 0;
1175
1176
1177 DBG_PRT(MSG_LEVEL_DEBUG, KERN_INFO " SIOCSIWRETRY \n");
1178
1179 if (wrq->disabled) {
1180 rc = -EINVAL;
1181 return rc;
1182 }
1183
1184 if (wrq->flags & IW_RETRY_LIMIT) {
1185 if(wrq->flags & IW_RETRY_MAX)
1186 pDevice->byLongRetryLimit = wrq->value;
1187 else if (wrq->flags & IW_RETRY_MIN)
1188 pDevice->byShortRetryLimit = wrq->value;
1189 else {
1190 // No modifier : set both
1191 pDevice->byShortRetryLimit = wrq->value;
1192 pDevice->byLongRetryLimit = wrq->value;
1193 }
1194 }
1195 if (wrq->flags & IW_RETRY_LIFETIME) {
1196 pDevice->wMaxTransmitMSDULifetime = wrq->value;
1197 }
1198
1199
1200 return rc;
1201 }
1202
1203 /*
1204 * Wireless Handler : get retry threshold
1205 */
1206 int iwctl_giwretry(struct net_device *dev,
1207 struct iw_request_info *info,
1208 struct iw_param *wrq,
1209 char *extra)
1210 {
1211 PSDevice pDevice = (PSDevice)netdev_priv(dev);
1212 DBG_PRT(MSG_LEVEL_DEBUG, KERN_INFO " SIOCGIWRETRY \n");
1213 wrq->disabled = 0; // Can't be disabled
1214
1215 // Note : by default, display the min retry number
1216 if((wrq->flags & IW_RETRY_TYPE) == IW_RETRY_LIFETIME) {
1217 wrq->flags = IW_RETRY_LIFETIME;
1218 wrq->value = (int)pDevice->wMaxTransmitMSDULifetime; //ms
1219 } else if((wrq->flags & IW_RETRY_MAX)) {
1220 wrq->flags = IW_RETRY_LIMIT | IW_RETRY_MAX;
1221 wrq->value = (int)pDevice->byLongRetryLimit;
1222 } else {
1223 wrq->flags = IW_RETRY_LIMIT;
1224 wrq->value = (int)pDevice->byShortRetryLimit;
1225 if((int)pDevice->byShortRetryLimit != (int)pDevice->byLongRetryLimit)
1226 wrq->flags |= IW_RETRY_MIN;
1227 }
1228
1229
1230 return 0;
1231 }
1232
1233
1234 /*
1235 * Wireless Handler : set encode mode
1236 */
1237 int iwctl_siwencode(struct net_device *dev,
1238 struct iw_request_info *info,
1239 struct iw_point *wrq,
1240 char *extra)
1241 {
1242 PSDevice pDevice = (PSDevice)netdev_priv(dev);
1243 PSMgmtObject pMgmt = &(pDevice->sMgmtObj);
1244 DWORD dwKeyIndex = (DWORD)(wrq->flags & IW_ENCODE_INDEX);
1245 int ii,uu, rc = 0;
1246 int index = (wrq->flags & IW_ENCODE_INDEX);
1247
1248
1249 DBG_PRT(MSG_LEVEL_DEBUG, KERN_INFO " SIOCSIWENCODE \n");
1250
1251 // Check the size of the key
1252 if (wrq->length > WLAN_WEP232_KEYLEN) {
1253 rc = -EINVAL;
1254 return rc;
1255 }
1256
1257 if (dwKeyIndex > WLAN_WEP_NKEYS) {
1258 rc = -EINVAL;
1259 return rc;
1260 }
1261
1262 if (dwKeyIndex > 0)
1263 dwKeyIndex--;
1264
1265 // Send the key to the card
1266 if (wrq->length > 0) {
1267
1268 if (wrq->length == WLAN_WEP232_KEYLEN) {
1269 DBG_PRT(MSG_LEVEL_DEBUG, KERN_INFO "Set 232 bit wep key\n");
1270 }
1271 else if (wrq->length == WLAN_WEP104_KEYLEN) {
1272 DBG_PRT(MSG_LEVEL_DEBUG, KERN_INFO "Set 104 bit wep key\n");
1273 }
1274 else if (wrq->length == WLAN_WEP40_KEYLEN) {
1275 DBG_PRT(MSG_LEVEL_DEBUG, KERN_INFO "Set 40 bit wep key, index= %d\n", (int)dwKeyIndex);
1276 }
1277 memset(pDevice->abyKey, 0, WLAN_WEP232_KEYLEN);
1278 memcpy(pDevice->abyKey, extra, wrq->length);
1279
1280 DBG_PRT(MSG_LEVEL_DEBUG, KERN_INFO"abyKey: ");
1281 for (ii = 0; ii < wrq->length; ii++) {
1282 DBG_PRT(MSG_LEVEL_DEBUG, KERN_INFO "%02x ", pDevice->abyKey[ii]);
1283 }
1284
1285 if (pDevice->flags & DEVICE_FLAGS_OPENED) {
1286 spin_lock_irq(&pDevice->lock);
1287 KeybSetDefaultKey( pDevice,
1288 &(pDevice->sKey),
1289 dwKeyIndex | (1 << 31),
1290 wrq->length,
1291 NULL,
1292 pDevice->abyKey,
1293 KEY_CTL_WEP
1294 );
1295 spin_unlock_irq(&pDevice->lock);
1296 }
1297 pDevice->byKeyIndex = (BYTE)dwKeyIndex;
1298 pDevice->uKeyLength = wrq->length;
1299 pDevice->bTransmitKey = TRUE;
1300 pDevice->bEncryptionEnable = TRUE;
1301 pDevice->eEncryptionStatus = Ndis802_11Encryption1Enabled;
1302
1303 // Do we want to just set the transmit key index ?
1304 if ( index < 4 ) {
1305 pDevice->byKeyIndex = index;
1306 } else if (!(wrq->flags & IW_ENCODE_MODE)) {
1307 rc = -EINVAL;
1308 return rc;
1309 }
1310 }
1311 // Read the flags
1312 if(wrq->flags & IW_ENCODE_DISABLED){
1313
1314 DBG_PRT(MSG_LEVEL_DEBUG, KERN_INFO "Disable WEP function\n");
1315 pMgmt->bShareKeyAlgorithm = FALSE;
1316 pDevice->bEncryptionEnable = FALSE;
1317 pDevice->eEncryptionStatus = Ndis802_11EncryptionDisabled;
1318 if (pDevice->flags & DEVICE_FLAGS_OPENED) {
1319 spin_lock_irq(&pDevice->lock);
1320 for (uu = 0; uu < MAX_KEY_TABLE; uu++)
1321 MACvDisableKeyEntry(pDevice, uu);
1322 spin_unlock_irq(&pDevice->lock);
1323 }
1324 }
1325 if(wrq->flags & IW_ENCODE_RESTRICTED) {
1326 DBG_PRT(MSG_LEVEL_DEBUG, KERN_INFO "Enable WEP & ShareKey System\n");
1327 pMgmt->bShareKeyAlgorithm = TRUE;
1328 }
1329 if(wrq->flags & IW_ENCODE_OPEN) {
1330 DBG_PRT(MSG_LEVEL_DEBUG, KERN_INFO "Enable WEP & Open System\n");
1331 pMgmt->bShareKeyAlgorithm = FALSE;
1332 }
1333
1334 #ifdef WPA_SUPPLICANT_DRIVER_WEXT_SUPPORT
1335 memset(pMgmt->abyDesireBSSID, 0xFF,6);
1336 #endif
1337
1338 return rc;
1339 }
1340
1341 /*
1342 * Wireless Handler : get encode mode
1343 */
1344 //2008-0409-06, <Mark> by Einsn Liu
1345 /*
1346 int iwctl_giwencode(struct net_device *dev,
1347 struct iw_request_info *info,
1348 struct iw_point *wrq,
1349 char *extra)
1350 {
1351 PSDevice pDevice = (PSDevice)netdev_priv(dev);
1352 PSMgmtObject pMgmt = &(pDevice->sMgmtObj);
1353 int rc = 0;
1354 char abyKey[WLAN_WEP232_KEYLEN];
1355 unsigned int index = (unsigned int)(wrq->flags & IW_ENCODE_INDEX);
1356 PSKeyItem pKey = NULL;
1357
1358 DBG_PRT(MSG_LEVEL_DEBUG, KERN_INFO " SIOCGIWENCODE\n");
1359
1360
1361 memset(abyKey, 0, sizeof(abyKey));
1362 // Check encryption mode
1363 wrq->flags = IW_ENCODE_NOKEY;
1364 // Is WEP enabled ???
1365 if (pDevice->bEncryptionEnable)
1366 wrq->flags |= IW_ENCODE_ENABLED;
1367 else
1368 wrq->flags |= IW_ENCODE_DISABLED;
1369
1370 if (pMgmt->bShareKeyAlgorithm)
1371 wrq->flags |= IW_ENCODE_RESTRICTED;
1372 else
1373 wrq->flags |= IW_ENCODE_OPEN;
1374
1375 if (KeybGetKey(&(pDevice->sKey), pDevice->abyBroadcastAddr, (BYTE)index , &pKey)){
1376 wrq->length = pKey->uKeyLength;
1377 memcpy(abyKey, pKey->abyKey, pKey->uKeyLength);
1378 }
1379 else {
1380 rc = -EINVAL;
1381 return rc;
1382 }
1383 wrq->flags |= index;
1384 // Copy the key to the user buffer
1385 memcpy(extra, abyKey, WLAN_WEP232_KEYLEN);
1386 return 0;
1387 }
1388 */
1389
1390 int iwctl_giwencode(struct net_device *dev,
1391 struct iw_request_info *info,
1392 struct iw_point *wrq,
1393 char *extra)
1394 {
1395 PSDevice pDevice = (PSDevice)netdev_priv(dev);
1396 PSMgmtObject pMgmt = &(pDevice->sMgmtObj);
1397 char abyKey[WLAN_WEP232_KEYLEN];
1398
1399 unsigned int index = (unsigned int)(wrq->flags & IW_ENCODE_INDEX);
1400 PSKeyItem pKey = NULL;
1401
1402 DBG_PRT(MSG_LEVEL_DEBUG, KERN_INFO " SIOCGIWENCODE\n");
1403
1404 if (index > WLAN_WEP_NKEYS) {
1405 return -EINVAL;
1406 }
1407 if(index<1){//get default key
1408 if(pDevice->byKeyIndex<WLAN_WEP_NKEYS){
1409 index=pDevice->byKeyIndex;
1410 } else
1411 index=0;
1412 }else
1413 index--;
1414
1415 memset(abyKey, 0, WLAN_WEP232_KEYLEN);
1416 // Check encryption mode
1417 wrq->flags = IW_ENCODE_NOKEY;
1418 // Is WEP enabled ???
1419 if (pDevice->bEncryptionEnable)
1420 wrq->flags |= IW_ENCODE_ENABLED;
1421 else
1422 wrq->flags |= IW_ENCODE_DISABLED;
1423
1424 if (pMgmt->bShareKeyAlgorithm)
1425 wrq->flags |= IW_ENCODE_RESTRICTED;
1426 else
1427 wrq->flags |= IW_ENCODE_OPEN;
1428 wrq->length=0;
1429
1430 if((index==0)&&(pDevice->eEncryptionStatus == Ndis802_11Encryption2Enabled||
1431 pDevice->eEncryptionStatus == Ndis802_11Encryption3Enabled)){//get wpa pairwise key
1432 if (KeybGetKey(&(pDevice->sKey),pMgmt->abyCurrBSSID, 0xffffffff, &pKey)){
1433 wrq->length = pKey->uKeyLength;
1434 memcpy(abyKey, pKey->abyKey, pKey->uKeyLength);
1435 memcpy(extra, abyKey, WLAN_WEP232_KEYLEN);
1436 }
1437 }else if (KeybGetKey(&(pDevice->sKey), pDevice->abyBroadcastAddr, (BYTE)index , &pKey)){
1438 wrq->length = pKey->uKeyLength;
1439 memcpy(abyKey, pKey->abyKey, pKey->uKeyLength);
1440 memcpy(extra, abyKey, WLAN_WEP232_KEYLEN);
1441 }
1442
1443 wrq->flags |= index+1;
1444
1445 return 0;
1446 }
1447
1448
1449 /*
1450 * Wireless Handler : set power mode
1451 */
1452 int iwctl_siwpower(struct net_device *dev,
1453 struct iw_request_info *info,
1454 struct iw_param *wrq,
1455 char *extra)
1456 {
1457 PSDevice pDevice = (PSDevice)netdev_priv(dev);
1458 PSMgmtObject pMgmt = &(pDevice->sMgmtObj);
1459 int rc = 0;
1460
1461 DBG_PRT(MSG_LEVEL_DEBUG, KERN_INFO " SIOCSIWPOWER \n");
1462
1463 if (!(pDevice->flags & DEVICE_FLAGS_OPENED)) {
1464 rc = -EINVAL;
1465 return rc;
1466 }
1467
1468 if (wrq->disabled) {
1469 pDevice->ePSMode = WMAC_POWER_CAM;
1470 PSvDisablePowerSaving(pDevice);
1471 return rc;
1472 }
1473 if ((wrq->flags & IW_POWER_TYPE) == IW_POWER_TIMEOUT) {
1474 pDevice->ePSMode = WMAC_POWER_FAST;
1475 PSvEnablePowerSaving((void *) pDevice, pMgmt->wListenInterval);
1476
1477 } else if ((wrq->flags & IW_POWER_TYPE) == IW_POWER_PERIOD) {
1478 pDevice->ePSMode = WMAC_POWER_FAST;
1479 PSvEnablePowerSaving((void *) pDevice, pMgmt->wListenInterval);
1480 }
1481 switch (wrq->flags & IW_POWER_MODE) {
1482 case IW_POWER_UNICAST_R:
1483 DBG_PRT(MSG_LEVEL_DEBUG, KERN_INFO " SIOCSIWPOWER: IW_POWER_UNICAST_R \n");
1484 rc = -EINVAL;
1485 break;
1486 case IW_POWER_ALL_R:
1487 DBG_PRT(MSG_LEVEL_DEBUG, KERN_INFO " SIOCSIWPOWER: IW_POWER_ALL_R \n");
1488 rc = -EINVAL;
1489 case IW_POWER_ON:
1490 DBG_PRT(MSG_LEVEL_DEBUG, KERN_INFO " SIOCSIWPOWER: IW_POWER_ON \n");
1491 break;
1492 default:
1493 rc = -EINVAL;
1494 }
1495
1496 return rc;
1497 }
1498
1499 /*
1500 * Wireless Handler : get power mode
1501 */
1502 int iwctl_giwpower(struct net_device *dev,
1503 struct iw_request_info *info,
1504 struct iw_param *wrq,
1505 char *extra)
1506 {
1507 PSDevice pDevice = (PSDevice)netdev_priv(dev);
1508 PSMgmtObject pMgmt = &(pDevice->sMgmtObj);
1509 int mode = pDevice->ePSMode;
1510
1511
1512 DBG_PRT(MSG_LEVEL_DEBUG, KERN_INFO " SIOCGIWPOWER \n");
1513
1514
1515 if ((wrq->disabled = (mode == WMAC_POWER_CAM)))
1516 return 0;
1517
1518 if ((wrq->flags & IW_POWER_TYPE) == IW_POWER_TIMEOUT) {
1519 wrq->value = (int)((pMgmt->wListenInterval * pMgmt->wCurrBeaconPeriod) << 10);
1520 wrq->flags = IW_POWER_TIMEOUT;
1521 } else {
1522 wrq->value = (int)((pMgmt->wListenInterval * pMgmt->wCurrBeaconPeriod) << 10);
1523 wrq->flags = IW_POWER_PERIOD;
1524 }
1525 wrq->flags |= IW_POWER_ALL_R;
1526
1527 return 0;
1528 }
1529
1530
1531 /*
1532 * Wireless Handler : get Sensitivity
1533 */
1534 int iwctl_giwsens(struct net_device *dev,
1535 struct iw_request_info *info,
1536 struct iw_param *wrq,
1537 char *extra)
1538 {
1539 PSDevice pDevice = (PSDevice)netdev_priv(dev);
1540 long ldBm;
1541
1542 DBG_PRT(MSG_LEVEL_DEBUG, KERN_INFO " SIOCGIWSENS \n");
1543 if (pDevice->bLinkPass == TRUE) {
1544 RFvRSSITodBm(pDevice, (BYTE)(pDevice->uCurrRSSI), &ldBm);
1545 wrq->value = ldBm;
1546 }
1547 else {
1548 wrq->value = 0;
1549 };
1550 wrq->disabled = (wrq->value == 0);
1551 wrq->fixed = 1;
1552
1553
1554 return 0;
1555 }
1556
1557 #ifdef WPA_SUPPLICANT_DRIVER_WEXT_SUPPORT
1558
1559 int iwctl_siwauth(struct net_device *dev,
1560 struct iw_request_info *info,
1561 struct iw_param *wrq,
1562 char *extra)
1563 {
1564 PSDevice pDevice = (PSDevice)netdev_priv(dev);
1565 PSMgmtObject pMgmt = &(pDevice->sMgmtObj);
1566 int ret=0;
1567 static int wpa_version=0; //must be static to save the last value,einsn liu
1568 static int pairwise=0;
1569
1570 DBG_PRT(MSG_LEVEL_DEBUG, KERN_INFO " SIOCSIWAUTH \n");
1571 switch (wrq->flags & IW_AUTH_INDEX) {
1572 case IW_AUTH_WPA_VERSION:
1573 wpa_version = wrq->value;
1574 if(wrq->value == IW_AUTH_WPA_VERSION_DISABLED) {
1575 PRINT_K("iwctl_siwauth:set WPADEV to disable at 1??????\n");
1576 //pDevice->bWPADEVUp = FALSE;
1577 }
1578 else if(wrq->value == IW_AUTH_WPA_VERSION_WPA) {
1579 PRINT_K("iwctl_siwauth:set WPADEV to WPA1******\n");
1580 }
1581 else {
1582 PRINT_K("iwctl_siwauth:set WPADEV to WPA2******\n");
1583 }
1584 //pDevice->bWPASuppWextEnabled =TRUE;
1585 break;
1586 case IW_AUTH_CIPHER_PAIRWISE:
1587 pairwise = wrq->value;
1588 PRINT_K("iwctl_siwauth:set pairwise=%d\n",pairwise);
1589 if(pairwise == IW_AUTH_CIPHER_CCMP){
1590 pDevice->eEncryptionStatus = Ndis802_11Encryption3Enabled;
1591 }else if(pairwise == IW_AUTH_CIPHER_TKIP){
1592 pDevice->eEncryptionStatus = Ndis802_11Encryption2Enabled;
1593 } else if (pairwise == IW_AUTH_CIPHER_WEP40 ||
1594 pairwise == IW_AUTH_CIPHER_WEP104) {
1595 pDevice->eEncryptionStatus = Ndis802_11Encryption1Enabled;
1596 }else if(pairwise == IW_AUTH_CIPHER_NONE){
1597 //do nothing,einsn liu
1598 }else pDevice->eEncryptionStatus = Ndis802_11EncryptionDisabled;
1599
1600 break;
1601 case IW_AUTH_CIPHER_GROUP:
1602 PRINT_K("iwctl_siwauth:set GROUP=%d\n",wrq->value);
1603 if(wpa_version == IW_AUTH_WPA_VERSION_DISABLED)
1604 break;
1605 if(pairwise == IW_AUTH_CIPHER_NONE){
1606 if(wrq->value == IW_AUTH_CIPHER_CCMP){
1607 pDevice->eEncryptionStatus = Ndis802_11Encryption3Enabled;
1608 }else {
1609 pDevice->eEncryptionStatus = Ndis802_11Encryption2Enabled;
1610 }
1611 }
1612 break;
1613 case IW_AUTH_KEY_MGMT:
1614 PRINT_K("iwctl_siwauth(wpa_version=%d):set KEY_MGMT=%d\n",wpa_version,wrq->value);
1615 if(wpa_version == IW_AUTH_WPA_VERSION_WPA2){
1616 if(wrq->value == IW_AUTH_KEY_MGMT_PSK)
1617 pMgmt->eAuthenMode = WMAC_AUTH_WPA2PSK;
1618 else pMgmt->eAuthenMode = WMAC_AUTH_WPA2;
1619 }else if(wpa_version == IW_AUTH_WPA_VERSION_WPA){
1620 if(wrq->value == 0){
1621 pMgmt->eAuthenMode = WMAC_AUTH_WPANONE;
1622 }else if(wrq->value == IW_AUTH_KEY_MGMT_PSK)
1623 pMgmt->eAuthenMode = WMAC_AUTH_WPAPSK;
1624 else pMgmt->eAuthenMode = WMAC_AUTH_WPA;
1625 }
1626
1627 break;
1628 case IW_AUTH_TKIP_COUNTERMEASURES:
1629 break; /* FIXME */
1630 case IW_AUTH_DROP_UNENCRYPTED:
1631 break;
1632 case IW_AUTH_80211_AUTH_ALG:
1633 PRINT_K("iwctl_siwauth:set AUTH_ALG=%d\n",wrq->value);
1634 if(wrq->value==IW_AUTH_ALG_OPEN_SYSTEM){
1635 pMgmt->bShareKeyAlgorithm=FALSE;
1636 }else if(wrq->value==IW_AUTH_ALG_SHARED_KEY){
1637 pMgmt->bShareKeyAlgorithm=TRUE;
1638 }
1639 break;
1640 case IW_AUTH_WPA_ENABLED:
1641 //pDevice->bWPADEVUp = !! wrq->value;
1642 //if(pDevice->bWPADEVUp==TRUE)
1643 // printk("iwctl_siwauth:set WPADEV to enable successful*******\n");
1644 //else
1645 // printk("iwctl_siwauth:set WPADEV to enable fail?????\n");
1646 break;
1647 case IW_AUTH_RX_UNENCRYPTED_EAPOL:
1648 break;
1649 case IW_AUTH_ROAMING_CONTROL:
1650 ret = -EOPNOTSUPP;
1651 break;
1652 case IW_AUTH_PRIVACY_INVOKED:
1653 pDevice->bEncryptionEnable = !!wrq->value;
1654 if(pDevice->bEncryptionEnable == FALSE){
1655 wpa_version = 0;
1656 pairwise = 0;
1657 pDevice->eEncryptionStatus = Ndis802_11EncryptionDisabled;
1658 pMgmt->bShareKeyAlgorithm = FALSE;
1659 pMgmt->eAuthenMode = WMAC_AUTH_OPEN;
1660 //pDevice->bWPADEVUp = FALSE;
1661 PRINT_K("iwctl_siwauth:set WPADEV to disaable at 2?????\n");
1662 }
1663
1664 break;
1665 default:
1666 ret = -EOPNOTSUPP;
1667 break;
1668 }
1669 /*
1670 DBG_PRT(MSG_LEVEL_DEBUG, KERN_INFO "wpa_version = %d\n",wpa_version);
1671 DBG_PRT(MSG_LEVEL_DEBUG, KERN_INFO "pairwise = %d\n",pairwise);
1672 DBG_PRT(MSG_LEVEL_DEBUG, KERN_INFO "pDevice->eEncryptionStatus = %d\n",pDevice->eEncryptionStatus);
1673 DBG_PRT(MSG_LEVEL_DEBUG, KERN_INFO "pMgmt->eAuthenMode = %d\n",pMgmt->eAuthenMode);
1674 DBG_PRT(MSG_LEVEL_DEBUG, KERN_INFO "pMgmt->bShareKeyAlgorithm = %s\n",pMgmt->bShareKeyAlgorithm?"TRUE":"FALSE");
1675 DBG_PRT(MSG_LEVEL_DEBUG, KERN_INFO "pDevice->bEncryptionEnable = %s\n",pDevice->bEncryptionEnable?"TRUE":"FALSE");
1676 DBG_PRT(MSG_LEVEL_DEBUG, KERN_INFO "pDevice->bWPADEVUp = %s\n",pDevice->bWPADEVUp?"TRUE":"FALSE");
1677 */
1678 return ret;
1679 }
1680
1681
1682 int iwctl_giwauth(struct net_device *dev,
1683 struct iw_request_info *info,
1684 struct iw_param *wrq,
1685 char *extra)
1686 {
1687 return -EOPNOTSUPP;
1688 }
1689
1690
1691
1692 int iwctl_siwgenie(struct net_device *dev,
1693 struct iw_request_info *info,
1694 struct iw_point *wrq,
1695 char *extra)
1696 {
1697 PSDevice pDevice = (PSDevice)netdev_priv(dev);
1698 PSMgmtObject pMgmt = &(pDevice->sMgmtObj);
1699 int ret=0;
1700
1701 if(wrq->length){
1702 if ((wrq->length < 2) || (extra[1]+2 != wrq->length)) {
1703 ret = -EINVAL;
1704 goto out;
1705 }
1706 if(wrq->length > MAX_WPA_IE_LEN){
1707 ret = -ENOMEM;
1708 goto out;
1709 }
1710 memset(pMgmt->abyWPAIE, 0, MAX_WPA_IE_LEN);
1711 if(copy_from_user(pMgmt->abyWPAIE, extra, wrq->length)){
1712 ret = -EFAULT;
1713 goto out;
1714 }
1715 pMgmt->wWPAIELen = wrq->length;
1716 }else {
1717 memset(pMgmt->abyWPAIE, 0, MAX_WPA_IE_LEN);
1718 pMgmt->wWPAIELen = 0;
1719 }
1720
1721 out://not completely ...not necessary in wpa_supplicant 0.5.8
1722 return ret;
1723 }
1724
1725 int iwctl_giwgenie(struct net_device *dev,
1726 struct iw_request_info *info,
1727 struct iw_point *wrq,
1728 char *extra)
1729 {
1730 PSDevice pDevice = (PSDevice)netdev_priv(dev);
1731 PSMgmtObject pMgmt = &(pDevice->sMgmtObj);
1732 int ret=0;
1733 int space = wrq->length;
1734
1735 wrq->length = 0;
1736 if(pMgmt->wWPAIELen > 0){
1737 wrq->length = pMgmt->wWPAIELen;
1738 if(pMgmt->wWPAIELen <= space){
1739 if(copy_to_user(extra, pMgmt->abyWPAIE, pMgmt->wWPAIELen)){
1740 ret = -EFAULT;
1741 }
1742 }else
1743 ret = -E2BIG;
1744 }
1745
1746 return ret;
1747 }
1748
1749
1750 int iwctl_siwencodeext(struct net_device *dev,
1751 struct iw_request_info *info,
1752 struct iw_point *wrq,
1753 char *extra)
1754 {
1755 PSDevice pDevice = (PSDevice)netdev_priv(dev);
1756 PSMgmtObject pMgmt = &(pDevice->sMgmtObj);
1757 struct iw_encode_ext *ext = (struct iw_encode_ext*)extra;
1758 struct viawget_wpa_param *param=NULL;
1759 //original member
1760 wpa_alg alg_name;
1761 u8 addr[6];
1762 int key_idx, set_tx=0;
1763 u8 seq[IW_ENCODE_SEQ_MAX_SIZE];
1764 u8 key[64];
1765 size_t seq_len=0,key_len=0;
1766 //
1767 // int ii;
1768 u8 *buf;
1769 size_t blen;
1770 u8 key_array[64];
1771 int ret=0;
1772
1773 PRINT_K("SIOCSIWENCODEEXT...... \n");
1774
1775 blen = sizeof(*param);
1776 buf = kmalloc((int)blen, (int)GFP_KERNEL);
1777 if (buf == NULL)
1778 return -ENOMEM;
1779 memset(buf, 0, blen);
1780 param = (struct viawget_wpa_param *) buf;
1781
1782 //recover alg_name
1783 switch (ext->alg) {
1784 case IW_ENCODE_ALG_NONE:
1785 alg_name = WPA_ALG_NONE;
1786 break;
1787 case IW_ENCODE_ALG_WEP:
1788 alg_name = WPA_ALG_WEP;
1789 break;
1790 case IW_ENCODE_ALG_TKIP:
1791 alg_name = WPA_ALG_TKIP;
1792 break;
1793 case IW_ENCODE_ALG_CCMP:
1794 alg_name = WPA_ALG_CCMP;
1795 break;
1796 default:
1797 PRINT_K("Unknown alg = %d\n",ext->alg);
1798 ret= -ENOMEM;
1799 goto error;
1800 }
1801 //recover addr
1802 memcpy(addr, ext->addr.sa_data, ETH_ALEN);
1803 //recover key_idx
1804 key_idx = (wrq->flags&IW_ENCODE_INDEX) - 1;
1805 //recover set_tx
1806 if(ext->ext_flags & IW_ENCODE_EXT_SET_TX_KEY)
1807 set_tx = 1;
1808 //recover seq,seq_len
1809 if(ext->ext_flags & IW_ENCODE_EXT_RX_SEQ_VALID) {
1810 seq_len=IW_ENCODE_SEQ_MAX_SIZE;
1811 memcpy(seq, ext->rx_seq, seq_len);
1812 }
1813 //recover key,key_len
1814 if(ext->key_len) {
1815 key_len=ext->key_len;
1816 memcpy(key, &ext->key[0], key_len);
1817 }
1818
1819 memset(key_array, 0, 64);
1820 if ( key_len > 0) {
1821 memcpy(key_array, key, key_len);
1822 if (key_len == 32) {
1823 // notice ! the oder
1824 memcpy(&key_array[16], &key[24], 8);
1825 memcpy(&key_array[24], &key[16], 8);
1826 }
1827 }
1828
1829 /**************Translate iw_encode_ext to viawget_wpa_param****************/
1830 memcpy(param->addr, addr, ETH_ALEN);
1831 param->u.wpa_key.alg_name = (int)alg_name;
1832 param->u.wpa_key.set_tx = set_tx;
1833 param->u.wpa_key.key_index = key_idx;
1834 param->u.wpa_key.key_len = key_len;
1835 param->u.wpa_key.key = (u8 *)key_array;
1836 param->u.wpa_key.seq = (u8 *)seq;
1837 param->u.wpa_key.seq_len = seq_len;
1838
1839 //****set if current action is Network Manager count??
1840 //****this method is so foolish,but there is no other way???
1841 if(param->u.wpa_key.alg_name == WPA_ALG_NONE) {
1842 if(param->u.wpa_key.key_index ==0) {
1843 pDevice->bwextstep0 = TRUE;
1844 }
1845 if((pDevice->bwextstep0 = TRUE)&&(param->u.wpa_key.key_index ==1)) {
1846 pDevice->bwextstep0 = FALSE;
1847 pDevice->bwextstep1 = TRUE;
1848 }
1849 if((pDevice->bwextstep1 = TRUE)&&(param->u.wpa_key.key_index ==2)) {
1850 pDevice->bwextstep1 = FALSE;
1851 pDevice->bwextstep2 = TRUE;
1852 }
1853 if((pDevice->bwextstep2 = TRUE)&&(param->u.wpa_key.key_index ==3)) {
1854 pDevice->bwextstep2 = FALSE;
1855 pDevice->bwextstep3 = TRUE;
1856 }
1857 }
1858 if(pDevice->bwextstep3 == TRUE) {
1859 PRINT_K("SIOCSIWENCODEEXT:Enable WPA WEXT SUPPORT!!!!!\n");
1860 pDevice->bwextstep0 = FALSE;
1861 pDevice->bwextstep1 = FALSE;
1862 pDevice->bwextstep2 = FALSE;
1863 pDevice->bwextstep3 = FALSE;
1864 pDevice->bWPASuppWextEnabled = TRUE;
1865 memset(pMgmt->abyDesireBSSID, 0xFF,6);
1866 KeyvInitTable(pDevice,&pDevice->sKey);
1867 }
1868 //******
1869
1870 spin_lock_irq(&pDevice->lock);
1871 ret = wpa_set_keys(pDevice, param, TRUE);
1872 spin_unlock_irq(&pDevice->lock);
1873
1874 error:
1875 kfree(param);
1876 return ret;
1877 }
1878
1879
1880
1881 int iwctl_giwencodeext(struct net_device *dev,
1882 struct iw_request_info *info,
1883 struct iw_point *wrq,
1884 char *extra)
1885 {
1886 return -EOPNOTSUPP;
1887 }
1888
1889 int iwctl_siwmlme(struct net_device *dev,
1890 struct iw_request_info * info,
1891 struct iw_point *wrq,
1892 char *extra)
1893 {
1894 PSDevice pDevice = (PSDevice)netdev_priv(dev);
1895 PSMgmtObject pMgmt = &(pDevice->sMgmtObj);
1896 struct iw_mlme *mlme = (struct iw_mlme *)extra;
1897 //u16 reason = cpu_to_le16(mlme->reason_code);
1898 int ret = 0;
1899
1900 if(memcmp(pMgmt->abyCurrBSSID, mlme->addr.sa_data, ETH_ALEN)){
1901 ret = -EINVAL;
1902 return ret;
1903 }
1904 switch(mlme->cmd){
1905 case IW_MLME_DEAUTH:
1906 //this command seems to be not complete,please test it --einsnliu
1907 //printk("iwctl_siwmlme--->send DEAUTH\n");
1908 /* bScheduleCommand((void *) pDevice,
1909 WLAN_CMD_DEAUTH,
1910 (PBYTE)&reason); */
1911 //break;
1912 case IW_MLME_DISASSOC:
1913 if(pDevice->bLinkPass == TRUE){
1914 PRINT_K("iwctl_siwmlme--->send DISASSOCIATE\n");
1915 bScheduleCommand((void *) pDevice,
1916 WLAN_CMD_DISASSOCIATE,
1917 NULL);
1918 }
1919 break;
1920 default:
1921 ret = -EOPNOTSUPP;
1922 }
1923
1924 return ret;
1925
1926 }
1927
1928 #endif
1929
1930 /*------------------------------------------------------------------*/
1931 /*
1932 * Structures to export the Wireless Handlers
1933 */
1934
1935
1936 /*
1937 static const iw_handler iwctl_handler[] =
1938 {
1939 (iw_handler) iwctl_commit, // SIOCSIWCOMMIT
1940 (iw_handler) iwctl_giwname, // SIOCGIWNAME
1941 (iw_handler) NULL, // SIOCSIWNWID
1942 (iw_handler) NULL, // SIOCGIWNWID
1943 (iw_handler) iwctl_siwfreq, // SIOCSIWFREQ
1944 (iw_handler) iwctl_giwfreq, // SIOCGIWFREQ
1945 (iw_handler) iwctl_siwmode, // SIOCSIWMODE
1946 (iw_handler) iwctl_giwmode, // SIOCGIWMODE
1947 (iw_handler) NULL, // SIOCSIWSENS
1948 (iw_handler) iwctl_giwsens, // SIOCGIWSENS
1949 (iw_handler) NULL, // SIOCSIWRANGE
1950 (iw_handler) iwctl_giwrange, // SIOCGIWRANGE
1951 (iw_handler) NULL, // SIOCSIWPRIV
1952 (iw_handler) NULL, // SIOCGIWPRIV
1953 (iw_handler) NULL, // SIOCSIWSTATS
1954 (iw_handler) NULL, // SIOCGIWSTATS
1955 (iw_handler) NULL, // SIOCSIWSPY
1956 (iw_handler) NULL, // SIOCGIWSPY
1957 (iw_handler) NULL, // -- hole --
1958 (iw_handler) NULL, // -- hole --
1959 (iw_handler) iwctl_siwap, // SIOCSIWAP
1960 (iw_handler) iwctl_giwap, // SIOCGIWAP
1961 (iw_handler) NULL, // -- hole -- 0x16
1962 (iw_handler) iwctl_giwaplist, // SIOCGIWAPLIST
1963 (iw_handler) iwctl_siwscan, // SIOCSIWSCAN
1964 (iw_handler) iwctl_giwscan, // SIOCGIWSCAN
1965 (iw_handler) iwctl_siwessid, // SIOCSIWESSID
1966 (iw_handler) iwctl_giwessid, // SIOCGIWESSID
1967 (iw_handler) NULL, // SIOCSIWNICKN
1968 (iw_handler) NULL, // SIOCGIWNICKN
1969 (iw_handler) NULL, // -- hole --
1970 (iw_handler) NULL, // -- hole --
1971 (iw_handler) iwctl_siwrate, // SIOCSIWRATE 0x20
1972 (iw_handler) iwctl_giwrate, // SIOCGIWRATE
1973 (iw_handler) iwctl_siwrts, // SIOCSIWRTS
1974 (iw_handler) iwctl_giwrts, // SIOCGIWRTS
1975 (iw_handler) iwctl_siwfrag, // SIOCSIWFRAG
1976 (iw_handler) iwctl_giwfrag, // SIOCGIWFRAG
1977 (iw_handler) NULL, // SIOCSIWTXPOW
1978 (iw_handler) NULL, // SIOCGIWTXPOW
1979 (iw_handler) iwctl_siwretry, // SIOCSIWRETRY
1980 (iw_handler) iwctl_giwretry, // SIOCGIWRETRY
1981 (iw_handler) iwctl_siwencode, // SIOCSIWENCODE
1982 (iw_handler) iwctl_giwencode, // SIOCGIWENCODE
1983 (iw_handler) iwctl_siwpower, // SIOCSIWPOWER
1984 (iw_handler) iwctl_giwpower, // SIOCGIWPOWER
1985 (iw_handler) NULL, // -- hole --
1986 (iw_handler) NULL, // -- hole --
1987 (iw_handler) iwctl_siwgenie, // SIOCSIWGENIE
1988 (iw_handler) iwctl_giwgenie, // SIOCGIWGENIE
1989 (iw_handler) iwctl_siwauth, // SIOCSIWAUTH
1990 (iw_handler) iwctl_giwauth, // SIOCGIWAUTH
1991 (iw_handler) iwctl_siwencodeext, // SIOCSIWENCODEEXT
1992 (iw_handler) iwctl_giwencodeext, // SIOCGIWENCODEEXT
1993 (iw_handler) NULL, // SIOCSIWPMKSA
1994 (iw_handler) NULL, // -- hole --
1995
1996 };
1997 */
1998
1999 static const iw_handler iwctl_handler[] =
2000 {
2001 (iw_handler) iwctl_commit, // SIOCSIWCOMMIT
2002 (iw_handler) NULL, // SIOCGIWNAME
2003 (iw_handler) NULL, // SIOCSIWNWID
2004 (iw_handler) NULL, // SIOCGIWNWID
2005 (iw_handler) NULL, // SIOCSIWFREQ
2006 (iw_handler) NULL, // SIOCGIWFREQ
2007 (iw_handler) NULL, // SIOCSIWMODE
2008 (iw_handler) NULL, // SIOCGIWMODE
2009 (iw_handler) NULL, // SIOCSIWSENS
2010 (iw_handler) NULL, // SIOCGIWSENS
2011 (iw_handler) NULL, // SIOCSIWRANGE
2012 (iw_handler) iwctl_giwrange, // SIOCGIWRANGE
2013 (iw_handler) NULL, // SIOCSIWPRIV
2014 (iw_handler) NULL, // SIOCGIWPRIV
2015 (iw_handler) NULL, // SIOCSIWSTATS
2016 (iw_handler) NULL, // SIOCGIWSTATS
2017 (iw_handler) NULL, // SIOCSIWSPY
2018 (iw_handler) NULL, // SIOCGIWSPY
2019 (iw_handler) NULL, // -- hole --
2020 (iw_handler) NULL, // -- hole --
2021 (iw_handler) NULL, // SIOCSIWAP
2022 (iw_handler) NULL, // SIOCGIWAP
2023 (iw_handler) NULL, // -- hole -- 0x16
2024 (iw_handler) NULL, // SIOCGIWAPLIST
2025 (iw_handler) iwctl_siwscan, // SIOCSIWSCAN
2026 (iw_handler) iwctl_giwscan, // SIOCGIWSCAN
2027 (iw_handler) NULL, // SIOCSIWESSID
2028 (iw_handler) NULL, // SIOCGIWESSID
2029 (iw_handler) NULL, // SIOCSIWNICKN
2030 (iw_handler) NULL, // SIOCGIWNICKN
2031 (iw_handler) NULL, // -- hole --
2032 (iw_handler) NULL, // -- hole --
2033 (iw_handler) NULL, // SIOCSIWRATE 0x20
2034 (iw_handler) NULL, // SIOCGIWRATE
2035 (iw_handler) NULL, // SIOCSIWRTS
2036 (iw_handler) NULL, // SIOCGIWRTS
2037 (iw_handler) NULL, // SIOCSIWFRAG
2038 (iw_handler) NULL, // SIOCGIWFRAG
2039 (iw_handler) NULL, // SIOCSIWTXPOW
2040 (iw_handler) NULL, // SIOCGIWTXPOW
2041 (iw_handler) NULL, // SIOCSIWRETRY
2042 (iw_handler) NULL, // SIOCGIWRETRY
2043 (iw_handler) NULL, // SIOCSIWENCODE
2044 (iw_handler) NULL, // SIOCGIWENCODE
2045 (iw_handler) NULL, // SIOCSIWPOWER
2046 (iw_handler) NULL, // SIOCGIWPOWER
2047 (iw_handler) NULL, // -- hole --
2048 (iw_handler) NULL, // -- hole --
2049 (iw_handler) NULL, // SIOCSIWGENIE
2050 (iw_handler) NULL, // SIOCGIWGENIE
2051 (iw_handler) NULL, // SIOCSIWAUTH
2052 (iw_handler) NULL, // SIOCGIWAUTH
2053 (iw_handler) NULL, // SIOCSIWENCODEEXT
2054 (iw_handler) NULL, // SIOCGIWENCODEEXT
2055 (iw_handler) NULL, // SIOCSIWPMKSA
2056 (iw_handler) NULL, // -- hole --
2057 };
2058
2059
2060 static const iw_handler iwctl_private_handler[] =
2061 {
2062 NULL, // SIOCIWFIRSTPRIV
2063 };
2064
2065
2066 struct iw_priv_args iwctl_private_args[] = {
2067 { IOCTL_CMD_SET,
2068 IW_PRIV_TYPE_CHAR | 1024, 0,
2069 "set"},
2070 };
2071
2072
2073
2074 const struct iw_handler_def iwctl_handler_def =
2075 {
2076 .get_wireless_stats = &iwctl_get_wireless_stats,
2077 .num_standard = sizeof(iwctl_handler)/sizeof(iw_handler),
2078 // .num_private = sizeof(iwctl_private_handler)/sizeof(iw_handler),
2079 // .num_private_args = sizeof(iwctl_private_args)/sizeof(struct iw_priv_args),
2080 .num_private = 0,
2081 .num_private_args = 0,
2082 .standard = (iw_handler *) iwctl_handler,
2083 // .private = (iw_handler *) iwctl_private_handler,
2084 // .private_args = (struct iw_priv_args *)iwctl_private_args,
2085 .private = NULL,
2086 .private_args = NULL,
2087 };
linux-next