?  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 / ioctl.c
blobcfe9c95d78074a076d80c1560751a1575fd65512
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: ioctl.c
20 *
21 * Purpose: private ioctl functions
22 *
23 * Author: Lyndon Chen
24 *
25 * Date: Auguest 20, 2003
26 *
27 * Functions:
28 *
29 * Revision History:
30 *
31 */
32
33 #include "ioctl.h"
34 #include "iocmd.h"
35 #include "mac.h"
36 #include "card.h"
37 #include "hostap.h"
38 #include "wpactl.h"
39 #include "control.h"
40 #include "rndis.h"
41 #include "rf.h"
42
43 /*--------------------- Static Definitions -------------------------*/
44
45 /*--------------------- Static Classes ----------------------------*/
46
47 /*--------------------- Static Variables --------------------------*/
48 //static int msglevel =MSG_LEVEL_DEBUG;
49 static int msglevel =MSG_LEVEL_INFO;
50
51 SWPAResult wpa_Result;
52
53 /*--------------------- Static Functions --------------------------*/
54
55 /*--------------------- Export Variables --------------------------*/
56
57 int private_ioctl(PSDevice pDevice, struct ifreq *rq) {
58
59 PSCmdRequest pReq = (PSCmdRequest)rq;
60 PSMgmtObject pMgmt = &(pDevice->sMgmtObj);
61 int result = 0;
62 PWLAN_IE_SSID pItemSSID;
63 SCmdBSSJoin sJoinCmd;
64 SCmdZoneTypeSet sZoneTypeCmd;
65 SCmdScan sScanCmd;
66 SCmdStartAP sStartAPCmd;
67 SCmdSetWEP sWEPCmd;
68 SCmdValue sValue;
69 SBSSIDList sList;
70 SNodeList sNodeList;
71 PSBSSIDList pList;
72 PSNodeList pNodeList;
73 unsigned int cbListCount;
74 PKnownBSS pBSS;
75 PKnownNodeDB pNode;
76 unsigned int ii, jj;
77 SCmdLinkStatus sLinkStatus;
78 BYTE abySuppRates[] = {WLAN_EID_SUPP_RATES, 4, 0x02, 0x04, 0x0B, 0x16};
79 BYTE abyNullAddr[] = {0x00, 0x00, 0x00, 0x00, 0x00, 0x00};
80 DWORD dwKeyIndex= 0;
81 BYTE abyScanSSID[WLAN_IEHDR_LEN + WLAN_SSID_MAXLEN + 1];
82 signed long ldBm;
83
84 pReq->wResult = 0;
85
86 switch(pReq->wCmdCode) {
87
88 case WLAN_CMD_BSS_SCAN:
89
90 if (copy_from_user(&sScanCmd, pReq->data, sizeof(SCmdScan))) {
91 result = -EFAULT;
92 break;
93 }
94
95 pItemSSID = (PWLAN_IE_SSID)sScanCmd.ssid;
96 if (pItemSSID->len != 0) {
97 memset(abyScanSSID, 0, WLAN_IEHDR_LEN + WLAN_SSID_MAXLEN + 1);
98 memcpy(abyScanSSID, pItemSSID, pItemSSID->len + WLAN_IEHDR_LEN);
99 }
100 spin_lock_irq(&pDevice->lock);
101
102 if (memcmp(pMgmt->abyCurrBSSID, &abyNullAddr[0], 6) == 0)
103 BSSvClearBSSList((void *) pDevice, FALSE);
104 else
105 BSSvClearBSSList((void *) pDevice, pDevice->bLinkPass);
106
107 DBG_PRT(MSG_LEVEL_DEBUG, KERN_INFO "WLAN_CMD_BSS_SCAN..begin\n");
108
109 if (pItemSSID->len != 0)
110 bScheduleCommand((void *) pDevice,
111 WLAN_CMD_BSSID_SCAN,
112 abyScanSSID);
113 else
114 bScheduleCommand((void *) pDevice, WLAN_CMD_BSSID_SCAN, NULL);
115
116 spin_unlock_irq(&pDevice->lock);
117 break;
118
119 case WLAN_CMD_ZONETYPE_SET:
120 //mike add :cann't support.
121 result=-EOPNOTSUPP;
122 break;
123
124 if (copy_from_user(&sZoneTypeCmd, pReq->data, sizeof(SCmdZoneTypeSet))) {
125 result = -EFAULT;
126 break;
127 }
128
129 if(sZoneTypeCmd.bWrite==TRUE) {
130 //////write zonetype
131 if(sZoneTypeCmd.ZoneType == ZoneType_USA) {
132 //set to USA
133 printk("set_ZoneType:USA\n");
134 }
135 else if(sZoneTypeCmd.ZoneType == ZoneType_Japan) {
136 //set to Japan
137 printk("set_ZoneType:Japan\n");
138 }
139 else if(sZoneTypeCmd.ZoneType == ZoneType_Europe) {
140 //set to Europe
141 printk("set_ZoneType:Europe\n");
142 }
143 }
144 else {
145 ///////read zonetype
146 BYTE zonetype=0;
147
148
149 if(zonetype == 0x00) { //USA
150 sZoneTypeCmd.ZoneType = ZoneType_USA;
151 }
152 else if(zonetype == 0x01) { //Japan
153 sZoneTypeCmd.ZoneType = ZoneType_Japan;
154 }
155 else if(zonetype == 0x02) { //Europe
156 sZoneTypeCmd.ZoneType = ZoneType_Europe;
157 }
158 else { //Unknown ZoneType
159 printk("Error:ZoneType[%x] Unknown ???\n",zonetype);
160 result = -EFAULT;
161 break;
162 }
163 if (copy_to_user(pReq->data, &sZoneTypeCmd, sizeof(SCmdZoneTypeSet))) {
164 result = -EFAULT;
165 break;
166 }
167 }
168
169 break;
170
171 case WLAN_CMD_BSS_JOIN:
172
173 if (copy_from_user(&sJoinCmd, pReq->data, sizeof(SCmdBSSJoin))) {
174 result = -EFAULT;
175 break;
176 }
177
178 pItemSSID = (PWLAN_IE_SSID)sJoinCmd.ssid;
179 memset(pMgmt->abyDesireSSID, 0, WLAN_IEHDR_LEN + WLAN_SSID_MAXLEN + 1);
180 memcpy(pMgmt->abyDesireSSID, pItemSSID, pItemSSID->len + WLAN_IEHDR_LEN);
181 if (sJoinCmd.wBSSType == ADHOC) {
182 pMgmt->eConfigMode = WMAC_CONFIG_IBSS_STA;
183 DBG_PRT(MSG_LEVEL_DEBUG, KERN_INFO "ioct set to adhoc mode\n");
184 }
185 else {
186 pMgmt->eConfigMode = WMAC_CONFIG_ESS_STA;
187 DBG_PRT(MSG_LEVEL_DEBUG, KERN_INFO "ioct set to STA mode\n");
188 }
189 if (sJoinCmd.bPSEnable == TRUE) {
190 pDevice->ePSMode = WMAC_POWER_FAST;
191 // pDevice->ePSMode = WMAC_POWER_MAX;
192 pMgmt->wListenInterval = 2;
193 DBG_PRT(MSG_LEVEL_DEBUG, KERN_INFO "Power Saving On\n");
194 }
195 else {
196 pDevice->ePSMode = WMAC_POWER_CAM;
197 pMgmt->wListenInterval = 1;
198 DBG_PRT(MSG_LEVEL_DEBUG, KERN_INFO "Power Saving Off \n");
199 }
200
201 if (sJoinCmd.bShareKeyAuth == TRUE){
202 pMgmt->bShareKeyAlgorithm = TRUE;
203 DBG_PRT(MSG_LEVEL_DEBUG, KERN_INFO "Share Key \n");
204 }
205 else {
206 pMgmt->bShareKeyAlgorithm = FALSE;
207 DBG_PRT(MSG_LEVEL_DEBUG, KERN_INFO "Open System \n");
208 }
209 pDevice->uChannel = sJoinCmd.uChannel;
210 netif_stop_queue(pDevice->dev);
211 spin_lock_irq(&pDevice->lock);
212 pMgmt->eCurrState = WMAC_STATE_IDLE;
213 bScheduleCommand((void *) pDevice,
214 WLAN_CMD_BSSID_SCAN,
215 pMgmt->abyDesireSSID);
216 bScheduleCommand((void *) pDevice, WLAN_CMD_SSID, NULL);
217 spin_unlock_irq(&pDevice->lock);
218 break;
219
220 case WLAN_CMD_SET_WEP:
221 DBG_PRT(MSG_LEVEL_DEBUG, KERN_INFO "WLAN_CMD_SET_WEP Key. \n");
222 memset(&sWEPCmd, 0 ,sizeof(SCmdSetWEP));
223 if (copy_from_user(&sWEPCmd, pReq->data, sizeof(SCmdSetWEP))) {
224 result = -EFAULT;
225 break;
226 }
227 if (sWEPCmd.bEnableWep != TRUE) {
228 int uu;
229
230 pDevice->bEncryptionEnable = FALSE;
231 pDevice->eEncryptionStatus = Ndis802_11EncryptionDisabled;
232 spin_lock_irq(&pDevice->lock);
233 for (uu = 0; uu < MAX_KEY_TABLE; uu++)
234 MACvDisableKeyEntry(pDevice, uu);
235 spin_unlock_irq(&pDevice->lock);
236 DBG_PRT(MSG_LEVEL_DEBUG, KERN_INFO "WEP function disable.\n");
237 break;
238 }
239
240 for (ii = 0; ii < WLAN_WEP_NKEYS; ii ++) {
241 if (sWEPCmd.bWepKeyAvailable[ii]) {
242 if (ii == sWEPCmd.byKeyIndex)
243 //2006-1207-01<Modify>by Einsn Liu
244 // dwKeyIndex|= (1 << 31);
245 dwKeyIndex=ii|(1 << 31);
246 else
247 dwKeyIndex = ii;
248 spin_lock_irq(&pDevice->lock);
249 KeybSetDefaultKey( pDevice,
250 &(pDevice->sKey),
251 dwKeyIndex,
252 sWEPCmd.auWepKeyLength[ii],
253 NULL,
254 (PBYTE)&sWEPCmd.abyWepKey[ii][0],
255 KEY_CTL_WEP
256 );
257 spin_unlock_irq(&pDevice->lock);
258
259 }
260 }
261 pDevice->byKeyIndex = sWEPCmd.byKeyIndex;
262 pDevice->bTransmitKey = TRUE;
263 pDevice->bEncryptionEnable = TRUE;
264 pDevice->eEncryptionStatus = Ndis802_11Encryption1Enabled;
265
266 break;
267
268 case WLAN_CMD_GET_LINK:
269 DBG_PRT(MSG_LEVEL_DEBUG, KERN_INFO "WLAN_CMD_GET_LINK status. \n");
270
271 memset(sLinkStatus.abySSID, 0 , WLAN_SSID_MAXLEN + 1);
272
273 if (pMgmt->eCurrMode == WMAC_MODE_IBSS_STA)
274 sLinkStatus.wBSSType = ADHOC;
275 else
276 sLinkStatus.wBSSType = INFRA;
277
278 if (pMgmt->eCurrState == WMAC_STATE_JOINTED)
279 sLinkStatus.byState = ADHOC_JOINTED;
280 else
281 sLinkStatus.byState = ADHOC_STARTED;
282
283 sLinkStatus.uChannel = pMgmt->uCurrChannel;
284 if (pDevice->bLinkPass == TRUE) {
285 sLinkStatus.bLink = TRUE;
286 pItemSSID = (PWLAN_IE_SSID)pMgmt->abyCurrSSID;
287 memcpy(sLinkStatus.abySSID, pItemSSID->abySSID, pItemSSID->len);
288 memcpy(sLinkStatus.abyBSSID, pMgmt->abyCurrBSSID, WLAN_BSSID_LEN);
289 sLinkStatus.uLinkRate = pMgmt->sNodeDBTable[0].wTxDataRate;
290 DBG_PRT(MSG_LEVEL_DEBUG, KERN_INFO" Link Success ! \n");
291 }
292 else {
293 sLinkStatus.bLink = FALSE;
294 }
295 if (copy_to_user(pReq->data, &sLinkStatus, sizeof(SCmdLinkStatus))) {
296 result = -EFAULT;
297 break;
298 }
299
300 break;
301
302 case WLAN_CMD_GET_LISTLEN:
303 cbListCount = 0;
304 pBSS = &(pMgmt->sBSSList[0]);
305 for (ii = 0; ii < MAX_BSS_NUM; ii++) {
306 pBSS = &(pMgmt->sBSSList[ii]);
307 if (!pBSS->bActive)
308 continue;
309 cbListCount++;
310 }
311 sList.uItem = cbListCount;
312 if (copy_to_user(pReq->data, &sList, sizeof(SBSSIDList))) {
313 result = -EFAULT;
314 break;
315 }
316 pReq->wResult = 0;
317 break;
318
319 case WLAN_CMD_GET_LIST:
320 if (copy_from_user(&sList, pReq->data, sizeof(SBSSIDList))) {
321 result = -EFAULT;
322 break;
323 }
324 pList = (PSBSSIDList)kmalloc(sizeof(SBSSIDList) + (sList.uItem * sizeof(SBSSIDItem)), (int)GFP_ATOMIC);
325 if (pList == NULL) {
326 result = -ENOMEM;
327 break;
328 }
329 pList->uItem = sList.uItem;
330 pBSS = &(pMgmt->sBSSList[0]);
331 for (ii = 0, jj = 0; jj < MAX_BSS_NUM ; jj++) {
332 pBSS = &(pMgmt->sBSSList[jj]);
333 if (pBSS->bActive) {
334 pList->sBSSIDList[ii].uChannel = pBSS->uChannel;
335 pList->sBSSIDList[ii].wBeaconInterval = pBSS->wBeaconInterval;
336 pList->sBSSIDList[ii].wCapInfo = pBSS->wCapInfo;
337 RFvRSSITodBm(pDevice, (BYTE)(pBSS->uRSSI), &ldBm);
338 pList->sBSSIDList[ii].uRSSI = (unsigned int) ldBm;
339 // pList->sBSSIDList[ii].uRSSI = pBSS->uRSSI;
340 memcpy(pList->sBSSIDList[ii].abyBSSID, pBSS->abyBSSID, WLAN_BSSID_LEN);
341 pItemSSID = (PWLAN_IE_SSID)pBSS->abySSID;
342 memset(pList->sBSSIDList[ii].abySSID, 0, WLAN_SSID_MAXLEN + 1);
343 memcpy(pList->sBSSIDList[ii].abySSID, pItemSSID->abySSID, pItemSSID->len);
344 if (WLAN_GET_CAP_INFO_ESS(pBSS->wCapInfo)) {
345 pList->sBSSIDList[ii].byNetType = INFRA;
346 }
347 else {
348 pList->sBSSIDList[ii].byNetType = ADHOC;
349 }
350 if (WLAN_GET_CAP_INFO_PRIVACY(pBSS->wCapInfo)) {
351 pList->sBSSIDList[ii].bWEPOn = TRUE;
352 }
353 else {
354 pList->sBSSIDList[ii].bWEPOn = FALSE;
355 }
356 ii ++;
357 if (ii >= pList->uItem)
358 break;
359 }
360 }
361
362 if (copy_to_user(pReq->data, pList, sizeof(SBSSIDList) + (sList.uItem * sizeof(SBSSIDItem)))) {
363 result = -EFAULT;
364 break;
365 }
366 kfree(pList);
367 pReq->wResult = 0;
368 break;
369
370 case WLAN_CMD_GET_MIB:
371 if (copy_to_user(pReq->data, &(pDevice->s802_11Counter), sizeof(SDot11MIBCount))) {
372 result = -EFAULT;
373 break;
374 }
375 break;
376
377 case WLAN_CMD_GET_STAT:
378 if (copy_to_user(pReq->data, &(pDevice->scStatistic), sizeof(SStatCounter))) {
379 result = -EFAULT;
380 break;
381 }
382 break;
383 case WLAN_CMD_STOP_MAC:
384
385 DBG_PRT(MSG_LEVEL_DEBUG, KERN_INFO "WLAN_CMD_STOP_MAC\n");
386 // Todo xxxxxx
387 netif_stop_queue(pDevice->dev);
388 spin_lock_irq(&pDevice->lock);
389 if (pDevice->bRadioOff == FALSE) {
390 CARDbRadioPowerOff(pDevice);
391 }
392 pDevice->bLinkPass = FALSE;
393 ControlvMaskByte(pDevice,MESSAGE_REQUEST_MACREG,MAC_REG_PAPEDELAY,LEDSTS_STS,LEDSTS_SLOW);
394 memset(pMgmt->abyCurrBSSID, 0, 6);
395 pMgmt->eCurrState = WMAC_STATE_IDLE;
396 // del_timer(&pDevice->sTimerCommand);
397 // del_timer(&pMgmt->sTimerSecondCallback);
398 pDevice->bCmdRunning = FALSE;
399 spin_unlock_irq(&pDevice->lock);
400
401 break;
402
403 case WLAN_CMD_START_MAC:
404
405 DBG_PRT(MSG_LEVEL_DEBUG, KERN_INFO "WLAN_CMD_START_MAC\n");
406 // Todo xxxxxxx
407 if (pDevice->bRadioOff == TRUE)
408 CARDbRadioPowerOn(pDevice);
409 break;
410
411 case WLAN_CMD_SET_HOSTAPD:
412
413 DBG_PRT(MSG_LEVEL_DEBUG, KERN_INFO "WLAN_CMD_SET_HOSTAPD\n");
414
415 if (copy_from_user(&sValue, pReq->data, sizeof(SCmdValue))) {
416 result = -EFAULT;
417 break;
418 }
419 if (sValue.dwValue == 1) {
420 if (vt6656_hostap_set_hostapd(pDevice, 1, 1) == 0){
421 DBG_PRT(MSG_LEVEL_DEBUG, KERN_INFO "Enable HOSTAP\n");
422 }
423 else {
424 result = -EFAULT;
425 break;
426 }
427 }
428 else {
429 vt6656_hostap_set_hostapd(pDevice, 0, 1);
430 DBG_PRT(MSG_LEVEL_DEBUG, KERN_INFO "Disable HOSTAP\n");
431 }
432
433 break;
434
435 case WLAN_CMD_SET_HOSTAPD_STA:
436
437 DBG_PRT(MSG_LEVEL_DEBUG, KERN_INFO "WLAN_CMD_SET_HOSTAPD_STA\n");
438
439 break;
440 case WLAN_CMD_SET_802_1X:
441
442 DBG_PRT(MSG_LEVEL_DEBUG, KERN_INFO "WLAN_CMD_SET_802_1X\n");
443 if (copy_from_user(&sValue, pReq->data, sizeof(SCmdValue))) {
444 result = -EFAULT;
445 break;
446 }
447
448 if (sValue.dwValue == 1) {
449 pDevice->bEnable8021x = TRUE;
450 DBG_PRT(MSG_LEVEL_DEBUG, KERN_INFO "Enable 802.1x\n");
451 }
452 else {
453 pDevice->bEnable8021x = FALSE;
454 DBG_PRT(MSG_LEVEL_DEBUG, KERN_INFO "Disable 802.1x\n");
455 }
456
457 break;
458
459
460 case WLAN_CMD_SET_HOST_WEP:
461
462 DBG_PRT(MSG_LEVEL_DEBUG, KERN_INFO "WLAN_CMD_SET_HOST_WEP\n");
463 if (copy_from_user(&sValue, pReq->data, sizeof(SCmdValue))) {
464 result = -EFAULT;
465 break;
466 }
467
468 if (sValue.dwValue == 1) {
469 pDevice->bEnableHostWEP = TRUE;
470 DBG_PRT(MSG_LEVEL_DEBUG, KERN_INFO "Enable HostWEP\n");
471 }
472 else {
473 pDevice->bEnableHostWEP = FALSE;
474 DBG_PRT(MSG_LEVEL_DEBUG, KERN_INFO "Disable HostWEP\n");
475 }
476
477 break;
478
479 case WLAN_CMD_SET_WPA:
480 DBG_PRT(MSG_LEVEL_DEBUG, KERN_INFO "WLAN_CMD_SET_WPA\n");
481
482 if (copy_from_user(&sValue, pReq->data, sizeof(SCmdValue))) {
483 result = -EFAULT;
484 break;
485 }
486 if (sValue.dwValue == 1) {
487 DBG_PRT(MSG_LEVEL_DEBUG, KERN_INFO "up wpadev\n");
488 memcpy(pDevice->wpadev->dev_addr,
489 pDevice->dev->dev_addr,
490 ETH_ALEN);
491 pDevice->bWPADEVUp = TRUE;
492 }
493 else {
494 DBG_PRT(MSG_LEVEL_DEBUG, KERN_INFO "close wpadev\n");
495 pDevice->bWPADEVUp = FALSE;
496 }
497
498 break;
499
500 case WLAN_CMD_AP_START:
501
502 DBG_PRT(MSG_LEVEL_DEBUG, KERN_INFO "WLAN_CMD_AP_START\n");
503 if (pDevice->bRadioOff == TRUE) {
504 CARDbRadioPowerOn(pDevice);
505 add_timer(&pMgmt->sTimerSecondCallback);
506 }
507 if (copy_from_user(&sStartAPCmd, pReq->data, sizeof(SCmdStartAP))) {
508 result = -EFAULT;
509 break;
510 }
511
512 if (sStartAPCmd.wBSSType == AP) {
513 pMgmt->eConfigMode = WMAC_CONFIG_AP;
514 DBG_PRT(MSG_LEVEL_DEBUG, KERN_INFO "ioct set to AP mode\n");
515 }
516 else {
517 DBG_PRT(MSG_LEVEL_DEBUG, KERN_INFO "ioct BSS type not set to AP mode\n");
518 result = -EFAULT;
519 break;
520 }
521
522
523 if (sStartAPCmd.wBBPType == PHY80211g) {
524 pMgmt->byAPBBType = PHY_TYPE_11G;
525 }
526 else if (sStartAPCmd.wBBPType == PHY80211a) {
527 pMgmt->byAPBBType = PHY_TYPE_11A;
528 }
529 else {
530 pMgmt->byAPBBType = PHY_TYPE_11B;
531 }
532
533 pItemSSID = (PWLAN_IE_SSID)sStartAPCmd.ssid;
534 memset(pMgmt->abyDesireSSID, 0, WLAN_IEHDR_LEN + WLAN_SSID_MAXLEN + 1);
535 memcpy(pMgmt->abyDesireSSID, pItemSSID, pItemSSID->len + WLAN_IEHDR_LEN);
536
537 if ((sStartAPCmd.uChannel > 0)&&(sStartAPCmd.uChannel <= 14))
538 pDevice->uChannel = sStartAPCmd.uChannel;
539
540 if ((sStartAPCmd.uBeaconInt >= 20) && (sStartAPCmd.uBeaconInt <= 1000))
541 pMgmt->wIBSSBeaconPeriod = sStartAPCmd.uBeaconInt;
542 else
543 pMgmt->wIBSSBeaconPeriod = 100;
544
545 if (sStartAPCmd.bShareKeyAuth == TRUE){
546 pMgmt->bShareKeyAlgorithm = TRUE;
547 DBG_PRT(MSG_LEVEL_DEBUG, KERN_INFO "Share Key \n");
548 }
549 else {
550 pMgmt->bShareKeyAlgorithm = FALSE;
551 DBG_PRT(MSG_LEVEL_DEBUG, KERN_INFO "Open System \n");
552 }
553 memcpy(pMgmt->abyIBSSSuppRates, abySuppRates, 6);
554
555 if (sStartAPCmd.byBasicRate & BIT3) {
556 pMgmt->abyIBSSSuppRates[2] |= BIT7;
557 pMgmt->abyIBSSSuppRates[3] |= BIT7;
558 pMgmt->abyIBSSSuppRates[4] |= BIT7;
559 pMgmt->abyIBSSSuppRates[5] |= BIT7;
560 }else if (sStartAPCmd.byBasicRate & BIT2) {
561 pMgmt->abyIBSSSuppRates[2] |= BIT7;
562 pMgmt->abyIBSSSuppRates[3] |= BIT7;
563 pMgmt->abyIBSSSuppRates[4] |= BIT7;
564 }else if (sStartAPCmd.byBasicRate & BIT1) {
565 pMgmt->abyIBSSSuppRates[2] |= BIT7;
566 pMgmt->abyIBSSSuppRates[3] |= BIT7;
567 }else if (sStartAPCmd.byBasicRate & BIT1) {
568 pMgmt->abyIBSSSuppRates[2] |= BIT7;
569 }else {
570 //default 1,2M
571 pMgmt->abyIBSSSuppRates[2] |= BIT7;
572 pMgmt->abyIBSSSuppRates[3] |= BIT7;
573 }
574
575 DBG_PRT(MSG_LEVEL_DEBUG, KERN_INFO "Support Rate= %x %x %x %x\n",
576 pMgmt->abyIBSSSuppRates[2],
577 pMgmt->abyIBSSSuppRates[3],
578 pMgmt->abyIBSSSuppRates[4],
579 pMgmt->abyIBSSSuppRates[5]
580 );
581
582 netif_stop_queue(pDevice->dev);
583 spin_lock_irq(&pDevice->lock);
584 bScheduleCommand((void *) pDevice, WLAN_CMD_RUN_AP, NULL);
585 spin_unlock_irq(&pDevice->lock);
586 break;
587
588 case WLAN_CMD_GET_NODE_CNT:
589
590 cbListCount = 0;
591 pNode = &(pMgmt->sNodeDBTable[0]);
592 for (ii = 0; ii < (MAX_NODE_NUM + 1); ii++) {
593 pNode = &(pMgmt->sNodeDBTable[ii]);
594 if (!pNode->bActive)
595 continue;
596 cbListCount++;
597 }
598
599 sNodeList.uItem = cbListCount;
600 if (copy_to_user(pReq->data, &sNodeList, sizeof(SNodeList))) {
601 result = -EFAULT;
602 break;
603 }
604 pReq->wResult = 0;
605 break;
606
607 case WLAN_CMD_GET_NODE_LIST:
608
609 if (copy_from_user(&sNodeList, pReq->data, sizeof(SNodeList))) {
610 result = -EFAULT;
611 break;
612 }
613 pNodeList = (PSNodeList)kmalloc(sizeof(SNodeList) + (sNodeList.uItem * sizeof(SNodeItem)), (int)GFP_ATOMIC);
614 if (pNodeList == NULL) {
615 result = -ENOMEM;
616 break;
617 }
618 pNodeList->uItem = sNodeList.uItem;
619 pNode = &(pMgmt->sNodeDBTable[0]);
620 for (ii = 0, jj = 0; ii < (MAX_NODE_NUM + 1); ii++) {
621 pNode = &(pMgmt->sNodeDBTable[ii]);
622 if (pNode->bActive) {
623 pNodeList->sNodeList[jj].wAID = pNode->wAID;
624 memcpy(pNodeList->sNodeList[jj].abyMACAddr, pNode->abyMACAddr, WLAN_ADDR_LEN);
625 pNodeList->sNodeList[jj].wTxDataRate = pNode->wTxDataRate;
626 pNodeList->sNodeList[jj].wInActiveCount = (WORD)pNode->uInActiveCount;
627 pNodeList->sNodeList[jj].wEnQueueCnt = (WORD)pNode->wEnQueueCnt;
628 pNodeList->sNodeList[jj].wFlags = (WORD)pNode->dwFlags;
629 pNodeList->sNodeList[jj].bPWBitOn = pNode->bPSEnable;
630 pNodeList->sNodeList[jj].byKeyIndex = pNode->byKeyIndex;
631 pNodeList->sNodeList[jj].wWepKeyLength = pNode->uWepKeyLength;
632 memcpy(&(pNodeList->sNodeList[jj].abyWepKey[0]), &(pNode->abyWepKey[0]), WEP_KEYMAXLEN);
633 DBG_PRT(MSG_LEVEL_DEBUG, KERN_INFO "key= %2.2X:%2.2X:%2.2X:%2.2X:%2.2X\n",
634 pNodeList->sNodeList[jj].abyWepKey[0],
635 pNodeList->sNodeList[jj].abyWepKey[1],
636 pNodeList->sNodeList[jj].abyWepKey[2],
637 pNodeList->sNodeList[jj].abyWepKey[3],
638 pNodeList->sNodeList[jj].abyWepKey[4]
639 );
640 pNodeList->sNodeList[jj].bIsInFallback = pNode->bIsInFallback;
641 pNodeList->sNodeList[jj].uTxFailures = pNode->uTxFailures;
642 pNodeList->sNodeList[jj].uTxAttempts = pNode->uTxAttempts;
643 pNodeList->sNodeList[jj].wFailureRatio = (WORD)pNode->uFailureRatio;
644 jj ++;
645 if (jj >= pNodeList->uItem)
646 break;
647 }
648 }
649 if (copy_to_user(pReq->data, pNodeList, sizeof(SNodeList) + (sNodeList.uItem * sizeof(SNodeItem)))) {
650 result = -EFAULT;
651 break;
652 }
653 kfree(pNodeList);
654 pReq->wResult = 0;
655 break;
656
657 case 0xFF:
658 memset(wpa_Result.ifname,0,sizeof(wpa_Result.ifname));
659 wpa_Result.proto = 0;
660 wpa_Result.key_mgmt = 0;
661 wpa_Result.eap_type = 0;
662 wpa_Result.authenticated = FALSE;
663 pDevice->fWPA_Authened = FALSE;
664 if (copy_from_user(&wpa_Result, pReq->data, sizeof(wpa_Result))) {
665 result = -EFAULT;
666 break;
667 }
668 //DavidWang for some AP maybe good authenticate
669 if(wpa_Result.key_mgmt==0x20)
670 pMgmt->Cisco_cckm =1;
671 else
672 pMgmt->Cisco_cckm =0;
673
674
675 if(wpa_Result.authenticated==TRUE) {
676 {
677 union iwreq_data wrqu;
678
679 pItemSSID = (PWLAN_IE_SSID)pMgmt->abyCurrSSID;
680
681 memset(&wrqu, 0, sizeof(wrqu));
682 wrqu.data.flags = RT_WPACONNECTED_EVENT_FLAG;
683 wrqu.data.length =pItemSSID->len;
684 wireless_send_event(pDevice->dev, IWEVCUSTOM, &wrqu, pItemSSID->abySSID);
685 }
686 pDevice->fWPA_Authened = TRUE; //is successful peer to wpa_Result.authenticated?
687 }
688
689 //printk("get private wpa_supplicant announce WPA SM\n");
690 //printk("wpa-->ifname=%s\n",wpa_Result.ifname);
691 //printk("wpa-->proto=%d\n",wpa_Result.proto);
692 //printk("wpa-->key-mgmt=%d\n",wpa_Result.key_mgmt);
693 //printk("wpa-->eap_type=%d\n",wpa_Result.eap_type);
694 //printk("wpa-->authenticated is %s\n",(wpa_Result.authenticated==TRUE)?"TRUE":"FALSE");
695
696 pReq->wResult = 0;
697 break;
698
699 default:
700 DBG_PRT(MSG_LEVEL_DEBUG, KERN_INFO "Private command not support..\n");
701 }
702
703 return result;
704 }
linux-next