git.oblomov.eu Git - linux-2.6/blob - drivers/staging/rt2860/sta/sync.c

   1 /*
   2  *************************************************************************
   3  * Ralink Tech Inc.
   4  * 5F., No.36, Taiyuan St., Jhubei City,
   5  * Hsinchu County 302,
   6  * Taiwan, R.O.C.
   7  *
   8  * (c) Copyright 2002-2007, Ralink Technology, Inc.
   9  *
  10  * This program is free software; you can redistribute it and/or modify  *
  11  * it under the terms of the GNU General Public License as published by  *
  12  * the Free Software Foundation; either version 2 of the License, or     *
  13  * (at your option) any later version.                                   *
  14  *                                                                       *
  15  * This program is distributed in the hope that it will be useful,       *
  16  * but WITHOUT ANY WARRANTY; without even the implied warranty of        *
  17  * MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE.  See the         *
  18  * GNU General Public License for more details.                          *
  19  *                                                                       *
  20  * You should have received a copy of the GNU General Public License     *
  21  * along with this program; if not, write to the                         *
  22  * Free Software Foundation, Inc.,                                       *
  23  * 59 Temple Place - Suite 330, Boston, MA  02111-1307, USA.             *
  24  *                                                                       *
  25  *************************************************************************
  26
  27         Module Name:
  28         sync.c
  29
  30         Abstract:
  31
  32         Revision History:
  33         Who                     When                    What
  34         --------        ----------              ----------------------------------------------
  35         John Chang      2004-09-01      modified for rt2561/2661
  36         Jan Lee         2006-08-01      modified for rt2860 for 802.11n
  37 */
  38 #include "../rt_config.h"
  39
  40 #define AC0_DEF_TXOP            0
  41 #define AC1_DEF_TXOP            0
  42 #define AC2_DEF_TXOP            94
  43 #define AC3_DEF_TXOP            47
  44
  45 VOID    AdhocTurnOnQos(
  46         IN  PRTMP_ADAPTER pAd)
  47 {
  48         // Turn on QOs if use HT rate.
  49         if (pAd->CommonCfg.APEdcaParm.bValid == FALSE)
  50         {
  51                 pAd->CommonCfg.APEdcaParm.bValid = TRUE;
  52                 pAd->CommonCfg.APEdcaParm.Aifsn[0] = 3;
  53                 pAd->CommonCfg.APEdcaParm.Aifsn[1] = 7;
  54                 pAd->CommonCfg.APEdcaParm.Aifsn[2] = 1;
  55                 pAd->CommonCfg.APEdcaParm.Aifsn[3] = 1;
  56
  57                 pAd->CommonCfg.APEdcaParm.Cwmin[0] = 4;
  58                 pAd->CommonCfg.APEdcaParm.Cwmin[1] = 4;
  59                 pAd->CommonCfg.APEdcaParm.Cwmin[2] = 3;
  60                 pAd->CommonCfg.APEdcaParm.Cwmin[3] = 2;
  61
  62                 pAd->CommonCfg.APEdcaParm.Cwmax[0] = 10;
  63                 pAd->CommonCfg.APEdcaParm.Cwmax[1] = 6;
  64                 pAd->CommonCfg.APEdcaParm.Cwmax[2] = 4;
  65                 pAd->CommonCfg.APEdcaParm.Cwmax[3] = 3;
  66
  67                 pAd->CommonCfg.APEdcaParm.Txop[0]  = 0;
  68                 pAd->CommonCfg.APEdcaParm.Txop[1]  = 0;
  69                 pAd->CommonCfg.APEdcaParm.Txop[2]  = AC2_DEF_TXOP;
  70                 pAd->CommonCfg.APEdcaParm.Txop[3]  = AC3_DEF_TXOP;
  71         }
  72         AsicSetEdcaParm(pAd, &pAd->CommonCfg.APEdcaParm);
  73 }
  74
  75 /*
  76         ==========================================================================
  77         Description:
  78                 The sync state machine,
  79         Parameters:
  80                 Sm - pointer to the state machine
  81         Note:
  82                 the state machine looks like the following
  83
  84         ==========================================================================
  85  */
  86 VOID SyncStateMachineInit(
  87         IN PRTMP_ADAPTER pAd,
  88         IN STATE_MACHINE *Sm,
  89         OUT STATE_MACHINE_FUNC Trans[])
  90 {
  91         StateMachineInit(Sm, Trans, MAX_SYNC_STATE, MAX_SYNC_MSG, (STATE_MACHINE_FUNC)Drop, SYNC_IDLE, SYNC_MACHINE_BASE);
  92
  93         // column 1
  94         StateMachineSetAction(Sm, SYNC_IDLE, MT2_MLME_SCAN_REQ, (STATE_MACHINE_FUNC)MlmeScanReqAction);
  95         StateMachineSetAction(Sm, SYNC_IDLE, MT2_MLME_JOIN_REQ, (STATE_MACHINE_FUNC)MlmeJoinReqAction);
  96         StateMachineSetAction(Sm, SYNC_IDLE, MT2_MLME_START_REQ, (STATE_MACHINE_FUNC)MlmeStartReqAction);
  97         StateMachineSetAction(Sm, SYNC_IDLE, MT2_PEER_BEACON, (STATE_MACHINE_FUNC)PeerBeacon);
  98         StateMachineSetAction(Sm, SYNC_IDLE, MT2_PEER_PROBE_REQ, (STATE_MACHINE_FUNC)PeerProbeReqAction);
  99
 100         //column 2
 101         StateMachineSetAction(Sm, JOIN_WAIT_BEACON, MT2_MLME_SCAN_REQ, (STATE_MACHINE_FUNC)InvalidStateWhenScan);
 102         StateMachineSetAction(Sm, JOIN_WAIT_BEACON, MT2_MLME_JOIN_REQ, (STATE_MACHINE_FUNC)InvalidStateWhenJoin);
 103         StateMachineSetAction(Sm, JOIN_WAIT_BEACON, MT2_MLME_START_REQ, (STATE_MACHINE_FUNC)InvalidStateWhenStart);
 104         StateMachineSetAction(Sm, JOIN_WAIT_BEACON, MT2_PEER_BEACON, (STATE_MACHINE_FUNC)PeerBeaconAtJoinAction);
 105         StateMachineSetAction(Sm, JOIN_WAIT_BEACON, MT2_BEACON_TIMEOUT, (STATE_MACHINE_FUNC)BeaconTimeoutAtJoinAction);
 106
 107         // column 3
 108         StateMachineSetAction(Sm, SCAN_LISTEN, MT2_MLME_SCAN_REQ, (STATE_MACHINE_FUNC)InvalidStateWhenScan);
 109         StateMachineSetAction(Sm, SCAN_LISTEN, MT2_MLME_JOIN_REQ, (STATE_MACHINE_FUNC)InvalidStateWhenJoin);
 110         StateMachineSetAction(Sm, SCAN_LISTEN, MT2_MLME_START_REQ, (STATE_MACHINE_FUNC)InvalidStateWhenStart);
 111         StateMachineSetAction(Sm, SCAN_LISTEN, MT2_PEER_BEACON, (STATE_MACHINE_FUNC)PeerBeaconAtScanAction);
 112         StateMachineSetAction(Sm, SCAN_LISTEN, MT2_PEER_PROBE_RSP, (STATE_MACHINE_FUNC)PeerBeaconAtScanAction);
 113         StateMachineSetAction(Sm, SCAN_LISTEN, MT2_SCAN_TIMEOUT, (STATE_MACHINE_FUNC)ScanTimeoutAction);
 114
 115         // timer init
 116         RTMPInitTimer(pAd, &pAd->MlmeAux.BeaconTimer, GET_TIMER_FUNCTION(BeaconTimeout), pAd, FALSE);
 117         RTMPInitTimer(pAd, &pAd->MlmeAux.ScanTimer, GET_TIMER_FUNCTION(ScanTimeout), pAd, FALSE);
 118 }
 119
 120 /*
 121         ==========================================================================
 122         Description:
 123                 Beacon timeout handler, executed in timer thread
 124
 125         IRQL = DISPATCH_LEVEL
 126
 127         ==========================================================================
 128  */
 129 VOID BeaconTimeout(
 130         IN PVOID SystemSpecific1,
 131         IN PVOID FunctionContext,
 132         IN PVOID SystemSpecific2,
 133         IN PVOID SystemSpecific3)
 134 {
 135         RTMP_ADAPTER *pAd = (RTMP_ADAPTER *)FunctionContext;
 136
 137         DBGPRINT(RT_DEBUG_TRACE,("SYNC - BeaconTimeout\n"));
 138
 139         // Do nothing if the driver is starting halt state.
 140         // This might happen when timer already been fired before cancel timer with mlmehalt
 141         if (RTMP_TEST_FLAG(pAd, fRTMP_ADAPTER_HALT_IN_PROGRESS))
 142                 return;
 143
 144 #ifdef DOT11_N_SUPPORT
 145         if ((pAd->CommonCfg.BBPCurrentBW == BW_40)
 146                 )
 147         {
 148                 UCHAR        BBPValue = 0;
 149                 AsicSwitchChannel(pAd, pAd->CommonCfg.CentralChannel, FALSE);
 150                 AsicLockChannel(pAd, pAd->CommonCfg.CentralChannel);
 151                 RTMP_BBP_IO_READ8_BY_REG_ID(pAd, BBP_R4, &BBPValue);
 152                 BBPValue &= (~0x18);
 153                 BBPValue |= 0x10;
 154                 RTMP_BBP_IO_WRITE8_BY_REG_ID(pAd, BBP_R4, BBPValue);
 155                 DBGPRINT(RT_DEBUG_TRACE, ("SYNC - End of SCAN, restore to 40MHz channel %d, Total BSS[%02d]\n",pAd->CommonCfg.CentralChannel, pAd->ScanTab.BssNr));
 156         }
 157 #endif // DOT11_N_SUPPORT //
 158
 159         MlmeEnqueue(pAd, SYNC_STATE_MACHINE, MT2_BEACON_TIMEOUT, 0, NULL);
 160         RT28XX_MLME_HANDLER(pAd);
 161 }
 162
 163 /*
 164         ==========================================================================
 165         Description:
 166                 Scan timeout handler, executed in timer thread
 167
 168         IRQL = DISPATCH_LEVEL
 169
 170         ==========================================================================
 171  */
 172 VOID ScanTimeout(
 173         IN PVOID SystemSpecific1,
 174         IN PVOID FunctionContext,
 175         IN PVOID SystemSpecific2,
 176         IN PVOID SystemSpecific3)
 177 {
 178         RTMP_ADAPTER *pAd = (RTMP_ADAPTER *)FunctionContext;
 179
 180
 181         // Do nothing if the driver is starting halt state.
 182         // This might happen when timer already been fired before cancel timer with mlmehalt
 183         if (RTMP_TEST_FLAG(pAd, fRTMP_ADAPTER_HALT_IN_PROGRESS))
 184                 return;
 185
 186         if (MlmeEnqueue(pAd, SYNC_STATE_MACHINE, MT2_SCAN_TIMEOUT, 0, NULL))
 187         {
 188                 RT28XX_MLME_HANDLER(pAd);
 189         }
 190         else
 191         {
 192                 // To prevent SyncMachine.CurrState is SCAN_LISTEN forever.
 193                 pAd->MlmeAux.Channel = 0;
 194                 ScanNextChannel(pAd);
 195                 if (pAd->CommonCfg.bWirelessEvent)
 196                 {
 197                         RTMPSendWirelessEvent(pAd, IW_SCAN_ENQUEUE_FAIL_EVENT_FLAG, pAd->MacTab.Content[BSSID_WCID].Addr, BSS0, 0);
 198                 }
 199         }
 200 }
 201
 202 /*
 203         ==========================================================================
 204         Description:
 205                 MLME SCAN req state machine procedure
 206         ==========================================================================
 207  */
 208 VOID MlmeScanReqAction(
 209         IN PRTMP_ADAPTER pAd,
 210         IN MLME_QUEUE_ELEM *Elem)
 211 {
 212         UCHAR          Ssid[MAX_LEN_OF_SSID], SsidLen, ScanType, BssType, BBPValue = 0;
 213         BOOLEAN        TimerCancelled;
 214         ULONG              Now;
 215         USHORT         Status;
 216         PHEADER_802_11 pHdr80211;
 217         PUCHAR         pOutBuffer = NULL;
 218         NDIS_STATUS    NStatus;
 219
 220         // Check the total scan tries for one single OID command
 221         // If this is the CCX 2.0 Case, skip that!
 222         if ( !RTMP_TEST_FLAG(pAd, fRTMP_ADAPTER_START_UP))
 223         {
 224                 DBGPRINT(RT_DEBUG_TRACE, ("SYNC - MlmeScanReqAction before Startup\n"));
 225                 return;
 226         }
 227
 228         // Increase the scan retry counters.
 229         pAd->StaCfg.ScanCnt++;
 230
 231 #ifdef RT2860
 232     if ((OPSTATUS_TEST_FLAG(pAd, fOP_STATUS_ADVANCE_POWER_SAVE_PCIE_DEVICE)) &&
 233         (IDLE_ON(pAd)) &&
 234                 (pAd->StaCfg.bRadio == TRUE) &&
 235                 (RTMP_TEST_FLAG(pAd, fRTMP_ADAPTER_IDLE_RADIO_OFF)))
 236         {
 237                 RT28xxPciAsicRadioOn(pAd, GUI_IDLE_POWER_SAVE);
 238         }
 239 #endif // RT2860 //
 240
 241         // first check the parameter sanity
 242         if (MlmeScanReqSanity(pAd,
 243                                                   Elem->Msg,
 244                                                   Elem->MsgLen,
 245                                                   &BssType,
 246                                                   Ssid,
 247                                                   &SsidLen,
 248                                                   &ScanType))
 249         {
 250
 251                 // Check for channel load and noise hist request
 252                 // Suspend MSDU only at scan request, not the last two mentioned
 253                 if ((ScanType == SCAN_CISCO_NOISE) || (ScanType == SCAN_CISCO_CHANNEL_LOAD))
 254                 {
 255                         if (pAd->StaCfg.CCXScanChannel != pAd->CommonCfg.Channel)
 256                                 RTMPSuspendMsduTransmission(pAd);                       // Suspend MSDU transmission here
 257                 }
 258                 else
 259                 {
 260                         // Suspend MSDU transmission here
 261                         RTMPSuspendMsduTransmission(pAd);
 262                 }
 263
 264                 //
 265                 // To prevent data lost.
 266                 // Send an NULL data with turned PSM bit on to current associated AP before SCAN progress.
 267                 // And should send an NULL data with turned PSM bit off to AP, when scan progress done
 268                 //
 269                 if (OPSTATUS_TEST_FLAG(pAd, fOP_STATUS_MEDIA_STATE_CONNECTED) && (INFRA_ON(pAd)))
 270                 {
 271                         NStatus = MlmeAllocateMemory(pAd, (PVOID)&pOutBuffer);
 272                         if (NStatus     == NDIS_STATUS_SUCCESS)
 273                         {
 274                                 pHdr80211 = (PHEADER_802_11) pOutBuffer;
 275                                 MgtMacHeaderInit(pAd, pHdr80211, SUBTYPE_NULL_FUNC, 1, pAd->CommonCfg.Bssid, pAd->CommonCfg.Bssid);
 276                                 pHdr80211->Duration = 0;
 277                                 pHdr80211->FC.Type = BTYPE_DATA;
 278                                 pHdr80211->FC.PwrMgmt = PWR_SAVE;
 279
 280                                 // Send using priority queue
 281                                 MiniportMMRequest(pAd, 0, pOutBuffer, sizeof(HEADER_802_11));
 282                                 DBGPRINT(RT_DEBUG_TRACE, ("MlmeScanReqAction -- Send PSM Data frame for off channel RM\n"));
 283                                 MlmeFreeMemory(pAd, pOutBuffer);
 284                                 RTMPusecDelay(5000);
 285                         }
 286                 }
 287
 288                 NdisGetSystemUpTime(&Now);
 289                 pAd->StaCfg.LastScanTime = Now;
 290                 // reset all the timers
 291                 RTMPCancelTimer(&pAd->MlmeAux.BeaconTimer, &TimerCancelled);
 292                 RTMPCancelTimer(&pAd->MlmeAux.ScanTimer, &TimerCancelled);
 293
 294                 // record desired BSS parameters
 295                 pAd->MlmeAux.BssType = BssType;
 296                 pAd->MlmeAux.ScanType = ScanType;
 297                 pAd->MlmeAux.SsidLen = SsidLen;
 298         NdisZeroMemory(pAd->MlmeAux.Ssid, MAX_LEN_OF_SSID);
 299                 NdisMoveMemory(pAd->MlmeAux.Ssid, Ssid, SsidLen);
 300
 301                 // start from the first channel
 302                 pAd->MlmeAux.Channel = FirstChannel(pAd);
 303
 304                 // Change the scan channel when dealing with CCX beacon report
 305                 if ((ScanType == SCAN_CISCO_PASSIVE) || (ScanType == SCAN_CISCO_ACTIVE) ||
 306                         (ScanType == SCAN_CISCO_CHANNEL_LOAD) || (ScanType == SCAN_CISCO_NOISE))
 307                         pAd->MlmeAux.Channel = pAd->StaCfg.CCXScanChannel;
 308
 309                 // Let BBP register at 20MHz to do scan
 310                 RTMP_BBP_IO_READ8_BY_REG_ID(pAd, BBP_R4, &BBPValue);
 311                 BBPValue &= (~0x18);
 312                 RTMP_BBP_IO_WRITE8_BY_REG_ID(pAd, BBP_R4, BBPValue);
 313                 DBGPRINT(RT_DEBUG_TRACE, ("SYNC - BBP R4 to 20MHz.l\n"));
 314                 ScanNextChannel(pAd);
 315         }
 316         else
 317         {
 318                 DBGPRINT_ERR(("SYNC - MlmeScanReqAction() sanity check fail\n"));
 319                 pAd->Mlme.SyncMachine.CurrState = SYNC_IDLE;
 320                 Status = MLME_INVALID_FORMAT;
 321                 MlmeEnqueue(pAd, MLME_CNTL_STATE_MACHINE, MT2_SCAN_CONF, 2, &Status);
 322         }
 323 }
 324
 325 /*
 326         ==========================================================================
 327         Description:
 328                 MLME JOIN req state machine procedure
 329         ==========================================================================
 330  */
 331 VOID MlmeJoinReqAction(
 332         IN PRTMP_ADAPTER pAd,
 333         IN MLME_QUEUE_ELEM *Elem)
 334 {
 335         UCHAR        BBPValue = 0;
 336         BSS_ENTRY    *pBss;
 337         BOOLEAN       TimerCancelled;
 338         HEADER_802_11 Hdr80211;
 339         NDIS_STATUS   NStatus;
 340         ULONG         FrameLen = 0;
 341         PUCHAR        pOutBuffer = NULL;
 342         PUCHAR        pSupRate = NULL;
 343         UCHAR         SupRateLen;
 344         PUCHAR        pExtRate = NULL;
 345         UCHAR         ExtRateLen;
 346         UCHAR         ASupRate[] = {0x8C, 0x12, 0x98, 0x24, 0xb0, 0x48, 0x60, 0x6C};
 347         UCHAR         ASupRateLen = sizeof(ASupRate)/sizeof(UCHAR);
 348         MLME_JOIN_REQ_STRUCT *pInfo = (MLME_JOIN_REQ_STRUCT *)(Elem->Msg);
 349
 350         DBGPRINT(RT_DEBUG_TRACE, ("SYNC - MlmeJoinReqAction(BSS #%ld)\n", pInfo->BssIdx));
 351
 352 #ifdef RT2860
 353     if ((OPSTATUS_TEST_FLAG(pAd, fOP_STATUS_ADVANCE_POWER_SAVE_PCIE_DEVICE)) &&
 354         (IDLE_ON(pAd)) &&
 355                 (pAd->StaCfg.bRadio == TRUE) &&
 356                 (RTMP_TEST_FLAG(pAd, fRTMP_ADAPTER_IDLE_RADIO_OFF)))
 357         {
 358                 RT28xxPciAsicRadioOn(pAd, GUI_IDLE_POWER_SAVE);
 359         }
 360 #endif // RT2860 //
 361
 362         // reset all the timers
 363         RTMPCancelTimer(&pAd->MlmeAux.ScanTimer, &TimerCancelled);
 364         RTMPCancelTimer(&pAd->MlmeAux.BeaconTimer, &TimerCancelled);
 365
 366         pBss = &pAd->MlmeAux.SsidBssTab.BssEntry[pInfo->BssIdx];
 367
 368         // record the desired SSID & BSSID we're waiting for
 369         COPY_MAC_ADDR(pAd->MlmeAux.Bssid, pBss->Bssid);
 370
 371         // If AP's SSID is not hidden, it is OK for updating ssid to MlmeAux again.
 372         if (pBss->Hidden == 0)
 373         {
 374                 NdisMoveMemory(pAd->MlmeAux.Ssid, pBss->Ssid, pBss->SsidLen);
 375                 pAd->MlmeAux.SsidLen = pBss->SsidLen;
 376         }
 377
 378         pAd->MlmeAux.BssType = pBss->BssType;
 379         pAd->MlmeAux.Channel = pBss->Channel;
 380         pAd->MlmeAux.CentralChannel = pBss->CentralChannel;
 381
 382 #ifdef EXT_BUILD_CHANNEL_LIST
 383         // Country IE of the AP will be evaluated and will be used.
 384         if ((pAd->StaCfg.IEEE80211dClientMode != Rt802_11_D_None) &&
 385                 (pBss->bHasCountryIE == TRUE))
 386         {
 387                 NdisMoveMemory(&pAd->CommonCfg.CountryCode[0], &pBss->CountryString[0], 2);
 388                 if (pBss->CountryString[2] == 'I')
 389                         pAd->CommonCfg.Geography = IDOR;
 390                 else if (pBss->CountryString[2] == 'O')
 391                         pAd->CommonCfg.Geography = ODOR;
 392                 else
 393                         pAd->CommonCfg.Geography = BOTH;
 394                 BuildChannelListEx(pAd);
 395         }
 396 #endif // EXT_BUILD_CHANNEL_LIST //
 397
 398         // Let BBP register at 20MHz to do scan
 399         RTMP_BBP_IO_READ8_BY_REG_ID(pAd, BBP_R4, &BBPValue);
 400         BBPValue &= (~0x18);
 401         RTMP_BBP_IO_WRITE8_BY_REG_ID(pAd, BBP_R4, BBPValue);
 402         DBGPRINT(RT_DEBUG_TRACE, ("SYNC - BBP R4 to 20MHz.l\n"));
 403
 404         // switch channel and waiting for beacon timer
 405         AsicSwitchChannel(pAd, pAd->MlmeAux.Channel, FALSE);
 406         AsicLockChannel(pAd, pAd->MlmeAux.Channel);
 407         RTMPSetTimer(&pAd->MlmeAux.BeaconTimer, JOIN_TIMEOUT);
 408
 409     do
 410         {
 411                 if (((pAd->CommonCfg.bIEEE80211H == 1) &&
 412             (pAd->MlmeAux.Channel > 14) &&
 413              RadarChannelCheck(pAd, pAd->MlmeAux.Channel))
 414 #ifdef CARRIER_DETECTION_SUPPORT // Roger sync Carrier
 415              || (pAd->CommonCfg.CarrierDetect.Enable == TRUE)
 416 #endif // CARRIER_DETECTION_SUPPORT //
 417             )
 418                 {
 419                         //
 420                         // We can't send any Probe request frame to meet 802.11h.
 421                         //
 422                         if (pBss->Hidden == 0)
 423                                 break;
 424                 }
 425
 426                 //
 427                 // send probe request
 428                 //
 429                 NStatus = MlmeAllocateMemory(pAd, &pOutBuffer);
 430                 if (NStatus == NDIS_STATUS_SUCCESS)
 431                 {
 432                         if (pAd->MlmeAux.Channel <= 14)
 433                         {
 434                                 pSupRate = pAd->CommonCfg.SupRate;
 435                                 SupRateLen = pAd->CommonCfg.SupRateLen;
 436                                 pExtRate = pAd->CommonCfg.ExtRate;
 437                                 ExtRateLen = pAd->CommonCfg.ExtRateLen;
 438                         }
 439                         else
 440                         {
 441                                 //
 442                                 // Overwrite Support Rate, CCK rate are not allowed
 443                                 //
 444                                 pSupRate = ASupRate;
 445                                 SupRateLen = ASupRateLen;
 446                                 ExtRateLen = 0;
 447                         }
 448
 449                         if (pAd->MlmeAux.BssType == BSS_INFRA)
 450                                 MgtMacHeaderInit(pAd, &Hdr80211, SUBTYPE_PROBE_REQ, 0, pAd->MlmeAux.Bssid, pAd->MlmeAux.Bssid);
 451                         else
 452                                 MgtMacHeaderInit(pAd, &Hdr80211, SUBTYPE_PROBE_REQ, 0, BROADCAST_ADDR, BROADCAST_ADDR);
 453
 454                         MakeOutgoingFrame(pOutBuffer,               &FrameLen,
 455                                                           sizeof(HEADER_802_11),    &Hdr80211,
 456                                                           1,                        &SsidIe,
 457                                                           1,                        &pAd->MlmeAux.SsidLen,
 458                                                           pAd->MlmeAux.SsidLen,     pAd->MlmeAux.Ssid,
 459                                                           1,                        &SupRateIe,
 460                                                           1,                        &SupRateLen,
 461                                                           SupRateLen,               pSupRate,
 462                                                           END_OF_ARGS);
 463
 464                         if (ExtRateLen)
 465                         {
 466                                 ULONG Tmp;
 467                                 MakeOutgoingFrame(pOutBuffer + FrameLen,            &Tmp,
 468                                                                   1,                                &ExtRateIe,
 469                                                                   1,                                &ExtRateLen,
 470                                                                   ExtRateLen,                       pExtRate,
 471                                                                   END_OF_ARGS);
 472                                 FrameLen += Tmp;
 473                         }
 474
 475
 476                         MiniportMMRequest(pAd, 0, pOutBuffer, FrameLen);
 477                         MlmeFreeMemory(pAd, pOutBuffer);
 478                 }
 479     } while (FALSE);
 480
 481         DBGPRINT(RT_DEBUG_TRACE, ("SYNC - Switch to ch %d, Wait BEACON from %02x:%02x:%02x:%02x:%02x:%02x\n",
 482                 pBss->Channel, pBss->Bssid[0], pBss->Bssid[1], pBss->Bssid[2], pBss->Bssid[3], pBss->Bssid[4], pBss->Bssid[5]));
 483
 484         pAd->Mlme.SyncMachine.CurrState = JOIN_WAIT_BEACON;
 485 }
 486
 487 /*
 488         ==========================================================================
 489         Description:
 490                 MLME START Request state machine procedure, starting an IBSS
 491         ==========================================================================
 492  */
 493 VOID MlmeStartReqAction(
 494         IN PRTMP_ADAPTER pAd,
 495         IN MLME_QUEUE_ELEM *Elem)
 496 {
 497         UCHAR         Ssid[MAX_LEN_OF_SSID], SsidLen;
 498         BOOLEAN       TimerCancelled;
 499
 500         // New for WPA security suites
 501         UCHAR                                           VarIE[MAX_VIE_LEN];     // Total VIE length = MAX_VIE_LEN - -5
 502         NDIS_802_11_VARIABLE_IEs        *pVIE = NULL;
 503         LARGE_INTEGER                           TimeStamp;
 504         BOOLEAN Privacy;
 505         USHORT Status;
 506
 507         // Init Variable IE structure
 508         pVIE = (PNDIS_802_11_VARIABLE_IEs) VarIE;
 509         pVIE->Length = 0;
 510         TimeStamp.u.LowPart  = 0;
 511         TimeStamp.u.HighPart = 0;
 512
 513         if (MlmeStartReqSanity(pAd, Elem->Msg, Elem->MsgLen, Ssid, &SsidLen))
 514         {
 515                 // reset all the timers
 516                 RTMPCancelTimer(&pAd->MlmeAux.ScanTimer, &TimerCancelled);
 517                 RTMPCancelTimer(&pAd->MlmeAux.BeaconTimer, &TimerCancelled);
 518
 519                 //
 520                 // Start a new IBSS. All IBSS parameters are decided now....
 521                 //
 522                 DBGPRINT(RT_DEBUG_TRACE, ("MlmeStartReqAction - Start a new IBSS. All IBSS parameters are decided now.... \n"));
 523                 pAd->MlmeAux.BssType           = BSS_ADHOC;
 524                 NdisMoveMemory(pAd->MlmeAux.Ssid, Ssid, SsidLen);
 525                 pAd->MlmeAux.SsidLen           = SsidLen;
 526
 527                 // generate a radom number as BSSID
 528                 MacAddrRandomBssid(pAd, pAd->MlmeAux.Bssid);
 529                 DBGPRINT(RT_DEBUG_TRACE, ("MlmeStartReqAction - generate a radom number as BSSID \n"));
 530
 531                 Privacy = (pAd->StaCfg.WepStatus == Ndis802_11Encryption1Enabled) ||
 532                                   (pAd->StaCfg.WepStatus == Ndis802_11Encryption2Enabled) ||
 533                                   (pAd->StaCfg.WepStatus == Ndis802_11Encryption3Enabled);
 534                 pAd->MlmeAux.CapabilityInfo    = CAP_GENERATE(0,1,Privacy, (pAd->CommonCfg.TxPreamble == Rt802_11PreambleShort), 1, 0);
 535                 pAd->MlmeAux.BeaconPeriod      = pAd->CommonCfg.BeaconPeriod;
 536                 pAd->MlmeAux.AtimWin           = pAd->StaCfg.AtimWin;
 537                 pAd->MlmeAux.Channel           = pAd->CommonCfg.Channel;
 538
 539                 pAd->CommonCfg.CentralChannel  = pAd->CommonCfg.Channel;
 540                 pAd->MlmeAux.CentralChannel    = pAd->CommonCfg.CentralChannel;
 541
 542                 pAd->MlmeAux.SupRateLen= pAd->CommonCfg.SupRateLen;
 543                 NdisMoveMemory(pAd->MlmeAux.SupRate, pAd->CommonCfg.SupRate, MAX_LEN_OF_SUPPORTED_RATES);
 544                 RTMPCheckRates(pAd, pAd->MlmeAux.SupRate, &pAd->MlmeAux.SupRateLen);
 545                 pAd->MlmeAux.ExtRateLen = pAd->CommonCfg.ExtRateLen;
 546                 NdisMoveMemory(pAd->MlmeAux.ExtRate, pAd->CommonCfg.ExtRate, MAX_LEN_OF_SUPPORTED_RATES);
 547                 RTMPCheckRates(pAd, pAd->MlmeAux.ExtRate, &pAd->MlmeAux.ExtRateLen);
 548 #ifdef DOT11_N_SUPPORT
 549                 if (pAd->CommonCfg.PhyMode >= PHY_11ABGN_MIXED)
 550                 {
 551                         RTMPUpdateHTIE(&pAd->CommonCfg.DesiredHtPhy, &pAd->StaCfg.DesiredHtPhyInfo.MCSSet[0], &pAd->MlmeAux.HtCapability, &pAd->MlmeAux.AddHtInfo);
 552                         pAd->MlmeAux.HtCapabilityLen = sizeof(HT_CAPABILITY_IE);
 553                         // Not turn pAd->StaActive.SupportedHtPhy.bHtEnable = TRUE here.
 554                         DBGPRINT(RT_DEBUG_TRACE, ("SYNC -pAd->StaActive.SupportedHtPhy.bHtEnable = TRUE\n"));
 555                 }
 556                 else
 557 #endif // DOT11_N_SUPPORT //
 558                 {
 559                         pAd->MlmeAux.HtCapabilityLen = 0;
 560                         pAd->StaActive.SupportedPhyInfo.bHtEnable = FALSE;
 561                 }
 562                 // temporarily not support QOS in IBSS
 563                 NdisZeroMemory(&pAd->MlmeAux.APEdcaParm, sizeof(EDCA_PARM));
 564                 NdisZeroMemory(&pAd->MlmeAux.APQbssLoad, sizeof(QBSS_LOAD_PARM));
 565                 NdisZeroMemory(&pAd->MlmeAux.APQosCapability, sizeof(QOS_CAPABILITY_PARM));
 566
 567                 AsicSwitchChannel(pAd, pAd->MlmeAux.Channel, FALSE);
 568                 AsicLockChannel(pAd, pAd->MlmeAux.Channel);
 569
 570                 DBGPRINT(RT_DEBUG_TRACE, ("SYNC - MlmeStartReqAction(ch= %d,sup rates= %d, ext rates=%d)\n",
 571                         pAd->MlmeAux.Channel, pAd->MlmeAux.SupRateLen, pAd->MlmeAux.ExtRateLen));
 572
 573                 pAd->Mlme.SyncMachine.CurrState = SYNC_IDLE;
 574                 Status = MLME_SUCCESS;
 575                 MlmeEnqueue(pAd, MLME_CNTL_STATE_MACHINE, MT2_START_CONF, 2, &Status);
 576         }
 577         else
 578         {
 579                 DBGPRINT_ERR(("SYNC - MlmeStartReqAction() sanity check fail.\n"));
 580                 pAd->Mlme.SyncMachine.CurrState = SYNC_IDLE;
 581                 Status = MLME_INVALID_FORMAT;
 582                 MlmeEnqueue(pAd, MLME_CNTL_STATE_MACHINE, MT2_START_CONF, 2, &Status);
 583         }
 584 }
 585
 586 /*
 587         ==========================================================================
 588         Description:
 589                 peer sends beacon back when scanning
 590         ==========================================================================
 591  */
 592 VOID PeerBeaconAtScanAction(
 593         IN PRTMP_ADAPTER pAd,
 594         IN MLME_QUEUE_ELEM *Elem)
 595 {
 596         UCHAR           Bssid[MAC_ADDR_LEN], Addr2[MAC_ADDR_LEN];
 597         UCHAR           Ssid[MAX_LEN_OF_SSID], BssType, Channel, NewChannel,
 598                                         SsidLen, DtimCount, DtimPeriod, BcastFlag, MessageToMe;
 599         CF_PARM         CfParm;
 600         USHORT          BeaconPeriod, AtimWin, CapabilityInfo;
 601         PFRAME_802_11   pFrame;
 602         LARGE_INTEGER   TimeStamp;
 603         UCHAR           Erp;
 604         UCHAR           SupRate[MAX_LEN_OF_SUPPORTED_RATES], ExtRate[MAX_LEN_OF_SUPPORTED_RATES];
 605         UCHAR                   SupRateLen, ExtRateLen;
 606         USHORT                  LenVIE;
 607         UCHAR                   CkipFlag;
 608         UCHAR                   AironetCellPowerLimit;
 609         EDCA_PARM       EdcaParm;
 610         QBSS_LOAD_PARM  QbssLoad;
 611         QOS_CAPABILITY_PARM QosCapability;
 612         ULONG                                           RalinkIe;
 613         UCHAR                                           VarIE[MAX_VIE_LEN];             // Total VIE length = MAX_VIE_LEN - -5
 614         NDIS_802_11_VARIABLE_IEs        *pVIE = NULL;
 615         HT_CAPABILITY_IE                HtCapability;
 616         ADD_HT_INFO_IE          AddHtInfo;      // AP might use this additional ht info IE
 617         UCHAR                   HtCapabilityLen = 0, PreNHtCapabilityLen = 0;
 618         UCHAR                   AddHtInfoLen;
 619         UCHAR                   NewExtChannelOffset = 0xff;
 620
 621         pFrame = (PFRAME_802_11) Elem->Msg;
 622         // Init Variable IE structure
 623         pVIE = (PNDIS_802_11_VARIABLE_IEs) VarIE;
 624         pVIE->Length = 0;
 625 #ifdef DOT11_N_SUPPORT
 626     RTMPZeroMemory(&HtCapability, sizeof(HtCapability));
 627         RTMPZeroMemory(&AddHtInfo, sizeof(ADD_HT_INFO_IE));
 628 #endif // DOT11_N_SUPPORT //
 629
 630         if (PeerBeaconAndProbeRspSanity(pAd,
 631                                                                 Elem->Msg,
 632                                                                 Elem->MsgLen,
 633                                                                 Elem->Channel,
 634                                                                 Addr2,
 635                                                                 Bssid,
 636                                                                 Ssid,
 637                                                                 &SsidLen,
 638                                                                 &BssType,
 639                                                                 &BeaconPeriod,
 640                                                                 &Channel,
 641                                                                 &NewChannel,
 642                                                                 &TimeStamp,
 643                                                                 &CfParm,
 644                                                                 &AtimWin,
 645                                                                 &CapabilityInfo,
 646                                                                 &Erp,
 647                                                                 &DtimCount,
 648                                                                 &DtimPeriod,
 649                                                                 &BcastFlag,
 650                                                                 &MessageToMe,
 651                                                                 SupRate,
 652                                                                 &SupRateLen,
 653                                                                 ExtRate,
 654                                                                 &ExtRateLen,
 655                                                                 &CkipFlag,
 656                                                                 &AironetCellPowerLimit,
 657                                                                 &EdcaParm,
 658                                                                 &QbssLoad,
 659                                                                 &QosCapability,
 660                                                                 &RalinkIe,
 661                                                                 &HtCapabilityLen,
 662                                                                 &PreNHtCapabilityLen,
 663                                                                 &HtCapability,
 664                                                                 &AddHtInfoLen,
 665                                                                 &AddHtInfo,
 666                                                                 &NewExtChannelOffset,
 667                                                                 &LenVIE,
 668                                                                 pVIE))
 669         {
 670                 ULONG Idx;
 671                 CHAR Rssi = 0;
 672
 673                 Idx = BssTableSearch(&pAd->ScanTab, Bssid, Channel);
 674                 if (Idx != BSS_NOT_FOUND)
 675                         Rssi = pAd->ScanTab.BssEntry[Idx].Rssi;
 676
 677                 Rssi = RTMPMaxRssi(pAd, ConvertToRssi(pAd, Elem->Rssi0, RSSI_0), ConvertToRssi(pAd, Elem->Rssi1, RSSI_1), ConvertToRssi(pAd, Elem->Rssi2, RSSI_2));
 678
 679
 680 #ifdef DOT11_N_SUPPORT
 681                 if ((HtCapabilityLen > 0) || (PreNHtCapabilityLen > 0))
 682                         HtCapabilityLen = SIZE_HT_CAP_IE;
 683 #endif // DOT11_N_SUPPORT //
 684                 if ((pAd->StaCfg.CCXReqType != MSRN_TYPE_UNUSED) && (Channel == pAd->StaCfg.CCXScanChannel))
 685                 {
 686                         Idx = BssTableSetEntry(pAd, &pAd->StaCfg.CCXBssTab, Bssid, Ssid, SsidLen, BssType, BeaconPeriod,
 687                                                  &CfParm, AtimWin, CapabilityInfo, SupRate, SupRateLen,ExtRate, ExtRateLen, &HtCapability,
 688                                                  &AddHtInfo, HtCapabilityLen, AddHtInfoLen, NewExtChannelOffset, Channel, Rssi, TimeStamp, CkipFlag,
 689                                                  &EdcaParm, &QosCapability, &QbssLoad, LenVIE, pVIE);
 690                         if (Idx != BSS_NOT_FOUND)
 691                         {
 692                                 NdisMoveMemory(pAd->StaCfg.CCXBssTab.BssEntry[Idx].PTSF, &Elem->Msg[24], 4);
 693                                 NdisMoveMemory(&pAd->StaCfg.CCXBssTab.BssEntry[Idx].TTSF[0], &Elem->TimeStamp.u.LowPart, 4);
 694                                 NdisMoveMemory(&pAd->StaCfg.CCXBssTab.BssEntry[Idx].TTSF[4], &Elem->TimeStamp.u.LowPart, 4);
 695                                 if (pAd->StaCfg.CCXReqType == MSRN_TYPE_BEACON_REQ)
 696                                         AironetAddBeaconReport(pAd, Idx, Elem);
 697                         }
 698                 }
 699                 else
 700                 {
 701                         Idx = BssTableSetEntry(pAd, &pAd->ScanTab, Bssid, Ssid, SsidLen, BssType, BeaconPeriod,
 702                                                   &CfParm, AtimWin, CapabilityInfo, SupRate, SupRateLen, ExtRate, ExtRateLen,  &HtCapability,
 703                                                  &AddHtInfo, HtCapabilityLen, AddHtInfoLen, NewExtChannelOffset, Channel, Rssi, TimeStamp, CkipFlag,
 704                                                  &EdcaParm, &QosCapability, &QbssLoad, LenVIE, pVIE);
 705 #ifdef DOT11_N_SUPPORT
 706 #ifdef DOT11N_DRAFT3
 707                         if (pAd->ChannelList[pAd->CommonCfg.ChannelListIdx].bEffectedChannel == TRUE)
 708                         {
 709                                 UCHAR           RegClass;
 710                                 PeerBeaconAndProbeRspSanity2(pAd, Elem->Msg, Elem->MsgLen, &RegClass);
 711                                 TriEventTableSetEntry(pAd, &pAd->CommonCfg.TriggerEventTab, Bssid, &HtCapability, HtCapabilityLen, RegClass, Channel);
 712                         }
 713 #endif // DOT11N_DRAFT3 //
 714 #endif // DOT11_N_SUPPORT //
 715                         if (Idx != BSS_NOT_FOUND)
 716                         {
 717                                 NdisMoveMemory(pAd->ScanTab.BssEntry[Idx].PTSF, &Elem->Msg[24], 4);
 718                                 NdisMoveMemory(&pAd->ScanTab.BssEntry[Idx].TTSF[0], &Elem->TimeStamp.u.LowPart, 4);
 719                                 NdisMoveMemory(&pAd->ScanTab.BssEntry[Idx].TTSF[4], &Elem->TimeStamp.u.LowPart, 4);
 720                         }
 721                 }
 722         }
 723         // sanity check fail, ignored
 724 }
 725
 726 /*
 727         ==========================================================================
 728         Description:
 729                 When waiting joining the (I)BSS, beacon received from external
 730         ==========================================================================
 731  */
 732 VOID PeerBeaconAtJoinAction(
 733         IN PRTMP_ADAPTER pAd,
 734         IN MLME_QUEUE_ELEM *Elem)
 735 {
 736         UCHAR         Bssid[MAC_ADDR_LEN], Addr2[MAC_ADDR_LEN];
 737         UCHAR         Ssid[MAX_LEN_OF_SSID], SsidLen, BssType, Channel, MessageToMe,
 738                                   DtimCount, DtimPeriod, BcastFlag, NewChannel;
 739         LARGE_INTEGER TimeStamp;
 740         USHORT        BeaconPeriod, AtimWin, CapabilityInfo;
 741         CF_PARM       Cf;
 742         BOOLEAN       TimerCancelled;
 743         UCHAR         Erp;
 744         UCHAR         SupRate[MAX_LEN_OF_SUPPORTED_RATES], ExtRate[MAX_LEN_OF_SUPPORTED_RATES];
 745         UCHAR             SupRateLen, ExtRateLen;
 746         UCHAR         CkipFlag;
 747         USHORT            LenVIE;
 748         UCHAR             AironetCellPowerLimit;
 749         EDCA_PARM       EdcaParm;
 750         QBSS_LOAD_PARM  QbssLoad;
 751         QOS_CAPABILITY_PARM QosCapability;
 752         USHORT        Status;
 753         UCHAR                                           VarIE[MAX_VIE_LEN];             // Total VIE length = MAX_VIE_LEN - -5
 754         NDIS_802_11_VARIABLE_IEs        *pVIE = NULL;
 755         ULONG           RalinkIe;
 756         ULONG         Idx;
 757         HT_CAPABILITY_IE                HtCapability;
 758         ADD_HT_INFO_IE          AddHtInfo;      // AP might use this additional ht info IE
 759         UCHAR                           HtCapabilityLen = 0, PreNHtCapabilityLen = 0;
 760         UCHAR                   AddHtInfoLen;
 761         UCHAR                   NewExtChannelOffset = 0xff;
 762 #ifdef DOT11_N_SUPPORT
 763         UCHAR                   CentralChannel;
 764 #endif // DOT11_N_SUPPORT //
 765
 766         // Init Variable IE structure
 767         pVIE = (PNDIS_802_11_VARIABLE_IEs) VarIE;
 768         pVIE->Length = 0;
 769     RTMPZeroMemory(&HtCapability, sizeof(HtCapability));
 770         RTMPZeroMemory(&AddHtInfo, sizeof(ADD_HT_INFO_IE));
 771
 772
 773         if (PeerBeaconAndProbeRspSanity(pAd,
 774                                                                 Elem->Msg,
 775                                                                 Elem->MsgLen,
 776                                                                 Elem->Channel,
 777                                                                 Addr2,
 778                                                                 Bssid,
 779                                                                 Ssid,
 780                                                                 &SsidLen,
 781                                                                 &BssType,
 782                                                                 &BeaconPeriod,
 783                                                                 &Channel,
 784                                                                 &NewChannel,
 785                                                                 &TimeStamp,
 786                                                                 &Cf,
 787                                                                 &AtimWin,
 788                                                                 &CapabilityInfo,
 789                                                                 &Erp,
 790                                                                 &DtimCount,
 791                                                                 &DtimPeriod,
 792                                                                 &BcastFlag,
 793                                                                 &MessageToMe,
 794                                                                 SupRate,
 795                                                                 &SupRateLen,
 796                                                                 ExtRate,
 797                                                                 &ExtRateLen,
 798                                                                 &CkipFlag,
 799                                                                 &AironetCellPowerLimit,
 800                                                                 &EdcaParm,
 801                                                                 &QbssLoad,
 802                                                                 &QosCapability,
 803                                                                 &RalinkIe,
 804                                                                 &HtCapabilityLen,
 805                                                                 &PreNHtCapabilityLen,
 806                                                                 &HtCapability,
 807                                                                 &AddHtInfoLen,
 808                                                                 &AddHtInfo,
 809                                                                 &NewExtChannelOffset,
 810                                                                 &LenVIE,
 811                                                                 pVIE))
 812         {
 813                 // Disqualify 11b only adhoc when we are in 11g only adhoc mode
 814                 if ((BssType == BSS_ADHOC) && (pAd->CommonCfg.PhyMode == PHY_11G) && ((SupRateLen+ExtRateLen)< 12))
 815                         return;
 816
 817                 // BEACON from desired BSS/IBSS found. We should be able to decide most
 818                 // BSS parameters here.
 819                 // Q. But what happen if this JOIN doesn't conclude a successful ASSOCIATEION?
 820                 //    Do we need to receover back all parameters belonging to previous BSS?
 821                 // A. Should be not. There's no back-door recover to previous AP. It still need
 822                 //    a new JOIN-AUTH-ASSOC sequence.
 823                 if (MAC_ADDR_EQUAL(pAd->MlmeAux.Bssid, Bssid))
 824                 {
 825                         DBGPRINT(RT_DEBUG_TRACE, ("SYNC - receive desired BEACON at JoinWaitBeacon... Channel = %d\n", Channel));
 826                         RTMPCancelTimer(&pAd->MlmeAux.BeaconTimer, &TimerCancelled);
 827
 828                         // Update RSSI to prevent No signal display when cards first initialized
 829                         pAd->StaCfg.RssiSample.LastRssi0        = ConvertToRssi(pAd, Elem->Rssi0, RSSI_0);
 830                         pAd->StaCfg.RssiSample.LastRssi1        = ConvertToRssi(pAd, Elem->Rssi1, RSSI_1);
 831                         pAd->StaCfg.RssiSample.LastRssi2        = ConvertToRssi(pAd, Elem->Rssi2, RSSI_2);
 832                         pAd->StaCfg.RssiSample.AvgRssi0 = pAd->StaCfg.RssiSample.LastRssi0;
 833                         pAd->StaCfg.RssiSample.AvgRssi0X8       = pAd->StaCfg.RssiSample.AvgRssi0 << 3;
 834                         pAd->StaCfg.RssiSample.AvgRssi1 = pAd->StaCfg.RssiSample.LastRssi1;
 835                         pAd->StaCfg.RssiSample.AvgRssi1X8       = pAd->StaCfg.RssiSample.AvgRssi1 << 3;
 836                         pAd->StaCfg.RssiSample.AvgRssi2 = pAd->StaCfg.RssiSample.LastRssi2;
 837                         pAd->StaCfg.RssiSample.AvgRssi2X8       = pAd->StaCfg.RssiSample.AvgRssi2 << 3;
 838
 839                         //
 840                         // We need to check if SSID only set to any, then we can record the current SSID.
 841                         // Otherwise will cause hidden SSID association failed.
 842                         //
 843                         if (pAd->MlmeAux.SsidLen == 0)
 844                         {
 845                                 NdisMoveMemory(pAd->MlmeAux.Ssid, Ssid, SsidLen);
 846                                 pAd->MlmeAux.SsidLen = SsidLen;
 847                         }
 848                         else
 849                         {
 850                                 Idx = BssSsidTableSearch(&pAd->ScanTab, Bssid, pAd->MlmeAux.Ssid, pAd->MlmeAux.SsidLen, Channel);
 851
 852                                 if (Idx != BSS_NOT_FOUND)
 853                                 {
 854                                         //
 855                                         // Multiple SSID case, used correct CapabilityInfo
 856                                         //
 857                                         CapabilityInfo = pAd->ScanTab.BssEntry[Idx].CapabilityInfo;
 858                                 }
 859                         }
 860                         NdisMoveMemory(pAd->MlmeAux.Bssid, Bssid, MAC_ADDR_LEN);
 861                         pAd->MlmeAux.CapabilityInfo = CapabilityInfo & SUPPORTED_CAPABILITY_INFO;
 862                         pAd->MlmeAux.BssType = BssType;
 863                         pAd->MlmeAux.BeaconPeriod = BeaconPeriod;
 864                         pAd->MlmeAux.Channel = Channel;
 865                         pAd->MlmeAux.AtimWin = AtimWin;
 866                         pAd->MlmeAux.CfpPeriod = Cf.CfpPeriod;
 867                         pAd->MlmeAux.CfpMaxDuration = Cf.CfpMaxDuration;
 868                         pAd->MlmeAux.APRalinkIe = RalinkIe;
 869
 870                         // Copy AP's supported rate to MlmeAux for creating assoication request
 871                         // Also filter out not supported rate
 872                         pAd->MlmeAux.SupRateLen = SupRateLen;
 873                         NdisMoveMemory(pAd->MlmeAux.SupRate, SupRate, SupRateLen);
 874                         RTMPCheckRates(pAd, pAd->MlmeAux.SupRate, &pAd->MlmeAux.SupRateLen);
 875                         pAd->MlmeAux.ExtRateLen = ExtRateLen;
 876                         NdisMoveMemory(pAd->MlmeAux.ExtRate, ExtRate, ExtRateLen);
 877                         RTMPCheckRates(pAd, pAd->MlmeAux.ExtRate, &pAd->MlmeAux.ExtRateLen);
 878
 879             NdisZeroMemory(pAd->StaActive.SupportedPhyInfo.MCSSet, 16);
 880 #ifdef DOT11_N_SUPPORT
 881                         pAd->MlmeAux.NewExtChannelOffset = NewExtChannelOffset;
 882                         pAd->MlmeAux.HtCapabilityLen = HtCapabilityLen;
 883
 884                         // filter out un-supported ht rates
 885                         if (((HtCapabilityLen > 0) || (PreNHtCapabilityLen > 0)) && (pAd->CommonCfg.PhyMode >= PHY_11ABGN_MIXED))
 886                         {
 887                                 RTMPZeroMemory(&pAd->MlmeAux.HtCapability, SIZE_HT_CAP_IE);
 888                                 RTMPMoveMemory(&pAd->MlmeAux.AddHtInfo, &AddHtInfo, SIZE_ADD_HT_INFO_IE);
 889
 890                                 // StaActive.SupportedHtPhy.MCSSet stores Peer AP's 11n Rx capability
 891                                 NdisMoveMemory(pAd->StaActive.SupportedPhyInfo.MCSSet, HtCapability.MCSSet, 16);
 892                                 pAd->MlmeAux.NewExtChannelOffset = NewExtChannelOffset;
 893                                 pAd->MlmeAux.HtCapabilityLen = SIZE_HT_CAP_IE;
 894                                 pAd->StaActive.SupportedPhyInfo.bHtEnable = TRUE;
 895                                 if (PreNHtCapabilityLen > 0)
 896                                         pAd->StaActive.SupportedPhyInfo.bPreNHt = TRUE;
 897                                 RTMPCheckHt(pAd, BSSID_WCID, &HtCapability, &AddHtInfo);
 898                                 // Copy AP Parameter to StaActive.  This is also in LinkUp.
 899                                 DBGPRINT(RT_DEBUG_TRACE, ("PeerBeaconAtJoinAction! (MpduDensity=%d, MaxRAmpduFactor=%d, BW=%d)\n",
 900                                         pAd->StaActive.SupportedHtPhy.MpduDensity, pAd->StaActive.SupportedHtPhy.MaxRAmpduFactor, HtCapability.HtCapInfo.ChannelWidth));
 901
 902                                 if (AddHtInfoLen > 0)
 903                                 {
 904                                         CentralChannel = AddHtInfo.ControlChan;
 905                                         // Check again the Bandwidth capability of this AP.
 906                                         if ((AddHtInfo.ControlChan > 2)&& (AddHtInfo.AddHtInfo.ExtChanOffset == EXTCHA_BELOW) && (HtCapability.HtCapInfo.ChannelWidth == BW_40))
 907                                         {
 908                                                 CentralChannel = AddHtInfo.ControlChan - 2;
 909                                         }
 910                                         else if ((AddHtInfo.AddHtInfo.ExtChanOffset == EXTCHA_ABOVE) && (HtCapability.HtCapInfo.ChannelWidth == BW_40))
 911                                         {
 912                                                 CentralChannel = AddHtInfo.ControlChan + 2;
 913                                         }
 914
 915                                         // Check Error .
 916                                         if (pAd->MlmeAux.CentralChannel != CentralChannel)
 917                                                 DBGPRINT(RT_DEBUG_ERROR, ("PeerBeaconAtJoinAction HT===>Beacon Central Channel = %d, Control Channel = %d. Mlmeaux CentralChannel = %d\n", CentralChannel, AddHtInfo.ControlChan, pAd->MlmeAux.CentralChannel));
 918
 919                                         DBGPRINT(RT_DEBUG_TRACE, ("PeerBeaconAtJoinAction HT===>Central Channel = %d, Control Channel = %d,  .\n", CentralChannel, AddHtInfo.ControlChan));
 920
 921                                 }
 922
 923                         }
 924                         else
 925 #endif // DOT11_N_SUPPORT //
 926                         {
 927                                 // To prevent error, let legacy AP must have same CentralChannel and Channel.
 928                                 if ((HtCapabilityLen == 0) && (PreNHtCapabilityLen == 0))
 929                                         pAd->MlmeAux.CentralChannel = pAd->MlmeAux.Channel;
 930
 931                                 pAd->StaActive.SupportedPhyInfo.bHtEnable = FALSE;
 932                                 RTMPZeroMemory(&pAd->MlmeAux.HtCapability, SIZE_HT_CAP_IE);
 933                                 RTMPZeroMemory(&pAd->MlmeAux.AddHtInfo, SIZE_ADD_HT_INFO_IE);
 934                         }
 935
 936                         RTMPUpdateMlmeRate(pAd);
 937
 938                         // copy QOS related information
 939                         if ((pAd->CommonCfg.bWmmCapable)
 940 #ifdef DOT11_N_SUPPORT
 941                                  || (pAd->CommonCfg.PhyMode >= PHY_11ABGN_MIXED)
 942 #endif // DOT11_N_SUPPORT //
 943                                 )
 944                         {
 945                                 NdisMoveMemory(&pAd->MlmeAux.APEdcaParm, &EdcaParm, sizeof(EDCA_PARM));
 946                                 NdisMoveMemory(&pAd->MlmeAux.APQbssLoad, &QbssLoad, sizeof(QBSS_LOAD_PARM));
 947                                 NdisMoveMemory(&pAd->MlmeAux.APQosCapability, &QosCapability, sizeof(QOS_CAPABILITY_PARM));
 948                         }
 949                         else
 950                         {
 951                                 NdisZeroMemory(&pAd->MlmeAux.APEdcaParm, sizeof(EDCA_PARM));
 952                                 NdisZeroMemory(&pAd->MlmeAux.APQbssLoad, sizeof(QBSS_LOAD_PARM));
 953                                 NdisZeroMemory(&pAd->MlmeAux.APQosCapability, sizeof(QOS_CAPABILITY_PARM));
 954                         }
 955
 956                         DBGPRINT(RT_DEBUG_TRACE, ("SYNC - after JOIN, SupRateLen=%d, ExtRateLen=%d\n",
 957                                                                                 pAd->MlmeAux.SupRateLen, pAd->MlmeAux.ExtRateLen));
 958
 959 #ifdef LEAP_SUPPORT
 960                         // Update CkipFlag
 961                         pAd->StaCfg.CkipFlag = CkipFlag;
 962
 963                         // Keep TimeStamp for Re-Association used.
 964                         if (LEAP_CCKM_ON(pAd) && (pAd->StaCfg.CCKMLinkUpFlag == TRUE))
 965                                 pAd->StaCfg.CCKMBeaconAtJoinTimeStamp = TimeStamp;
 966 #endif // LEAP_SUPPORT //
 967
 968                         if (AironetCellPowerLimit != 0xFF)
 969                         {
 970                                 //We need to change our TxPower for CCX 2.0 AP Control of Client Transmit Power
 971                                 ChangeToCellPowerLimit(pAd, AironetCellPowerLimit);
 972                         }
 973                         else  //Used the default TX Power Percentage.
 974                                 pAd->CommonCfg.TxPowerPercentage = pAd->CommonCfg.TxPowerDefault;
 975
 976                         pAd->Mlme.SyncMachine.CurrState = SYNC_IDLE;
 977                         Status = MLME_SUCCESS;
 978                         MlmeEnqueue(pAd, MLME_CNTL_STATE_MACHINE, MT2_JOIN_CONF, 2, &Status);
 979                 }
 980                 // not to me BEACON, ignored
 981         }
 982         // sanity check fail, ignore this frame
 983 }
 984
 985 /*
 986         ==========================================================================
 987         Description:
 988                 receive BEACON from peer
 989
 990         IRQL = DISPATCH_LEVEL
 991
 992         ==========================================================================
 993  */
 994 VOID PeerBeacon(
 995         IN PRTMP_ADAPTER pAd,
 996         IN MLME_QUEUE_ELEM *Elem)
 997 {
 998         UCHAR         Bssid[MAC_ADDR_LEN], Addr2[MAC_ADDR_LEN];
 999         CHAR          Ssid[MAX_LEN_OF_SSID];
1000         CF_PARM       CfParm;
1001         UCHAR         SsidLen, MessageToMe=0, BssType, Channel, NewChannel, index=0;
1002         UCHAR         DtimCount=0, DtimPeriod=0, BcastFlag=0;
1003         USHORT        CapabilityInfo, AtimWin, BeaconPeriod;
1004         LARGE_INTEGER TimeStamp;
1005         USHORT        TbttNumToNextWakeUp;
1006         UCHAR         Erp;
1007         UCHAR         SupRate[MAX_LEN_OF_SUPPORTED_RATES], ExtRate[MAX_LEN_OF_SUPPORTED_RATES];
1008         UCHAR             SupRateLen, ExtRateLen;
1009         UCHAR             CkipFlag;
1010         USHORT        LenVIE;
1011         UCHAR             AironetCellPowerLimit;
1012         EDCA_PARM       EdcaParm;
1013         QBSS_LOAD_PARM  QbssLoad;
1014         QOS_CAPABILITY_PARM QosCapability;
1015         ULONG           RalinkIe;
1016         // New for WPA security suites
1017         UCHAR                                           VarIE[MAX_VIE_LEN];             // Total VIE length = MAX_VIE_LEN - -5
1018         NDIS_802_11_VARIABLE_IEs        *pVIE = NULL;
1019         HT_CAPABILITY_IE                HtCapability;
1020         ADD_HT_INFO_IE          AddHtInfo;      // AP might use this additional ht info IE
1021         UCHAR                   HtCapabilityLen, PreNHtCapabilityLen;
1022         UCHAR                   AddHtInfoLen;
1023         UCHAR                   NewExtChannelOffset = 0xff;
1024
1025
1026 #ifdef RALINK_ATE
1027     if (ATE_ON(pAd))
1028     {
1029                 return;
1030     }
1031 #endif // RALINK_ATE //
1032
1033         if (!(INFRA_ON(pAd) || ADHOC_ON(pAd)
1034                 ))
1035                 return;
1036
1037         // Init Variable IE structure
1038         pVIE = (PNDIS_802_11_VARIABLE_IEs) VarIE;
1039         pVIE->Length = 0;
1040     RTMPZeroMemory(&HtCapability, sizeof(HtCapability));
1041         RTMPZeroMemory(&AddHtInfo, sizeof(ADD_HT_INFO_IE));
1042
1043         if (PeerBeaconAndProbeRspSanity(pAd,
1044                                                                 Elem->Msg,
1045                                                                 Elem->MsgLen,
1046                                                                 Elem->Channel,
1047                                                                 Addr2,
1048                                                                 Bssid,
1049                                                                 Ssid,
1050                                                                 &SsidLen,
1051                                                                 &BssType,
1052                                                                 &BeaconPeriod,
1053                                                                 &Channel,
1054                                                                 &NewChannel,
1055                                                                 &TimeStamp,
1056                                                                 &CfParm,
1057                                                                 &AtimWin,
1058                                                                 &CapabilityInfo,
1059                                                                 &Erp,
1060                                                                 &DtimCount,
1061                                                                 &DtimPeriod,
1062                                                                 &BcastFlag,
1063                                                                 &MessageToMe,
1064                                                                 SupRate,
1065                                                                 &SupRateLen,
1066                                                                 ExtRate,
1067                                                                 &ExtRateLen,
1068                                                                 &CkipFlag,
1069                                                                 &AironetCellPowerLimit,
1070                                                                 &EdcaParm,
1071                                                                 &QbssLoad,
1072                                                                 &QosCapability,
1073                                                                 &RalinkIe,
1074                                                                 &HtCapabilityLen,
1075                                                                 &PreNHtCapabilityLen,
1076                                                                 &HtCapability,
1077                                                                 &AddHtInfoLen,
1078                                                                 &AddHtInfo,
1079                                                                 &NewExtChannelOffset,
1080                                                                 &LenVIE,
1081                                                                 pVIE))
1082         {
1083                 BOOLEAN is_my_bssid, is_my_ssid;
1084                 ULONG   Bssidx, Now;
1085                 BSS_ENTRY *pBss;
1086                 CHAR            RealRssi = RTMPMaxRssi(pAd, ConvertToRssi(pAd, Elem->Rssi0, RSSI_0), ConvertToRssi(pAd, Elem->Rssi1, RSSI_1), ConvertToRssi(pAd, Elem->Rssi2, RSSI_2));
1087
1088                 is_my_bssid = MAC_ADDR_EQUAL(Bssid, pAd->CommonCfg.Bssid)? TRUE : FALSE;
1089                 is_my_ssid = SSID_EQUAL(Ssid, SsidLen, pAd->CommonCfg.Ssid, pAd->CommonCfg.SsidLen)? TRUE:FALSE;
1090
1091
1092                 // ignore BEACON not for my SSID
1093                 if ((! is_my_ssid) && (! is_my_bssid))
1094                         return;
1095
1096                 // It means STA waits disassoc completely from this AP, ignores this beacon.
1097                 if (pAd->Mlme.CntlMachine.CurrState == CNTL_WAIT_DISASSOC)
1098                         return;
1099
1100 #ifdef DOT11_N_SUPPORT
1101                 // Copy Control channel for this BSSID.
1102                 if (AddHtInfoLen != 0)
1103                         Channel = AddHtInfo.ControlChan;
1104
1105                 if ((HtCapabilityLen > 0) || (PreNHtCapabilityLen > 0))
1106                         HtCapabilityLen = SIZE_HT_CAP_IE;
1107 #endif // DOT11_N_SUPPORT //
1108
1109                 //
1110                 // Housekeeping "SsidBssTab" table for later-on ROAMing usage.
1111                 //
1112                 Bssidx = BssTableSearch(&pAd->ScanTab, Bssid, Channel);
1113                 if (Bssidx == BSS_NOT_FOUND)
1114                 {
1115                         // discover new AP of this network, create BSS entry
1116                         Bssidx = BssTableSetEntry(pAd, &pAd->ScanTab, Bssid, Ssid, SsidLen, BssType, BeaconPeriod,
1117                                                  &CfParm, AtimWin, CapabilityInfo, SupRate, SupRateLen, ExtRate, ExtRateLen,
1118                                                 &HtCapability, &AddHtInfo,HtCapabilityLen,AddHtInfoLen,NewExtChannelOffset, Channel,
1119                                                 RealRssi, TimeStamp, CkipFlag, &EdcaParm, &QosCapability,
1120                                                 &QbssLoad, LenVIE, pVIE);
1121                         if (Bssidx == BSS_NOT_FOUND) // return if BSS table full
1122                                 return;
1123
1124                         NdisMoveMemory(pAd->ScanTab.BssEntry[Bssidx].PTSF, &Elem->Msg[24], 4);
1125                         NdisMoveMemory(&pAd->ScanTab.BssEntry[Bssidx].TTSF[0], &Elem->TimeStamp.u.LowPart, 4);
1126                         NdisMoveMemory(&pAd->ScanTab.BssEntry[Bssidx].TTSF[4], &Elem->TimeStamp.u.LowPart, 4);
1127
1128
1129
1130                 }
1131
1132                 if ((pAd->CommonCfg.bIEEE80211H == 1) && (NewChannel != 0) && (Channel != NewChannel))
1133                 {
1134                         // Switching to channel 1 can prevent from rescanning the current channel immediately (by auto reconnection).
1135                         // In addition, clear the MLME queue and the scan table to discard the RX packets and previous scanning results.
1136                         AsicSwitchChannel(pAd, 1, FALSE);
1137                         AsicLockChannel(pAd, 1);
1138                     LinkDown(pAd, FALSE);
1139                         MlmeQueueInit(&pAd->Mlme.Queue);
1140                         BssTableInit(&pAd->ScanTab);
1141                     RTMPusecDelay(1000000);             // use delay to prevent STA do reassoc
1142
1143                         // channel sanity check
1144                         for (index = 0 ; index < pAd->ChannelListNum; index++)
1145                         {
1146                                 if (pAd->ChannelList[index].Channel == NewChannel)
1147                                 {
1148                                         pAd->ScanTab.BssEntry[Bssidx].Channel = NewChannel;
1149                                         pAd->CommonCfg.Channel = NewChannel;
1150                                         AsicSwitchChannel(pAd, pAd->CommonCfg.Channel, FALSE);
1151                                         AsicLockChannel(pAd, pAd->CommonCfg.Channel);
1152                                         DBGPRINT(RT_DEBUG_TRACE, ("PeerBeacon - STA receive channel switch announcement IE (New Channel =%d)\n", NewChannel));
1153                                         break;
1154                                 }
1155                         }
1156
1157                         if (index >= pAd->ChannelListNum)
1158                         {
1159                                 DBGPRINT_ERR(("PeerBeacon(can not find New Channel=%d in ChannelList[%d]\n", pAd->CommonCfg.Channel, pAd->ChannelListNum));
1160                         }
1161                 }
1162
1163                 // if the ssid matched & bssid unmatched, we should select the bssid with large value.
1164                 // This might happened when two STA start at the same time
1165                 if ((! is_my_bssid) && ADHOC_ON(pAd))
1166                 {
1167                         INT     i;
1168
1169                         // Add the safeguard against the mismatch of adhoc wep status
1170                         if (pAd->StaCfg.WepStatus != pAd->ScanTab.BssEntry[Bssidx].WepStatus)
1171                         {
1172                                 return;
1173                         }
1174
1175                         // collapse into the ADHOC network which has bigger BSSID value.
1176                         for (i = 0; i < 6; i++)
1177                         {
1178                                 if (Bssid[i] > pAd->CommonCfg.Bssid[i])
1179                                 {
1180                                         DBGPRINT(RT_DEBUG_TRACE, ("SYNC - merge to the IBSS with bigger BSSID=%02x:%02x:%02x:%02x:%02x:%02x\n",
1181                                                 Bssid[0], Bssid[1], Bssid[2], Bssid[3], Bssid[4], Bssid[5]));
1182                                         AsicDisableSync(pAd);
1183                                         COPY_MAC_ADDR(pAd->CommonCfg.Bssid, Bssid);
1184                                         AsicSetBssid(pAd, pAd->CommonCfg.Bssid);
1185                                         MakeIbssBeacon(pAd);        // re-build BEACON frame
1186                                         AsicEnableIbssSync(pAd);    // copy BEACON frame to on-chip memory
1187                                         is_my_bssid = TRUE;
1188                                         break;
1189                                 }
1190                                 else if (Bssid[i] < pAd->CommonCfg.Bssid[i])
1191                                         break;
1192                         }
1193                 }
1194
1195
1196                 NdisGetSystemUpTime(&Now);
1197                 pBss = &pAd->ScanTab.BssEntry[Bssidx];
1198                 pBss->Rssi = RealRssi;       // lastest RSSI
1199                 pBss->LastBeaconRxTime = Now;   // last RX timestamp
1200
1201                 //
1202                 // BEACON from my BSSID - either IBSS or INFRA network
1203                 //
1204                 if (is_my_bssid)
1205                 {
1206                         RXWI_STRUC      RxWI;
1207
1208                         pAd->StaCfg.DtimCount = DtimCount;
1209                         pAd->StaCfg.DtimPeriod = DtimPeriod;
1210                         pAd->StaCfg.LastBeaconRxTime = Now;
1211
1212
1213                         RxWI.RSSI0 = Elem->Rssi0;
1214                         RxWI.RSSI1 = Elem->Rssi1;
1215                         RxWI.RSSI2 = Elem->Rssi2;
1216
1217                         Update_Rssi_Sample(pAd, &pAd->StaCfg.RssiSample, &RxWI);
1218                         if (AironetCellPowerLimit != 0xFF)
1219                         {
1220                                 //
1221                                 // We get the Cisco (ccx) "TxPower Limit" required
1222                                 // Changed to appropriate TxPower Limit for Ciso Compatible Extensions
1223                                 //
1224                                 ChangeToCellPowerLimit(pAd, AironetCellPowerLimit);
1225                         }
1226                         else
1227                         {
1228                                 //
1229                                 // AironetCellPowerLimit equal to 0xFF means the Cisco (ccx) "TxPower Limit" not exist.
1230                                 // Used the default TX Power Percentage, that set from UI.
1231                                 //
1232                                 pAd->CommonCfg.TxPowerPercentage = pAd->CommonCfg.TxPowerDefault;
1233                         }
1234
1235                         // at least one 11b peer joined. downgrade the MaxTxRate to 11Mbps
1236                         // after last 11b peer left for several seconds, we'll auto switch back to 11G rate
1237                         // in MlmePeriodicExec()
1238                         if (ADHOC_ON(pAd) && (CAP_IS_IBSS_ON(CapabilityInfo)))
1239                         {
1240                                 BOOLEAN bRestart;
1241                 BOOLEAN bnRestart;
1242
1243                                 bRestart = FALSE;
1244                 bnRestart = FALSE;
1245
1246                                 do
1247                                 {
1248                                         if ((SupRateLen+ExtRateLen <= 4) && (pAd->CommonCfg.MaxTxRate > RATE_11))
1249                                         {
1250                                                 if (pAd->StaCfg.AdhocBOnlyJoined == FALSE)
1251                                                 {
1252                                                         DBGPRINT(RT_DEBUG_TRACE, ("SYNC - 11b peer joined. down-grade to 11b TX rates \n"));
1253                                                         bRestart = TRUE;
1254                                                         NdisMoveMemory(pAd->StaActive.SupRate, SupRate, MAX_LEN_OF_SUPPORTED_RATES);
1255                                                         pAd->StaActive.SupRateLen = SupRateLen;
1256                                                         NdisMoveMemory(pAd->StaActive.ExtRate, ExtRate, MAX_LEN_OF_SUPPORTED_RATES);
1257                                                         pAd->StaActive.ExtRateLen = ExtRateLen;
1258                                                         pAd->StaCfg.AdhocBOnlyJoined = TRUE;
1259                                                         pAd->StaActive.SupportedPhyInfo.bHtEnable = FALSE;
1260                                                         AsicSetEdcaParm(pAd, NULL);
1261                                                 }
1262
1263                                                 // this timestamp is for MlmePeriodicExec() to check if all 11B peers have left
1264                                                 pAd->StaCfg.Last11bBeaconRxTime = Now;
1265                                                 break;
1266                                         }
1267 #ifdef DOT11_N_SUPPORT
1268                                         // Update Ht Phy.
1269                                         if ((pAd->CommonCfg.PhyMode >= PHY_11ABGN_MIXED))
1270                                         {
1271                                                 if (!OPSTATUS_TEST_FLAG(pAd, fOP_STATUS_MEDIA_STATE_CONNECTED) &&
1272                                                         !pAd->StaCfg.AdhocBGJoined &&
1273                                                         !pAd->StaCfg.AdhocBOnlyJoined)
1274                                                         AdhocTurnOnQos(pAd);
1275
1276                                                 // Handle rate switch issue when Adhoc mode
1277                                                 if ((SupRateLen+ExtRateLen >= 8) && (HtCapability.MCSSet[0] == 0) && (HtCapability.MCSSet[1] == 0))
1278                                                 {
1279                                                         if (pAd->StaCfg.AdhocBGJoined == FALSE)
1280                                                         {
1281                                                                 DBGPRINT(RT_DEBUG_TRACE, ("SYNC - 11g peer joined. down-grade to 11g TX rates \n"));
1282                                                                 bRestart = TRUE;
1283                                                                 NdisMoveMemory(pAd->StaActive.SupRate, SupRate, MAX_LEN_OF_SUPPORTED_RATES);
1284                                                                 pAd->StaActive.SupRateLen = SupRateLen;
1285                                                                 NdisMoveMemory(pAd->StaActive.ExtRate, ExtRate, MAX_LEN_OF_SUPPORTED_RATES);
1286                                                                 pAd->StaActive.ExtRateLen = ExtRateLen;
1287                                                                 pAd->StaCfg.AdhocBGJoined = TRUE;
1288                                                                 pAd->StaActive.SupportedPhyInfo.bHtEnable = FALSE;
1289                                                                 AsicSetEdcaParm(pAd, NULL);
1290                                                         }
1291
1292                                                         // this timestamp is for MlmePeriodicExec() to check if all 11g peers have left
1293                                                         pAd->StaCfg.Last11gBeaconRxTime = Now;
1294                                                         break;
1295                                                 }
1296                                                 else if (!pAd->StaCfg.AdhocBGJoined &&
1297                                                                  !pAd->StaCfg.AdhocBOnlyJoined &&
1298                                                                  (pAd->CommonCfg.RegTransmitSetting.field.BW == BW_40) &&
1299                                                                  (HtCapability.HtCapInfo.ChannelWidth == BW_20))
1300                                                 {
1301                                                         if (pAd->StaCfg.Adhoc20NJoined == FALSE)
1302                                                         {
1303                                                                 pAd->CommonCfg.CentralChannel = pAd->CommonCfg.Channel;
1304
1305                                                                 pAd->StaCfg.Adhoc20NJoined = TRUE;
1306                                                                 NdisMoveMemory(&pAd->MlmeAux.HtCapability, &HtCapability, SIZE_HT_CAP_IE);
1307                                                                 if (AddHtInfoLen != 0)
1308                                                                         NdisMoveMemory(&pAd->MlmeAux.AddHtInfo, &AddHtInfo, AddHtInfoLen);
1309                                                                 NdisMoveMemory(pAd->StaActive.SupportedPhyInfo.MCSSet, HtCapability.MCSSet, 16);
1310
1311                                                                 RTMPCheckHt(pAd, Elem->Wcid, &pAd->MlmeAux.HtCapability, &pAd->MlmeAux.AddHtInfo);
1312                                                                 COPY_HTSETTINGS_FROM_MLME_AUX_TO_ACTIVE_CFG(pAd);
1313                                                                 pAd->StaActive.SupportedPhyInfo.bHtEnable = TRUE;
1314                                                                 bRestart = TRUE;
1315                                                                 bnRestart = TRUE;
1316                                                         }
1317                                                         // this timestamp is for MlmePeriodicExec() to check if all 20MHz N peers have left
1318                                                         pAd->StaCfg.Last20NBeaconRxTime = Now;
1319                                                 }
1320
1321                                         }
1322                                         else
1323 #endif // DOT11_N_SUPPORT //
1324                                         {
1325                                                 RTMPZeroMemory(&pAd->MlmeAux.HtCapability, SIZE_HT_CAP_IE);
1326                                                 RTMPZeroMemory(&pAd->MlmeAux.AddHtInfo, SIZE_ADD_HT_INFO_IE);
1327                                         }
1328                                 }while (FALSE);
1329
1330                                 // If peer Adhoc is legacy mode, I don't need to call MlmeUpdateHtTxRates no matter I support HT or not
1331                                 if ((bRestart == TRUE) && (bnRestart == FALSE))
1332                                 {
1333                                         MlmeUpdateTxRates(pAd, FALSE, 0);
1334                                         MakeIbssBeacon(pAd);        // re-build BEACON frame
1335                                         AsicEnableIbssSync(pAd);    // copy to on-chip memory
1336                                 }
1337 #ifdef DOT11_N_SUPPORT
1338                                 else if ((bRestart == TRUE) && (bnRestart == TRUE))
1339                                 {
1340                                         MlmeUpdateTxRates(pAd, FALSE, BSS0);
1341                                         MlmeUpdateHtTxRates(pAd, BSS0);
1342                                         MakeIbssBeacon(pAd);        // re-build BEACON frame
1343                                         AsicEnableIbssSync(pAd);    // copy to on-chip memory
1344                                 }
1345 #endif // DOT11_N_SUPPORT //
1346
1347                                 // At least another peer in this IBSS, declare MediaState as CONNECTED
1348                                 if (!OPSTATUS_TEST_FLAG(pAd, fOP_STATUS_MEDIA_STATE_CONNECTED))
1349                                 {
1350                                         OPSTATUS_SET_FLAG(pAd, fOP_STATUS_MEDIA_STATE_CONNECTED);
1351
1352                                         pAd->IndicateMediaState = NdisMediaStateConnected;
1353                                         RTMP_IndicateMediaState(pAd);
1354                         pAd->ExtraInfo = GENERAL_LINK_UP;
1355                                         AsicSetBssid(pAd, pAd->CommonCfg.Bssid);
1356
1357                                         // 2003/03/12 - john
1358                                         // Make sure this entry in "ScanTab" table, thus complies to Microsoft's policy that
1359                                         // "site survey" result should always include the current connected network.
1360                                         //
1361                                         Bssidx = BssTableSearch(&pAd->ScanTab, Bssid, Channel);
1362                                         if (Bssidx == BSS_NOT_FOUND)
1363                                         {
1364                                                 Bssidx = BssTableSetEntry(pAd, &pAd->ScanTab, Bssid, Ssid, SsidLen, BssType, BeaconPeriod,
1365                                                                         &CfParm, AtimWin, CapabilityInfo, SupRate, SupRateLen, ExtRate, ExtRateLen, &HtCapability,
1366                                                                         &AddHtInfo, HtCapabilityLen, AddHtInfoLen, NewExtChannelOffset, Channel, RealRssi, TimeStamp, 0,
1367                                                                         &EdcaParm, &QosCapability, &QbssLoad, LenVIE, pVIE);
1368                                         }
1369                                         DBGPRINT(RT_DEBUG_TRACE, ("ADHOC  fOP_STATUS_MEDIA_STATE_CONNECTED.\n"));
1370                                 }
1371
1372                                 // Ad-hoc mode is using MAC address as BA session. So we need to continuously find newly joined adhoc station by receiving beacon.
1373                                 // To prevent always check this, we use wcid == RESERVED_WCID to recognize it as newly joined adhoc station.
1374                                 if (ADHOC_ON(pAd) && (Elem->Wcid == RESERVED_WCID))
1375                                 {
1376                                         UCHAR   idx;
1377                                         MAC_TABLE_ENTRY *pEntry;
1378
1379                                         // look up the existing table
1380                                         pEntry = MacTableLookup(pAd, Addr2);
1381                                         if (pEntry == NULL)
1382                                         {
1383                                                 // Another adhoc joining, add to our MAC table.
1384                                                 pEntry = MacTableInsertEntry(pAd, Addr2, BSS0, FALSE);
1385                                                 if (pEntry)
1386                                                 {
1387                                                         pEntry->Sst = SST_ASSOC;
1388                                                         idx = pAd->StaCfg.DefaultKeyId;
1389                                                         // After InsertEntry, Write to ASIC on-chip table.
1390                                                         RT28XX_STA_SECURITY_INFO_ADD(pAd, BSS0, idx, pEntry);
1391                                                         DBGPRINT(RT_DEBUG_TRACE, ("ADHOC %x:%x:%x:%x:%x:%x  join in.Entry=%d\n", Addr2[0],Addr2[1],Addr2[2],Addr2[3],Addr2[4],Addr2[5], pEntry->Aid));
1392
1393                                                         pEntry->HTPhyMode.word = pAd->StaCfg.HTPhyMode.word;
1394                                 if (HtCapabilityLen <= 0)
1395                                 {
1396                                     pEntry->HTPhyMode.field.STBC = 0;
1397                                     pEntry->HTPhyMode.field.BW = 0;
1398                                     pEntry->HTPhyMode.field.ShortGI = 0;
1399                                     if ((SupRateLen+ExtRateLen <= 4) && (pAd->CommonCfg.Channel <= 14))
1400                                                         {
1401                                                                 pEntry->HTPhyMode.field.MODE = MODE_CCK;
1402                                                         }
1403                                                         else
1404                                                         {
1405                                                                 pEntry->HTPhyMode.field.MODE = MODE_OFDM;
1406                                                         }
1407                                                                 MlmeUpdateTxRates(pAd, FALSE, 0);
1408                                 }
1409 #ifdef DOT11_N_SUPPORT
1410                                                         else
1411                                                         {
1412                                                                 MlmeUpdateTxRates(pAd, FALSE, 0);
1413                                                                 MlmeUpdateHtTxRates(pAd, BSS0);
1414                                                         }
1415 #endif // DOT11_N_SUPPORT //
1416
1417 #ifdef WPA_SUPPLICANT_SUPPORT
1418 #ifndef NATIVE_WPA_SUPPLICANT_SUPPORT
1419                                 if (pAd->StaCfg.WpaSupplicantUP)
1420                                 {
1421                                     union iwreq_data    wrqu;
1422
1423                                     SendAssocIEsToWpaSupplicant(pAd);
1424                                     memset(&wrqu, 0, sizeof(wrqu));
1425                                     wrqu.data.flags = RT_ASSOC_EVENT_FLAG;
1426                                     wireless_send_event(pAd->net_dev, IWEVCUSTOM, &wrqu, NULL);
1427                                 }
1428 #endif // NATIVE_WPA_SUPPLICANT_SUPPORT //
1429 #endif // WPA_SUPPLICANT_SUPPORT //
1430
1431 #ifdef NATIVE_WPA_SUPPLICANT_SUPPORT
1432                                 {
1433                                     union iwreq_data    wrqu;
1434                                     wext_notify_event_assoc(pAd);
1435
1436                                     memset(wrqu.ap_addr.sa_data, 0, MAC_ADDR_LEN);
1437                                     memcpy(wrqu.ap_addr.sa_data, pAd->MlmeAux.Bssid, MAC_ADDR_LEN);
1438                                     wireless_send_event(pAd->net_dev, SIOCGIWAP, &wrqu, NULL);
1439
1440                                 }
1441 #endif // NATIVE_WPA_SUPPLICANT_SUPPORT //
1442                                                 }
1443                                         }
1444                                 }
1445                         }
1446
1447                         if (INFRA_ON(pAd))
1448                         {
1449                                 BOOLEAN bUseShortSlot, bUseBGProtection;
1450
1451                                 // decide to use/change to -
1452                                 //      1. long slot (20 us) or short slot (9 us) time
1453                                 //      2. turn on/off RTS/CTS and/or CTS-to-self protection
1454                                 //      3. short preamble
1455
1456                                 //bUseShortSlot = pAd->CommonCfg.bUseShortSlotTime && CAP_IS_SHORT_SLOT(CapabilityInfo);
1457                                 bUseShortSlot = CAP_IS_SHORT_SLOT(CapabilityInfo);
1458                                 if (bUseShortSlot != OPSTATUS_TEST_FLAG(pAd, fOP_STATUS_SHORT_SLOT_INUSED))
1459                                         AsicSetSlotTime(pAd, bUseShortSlot);
1460
1461                                 bUseBGProtection = (pAd->CommonCfg.UseBGProtection == 1) ||    // always use
1462                                                                    ((pAd->CommonCfg.UseBGProtection == 0) && ERP_IS_USE_PROTECTION(Erp));
1463
1464                                 if (pAd->CommonCfg.Channel > 14) // always no BG protection in A-band. falsely happened when switching A/G band to a dual-band AP
1465                                         bUseBGProtection = FALSE;
1466
1467                                 if (bUseBGProtection != OPSTATUS_TEST_FLAG(pAd, fOP_STATUS_BG_PROTECTION_INUSED))
1468                                 {
1469                                         if (bUseBGProtection)
1470                                         {
1471                                                 OPSTATUS_SET_FLAG(pAd, fOP_STATUS_BG_PROTECTION_INUSED);
1472                                                 AsicUpdateProtect(pAd, pAd->MlmeAux.AddHtInfo.AddHtInfo2.OperaionMode, (OFDMSETPROTECT|CCKSETPROTECT|ALLN_SETPROTECT),FALSE,(pAd->MlmeAux.AddHtInfo.AddHtInfo2.NonGfPresent == 1));
1473                                         }
1474                                         else
1475                                         {
1476                                                 OPSTATUS_CLEAR_FLAG(pAd, fOP_STATUS_BG_PROTECTION_INUSED);
1477                                                 AsicUpdateProtect(pAd, pAd->MlmeAux.AddHtInfo.AddHtInfo2.OperaionMode, (OFDMSETPROTECT|CCKSETPROTECT|ALLN_SETPROTECT),TRUE,(pAd->MlmeAux.AddHtInfo.AddHtInfo2.NonGfPresent == 1));
1478                                         }
1479
1480                                         DBGPRINT(RT_DEBUG_WARN, ("SYNC - AP changed B/G protection to %d\n", bUseBGProtection));
1481                                 }
1482
1483 #ifdef DOT11_N_SUPPORT
1484                                 // check Ht protection mode. and adhere to the Non-GF device indication by AP.
1485                                 if ((AddHtInfoLen != 0) &&
1486                                         ((AddHtInfo.AddHtInfo2.OperaionMode != pAd->MlmeAux.AddHtInfo.AddHtInfo2.OperaionMode) ||
1487                                         (AddHtInfo.AddHtInfo2.NonGfPresent != pAd->MlmeAux.AddHtInfo.AddHtInfo2.NonGfPresent)))
1488                                 {
1489                                         pAd->MlmeAux.AddHtInfo.AddHtInfo2.NonGfPresent = AddHtInfo.AddHtInfo2.NonGfPresent;
1490                                         pAd->MlmeAux.AddHtInfo.AddHtInfo2.OperaionMode = AddHtInfo.AddHtInfo2.OperaionMode;
1491                                         if (pAd->MlmeAux.AddHtInfo.AddHtInfo2.NonGfPresent == 1)
1492                                 {
1493                                                 AsicUpdateProtect(pAd, pAd->MlmeAux.AddHtInfo.AddHtInfo2.OperaionMode, ALLN_SETPROTECT, FALSE, TRUE);
1494                                         }
1495                                         else
1496                                                 AsicUpdateProtect(pAd, pAd->MlmeAux.AddHtInfo.AddHtInfo2.OperaionMode, ALLN_SETPROTECT, FALSE, FALSE);
1497
1498                                         DBGPRINT(RT_DEBUG_TRACE, ("SYNC - AP changed N OperaionMode to %d\n", pAd->MlmeAux.AddHtInfo.AddHtInfo2.OperaionMode));
1499                                 }
1500 #endif // DOT11_N_SUPPORT //
1501
1502                                 if (OPSTATUS_TEST_FLAG(pAd, fOP_STATUS_SHORT_PREAMBLE_INUSED) &&
1503                                         ERP_IS_USE_BARKER_PREAMBLE(Erp))
1504                                 {
1505                                         MlmeSetTxPreamble(pAd, Rt802_11PreambleLong);
1506                                         DBGPRINT(RT_DEBUG_TRACE, ("SYNC - AP forced to use LONG preamble\n"));
1507                                 }
1508
1509                                 if (OPSTATUS_TEST_FLAG(pAd, fOP_STATUS_WMM_INUSED)    &&
1510                                         (EdcaParm.bValid == TRUE)                          &&
1511                                         (EdcaParm.EdcaUpdateCount != pAd->CommonCfg.APEdcaParm.EdcaUpdateCount))
1512                                 {
1513                                         DBGPRINT(RT_DEBUG_TRACE, ("SYNC - AP change EDCA parameters(from %d to %d)\n",
1514                                                 pAd->CommonCfg.APEdcaParm.EdcaUpdateCount,
1515                                                 EdcaParm.EdcaUpdateCount));
1516                                         AsicSetEdcaParm(pAd, &EdcaParm);
1517                                 }
1518
1519                                 // copy QOS related information
1520                                 NdisMoveMemory(&pAd->CommonCfg.APQbssLoad, &QbssLoad, sizeof(QBSS_LOAD_PARM));
1521                                 NdisMoveMemory(&pAd->CommonCfg.APQosCapability, &QosCapability, sizeof(QOS_CAPABILITY_PARM));
1522                         }
1523
1524                         // only INFRASTRUCTURE mode support power-saving feature
1525                         if ((INFRA_ON(pAd) && (pAd->StaCfg.Psm == PWR_SAVE)) || (pAd->CommonCfg.bAPSDForcePowerSave))
1526                         {
1527                                 UCHAR FreeNumber;
1528                                 //  1. AP has backlogged unicast-to-me frame, stay AWAKE, send PSPOLL
1529                                 //  2. AP has backlogged broadcast/multicast frame and we want those frames, stay AWAKE
1530                                 //  3. we have outgoing frames in TxRing or MgmtRing, better stay AWAKE
1531                                 //  4. Psm change to PWR_SAVE, but AP not been informed yet, we better stay AWAKE
1532                                 //  5. otherwise, put PHY back to sleep to save battery.
1533                                 if (MessageToMe)
1534                                 {
1535 #ifdef RT2860
1536                                         if (OPSTATUS_TEST_FLAG(pAd, fOP_STATUS_ADVANCE_POWER_SAVE_PCIE_DEVICE))
1537                                         {
1538                                                 RTMP_BBP_IO_WRITE8_BY_REG_ID(pAd, BBP_R3, pAd->StaCfg.BBPR3);
1539                                                 // Turn clk to 80Mhz.
1540                                         }
1541 #endif // RT2860 //
1542                                         if (pAd->CommonCfg.bAPSDCapable && pAd->CommonCfg.APEdcaParm.bAPSDCapable &&
1543                                                 pAd->CommonCfg.bAPSDAC_BE && pAd->CommonCfg.bAPSDAC_BK && pAd->CommonCfg.bAPSDAC_VI && pAd->CommonCfg.bAPSDAC_VO)
1544                                         {
1545                                                 pAd->CommonCfg.bNeedSendTriggerFrame = TRUE;
1546                                         }
1547                                         else
1548                                                 RT28XX_PS_POLL_ENQUEUE(pAd);
1549                                 }
1550                                 else if (BcastFlag && (DtimCount == 0) && OPSTATUS_TEST_FLAG(pAd, fOP_STATUS_RECEIVE_DTIM))
1551                                 {
1552 #ifdef RT2860
1553                                         if (OPSTATUS_TEST_FLAG(pAd, fOP_STATUS_ADVANCE_POWER_SAVE_PCIE_DEVICE))
1554                                         {
1555                                                 RTMP_BBP_IO_WRITE8_BY_REG_ID(pAd, BBP_R3, pAd->StaCfg.BBPR3);
1556                                         }
1557 #endif // RT2860 //
1558                                 }
1559                                 else if ((pAd->TxSwQueue[QID_AC_BK].Number != 0)                                                                                                        ||
1560                                                 (pAd->TxSwQueue[QID_AC_BE].Number != 0)                                                                                                         ||
1561                                                 (pAd->TxSwQueue[QID_AC_VI].Number != 0)                                                                                                         ||
1562                                                 (pAd->TxSwQueue[QID_AC_VO].Number != 0)                                                                                                         ||
1563                                                 (RTMPFreeTXDRequest(pAd, QID_AC_BK, TX_RING_SIZE - 1, &FreeNumber) != NDIS_STATUS_SUCCESS)      ||
1564                                                 (RTMPFreeTXDRequest(pAd, QID_AC_BE, TX_RING_SIZE - 1, &FreeNumber) != NDIS_STATUS_SUCCESS)      ||
1565                                                 (RTMPFreeTXDRequest(pAd, QID_AC_VI, TX_RING_SIZE - 1, &FreeNumber) != NDIS_STATUS_SUCCESS)      ||
1566                                                 (RTMPFreeTXDRequest(pAd, QID_AC_VO, TX_RING_SIZE - 1, &FreeNumber) != NDIS_STATUS_SUCCESS)      ||
1567                                                 (RTMPFreeTXDRequest(pAd, QID_MGMT, MGMT_RING_SIZE - 1, &FreeNumber) != NDIS_STATUS_SUCCESS))
1568                                 {
1569                                         // TODO: consider scheduled HCCA. might not be proper to use traditional DTIM-based power-saving scheme
1570                                         // can we cheat here (i.e. just check MGMT & AC_BE) for better performance?
1571 #ifdef RT2860
1572                                         if (OPSTATUS_TEST_FLAG(pAd, fOP_STATUS_ADVANCE_POWER_SAVE_PCIE_DEVICE))
1573                                         {
1574                                                 RTMP_BBP_IO_WRITE8_BY_REG_ID(pAd, BBP_R3, pAd->StaCfg.BBPR3);
1575                                         }
1576 #endif // RT2860 //
1577                                 }
1578                                 else
1579                                 {
1580                                         USHORT NextDtim = DtimCount;
1581
1582                                         if (NextDtim == 0)
1583                                                 NextDtim = DtimPeriod;
1584
1585                                         TbttNumToNextWakeUp = pAd->StaCfg.DefaultListenCount;
1586                                         if (OPSTATUS_TEST_FLAG(pAd, fOP_STATUS_RECEIVE_DTIM) && (TbttNumToNextWakeUp > NextDtim))
1587                                                 TbttNumToNextWakeUp = NextDtim;
1588
1589                                         if (!OPSTATUS_TEST_FLAG(pAd, fOP_STATUS_DOZE))
1590                                         {
1591                                                 AsicSleepThenAutoWakeup(pAd, TbttNumToNextWakeUp);
1592                                         }
1593                                 }
1594                         }
1595                 }
1596                 // not my BSSID, ignore it
1597         }
1598         // sanity check fail, ignore this frame
1599 }
1600
1601 /*
1602         ==========================================================================
1603         Description:
1604                 Receive PROBE REQ from remote peer when operating in IBSS mode
1605         ==========================================================================
1606  */
1607 VOID PeerProbeReqAction(
1608         IN PRTMP_ADAPTER pAd,
1609         IN MLME_QUEUE_ELEM *Elem)
1610 {
1611         UCHAR         Addr2[MAC_ADDR_LEN];
1612         CHAR          Ssid[MAX_LEN_OF_SSID];
1613         UCHAR         SsidLen;
1614 #ifdef DOT11_N_SUPPORT
1615         UCHAR             HtLen, AddHtLen, NewExtLen;
1616 #endif // DOT11_N_SUPPORT //
1617         HEADER_802_11 ProbeRspHdr;
1618         NDIS_STATUS   NStatus;
1619         PUCHAR        pOutBuffer = NULL;
1620         ULONG         FrameLen = 0;
1621         LARGE_INTEGER FakeTimestamp;
1622         UCHAR         DsLen = 1, IbssLen = 2;
1623         UCHAR         LocalErpIe[3] = {IE_ERP, 1, 0};
1624         BOOLEAN       Privacy;
1625         USHORT        CapabilityInfo;
1626         UCHAR             RSNIe = IE_WPA;
1627
1628         if (! ADHOC_ON(pAd))
1629                 return;
1630
1631         if (PeerProbeReqSanity(pAd, Elem->Msg, Elem->MsgLen, Addr2, Ssid, &SsidLen))
1632         {
1633                 if ((SsidLen == 0) || SSID_EQUAL(Ssid, SsidLen, pAd->CommonCfg.Ssid, pAd->CommonCfg.SsidLen))
1634                 {
1635                         // allocate and send out ProbeRsp frame
1636                         NStatus = MlmeAllocateMemory(pAd, &pOutBuffer);  //Get an unused nonpaged memory
1637                         if (NStatus != NDIS_STATUS_SUCCESS)
1638                                 return;
1639
1640                         //pAd->StaCfg.AtimWin = 0;  // ??????
1641
1642                         Privacy = (pAd->StaCfg.WepStatus == Ndis802_11Encryption1Enabled) ||
1643                                           (pAd->StaCfg.WepStatus == Ndis802_11Encryption2Enabled) ||
1644                                           (pAd->StaCfg.WepStatus == Ndis802_11Encryption3Enabled);
1645                         CapabilityInfo = CAP_GENERATE(0, 1, Privacy, (pAd->CommonCfg.TxPreamble == Rt802_11PreambleShort), 0, 0);
1646
1647                         MakeOutgoingFrame(pOutBuffer,                   &FrameLen,
1648                                                           sizeof(HEADER_802_11),        &ProbeRspHdr,
1649                                                           TIMESTAMP_LEN,                &FakeTimestamp,
1650                                                           2,                            &pAd->CommonCfg.BeaconPeriod,
1651                                                           2,                            &CapabilityInfo,
1652                                                           1,                            &SsidIe,
1653                                                           1,                            &pAd->CommonCfg.SsidLen,
1654                                                           pAd->CommonCfg.SsidLen,       pAd->CommonCfg.Ssid,
1655                                                           1,                            &SupRateIe,
1656                                                           1,                            &pAd->StaActive.SupRateLen,
1657                                                           pAd->StaActive.SupRateLen,    pAd->StaActive.SupRate,
1658                                                           1,                            &DsIe,
1659                                                           1,                            &DsLen,
1660                                                           1,                            &pAd->CommonCfg.Channel,
1661                                                           1,                            &IbssIe,
1662                                                           1,                            &IbssLen,
1663                                                           2,                            &pAd->StaActive.AtimWin,
1664                                                           END_OF_ARGS);
1665
1666                         if (pAd->StaActive.ExtRateLen)
1667                         {
1668                                 ULONG tmp;
1669                                 MakeOutgoingFrame(pOutBuffer + FrameLen,        &tmp,
1670                                                                   3,                            LocalErpIe,
1671                                                                   1,                            &ExtRateIe,
1672                                                                   1,                            &pAd->StaActive.ExtRateLen,
1673                                                                   pAd->StaActive.ExtRateLen,    &pAd->StaActive.ExtRate,
1674                                                                   END_OF_ARGS);
1675                                 FrameLen += tmp;
1676                         }
1677
1678                         // If adhoc secruity is set for WPA-None, append the cipher suite IE
1679                         if (pAd->StaCfg.AuthMode == Ndis802_11AuthModeWPANone)
1680                         {
1681                                 ULONG tmp;
1682                                 MakeOutgoingFrame(pOutBuffer + FrameLen,                &tmp,
1683                                                                         1,                              &RSNIe,
1684                                                                         1,                              &pAd->StaCfg.RSNIE_Len,
1685                                                                         pAd->StaCfg.RSNIE_Len,          pAd->StaCfg.RSN_IE,
1686                                                                         END_OF_ARGS);
1687                                 FrameLen += tmp;
1688                         }
1689 #ifdef DOT11_N_SUPPORT
1690                         if (pAd->CommonCfg.PhyMode >= PHY_11ABGN_MIXED)
1691                         {
1692                                 ULONG TmpLen;
1693                                 UCHAR   BROADCOM[4] = {0x0, 0x90, 0x4c, 0x33};
1694                                 HtLen = sizeof(pAd->CommonCfg.HtCapability);
1695                                 AddHtLen = sizeof(pAd->CommonCfg.AddHTInfo);
1696                                 NewExtLen = 1;
1697                                 //New extension channel offset IE is included in Beacon, Probe Rsp or channel Switch Announcement Frame
1698                                 if (pAd->bBroadComHT == TRUE)
1699                                 {
1700                                         MakeOutgoingFrame(pOutBuffer + FrameLen,            &TmpLen,
1701                                                                   1,                                &WpaIe,
1702                                                                   4,                                &BROADCOM[0],
1703                                                                  pAd->MlmeAux.HtCapabilityLen,          &pAd->MlmeAux.HtCapability,
1704                                                                   END_OF_ARGS);
1705                                 }
1706                                 else
1707                                 {
1708                                 MakeOutgoingFrame(pOutBuffer + FrameLen,            &TmpLen,
1709                                                                   1,                                &HtCapIe,
1710                                                                   1,                                &HtLen,
1711                                                                  sizeof(HT_CAPABILITY_IE),          &pAd->CommonCfg.HtCapability,
1712                                                                   1,                                &AddHtInfoIe,
1713                                                                   1,                                &AddHtLen,
1714                                                                  sizeof(ADD_HT_INFO_IE),          &pAd->CommonCfg.AddHTInfo,
1715                                                                   1,                                &NewExtChanIe,
1716                                                                   1,                                &NewExtLen,
1717                                                                  sizeof(NEW_EXT_CHAN_IE),          &pAd->CommonCfg.NewExtChanOffset,
1718                                                                   END_OF_ARGS);
1719                                 }
1720                                 FrameLen += TmpLen;
1721                         }
1722 #endif // DOT11_N_SUPPORT //
1723                         MiniportMMRequest(pAd, 0, pOutBuffer, FrameLen);
1724                         MlmeFreeMemory(pAd, pOutBuffer);
1725                 }
1726         }
1727 }
1728
1729 VOID BeaconTimeoutAtJoinAction(
1730         IN PRTMP_ADAPTER pAd,
1731         IN MLME_QUEUE_ELEM *Elem)
1732 {
1733         USHORT Status;
1734         DBGPRINT(RT_DEBUG_TRACE, ("SYNC - BeaconTimeoutAtJoinAction\n"));
1735         pAd->Mlme.SyncMachine.CurrState = SYNC_IDLE;
1736         Status = MLME_REJ_TIMEOUT;
1737         MlmeEnqueue(pAd, MLME_CNTL_STATE_MACHINE, MT2_JOIN_CONF, 2, &Status);
1738 }
1739
1740 /*
1741         ==========================================================================
1742         Description:
1743                 Scan timeout procedure. basically add channel index by 1 and rescan
1744         ==========================================================================
1745  */
1746 VOID ScanTimeoutAction(
1747         IN PRTMP_ADAPTER pAd,
1748         IN MLME_QUEUE_ELEM *Elem)
1749 {
1750         pAd->MlmeAux.Channel = NextChannel(pAd, pAd->MlmeAux.Channel);
1751
1752         // Only one channel scanned for CISCO beacon request
1753         if ((pAd->MlmeAux.ScanType == SCAN_CISCO_ACTIVE) ||
1754                 (pAd->MlmeAux.ScanType == SCAN_CISCO_PASSIVE) ||
1755                 (pAd->MlmeAux.ScanType == SCAN_CISCO_NOISE) ||
1756                 (pAd->MlmeAux.ScanType == SCAN_CISCO_CHANNEL_LOAD))
1757                 pAd->MlmeAux.Channel = 0;
1758
1759         // this routine will stop if pAd->MlmeAux.Channel == 0
1760         ScanNextChannel(pAd);
1761 }
1762
1763 /*
1764         ==========================================================================
1765         Description:
1766         ==========================================================================
1767  */
1768 VOID InvalidStateWhenScan(
1769         IN PRTMP_ADAPTER pAd,
1770         IN MLME_QUEUE_ELEM *Elem)
1771 {
1772         USHORT Status;
1773         DBGPRINT(RT_DEBUG_TRACE, ("AYNC - InvalidStateWhenScan(state=%ld). Reset SYNC machine\n", pAd->Mlme.SyncMachine.CurrState));
1774         pAd->Mlme.SyncMachine.CurrState = SYNC_IDLE;
1775         Status = MLME_STATE_MACHINE_REJECT;
1776         MlmeEnqueue(pAd, MLME_CNTL_STATE_MACHINE, MT2_SCAN_CONF, 2, &Status);
1777 }
1778
1779 /*
1780         ==========================================================================
1781         Description:
1782         ==========================================================================
1783  */
1784 VOID InvalidStateWhenJoin(
1785         IN PRTMP_ADAPTER pAd,
1786         IN MLME_QUEUE_ELEM *Elem)
1787 {
1788         USHORT Status;
1789         DBGPRINT(RT_DEBUG_TRACE, ("InvalidStateWhenJoin(state=%ld). Reset SYNC machine\n", pAd->Mlme.SyncMachine.CurrState));
1790         pAd->Mlme.SyncMachine.CurrState = SYNC_IDLE;
1791         Status = MLME_STATE_MACHINE_REJECT;
1792         MlmeEnqueue(pAd, MLME_CNTL_STATE_MACHINE, MT2_JOIN_CONF, 2, &Status);
1793 }
1794
1795 /*
1796         ==========================================================================
1797         Description:
1798         ==========================================================================
1799  */
1800 VOID InvalidStateWhenStart(
1801         IN PRTMP_ADAPTER pAd,
1802         IN MLME_QUEUE_ELEM *Elem)
1803 {
1804         USHORT Status;
1805         DBGPRINT(RT_DEBUG_TRACE, ("InvalidStateWhenStart(state=%ld). Reset SYNC machine\n", pAd->Mlme.SyncMachine.CurrState));
1806         pAd->Mlme.SyncMachine.CurrState = SYNC_IDLE;
1807         Status = MLME_STATE_MACHINE_REJECT;
1808         MlmeEnqueue(pAd, MLME_CNTL_STATE_MACHINE, MT2_START_CONF, 2, &Status);
1809 }
1810
1811 /*
1812         ==========================================================================
1813         Description:
1814
1815         IRQL = DISPATCH_LEVEL
1816
1817         ==========================================================================
1818  */
1819 VOID EnqueuePsPoll(
1820         IN PRTMP_ADAPTER pAd)
1821 {
1822 #ifdef RALINK_ATE
1823     if (ATE_ON(pAd))
1824     {
1825                 return;
1826     }
1827 #endif // RALINK_ATE //
1828
1829
1830         if (pAd->StaCfg.WindowsPowerMode == Ndis802_11PowerModeLegacy_PSP)
1831         pAd->PsPollFrame.FC.PwrMgmt = PWR_SAVE;
1832         MiniportMMRequest(pAd, 0, (PUCHAR)&pAd->PsPollFrame, sizeof(PSPOLL_FRAME));
1833 }
1834
1835
1836 /*
1837         ==========================================================================
1838         Description:
1839         ==========================================================================
1840  */
1841 VOID EnqueueProbeRequest(
1842         IN PRTMP_ADAPTER pAd)
1843 {
1844         NDIS_STATUS     NState;
1845         PUCHAR          pOutBuffer;
1846         ULONG           FrameLen = 0;
1847         HEADER_802_11   Hdr80211;
1848
1849         DBGPRINT(RT_DEBUG_TRACE, ("force out a ProbeRequest ...\n"));
1850
1851         NState = MlmeAllocateMemory(pAd, &pOutBuffer);  //Get an unused nonpaged memory
1852         if (NState == NDIS_STATUS_SUCCESS)
1853         {
1854                 MgtMacHeaderInit(pAd, &Hdr80211, SUBTYPE_PROBE_REQ, 0, BROADCAST_ADDR, BROADCAST_ADDR);
1855
1856                 // this ProbeRequest explicitly specify SSID to reduce unwanted ProbeResponse
1857                 MakeOutgoingFrame(pOutBuffer,                     &FrameLen,
1858                                                   sizeof(HEADER_802_11),          &Hdr80211,
1859                                                   1,                              &SsidIe,
1860                                                   1,                              &pAd->CommonCfg.SsidLen,
1861                                                   pAd->CommonCfg.SsidLen,                 pAd->CommonCfg.Ssid,
1862                                                   1,                              &SupRateIe,
1863                                                   1,                              &pAd->StaActive.SupRateLen,
1864                                                   pAd->StaActive.SupRateLen,      pAd->StaActive.SupRate,
1865                                                   END_OF_ARGS);
1866                 MiniportMMRequest(pAd, 0, pOutBuffer, FrameLen);
1867                 MlmeFreeMemory(pAd, pOutBuffer);
1868         }
1869
1870 }
1871
1872 #ifdef DOT11_N_SUPPORT
1873 #ifdef DOT11N_DRAFT3
1874 VOID BuildEffectedChannelList(
1875         IN PRTMP_ADAPTER pAd)
1876 {
1877         UCHAR           EChannel[11];
1878         UCHAR           i, j, k;
1879         UCHAR           UpperChannel = 0, LowerChannel = 0;
1880
1881         RTMPZeroMemory(EChannel, 11);
1882         i = 0;
1883         // Find upper channel and lower channel.
1884         if (pAd->CommonCfg.CentralChannel < pAd->CommonCfg.Channel)
1885         {
1886                 UpperChannel = pAd->CommonCfg.Channel;
1887                 LowerChannel = pAd->CommonCfg.CentralChannel;
1888         }
1889         else if (pAd->CommonCfg.CentralChannel > pAd->CommonCfg.Channel)
1890         {
1891                 UpperChannel = pAd->CommonCfg.CentralChannel;
1892                 LowerChannel = pAd->CommonCfg.Channel;
1893         }
1894         else
1895         {
1896                 return;
1897         }
1898
1899         // Record channels that is below lower channel..
1900         if (LowerChannel > 1)
1901         {
1902                 EChannel[0] = LowerChannel - 1;
1903                 i = 1;
1904                 if (LowerChannel > 2)
1905                 {
1906                         EChannel[1] = LowerChannel - 2;
1907                         i = 2;
1908                         if (LowerChannel > 3)
1909                         {
1910                                 EChannel[2] = LowerChannel - 3;
1911                                 i = 3;
1912                         }
1913                 }
1914         }
1915         // Record channels that is between  lower channel and upper channel.
1916         for (k = LowerChannel;k < UpperChannel;k++)
1917         {
1918                 EChannel[i] = k;
1919                 i++;
1920         }
1921         // Record channels that is above upper channel..
1922         if (LowerChannel < 11)
1923         {
1924                 EChannel[i] = UpperChannel + 1;
1925                 i++;
1926                 if (LowerChannel < 10)
1927                 {
1928                         EChannel[i] = LowerChannel + 2;
1929                         i++;
1930                         if (LowerChannel < 9)
1931                         {
1932                                 EChannel[i] = LowerChannel + 3;
1933                                 i++;
1934                         }
1935                 }
1936         }
1937         //
1938         for (j = 0;j < i;j++)
1939         {
1940                 for (k = 0;k < pAd->ChannelListNum;k++)
1941                 {
1942                         if (pAd->ChannelList[k].Channel == EChannel[j])
1943                         {
1944                                 pAd->ChannelList[k].bEffectedChannel = TRUE;
1945                                 DBGPRINT(RT_DEBUG_TRACE,(" EffectedChannel( =%d)\n", EChannel[j]));
1946                                 break;
1947                         }
1948                 }
1949         }
1950 }
1951 #endif // DOT11N_DRAFT3 //
1952 #endif // DOT11_N_SUPPORT //
1953
1954 BOOLEAN ScanRunning(
1955                 IN PRTMP_ADAPTER pAd)
1956 {
1957         return (pAd->Mlme.SyncMachine.CurrState == SCAN_LISTEN) ? TRUE : FALSE;
1958 }
1959