projects / GitHub / mt8127 / android_kernel_alcatel_ttab.git / blame
? search:
summary | shortlog | log | commit | commitdiff | tree
blob | blame (incremental) | history | HEAD
Merge commit '3ff195b011d7decf501a4d55aeed312731094796' into for-linus
[GitHub/mt8127/android_kernel_alcatel_ttab.git] / drivers / staging / vt6656 / wcmd.c
CommitLineData
92b96797
FB		 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: wcmd.c
20 *
21 * Purpose: Handles the management command interface functions
22 *
23 * Author: Lyndon Chen
24 *
25 * Date: May 8, 2003
26 *
27 * Functions:
28 * s_vProbeChannel - Active scan channel
29 * s_MgrMakeProbeRequest - Make ProbeRequest packet
30 * CommandTimer - Timer function to handle command
31 * s_bCommandComplete - Command Complete function
32 * bScheduleCommand - Push Command and wait Command Scheduler to do
33 * vCommandTimer- Command call back functions
34 * vCommandTimerWait- Call back timer
35 * s_bClearBSSID_SCAN- Clear BSSID_SCAN cmd in CMD Queue
36 *
37 * Revision History:
38 *
39 */
40
92b96797 41#include "ttype.h"
92b96797 42#include "tmacro.h"
92b96797 43#include "device.h"
92b96797 44#include "mac.h"
92b96797 45#include "card.h"
92b96797 46#include "80211hdr.h"
92b96797 47#include "wcmd.h"
92b96797 48#include "wmgr.h"
92b96797 49#include "power.h"
92b96797 50#include "wctl.h"
92b96797 51#include "baseband.h"
92b96797 52#include "control.h"
92b96797 53#include "rxtx.h"
92b96797 54#include "rf.h"
92b96797 55#include "rndis.h"
92b96797 56#include "channel.h"
92b96797 57#include "iowpa.h"
92b96797
FB		 58
59/*--------------------- Static Definitions -------------------------*/
60
61
62
63
64/*--------------------- Static Classes ----------------------------*/
65
66/*--------------------- Static Variables --------------------------*/
67static int msglevel =MSG_LEVEL_INFO;
68//static int msglevel =MSG_LEVEL_DEBUG;
69/*--------------------- Static Functions --------------------------*/
70
71static
72VOID
73s_vProbeChannel(
74 IN PSDevice pDevice
75 );
76
77
78static
79PSTxMgmtPacket
80s_MgrMakeProbeRequest(
81 IN PSDevice pDevice,
82 IN PSMgmtObject pMgmt,
83 IN PBYTE pScanBSSID,
84 IN PWLAN_IE_SSID pSSID,
85 IN PWLAN_IE_SUPP_RATES pCurrRates,
86 IN PWLAN_IE_SUPP_RATES pCurrExtSuppRates
87 );
88
89
90static
91BOOL
92s_bCommandComplete (
93 PSDevice pDevice
94 );
95
96
97static
98BOOL s_bClearBSSID_SCAN (
99 IN HANDLE hDeviceContext
100 );
101
102/*--------------------- Export Variables --------------------------*/
103
104
105/*--------------------- Export Functions --------------------------*/
106
107
108
109/*
110 * Description:
111 * Stop AdHoc beacon during scan process
112 *
113 * Parameters:
114 * In:
115 * pDevice - Pointer to the adapter
116 * Out:
117 * none
118 *
119 * Return Value: none
120 *
121 */
122static
123void
124vAdHocBeaconStop(PSDevice pDevice)
125{
126
127 PSMgmtObject pMgmt = &(pDevice->sMgmtObj);
128 BOOL bStop;
129
130 /*
131 * temporarily stop Beacon packet for AdHoc Server
132 * if all of the following coditions are met:
133 * (1) STA is in AdHoc mode
134 * (2) VT3253 is programmed as automatic Beacon Transmitting
135 * (3) One of the following conditions is met
136 * (3.1) AdHoc channel is in B/G band and the
137 * current scan channel is in A band
138 * or
139 * (3.2) AdHoc channel is in A mode
140 */
141 bStop = FALSE;
142 if ((pMgmt->eCurrMode == WMAC_MODE_IBSS_STA) &&
143 (pMgmt->eCurrState >= WMAC_STATE_STARTED))
144 {
145 if ((pMgmt->uIBSSChannel <= CB_MAX_CHANNEL_24G) &&
146 (pMgmt->uScanChannel > CB_MAX_CHANNEL_24G))
147 {
148 bStop = TRUE;
149 }
150 if (pMgmt->uIBSSChannel > CB_MAX_CHANNEL_24G)
151 {
152 bStop = TRUE;
153 }
154 }
155
156 if (bStop)
157 {
158 //PMESG(("STOP_BEACON: IBSSChannel = %u, ScanChannel = %u\n",
159 // pMgmt->uIBSSChannel, pMgmt->uScanChannel));
160 MACvRegBitsOff(pDevice, MAC_REG_TCR, TCR_AUTOBCNTX);
161 }
162
163} /* vAdHocBeaconStop */
164
165
166/*
167 * Description:
168 * Restart AdHoc beacon after scan process complete
169 *
170 * Parameters:
171 * In:
172 * pDevice - Pointer to the adapter
173 * Out:
174 * none
175 *
176 * Return Value: none
177 *
178 */
179static
180void
181vAdHocBeaconRestart(PSDevice pDevice)
182{
183 PSMgmtObject pMgmt = &(pDevice->sMgmtObj);
184
185 /*
186 * Restart Beacon packet for AdHoc Server
187 * if all of the following coditions are met:
188 * (1) STA is in AdHoc mode
189 * (2) VT3253 is programmed as automatic Beacon Transmitting
190 */
191 if ((pMgmt->eCurrMode == WMAC_MODE_IBSS_STA) &&
192 (pMgmt->eCurrState >= WMAC_STATE_STARTED))
193 {
194 //PMESG(("RESTART_BEACON\n"));
195 MACvRegBitsOn(pDevice, MAC_REG_TCR, TCR_AUTOBCNTX);
196 }
197
198}
199
200
201/*+
202 *
203 * Routine Description:
204 * Prepare and send probe request management frames.
205 *
206 *
207 * Return Value:
208 * none.
209 *
210-*/
211
212static
213VOID
214s_vProbeChannel(
215 IN PSDevice pDevice
216 )
217{
218 //1M, 2M, 5M, 11M, 18M, 24M, 36M, 54M
219 BYTE abyCurrSuppRatesG[] = {WLAN_EID_SUPP_RATES, 8, 0x02, 0x04, 0x0B, 0x16, 0x24, 0x30, 0x48, 0x6C};
220 BYTE abyCurrExtSuppRatesG[] = {WLAN_EID_EXTSUPP_RATES, 4, 0x0C, 0x12, 0x18, 0x60};
221 //6M, 9M, 12M, 48M
222 BYTE abyCurrSuppRatesA[] = {WLAN_EID_SUPP_RATES, 8, 0x0C, 0x12, 0x18, 0x24, 0x30, 0x48, 0x60, 0x6C};
223 BYTE abyCurrSuppRatesB[] = {WLAN_EID_SUPP_RATES, 4, 0x02, 0x04, 0x0B, 0x16};
224 PBYTE pbyRate;
225 PSTxMgmtPacket pTxPacket;
226 PSMgmtObject pMgmt = &(pDevice->sMgmtObj);
227 UINT ii;
228
229
230 if (pDevice->byBBType == BB_TYPE_11A) {
231 pbyRate = &abyCurrSuppRatesA[0];
232 } else if (pDevice->byBBType == BB_TYPE_11B) {
233 pbyRate = &abyCurrSuppRatesB[0];
234 } else {
235 pbyRate = &abyCurrSuppRatesG[0];
236 }
237 // build an assocreq frame and send it
238 pTxPacket = s_MgrMakeProbeRequest
239 (
240 pDevice,
241 pMgmt,
242 pMgmt->abyScanBSSID,
243 (PWLAN_IE_SSID)pMgmt->abyScanSSID,
244 (PWLAN_IE_SUPP_RATES)pbyRate,
245 (PWLAN_IE_SUPP_RATES)abyCurrExtSuppRatesG
246 );
247
248 if (pTxPacket != NULL ){
249 for (ii = 0; ii < 1 ; ii++) {
250 if (csMgmt_xmit(pDevice, pTxPacket) != CMD_STATUS_PENDING) {
251 DBG_PRT(MSG_LEVEL_DEBUG, KERN_INFO "Probe request sending fail.. \n");
252 }
253 else {
254 DBG_PRT(MSG_LEVEL_DEBUG, KERN_INFO "Probe request is sending.. \n");
255 }
256 }
257 }
258
259}
260
261
262
263
264/*+
265 *
266 * Routine Description:
267 * Constructs an probe request frame
268 *
269 *
270 * Return Value:
271 * A ptr to Tx frame or NULL on allocation failue
272 *
273-*/
274
275
276PSTxMgmtPacket
277s_MgrMakeProbeRequest(
278 IN PSDevice pDevice,
279 IN PSMgmtObject pMgmt,
280 IN PBYTE pScanBSSID,
281 IN PWLAN_IE_SSID pSSID,
282 IN PWLAN_IE_SUPP_RATES pCurrRates,
283 IN PWLAN_IE_SUPP_RATES pCurrExtSuppRates
284
285 )
286{
287 PSTxMgmtPacket pTxPacket = NULL;
288 WLAN_FR_PROBEREQ sFrame;
289
290
291 pTxPacket = (PSTxMgmtPacket)pMgmt->pbyMgmtPacketPool;
292 memset(pTxPacket, 0, sizeof(STxMgmtPacket) + WLAN_PROBEREQ_FR_MAXLEN);
293 pTxPacket->p80211Header = (PUWLAN_80211HDR)((PBYTE)pTxPacket + sizeof(STxMgmtPacket));
294 sFrame.pBuf = (PBYTE)pTxPacket->p80211Header;
295 sFrame.len = WLAN_PROBEREQ_FR_MAXLEN;
296 vMgrEncodeProbeRequest(&sFrame);
297 sFrame.pHdr->sA3.wFrameCtl = cpu_to_le16(
298 (
299 WLAN_SET_FC_FTYPE(WLAN_TYPE_MGR) |
300 WLAN_SET_FC_FSTYPE(WLAN_FSTYPE_PROBEREQ)
301 ));
302 memcpy( sFrame.pHdr->sA3.abyAddr1, pScanBSSID, WLAN_ADDR_LEN);
303 memcpy( sFrame.pHdr->sA3.abyAddr2, pMgmt->abyMACAddr, WLAN_ADDR_LEN);
304 memcpy( sFrame.pHdr->sA3.abyAddr3, pScanBSSID, WLAN_BSSID_LEN);
305 // Copy the SSID, pSSID->len=0 indicate broadcast SSID
306 sFrame.pSSID = (PWLAN_IE_SSID)(sFrame.pBuf + sFrame.len);
307 sFrame.len += pSSID->len + WLAN_IEHDR_LEN;
308 memcpy(sFrame.pSSID, pSSID, pSSID->len + WLAN_IEHDR_LEN);
309 sFrame.pSuppRates = (PWLAN_IE_SUPP_RATES)(sFrame.pBuf + sFrame.len);
310 sFrame.len += pCurrRates->len + WLAN_IEHDR_LEN;
311 memcpy(sFrame.pSuppRates, pCurrRates, pCurrRates->len + WLAN_IEHDR_LEN);
312 // Copy the extension rate set
313 if (pDevice->byBBType == BB_TYPE_11G) {
314 sFrame.pExtSuppRates = (PWLAN_IE_SUPP_RATES)(sFrame.pBuf + sFrame.len);
315 sFrame.len += pCurrExtSuppRates->len + WLAN_IEHDR_LEN;
316 memcpy(sFrame.pExtSuppRates, pCurrExtSuppRates, pCurrExtSuppRates->len + WLAN_IEHDR_LEN);
317 }
318 pTxPacket->cbMPDULen = sFrame.len;
319 pTxPacket->cbPayloadLen = sFrame.len - WLAN_HDR_ADDR3_LEN;
320
321 return pTxPacket;
322}
323
324
325
326
327
328VOID
329vCommandTimerWait(
330 IN HANDLE hDeviceContext,
331 IN UINT MSecond
332 )
333{
334 PSDevice pDevice = (PSDevice)hDeviceContext;
335
336 init_timer(&pDevice->sTimerCommand);
337 pDevice->sTimerCommand.data = (ULONG)pDevice;
338 pDevice->sTimerCommand.function = (TimerFunction)vRunCommand;
339 // RUN_AT :1 msec ~= (HZ/1024)
340 pDevice->sTimerCommand.expires = (UINT)RUN_AT((MSecond * HZ) >> 10);
341 add_timer(&pDevice->sTimerCommand);
342 return;
343}
344
345
346
347
348VOID
349vRunCommand(
350 IN HANDLE hDeviceContext
351 )
352{
353 PSDevice pDevice = (PSDevice)hDeviceContext;
354 PSMgmtObject pMgmt = &(pDevice->sMgmtObj);
355 PWLAN_IE_SSID pItemSSID;
356 PWLAN_IE_SSID pItemSSIDCurr;
357 CMD_STATUS Status;
358 UINT ii;
359 BYTE byMask[8] = {1, 2, 4, 8, 0x10, 0x20, 0x40, 0x80};
360 struct sk_buff *skb;
361 BYTE byData;
362
363
364 if (pDevice->dwDiagRefCount != 0)
365 return;
366 if (pDevice->bCmdRunning != TRUE)
367 return;
368
369 spin_lock_irq(&pDevice->lock);
370
371 switch ( pDevice->eCommandState ) {
372
373 case WLAN_CMD_SCAN_START:
374
375 pDevice->byReAssocCount = 0;
376 if (pDevice->bRadioOff == TRUE) {
377 s_bCommandComplete(pDevice);
378 spin_unlock_irq(&pDevice->lock);
379 return;
380 }
381
382 if (pMgmt->eCurrMode == WMAC_MODE_ESS_AP) {
383 s_bCommandComplete(pDevice);
384 spin_unlock_irq(&pDevice->lock);
385 return;
386 }
387
388 pItemSSID = (PWLAN_IE_SSID)pMgmt->abyScanSSID;
389
390 if (pMgmt->uScanChannel == 0 ) {
391 pMgmt->uScanChannel = pDevice->byMinChannel;
392 }
393 if (pMgmt->uScanChannel > pDevice->byMaxChannel) {
394 pMgmt->eScanState = WMAC_NO_SCANNING;
395
396 if (pDevice->byBBType != pDevice->byScanBBType) {
397 pDevice->byBBType = pDevice->byScanBBType;
398 CARDvSetBSSMode(pDevice);
399 }
400
401 if (pDevice->bUpdateBBVGA) {
402 BBvSetShortSlotTime(pDevice);
403 BBvSetVGAGainOffset(pDevice, pDevice->byBBVGACurrent);
404 BBvUpdatePreEDThreshold(pDevice, FALSE);
405 }
406 // Set channel back
407 vAdHocBeaconRestart(pDevice);
408 // Set channel back
409 CARDbSetMediaChannel(pDevice, pMgmt->uCurrChannel);
410 // Set Filter
411 if (pMgmt->bCurrBSSIDFilterOn) {
412 MACvRegBitsOn(pDevice, MAC_REG_RCR, RCR_BSSID);
413 pDevice->byRxMode |= RCR_BSSID;
414 }
415 DBG_PRT(MSG_LEVEL_DEBUG, KERN_INFO "Scanning, set back to channel: [%d]\n", pMgmt->uCurrChannel);
416 pDevice->bStopDataPkt = FALSE;
417 s_bCommandComplete(pDevice);
418 spin_unlock_irq(&pDevice->lock);
419 return;
420
421 } else {
422 if (!ChannelValid(pDevice->byZoneType, pMgmt->uScanChannel)) {
423 DBG_PRT(MSG_LEVEL_DEBUG, KERN_INFO "Invalid channel pMgmt->uScanChannel = %d \n",pMgmt->uScanChannel);
424 s_bCommandComplete(pDevice);
425 spin_unlock_irq(&pDevice->lock);
426 return;
427 }
428 if (pMgmt->uScanChannel == pDevice->byMinChannel) {
429 // pMgmt->eScanType = WMAC_SCAN_ACTIVE; //mike mark
430 pMgmt->abyScanBSSID[0] = 0xFF;
431 pMgmt->abyScanBSSID[1] = 0xFF;
432 pMgmt->abyScanBSSID[2] = 0xFF;
433 pMgmt->abyScanBSSID[3] = 0xFF;
434 pMgmt->abyScanBSSID[4] = 0xFF;
435 pMgmt->abyScanBSSID[5] = 0xFF;
436 pItemSSID->byElementID = WLAN_EID_SSID;
437 // clear bssid list
438 // BSSvClearBSSList((HANDLE)pDevice, pDevice->bLinkPass);
439 pMgmt->eScanState = WMAC_IS_SCANNING;
440 pDevice->byScanBBType = pDevice->byBBType; //lucas
441 pDevice->bStopDataPkt = TRUE;
442 // Turn off RCR_BSSID filter everytime
443 MACvRegBitsOff(pDevice, MAC_REG_RCR, RCR_BSSID);
444 pDevice->byRxMode &= ~RCR_BSSID;
445
446 }
447 //lucas
448 vAdHocBeaconStop(pDevice);
449 if ((pDevice->byBBType != BB_TYPE_11A) && (pMgmt->uScanChannel > CB_MAX_CHANNEL_24G)) {
450 pDevice->byBBType = BB_TYPE_11A;
451 CARDvSetBSSMode(pDevice);
452 }
453 else if ((pDevice->byBBType == BB_TYPE_11A) && (pMgmt->uScanChannel <= CB_MAX_CHANNEL_24G)) {
454 pDevice->byBBType = BB_TYPE_11G;
455 CARDvSetBSSMode(pDevice);
456 }
457 DBG_PRT(MSG_LEVEL_DEBUG, KERN_INFO "Scanning.... channel: [%d]\n", pMgmt->uScanChannel);
458 // Set channel
459 CARDbSetMediaChannel(pDevice, pMgmt->uScanChannel);
460 // Set Baseband to be more sensitive.
461
462 if (pDevice->bUpdateBBVGA) {
463 BBvSetShortSlotTime(pDevice);
464 BBvSetVGAGainOffset(pDevice, pDevice->abyBBVGA[0]);
465 BBvUpdatePreEDThreshold(pDevice, TRUE);
466 }
467 pMgmt->uScanChannel++;
468
469 while (!ChannelValid(pDevice->byZoneType, pMgmt->uScanChannel) &&
470 pMgmt->uScanChannel <= pDevice->byMaxChannel ){
471 pMgmt->uScanChannel++;
472 }
473
474 if (pMgmt->uScanChannel > pDevice->byMaxChannel) {
475 // Set Baseband to be not sensitive and rescan
476 pDevice->eCommandState = WLAN_CMD_SCAN_END;
477
478 }
479 if ((pMgmt->b11hEnable == FALSE) ||
480 (pMgmt->uScanChannel < CB_MAX_CHANNEL_24G)) {
481 s_vProbeChannel(pDevice);
482 spin_unlock_irq(&pDevice->lock);
92b96797 483 vCommandTimerWait((HANDLE)pDevice, 100);
92b96797
FB		 484 return;
485 } else {
486 spin_unlock_irq(&pDevice->lock);
487 vCommandTimerWait((HANDLE)pDevice, WCMD_PASSIVE_SCAN_TIME);
488 return;
489 }
490
491 }
492
493 break;
494
495 case WLAN_CMD_SCAN_END:
496
497 // Set Baseband's sensitivity back.
498 if (pDevice->byBBType != pDevice->byScanBBType) {
499 pDevice->byBBType = pDevice->byScanBBType;
500 CARDvSetBSSMode(pDevice);
501 }
502
503 if (pDevice->bUpdateBBVGA) {
504 BBvSetShortSlotTime(pDevice);
505 BBvSetVGAGainOffset(pDevice, pDevice->byBBVGACurrent);
506 BBvUpdatePreEDThreshold(pDevice, FALSE);
507 }
508
509 // Set channel back
510 vAdHocBeaconRestart(pDevice);
511 // Set channel back
512 CARDbSetMediaChannel(pDevice, pMgmt->uCurrChannel);
513 // Set Filter
514 if (pMgmt->bCurrBSSIDFilterOn) {
515 MACvRegBitsOn(pDevice, MAC_REG_RCR, RCR_BSSID);
516 pDevice->byRxMode |= RCR_BSSID;
517 }
518 DBG_PRT(MSG_LEVEL_DEBUG, KERN_INFO "Scanning, set back to channel: [%d]\n", pMgmt->uCurrChannel);
519 pMgmt->eScanState = WMAC_NO_SCANNING;
520 pDevice->bStopDataPkt = FALSE;
521//2008-0409-07, <Add> by Einsn Liu
522#ifdef WPA_SUPPLICANT_DRIVER_WEXT_SUPPORT
523 if(pMgmt->eScanType == WMAC_SCAN_PASSIVE)
524 {
525 //send scan event to wpa_Supplicant
526 union iwreq_data wrqu;
527 PRINT_K("wireless_send_event--->SIOCGIWSCAN(scan done)\n");
528 memset(&wrqu, 0, sizeof(wrqu));
529 wireless_send_event(pDevice->dev, SIOCGIWSCAN, &wrqu, NULL);
530 }
531#endif
532 s_bCommandComplete(pDevice);
533 break;
534
535 case WLAN_CMD_DISASSOCIATE_START :
536 pDevice->byReAssocCount = 0;
537 if ((pMgmt->eCurrMode == WMAC_MODE_ESS_STA) &&
538 (pMgmt->eCurrState != WMAC_STATE_ASSOC)) {
539 s_bCommandComplete(pDevice);
540 spin_unlock_irq(&pDevice->lock);
541 return;
542 } else {
543
544 #ifdef WPA_SUPPLICANT_DRIVER_WEXT_SUPPORT
545 pDevice->bwextstep0 = FALSE;
546 pDevice->bwextstep1 = FALSE;
547 pDevice->bwextstep2 = FALSE;
548 pDevice->bwextstep3 = FALSE;
549 pDevice->bWPASuppWextEnabled = FALSE;
550 #endif
551 pDevice->fWPA_Authened = FALSE;
552
553 DBG_PRT(MSG_LEVEL_DEBUG, KERN_INFO"Send Disassociation Packet..\n");
554 // reason = 8 : disassoc because sta has left
555 vMgrDisassocBeginSta((HANDLE)pDevice, pMgmt, pMgmt->abyCurrBSSID, (8), &Status);
556 pDevice->bLinkPass = FALSE;
557 ControlvMaskByte(pDevice,MESSAGE_REQUEST_MACREG,MAC_REG_PAPEDELAY,LEDSTS_STS,LEDSTS_SLOW);
558 // unlock command busy
559 pItemSSID = (PWLAN_IE_SSID)pMgmt->abyCurrSSID;
560 pItemSSID->len = 0;
561 memset(pItemSSID->abySSID, 0, WLAN_SSID_MAXLEN);
562 pMgmt->eCurrState = WMAC_STATE_IDLE;
563 pMgmt->sNodeDBTable[0].bActive = FALSE;
564// pDevice->bBeaconBufReady = FALSE;
565 }
566 netif_stop_queue(pDevice->dev);
567 if (pDevice->bNeedRadioOFF == TRUE)
568 CARDbRadioPowerOff(pDevice);
569 s_bCommandComplete(pDevice);
570 break;
571
572
573 case WLAN_CMD_SSID_START:
574
575 pDevice->byReAssocCount = 0;
576 if (pDevice->bRadioOff == TRUE) {
577 s_bCommandComplete(pDevice);
578 spin_unlock_irq(&pDevice->lock);
579 return;
580 }
581
582//20080131-03,<Add> by Mike Liu
583 #ifdef Adhoc_STA
584 memcpy(pMgmt->abyAdHocSSID,pMgmt->abyDesireSSID,
585 ((PWLAN_IE_SSID)pMgmt->abyDesireSSID)->len + WLAN_IEHDR_LEN);
586 #endif
587 pItemSSID = (PWLAN_IE_SSID)pMgmt->abyDesireSSID;
588 pItemSSIDCurr = (PWLAN_IE_SSID)pMgmt->abyCurrSSID;
589 DBG_PRT(MSG_LEVEL_DEBUG, KERN_INFO" cmd: desire ssid = %s\n", pItemSSID->abySSID);
590 DBG_PRT(MSG_LEVEL_DEBUG, KERN_INFO" cmd: curr ssid = %s\n", pItemSSIDCurr->abySSID);
591
592 if (pMgmt->eCurrState == WMAC_STATE_ASSOC) {
593 DBG_PRT(MSG_LEVEL_DEBUG, KERN_INFO" Cmd pMgmt->eCurrState == WMAC_STATE_ASSOC\n");
594 DBG_PRT(MSG_LEVEL_DEBUG, KERN_INFO" pItemSSID->len =%d\n",pItemSSID->len);
595 DBG_PRT(MSG_LEVEL_DEBUG, KERN_INFO" pItemSSIDCurr->len = %d\n",pItemSSIDCurr->len);
596 DBG_PRT(MSG_LEVEL_DEBUG, KERN_INFO" desire ssid = %s\n", pItemSSID->abySSID);
597 DBG_PRT(MSG_LEVEL_DEBUG, KERN_INFO" curr ssid = %s\n", pItemSSIDCurr->abySSID);
598 }
599
600 if ((pMgmt->eCurrState == WMAC_STATE_ASSOC) ||
601 ((pMgmt->eCurrMode == WMAC_MODE_IBSS_STA)&& (pMgmt->eCurrState == WMAC_STATE_JOINTED))) {
602
603 if (pItemSSID->len == pItemSSIDCurr->len) {
604 if (memcmp(pItemSSID->abySSID, pItemSSIDCurr->abySSID, pItemSSID->len) == 0) {
605 s_bCommandComplete(pDevice);
606 spin_unlock_irq(&pDevice->lock);
607 return;
608 }
609 }
610 netif_stop_queue(pDevice->dev);
611 pDevice->bLinkPass = FALSE;
612 ControlvMaskByte(pDevice,MESSAGE_REQUEST_MACREG,MAC_REG_PAPEDELAY,LEDSTS_STS,LEDSTS_SLOW);
613 }
614 // set initial state
615 pMgmt->eCurrState = WMAC_STATE_IDLE;
616 pMgmt->eCurrMode = WMAC_MODE_STANDBY;
617 PSvDisablePowerSaving((HANDLE)pDevice);
618 BSSvClearNodeDBTable(pDevice, 0);
619 vMgrJoinBSSBegin((HANDLE)pDevice, &Status);
620 // if Infra mode
621 if ((pMgmt->eCurrMode == WMAC_MODE_ESS_STA) && (pMgmt->eCurrState == WMAC_STATE_JOINTED)) {
622 // Call mgr to begin the deauthentication
623 // reason = (3) beacuse sta has left ESS
624 if (pMgmt->eCurrState>= WMAC_STATE_AUTH) {
625 vMgrDeAuthenBeginSta((HANDLE)pDevice, pMgmt, pMgmt->abyCurrBSSID, (3), &Status);
626 }
627 // Call mgr to begin the authentication
628 vMgrAuthenBeginSta((HANDLE)pDevice, pMgmt, &Status);
629 if (Status == CMD_STATUS_SUCCESS) {
630 pDevice->byLinkWaitCount = 0;
631 pDevice->eCommandState = WLAN_AUTHENTICATE_WAIT;
632 vCommandTimerWait((HANDLE)pDevice, AUTHENTICATE_TIMEOUT);
633 spin_unlock_irq(&pDevice->lock);
634 DBG_PRT(MSG_LEVEL_DEBUG, KERN_INFO" Set eCommandState = WLAN_AUTHENTICATE_WAIT\n");
635 return;
636 }
637 }
638 // if Adhoc mode
639 else if (pMgmt->eCurrMode == WMAC_MODE_IBSS_STA) {
640 if (pMgmt->eCurrState == WMAC_STATE_JOINTED) {
641 if (netif_queue_stopped(pDevice->dev)){
642 netif_wake_queue(pDevice->dev);
643 }
644 pDevice->bLinkPass = TRUE;
645 ControlvMaskByte(pDevice,MESSAGE_REQUEST_MACREG,MAC_REG_PAPEDELAY,LEDSTS_STS,LEDSTS_INTER);
646 pMgmt->sNodeDBTable[0].bActive = TRUE;
647 pMgmt->sNodeDBTable[0].uInActiveCount = 0;
648 }
649 else {
650 // start own IBSS
651 DBG_PRT(MSG_LEVEL_DEBUG, KERN_INFO "CreateOwn IBSS by CurrMode = IBSS_STA \n");
652 vMgrCreateOwnIBSS((HANDLE)pDevice, &Status);
653 if (Status != CMD_STATUS_SUCCESS){
654 DBG_PRT(MSG_LEVEL_DEBUG, KERN_INFO " WLAN_CMD_IBSS_CREATE fail ! \n");
655 };
656 BSSvAddMulticastNode(pDevice);
657 }
658 s_bClearBSSID_SCAN(pDevice);
659 }
660 // if SSID not found
661 else if (pMgmt->eCurrMode == WMAC_MODE_STANDBY) {
662 if (pMgmt->eConfigMode == WMAC_CONFIG_IBSS_STA ||
663 pMgmt->eConfigMode == WMAC_CONFIG_AUTO) {
664 // start own IBSS
665 DBG_PRT(MSG_LEVEL_DEBUG, KERN_INFO "CreateOwn IBSS by CurrMode = STANDBY \n");
666 vMgrCreateOwnIBSS((HANDLE)pDevice, &Status);
667 if (Status != CMD_STATUS_SUCCESS){
668 DBG_PRT(MSG_LEVEL_DEBUG, KERN_INFO" WLAN_CMD_IBSS_CREATE fail ! \n");
669 };
670 BSSvAddMulticastNode(pDevice);
671 s_bClearBSSID_SCAN(pDevice);
672/*
673 pDevice->bLinkPass = TRUE;
674 ControlvMaskByte(pDevice,MESSAGE_REQUEST_MACREG,MAC_REG_PAPEDELAY,LEDSTS_STS,LEDSTS_INTER);
675 if (netif_queue_stopped(pDevice->dev)){
676 netif_wake_queue(pDevice->dev);
677 }
678 s_bClearBSSID_SCAN(pDevice);
679*/
680 }
681 else {
682 DBG_PRT(MSG_LEVEL_DEBUG, KERN_INFO "Disconnect SSID none\n");
683 #ifdef WPA_SUPPLICANT_DRIVER_WEXT_SUPPORT
684 // if(pDevice->bWPASuppWextEnabled == TRUE)
685 {
686 union iwreq_data wrqu;
687 memset(&wrqu, 0, sizeof (wrqu));
688 wrqu.ap_addr.sa_family = ARPHRD_ETHER;
689 PRINT_K("wireless_send_event--->SIOCGIWAP(disassociated:vMgrJoinBSSBegin Fail !!)\n");
690 wireless_send_event(pDevice->dev, SIOCGIWAP, &wrqu, NULL);
691 }
692 #endif
693 }
694 }
695 s_bCommandComplete(pDevice);
696 break;
697
698 case WLAN_AUTHENTICATE_WAIT :
699 DBG_PRT(MSG_LEVEL_DEBUG, KERN_INFO"eCommandState == WLAN_AUTHENTICATE_WAIT\n");
700 if (pMgmt->eCurrState == WMAC_STATE_AUTH) {
701 pDevice->byLinkWaitCount = 0;
702 // Call mgr to begin the association
703 DBG_PRT(MSG_LEVEL_DEBUG, KERN_INFO"eCurrState == WMAC_STATE_AUTH\n");
704 vMgrAssocBeginSta((HANDLE)pDevice, pMgmt, &Status);
705 if (Status == CMD_STATUS_SUCCESS) {
706 DBG_PRT(MSG_LEVEL_DEBUG, KERN_INFO"eCommandState = WLAN_ASSOCIATE_WAIT\n");
707 pDevice->byLinkWaitCount = 0;
708 pDevice->eCommandState = WLAN_ASSOCIATE_WAIT;
709 vCommandTimerWait((HANDLE)pDevice, ASSOCIATE_TIMEOUT);
710 spin_unlock_irq(&pDevice->lock);
711 return;
712 }
713 }
714 else if(pMgmt->eCurrState < WMAC_STATE_AUTHPENDING) {
715 printk("WLAN_AUTHENTICATE_WAIT:Authen Fail???\n");
716 }
717 else if(pDevice->byLinkWaitCount <= 4){ //mike add:wait another 2 sec if authenticated_frame delay!
718 pDevice->byLinkWaitCount ++;
719 printk("WLAN_AUTHENTICATE_WAIT:wait %d times!!\n",pDevice->byLinkWaitCount);
720 spin_unlock_irq(&pDevice->lock);
721 vCommandTimerWait((HANDLE)pDevice, AUTHENTICATE_TIMEOUT/2);
722 return;
723 }
724 pDevice->byLinkWaitCount = 0;
725 #if 0
726 #ifdef WPA_SUPPLICANT_DRIVER_WEXT_SUPPORT
727 // if(pDevice->bWPASuppWextEnabled == TRUE)
728 {
729 union iwreq_data wrqu;
730 memset(&wrqu, 0, sizeof (wrqu));
731 wrqu.ap_addr.sa_family = ARPHRD_ETHER;
732 printk("wireless_send_event--->SIOCGIWAP(disassociated:AUTHENTICATE_WAIT_timeout)\n");
733 wireless_send_event(pDevice->dev, SIOCGIWAP, &wrqu, NULL);
734 }
735 #endif
736 #endif
737
738 s_bCommandComplete(pDevice);
739 break;
740
741 case WLAN_ASSOCIATE_WAIT :
742 if (pMgmt->eCurrState == WMAC_STATE_ASSOC) {
743 DBG_PRT(MSG_LEVEL_DEBUG, KERN_INFO"eCurrState == WMAC_STATE_ASSOC\n");
744 if (pDevice->ePSMode != WMAC_POWER_CAM) {
745 PSvEnablePowerSaving((HANDLE)pDevice, pMgmt->wListenInterval);
746 }
747/*
748 if (pMgmt->eAuthenMode >= WMAC_AUTH_WPA) {
749 KeybRemoveAllKey(pDevice, &(pDevice->sKey), pDevice->abyBSSID);
750 }
751*/
752 pDevice->byLinkWaitCount = 0;
753 pDevice->byReAssocCount = 0;
754 pDevice->bLinkPass = TRUE;
755 ControlvMaskByte(pDevice,MESSAGE_REQUEST_MACREG,MAC_REG_PAPEDELAY,LEDSTS_STS,LEDSTS_INTER);
756 s_bClearBSSID_SCAN(pDevice);
757
758 if (netif_queue_stopped(pDevice->dev)){
759 netif_wake_queue(pDevice->dev);
760 }
761
762 //2007-0115-07<Add>by MikeLiu
763 #ifdef TxInSleep
764 if(pDevice->IsTxDataTrigger != FALSE) { //TxDataTimer is not triggered at the first time
765 // printk("Re-initial TxDataTimer****\n");
766 del_timer(&pDevice->sTimerTxData);
767 init_timer(&pDevice->sTimerTxData);
768 pDevice->sTimerTxData.data = (ULONG)pDevice;
769 pDevice->sTimerTxData.function = (TimerFunction)BSSvSecondTxData;
770 pDevice->sTimerTxData.expires = RUN_AT(10*HZ); //10s callback
771 pDevice->fTxDataInSleep = FALSE;
772 pDevice->nTxDataTimeCout = 0;
773 }
774 else {
775 // printk("mike:-->First time triger TimerTxData InSleep\n");
776 }
777 pDevice->IsTxDataTrigger = TRUE;
778 add_timer(&pDevice->sTimerTxData);
779 #endif
780
781 }
782 else if(pMgmt->eCurrState < WMAC_STATE_ASSOCPENDING) {
783 printk("WLAN_ASSOCIATE_WAIT:Association Fail???\n");
784 }
785 else if(pDevice->byLinkWaitCount <= 4){ //mike add:wait another 2 sec if associated_frame delay!
786 pDevice->byLinkWaitCount ++;
787 printk("WLAN_ASSOCIATE_WAIT:wait %d times!!\n",pDevice->byLinkWaitCount);
788 spin_unlock_irq(&pDevice->lock);
789 vCommandTimerWait((HANDLE)pDevice, ASSOCIATE_TIMEOUT/2);
790 return;
791 }
792 pDevice->byLinkWaitCount = 0;
793 #if 0
794 #ifdef WPA_SUPPLICANT_DRIVER_WEXT_SUPPORT
795 // if(pDevice->bWPASuppWextEnabled == TRUE)
796 {
797 union iwreq_data wrqu;
798 memset(&wrqu, 0, sizeof (wrqu));
799 wrqu.ap_addr.sa_family = ARPHRD_ETHER;
800 printk("wireless_send_event--->SIOCGIWAP(disassociated:ASSOCIATE_WAIT_timeout)\n");
801 wireless_send_event(pDevice->dev, SIOCGIWAP, &wrqu, NULL);
802 }
803 #endif
804 #endif
805
806 s_bCommandComplete(pDevice);
807 break;
808
809 case WLAN_CMD_AP_MODE_START :
810 DBG_PRT(MSG_LEVEL_DEBUG, KERN_INFO"eCommandState == WLAN_CMD_AP_MODE_START\n");
811
812 if (pMgmt->eConfigMode == WMAC_CONFIG_AP) {
813 del_timer(&pMgmt->sTimerSecondCallback);
814 pMgmt->eCurrState = WMAC_STATE_IDLE;
815 pMgmt->eCurrMode = WMAC_MODE_STANDBY;
816 pDevice->bLinkPass = FALSE;
817 ControlvMaskByte(pDevice,MESSAGE_REQUEST_MACREG,MAC_REG_PAPEDELAY,LEDSTS_STS,LEDSTS_SLOW);
818 if (pDevice->bEnableHostWEP == TRUE)
819 BSSvClearNodeDBTable(pDevice, 1);
820 else
821 BSSvClearNodeDBTable(pDevice, 0);
822 pDevice->uAssocCount = 0;
823 pMgmt->eCurrState = WMAC_STATE_IDLE;
824 pDevice->bFixRate = FALSE;
825
826 vMgrCreateOwnIBSS((HANDLE)pDevice, &Status);
827 if (Status != CMD_STATUS_SUCCESS){
828 DBG_PRT(MSG_LEVEL_DEBUG, KERN_INFO " vMgrCreateOwnIBSS fail ! \n");
829 };
830 // alway turn off unicast bit
831 MACvRegBitsOff(pDevice, MAC_REG_RCR, RCR_UNICAST);
832 pDevice->byRxMode &= ~RCR_UNICAST;
833 DBG_PRT(MSG_LEVEL_DEBUG, KERN_INFO "wcmd: rx_mode = %x\n", pDevice->byRxMode );
834 BSSvAddMulticastNode(pDevice);
835 if (netif_queue_stopped(pDevice->dev)){
836 netif_wake_queue(pDevice->dev);
837 }
838 pDevice->bLinkPass = TRUE;
839 ControlvMaskByte(pDevice,MESSAGE_REQUEST_MACREG,MAC_REG_PAPEDELAY,LEDSTS_STS,LEDSTS_INTER);
840 add_timer(&pMgmt->sTimerSecondCallback);
841 }
842 s_bCommandComplete(pDevice);
843 break;
844
845 case WLAN_CMD_TX_PSPACKET_START :
846 // DTIM Multicast tx
847 if (pMgmt->sNodeDBTable[0].bRxPSPoll) {
848 while ((skb = skb_dequeue(&pMgmt->sNodeDBTable[0].sTxPSQueue)) != NULL) {
849 if (skb_queue_empty(&pMgmt->sNodeDBTable[0].sTxPSQueue)) {
850 pMgmt->abyPSTxMap[0] &= ~byMask[0];
851 pDevice->bMoreData = FALSE;
852 }
853 else {
854 pDevice->bMoreData = TRUE;
855 }
856
857 if (nsDMA_tx_packet(pDevice, TYPE_AC0DMA, skb) != 0) {
858 DBG_PRT(MSG_LEVEL_DEBUG, KERN_INFO "Multicast ps tx fail \n");
859 }
860
861 pMgmt->sNodeDBTable[0].wEnQueueCnt--;
862 }
863 };
864
865 // PS nodes tx
866 for (ii = 1; ii < (MAX_NODE_NUM + 1); ii++) {
867 if (pMgmt->sNodeDBTable[ii].bActive &&
868 pMgmt->sNodeDBTable[ii].bRxPSPoll) {
869 DBG_PRT(MSG_LEVEL_DEBUG, KERN_INFO "Index=%d Enqueu Cnt= %d\n",
870 ii, pMgmt->sNodeDBTable[ii].wEnQueueCnt);
871 while ((skb = skb_dequeue(&pMgmt->sNodeDBTable[ii].sTxPSQueue)) != NULL) {
872 if (skb_queue_empty(&pMgmt->sNodeDBTable[ii].sTxPSQueue)) {
873 // clear tx map
874 pMgmt->abyPSTxMap[pMgmt->sNodeDBTable[ii].wAID >> 3] &=
875 ~byMask[pMgmt->sNodeDBTable[ii].wAID & 7];
876 pDevice->bMoreData = FALSE;
877 }
878 else {
879 pDevice->bMoreData = TRUE;
880 }
881
882 if (nsDMA_tx_packet(pDevice, TYPE_AC0DMA, skb) != 0) {
883 DBG_PRT(MSG_LEVEL_DEBUG, KERN_INFO "sta ps tx fail \n");
884 }
885
886 pMgmt->sNodeDBTable[ii].wEnQueueCnt--;
887 // check if sta ps enable, wait next pspoll
888 // if sta ps disable, send all pending buffers.
889 if (pMgmt->sNodeDBTable[ii].bPSEnable)
890 break;
891 }
892 if (skb_queue_empty(&pMgmt->sNodeDBTable[ii].sTxPSQueue)) {
893 // clear tx map
894 pMgmt->abyPSTxMap[pMgmt->sNodeDBTable[ii].wAID >> 3] &=
895 ~byMask[pMgmt->sNodeDBTable[ii].wAID & 7];
896 DBG_PRT(MSG_LEVEL_DEBUG, KERN_INFO "Index=%d PS queue clear \n", ii);
897 }
898 pMgmt->sNodeDBTable[ii].bRxPSPoll = FALSE;
899 }
900 }
901
902 s_bCommandComplete(pDevice);
903 break;
904
905 case WLAN_CMD_RADIO_START:
906
907 DBG_PRT(MSG_LEVEL_DEBUG, KERN_INFO"eCommandState == WLAN_CMD_RADIO_START\n");
908 // if (pDevice->bRadioCmd == TRUE)
909 // CARDbRadioPowerOn(pDevice);
910 // else
911 // CARDbRadioPowerOff(pDevice);
912 //2008-09-09<Add> BY Mike:Hot Key for Radio On/Off
913 {
914 NTSTATUS ntStatus = STATUS_SUCCESS;
915 BYTE byTmp;
916
917 ntStatus = CONTROLnsRequestIn(pDevice,
918 MESSAGE_TYPE_READ,
919 MAC_REG_GPIOCTL1,
920 MESSAGE_REQUEST_MACREG,
921 1,
922 &byTmp);
923
924 if ( ntStatus != STATUS_SUCCESS ) {
925 s_bCommandComplete(pDevice);
926 spin_unlock_irq(&pDevice->lock);
927 return;
928 }
929 if ( (byTmp & GPIO3_DATA) == 0 ) {
930 DBG_PRT(MSG_LEVEL_DEBUG, KERN_INFO" WLAN_CMD_RADIO_START_OFF........................\n");
931 // Old commands are useless.
932 // empty command Q
933 pDevice->cbFreeCmdQueue = CMD_Q_SIZE;
934 pDevice->uCmdDequeueIdx = 0;
935 pDevice->uCmdEnqueueIdx = 0;
936 //0415pDevice->bCmdRunning = FALSE;
937 pDevice->bCmdClear = TRUE;
938 pDevice->bStopTx0Pkt = FALSE;
939 pDevice->bStopDataPkt = TRUE;
940
941 pDevice->byKeyIndex = 0;
942 pDevice->bTransmitKey = FALSE;
943 spin_unlock_irq(&pDevice->lock);
944 KeyvInitTable(pDevice,&pDevice->sKey);
945 spin_lock_irq(&pDevice->lock);
946 pMgmt->byCSSPK = KEY_CTL_NONE;
947 pMgmt->byCSSGK = KEY_CTL_NONE;
948
949 if (pDevice->bLinkPass == TRUE) {
950 // reason = 8 : disassoc because sta has left
951 vMgrDisassocBeginSta((HANDLE)pDevice, pMgmt, pMgmt->abyCurrBSSID, (8), &Status);
952 pDevice->bLinkPass = FALSE;
953 // unlock command busy
954 pMgmt->eCurrState = WMAC_STATE_IDLE;
955 pMgmt->sNodeDBTable[0].bActive = FALSE;
956 #ifdef WPA_SUPPLICANT_DRIVER_WEXT_SUPPORT
957 // if(pDevice->bWPASuppWextEnabled == TRUE)
958 {
959 union iwreq_data wrqu;
960 memset(&wrqu, 0, sizeof (wrqu));
961 wrqu.ap_addr.sa_family = ARPHRD_ETHER;
962 PRINT_K("wireless_send_event--->SIOCGIWAP(disassociated)\n");
963 wireless_send_event(pDevice->dev, SIOCGIWAP, &wrqu, NULL);
964 }
965 #endif
966 }
967 #ifdef WPA_SUPPLICANT_DRIVER_WEXT_SUPPORT
968 pDevice->bwextstep0 = FALSE;
969 pDevice->bwextstep1 = FALSE;
970 pDevice->bwextstep2 = FALSE;
971 pDevice->bwextstep3 = FALSE;
972 pDevice->bWPASuppWextEnabled = FALSE;
973 #endif
974 //clear current SSID
975 pItemSSID = (PWLAN_IE_SSID)pMgmt->abyCurrSSID;
976 pItemSSID->len = 0;
977 memset(pItemSSID->abySSID, 0, WLAN_SSID_MAXLEN);
978 //clear dessire SSID
979 pItemSSID = (PWLAN_IE_SSID)pMgmt->abyDesireSSID;
980 pItemSSID->len = 0;
981 memset(pItemSSID->abySSID, 0, WLAN_SSID_MAXLEN);
982
983 netif_stop_queue(pDevice->dev);
984 CARDbRadioPowerOff(pDevice);
985 MACvRegBitsOn(pDevice,MAC_REG_GPIOCTL1,GPIO3_INTMD);
986 ControlvMaskByte(pDevice,MESSAGE_REQUEST_MACREG,MAC_REG_PAPEDELAY,LEDSTS_STS,LEDSTS_OFF);
987 pDevice->bHWRadioOff = TRUE;
988 } else {
989 DBG_PRT(MSG_LEVEL_DEBUG, KERN_INFO" WLAN_CMD_RADIO_START_ON........................\n");
990 pDevice->bHWRadioOff = FALSE;
991 CARDbRadioPowerOn(pDevice);
992 MACvRegBitsOff(pDevice,MAC_REG_GPIOCTL1,GPIO3_INTMD);
993 ControlvMaskByte(pDevice,MESSAGE_REQUEST_MACREG,MAC_REG_PAPEDELAY,LEDSTS_STS,LEDSTS_ON);
994 }
995 }
996
997 s_bCommandComplete(pDevice);
998 break;
999
1000
1001 case WLAN_CMD_CHANGE_BBSENSITIVITY_START:
1002
1003 pDevice->bStopDataPkt = TRUE;
1004 pDevice->byBBVGACurrent = pDevice->byBBVGANew;
1005 BBvSetVGAGainOffset(pDevice, pDevice->byBBVGACurrent);
1006 DBG_PRT(MSG_LEVEL_DEBUG, KERN_INFO"Change sensitivity pDevice->byBBVGACurrent = %x\n", pDevice->byBBVGACurrent);
1007 pDevice->bStopDataPkt = FALSE;
1008 s_bCommandComplete(pDevice);
1009 break;
1010
1011 case WLAN_CMD_TBTT_WAKEUP_START:
1012 PSbIsNextTBTTWakeUp(pDevice);
1013 s_bCommandComplete(pDevice);
1014 break;
1015
1016 case WLAN_CMD_BECON_SEND_START:
1017 bMgrPrepareBeaconToSend(pDevice, pMgmt);
1018 s_bCommandComplete(pDevice);
1019 break;
1020
1021 case WLAN_CMD_SETPOWER_START:
1022
1023 RFbSetPower(pDevice, pDevice->wCurrentRate, pMgmt->uCurrChannel);
1024
1025 s_bCommandComplete(pDevice);
1026 break;
1027
1028 case WLAN_CMD_CHANGE_ANTENNA_START:
1029 DBG_PRT(MSG_LEVEL_DEBUG, KERN_INFO"Change from Antenna%d to", (int)pDevice->dwRxAntennaSel);
1030 if ( pDevice->dwRxAntennaSel == 0) {
1031 pDevice->dwRxAntennaSel=1;
1032 if (pDevice->bTxRxAntInv == TRUE)
1033 BBvSetAntennaMode(pDevice, ANT_RXA);
1034 else
1035 BBvSetAntennaMode(pDevice, ANT_RXB);
1036 } else {
1037 pDevice->dwRxAntennaSel=0;
1038 if (pDevice->bTxRxAntInv == TRUE)
1039 BBvSetAntennaMode(pDevice, ANT_RXB);
1040 else
1041 BBvSetAntennaMode(pDevice, ANT_RXA);
1042 }
1043 s_bCommandComplete(pDevice);
1044 break;
1045
1046 case WLAN_CMD_REMOVE_ALLKEY_START:
1047 KeybRemoveAllKey(pDevice, &(pDevice->sKey), pDevice->abyBSSID);
1048 s_bCommandComplete(pDevice);
1049 break;
1050
1051
1052 case WLAN_CMD_MAC_DISPOWERSAVING_START:
1053 ControlvReadByte (pDevice, MESSAGE_REQUEST_MACREG, MAC_REG_PSCTL, &byData);
1054 if ( (byData & PSCTL_PS) != 0 ) {
1055 // disable power saving hw function
1056 CONTROLnsRequestOut(pDevice,
1057 MESSAGE_TYPE_DISABLE_PS,
1058 0,
1059 0,
1060 0,
1061 NULL
1062 );
1063 }
1064 s_bCommandComplete(pDevice);
1065 break;
1066
1067 case WLAN_CMD_11H_CHSW_START:
1068 CARDbSetMediaChannel(pDevice, pDevice->byNewChannel);
1069 pDevice->bChannelSwitch = FALSE;
1070 pMgmt->uCurrChannel = pDevice->byNewChannel;
1071 pDevice->bStopDataPkt = FALSE;
1072 s_bCommandComplete(pDevice);
1073 break;
1074
1075 default:
1076 s_bCommandComplete(pDevice);
1077 break;
1078 } //switch
1079
1080 spin_unlock_irq(&pDevice->lock);
1081 return;
1082}
1083
1084
1085static
1086BOOL
1087s_bCommandComplete (
1088 PSDevice pDevice
1089 )
1090{
1091 PWLAN_IE_SSID pSSID;
1092 BOOL bRadioCmd = FALSE;
1093 //WORD wDeAuthenReason = 0;
1094 BOOL bForceSCAN = TRUE;
1095 PSMgmtObject pMgmt = &(pDevice->sMgmtObj);
1096
1097
1098 pDevice->eCommandState = WLAN_CMD_IDLE;
1099 if (pDevice->cbFreeCmdQueue == CMD_Q_SIZE) {
1100 //Command Queue Empty
1101 pDevice->bCmdRunning = FALSE;
1102 return TRUE;
1103 }
1104 else {
1105 pDevice->eCommand = pDevice->eCmdQueue[pDevice->uCmdDequeueIdx].eCmd;
1106 pSSID = (PWLAN_IE_SSID)pDevice->eCmdQueue[pDevice->uCmdDequeueIdx].abyCmdDesireSSID;
1107 bRadioCmd = pDevice->eCmdQueue[pDevice->uCmdDequeueIdx].bRadioCmd;
1108 bForceSCAN = pDevice->eCmdQueue[pDevice->uCmdDequeueIdx].bForceSCAN;
1109 ADD_ONE_WITH_WRAP_AROUND(pDevice->uCmdDequeueIdx, CMD_Q_SIZE);
1110 pDevice->cbFreeCmdQueue++;
1111 pDevice->bCmdRunning = TRUE;
1112 switch ( pDevice->eCommand ) {
1113 case WLAN_CMD_BSSID_SCAN:
1114 DBG_PRT(MSG_LEVEL_DEBUG, KERN_INFO"eCommandState= WLAN_CMD_BSSID_SCAN\n");
1115 pDevice->eCommandState = WLAN_CMD_SCAN_START;
1116 pMgmt->uScanChannel = 0;
1117 if (pSSID->len != 0) {
3e362598 1118 memcpy(pMgmt->abyScanSSID, pSSID, WLAN_IEHDR_LEN + WLAN_SSID_MAXLEN + 1);
92b96797
FB		 1119 } else {
1120 memset(pMgmt->abyScanSSID, 0, WLAN_IEHDR_LEN + WLAN_SSID_MAXLEN + 1);
1121 }
1122/*
1123 if ((bForceSCAN == FALSE) && (pDevice->bLinkPass == TRUE)) {
1124 if ((pSSID->len == ((PWLAN_IE_SSID)pMgmt->abyCurrSSID)->len) &&
3e362598 1125 ( !memcmp(pSSID->abySSID, ((PWLAN_IE_SSID)pMgmt->abyCurrSSID)->abySSID, pSSID->len))) {
92b96797
FB		 1126 pDevice->eCommandState = WLAN_CMD_IDLE;
1127 }
1128 }
1129*/
1130 break;
1131 case WLAN_CMD_SSID:
1132 pDevice->eCommandState = WLAN_CMD_SSID_START;
1133 if (pSSID->len > WLAN_SSID_MAXLEN)
1134 pSSID->len = WLAN_SSID_MAXLEN;
1135 if (pSSID->len != 0)
3e362598 1136 memcpy(pMgmt->abyDesireSSID, pSSID, WLAN_IEHDR_LEN + WLAN_SSID_MAXLEN + 1);
92b96797
FB		 1137 DBG_PRT(MSG_LEVEL_DEBUG, KERN_INFO"eCommandState= WLAN_CMD_SSID_START\n");
1138 break;
1139 case WLAN_CMD_DISASSOCIATE:
1140 pDevice->eCommandState = WLAN_CMD_DISASSOCIATE_START;
1141 break;
1142 case WLAN_CMD_RX_PSPOLL:
1143 pDevice->eCommandState = WLAN_CMD_TX_PSPACKET_START;
1144 break;
1145 case WLAN_CMD_RUN_AP:
1146 pDevice->eCommandState = WLAN_CMD_AP_MODE_START;
1147 break;
1148 case WLAN_CMD_RADIO:
1149 pDevice->eCommandState = WLAN_CMD_RADIO_START;
1150 pDevice->bRadioCmd = bRadioCmd;
1151 break;
1152 case WLAN_CMD_CHANGE_BBSENSITIVITY:
1153 pDevice->eCommandState = WLAN_CMD_CHANGE_BBSENSITIVITY_START;
1154 break;
1155
1156 case WLAN_CMD_TBTT_WAKEUP:
1157 pDevice->eCommandState = WLAN_CMD_TBTT_WAKEUP_START;
1158 break;
1159
1160 case WLAN_CMD_BECON_SEND:
1161 pDevice->eCommandState = WLAN_CMD_BECON_SEND_START;
1162 break;
1163
1164 case WLAN_CMD_SETPOWER:
1165 pDevice->eCommandState = WLAN_CMD_SETPOWER_START;
1166 break;
1167
1168 case WLAN_CMD_CHANGE_ANTENNA:
1169 pDevice->eCommandState = WLAN_CMD_CHANGE_ANTENNA_START;
1170 break;
1171
1172 case WLAN_CMD_REMOVE_ALLKEY:
1173 pDevice->eCommandState = WLAN_CMD_REMOVE_ALLKEY_START;
1174 break;
1175
1176 case WLAN_CMD_MAC_DISPOWERSAVING:
1177 pDevice->eCommandState = WLAN_CMD_MAC_DISPOWERSAVING_START;
1178 break;
1179
1180 case WLAN_CMD_11H_CHSW:
1181 pDevice->eCommandState = WLAN_CMD_11H_CHSW_START;
1182 break;
1183
1184 default:
1185 break;
1186
1187 }
1188
1189 vCommandTimerWait((HANDLE)pDevice, 0);
1190 }
1191
1192 return TRUE;
1193}
1194
1195BOOL bScheduleCommand (
1196 IN HANDLE hDeviceContext,
1197 IN CMD_CODE eCommand,
1198 IN PBYTE pbyItem0
1199 )
1200{
1201 PSDevice pDevice = (PSDevice)hDeviceContext;
1202
1203
1204 if (pDevice->cbFreeCmdQueue == 0) {
1205 return (FALSE);
1206 }
1207 pDevice->eCmdQueue[pDevice->uCmdEnqueueIdx].eCmd = eCommand;
1208 pDevice->eCmdQueue[pDevice->uCmdEnqueueIdx].bForceSCAN = TRUE;
1209 memset(pDevice->eCmdQueue[pDevice->uCmdEnqueueIdx].abyCmdDesireSSID, 0 , WLAN_IEHDR_LEN + WLAN_SSID_MAXLEN + 1);
1210 if (pbyItem0 != NULL) {
1211 switch (eCommand) {
1212 case WLAN_CMD_BSSID_SCAN:
1213 pDevice->eCmdQueue[pDevice->uCmdEnqueueIdx].bForceSCAN = FALSE;
3e362598 1214 memcpy(pDevice->eCmdQueue[pDevice->uCmdEnqueueIdx].abyCmdDesireSSID,
92b96797
FB		 1215 pbyItem0, WLAN_IEHDR_LEN + WLAN_SSID_MAXLEN + 1);
1216 break;
1217
1218 case WLAN_CMD_SSID:
3e362598 1219 memcpy(pDevice->eCmdQueue[pDevice->uCmdEnqueueIdx].abyCmdDesireSSID,
92b96797
FB		 1220 pbyItem0, WLAN_IEHDR_LEN + WLAN_SSID_MAXLEN + 1);
1221 break;
1222
1223 case WLAN_CMD_DISASSOCIATE:
193a823c 1224 pDevice->eCmdQueue[pDevice->uCmdEnqueueIdx].bNeedRadioOFF = *((int *)pbyItem0);
92b96797
FB		 1225 break;
1226/*
1227 case WLAN_CMD_DEAUTH:
1228 pDevice->eCmdQueue[pDevice->uCmdEnqueueIdx].wDeAuthenReason = *((PWORD)pbyItem0);
1229 break;
1230*/
1231
1232 case WLAN_CMD_RADIO:
193a823c 1233 pDevice->eCmdQueue[pDevice->uCmdEnqueueIdx].bRadioCmd = *((int *)pbyItem0);
92b96797
FB		 1234 break;
1235
1236 default:
1237 break;
1238 }
1239 }
1240
1241 ADD_ONE_WITH_WRAP_AROUND(pDevice->uCmdEnqueueIdx, CMD_Q_SIZE);
1242 pDevice->cbFreeCmdQueue--;
1243
1244 if (pDevice->bCmdRunning == FALSE) {
1245 s_bCommandComplete(pDevice);
1246 }
1247 else {
1248 }
1249 return (TRUE);
1250
1251}
1252
1253/*
1254 * Description:
1255 * Clear BSSID_SCAN cmd in CMD Queue
1256 *
1257 * Parameters:
1258 * In:
1259 * hDeviceContext - Pointer to the adapter
1260 * eCommand - Command
1261 * Out:
1262 * none
1263 *
1264 * Return Value: TRUE if success; otherwise FALSE
1265 *
1266 */
1267static
1268BOOL s_bClearBSSID_SCAN (
1269 IN HANDLE hDeviceContext
1270 )
1271{
1272 PSDevice pDevice = (PSDevice)hDeviceContext;
1273 UINT uCmdDequeueIdx = pDevice->uCmdDequeueIdx;
1274 UINT ii;
1275
1276 if ((pDevice->cbFreeCmdQueue < CMD_Q_SIZE) && (uCmdDequeueIdx != pDevice->uCmdEnqueueIdx)) {
1277 for (ii = 0; ii < (CMD_Q_SIZE - pDevice->cbFreeCmdQueue); ii ++) {
1278 if (pDevice->eCmdQueue[uCmdDequeueIdx].eCmd == WLAN_CMD_BSSID_SCAN)
1279 pDevice->eCmdQueue[uCmdDequeueIdx].eCmd = WLAN_CMD_IDLE;
1280 ADD_ONE_WITH_WRAP_AROUND(uCmdDequeueIdx, CMD_Q_SIZE);
1281 if (uCmdDequeueIdx == pDevice->uCmdEnqueueIdx)
1282 break;
1283 }
1284 }
1285 return TRUE;
1286}
1287
1288
1289//mike add:reset command timer
1290VOID
1291vResetCommandTimer(
1292 IN HANDLE hDeviceContext
1293 )
1294{
1295 PSDevice pDevice = (PSDevice)hDeviceContext;
1296
1297 //delete timer
1298 del_timer(&pDevice->sTimerCommand);
1299 //init timer
1300 init_timer(&pDevice->sTimerCommand);
1301 pDevice->sTimerCommand.data = (ULONG)pDevice;
1302 pDevice->sTimerCommand.function = (TimerFunction)vRunCommand;
1303 pDevice->sTimerCommand.expires = RUN_AT(HZ);
1304 pDevice->cbFreeCmdQueue = CMD_Q_SIZE;
1305 pDevice->uCmdDequeueIdx = 0;
1306 pDevice->uCmdEnqueueIdx = 0;
1307 pDevice->eCommandState = WLAN_CMD_IDLE;
1308 pDevice->bCmdRunning = FALSE;
1309 pDevice->bCmdClear = FALSE;
1310}
1311
1312//2007-0115-08<Add>by MikeLiu
1313#ifdef TxInSleep
1314VOID
1315BSSvSecondTxData(
1316 IN HANDLE hDeviceContext
1317 )
1318{
1319 PSDevice pDevice = (PSDevice)hDeviceContext;
1320 PSMgmtObject pMgmt = &(pDevice->sMgmtObj);
1321
1322 pDevice->nTxDataTimeCout++;
1323
1324 if(pDevice->nTxDataTimeCout<4) //don't tx data if timer less than 40s
1325 {
1326 // printk("mike:%s-->no data Tx not exceed the desired Time as %d\n",__FUNCTION__,
1327 // (int)pDevice->nTxDataTimeCout);
1328 pDevice->sTimerTxData.expires = RUN_AT(10*HZ); //10s callback
1329 add_timer(&pDevice->sTimerTxData);
1330 return;
1331 }
1332
1333 spin_lock_irq(&pDevice->lock);
bbc9a991 1334 //is wap_supplicant running successful OR only open && sharekey mode!
92b96797
FB		 1335 #if 1
1336 if(((pDevice->bLinkPass ==TRUE)&&(pMgmt->eAuthenMode < WMAC_AUTH_WPA)) || //open && sharekey linking
1337 (pDevice->fWPA_Authened == TRUE)) { //wpa linking
1338 #else
1339 if(pDevice->bLinkPass ==TRUE) {
1340 #endif
1341 // printk("mike:%s-->InSleep Tx Data Procedure\n",__FUNCTION__);
1342 pDevice->fTxDataInSleep = TRUE;
1343 PSbSendNullPacket(pDevice); //send null packet
1344 pDevice->fTxDataInSleep = FALSE;
1345 }
1346 spin_unlock_irq(&pDevice->lock);
1347
1348 pDevice->sTimerTxData.expires = RUN_AT(10*HZ); //10s callback
1349 add_timer(&pDevice->sTimerTxData);
1350 return;
1351}
1352#endif
1353
kernel source for telekom puls (alcatel/mediatek)