SAFE public projects git trees. - safe/jmp/linux-2.6/blob - drivers/staging/vt6656/wcmd.c

   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 "baseband.h"
  52 #include "control.h"
  53 #include "rxtx.h"
  54 #include "rf.h"
  55 #include "rndis.h"
  56 #include "channel.h"
  57 #include "iowpa.h"
  58
  59 /*---------------------  Static Definitions -------------------------*/
  60
  61
  62
  63
  64 /*---------------------  Static Classes  ----------------------------*/
  65
  66 /*---------------------  Static Variables  --------------------------*/
  67 static int          msglevel                =MSG_LEVEL_INFO;
  68 //static int          msglevel                =MSG_LEVEL_DEBUG;
  69 /*---------------------  Static Functions  --------------------------*/
  70
  71 static
  72 VOID
  73 s_vProbeChannel(
  74     IN PSDevice pDevice
  75     );
  76
  77
  78 static
  79 PSTxMgmtPacket
  80 s_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
  90 static
  91 BOOL
  92 s_bCommandComplete (
  93     PSDevice pDevice
  94     );
  95
  96
  97 static
  98 BOOL 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  */
 122 static
 123 void
 124 vAdHocBeaconStop(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  */
 179 static
 180 void
 181 vAdHocBeaconRestart(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
 212 static
 213 VOID
 214 s_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
 276 PSTxMgmtPacket
 277 s_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
 328 VOID
 329 vCommandTimerWait(
 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
 348 VOID
 349 vRunCommand(
 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);
 483                      vCommandTimerWait((HANDLE)pDevice, 100);
 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
1085 static
1086 BOOL
1087 s_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) {
1118                     memcpy(pMgmt->abyScanSSID, pSSID, WLAN_IEHDR_LEN + WLAN_SSID_MAXLEN + 1);
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) &&
1125                         ( !memcmp(pSSID->abySSID, ((PWLAN_IE_SSID)pMgmt->abyCurrSSID)->abySSID, pSSID->len))) {
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)
1136                     memcpy(pMgmt->abyDesireSSID, pSSID, WLAN_IEHDR_LEN + WLAN_SSID_MAXLEN + 1);
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
1195 BOOL 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;
1214                 memcpy(pDevice->eCmdQueue[pDevice->uCmdEnqueueIdx].abyCmdDesireSSID,
1215                          pbyItem0, WLAN_IEHDR_LEN + WLAN_SSID_MAXLEN + 1);
1216                 break;
1217
1218             case WLAN_CMD_SSID:
1219                 memcpy(pDevice->eCmdQueue[pDevice->uCmdEnqueueIdx].abyCmdDesireSSID,
1220                          pbyItem0, WLAN_IEHDR_LEN + WLAN_SSID_MAXLEN + 1);
1221                 break;
1222
1223             case WLAN_CMD_DISASSOCIATE:
1224                 pDevice->eCmdQueue[pDevice->uCmdEnqueueIdx].bNeedRadioOFF = *((int *)pbyItem0);
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:
1233                 pDevice->eCmdQueue[pDevice->uCmdEnqueueIdx].bRadioCmd = *((int *)pbyItem0);
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  */
1267 static
1268 BOOL 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
1290 VOID
1291 vResetCommandTimer(
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
1314 VOID
1315 BSSvSecondTxData(
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);
1334   //is wap_supplicant running successful OR only open && sharekey mode!
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