git.oblomov.eu Git - linux-2.6/blob - drivers/staging/rt3070/common/action.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         action.c
  29
  30     Abstract:
  31     Handle association related requests either from WSTA or from local MLME
  32
  33     Revision History:
  34     Who         When          What
  35     --------    ----------    ----------------------------------------------
  36         Jan Lee         2006            created for rt2860
  37  */
  38
  39 #include "../rt_config.h"
  40 #include "../action.h"
  41
  42
  43 static VOID ReservedAction(
  44         IN PRTMP_ADAPTER pAd,
  45         IN MLME_QUEUE_ELEM *Elem);
  46
  47 /*
  48     ==========================================================================
  49     Description:
  50         association state machine init, including state transition and timer init
  51     Parameters:
  52         S - pointer to the association state machine
  53     Note:
  54         The state machine looks like the following
  55
  56                                     ASSOC_IDLE
  57         MT2_MLME_DISASSOC_REQ    mlme_disassoc_req_action
  58         MT2_PEER_DISASSOC_REQ    peer_disassoc_action
  59         MT2_PEER_ASSOC_REQ       drop
  60         MT2_PEER_REASSOC_REQ     drop
  61         MT2_CLS3ERR              cls3err_action
  62     ==========================================================================
  63  */
  64 VOID ActionStateMachineInit(
  65     IN  PRTMP_ADAPTER   pAd,
  66     IN  STATE_MACHINE *S,
  67     OUT STATE_MACHINE_FUNC Trans[])
  68 {
  69         StateMachineInit(S, (STATE_MACHINE_FUNC *)Trans, MAX_ACT_STATE, MAX_ACT_MSG, (STATE_MACHINE_FUNC)Drop, ACT_IDLE, ACT_MACHINE_BASE);
  70
  71         StateMachineSetAction(S, ACT_IDLE, MT2_PEER_SPECTRUM_CATE, (STATE_MACHINE_FUNC)PeerSpectrumAction);
  72         StateMachineSetAction(S, ACT_IDLE, MT2_PEER_QOS_CATE, (STATE_MACHINE_FUNC)PeerQOSAction);
  73
  74         StateMachineSetAction(S, ACT_IDLE, MT2_PEER_DLS_CATE, (STATE_MACHINE_FUNC)ReservedAction);
  75
  76         StateMachineSetAction(S, ACT_IDLE, MT2_PEER_BA_CATE, (STATE_MACHINE_FUNC)PeerBAAction);
  77         StateMachineSetAction(S, ACT_IDLE, MT2_PEER_HT_CATE, (STATE_MACHINE_FUNC)PeerHTAction);
  78         StateMachineSetAction(S, ACT_IDLE, MT2_MLME_ADD_BA_CATE, (STATE_MACHINE_FUNC)MlmeADDBAAction);
  79         StateMachineSetAction(S, ACT_IDLE, MT2_MLME_ORI_DELBA_CATE, (STATE_MACHINE_FUNC)MlmeDELBAAction);
  80         StateMachineSetAction(S, ACT_IDLE, MT2_MLME_REC_DELBA_CATE, (STATE_MACHINE_FUNC)MlmeDELBAAction);
  81
  82         StateMachineSetAction(S, ACT_IDLE, MT2_PEER_PUBLIC_CATE, (STATE_MACHINE_FUNC)PeerPublicAction);
  83         StateMachineSetAction(S, ACT_IDLE, MT2_PEER_RM_CATE, (STATE_MACHINE_FUNC)PeerRMAction);
  84
  85         StateMachineSetAction(S, ACT_IDLE, MT2_MLME_QOS_CATE, (STATE_MACHINE_FUNC)MlmeQOSAction);
  86         StateMachineSetAction(S, ACT_IDLE, MT2_MLME_DLS_CATE, (STATE_MACHINE_FUNC)MlmeDLSAction);
  87         StateMachineSetAction(S, ACT_IDLE, MT2_ACT_INVALID, (STATE_MACHINE_FUNC)MlmeInvalidAction);
  88 }
  89
  90 VOID MlmeADDBAAction(
  91     IN PRTMP_ADAPTER pAd,
  92     IN MLME_QUEUE_ELEM *Elem)
  93
  94 {
  95         MLME_ADDBA_REQ_STRUCT *pInfo;
  96         UCHAR           Addr[6];
  97         PUCHAR         pOutBuffer = NULL;
  98         NDIS_STATUS     NStatus;
  99         ULONG           Idx;
 100         FRAME_ADDBA_REQ  Frame;
 101         ULONG           FrameLen;
 102         BA_ORI_ENTRY                    *pBAEntry = NULL;
 103
 104         pInfo = (MLME_ADDBA_REQ_STRUCT *)Elem->Msg;
 105         NdisZeroMemory(&Frame, sizeof(FRAME_ADDBA_REQ));
 106
 107         if(MlmeAddBAReqSanity(pAd, Elem->Msg, Elem->MsgLen, Addr))
 108         {
 109                 NStatus = MlmeAllocateMemory(pAd, &pOutBuffer);  //Get an unused nonpaged memory
 110                 if(NStatus != NDIS_STATUS_SUCCESS)
 111                 {
 112                         DBGPRINT(RT_DEBUG_TRACE,("BA - MlmeADDBAAction() allocate memory failed \n"));
 113                         return;
 114                 }
 115                 // 1. find entry
 116                 Idx = pAd->MacTab.Content[pInfo->Wcid].BAOriWcidArray[pInfo->TID];
 117                 if (Idx == 0)
 118                 {
 119                         MlmeFreeMemory(pAd, pOutBuffer);
 120                         DBGPRINT(RT_DEBUG_ERROR,("BA - MlmeADDBAAction() can't find BAOriEntry \n"));
 121                         return;
 122                 }
 123                 else
 124                 {
 125                         pBAEntry =&pAd->BATable.BAOriEntry[Idx];
 126                 }
 127
 128                 {
 129                         if (ADHOC_ON(pAd))
 130                                 ActHeaderInit(pAd, &Frame.Hdr, pInfo->pAddr, pAd->CurrentAddress, pAd->CommonCfg.Bssid);
 131                         else
 132                                 ActHeaderInit(pAd, &Frame.Hdr, pAd->CommonCfg.Bssid, pAd->CurrentAddress, pInfo->pAddr);
 133
 134                 }
 135
 136                 Frame.Category = CATEGORY_BA;
 137                 Frame.Action = ADDBA_REQ;
 138                 Frame.BaParm.AMSDUSupported = 0;
 139                 Frame.BaParm.BAPolicy = IMMED_BA;
 140                 Frame.BaParm.TID = pInfo->TID;
 141                 Frame.BaParm.BufSize = pInfo->BaBufSize;
 142                 Frame.Token = pInfo->Token;
 143                 Frame.TimeOutValue = pInfo->TimeOutValue;
 144                 Frame.BaStartSeq.field.FragNum = 0;
 145                 Frame.BaStartSeq.field.StartSeq = pAd->MacTab.Content[pInfo->Wcid].TxSeq[pInfo->TID];
 146
 147                 *(USHORT *)(&Frame.BaParm) = cpu2le16(*(USHORT *)(&Frame.BaParm));
 148                 Frame.TimeOutValue = cpu2le16(Frame.TimeOutValue);
 149                 Frame.BaStartSeq.word = cpu2le16(Frame.BaStartSeq.word);
 150
 151                 MakeOutgoingFrame(pOutBuffer,              &FrameLen,
 152                               sizeof(FRAME_ADDBA_REQ), &Frame,
 153                               END_OF_ARGS);
 154                 MiniportMMRequest(pAd, QID_AC_BE, pOutBuffer, FrameLen);
 155                 //MiniportDataMMRequest(pAd, MapUserPriorityToAccessCategory[pInfo->TID], pOutBuffer, FrameLen);
 156                 MlmeFreeMemory(pAd, pOutBuffer);
 157
 158                 DBGPRINT(RT_DEBUG_TRACE, ("BA - Send ADDBA request. StartSeq = %x,  FrameLen = %ld. BufSize = %d\n", Frame.BaStartSeq.field.StartSeq, FrameLen, Frame.BaParm.BufSize));
 159     }
 160 }
 161
 162 /*
 163     ==========================================================================
 164     Description:
 165         send DELBA and delete BaEntry if any
 166     Parametrs:
 167         Elem - MLME message MLME_DELBA_REQ_STRUCT
 168
 169         IRQL = DISPATCH_LEVEL
 170
 171     ==========================================================================
 172  */
 173 VOID MlmeDELBAAction(
 174     IN PRTMP_ADAPTER pAd,
 175     IN MLME_QUEUE_ELEM *Elem)
 176 {
 177         MLME_DELBA_REQ_STRUCT *pInfo;
 178         PUCHAR         pOutBuffer = NULL;
 179         PUCHAR             pOutBuffer2 = NULL;
 180         NDIS_STATUS     NStatus;
 181         ULONG           Idx;
 182         FRAME_DELBA_REQ  Frame;
 183         ULONG           FrameLen;
 184         FRAME_BAR       FrameBar;
 185
 186         pInfo = (MLME_DELBA_REQ_STRUCT *)Elem->Msg;
 187         // must send back DELBA
 188         NdisZeroMemory(&Frame, sizeof(FRAME_DELBA_REQ));
 189         DBGPRINT(RT_DEBUG_TRACE, ("==> MlmeDELBAAction(), Initiator(%d) \n", pInfo->Initiator));
 190
 191         if(MlmeDelBAReqSanity(pAd, Elem->Msg, Elem->MsgLen))
 192         {
 193                 NStatus = MlmeAllocateMemory(pAd, &pOutBuffer);  //Get an unused nonpaged memory
 194                 if(NStatus != NDIS_STATUS_SUCCESS)
 195                 {
 196                         DBGPRINT(RT_DEBUG_ERROR,("BA - MlmeDELBAAction() allocate memory failed 1. \n"));
 197                         return;
 198                 }
 199
 200                 NStatus = MlmeAllocateMemory(pAd, &pOutBuffer2);  //Get an unused nonpaged memory
 201                 if(NStatus != NDIS_STATUS_SUCCESS)
 202                 {
 203                         MlmeFreeMemory(pAd, pOutBuffer);
 204                         DBGPRINT(RT_DEBUG_ERROR, ("BA - MlmeDELBAAction() allocate memory failed 2. \n"));
 205                         return;
 206                 }
 207
 208                 // SEND BAR (Send BAR to refresh peer reordering buffer.)
 209                 Idx = pAd->MacTab.Content[pInfo->Wcid].BAOriWcidArray[pInfo->TID];
 210
 211                 BarHeaderInit(pAd, &FrameBar, pAd->MacTab.Content[pInfo->Wcid].Addr, pAd->CurrentAddress);
 212
 213                 FrameBar.StartingSeq.field.FragNum = 0; // make sure sequence not clear in DEL funciton.
 214                 FrameBar.StartingSeq.field.StartSeq = pAd->MacTab.Content[pInfo->Wcid].TxSeq[pInfo->TID]; // make sure sequence not clear in DEL funciton.
 215                 FrameBar.BarControl.TID = pInfo->TID; // make sure sequence not clear in DEL funciton.
 216                 FrameBar.BarControl.ACKPolicy = IMMED_BA; // make sure sequence not clear in DEL funciton.
 217                 FrameBar.BarControl.Compressed = 1; // make sure sequence not clear in DEL funciton.
 218                 FrameBar.BarControl.MTID = 0; // make sure sequence not clear in DEL funciton.
 219
 220                 MakeOutgoingFrame(pOutBuffer2,                          &FrameLen,
 221                                           sizeof(FRAME_BAR),      &FrameBar,
 222                                           END_OF_ARGS);
 223                 MiniportMMRequest(pAd, QID_AC_BE, pOutBuffer2, FrameLen);
 224                 MlmeFreeMemory(pAd, pOutBuffer2);
 225                 DBGPRINT(RT_DEBUG_TRACE,("BA - MlmeDELBAAction() . Send BAR to refresh peer reordering buffer \n"));
 226
 227                 // SEND DELBA FRAME
 228                 FrameLen = 0;
 229
 230                 {
 231                         if (ADHOC_ON(pAd))
 232                                 ActHeaderInit(pAd, &Frame.Hdr, pAd->MacTab.Content[pInfo->Wcid].Addr, pAd->CurrentAddress, pAd->CommonCfg.Bssid);
 233                         else
 234                                 ActHeaderInit(pAd, &Frame.Hdr,  pAd->CommonCfg.Bssid, pAd->CurrentAddress, pAd->MacTab.Content[pInfo->Wcid].Addr);
 235                 }
 236
 237                 Frame.Category = CATEGORY_BA;
 238                 Frame.Action = DELBA;
 239                 Frame.DelbaParm.Initiator = pInfo->Initiator;
 240                 Frame.DelbaParm.TID = pInfo->TID;
 241                 Frame.ReasonCode = 39; // Time Out
 242                 *(USHORT *)(&Frame.DelbaParm) = cpu2le16(*(USHORT *)(&Frame.DelbaParm));
 243                 Frame.ReasonCode = cpu2le16(Frame.ReasonCode);
 244
 245                 MakeOutgoingFrame(pOutBuffer,               &FrameLen,
 246                               sizeof(FRAME_DELBA_REQ),    &Frame,
 247                               END_OF_ARGS);
 248                 MiniportMMRequest(pAd, QID_AC_BE, pOutBuffer, FrameLen);
 249                 MlmeFreeMemory(pAd, pOutBuffer);
 250                 DBGPRINT(RT_DEBUG_TRACE, ("BA - MlmeDELBAAction() . 3 DELBA sent. Initiator(%d)\n", pInfo->Initiator));
 251         }
 252 }
 253
 254 VOID MlmeQOSAction(
 255     IN PRTMP_ADAPTER pAd,
 256     IN MLME_QUEUE_ELEM *Elem)
 257 {
 258 }
 259
 260 VOID MlmeDLSAction(
 261     IN PRTMP_ADAPTER pAd,
 262     IN MLME_QUEUE_ELEM *Elem)
 263 {
 264 }
 265
 266 VOID MlmeInvalidAction(
 267     IN PRTMP_ADAPTER pAd,
 268     IN MLME_QUEUE_ELEM *Elem)
 269 {
 270         //PUCHAR                   pOutBuffer = NULL;
 271         //Return the receiving frame except the MSB of category filed set to 1.  7.3.1.11
 272 }
 273
 274 VOID PeerQOSAction(
 275         IN PRTMP_ADAPTER pAd,
 276         IN MLME_QUEUE_ELEM *Elem)
 277 {
 278 }
 279
 280 VOID PeerBAAction(
 281         IN PRTMP_ADAPTER pAd,
 282         IN MLME_QUEUE_ELEM *Elem)
 283 {
 284         UCHAR   Action = Elem->Msg[LENGTH_802_11+1];
 285
 286         switch(Action)
 287         {
 288                 case ADDBA_REQ:
 289                         PeerAddBAReqAction(pAd,Elem);
 290                         break;
 291                 case ADDBA_RESP:
 292                         PeerAddBARspAction(pAd,Elem);
 293                         break;
 294                 case DELBA:
 295                         PeerDelBAAction(pAd,Elem);
 296                         break;
 297         }
 298 }
 299
 300 VOID PeerPublicAction(
 301         IN PRTMP_ADAPTER pAd,
 302         IN MLME_QUEUE_ELEM *Elem)
 303 {
 304         if (Elem->Wcid >= MAX_LEN_OF_MAC_TABLE)
 305                 return;
 306 }
 307
 308
 309 static VOID ReservedAction(
 310         IN PRTMP_ADAPTER pAd,
 311         IN MLME_QUEUE_ELEM *Elem)
 312 {
 313         UCHAR Category;
 314
 315         if (Elem->MsgLen <= LENGTH_802_11)
 316         {
 317                 return;
 318         }
 319
 320         Category = Elem->Msg[LENGTH_802_11];
 321         DBGPRINT(RT_DEBUG_TRACE,("Rcv reserved category(%d) Action Frame\n", Category));
 322         hex_dump("Reserved Action Frame", &Elem->Msg[0], Elem->MsgLen);
 323 }
 324
 325 VOID PeerRMAction(
 326         IN PRTMP_ADAPTER pAd,
 327         IN MLME_QUEUE_ELEM *Elem)
 328
 329 {
 330         return;
 331 }
 332
 333 static VOID respond_ht_information_exchange_action(
 334         IN PRTMP_ADAPTER pAd,
 335         IN MLME_QUEUE_ELEM *Elem)
 336 {
 337         PUCHAR                  pOutBuffer = NULL;
 338         NDIS_STATUS             NStatus;
 339         ULONG                   FrameLen;
 340         FRAME_HT_INFO   HTINFOframe, *pFrame;
 341         UCHAR                   *pAddr;
 342
 343
 344         // 2. Always send back ADDBA Response
 345         NStatus = MlmeAllocateMemory(pAd, &pOutBuffer);  //Get an unused nonpaged memory
 346
 347         if (NStatus != NDIS_STATUS_SUCCESS)
 348         {
 349                 DBGPRINT(RT_DEBUG_TRACE,("ACTION - respond_ht_information_exchange_action() allocate memory failed \n"));
 350                 return;
 351         }
 352
 353         // get RA
 354         pFrame = (FRAME_HT_INFO *) &Elem->Msg[0];
 355         pAddr = pFrame->Hdr.Addr2;
 356
 357         NdisZeroMemory(&HTINFOframe, sizeof(FRAME_HT_INFO));
 358         // 2-1. Prepare ADDBA Response frame.
 359         {
 360                 if (ADHOC_ON(pAd))
 361                         ActHeaderInit(pAd, &HTINFOframe.Hdr, pAddr, pAd->CurrentAddress, pAd->CommonCfg.Bssid);
 362                 else
 363                         ActHeaderInit(pAd, &HTINFOframe.Hdr, pAd->CommonCfg.Bssid, pAd->CurrentAddress, pAddr);
 364         }
 365
 366         HTINFOframe.Category = CATEGORY_HT;
 367         HTINFOframe.Action = HT_INFO_EXCHANGE;
 368         HTINFOframe.HT_Info.Request = 0;
 369         HTINFOframe.HT_Info.Forty_MHz_Intolerant = pAd->CommonCfg.HtCapability.HtCapInfo.Forty_Mhz_Intolerant;
 370         HTINFOframe.HT_Info.STA_Channel_Width    = pAd->CommonCfg.AddHTInfo.AddHtInfo.RecomWidth;
 371
 372         MakeOutgoingFrame(pOutBuffer,                                   &FrameLen,
 373                                           sizeof(FRAME_HT_INFO),        &HTINFOframe,
 374                                           END_OF_ARGS);
 375
 376         MiniportMMRequest(pAd, QID_AC_BE, pOutBuffer, FrameLen);
 377         MlmeFreeMemory(pAd, pOutBuffer);
 378 }
 379
 380 VOID PeerHTAction(
 381         IN PRTMP_ADAPTER pAd,
 382         IN MLME_QUEUE_ELEM *Elem)
 383 {
 384         UCHAR   Action = Elem->Msg[LENGTH_802_11+1];
 385
 386         if (Elem->Wcid >= MAX_LEN_OF_MAC_TABLE)
 387                 return;
 388
 389         switch(Action)
 390         {
 391                 case NOTIFY_BW_ACTION:
 392                         DBGPRINT(RT_DEBUG_TRACE,("ACTION - HT Notify Channel bandwidth action----> \n"));
 393
 394                         if(pAd->StaActive.SupportedPhyInfo.bHtEnable == FALSE)
 395                         {
 396                                 // Note, this is to patch DIR-1353 AP. When the AP set to Wep, it will use legacy mode. But AP still keeps
 397                                 // sending BW_Notify Action frame, and cause us to linkup and linkdown.
 398                                 // In legacy mode, don't need to parse HT action frame.
 399                                 DBGPRINT(RT_DEBUG_TRACE,("ACTION -Ignore HT Notify Channel BW when link as legacy mode. BW = %d---> \n",
 400                                                                 Elem->Msg[LENGTH_802_11+2] ));
 401                                 break;
 402                         }
 403
 404                         if (Elem->Msg[LENGTH_802_11+2] == 0)    // 7.4.8.2. if value is 1, keep the same as supported channel bandwidth.
 405                                 pAd->MacTab.Content[Elem->Wcid].HTPhyMode.field.BW = 0;
 406
 407                         break;
 408
 409                 case SMPS_ACTION:
 410                         // 7.3.1.25
 411                         DBGPRINT(RT_DEBUG_TRACE,("ACTION - SMPS action----> \n"));
 412                         if (((Elem->Msg[LENGTH_802_11+2]&0x1) == 0))
 413                         {
 414                                 pAd->MacTab.Content[Elem->Wcid].MmpsMode = MMPS_ENABLE;
 415                         }
 416                         else if (((Elem->Msg[LENGTH_802_11+2]&0x2) == 0))
 417                         {
 418                                 pAd->MacTab.Content[Elem->Wcid].MmpsMode = MMPS_STATIC;
 419                         }
 420                         else
 421                         {
 422                                 pAd->MacTab.Content[Elem->Wcid].MmpsMode = MMPS_DYNAMIC;
 423                         }
 424
 425                         DBGPRINT(RT_DEBUG_TRACE,("Aid(%d) MIMO PS = %d\n", Elem->Wcid, pAd->MacTab.Content[Elem->Wcid].MmpsMode));
 426                         // rt2860c : add something for smps change.
 427                         break;
 428
 429                 case SETPCO_ACTION:
 430                         break;
 431
 432                 case MIMO_CHA_MEASURE_ACTION:
 433                         break;
 434
 435                 case HT_INFO_EXCHANGE:
 436                         {
 437                                 HT_INFORMATION_OCTET    *pHT_info;
 438
 439                                 pHT_info = (HT_INFORMATION_OCTET *) &Elem->Msg[LENGTH_802_11+2];
 440                                 // 7.4.8.10
 441                                 DBGPRINT(RT_DEBUG_TRACE,("ACTION - HT Information Exchange action----> \n"));
 442                                 if (pHT_info->Request)
 443                                 {
 444                                         respond_ht_information_exchange_action(pAd, Elem);
 445                                 }
 446                         }
 447                         break;
 448         }
 449 }
 450
 451
 452 /*
 453         ==========================================================================
 454         Description:
 455                 Retry sending ADDBA Reqest.
 456
 457         IRQL = DISPATCH_LEVEL
 458
 459         Parametrs:
 460         p8023Header: if this is already 802.3 format, p8023Header is NULL
 461
 462         Return  : TRUE if put into rx reordering buffer, shouldn't indicaterxhere.
 463                                 FALSE , then continue indicaterx at this moment.
 464         ==========================================================================
 465  */
 466 VOID ORIBATimerTimeout(
 467         IN      PRTMP_ADAPTER   pAd)
 468 {
 469         MAC_TABLE_ENTRY *pEntry;
 470         INT                     i, total;
 471 //      FRAME_BAR                       FrameBar;
 472 //      ULONG                   FrameLen;
 473 //      NDIS_STATUS     NStatus;
 474 //      PUCHAR                  pOutBuffer = NULL;
 475 //      USHORT                  Sequence;
 476         UCHAR                   TID;
 477
 478         total = pAd->MacTab.Size * NUM_OF_TID;
 479
 480         for (i = 1; ((i <MAX_LEN_OF_BA_ORI_TABLE) && (total > 0)) ; i++)
 481         {
 482                 if  (pAd->BATable.BAOriEntry[i].ORI_BA_Status == Originator_Done)
 483                 {
 484                         pEntry = &pAd->MacTab.Content[pAd->BATable.BAOriEntry[i].Wcid];
 485                         TID = pAd->BATable.BAOriEntry[i].TID;
 486
 487                         ASSERT(pAd->BATable.BAOriEntry[i].Wcid < MAX_LEN_OF_MAC_TABLE);
 488                 }
 489                 total --;
 490         }
 491 }
 492
 493
 494 VOID SendRefreshBAR(
 495         IN      PRTMP_ADAPTER   pAd,
 496         IN      MAC_TABLE_ENTRY *pEntry)
 497 {
 498         FRAME_BAR               FrameBar;
 499         ULONG                   FrameLen;
 500         NDIS_STATUS     NStatus;
 501         PUCHAR                  pOutBuffer = NULL;
 502         USHORT                  Sequence;
 503         UCHAR                   i, TID;
 504         USHORT                  idx;
 505         BA_ORI_ENTRY    *pBAEntry;
 506
 507         for (i = 0; i <NUM_OF_TID; i++)
 508         {
 509                 idx = pEntry->BAOriWcidArray[i];
 510                 if (idx == 0)
 511                 {
 512                         continue;
 513                 }
 514                 pBAEntry = &pAd->BATable.BAOriEntry[idx];
 515
 516                 if  (pBAEntry->ORI_BA_Status == Originator_Done)
 517                 {
 518                         TID = pBAEntry->TID;
 519
 520                         ASSERT(pBAEntry->Wcid < MAX_LEN_OF_MAC_TABLE);
 521
 522                         NStatus = MlmeAllocateMemory(pAd, &pOutBuffer);  //Get an unused nonpaged memory
 523                         if(NStatus != NDIS_STATUS_SUCCESS)
 524                         {
 525                                 DBGPRINT(RT_DEBUG_ERROR,("BA - MlmeADDBAAction() allocate memory failed \n"));
 526                                 return;
 527                         }
 528
 529                         Sequence = pEntry->TxSeq[TID];
 530
 531                         BarHeaderInit(pAd, &FrameBar, pEntry->Addr, pAd->CurrentAddress);
 532
 533                         FrameBar.StartingSeq.field.FragNum = 0; // make sure sequence not clear in DEL function.
 534                         FrameBar.StartingSeq.field.StartSeq = Sequence; // make sure sequence not clear in DEL funciton.
 535                         FrameBar.BarControl.TID = TID; // make sure sequence not clear in DEL funciton.
 536
 537                         MakeOutgoingFrame(pOutBuffer,                           &FrameLen,
 538                                                           sizeof(FRAME_BAR),      &FrameBar,
 539                                                           END_OF_ARGS);
 540                         //if (!(CLIENT_STATUS_TEST_FLAG(pEntry, fCLIENT_STATUS_RALINK_CHIPSET)))
 541                         if (1)  // Now we always send BAR.
 542                         {
 543                                 //MiniportMMRequestUnlock(pAd, 0, pOutBuffer, FrameLen);
 544                                 MiniportMMRequest(pAd, QID_AC_BE, pOutBuffer, FrameLen);
 545                                 //MiniportDataMMRequest(pAd, MapUserPriorityToAccessCategory[TID], pOutBuffer, FrameLen);
 546                         }
 547                         MlmeFreeMemory(pAd, pOutBuffer);
 548                 }
 549         }
 550 }
 551
 552 VOID ActHeaderInit(
 553     IN  PRTMP_ADAPTER   pAd,
 554     IN OUT PHEADER_802_11 pHdr80211,
 555     IN PUCHAR Addr1,
 556     IN PUCHAR Addr2,
 557     IN PUCHAR Addr3)
 558 {
 559     NdisZeroMemory(pHdr80211, sizeof(HEADER_802_11));
 560     pHdr80211->FC.Type = BTYPE_MGMT;
 561     pHdr80211->FC.SubType = SUBTYPE_ACTION;
 562
 563     COPY_MAC_ADDR(pHdr80211->Addr1, Addr1);
 564         COPY_MAC_ADDR(pHdr80211->Addr2, Addr2);
 565     COPY_MAC_ADDR(pHdr80211->Addr3, Addr3);
 566 }
 567
 568 VOID BarHeaderInit(
 569         IN      PRTMP_ADAPTER   pAd,
 570         IN OUT PFRAME_BAR pCntlBar,
 571         IN PUCHAR pDA,
 572         IN PUCHAR pSA)
 573 {
 574 //      USHORT  Duration;
 575
 576         NdisZeroMemory(pCntlBar, sizeof(FRAME_BAR));
 577         pCntlBar->FC.Type = BTYPE_CNTL;
 578         pCntlBar->FC.SubType = SUBTYPE_BLOCK_ACK_REQ;
 579         pCntlBar->BarControl.MTID = 0;
 580         pCntlBar->BarControl.Compressed = 1;
 581         pCntlBar->BarControl.ACKPolicy = 0;
 582
 583
 584         pCntlBar->Duration = 16 + RTMPCalcDuration(pAd, RATE_1, sizeof(FRAME_BA));
 585
 586         COPY_MAC_ADDR(pCntlBar->Addr1, pDA);
 587         COPY_MAC_ADDR(pCntlBar->Addr2, pSA);
 588 }
 589
 590
 591 /*
 592         ==========================================================================
 593         Description:
 594                 Insert Category and action code into the action frame.
 595
 596         Parametrs:
 597                 1. frame buffer pointer.
 598                 2. frame length.
 599                 3. category code of the frame.
 600                 4. action code of the frame.
 601
 602         Return  : None.
 603         ==========================================================================
 604  */
 605 VOID InsertActField(
 606         IN PRTMP_ADAPTER pAd,
 607         OUT PUCHAR pFrameBuf,
 608         OUT PULONG pFrameLen,
 609         IN UINT8 Category,
 610         IN UINT8 ActCode)
 611 {
 612         ULONG TempLen;
 613
 614         MakeOutgoingFrame(      pFrameBuf,              &TempLen,
 615                                                 1,                              &Category,
 616                                                 1,                              &ActCode,
 617                                                 END_OF_ARGS);
 618
 619         *pFrameLen = *pFrameLen + TempLen;
 620
 621         return;
 622 }