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