git.oblomov.eu Git - linux-2.6/blob - drivers/staging/rt2870/common/2870_rtmp_init.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         2870_rtmp_init.c
  29
  30         Abstract:
  31         Miniport generic portion header file
  32
  33         Revision History:
  34         Who         When          What
  35         --------    ----------    ----------------------------------------------
  36         Paul Lin    2002-08-01    created
  37     John Chang  2004-08-20    RT2561/2661 use scatter-gather scheme
  38     Jan Lee     2006-09-15    RT2860. Change for 802.11n , EEPROM, Led, BA, HT.
  39         Sample Lin      2007-05-31    Merge RT2860 and RT2870 drivers.
  40 */
  41
  42 #include "../rt_config.h"
  43
  44
  45 static void rx_done_tasklet(unsigned long data);
  46 static void rt2870_hcca_dma_done_tasklet(unsigned long data);
  47 static void rt2870_ac3_dma_done_tasklet(unsigned long data);
  48 static void rt2870_ac2_dma_done_tasklet(unsigned long data);
  49 static void rt2870_ac1_dma_done_tasklet(unsigned long data);
  50 static void rt2870_ac0_dma_done_tasklet(unsigned long data);
  51 static void rt2870_mgmt_dma_done_tasklet(unsigned long data);
  52 static void rt2870_null_frame_complete_tasklet(unsigned long data);
  53 static void rt2870_rts_frame_complete_tasklet(unsigned long data);
  54 static void rt2870_pspoll_frame_complete_tasklet(unsigned long data);
  55 static void rt2870_dataout_complete_tasklet(unsigned long data);
  56
  57
  58 /*
  59 ========================================================================
  60 Routine Description:
  61     Initialize receive data structures.
  62
  63 Arguments:
  64     pAd                                 Pointer to our adapter
  65
  66 Return Value:
  67         NDIS_STATUS_SUCCESS
  68         NDIS_STATUS_RESOURCES
  69
  70 Note:
  71         Initialize all receive releated private buffer, include those define
  72         in RTMP_ADAPTER structure and all private data structures. The mahor
  73         work is to allocate buffer for each packet and chain buffer to
  74         NDIS packet descriptor.
  75 ========================================================================
  76 */
  77 NDIS_STATUS     NICInitRecv(
  78         IN      PRTMP_ADAPTER   pAd)
  79 {
  80         UCHAR                           i;
  81         NDIS_STATUS                     Status = NDIS_STATUS_SUCCESS;
  82         POS_COOKIE                      pObj = (POS_COOKIE) pAd->OS_Cookie;
  83
  84
  85         DBGPRINT(RT_DEBUG_TRACE, ("--> NICInitRecv\n"));
  86         pObj = pObj;
  87
  88         //InterlockedExchange(&pAd->PendingRx, 0);
  89         pAd->PendingRx = 0;
  90         pAd->NextRxBulkInReadIndex      = 0;    // Next Rx Read index
  91         pAd->NextRxBulkInIndex          = 0 ; //RX_RING_SIZE -1; // Rx Bulk pointer
  92         pAd->NextRxBulkInPosition       = 0;
  93
  94         for (i = 0; i < (RX_RING_SIZE); i++)
  95         {
  96                 PRX_CONTEXT  pRxContext = &(pAd->RxContext[i]);
  97
  98                 //Allocate URB
  99                 pRxContext->pUrb = RTUSB_ALLOC_URB(0);
 100                 if (pRxContext->pUrb == NULL)
 101                 {
 102                         Status = NDIS_STATUS_RESOURCES;
 103                         goto out1;
 104                 }
 105
 106                 // Allocate transfer buffer
 107                 pRxContext->TransferBuffer = RTUSB_URB_ALLOC_BUFFER(pObj->pUsb_Dev, MAX_RXBULK_SIZE, &pRxContext->data_dma);
 108                 if (pRxContext->TransferBuffer == NULL)
 109                 {
 110                         Status = NDIS_STATUS_RESOURCES;
 111                         goto out1;
 112                 }
 113
 114                 NdisZeroMemory(pRxContext->TransferBuffer, MAX_RXBULK_SIZE);
 115
 116                 pRxContext->pAd = pAd;
 117                 pRxContext->pIrp = NULL;
 118                 pRxContext->InUse               = FALSE;
 119                 pRxContext->IRPPending  = FALSE;
 120                 pRxContext->Readable    = FALSE;
 121                 //pRxContext->ReorderInUse = FALSE;
 122                 pRxContext->bRxHandling = FALSE;
 123                 pRxContext->BulkInOffset = 0;
 124         }
 125
 126         DBGPRINT(RT_DEBUG_TRACE, ("<-- NICInitRecv\n"));
 127         return Status;
 128
 129 out1:
 130         for (i = 0; i < (RX_RING_SIZE); i++)
 131         {
 132                 PRX_CONTEXT  pRxContext = &(pAd->RxContext[i]);
 133
 134                 if (NULL != pRxContext->TransferBuffer)
 135                 {
 136                         RTUSB_URB_FREE_BUFFER(pObj->pUsb_Dev, MAX_RXBULK_SIZE,
 137                                                                 pRxContext->TransferBuffer, pRxContext->data_dma);
 138                         pRxContext->TransferBuffer = NULL;
 139                 }
 140
 141                 if (NULL != pRxContext->pUrb)
 142                 {
 143                         RTUSB_UNLINK_URB(pRxContext->pUrb);
 144                         RTUSB_FREE_URB(pRxContext->pUrb);
 145                         pRxContext->pUrb = NULL;
 146                 }
 147         }
 148
 149         return Status;
 150 }
 151
 152
 153 /*
 154 ========================================================================
 155 Routine Description:
 156     Initialize transmit data structures.
 157
 158 Arguments:
 159     pAd                                 Pointer to our adapter
 160
 161 Return Value:
 162         NDIS_STATUS_SUCCESS
 163         NDIS_STATUS_RESOURCES
 164
 165 Note:
 166 ========================================================================
 167 */
 168 NDIS_STATUS     NICInitTransmit(
 169         IN      PRTMP_ADAPTER   pAd)
 170 {
 171 #define LM_USB_ALLOC(pObj, Context, TB_Type, BufferSize, Status, msg1, err1, msg2, err2)        \
 172         Context->pUrb = RTUSB_ALLOC_URB(0);             \
 173         if (Context->pUrb == NULL) {                    \
 174                 DBGPRINT(RT_DEBUG_ERROR, msg1);         \
 175                 Status = NDIS_STATUS_RESOURCES;         \
 176                 goto err1; }                                            \
 177                                                                                         \
 178         Context->TransferBuffer =                               \
 179                 (TB_Type)RTUSB_URB_ALLOC_BUFFER(pObj->pUsb_Dev, BufferSize, &Context->data_dma);        \
 180         if (Context->TransferBuffer == NULL) {  \
 181                 DBGPRINT(RT_DEBUG_ERROR, msg2);         \
 182                 Status = NDIS_STATUS_RESOURCES;         \
 183                 goto err2; }
 184
 185 #define LM_URB_FREE(pObj, Context, BufferSize)                          \
 186         if (NULL != Context->pUrb) {                                                    \
 187                 RTUSB_UNLINK_URB(Context->pUrb);                                        \
 188                 RTUSB_FREE_URB(Context->pUrb);                                          \
 189                 Context->pUrb = NULL; }                                                         \
 190         if (NULL != Context->TransferBuffer) {                          \
 191                 RTUSB_URB_FREE_BUFFER(pObj->pUsb_Dev, BufferSize,       \
 192                                                                 Context->TransferBuffer,        \
 193                                                                 Context->data_dma);                     \
 194                 Context->TransferBuffer = NULL; }
 195
 196         UCHAR                   i, acidx;
 197         NDIS_STATUS     Status = NDIS_STATUS_SUCCESS;
 198         PTX_CONTEXT             pNullContext   = &(pAd->NullContext);
 199         PTX_CONTEXT             pPsPollContext = &(pAd->PsPollContext);
 200         PTX_CONTEXT             pRTSContext    = &(pAd->RTSContext);
 201         PTX_CONTEXT             pMLMEContext = NULL;
 202 //      PHT_TX_CONTEXT  pHTTXContext = NULL;
 203         POS_COOKIE              pObj = (POS_COOKIE) pAd->OS_Cookie;
 204         PVOID                   RingBaseVa;
 205 //      RTMP_TX_RING    *pTxRing;
 206         RTMP_MGMT_RING  *pMgmtRing;
 207
 208         DBGPRINT(RT_DEBUG_TRACE, ("--> NICInitTransmit\n"));
 209         pObj = pObj;
 210
 211         // Init 4 set of Tx parameters
 212         for(acidx = 0; acidx < NUM_OF_TX_RING; acidx++)
 213         {
 214                 // Initialize all Transmit releated queues
 215                 InitializeQueueHeader(&pAd->TxSwQueue[acidx]);
 216
 217                 // Next Local tx ring pointer waiting for buck out
 218                 pAd->NextBulkOutIndex[acidx] = acidx;
 219                 pAd->BulkOutPending[acidx] = FALSE; // Buck Out control flag
 220                 //pAd->DataBulkDoneIdx[acidx] = 0;
 221         }
 222
 223         //pAd->NextMLMEIndex    = 0;
 224         //pAd->PushMgmtIndex    = 0;
 225         //pAd->PopMgmtIndex     = 0;
 226         //InterlockedExchange(&pAd->MgmtQueueSize, 0);
 227         //InterlockedExchange(&pAd->TxCount, 0);
 228
 229         //pAd->PrioRingFirstIndex       = 0;
 230         //pAd->PrioRingTxCnt            = 0;
 231
 232         do
 233         {
 234                 //
 235                 // TX_RING_SIZE, 4 ACs
 236                 //
 237                 for(acidx=0; acidx<4; acidx++)
 238                 {
 239                         PHT_TX_CONTEXT  pHTTXContext = &(pAd->TxContext[acidx]);
 240
 241                         NdisZeroMemory(pHTTXContext, sizeof(HT_TX_CONTEXT));
 242                         //Allocate URB
 243                         LM_USB_ALLOC(pObj, pHTTXContext, PHTTX_BUFFER, sizeof(HTTX_BUFFER), Status,
 244                                                         ("<-- ERROR in Alloc TX TxContext[%d] urb!! \n", acidx),
 245                                                         done,
 246                                                         ("<-- ERROR in Alloc TX TxContext[%d] HTTX_BUFFER !! \n", acidx),
 247                                                         out1);
 248
 249                         NdisZeroMemory(pHTTXContext->TransferBuffer->Aggregation, 4);
 250                         pHTTXContext->pAd = pAd;
 251                         pHTTXContext->pIrp = NULL;
 252                         pHTTXContext->IRPPending = FALSE;
 253                         pHTTXContext->NextBulkOutPosition = 0;
 254                         pHTTXContext->ENextBulkOutPosition = 0;
 255                         pHTTXContext->CurWritePosition = 0;
 256                         pHTTXContext->CurWriteRealPos = 0;
 257                         pHTTXContext->BulkOutSize = 0;
 258                         pHTTXContext->BulkOutPipeId = acidx;
 259                         pHTTXContext->bRingEmpty = TRUE;
 260                         pHTTXContext->bCopySavePad = FALSE;
 261
 262                         pAd->BulkOutPending[acidx] = FALSE;
 263                 }
 264
 265
 266                 //
 267                 // MGMT_RING_SIZE
 268                 //
 269 #if 0
 270                 for(i=0; i<MGMT_RING_SIZE; i++) // 8
 271                 {
 272                         PTX_CONTEXT     pMLMEContext = &(pAd->MLMEContext[i]);
 273
 274
 275                         NdisZeroMemory(pMLMEContext, sizeof(TX_CONTEXT));
 276
 277                         //Allocate URB
 278                         LM_USB_ALLOC(pObj, pMLMEContext, PTX_BUFFER, sizeof(TX_BUFFER), Status,
 279                                                         ("<-- ERROR in Alloc TX MLMEContext[%d] urb!! \n", i),
 280                                                         out2,
 281                                                         ("<-- ERROR in Alloc TX MLMEContext[%d] TX_BUFFER !! \n", i),
 282                                                         out2);
 283
 284                         pMLMEContext->pAd = pAd;
 285                         pMLMEContext->pIrp = NULL;
 286                         pMLMEContext->InUse = FALSE;
 287                         pMLMEContext->IRPPending = FALSE;
 288                 }
 289 #else
 290                 // Allocate MGMT ring descriptor's memory
 291                 pAd->MgmtDescRing.AllocSize = MGMT_RING_SIZE * sizeof(TX_CONTEXT);
 292                 RTMPAllocateMemory(&pAd->MgmtDescRing.AllocVa, pAd->MgmtDescRing.AllocSize);
 293                 if (pAd->MgmtDescRing.AllocVa == NULL)
 294                 {
 295                         DBGPRINT_ERR(("Failed to allocate a big buffer for MgmtDescRing!\n"));
 296                         Status = NDIS_STATUS_RESOURCES;
 297                         goto out1;
 298                 }
 299                 NdisZeroMemory(pAd->MgmtDescRing.AllocVa, pAd->MgmtDescRing.AllocSize);
 300                 RingBaseVa     = pAd->MgmtDescRing.AllocVa;
 301
 302                 // Initialize MGMT Ring and associated buffer memory
 303                 pMgmtRing = &pAd->MgmtRing;
 304                 for (i = 0; i < MGMT_RING_SIZE; i++)
 305                 {
 306                         // link the pre-allocated Mgmt buffer to MgmtRing.Cell
 307                         pMgmtRing->Cell[i].AllocSize = sizeof(TX_CONTEXT);
 308                         pMgmtRing->Cell[i].AllocVa = RingBaseVa;
 309                         pMgmtRing->Cell[i].pNdisPacket = NULL;
 310                         pMgmtRing->Cell[i].pNextNdisPacket = NULL;
 311
 312                         //Allocate URB for MLMEContext
 313                         pMLMEContext = (PTX_CONTEXT) pAd->MgmtRing.Cell[i].AllocVa;
 314                         pMLMEContext->pUrb = RTUSB_ALLOC_URB(0);
 315                         if (pMLMEContext->pUrb == NULL)
 316                         {
 317                                 DBGPRINT(RT_DEBUG_ERROR, ("<-- ERROR in Alloc TX MLMEContext[%d] urb!! \n", i));
 318                                 Status = NDIS_STATUS_RESOURCES;
 319                                 goto out2;
 320                         }
 321                         pMLMEContext->pAd = pAd;
 322                         pMLMEContext->pIrp = NULL;
 323                         pMLMEContext->TransferBuffer = NULL;
 324                         pMLMEContext->InUse = FALSE;
 325                         pMLMEContext->IRPPending = FALSE;
 326                         pMLMEContext->bWaitingBulkOut = FALSE;
 327                         pMLMEContext->BulkOutSize = 0;
 328                         pMLMEContext->SelfIdx = i;
 329
 330                         // Offset to next ring descriptor address
 331                         RingBaseVa = (PUCHAR) RingBaseVa + sizeof(TX_CONTEXT);
 332                 }
 333                 DBGPRINT(RT_DEBUG_TRACE, ("MGMT Ring: total %d entry allocated\n", i));
 334
 335                 //pAd->MgmtRing.TxSwFreeIdx = (MGMT_RING_SIZE - 1);
 336                 pAd->MgmtRing.TxSwFreeIdx = MGMT_RING_SIZE;
 337                 pAd->MgmtRing.TxCpuIdx = 0;
 338                 pAd->MgmtRing.TxDmaIdx = 0;
 339 #endif
 340
 341                 //
 342                 // BEACON_RING_SIZE
 343                 //
 344                 for(i=0; i<BEACON_RING_SIZE; i++) // 2
 345                 {
 346                         PTX_CONTEXT     pBeaconContext = &(pAd->BeaconContext[i]);
 347
 348
 349                         NdisZeroMemory(pBeaconContext, sizeof(TX_CONTEXT));
 350
 351                         //Allocate URB
 352                         LM_USB_ALLOC(pObj, pBeaconContext, PTX_BUFFER, sizeof(TX_BUFFER), Status,
 353                                                         ("<-- ERROR in Alloc TX BeaconContext[%d] urb!! \n", i),
 354                                                         out2,
 355                                                         ("<-- ERROR in Alloc TX BeaconContext[%d] TX_BUFFER !! \n", i),
 356                                                         out3);
 357
 358                         pBeaconContext->pAd = pAd;
 359                         pBeaconContext->pIrp = NULL;
 360                         pBeaconContext->InUse = FALSE;
 361                         pBeaconContext->IRPPending = FALSE;
 362                 }
 363
 364                 //
 365                 // NullContext
 366                 //
 367                 NdisZeroMemory(pNullContext, sizeof(TX_CONTEXT));
 368
 369                 //Allocate URB
 370                 LM_USB_ALLOC(pObj, pNullContext, PTX_BUFFER, sizeof(TX_BUFFER), Status,
 371                                                 ("<-- ERROR in Alloc TX NullContext urb!! \n"),
 372                                                 out3,
 373                                                 ("<-- ERROR in Alloc TX NullContext TX_BUFFER !! \n"),
 374                                                 out4);
 375
 376                 pNullContext->pAd = pAd;
 377                 pNullContext->pIrp = NULL;
 378                 pNullContext->InUse = FALSE;
 379                 pNullContext->IRPPending = FALSE;
 380
 381                 //
 382                 // RTSContext
 383                 //
 384                 NdisZeroMemory(pRTSContext, sizeof(TX_CONTEXT));
 385
 386                 //Allocate URB
 387                 LM_USB_ALLOC(pObj, pRTSContext, PTX_BUFFER, sizeof(TX_BUFFER), Status,
 388                                                 ("<-- ERROR in Alloc TX RTSContext urb!! \n"),
 389                                                 out4,
 390                                                 ("<-- ERROR in Alloc TX RTSContext TX_BUFFER !! \n"),
 391                                                 out5);
 392
 393                 pRTSContext->pAd = pAd;
 394                 pRTSContext->pIrp = NULL;
 395                 pRTSContext->InUse = FALSE;
 396                 pRTSContext->IRPPending = FALSE;
 397
 398                 //
 399                 // PsPollContext
 400                 //
 401                 //NdisZeroMemory(pPsPollContext, sizeof(TX_CONTEXT));
 402                 //Allocate URB
 403                 LM_USB_ALLOC(pObj, pPsPollContext, PTX_BUFFER, sizeof(TX_BUFFER), Status,
 404                                                 ("<-- ERROR in Alloc TX PsPollContext urb!! \n"),
 405                                                 out5,
 406                                                 ("<-- ERROR in Alloc TX PsPollContext TX_BUFFER !! \n"),
 407                                                 out6);
 408
 409                 pPsPollContext->pAd = pAd;
 410                 pPsPollContext->pIrp = NULL;
 411                 pPsPollContext->InUse = FALSE;
 412                 pPsPollContext->IRPPending = FALSE;
 413                 pPsPollContext->bAggregatible = FALSE;
 414                 pPsPollContext->LastOne = TRUE;
 415
 416         }   while (FALSE);
 417
 418
 419 done:
 420         DBGPRINT(RT_DEBUG_TRACE, ("<-- NICInitTransmit\n"));
 421
 422         return Status;
 423
 424         /* --------------------------- ERROR HANDLE --------------------------- */
 425 out6:
 426         LM_URB_FREE(pObj, pPsPollContext, sizeof(TX_BUFFER));
 427
 428 out5:
 429         LM_URB_FREE(pObj, pRTSContext, sizeof(TX_BUFFER));
 430
 431 out4:
 432         LM_URB_FREE(pObj, pNullContext, sizeof(TX_BUFFER));
 433
 434 out3:
 435         for(i=0; i<BEACON_RING_SIZE; i++)
 436         {
 437                 PTX_CONTEXT     pBeaconContext = &(pAd->BeaconContext[i]);
 438                 if (pBeaconContext)
 439                         LM_URB_FREE(pObj, pBeaconContext, sizeof(TX_BUFFER));
 440         }
 441
 442 out2:
 443         if (pAd->MgmtDescRing.AllocVa)
 444         {
 445                 pMgmtRing = &pAd->MgmtRing;
 446         for(i=0; i<MGMT_RING_SIZE; i++)
 447         {
 448                 pMLMEContext = (PTX_CONTEXT) pAd->MgmtRing.Cell[i].AllocVa;
 449                 if (pMLMEContext)
 450                         LM_URB_FREE(pObj, pMLMEContext, sizeof(TX_BUFFER));
 451         }
 452                 NdisFreeMemory(pAd->MgmtDescRing.AllocVa, pAd->MgmtDescRing.AllocSize, 0);
 453                 pAd->MgmtDescRing.AllocVa = NULL;
 454         }
 455
 456 out1:
 457         for (acidx = 0; acidx < 4; acidx++)
 458         {
 459                 PHT_TX_CONTEXT pTxContext = &(pAd->TxContext[acidx]);
 460                 if (pTxContext)
 461                         LM_URB_FREE(pObj, pTxContext, sizeof(HTTX_BUFFER));
 462         }
 463
 464         // Here we didn't have any pre-allocated memory need to free.
 465
 466         return Status;
 467 }
 468
 469
 470 /*
 471 ========================================================================
 472 Routine Description:
 473     Allocate DMA memory blocks for send, receive.
 474
 475 Arguments:
 476     pAd                                 Pointer to our adapter
 477
 478 Return Value:
 479         NDIS_STATUS_SUCCESS
 480         NDIS_STATUS_FAILURE
 481         NDIS_STATUS_RESOURCES
 482
 483 Note:
 484 ========================================================================
 485 */
 486 NDIS_STATUS     RTMPAllocTxRxRingMemory(
 487         IN      PRTMP_ADAPTER   pAd)
 488 {
 489 //      COUNTER_802_11  pCounter = &pAd->WlanCounters;
 490         NDIS_STATUS             Status;
 491         INT                             num;
 492
 493
 494         DBGPRINT(RT_DEBUG_TRACE, ("--> RTMPAllocTxRxRingMemory\n"));
 495
 496
 497         do
 498         {
 499                 // Init the CmdQ and CmdQLock
 500                 NdisAllocateSpinLock(&pAd->CmdQLock);
 501                 NdisAcquireSpinLock(&pAd->CmdQLock);
 502                 RTUSBInitializeCmdQ(&pAd->CmdQ);
 503                 NdisReleaseSpinLock(&pAd->CmdQLock);
 504
 505
 506                 NdisAllocateSpinLock(&pAd->MLMEBulkOutLock);
 507                 //NdisAllocateSpinLock(&pAd->MLMEWaitQueueLock);
 508                 NdisAllocateSpinLock(&pAd->BulkOutLock[0]);
 509                 NdisAllocateSpinLock(&pAd->BulkOutLock[1]);
 510                 NdisAllocateSpinLock(&pAd->BulkOutLock[2]);
 511                 NdisAllocateSpinLock(&pAd->BulkOutLock[3]);
 512                 NdisAllocateSpinLock(&pAd->BulkOutLock[4]);
 513                 NdisAllocateSpinLock(&pAd->BulkOutLock[5]);
 514                 NdisAllocateSpinLock(&pAd->BulkInLock);
 515
 516                 for (num = 0; num < NUM_OF_TX_RING; num++)
 517                 {
 518                         NdisAllocateSpinLock(&pAd->TxContextQueueLock[num]);
 519                 }
 520
 521 //              NdisAllocateSpinLock(&pAd->MemLock);    // Not used in RT28XX
 522
 523 //              NdisAllocateSpinLock(&pAd->MacTabLock); // init it in UserCfgInit()
 524 //              NdisAllocateSpinLock(&pAd->BATabLock); // init it in BATableInit()
 525
 526 //              for(num=0; num<MAX_LEN_OF_BA_REC_TABLE; num++)
 527 //              {
 528 //                      NdisAllocateSpinLock(&pAd->BATable.BARecEntry[num].RxReRingLock);
 529 //              }
 530
 531                 //
 532                 // Init Mac Table
 533                 //
 534 //              MacTableInitialize(pAd);
 535
 536                 //
 537                 // Init send data structures and related parameters
 538                 //
 539                 Status = NICInitTransmit(pAd);
 540                 if (Status != NDIS_STATUS_SUCCESS)
 541                         break;
 542
 543                 //
 544                 // Init receive data structures and related parameters
 545                 //
 546                 Status = NICInitRecv(pAd);
 547                 if (Status != NDIS_STATUS_SUCCESS)
 548                         break;
 549
 550                 pAd->PendingIoCount = 1;
 551
 552         } while (FALSE);
 553
 554         NdisZeroMemory(&pAd->FragFrame, sizeof(FRAGMENT_FRAME));
 555         pAd->FragFrame.pFragPacket =  RTMP_AllocateFragPacketBuffer(pAd, RX_BUFFER_NORMSIZE);
 556
 557         if (pAd->FragFrame.pFragPacket == NULL)
 558         {
 559                 Status = NDIS_STATUS_RESOURCES;
 560         }
 561
 562         DBGPRINT_S(Status, ("<-- RTMPAllocTxRxRingMemory, Status=%x\n", Status));
 563         return Status;
 564 }
 565
 566
 567 /*
 568 ========================================================================
 569 Routine Description:
 570         Calls USB_InterfaceStop and frees memory allocated for the URBs
 571     calls NdisMDeregisterDevice and frees the memory
 572     allocated in VNetInitialize for the Adapter Object
 573
 574 Arguments:
 575         *pAd                            the raxx interface data pointer
 576
 577 Return Value:
 578         None
 579
 580 Note:
 581 ========================================================================
 582 */
 583 VOID    RTMPFreeTxRxRingMemory(
 584         IN      PRTMP_ADAPTER   pAd)
 585 {
 586 #define LM_URB_FREE(pObj, Context, BufferSize)                          \
 587         if (NULL != Context->pUrb) {                                                    \
 588                 RTUSB_UNLINK_URB(Context->pUrb);                                        \
 589                 RTUSB_FREE_URB(Context->pUrb);                                          \
 590                 Context->pUrb = NULL; }                                                         \
 591         if (NULL != Context->TransferBuffer) {                                  \
 592                 RTUSB_URB_FREE_BUFFER(pObj->pUsb_Dev, BufferSize,       \
 593                                                                 Context->TransferBuffer,        \
 594                                                                 Context->data_dma);                     \
 595                 Context->TransferBuffer = NULL; }
 596
 597
 598         UINT                i, acidx;
 599         PTX_CONTEXT                     pNullContext   = &pAd->NullContext;
 600         PTX_CONTEXT                     pPsPollContext = &pAd->PsPollContext;
 601         PTX_CONTEXT                     pRTSContext    = &pAd->RTSContext;
 602 //      PHT_TX_CONTEXT          pHTTXContext;
 603         //PRTMP_REORDERBUF      pReorderBuf;
 604         POS_COOKIE                      pObj = (POS_COOKIE) pAd->OS_Cookie;
 605 //      RTMP_TX_RING            *pTxRing;
 606
 607         DBGPRINT(RT_DEBUG_ERROR, ("---> RTMPFreeTxRxRingMemory\n"));
 608         pObj = pObj;
 609
 610         // Free all resources for the RECEIVE buffer queue.
 611         for(i=0; i<(RX_RING_SIZE); i++)
 612         {
 613                 PRX_CONTEXT  pRxContext = &(pAd->RxContext[i]);
 614                 if (pRxContext)
 615                         LM_URB_FREE(pObj, pRxContext, MAX_RXBULK_SIZE);
 616         }
 617
 618         // Free PsPoll frame resource
 619         LM_URB_FREE(pObj, pPsPollContext, sizeof(TX_BUFFER));
 620
 621         // Free NULL frame resource
 622         LM_URB_FREE(pObj, pNullContext, sizeof(TX_BUFFER));
 623
 624         // Free RTS frame resource
 625         LM_URB_FREE(pObj, pRTSContext, sizeof(TX_BUFFER));
 626
 627
 628         // Free beacon frame resource
 629         for(i=0; i<BEACON_RING_SIZE; i++)
 630         {
 631                 PTX_CONTEXT     pBeaconContext = &(pAd->BeaconContext[i]);
 632                 if (pBeaconContext)
 633                         LM_URB_FREE(pObj, pBeaconContext, sizeof(TX_BUFFER));
 634         }
 635
 636
 637         // Free mgmt frame resource
 638         for(i = 0; i < MGMT_RING_SIZE; i++)
 639         {
 640                 PTX_CONTEXT pMLMEContext = (PTX_CONTEXT)pAd->MgmtRing.Cell[i].AllocVa;
 641                 //LM_URB_FREE(pObj, pMLMEContext, sizeof(TX_BUFFER));
 642                 if (NULL != pAd->MgmtRing.Cell[i].pNdisPacket)
 643                 {
 644                         RTMPFreeNdisPacket(pAd, pAd->MgmtRing.Cell[i].pNdisPacket);
 645                         pAd->MgmtRing.Cell[i].pNdisPacket = NULL;
 646                         pMLMEContext->TransferBuffer = NULL;
 647                 }
 648
 649                 if (pMLMEContext)
 650                 {
 651                         if (NULL != pMLMEContext->pUrb)
 652                         {
 653                                 RTUSB_UNLINK_URB(pMLMEContext->pUrb);
 654                                 RTUSB_FREE_URB(pMLMEContext->pUrb);
 655                                 pMLMEContext->pUrb = NULL;
 656                         }
 657                 }
 658         }
 659         if (pAd->MgmtDescRing.AllocVa)
 660                 NdisFreeMemory(pAd->MgmtDescRing.AllocVa, pAd->MgmtDescRing.AllocSize, 0);
 661
 662
 663         // Free Tx frame resource
 664         for (acidx = 0; acidx < 4; acidx++)
 665                 {
 666                 PHT_TX_CONTEXT pHTTXContext = &(pAd->TxContext[acidx]);
 667                         if (pHTTXContext)
 668                                 LM_URB_FREE(pObj, pHTTXContext, sizeof(HTTX_BUFFER));
 669                 }
 670
 671         if (pAd->FragFrame.pFragPacket)
 672                 RELEASE_NDIS_PACKET(pAd, pAd->FragFrame.pFragPacket, NDIS_STATUS_SUCCESS);
 673
 674         for(i=0; i<6; i++)
 675         {
 676                 NdisFreeSpinLock(&pAd->BulkOutLock[i]);
 677         }
 678
 679         NdisFreeSpinLock(&pAd->BulkInLock);
 680         NdisFreeSpinLock(&pAd->MLMEBulkOutLock);
 681
 682         NdisFreeSpinLock(&pAd->CmdQLock);
 683
 684         // Clear all pending bulk-out request flags.
 685         RTUSB_CLEAR_BULK_FLAG(pAd, 0xffffffff);
 686
 687 //      NdisFreeSpinLock(&pAd->MacTabLock);
 688
 689 //      for(i=0; i<MAX_LEN_OF_BA_REC_TABLE; i++)
 690 //      {
 691 //              NdisFreeSpinLock(&pAd->BATable.BARecEntry[i].RxReRingLock);
 692 //      }
 693
 694         DBGPRINT(RT_DEBUG_ERROR, ("<--- ReleaseAdapter\n"));
 695 }
 696
 697
 698 /*
 699 ========================================================================
 700 Routine Description:
 701     Allocate memory for adapter control block.
 702
 703 Arguments:
 704     pAd                                 Pointer to our adapter
 705
 706 Return Value:
 707         NDIS_STATUS_SUCCESS
 708         NDIS_STATUS_FAILURE
 709         NDIS_STATUS_RESOURCES
 710
 711 Note:
 712 ========================================================================
 713 */
 714 NDIS_STATUS AdapterBlockAllocateMemory(
 715         IN PVOID        handle,
 716         OUT     PVOID   *ppAd)
 717 {
 718         PUSB_DEV        usb_dev;
 719         POS_COOKIE      pObj = (POS_COOKIE) handle;
 720
 721
 722         usb_dev = pObj->pUsb_Dev;
 723
 724         pObj->MLMEThr_task              = NULL;
 725         pObj->RTUSBCmdThr_task  = NULL;
 726
 727         *ppAd = (PVOID)vmalloc(sizeof(RTMP_ADAPTER));
 728
 729         if (*ppAd)
 730         {
 731                 NdisZeroMemory(*ppAd, sizeof(RTMP_ADAPTER));
 732                 ((PRTMP_ADAPTER)*ppAd)->OS_Cookie = handle;
 733                 return (NDIS_STATUS_SUCCESS);
 734         }
 735         else
 736         {
 737                 return (NDIS_STATUS_FAILURE);
 738         }
 739 }
 740
 741
 742 /*
 743 ========================================================================
 744 Routine Description:
 745     Create kernel threads & tasklets.
 746
 747 Arguments:
 748     *net_dev                    Pointer to wireless net device interface
 749
 750 Return Value:
 751         NDIS_STATUS_SUCCESS
 752         NDIS_STATUS_FAILURE
 753
 754 Note:
 755 ========================================================================
 756 */
 757 NDIS_STATUS      CreateThreads(
 758         IN      struct net_device *net_dev)
 759 {
 760         PRTMP_ADAPTER pAd = net_dev->ml_priv;
 761         POS_COOKIE pObj = (POS_COOKIE) pAd->OS_Cookie;
 762         struct task_struct *tsk;
 763
 764         //init_MUTEX(&(pAd->usbdev_semaphore));
 765
 766         init_MUTEX_LOCKED(&(pAd->mlme_semaphore));
 767         init_completion (&pAd->mlmeComplete);
 768
 769         init_MUTEX_LOCKED(&(pAd->RTUSBCmd_semaphore));
 770         init_completion (&pAd->CmdQComplete);
 771
 772         init_MUTEX_LOCKED(&(pAd->RTUSBTimer_semaphore));
 773         init_completion (&pAd->TimerQComplete);
 774
 775         // Creat MLME Thread
 776         pObj->MLMEThr_task = NULL;
 777         tsk = kthread_run(MlmeThread, pAd, pAd->net_dev->name);
 778
 779         if (IS_ERR(tsk)) {
 780                 printk (KERN_WARNING "%s: unable to start Mlme thread\n",pAd->net_dev->name);
 781                 return NDIS_STATUS_FAILURE;
 782         }
 783
 784         pObj->MLMEThr_task = tsk;
 785         // Wait for the thread to start
 786         wait_for_completion(&(pAd->mlmeComplete));
 787
 788         // Creat Command Thread
 789         pObj->RTUSBCmdThr_task = NULL;
 790         tsk = kthread_run(RTUSBCmdThread, pAd, pAd->net_dev->name);
 791
 792         if (IS_ERR(tsk) < 0)
 793         {
 794                 printk (KERN_WARNING "%s: unable to start RTUSBCmd thread\n",pAd->net_dev->name);
 795                 return NDIS_STATUS_FAILURE;
 796         }
 797
 798         pObj->RTUSBCmdThr_task = tsk;
 799         wait_for_completion(&(pAd->CmdQComplete));
 800
 801         pObj->TimerQThr_task = NULL;
 802         tsk = kthread_run(TimerQThread, pAd, pAd->net_dev->name);
 803         if (IS_ERR(tsk) < 0)
 804         {
 805                 printk (KERN_WARNING "%s: unable to start TimerQThread\n",pAd->net_dev->name);
 806                 return NDIS_STATUS_FAILURE;
 807         }
 808         pObj->TimerQThr_task = tsk;
 809         // Wait for the thread to start
 810         wait_for_completion(&(pAd->TimerQComplete));
 811
 812         // Create receive tasklet
 813         tasklet_init(&pObj->rx_done_task, rx_done_tasklet, (ULONG)pAd);
 814         tasklet_init(&pObj->mgmt_dma_done_task, rt2870_mgmt_dma_done_tasklet, (unsigned long)pAd);
 815         tasklet_init(&pObj->ac0_dma_done_task, rt2870_ac0_dma_done_tasklet, (unsigned long)pAd);
 816         tasklet_init(&pObj->ac1_dma_done_task, rt2870_ac1_dma_done_tasklet, (unsigned long)pAd);
 817         tasklet_init(&pObj->ac2_dma_done_task, rt2870_ac2_dma_done_tasklet, (unsigned long)pAd);
 818         tasklet_init(&pObj->ac3_dma_done_task, rt2870_ac3_dma_done_tasklet, (unsigned long)pAd);
 819         tasklet_init(&pObj->hcca_dma_done_task, rt2870_hcca_dma_done_tasklet, (unsigned long)pAd);
 820         tasklet_init(&pObj->tbtt_task, tbtt_tasklet, (unsigned long)pAd);
 821         tasklet_init(&pObj->null_frame_complete_task, rt2870_null_frame_complete_tasklet, (unsigned long)pAd);
 822         tasklet_init(&pObj->rts_frame_complete_task, rt2870_rts_frame_complete_tasklet, (unsigned long)pAd);
 823         tasklet_init(&pObj->pspoll_frame_complete_task, rt2870_pspoll_frame_complete_tasklet, (unsigned long)pAd);
 824
 825         return NDIS_STATUS_SUCCESS;
 826 }
 827
 828
 829 #ifdef CONFIG_STA_SUPPORT
 830 /*
 831 ========================================================================
 832 Routine Description:
 833         As STA's BSSID is a WC too, it uses shared key table.
 834         This function write correct unicast TX key to ASIC WCID.
 835         And we still make a copy in our MacTab.Content[BSSID_WCID].PairwiseKey.
 836         Caller guarantee TKIP/AES always has keyidx = 0. (pairwise key)
 837         Caller guarantee WEP calls this function when set Txkey,  default key index=0~3.
 838
 839 Arguments:
 840         pAd                                     Pointer to our adapter
 841         pKey                                    Pointer to the where the key stored
 842
 843 Return Value:
 844         NDIS_SUCCESS                    Add key successfully
 845
 846 Note:
 847 ========================================================================
 848 */
 849 VOID    RTMPAddBSSIDCipher(
 850         IN      PRTMP_ADAPTER           pAd,
 851         IN      UCHAR                           Aid,
 852         IN      PNDIS_802_11_KEY        pKey,
 853         IN  UCHAR                       CipherAlg)
 854 {
 855         PUCHAR          pTxMic, pRxMic;
 856         BOOLEAN         bKeyRSC, bAuthenticator; // indicate the receive SC set by KeyRSC value
 857 //      UCHAR           CipherAlg;
 858         UCHAR           i;
 859         ULONG           WCIDAttri;
 860         USHORT          offset;
 861         UCHAR           KeyIdx, IVEIV[8];
 862         UINT32          Value;
 863
 864         DBGPRINT(RT_DEBUG_TRACE, ("RTMPAddBSSIDCipher==> Aid = %d\n",Aid));
 865
 866         // Bit 29 of Add-key KeyRSC
 867         bKeyRSC            = (pKey->KeyIndex & 0x20000000) ? TRUE : FALSE;
 868
 869         // Bit 28 of Add-key Authenticator
 870         bAuthenticator = (pKey->KeyIndex & 0x10000000) ? TRUE : FALSE;
 871         KeyIdx = (UCHAR)pKey->KeyIndex&0xff;
 872
 873         if (KeyIdx > 4)
 874                 return;
 875
 876
 877         if (pAd->MacTab.Content[Aid].PairwiseKey.CipherAlg == CIPHER_TKIP)
 878         {       if (pAd->StaCfg.AuthMode == Ndis802_11AuthModeWPANone)
 879                 {
 880                         // for WPA-None Tx, Rx MIC is the same
 881                         pTxMic = (PUCHAR) (&pKey->KeyMaterial) + 16;
 882                         pRxMic = pTxMic;
 883                 }
 884                 else if (bAuthenticator == TRUE)
 885                 {
 886                         pTxMic = (PUCHAR) (&pKey->KeyMaterial) + 16;
 887                         pRxMic = (PUCHAR) (&pKey->KeyMaterial) + 24;
 888                 }
 889                 else
 890                 {
 891                         pRxMic = (PUCHAR) (&pKey->KeyMaterial) + 16;
 892                         pTxMic = (PUCHAR) (&pKey->KeyMaterial) + 24;
 893                 }
 894
 895                 offset = PAIRWISE_KEY_TABLE_BASE + (Aid * HW_KEY_ENTRY_SIZE) + 0x10;
 896                 for (i=0; i<8; )
 897                 {
 898                         Value = *(pTxMic+i);
 899                         Value += (*(pTxMic+i+1)<<8);
 900                         Value += (*(pTxMic+i+2)<<16);
 901                         Value += (*(pTxMic+i+3)<<24);
 902                         RTUSBWriteMACRegister(pAd, offset+i, Value);
 903                         i+=4;
 904                 }
 905
 906                 offset = PAIRWISE_KEY_TABLE_BASE + (Aid * HW_KEY_ENTRY_SIZE) + 0x18;
 907                 for (i=0; i<8; )
 908                 {
 909                         Value = *(pRxMic+i);
 910                         Value += (*(pRxMic+i+1)<<8);
 911                         Value += (*(pRxMic+i+2)<<16);
 912                         Value += (*(pRxMic+i+3)<<24);
 913                         RTUSBWriteMACRegister(pAd, offset+i, Value);
 914                         i+=4;
 915                 }
 916
 917                 // Only Key lenth equal to TKIP key have these
 918                 NdisMoveMemory(pAd->MacTab.Content[Aid].PairwiseKey.RxMic, pRxMic, 8);
 919                 NdisMoveMemory(pAd->MacTab.Content[Aid].PairwiseKey.TxMic, pTxMic, 8);
 920
 921                 DBGPRINT(RT_DEBUG_TRACE,
 922                                 ("      TxMIC  = %02x:%02x:%02x:%02x:%02x:%02x:%02x:%02x \n",
 923                                 pTxMic[0],pTxMic[1],pTxMic[2],pTxMic[3],
 924                                 pTxMic[4],pTxMic[5],pTxMic[6],pTxMic[7]));
 925                 DBGPRINT(RT_DEBUG_TRACE,
 926                                 ("      RxMIC  = %02x:%02x:%02x:%02x:%02x:%02x:%02x:%02x \n",
 927                                 pRxMic[0],pRxMic[1],pRxMic[2],pRxMic[3],
 928                                 pRxMic[4],pRxMic[5],pRxMic[6],pRxMic[7]));
 929         }
 930
 931         // 2. Record Security Key.
 932         pAd->MacTab.Content[BSSID_WCID].PairwiseKey.KeyLen= (UCHAR)pKey->KeyLength;
 933         NdisMoveMemory(pAd->MacTab.Content[Aid].PairwiseKey.Key, &pKey->KeyMaterial, pKey->KeyLength);
 934
 935         // 3. Check RxTsc. And used to init to ASIC IV.
 936         if (bKeyRSC == TRUE)
 937                 NdisMoveMemory(pAd->MacTab.Content[Aid].PairwiseKey.RxTsc, &pKey->KeyRSC, 6);
 938         else
 939                 NdisZeroMemory(pAd->MacTab.Content[Aid].PairwiseKey.RxTsc, 6);
 940
 941         // 4. Init TxTsc to one based on WiFi WPA specs
 942         pAd->MacTab.Content[Aid].PairwiseKey.TxTsc[0] = 1;
 943         pAd->MacTab.Content[Aid].PairwiseKey.TxTsc[1] = 0;
 944         pAd->MacTab.Content[Aid].PairwiseKey.TxTsc[2] = 0;
 945         pAd->MacTab.Content[Aid].PairwiseKey.TxTsc[3] = 0;
 946         pAd->MacTab.Content[Aid].PairwiseKey.TxTsc[4] = 0;
 947         pAd->MacTab.Content[Aid].PairwiseKey.TxTsc[5] = 0;
 948
 949         CipherAlg = pAd->MacTab.Content[Aid].PairwiseKey.CipherAlg;
 950
 951         offset = PAIRWISE_KEY_TABLE_BASE + (Aid * HW_KEY_ENTRY_SIZE);
 952         RTUSBMultiWrite(pAd, (USHORT) offset, pKey->KeyMaterial,
 953                                 ((pKey->KeyLength == LEN_TKIP_KEY) ? 16 : (USHORT)pKey->KeyLength));
 954
 955         offset = SHARED_KEY_TABLE_BASE + (KeyIdx * HW_KEY_ENTRY_SIZE);
 956         RTUSBMultiWrite(pAd, (USHORT) offset, pKey->KeyMaterial, (USHORT)pKey->KeyLength);
 957
 958         offset = PAIRWISE_IVEIV_TABLE_BASE + (Aid * HW_IVEIV_ENTRY_SIZE);
 959         NdisZeroMemory(IVEIV, 8);
 960
 961         // IV/EIV
 962         if ((CipherAlg == CIPHER_TKIP) ||
 963                 (CipherAlg == CIPHER_TKIP_NO_MIC) ||
 964                 (CipherAlg == CIPHER_AES))
 965         {
 966                 IVEIV[3] = 0x20; // Eiv bit on. keyid always 0 for pairwise key
 967         }
 968         // default key idx needs to set.
 969         // in TKIP/AES KeyIdx = 0 , WEP KeyIdx is default tx key.
 970         else
 971         {
 972                 IVEIV[3] |= (KeyIdx<< 6);
 973         }
 974         RTUSBMultiWrite(pAd, (USHORT) offset, IVEIV, 8);
 975
 976         // WCID Attribute UDF:3, BSSIdx:3, Alg:3, Keytable:1=PAIRWISE KEY, BSSIdx is 0
 977         if ((CipherAlg == CIPHER_TKIP) ||
 978                 (CipherAlg == CIPHER_TKIP_NO_MIC) ||
 979                 (CipherAlg == CIPHER_AES))
 980         {
 981                 WCIDAttri = (CipherAlg<<1)|SHAREDKEYTABLE;
 982         }
 983         else
 984                 WCIDAttri = (CipherAlg<<1)|SHAREDKEYTABLE;
 985
 986         offset = MAC_WCID_ATTRIBUTE_BASE + (Aid* HW_WCID_ATTRI_SIZE);
 987         RTUSBWriteMACRegister(pAd, offset, WCIDAttri);
 988         RTUSBReadMACRegister(pAd, offset, &Value);
 989
 990         DBGPRINT(RT_DEBUG_TRACE, ("BSSID_WCID : offset = %x, WCIDAttri = %lx\n",
 991                         offset, WCIDAttri));
 992
 993         // pAddr
 994         // Add Bssid mac address at linkup. not here.  check!
 995         /*offset = MAC_WCID_BASE + (BSSID_WCID * HW_WCID_ENTRY_SIZE);
 996         *for (i=0; i<MAC_ADDR_LEN; i++)
 997         {
 998                 RTMP_IO_WRITE8(pAd, offset+i, pKey->BSSID[i]);
 999         }
1000         */
1001
1002         DBGPRINT(RT_DEBUG_ERROR, ("AddBSSIDasWCIDEntry: Alg=%s, KeyLength = %d\n",
1003                         CipherName[CipherAlg], pKey->KeyLength));
1004         DBGPRINT(RT_DEBUG_TRACE, ("Key [idx=%x] [KeyLen = %d]\n",
1005                         pKey->KeyIndex, pKey->KeyLength));
1006         for(i=0; i<pKey->KeyLength; i++)
1007                 DBGPRINT_RAW(RT_DEBUG_TRACE,(" %x:", pKey->KeyMaterial[i]));
1008         DBGPRINT(RT_DEBUG_TRACE,("       \n"));
1009 }
1010 #endif // CONFIG_STA_SUPPORT //
1011
1012 /*
1013 ========================================================================
1014 Routine Description:
1015     Get a received packet.
1016
1017 Arguments:
1018         pAd                                     device control block
1019         pSaveRxD                        receive descriptor information
1020         *pbReschedule           need reschedule flag
1021         *pRxPending                     pending received packet flag
1022
1023 Return Value:
1024     the recieved packet
1025
1026 Note:
1027 ========================================================================
1028 */
1029 #define RT2870_RXDMALEN_FIELD_SIZE                      4
1030 PNDIS_PACKET GetPacketFromRxRing(
1031         IN              PRTMP_ADAPTER           pAd,
1032         OUT             PRT28XX_RXD_STRUC       pSaveRxD,
1033         OUT             BOOLEAN                         *pbReschedule,
1034         IN OUT  UINT32                          *pRxPending)
1035 {
1036         PRX_CONTEXT             pRxContext;
1037         PNDIS_PACKET    pSkb;
1038         PUCHAR                  pData;
1039         ULONG                   ThisFrameLen;
1040         ULONG                   RxBufferLength;
1041         PRXWI_STRUC             pRxWI;
1042
1043         pRxContext = &pAd->RxContext[pAd->NextRxBulkInReadIndex];
1044         if ((pRxContext->Readable == FALSE) || (pRxContext->InUse == TRUE))
1045                 return NULL;
1046
1047         RxBufferLength = pRxContext->BulkInOffset - pAd->ReadPosition;
1048         if (RxBufferLength < (RT2870_RXDMALEN_FIELD_SIZE + sizeof(RXWI_STRUC) + sizeof(RXINFO_STRUC)))
1049         {
1050                 goto label_null;
1051         }
1052
1053         pData = &pRxContext->TransferBuffer[pAd->ReadPosition]; /* 4KB */
1054         // The RXDMA field is 4 bytes, now just use the first 2 bytes. The Length including the (RXWI + MSDU + Padding)
1055         ThisFrameLen = *pData + (*(pData+1)<<8);
1056     if (ThisFrameLen == 0)
1057         {
1058                 DBGPRINT(RT_DEBUG_TRACE, ("BIRIdx(%d): RXDMALen is zero.[%ld], BulkInBufLen = %ld)\n",
1059                                                                 pAd->NextRxBulkInReadIndex, ThisFrameLen, pRxContext->BulkInOffset));
1060                 goto label_null;
1061         }
1062         if ((ThisFrameLen&0x3) != 0)
1063         {
1064                 DBGPRINT(RT_DEBUG_ERROR, ("BIRIdx(%d): RXDMALen not multiple of 4.[%ld], BulkInBufLen = %ld)\n",
1065                                                                 pAd->NextRxBulkInReadIndex, ThisFrameLen, pRxContext->BulkInOffset));
1066                 goto label_null;
1067         }
1068
1069         if ((ThisFrameLen + 8)> RxBufferLength) // 8 for (RT2870_RXDMALEN_FIELD_SIZE + sizeof(RXINFO_STRUC))
1070         {
1071                 DBGPRINT(RT_DEBUG_TRACE,("BIRIdx(%d):FrameLen(0x%lx) outranges. BulkInLen=0x%lx, remaining RxBufLen=0x%lx, ReadPos=0x%lx\n",
1072                                                 pAd->NextRxBulkInReadIndex, ThisFrameLen, pRxContext->BulkInOffset, RxBufferLength, pAd->ReadPosition));
1073
1074                 // error frame. finish this loop
1075                 goto label_null;
1076         }
1077
1078         // skip USB frame length field
1079         pData += RT2870_RXDMALEN_FIELD_SIZE;
1080         pRxWI = (PRXWI_STRUC)pData;
1081 #ifdef RT_BIG_ENDIAN
1082         RTMPWIEndianChange(pData, TYPE_RXWI);
1083 #endif // RT_BIG_ENDIAN //
1084         if (pRxWI->MPDUtotalByteCount > ThisFrameLen)
1085         {
1086                 DBGPRINT(RT_DEBUG_ERROR, ("%s():pRxWIMPDUtotalByteCount(%d) large than RxDMALen(%ld)\n",
1087                                                                         __func__, pRxWI->MPDUtotalByteCount, ThisFrameLen));
1088                 goto label_null;
1089         }
1090 #ifdef RT_BIG_ENDIAN
1091         RTMPWIEndianChange(pData, TYPE_RXWI);
1092 #endif // RT_BIG_ENDIAN //
1093
1094         // allocate a rx packet
1095         pSkb = dev_alloc_skb(ThisFrameLen);
1096         if (pSkb == NULL)
1097         {
1098                 DBGPRINT(RT_DEBUG_ERROR,("%s():Cannot Allocate sk buffer for this Bulk-In buffer!\n", __func__));
1099                 goto label_null;
1100         }
1101
1102         // copy the rx packet
1103         memcpy(skb_put(pSkb, ThisFrameLen), pData, ThisFrameLen);
1104         RTPKT_TO_OSPKT(pSkb)->dev = get_netdev_from_bssid(pAd, BSS0);
1105         RTMP_SET_PACKET_SOURCE(OSPKT_TO_RTPKT(pSkb), PKTSRC_NDIS);
1106
1107         // copy RxD
1108         *pSaveRxD = *(PRXINFO_STRUC)(pData + ThisFrameLen);
1109 #ifdef RT_BIG_ENDIAN
1110         RTMPDescriptorEndianChange((PUCHAR)pSaveRxD, TYPE_RXINFO);
1111 #endif // RT_BIG_ENDIAN //
1112
1113         // update next packet read position.
1114         pAd->ReadPosition += (ThisFrameLen + RT2870_RXDMALEN_FIELD_SIZE + RXINFO_SIZE); // 8 for (RT2870_RXDMALEN_FIELD_SIZE + sizeof(RXINFO_STRUC))
1115
1116         return pSkb;
1117
1118 label_null:
1119
1120         return NULL;
1121 }
1122
1123
1124 /*
1125 ========================================================================
1126 Routine Description:
1127     Handle received packets.
1128
1129 Arguments:
1130         data                            - URB information pointer
1131
1132 Return Value:
1133     None
1134
1135 Note:
1136 ========================================================================
1137 */
1138 static void rx_done_tasklet(unsigned long data)
1139 {
1140         purbb_t                         pUrb;
1141         PRX_CONTEXT                     pRxContext;
1142         PRTMP_ADAPTER           pAd;
1143         NTSTATUS                        Status;
1144         unsigned int            IrqFlags;
1145
1146         pUrb            = (purbb_t)data;
1147         pRxContext      = (PRX_CONTEXT)pUrb->context;
1148         pAd             = pRxContext->pAd;
1149         Status = pUrb->status;
1150
1151
1152         RTMP_IRQ_LOCK(&pAd->BulkInLock, IrqFlags);
1153         pRxContext->InUse = FALSE;
1154         pRxContext->IRPPending = FALSE;
1155         pRxContext->BulkInOffset += pUrb->actual_length;
1156         //NdisInterlockedDecrement(&pAd->PendingRx);
1157         pAd->PendingRx--;
1158
1159         if (Status == USB_ST_NOERROR)
1160         {
1161                 pAd->BulkInComplete++;
1162                 pAd->NextRxBulkInPosition = 0;
1163                 if (pRxContext->BulkInOffset)   // As jan's comment, it may bulk-in success but size is zero.
1164                 {
1165                         pRxContext->Readable = TRUE;
1166                         INC_RING_INDEX(pAd->NextRxBulkInIndex, RX_RING_SIZE);
1167                 }
1168                 RTMP_IRQ_UNLOCK(&pAd->BulkInLock, IrqFlags);
1169         }
1170         else     // STATUS_OTHER
1171         {
1172                 pAd->BulkInCompleteFail++;
1173                 // Still read this packet although it may comtain wrong bytes.
1174                 pRxContext->Readable = FALSE;
1175                 RTMP_IRQ_UNLOCK(&pAd->BulkInLock, IrqFlags);
1176
1177                 // Parsing all packets. because after reset, the index will reset to all zero.
1178                 if ((!RTMP_TEST_FLAG(pAd, (fRTMP_ADAPTER_RESET_IN_PROGRESS |
1179                                                                         fRTMP_ADAPTER_BULKIN_RESET |
1180                                                                         fRTMP_ADAPTER_HALT_IN_PROGRESS |
1181                                                                         fRTMP_ADAPTER_NIC_NOT_EXIST))))
1182                 {
1183
1184                         DBGPRINT_RAW(RT_DEBUG_ERROR, ("Bulk In Failed. Status=%d, BIIdx=0x%x, BIRIdx=0x%x, actual_length= 0x%x\n",
1185                                                         Status, pAd->NextRxBulkInIndex, pAd->NextRxBulkInReadIndex, pRxContext->pUrb->actual_length));
1186
1187                         RTMP_SET_FLAG(pAd, fRTMP_ADAPTER_BULKIN_RESET);
1188                         RTUSBEnqueueInternalCmd(pAd, CMDTHREAD_RESET_BULK_IN, NULL, 0);
1189                 }
1190         }
1191
1192         ASSERT((pRxContext->InUse == pRxContext->IRPPending));
1193
1194         RTUSBBulkReceive(pAd);
1195
1196         return;
1197
1198 }
1199
1200
1201 static void rt2870_mgmt_dma_done_tasklet(unsigned long data)
1202 {
1203         PRTMP_ADAPTER   pAd;
1204         PTX_CONTEXT             pMLMEContext;
1205         int                             index;
1206         PNDIS_PACKET    pPacket;
1207         purbb_t                 pUrb;
1208         NTSTATUS                Status;
1209         unsigned long   IrqFlags;
1210
1211
1212         pUrb                    = (purbb_t)data;
1213         pMLMEContext    = (PTX_CONTEXT)pUrb->context;
1214         pAd                     = pMLMEContext->pAd;
1215         Status                  = pUrb->status;
1216         index                   = pMLMEContext->SelfIdx;
1217
1218         ASSERT((pAd->MgmtRing.TxDmaIdx == index));
1219
1220         RTMP_IRQ_LOCK(&pAd->BulkOutLock[MGMTPIPEIDX], IrqFlags);
1221
1222
1223         if (Status != USB_ST_NOERROR)
1224         {
1225                 //Bulk-Out fail status handle
1226                 if ((!RTMP_TEST_FLAG(pAd, fRTMP_ADAPTER_RESET_IN_PROGRESS)) &&
1227                         (!RTMP_TEST_FLAG(pAd, fRTMP_ADAPTER_HALT_IN_PROGRESS)) &&
1228                         (!RTMP_TEST_FLAG(pAd, fRTMP_ADAPTER_NIC_NOT_EXIST)) &&
1229                         (!RTMP_TEST_FLAG(pAd, fRTMP_ADAPTER_BULKOUT_RESET)))
1230                 {
1231                         DBGPRINT_RAW(RT_DEBUG_ERROR, ("Bulk Out MLME Failed, Status=%d!\n", Status));
1232                         // TODO: How to handle about the MLMEBulkOut failed issue. Need to resend the mgmt pkt?
1233                         RTMP_SET_FLAG(pAd, fRTMP_ADAPTER_BULKOUT_RESET);
1234                         pAd->bulkResetPipeid = (MGMTPIPEIDX | BULKOUT_MGMT_RESET_FLAG);
1235                 }
1236         }
1237
1238         pAd->BulkOutPending[MGMTPIPEIDX] = FALSE;
1239         RTMP_IRQ_UNLOCK(&pAd->BulkOutLock[MGMTPIPEIDX], IrqFlags);
1240
1241         RTMP_IRQ_LOCK(&pAd->MLMEBulkOutLock, IrqFlags);
1242         // Reset MLME context flags
1243         pMLMEContext->IRPPending = FALSE;
1244         pMLMEContext->InUse = FALSE;
1245         pMLMEContext->bWaitingBulkOut = FALSE;
1246         pMLMEContext->BulkOutSize = 0;
1247
1248         pPacket = pAd->MgmtRing.Cell[index].pNdisPacket;
1249         pAd->MgmtRing.Cell[index].pNdisPacket = NULL;
1250
1251         // Increase MgmtRing Index
1252         INC_RING_INDEX(pAd->MgmtRing.TxDmaIdx, MGMT_RING_SIZE);
1253         pAd->MgmtRing.TxSwFreeIdx++;
1254         RTMP_IRQ_UNLOCK(&pAd->MLMEBulkOutLock, IrqFlags);
1255
1256         // No-matter success or fail, we free the mgmt packet.
1257         if (pPacket)
1258                 RTMPFreeNdisPacket(pAd, pPacket);
1259
1260         if ((RTMP_TEST_FLAG(pAd, (fRTMP_ADAPTER_RESET_IN_PROGRESS |
1261                                                                 fRTMP_ADAPTER_HALT_IN_PROGRESS |
1262                                                                 fRTMP_ADAPTER_NIC_NOT_EXIST))))
1263         {
1264                 // do nothing and return directly.
1265         }
1266         else
1267         {
1268                 if (RTMP_TEST_FLAG(pAd, fRTMP_ADAPTER_BULKOUT_RESET) &&
1269                         ((pAd->bulkResetPipeid & BULKOUT_MGMT_RESET_FLAG) == BULKOUT_MGMT_RESET_FLAG))
1270                 {       // For Mgmt Bulk-Out failed, ignore it now.
1271                         RTUSBEnqueueInternalCmd(pAd, CMDTHREAD_RESET_BULK_OUT, NULL, 0);
1272                 }
1273                 else
1274                 {
1275
1276                         // Always call Bulk routine, even reset bulk.
1277                         // The protectioon of rest bulk should be in BulkOut routine
1278                         if (pAd->MgmtRing.TxSwFreeIdx < MGMT_RING_SIZE /* pMLMEContext->bWaitingBulkOut == TRUE */)
1279                         {
1280                                 RTUSB_SET_BULK_FLAG(pAd, fRTUSB_BULK_OUT_MLME);
1281                         }
1282                                 RTUSBKickBulkOut(pAd);
1283                         }
1284                 }
1285
1286 }
1287
1288
1289 static void rt2870_hcca_dma_done_tasklet(unsigned long data)
1290 {
1291         PRTMP_ADAPTER           pAd;
1292         PHT_TX_CONTEXT          pHTTXContext;
1293         UCHAR                           BulkOutPipeId = 4;
1294         purbb_t                         pUrb;
1295
1296
1297         DBGPRINT_RAW(RT_DEBUG_ERROR, ("--->hcca_dma_done_tasklet\n"));
1298
1299
1300         pUrb                    = (purbb_t)data;
1301         pHTTXContext    = (PHT_TX_CONTEXT)pUrb->context;
1302         pAd                             = pHTTXContext->pAd;
1303
1304         rt2870_dataout_complete_tasklet((unsigned long)pUrb);
1305
1306         if ((RTMP_TEST_FLAG(pAd, (fRTMP_ADAPTER_RESET_IN_PROGRESS |
1307                                                                 fRTMP_ADAPTER_HALT_IN_PROGRESS |
1308                                                                 fRTMP_ADAPTER_NIC_NOT_EXIST))))
1309         {
1310                 // do nothing and return directly.
1311         }
1312         else
1313         {
1314                 if (RTMP_TEST_FLAG(pAd, fRTMP_ADAPTER_BULKOUT_RESET))
1315                 {
1316                         RTUSBEnqueueInternalCmd(pAd, CMDTHREAD_RESET_BULK_OUT, NULL, 0);
1317                 }
1318                 else
1319                 {       pHTTXContext = &pAd->TxContext[BulkOutPipeId];
1320                         if ((pAd->TxSwQueue[BulkOutPipeId].Number > 0) &&
1321                                 /*((pHTTXContext->CurWritePosition > (pHTTXContext->NextBulkOutPosition + 0x6000)) || (pHTTXContext->NextBulkOutPosition > pHTTXContext->CurWritePosition + 0x6000)) && */
1322                                 (pAd->DeQueueRunning[BulkOutPipeId] == FALSE) &&
1323                                 (pHTTXContext->bCurWriting == FALSE))
1324                         {
1325                                 RTMPDeQueuePacket(pAd, FALSE, BulkOutPipeId, MAX_TX_PROCESS);
1326                         }
1327
1328                         RTUSB_SET_BULK_FLAG(pAd, fRTUSB_BULK_OUT_DATA_NORMAL);
1329                         RTUSBKickBulkOut(pAd);
1330                 }
1331         }
1332
1333         DBGPRINT_RAW(RT_DEBUG_ERROR, ("<---hcca_dma_done_tasklet\n"));
1334
1335                 return;
1336 }
1337
1338
1339 static void rt2870_ac3_dma_done_tasklet(unsigned long data)
1340 {
1341         PRTMP_ADAPTER           pAd;
1342         PHT_TX_CONTEXT          pHTTXContext;
1343         UCHAR                           BulkOutPipeId = 3;
1344         purbb_t                         pUrb;
1345
1346
1347         pUrb                    = (purbb_t)data;
1348         pHTTXContext    = (PHT_TX_CONTEXT)pUrb->context;
1349         pAd                             = pHTTXContext->pAd;
1350
1351         rt2870_dataout_complete_tasklet((unsigned long)pUrb);
1352
1353         if ((RTMP_TEST_FLAG(pAd, (fRTMP_ADAPTER_RESET_IN_PROGRESS |
1354                                                                 fRTMP_ADAPTER_HALT_IN_PROGRESS |
1355                                                                 fRTMP_ADAPTER_NIC_NOT_EXIST))))
1356         {
1357                 // do nothing and return directly.
1358         }
1359         else
1360         {
1361                 if (RTMP_TEST_FLAG(pAd, fRTMP_ADAPTER_BULKOUT_RESET))
1362                 {
1363                         RTUSBEnqueueInternalCmd(pAd, CMDTHREAD_RESET_BULK_OUT, NULL, 0);
1364                 }
1365                 else
1366                 {       pHTTXContext = &pAd->TxContext[BulkOutPipeId];
1367                         if ((pAd->TxSwQueue[BulkOutPipeId].Number > 0) &&
1368                                 /*((pHTTXContext->CurWritePosition > (pHTTXContext->NextBulkOutPosition + 0x6000)) || (pHTTXContext->NextBulkOutPosition > pHTTXContext->CurWritePosition + 0x6000)) && */
1369                                 (pAd->DeQueueRunning[BulkOutPipeId] == FALSE) &&
1370                                 (pHTTXContext->bCurWriting == FALSE))
1371                         {
1372                                 RTMPDeQueuePacket(pAd, FALSE, BulkOutPipeId, MAX_TX_PROCESS);
1373                         }
1374
1375                         RTUSB_SET_BULK_FLAG(pAd, fRTUSB_BULK_OUT_DATA_NORMAL<<3);
1376                         RTUSBKickBulkOut(pAd);
1377                 }
1378         }
1379
1380
1381                 return;
1382 }
1383
1384
1385 static void rt2870_ac2_dma_done_tasklet(unsigned long data)
1386 {
1387         PRTMP_ADAPTER           pAd;
1388         PHT_TX_CONTEXT          pHTTXContext;
1389         UCHAR                           BulkOutPipeId = 2;
1390         purbb_t                         pUrb;
1391
1392
1393         pUrb                    = (purbb_t)data;
1394         pHTTXContext    = (PHT_TX_CONTEXT)pUrb->context;
1395         pAd                             = pHTTXContext->pAd;
1396
1397         rt2870_dataout_complete_tasklet((unsigned long)pUrb);
1398
1399         if ((RTMP_TEST_FLAG(pAd, (fRTMP_ADAPTER_RESET_IN_PROGRESS |
1400                                                                 fRTMP_ADAPTER_HALT_IN_PROGRESS |
1401                                                                 fRTMP_ADAPTER_NIC_NOT_EXIST))))
1402         {
1403                 // do nothing and return directly.
1404         }
1405         else
1406         {
1407                 if (RTMP_TEST_FLAG(pAd, fRTMP_ADAPTER_BULKOUT_RESET))
1408                 {
1409                         RTUSBEnqueueInternalCmd(pAd, CMDTHREAD_RESET_BULK_OUT, NULL, 0);
1410                 }
1411                 else
1412                 {       pHTTXContext = &pAd->TxContext[BulkOutPipeId];
1413                         if ((pAd->TxSwQueue[BulkOutPipeId].Number > 0) &&
1414                                 /*((pHTTXContext->CurWritePosition > (pHTTXContext->NextBulkOutPosition + 0x6000)) || (pHTTXContext->NextBulkOutPosition > pHTTXContext->CurWritePosition + 0x6000)) && */
1415                                 (pAd->DeQueueRunning[BulkOutPipeId] == FALSE) &&
1416                                 (pHTTXContext->bCurWriting == FALSE))
1417                         {
1418                                 RTMPDeQueuePacket(pAd, FALSE, BulkOutPipeId, MAX_TX_PROCESS);
1419                         }
1420
1421                         RTUSB_SET_BULK_FLAG(pAd, fRTUSB_BULK_OUT_DATA_NORMAL<<2);
1422                         RTUSBKickBulkOut(pAd);
1423                 }
1424         }
1425
1426                 return;
1427 }
1428
1429
1430 static void rt2870_ac1_dma_done_tasklet(unsigned long data)
1431 {
1432         PRTMP_ADAPTER           pAd;
1433         PHT_TX_CONTEXT          pHTTXContext;
1434         UCHAR                           BulkOutPipeId = 1;
1435         purbb_t                         pUrb;
1436
1437
1438         pUrb                    = (purbb_t)data;
1439         pHTTXContext    = (PHT_TX_CONTEXT)pUrb->context;
1440         pAd                             = pHTTXContext->pAd;
1441
1442         rt2870_dataout_complete_tasklet((unsigned long)pUrb);
1443
1444         if ((RTMP_TEST_FLAG(pAd, (fRTMP_ADAPTER_RESET_IN_PROGRESS |
1445                                                                 fRTMP_ADAPTER_HALT_IN_PROGRESS |
1446                                                                 fRTMP_ADAPTER_NIC_NOT_EXIST))))
1447         {
1448                 // do nothing and return directly.
1449         }
1450         else
1451         {
1452                 if (RTMP_TEST_FLAG(pAd, fRTMP_ADAPTER_BULKOUT_RESET))
1453                 {
1454                         RTUSBEnqueueInternalCmd(pAd, CMDTHREAD_RESET_BULK_OUT, NULL, 0);
1455                 }
1456                 else
1457                 {       pHTTXContext = &pAd->TxContext[BulkOutPipeId];
1458                         if ((pAd->TxSwQueue[BulkOutPipeId].Number > 0) &&
1459                                 /*((pHTTXContext->CurWritePosition > (pHTTXContext->NextBulkOutPosition + 0x6000)) || (pHTTXContext->NextBulkOutPosition > pHTTXContext->CurWritePosition + 0x6000)) && */
1460                                 (pAd->DeQueueRunning[BulkOutPipeId] == FALSE) &&
1461                                 (pHTTXContext->bCurWriting == FALSE))
1462                         {
1463                                 RTMPDeQueuePacket(pAd, FALSE, BulkOutPipeId, MAX_TX_PROCESS);
1464                         }
1465
1466                         RTUSB_SET_BULK_FLAG(pAd, fRTUSB_BULK_OUT_DATA_NORMAL<<1);
1467                         RTUSBKickBulkOut(pAd);
1468                 }
1469         }
1470
1471
1472         return;
1473 }
1474
1475
1476 static void rt2870_ac0_dma_done_tasklet(unsigned long data)
1477 {
1478         PRTMP_ADAPTER           pAd;
1479         PHT_TX_CONTEXT          pHTTXContext;
1480         UCHAR                           BulkOutPipeId = 0;
1481         purbb_t                         pUrb;
1482
1483
1484         pUrb                    = (purbb_t)data;
1485         pHTTXContext    = (PHT_TX_CONTEXT)pUrb->context;
1486         pAd                             = pHTTXContext->pAd;
1487
1488         rt2870_dataout_complete_tasklet((unsigned long)pUrb);
1489
1490         if ((RTMP_TEST_FLAG(pAd, (fRTMP_ADAPTER_RESET_IN_PROGRESS |
1491                                                                 fRTMP_ADAPTER_HALT_IN_PROGRESS |
1492                                                                 fRTMP_ADAPTER_NIC_NOT_EXIST))))
1493         {
1494                 // do nothing and return directly.
1495         }
1496         else
1497         {
1498                 if (RTMP_TEST_FLAG(pAd, fRTMP_ADAPTER_BULKOUT_RESET))
1499                 {
1500                         RTUSBEnqueueInternalCmd(pAd, CMDTHREAD_RESET_BULK_OUT, NULL, 0);
1501                 }
1502                 else
1503                 {       pHTTXContext = &pAd->TxContext[BulkOutPipeId];
1504                         if ((pAd->TxSwQueue[BulkOutPipeId].Number > 0) &&
1505                                 /*  ((pHTTXContext->CurWritePosition > (pHTTXContext->NextBulkOutPosition + 0x6000)) || (pHTTXContext->NextBulkOutPosition > pHTTXContext->CurWritePosition + 0x6000)) && */
1506                                 (pAd->DeQueueRunning[BulkOutPipeId] == FALSE) &&
1507                                 (pHTTXContext->bCurWriting == FALSE))
1508                         {
1509                                 RTMPDeQueuePacket(pAd, FALSE, BulkOutPipeId, MAX_TX_PROCESS);
1510                         }
1511
1512                         RTUSB_SET_BULK_FLAG(pAd, fRTUSB_BULK_OUT_DATA_NORMAL);
1513                         RTUSBKickBulkOut(pAd);
1514                 }
1515         }
1516
1517
1518         return;
1519
1520 }
1521
1522
1523 static void rt2870_null_frame_complete_tasklet(unsigned long data)
1524 {
1525         PRTMP_ADAPTER   pAd;
1526         PTX_CONTEXT             pNullContext;
1527         purbb_t                 pUrb;
1528         NTSTATUS                Status;
1529         unsigned long   irqFlag;
1530
1531
1532         pUrb                    = (purbb_t)data;
1533         pNullContext    = (PTX_CONTEXT)pUrb->context;
1534         pAd                     = pNullContext->pAd;
1535         Status                  = pUrb->status;
1536
1537         // Reset Null frame context flags
1538         RTMP_IRQ_LOCK(&pAd->BulkOutLock[0], irqFlag);
1539         pNullContext->IRPPending        = FALSE;
1540         pNullContext->InUse             = FALSE;
1541         pAd->BulkOutPending[0] = FALSE;
1542         pAd->watchDogTxPendingCnt[0] = 0;
1543
1544         if (Status == USB_ST_NOERROR)
1545         {
1546                 RTMP_IRQ_UNLOCK(&pAd->BulkOutLock[0], irqFlag);
1547
1548                 RTMPDeQueuePacket(pAd, FALSE, NUM_OF_TX_RING, MAX_TX_PROCESS);
1549         }
1550         else    // STATUS_OTHER
1551         {
1552                 if ((!RTMP_TEST_FLAG(pAd, fRTMP_ADAPTER_RESET_IN_PROGRESS)) &&
1553                         (!RTMP_TEST_FLAG(pAd, fRTMP_ADAPTER_HALT_IN_PROGRESS)) &&
1554                         (!RTMP_TEST_FLAG(pAd, fRTMP_ADAPTER_NIC_NOT_EXIST)) &&
1555                         (!RTMP_TEST_FLAG(pAd, fRTMP_ADAPTER_BULKOUT_RESET)))
1556                 {
1557                         DBGPRINT_RAW(RT_DEBUG_ERROR, ("Bulk Out Null Frame Failed, ReasonCode=%d!\n", Status));
1558                         RTMP_SET_FLAG(pAd, fRTMP_ADAPTER_BULKOUT_RESET);
1559                         pAd->bulkResetPipeid = (MGMTPIPEIDX | BULKOUT_MGMT_RESET_FLAG);
1560                         RTMP_IRQ_UNLOCK(&pAd->BulkOutLock[0], irqFlag);
1561                         RTUSBEnqueueInternalCmd(pAd, CMDTHREAD_RESET_BULK_OUT, NULL, 0);
1562                 }
1563                 else
1564                 {
1565                         RTMP_IRQ_UNLOCK(&pAd->BulkOutLock[0], irqFlag);
1566                 }
1567         }
1568
1569         // Always call Bulk routine, even reset bulk.
1570         // The protectioon of rest bulk should be in BulkOut routine
1571         RTUSBKickBulkOut(pAd);
1572
1573 }
1574
1575
1576 static void rt2870_rts_frame_complete_tasklet(unsigned long data)
1577 {
1578         PRTMP_ADAPTER   pAd;
1579         PTX_CONTEXT             pRTSContext;
1580         purbb_t                 pUrb;
1581         NTSTATUS                Status;
1582         unsigned long   irqFlag;
1583
1584
1585         pUrb            = (purbb_t)data;
1586         pRTSContext     = (PTX_CONTEXT)pUrb->context;
1587         pAd                     = pRTSContext->pAd;
1588         Status          = pUrb->status;
1589
1590         // Reset RTS frame context flags
1591         RTMP_IRQ_LOCK(&pAd->BulkOutLock[0], irqFlag);
1592         pRTSContext->IRPPending = FALSE;
1593         pRTSContext->InUse              = FALSE;
1594
1595         if (Status == USB_ST_NOERROR)
1596         {
1597                 RTMP_IRQ_UNLOCK(&pAd->BulkOutLock[0], irqFlag);
1598                 RTMPDeQueuePacket(pAd, FALSE, NUM_OF_TX_RING, MAX_TX_PROCESS);
1599         }
1600         else    // STATUS_OTHER
1601         {
1602                 if ((!RTMP_TEST_FLAG(pAd, fRTMP_ADAPTER_RESET_IN_PROGRESS)) &&
1603                         (!RTMP_TEST_FLAG(pAd, fRTMP_ADAPTER_HALT_IN_PROGRESS)) &&
1604                         (!RTMP_TEST_FLAG(pAd, fRTMP_ADAPTER_NIC_NOT_EXIST)) &&
1605                         (!RTMP_TEST_FLAG(pAd, fRTMP_ADAPTER_BULKOUT_RESET)))
1606                 {
1607                         DBGPRINT_RAW(RT_DEBUG_ERROR, ("Bulk Out RTS Frame Failed\n"));
1608                         RTMP_SET_FLAG(pAd, fRTMP_ADAPTER_BULKOUT_RESET);
1609                         pAd->bulkResetPipeid = (MGMTPIPEIDX | BULKOUT_MGMT_RESET_FLAG);
1610                         RTMP_IRQ_UNLOCK(&pAd->BulkOutLock[0], irqFlag);
1611                         RTUSBEnqueueInternalCmd(pAd, CMDTHREAD_RESET_BULK_OUT, NULL, 0);
1612                 }
1613                 else
1614                 {
1615                         RTMP_IRQ_UNLOCK(&pAd->BulkOutLock[0], irqFlag);
1616                 }
1617         }
1618
1619         RTMP_SEM_LOCK(&pAd->BulkOutLock[pRTSContext->BulkOutPipeId]);
1620         pAd->BulkOutPending[pRTSContext->BulkOutPipeId] = FALSE;
1621         RTMP_SEM_UNLOCK(&pAd->BulkOutLock[pRTSContext->BulkOutPipeId]);
1622
1623         // Always call Bulk routine, even reset bulk.
1624         // The protectioon of rest bulk should be in BulkOut routine
1625         RTUSBKickBulkOut(pAd);
1626
1627 }
1628
1629
1630 static void rt2870_pspoll_frame_complete_tasklet(unsigned long data)
1631 {
1632         PRTMP_ADAPTER   pAd;
1633         PTX_CONTEXT             pPsPollContext;
1634         purbb_t                 pUrb;
1635         NTSTATUS                Status;
1636
1637
1638         pUrb                    = (purbb_t)data;
1639         pPsPollContext  = (PTX_CONTEXT)pUrb->context;
1640         pAd                             = pPsPollContext->pAd;
1641         Status                  = pUrb->status;
1642
1643         // Reset PsPoll context flags
1644         pPsPollContext->IRPPending      = FALSE;
1645         pPsPollContext->InUse           = FALSE;
1646         pAd->watchDogTxPendingCnt[0] = 0;
1647
1648         if (Status == USB_ST_NOERROR)
1649         {
1650                 RTMPDeQueuePacket(pAd, FALSE, NUM_OF_TX_RING, MAX_TX_PROCESS);
1651         }
1652         else // STATUS_OTHER
1653         {
1654                 if ((!RTMP_TEST_FLAG(pAd, fRTMP_ADAPTER_RESET_IN_PROGRESS)) &&
1655                         (!RTMP_TEST_FLAG(pAd, fRTMP_ADAPTER_HALT_IN_PROGRESS)) &&
1656                         (!RTMP_TEST_FLAG(pAd, fRTMP_ADAPTER_NIC_NOT_EXIST)) &&
1657                         (!RTMP_TEST_FLAG(pAd, fRTMP_ADAPTER_BULKOUT_RESET)))
1658                 {
1659                         DBGPRINT_RAW(RT_DEBUG_ERROR, ("Bulk Out PSPoll Failed\n"));
1660                         RTMP_SET_FLAG(pAd, fRTMP_ADAPTER_BULKOUT_RESET);
1661                         pAd->bulkResetPipeid = (MGMTPIPEIDX | BULKOUT_MGMT_RESET_FLAG);
1662                         RTUSBEnqueueInternalCmd(pAd, CMDTHREAD_RESET_BULK_OUT, NULL, 0);
1663                 }
1664         }
1665
1666         RTMP_SEM_LOCK(&pAd->BulkOutLock[0]);
1667         pAd->BulkOutPending[0] = FALSE;
1668         RTMP_SEM_UNLOCK(&pAd->BulkOutLock[0]);
1669
1670         // Always call Bulk routine, even reset bulk.
1671         // The protectioon of rest bulk should be in BulkOut routine
1672         RTUSBKickBulkOut(pAd);
1673
1674 }
1675
1676
1677 static void rt2870_dataout_complete_tasklet(unsigned long data)
1678 {
1679         PRTMP_ADAPTER           pAd;
1680         purbb_t                         pUrb;
1681         POS_COOKIE                      pObj;
1682         PHT_TX_CONTEXT          pHTTXContext;
1683         UCHAR                           BulkOutPipeId;
1684         NTSTATUS                        Status;
1685         unsigned long           IrqFlags;
1686
1687
1688         pUrb                    = (purbb_t)data;
1689         pHTTXContext    = (PHT_TX_CONTEXT)pUrb->context;
1690         pAd                             = pHTTXContext->pAd;
1691         pObj                    = (POS_COOKIE) pAd->OS_Cookie;
1692         Status                  = pUrb->status;
1693
1694         // Store BulkOut PipeId
1695         BulkOutPipeId = pHTTXContext->BulkOutPipeId;
1696         pAd->BulkOutDataOneSecCount++;
1697
1698         //DBGPRINT(RT_DEBUG_LOUD, ("Done-B(%d):I=0x%lx, CWPos=%ld, NBPos=%ld, ENBPos=%ld, bCopy=%d!\n", BulkOutPipeId, in_interrupt(), pHTTXContext->CurWritePosition,
1699         //              pHTTXContext->NextBulkOutPosition, pHTTXContext->ENextBulkOutPosition, pHTTXContext->bCopySavePad));
1700
1701         RTMP_IRQ_LOCK(&pAd->BulkOutLock[BulkOutPipeId], IrqFlags);
1702         pAd->BulkOutPending[BulkOutPipeId] = FALSE;
1703         pHTTXContext->IRPPending = FALSE;
1704         pAd->watchDogTxPendingCnt[BulkOutPipeId] = 0;
1705
1706         if (Status == USB_ST_NOERROR)
1707         {
1708                 pAd->BulkOutComplete++;
1709
1710                 RTMP_IRQ_UNLOCK(&pAd->BulkOutLock[BulkOutPipeId], IrqFlags);
1711
1712                 pAd->Counters8023.GoodTransmits++;
1713                 //RTMP_IRQ_LOCK(&pAd->TxContextQueueLock[BulkOutPipeId], IrqFlags);
1714                 FREE_HTTX_RING(pAd, BulkOutPipeId, pHTTXContext);
1715                 //RTMP_IRQ_UNLOCK(&pAd->TxContextQueueLock[BulkOutPipeId], IrqFlags);
1716
1717
1718         }
1719         else    // STATUS_OTHER
1720         {
1721                 PUCHAR  pBuf;
1722
1723                 pAd->BulkOutCompleteOther++;
1724
1725                 pBuf = &pHTTXContext->TransferBuffer->field.WirelessPacket[pHTTXContext->NextBulkOutPosition];
1726
1727                 if (!RTMP_TEST_FLAG(pAd, (fRTMP_ADAPTER_RESET_IN_PROGRESS |
1728                                                                         fRTMP_ADAPTER_HALT_IN_PROGRESS |
1729                                                                         fRTMP_ADAPTER_NIC_NOT_EXIST |
1730                                                                         fRTMP_ADAPTER_BULKOUT_RESET)))
1731                 {
1732                         RTMP_SET_FLAG(pAd, fRTMP_ADAPTER_BULKOUT_RESET);
1733                         pAd->bulkResetPipeid = BulkOutPipeId;
1734                         pAd->bulkResetReq[BulkOutPipeId] = pAd->BulkOutReq;
1735                 }
1736                 RTMP_IRQ_UNLOCK(&pAd->BulkOutLock[BulkOutPipeId], IrqFlags);
1737
1738                 DBGPRINT_RAW(RT_DEBUG_ERROR, ("BulkOutDataPacket failed: ReasonCode=%d!\n", Status));
1739                 DBGPRINT_RAW(RT_DEBUG_ERROR, ("\t>>BulkOut Req=0x%lx, Complete=0x%lx, Other=0x%lx\n", pAd->BulkOutReq, pAd->BulkOutComplete, pAd->BulkOutCompleteOther));
1740                 DBGPRINT_RAW(RT_DEBUG_ERROR, ("\t>>BulkOut Header:%x %x %x %x %x %x %x %x\n", pBuf[0], pBuf[1], pBuf[2], pBuf[3], pBuf[4], pBuf[5], pBuf[6], pBuf[7]));
1741                 //DBGPRINT_RAW(RT_DEBUG_ERROR, (">>BulkOutCompleteCancel=0x%x, BulkOutCompleteOther=0x%x\n", pAd->BulkOutCompleteCancel, pAd->BulkOutCompleteOther));
1742
1743         }
1744
1745         //
1746         // bInUse = TRUE, means some process are filling TX data, after that must turn on bWaitingBulkOut
1747         // bWaitingBulkOut = TRUE, means the TX data are waiting for bulk out.
1748         //
1749         //RTMP_IRQ_LOCK(&pAd->TxContextQueueLock[BulkOutPipeId], IrqFlags);
1750         if ((pHTTXContext->ENextBulkOutPosition != pHTTXContext->CurWritePosition) &&
1751                 (pHTTXContext->ENextBulkOutPosition != (pHTTXContext->CurWritePosition+8)) &&
1752                 !RTUSB_TEST_BULK_FLAG(pAd, (fRTUSB_BULK_OUT_DATA_FRAG << BulkOutPipeId)))
1753         {
1754                 // Indicate There is data avaliable
1755                 RTUSB_SET_BULK_FLAG(pAd, (fRTUSB_BULK_OUT_DATA_NORMAL << BulkOutPipeId));
1756         }
1757         //RTMP_IRQ_UNLOCK(&pAd->TxContextQueueLock[BulkOutPipeId], IrqFlags);
1758
1759         // Always call Bulk routine, even reset bulk.
1760         // The protection of rest bulk should be in BulkOut routine
1761         RTUSBKickBulkOut(pAd);
1762 }
1763
1764 /* End of 2870_rtmp_init.c */