VOID tr_tb_set_entry(RTMP_ADAPTER *pAd, UCHAR tr_tb_idx, MAC_TABLE_ENTRY *pEntry)
{
struct _STA_TR_ENTRY *tr_entry;
INT qidx, tid,upId;
//MAC_TABLE_ENTRY *mac_entry;
struct wtbl_entry tb_entry;
//struct wtbl_2_struc *wtbl_2;
if (tr_tb_idx < MAX_LEN_OF_TR_TABLE)
{
tr_entry = &pAd->MacTab.tr_entry[tr_tb_idx];
tr_entry->EntryType = pEntry->EntryType;
tr_entry->wdev = pEntry->wdev;
tr_entry->func_tb_idx = pEntry->func_tb_idx;
tr_entry->wcid = pEntry->wcid;
NdisMoveMemory(tr_entry->Addr, pEntry->Addr, MAC_ADDR_LEN);
tr_entry->NonQosDataSeq = 0;
for (tid = 0; tid < NUM_OF_TID; tid++)
tr_entry->TxSeq[tid] = 0;
for(upId = 0 ; upId < NUM_OF_UP ; upId ++)
{
tr_entry->cacheSn[upId] = -1;
}
/* Reset BA SSN & Score Board Bitmap, for BA Receiptor */
NdisZeroMemory(&tb_entry, sizeof(tb_entry));
if (mt_wtbl_get_entry234(pAd, tr_entry->wcid, &tb_entry) == FALSE) {
DBGPRINT(RT_DEBUG_ERROR, ("%s(): Not found WTBL2/3/4 for tr_entry->wcid(%d), !ERROR!\n",
__FUNCTION__, tr_entry->wcid));
return;
}
//mac_entry = &pAd->MacTab.Content[tr_entry->wcid];
tr_entry->PsMode = PWR_ACTIVE;
tr_entry->isCached = FALSE;
tr_entry->PortSecured = WPA_802_1X_PORT_NOT_SECURED;
tr_entry->CurrTxRate = pEntry->CurrTxRate;
for (qidx = 0 ; qidx < WMM_QUE_NUM; qidx++) {
InitializeQueueHeader(&tr_entry->tx_queue[qidx]);
NdisAllocateSpinLock(pAd, &tr_entry->txq_lock[qidx]);
}
InitializeQueueHeader(&tr_entry->ps_queue);
NdisAllocateSpinLock(pAd, &tr_entry->ps_queue_lock);
tr_entry->deq_cnt = 0;
tr_entry->deq_bytes = 0;
tr_entry->PsQIdleCount = 0;
tr_entry->enq_cap = TRUE;
tr_entry->deq_cap = TRUE;
tr_entry->PsTokenFlag = 0;
NdisMoveMemory(tr_entry->bssid, pEntry->wdev->bssid, MAC_ADDR_LEN);
}
}
VOID NICInitTxRxRingAndBacklogQueue(
IN PRTMP_ADAPTER pAd)
{
int i;
DBGPRINT(RT_DEBUG_TRACE, ("<--> NICInitTxRxRingAndBacklogQueue\n"));
InitializeQueueHeader(&pAd->TxSwQueue[QID_AC_BE]);
InitializeQueueHeader(&pAd->TxSwQueue[QID_AC_BK]);
InitializeQueueHeader(&pAd->TxSwQueue[QID_AC_VI]);
InitializeQueueHeader(&pAd->TxSwQueue[QID_AC_VO]);
InitializeQueueHeader(&pAd->TxSwQueue[QID_HCCA]);
pAd->RxRing.RxSwReadIdx = 0;
pAd->RxRing.RxCpuIdx = RX_RING_SIZE - 1;
for (i=0; i<NUM_OF_TX_RING; i++)
{
pAd->TxRing[i].TxSwFreeIdx = 0;
pAd->TxRing[i].TxCpuIdx = 0;
}
pAd->MgmtRing.TxSwFreeIdx = 0;
pAd->MgmtRing.TxCpuIdx = 0;
pAd->PrivateInfo.TxRingFullCnt = 0;
}
/*
========================================================================
Routine Description:
Initialize transmit data structures
Arguments:
Adapter Pointer to our adapter
Return Value:
None
IRQL = PASSIVE_LEVEL
Note:
Initialize all transmit releated private buffer, include those define
in RTMP_ADAPTER structure and all private data structures.
========================================================================
*/
VOID NICInitTxRxRingAndBacklogQueue(
IN PRTMP_ADAPTER pAd)
{
//WPDMA_GLO_CFG_STRUC GloCfg;
int i;
DBGPRINT(RT_DEBUG_TRACE, ("<--> NICInitTxRxRingAndBacklogQueue\n"));
// Initialize all transmit related software queues
InitializeQueueHeader(&pAd->TxSwQueue[QID_AC_BE]);
InitializeQueueHeader(&pAd->TxSwQueue[QID_AC_BK]);
InitializeQueueHeader(&pAd->TxSwQueue[QID_AC_VI]);
InitializeQueueHeader(&pAd->TxSwQueue[QID_AC_VO]);
InitializeQueueHeader(&pAd->TxSwQueue[QID_HCCA]);
// Init RX Ring index pointer
pAd->RxRing.RxSwReadIdx = 0;
pAd->RxRing.RxCpuIdx = RX_RING_SIZE - 1;
// Init TX rings index pointer
for (i=0; i<NUM_OF_TX_RING; i++)
{
pAd->TxRing[i].TxSwFreeIdx = 0;
pAd->TxRing[i].TxCpuIdx = 0;
}
// init MGMT ring index pointer
pAd->MgmtRing.TxSwFreeIdx = 0;
pAd->MgmtRing.TxCpuIdx = 0;
pAd->PrivateInfo.TxRingFullCnt = 0;
}
VOID tr_tb_set_mcast_entry(RTMP_ADAPTER *pAd, UCHAR tr_tb_idx, struct wifi_dev *wdev)
{
struct _STA_TR_ENTRY *tr_entry = &pAd->MacTab.tr_entry[tr_tb_idx];
INT qidx, tid;
NdisZeroMemory(tr_entry, sizeof(struct _STA_TR_ENTRY));
tr_entry->EntryType = ENTRY_CAT_MCAST;
tr_entry->wdev = wdev;
tr_entry->func_tb_idx = wdev->func_idx;
tr_entry->PsMode = PWR_ACTIVE;
tr_entry->isCached = FALSE;
tr_entry->PortSecured = WPA_802_1X_PORT_SECURED;
tr_entry->CurrTxRate = pAd->CommonCfg.MlmeRate;
NdisMoveMemory(tr_entry->Addr, &BROADCAST_ADDR[0], MAC_ADDR_LEN);
// TODO: shiang-usw, for following fields, need better assignment!
tr_entry->wcid = tr_tb_idx;
tr_entry->NonQosDataSeq = 0;
for (tid = 0; tid < NUM_OF_TID; tid++)
tr_entry->TxSeq[tid] = 0;
for (qidx = 0 ; qidx < WMM_QUE_NUM; qidx++) {
InitializeQueueHeader(&tr_entry->tx_queue[qidx]);
NdisAllocateSpinLock(pAd, &tr_entry->txq_lock[qidx]);
}
InitializeQueueHeader(&tr_entry->ps_queue);
NdisAllocateSpinLock(pAd, &tr_entry->ps_queue_lock);
tr_entry->deq_cnt = 0;
tr_entry->deq_bytes = 0;
tr_entry->PsQIdleCount = 0;
tr_entry->enq_cap = TRUE;
tr_entry->deq_cap = TRUE;
tr_entry->PsTokenFlag = 0;
#ifdef DATA_QUEUE_RESERVE
tr_entry->high_pkt_cnt = 0;
tr_entry->high_pkt_drop_cnt = 0;
#endif /* DATA_QUEUE_RESERVE */
NdisMoveMemory(tr_entry->bssid, wdev->bssid, MAC_ADDR_LEN);
}
MAC_TABLE_ENTRY *RTMPInsertRepeaterMacEntry(
IN RTMP_ADAPTER *pAd,
IN UCHAR *pAddr,
IN struct wifi_dev *wdev,
IN UCHAR apIdx,
IN UCHAR cliIdx,
IN BOOLEAN CleanAll)
{
UCHAR HashIdx;
int i;
MAC_TABLE_ENTRY *pEntry = NULL, *pCurrEntry;
BOOLEAN Cancelled;
/* if FULL, return*/
if (pAd->MacTab.Size >= MAX_LEN_OF_MAC_TABLE)
return NULL;
/* allocate one MAC entry*/
NdisAcquireSpinLock(&pAd->MacTabLock);
i = (MAX_NUMBER_OF_MAC + ((MAX_EXT_MAC_ADDR_SIZE + 1) * (apIdx - MIN_NET_DEVICE_FOR_APCLI)));
if (cliIdx != 0xFF)
i = i + cliIdx + 1;
/* pick up the first available vacancy*/
pEntry = &pAd->MacTab.Content[i];
if (pEntry == NULL)
{
printk("###### %s pEntry == NULL, i = %d\n", __func__, i);
}
if (pEntry && IS_ENTRY_NONE(pEntry))
{
/* ENTRY PREEMPTION: initialize the entry */
if (pEntry->RetryTimer.Valid)
RTMPCancelTimer(&pEntry->RetryTimer, &Cancelled);
if (pEntry->EnqueueStartForPSKTimer.Valid)
RTMPCancelTimer(&pEntry->EnqueueStartForPSKTimer, &Cancelled);
NdisZeroMemory(pEntry, sizeof(MAC_TABLE_ENTRY));
if (CleanAll == TRUE)
{
pEntry->MaxSupportedRate = RATE_11;
pEntry->CurrTxRate = RATE_11;
NdisZeroMemory(pEntry, sizeof(MAC_TABLE_ENTRY));
pEntry->PairwiseKey.KeyLen = 0;
pEntry->PairwiseKey.CipherAlg = CIPHER_NONE;
}
SET_ENTRY_APCLI(pEntry);
pEntry->wdev = wdev;
pEntry->wcid = i;
pEntry->isCached = FALSE;
pEntry->bIAmBadAtheros = FALSE;
RTMPInitTimer(pAd, &pEntry->EnqueueStartForPSKTimer, GET_TIMER_FUNCTION(EnqueueStartForPSKExec), pEntry, FALSE);
RTMPInitTimer(pAd, &pEntry->RetryTimer, GET_TIMER_FUNCTION(WPARetryExec), pEntry, FALSE);
#ifdef TXBF_SUPPORT
if (pAd->chipCap.FlgHwTxBfCap)
RTMPInitTimer(pAd, &pEntry->eTxBfProbeTimer, GET_TIMER_FUNCTION(eTxBfProbeTimerExec), pEntry, FALSE);
#endif /* TXBF_SUPPORT */
pEntry->pAd = pAd;
pEntry->CMTimerRunning = FALSE;
pEntry->EnqueueEapolStartTimerRunning = EAPOL_START_DISABLE;
pEntry->RSNIE_Len = 0;
NdisZeroMemory(pEntry->R_Counter, sizeof(pEntry->R_Counter));
pEntry->ReTryCounter = PEER_MSG1_RETRY_TIMER_CTR;
pEntry->apidx = (apIdx - MIN_NET_DEVICE_FOR_APCLI);
pEntry->pMbss = &pAd->ApCfg.MBSSID[pEntry->apidx];
pEntry->AuthMode = pAd->ApCfg.ApCliTab[pEntry->apidx].wdev.AuthMode;
pEntry->WepStatus = pAd->ApCfg.ApCliTab[pEntry->apidx].wdev.WepStatus;
pEntry->wdev_idx = pEntry->apidx;
if (pEntry->AuthMode < Ndis802_11AuthModeWPA)
{
pEntry->WpaState = AS_NOTUSE;
pEntry->PrivacyFilter = Ndis802_11PrivFilterAcceptAll;
}
else
{
pEntry->WpaState = AS_PTKSTART;
pEntry->PrivacyFilter = Ndis802_11PrivFilter8021xWEP;
}
pEntry->GTKState = REKEY_NEGOTIATING;
pEntry->PairwiseKey.KeyLen = 0;
pEntry->PairwiseKey.CipherAlg = CIPHER_NONE;
pEntry->PortSecured = WPA_802_1X_PORT_NOT_SECURED;
pEntry->PMKID_CacheIdx = ENTRY_NOT_FOUND;
COPY_MAC_ADDR(pEntry->Addr, pAddr);
//COPY_MAC_ADDR(pEntry->HdrAddr1, pAddr);
//COPY_MAC_ADDR(pEntry->HdrAddr2, pAd->ApCfg.ApCliTab[pEntry->apidx].CurrentAddress);
//COPY_MAC_ADDR(pEntry->HdrAddr3, pAddr);
COPY_MAC_ADDR(pEntry->bssid, pAddr);
pEntry->Sst = SST_NOT_AUTH;
pEntry->AuthState = AS_NOT_AUTH;
pEntry->Aid = (USHORT)i; /*0;*/
pEntry->CapabilityInfo = 0;
pEntry->PsMode = PWR_ACTIVE;
pEntry->PsQIdleCount = 0;
pEntry->NoDataIdleCount = 0;
pEntry->AssocDeadLine = MAC_TABLE_ASSOC_TIMEOUT;
pEntry->ContinueTxFailCnt = 0;
pEntry->TimeStamp_toTxRing = 0;
InitializeQueueHeader(&pEntry->PsQueue);
#ifdef PS_ENTRY_MAITENANCE
pEntry->continuous_ps_count = 0;
#endif /* PS_ENTRY_MAITENANCE */
pAd->MacTab.Size ++;
/* Set the security mode of this entry as OPEN-NONE in ASIC */
RTMP_REMOVE_PAIRWISE_KEY_ENTRY(pAd, (UCHAR)i);
/* Add this entry into ASIC RX WCID search table */
RTMP_STA_ENTRY_ADD(pAd, pEntry);
#ifdef WSC_AP_SUPPORT
pEntry->bWscCapable = FALSE;
pEntry->Receive_EapolStart_EapRspId = 0;
#endif /* WSC_AP_SUPPORT */
#ifdef TXBF_SUPPORT
if (pAd->chipCap.FlgHwTxBfCap)
NdisAllocateSpinLock(pAd, &pEntry->TxSndgLock);
#endif /* TXBF_SUPPORT */
#ifdef PEER_DELBA_TX_ADAPT
Peer_DelBA_Tx_Adapt_Init(pAd, pEntry);
#endif /* PEER_DELBA_TX_ADAPT */
#ifdef DROP_MASK_SUPPORT
drop_mask_init_per_client(pAd, pEntry);
#endif /* DROP_MASK_SUPPORT */
#ifdef FIFO_EXT_SUPPORT
if (pAd->chipCap.FlgHwFifoExtCap)
{
UCHAR tblIdx;
if ((cliIdx != 0xFF) && IsFifoExtTblAvailable(pAd, &tblIdx))
FifoExtTblUpdateEntry(pAd, tblIdx, i);
}
#endif
DBGPRINT(RT_DEBUG_TRACE, ("%s - allocate entry #%d, Aid = %d, Wcid = %d Addr(%02x:%02x:%02x:%02x:%02x:%02x) Total= %d\n",__FUNCTION__, i,
pEntry->Aid, pEntry->wcid, PRINT_MAC(pEntry->Addr), pAd->MacTab.Size));
}
else
{
DBGPRINT(RT_DEBUG_ERROR, ("%s - exist entry #%d, Aid = %d, Total= %d\n", __FUNCTION__, i, pEntry->Aid, pAd->MacTab.Size));
NdisReleaseSpinLock(&pAd->MacTabLock);
return pEntry;
}
/* add this MAC entry into HASH table */
if (pEntry)
{
pEntry->pNext = NULL;
HashIdx = MAC_ADDR_HASH_INDEX(pAddr);
if (pAd->MacTab.Hash[HashIdx] == NULL)
{
pAd->MacTab.Hash[HashIdx] = pEntry;
}
else
{
pCurrEntry = pAd->MacTab.Hash[HashIdx];
while (pCurrEntry->pNext != NULL)
pCurrEntry = pCurrEntry->pNext;
pCurrEntry->pNext = pEntry;
}
}
NdisReleaseSpinLock(&pAd->MacTabLock);
return pEntry;
}
/*
========================================================================
Routine Description:
Initialize transmit data structures.
Arguments:
pAd Pointer to our adapter
Return Value:
NDIS_STATUS_SUCCESS
NDIS_STATUS_RESOURCES
Note:
========================================================================
*/
NDIS_STATUS NICInitTransmit(
IN PRTMP_ADAPTER pAd)
{
#define LM_USB_ALLOC(pObj, Context, TB_Type, BufferSize, Status, msg1, err1, msg2, err2) \
Context->pUrb = RTUSB_ALLOC_URB(0); \
if (Context->pUrb == NULL) { \
DBGPRINT(RT_DEBUG_ERROR, msg1); \
Status = NDIS_STATUS_RESOURCES; \
goto err1; } \
\
Context->TransferBuffer = \
(TB_Type)RTUSB_URB_ALLOC_BUFFER(pObj->pUsb_Dev, BufferSize, &Context->data_dma); \
if (Context->TransferBuffer == NULL) { \
DBGPRINT(RT_DEBUG_ERROR, msg2); \
Status = NDIS_STATUS_RESOURCES; \
goto err2; }
#define LM_URB_FREE(pObj, Context, BufferSize) \
if (NULL != Context->pUrb) { \
RTUSB_UNLINK_URB(Context->pUrb); \
RTUSB_FREE_URB(Context->pUrb); \
Context->pUrb = NULL; } \
if (NULL != Context->TransferBuffer) { \
RTUSB_URB_FREE_BUFFER(pObj->pUsb_Dev, BufferSize, \
Context->TransferBuffer, \
Context->data_dma); \
Context->TransferBuffer = NULL; }
UCHAR i, acidx;
NDIS_STATUS Status = NDIS_STATUS_SUCCESS;
PTX_CONTEXT pNullContext = &(pAd->NullContext);
PTX_CONTEXT pPsPollContext = &(pAd->PsPollContext);
PTX_CONTEXT pRTSContext = &(pAd->RTSContext);
PTX_CONTEXT pMLMEContext = NULL;
// PHT_TX_CONTEXT pHTTXContext = NULL;
POS_COOKIE pObj = (POS_COOKIE) pAd->OS_Cookie;
PVOID RingBaseVa;
// RTMP_TX_RING *pTxRing;
RTMP_MGMT_RING *pMgmtRing;
DBGPRINT(RT_DEBUG_TRACE, ("--> NICInitTransmit\n"));
pObj = pObj;
// Init 4 set of Tx parameters
for(acidx = 0; acidx < NUM_OF_TX_RING; acidx++)
{
// Initialize all Transmit releated queues
InitializeQueueHeader(&pAd->TxSwQueue[acidx]);
// Next Local tx ring pointer waiting for buck out
pAd->NextBulkOutIndex[acidx] = acidx;
pAd->BulkOutPending[acidx] = FALSE; // Buck Out control flag
//pAd->DataBulkDoneIdx[acidx] = 0;
}
//pAd->NextMLMEIndex = 0;
//pAd->PushMgmtIndex = 0;
//pAd->PopMgmtIndex = 0;
//InterlockedExchange(&pAd->MgmtQueueSize, 0);
//InterlockedExchange(&pAd->TxCount, 0);
//pAd->PrioRingFirstIndex = 0;
//pAd->PrioRingTxCnt = 0;
do
{
//
// TX_RING_SIZE, 4 ACs
//
#ifdef CONFIG_STA_SUPPORT
IF_DEV_CONFIG_OPMODE_ON_STA(pAd)
for(acidx=0; acidx<4; acidx++)
#endif // CONFIG_STA_SUPPORT //
{
#if 1 //def DOT11_N_SUPPORT
PHT_TX_CONTEXT pHTTXContext = &(pAd->TxContext[acidx]);
NdisZeroMemory(pHTTXContext, sizeof(HT_TX_CONTEXT));
//Allocate URB
LM_USB_ALLOC(pObj, pHTTXContext, PHTTX_BUFFER, sizeof(HTTX_BUFFER), Status,
("<-- ERROR in Alloc TX TxContext[%d] urb!! \n", acidx),
done,
("<-- ERROR in Alloc TX TxContext[%d] HTTX_BUFFER !! \n", acidx),
out1);
NdisZeroMemory(pHTTXContext->TransferBuffer->Aggregation, 4);
pHTTXContext->pAd = pAd;
pHTTXContext->pIrp = NULL;
pHTTXContext->IRPPending = FALSE;
pHTTXContext->NextBulkOutPosition = 0;
pHTTXContext->ENextBulkOutPosition = 0;
pHTTXContext->CurWritePosition = 0;
pHTTXContext->CurWriteRealPos = 0;
pHTTXContext->BulkOutSize = 0;
pHTTXContext->BulkOutPipeId = acidx;
pHTTXContext->bRingEmpty = TRUE;
pHTTXContext->bCopySavePad = FALSE;
#endif // DOT11_N_SUPPORT //
pAd->BulkOutPending[acidx] = FALSE;
}
//
// MGMT_RING_SIZE
//
#if 0
for(i=0; i<MGMT_RING_SIZE; i++) // 8
{
PTX_CONTEXT pMLMEContext = &(pAd->MLMEContext[i]);
NdisZeroMemory(pMLMEContext, sizeof(TX_CONTEXT));
//Allocate URB
LM_USB_ALLOC(pObj, pMLMEContext, PTX_BUFFER, sizeof(TX_BUFFER), Status,
("<-- ERROR in Alloc TX MLMEContext[%d] urb!! \n", i),
out2,
("<-- ERROR in Alloc TX MLMEContext[%d] TX_BUFFER !! \n", i),
out2);
pMLMEContext->pAd = pAd;
pMLMEContext->pIrp = NULL;
pMLMEContext->InUse = FALSE;
pMLMEContext->IRPPending = FALSE;
}
#else
// Allocate MGMT ring descriptor's memory
pAd->MgmtDescRing.AllocSize = MGMT_RING_SIZE * sizeof(TX_CONTEXT);
RTMPAllocateMemory(&pAd->MgmtDescRing.AllocVa, pAd->MgmtDescRing.AllocSize);
if (pAd->MgmtDescRing.AllocVa == NULL)
{
DBGPRINT_ERR(("Failed to allocate a big buffer for MgmtDescRing!\n"));
Status = NDIS_STATUS_RESOURCES;
goto out1;
}
NdisZeroMemory(pAd->MgmtDescRing.AllocVa, pAd->MgmtDescRing.AllocSize);
RingBaseVa = pAd->MgmtDescRing.AllocVa;
// Initialize MGMT Ring and associated buffer memory
pMgmtRing = &pAd->MgmtRing;
for (i = 0; i < MGMT_RING_SIZE; i++)
{
// link the pre-allocated Mgmt buffer to MgmtRing.Cell
pMgmtRing->Cell[i].AllocSize = sizeof(TX_CONTEXT);
pMgmtRing->Cell[i].AllocVa = RingBaseVa;
pMgmtRing->Cell[i].pNdisPacket = NULL;
pMgmtRing->Cell[i].pNextNdisPacket = NULL;
//Allocate URB for MLMEContext
pMLMEContext = (PTX_CONTEXT) pAd->MgmtRing.Cell[i].AllocVa;
pMLMEContext->pUrb = RTUSB_ALLOC_URB(0);
if (pMLMEContext->pUrb == NULL)
{
DBGPRINT(RT_DEBUG_ERROR, ("<-- ERROR in Alloc TX MLMEContext[%d] urb!! \n", i));
Status = NDIS_STATUS_RESOURCES;
goto out2;
}
pMLMEContext->pAd = pAd;
pMLMEContext->pIrp = NULL;
pMLMEContext->TransferBuffer = NULL;
pMLMEContext->InUse = FALSE;
pMLMEContext->IRPPending = FALSE;
pMLMEContext->bWaitingBulkOut = FALSE;
pMLMEContext->BulkOutSize = 0;
pMLMEContext->SelfIdx = i;
// Offset to next ring descriptor address
RingBaseVa = (PUCHAR) RingBaseVa + sizeof(TX_CONTEXT);
}
DBGPRINT(RT_DEBUG_TRACE, ("MGMT Ring: total %d entry allocated\n", i));
//pAd->MgmtRing.TxSwFreeIdx = (MGMT_RING_SIZE - 1);
pAd->MgmtRing.TxSwFreeIdx = MGMT_RING_SIZE;
pAd->MgmtRing.TxCpuIdx = 0;
pAd->MgmtRing.TxDmaIdx = 0;
#endif
//
// BEACON_RING_SIZE
//
for(i=0; i<BEACON_RING_SIZE; i++) // 2
{
PTX_CONTEXT pBeaconContext = &(pAd->BeaconContext[i]);
NdisZeroMemory(pBeaconContext, sizeof(TX_CONTEXT));
//Allocate URB
LM_USB_ALLOC(pObj, pBeaconContext, PTX_BUFFER, sizeof(TX_BUFFER), Status,
("<-- ERROR in Alloc TX BeaconContext[%d] urb!! \n", i),
out2,
("<-- ERROR in Alloc TX BeaconContext[%d] TX_BUFFER !! \n", i),
out3);
pBeaconContext->pAd = pAd;
pBeaconContext->pIrp = NULL;
pBeaconContext->InUse = FALSE;
pBeaconContext->IRPPending = FALSE;
}
//
// NullContext
//
NdisZeroMemory(pNullContext, sizeof(TX_CONTEXT));
//Allocate URB
LM_USB_ALLOC(pObj, pNullContext, PTX_BUFFER, sizeof(TX_BUFFER), Status,
("<-- ERROR in Alloc TX NullContext urb!! \n"),
out3,
("<-- ERROR in Alloc TX NullContext TX_BUFFER !! \n"),
out4);
pNullContext->pAd = pAd;
pNullContext->pIrp = NULL;
pNullContext->InUse = FALSE;
pNullContext->IRPPending = FALSE;
//
// RTSContext
//
NdisZeroMemory(pRTSContext, sizeof(TX_CONTEXT));
//Allocate URB
LM_USB_ALLOC(pObj, pRTSContext, PTX_BUFFER, sizeof(TX_BUFFER), Status,
("<-- ERROR in Alloc TX RTSContext urb!! \n"),
out4,
("<-- ERROR in Alloc TX RTSContext TX_BUFFER !! \n"),
out5);
pRTSContext->pAd = pAd;
pRTSContext->pIrp = NULL;
pRTSContext->InUse = FALSE;
pRTSContext->IRPPending = FALSE;
//
// PsPollContext
//
//NdisZeroMemory(pPsPollContext, sizeof(TX_CONTEXT));
//Allocate URB
LM_USB_ALLOC(pObj, pPsPollContext, PTX_BUFFER, sizeof(TX_BUFFER), Status,
("<-- ERROR in Alloc TX PsPollContext urb!! \n"),
out5,
("<-- ERROR in Alloc TX PsPollContext TX_BUFFER !! \n"),
out6);
pPsPollContext->pAd = pAd;
pPsPollContext->pIrp = NULL;
pPsPollContext->InUse = FALSE;
pPsPollContext->IRPPending = FALSE;
pPsPollContext->bAggregatible = FALSE;
pPsPollContext->LastOne = TRUE;
} while (FALSE);
done:
DBGPRINT(RT_DEBUG_TRACE, ("<-- NICInitTransmit\n"));
return Status;
/* --------------------------- ERROR HANDLE --------------------------- */
out6:
LM_URB_FREE(pObj, pPsPollContext, sizeof(TX_BUFFER));
out5:
LM_URB_FREE(pObj, pRTSContext, sizeof(TX_BUFFER));
out4:
LM_URB_FREE(pObj, pNullContext, sizeof(TX_BUFFER));
out3:
for(i=0; i<BEACON_RING_SIZE; i++)
{
PTX_CONTEXT pBeaconContext = &(pAd->BeaconContext[i]);
if (pBeaconContext)
LM_URB_FREE(pObj, pBeaconContext, sizeof(TX_BUFFER));
}
out2:
if (pAd->MgmtDescRing.AllocVa)
{
pMgmtRing = &pAd->MgmtRing;
for(i=0; i<MGMT_RING_SIZE; i++)
{
pMLMEContext = (PTX_CONTEXT) pAd->MgmtRing.Cell[i].AllocVa;
if (pMLMEContext)
LM_URB_FREE(pObj, pMLMEContext, sizeof(TX_BUFFER));
}
NdisFreeMemory(pAd->MgmtDescRing.AllocVa, pAd->MgmtDescRing.AllocSize, 0);
pAd->MgmtDescRing.AllocVa = NULL;
}
out1:
#ifdef CONFIG_STA_SUPPORT
IF_DEV_CONFIG_OPMODE_ON_STA(pAd)
for(acidx=0; acidx<4; acidx++)
#endif // CONFIG_STA_SUPPORT //
{
PHT_TX_CONTEXT pTxContext = &(pAd->TxContext[acidx]);
if (pTxContext)
LM_URB_FREE(pObj, pTxContext, sizeof(HTTX_BUFFER));
}
// Here we didn't have any pre-allocated memory need to free.
return Status;
}
MAC_TABLE_ENTRY *MacTableInsertEntry(
IN PRTMP_ADAPTER pAd,
IN PUCHAR pAddr,
IN UCHAR apidx,
IN UCHAR OpMode,
IN BOOLEAN CleanAll)
{
UCHAR HashIdx;
int i, FirstWcid;
MAC_TABLE_ENTRY *pEntry = NULL, *pCurrEntry;
/* USHORT offset;*/
/* ULONG addr;*/
BOOLEAN Cancelled;
/* if FULL, return*/
if (pAd->MacTab.Size >= MAX_LEN_OF_MAC_TABLE)
return NULL;
FirstWcid = 1;
/* allocate one MAC entry*/
NdisAcquireSpinLock(&pAd->MacTabLock);
for (i = FirstWcid; i< MAX_LEN_OF_MAC_TABLE; i++) /* skip entry#0 so that "entry index == AID" for fast lookup*/
{
/* pick up the first available vacancy*/
if (IS_ENTRY_NONE(&pAd->MacTab.Content[i]))
{
pEntry = &pAd->MacTab.Content[i];
/* ENTRY PREEMPTION: initialize the entry */
RTMPCancelTimer(&pEntry->RetryTimer, &Cancelled);
RTMPCancelTimer(&pEntry->EnqueueStartForPSKTimer, &Cancelled);
NdisZeroMemory(pEntry, sizeof(MAC_TABLE_ENTRY));
if (CleanAll == TRUE)
{
pEntry->MaxSupportedRate = RATE_11;
pEntry->CurrTxRate = RATE_11;
NdisZeroMemory(pEntry, sizeof(MAC_TABLE_ENTRY));
pEntry->PairwiseKey.KeyLen = 0;
pEntry->PairwiseKey.CipherAlg = CIPHER_NONE;
}
do
{
#ifdef CONFIG_AP_SUPPORT
#ifdef APCLI_SUPPORT
if (apidx >= MIN_NET_DEVICE_FOR_APCLI)
{
SET_ENTRY_APCLI(pEntry);
pEntry->isCached = FALSE;
break;
}
#endif /* APCLI_SUPPORT */
#ifdef WDS_SUPPORT
if (apidx >= MIN_NET_DEVICE_FOR_WDS)
{
SET_ENTRY_WDS(pEntry);
pEntry->isCached = FALSE;
break;
}
#endif /* WDS_SUPPORT */
#endif /* CONFIG_AP_SUPPORT */
#ifdef CONFIG_AP_SUPPORT
IF_DEV_CONFIG_OPMODE_ON_AP(pAd)
{ /* be a regular-entry*/
if ((apidx < pAd->ApCfg.BssidNum) &&
(apidx < MAX_MBSSID_NUM(pAd)) &&
((apidx < HW_BEACON_MAX_NUM)) &&
(pAd->ApCfg.MBSSID[apidx].MaxStaNum != 0) &&
(pAd->ApCfg.MBSSID[apidx].StaCount >= pAd->ApCfg.MBSSID[apidx].MaxStaNum))
{
DBGPRINT(RT_DEBUG_WARN, ("%s: The connection table is full in ra%d.\n", __FUNCTION__, apidx));
NdisReleaseSpinLock(&pAd->MacTabLock);
return NULL;
}
}
#endif /* CONFIG_AP_SUPPORT */
SET_ENTRY_CLIENT(pEntry);
} while (FALSE);
pEntry->bIAmBadAtheros = FALSE;
RTMPInitTimer(pAd, &pEntry->EnqueueStartForPSKTimer, GET_TIMER_FUNCTION(EnqueueStartForPSKExec), pEntry, FALSE);
#ifdef CONFIG_AP_SUPPORT
IF_DEV_CONFIG_OPMODE_ON_AP(pAd)
{
if (IS_ENTRY_CLIENT(pEntry)) /* Only Clent entry need the retry timer.*/
{
RTMPInitTimer(pAd, &pEntry->RetryTimer, GET_TIMER_FUNCTION(WPARetryExec), pEntry, FALSE);
/* RTMP_OS_Init_Timer(pAd, &pEntry->RetryTimer, GET_TIMER_FUNCTION(WPARetryExec), pAd);*/
}
#ifdef APCLI_SUPPORT
else if (IS_ENTRY_APCLI(pEntry))
{
RTMPInitTimer(pAd, &pEntry->RetryTimer, GET_TIMER_FUNCTION(WPARetryExec), pEntry, FALSE);
}
#endif /* APCLI_SUPPORT */
}
#endif /* CONFIG_AP_SUPPORT */
#ifdef TXBF_SUPPORT
if (pAd->chipCap.FlgHwTxBfCap)
RTMPInitTimer(pAd, &pEntry->eTxBfProbeTimer, GET_TIMER_FUNCTION(eTxBfProbeTimerExec), pEntry, FALSE);
#endif /* TXBF_SUPPORT */
pEntry->pAd = pAd;
pEntry->CMTimerRunning = FALSE;
pEntry->EnqueueEapolStartTimerRunning = EAPOL_START_DISABLE;
pEntry->RSNIE_Len = 0;
NdisZeroMemory(pEntry->R_Counter, sizeof(pEntry->R_Counter));
pEntry->ReTryCounter = PEER_MSG1_RETRY_TIMER_CTR;
if (IS_ENTRY_MESH(pEntry))
pEntry->apidx = (apidx - MIN_NET_DEVICE_FOR_MESH);
else if (IS_ENTRY_APCLI(pEntry))
pEntry->apidx = (apidx - MIN_NET_DEVICE_FOR_APCLI);
else if (IS_ENTRY_WDS(pEntry))
pEntry->apidx = (apidx - MIN_NET_DEVICE_FOR_WDS);
else
pEntry->apidx = apidx;
#ifdef CONFIG_AP_SUPPORT
if ((apidx < pAd->ApCfg.BssidNum) &&
(apidx < MAX_MBSSID_NUM(pAd)) &&
(apidx < HW_BEACON_MAX_NUM))
pEntry->pMbss = &pAd->ApCfg.MBSSID[pEntry->apidx];
else
pEntry->pMbss = NULL;
#endif /* CONFIG_AP_SUPPORT */
do
{
#ifdef CONFIG_AP_SUPPORT
#ifdef APCLI_SUPPORT
if (IS_ENTRY_APCLI(pEntry))
{
pEntry->AuthMode = pAd->ApCfg.ApCliTab[pEntry->apidx].AuthMode;
pEntry->WepStatus = pAd->ApCfg.ApCliTab[pEntry->apidx].WepStatus;
if (pEntry->AuthMode < Ndis802_11AuthModeWPA)
{
pEntry->WpaState = AS_NOTUSE;
pEntry->PrivacyFilter = Ndis802_11PrivFilterAcceptAll;
}
else
{
pEntry->WpaState = AS_PTKSTART;
pEntry->PrivacyFilter = Ndis802_11PrivFilter8021xWEP;
}
pEntry->MatchAPCLITabIdx = pEntry->apidx;
break;
}
#endif /* APCLI_SUPPORT */
#ifdef WDS_SUPPORT
if (IS_ENTRY_WDS(pEntry))
{
pEntry->AuthMode = Ndis802_11AuthModeOpen;
pEntry->WepStatus = Ndis802_11EncryptionDisabled;
pEntry->MatchWDSTabIdx = pEntry->apidx;
break;
}
#endif /* WDS_SUPPORT */
IF_DEV_CONFIG_OPMODE_ON_AP(pAd)
{
MBSS_MR_APIDX_SANITY_CHECK(pAd, apidx);
pEntry->AuthMode = pAd->ApCfg.MBSSID[apidx].AuthMode;
pEntry->WepStatus = pAd->ApCfg.MBSSID[apidx].WepStatus;
pEntry->GroupKeyWepStatus = pAd->ApCfg.MBSSID[apidx].GroupKeyWepStatus;
if (pEntry->AuthMode < Ndis802_11AuthModeWPA)
pEntry->WpaState = AS_NOTUSE;
else
pEntry->WpaState = AS_INITIALIZE;
pEntry->PrivacyFilter = Ndis802_11PrivFilterAcceptAll;
pEntry->StaIdleTimeout = pAd->ApCfg.StaIdleTimeout;
pAd->ApCfg.MBSSID[apidx].StaCount++;
pAd->ApCfg.EntryClientCount++;
break;
}
#endif /* CONFIG_AP_SUPPORT */
} while (FALSE);
pEntry->GTKState = REKEY_NEGOTIATING;
pEntry->PairwiseKey.KeyLen = 0;
pEntry->PairwiseKey.CipherAlg = CIPHER_NONE;
pEntry->PortSecured = WPA_802_1X_PORT_NOT_SECURED;
pEntry->PMKID_CacheIdx = ENTRY_NOT_FOUND;
COPY_MAC_ADDR(pEntry->Addr, pAddr);
COPY_MAC_ADDR(pEntry->HdrAddr1, pAddr);
do
{
#ifdef APCLI_SUPPORT
if (IS_ENTRY_APCLI(pEntry))
{
COPY_MAC_ADDR(pEntry->HdrAddr2, pAd->ApCfg.ApCliTab[pEntry->apidx].CurrentAddress);
COPY_MAC_ADDR(pEntry->HdrAddr3, pAddr);
break;
}
#endif // APCLI_SUPPORT //
#ifdef WDS_SUPPORT
if (IS_ENTRY_WDS(pEntry))
{
COPY_MAC_ADDR(pEntry->HdrAddr2, pAd->ApCfg.MBSSID[MAIN_MBSSID].Bssid);
COPY_MAC_ADDR(pEntry->HdrAddr3, pAd->ApCfg.MBSSID[MAIN_MBSSID].Bssid);
break;
}
#endif // WDS_SUPPORT //
#ifdef CONFIG_AP_SUPPORT
if (OpMode == OPMODE_AP)
{
COPY_MAC_ADDR(pEntry->HdrAddr2, pAd->ApCfg.MBSSID[apidx].Bssid);
COPY_MAC_ADDR(pEntry->HdrAddr3, pAd->ApCfg.MBSSID[apidx].Bssid);
break;
}
#endif // CONFIG_AP_SUPPORT //
} while (FALSE);
pEntry->Sst = SST_NOT_AUTH;
pEntry->AuthState = AS_NOT_AUTH;
pEntry->Aid = (USHORT)i; /*0;*/
pEntry->CapabilityInfo = 0;
pEntry->PsMode = PWR_ACTIVE;
pEntry->PsQIdleCount = 0;
pEntry->NoDataIdleCount = 0;
pEntry->AssocDeadLine = MAC_TABLE_ASSOC_TIMEOUT;
pEntry->ContinueTxFailCnt = 0;
#ifdef WDS_SUPPORT
pEntry->LockEntryTx = FALSE;
#endif /* WDS_SUPPORT */
pEntry->TimeStamp_toTxRing = 0;
InitializeQueueHeader(&pEntry->PsQueue);
#ifdef STREAM_MODE_SUPPORT
/* Enable Stream mode for first three entries in MAC table */
#endif /* STREAM_MODE_SUPPORT */
#ifdef CONFIG_AP_SUPPORT
IF_DEV_CONFIG_OPMODE_ON_AP(pAd)
{
#ifdef UAPSD_SUPPORT
if (IS_ENTRY_CLIENT(pEntry)) /* Ralink WDS doesn't support any power saving.*/
{
/* init U-APSD enhancement related parameters */
UAPSD_MR_ENTRY_INIT(pEntry);
}
#endif /* UAPSD_SUPPORT */
}
#endif /* CONFIG_AP_SUPPORT */
pAd->MacTab.Size ++;
/* Set the security mode of this entry as OPEN-NONE in ASIC */
RTMP_REMOVE_PAIRWISE_KEY_ENTRY(pAd, (UCHAR)i);
/* Add this entry into ASIC RX WCID search table */
RTMP_STA_ENTRY_ADD(pAd, pEntry);
#ifdef CONFIG_AP_SUPPORT
IF_DEV_CONFIG_OPMODE_ON_AP(pAd)
{
#ifdef WSC_AP_SUPPORT
pEntry->bWscCapable = FALSE;
pEntry->Receive_EapolStart_EapRspId = 0;
#endif /* WSC_AP_SUPPORT */
}
#endif /* CONFIG_AP_SUPPORT */
#ifdef TXBF_SUPPORT
if (pAd->chipCap.FlgHwTxBfCap)
NdisAllocateSpinLock(pAd, &pEntry->TxSndgLock);
#endif /* TXBF_SUPPORT */
DBGPRINT(RT_DEBUG_TRACE, ("MacTableInsertEntry - allocate entry #%d, Total= %d\n",i, pAd->MacTab.Size));
break;
}
}
MAC_TABLE_ENTRY *RTMPInsertRepeaterMacEntry(
IN PRTMP_ADAPTER pAd,
IN PUCHAR pAddr,
IN UCHAR apidx,
IN UCHAR cliidx,
IN BOOLEAN CleanAll)
{
UCHAR HashIdx;
int i;
MAC_TABLE_ENTRY *pEntry = NULL, *pCurrEntry;
BOOLEAN Cancelled;
/* if FULL, return*/
if (pAd->MacTab.Size >= MAX_MAC_TABLE_SIZE_WITH_REPEATER)
return NULL;
/* allocate one MAC entry*/
NdisAcquireSpinLock(&pAd->MacTabLock);
i = (MAX_LEN_OF_MAC_TABLE + ((MAX_EXT_MAC_ADDR_SIZE + 1) * (apidx - MIN_NET_DEVICE_FOR_APCLI)));
if (cliidx != 0xFF)
i = i + cliidx + 1;
pEntry = &pAd->MacTab.Content[i];
if (IS_ENTRY_NONE(pEntry))
{
/* ENTRY PREEMPTION: initialize the entry */
if (pEntry->RetryTimer.Valid)
RTMPCancelTimer(&pEntry->RetryTimer, &Cancelled);
if (pEntry->EnqueueStartForPSKTimer.Valid)
RTMPCancelTimer(&pEntry->EnqueueStartForPSKTimer, &Cancelled);
NdisZeroMemory(pEntry, sizeof(MAC_TABLE_ENTRY));
if (CleanAll == TRUE)
{
pEntry->MaxSupportedRate = RATE_11;
pEntry->CurrTxRate = RATE_11;
NdisZeroMemory(pEntry, sizeof(MAC_TABLE_ENTRY));
pEntry->PairwiseKey.KeyLen = 0;
pEntry->PairwiseKey.CipherAlg = CIPHER_NONE;
}
SET_ENTRY_APCLI(pEntry);
pEntry->isCached = FALSE;
pEntry->bIAmBadAtheros = FALSE;
RTMPInitTimer(pAd, &pEntry->EnqueueStartForPSKTimer, GET_TIMER_FUNCTION(EnqueueStartForPSKExec), pEntry, FALSE);
RTMPInitTimer(pAd, &pEntry->RetryTimer, GET_TIMER_FUNCTION(WPARetryExec), pEntry, FALSE);
pEntry->pAd = pAd;
pEntry->CMTimerRunning = FALSE;
pEntry->EnqueueEapolStartTimerRunning = EAPOL_START_DISABLE;
pEntry->RSNIE_Len = 0;
NdisZeroMemory(pEntry->R_Counter, sizeof(pEntry->R_Counter));
pEntry->ReTryCounter = PEER_MSG1_RETRY_TIMER_CTR;
pEntry->apidx = (apidx - MIN_NET_DEVICE_FOR_APCLI);
pEntry->pMbss = NULL;
pEntry->AuthMode = pAd->ApCfg.ApCliTab[pEntry->apidx].AuthMode;
pEntry->WepStatus = pAd->ApCfg.ApCliTab[pEntry->apidx].WepStatus;
pEntry->MatchAPCLITabIdx = pEntry->apidx;
if (pEntry->AuthMode < Ndis802_11AuthModeWPA)
{
pEntry->WpaState = AS_NOTUSE;
pEntry->PrivacyFilter = Ndis802_11PrivFilterAcceptAll;
}
else
{
pEntry->WpaState = AS_PTKSTART;
pEntry->PrivacyFilter = Ndis802_11PrivFilter8021xWEP;
}
pEntry->GTKState = REKEY_NEGOTIATING;
pEntry->PairwiseKey.KeyLen = 0;
pEntry->PairwiseKey.CipherAlg = CIPHER_NONE;
pEntry->PortSecured = WPA_802_1X_PORT_NOT_SECURED;
pEntry->PMKID_CacheIdx = ENTRY_NOT_FOUND;
COPY_MAC_ADDR(pEntry->Addr, pAddr);
COPY_MAC_ADDR(pEntry->HdrAddr1, pAddr);
COPY_MAC_ADDR(pEntry->HdrAddr2, pAd->ApCfg.ApCliTab[pEntry->apidx].CurrentAddress);
COPY_MAC_ADDR(pEntry->HdrAddr3, pAddr);
pEntry->Sst = SST_NOT_AUTH;
pEntry->AuthState = AS_NOT_AUTH;
pEntry->Aid = (USHORT)i; /*0;*/
pEntry->CapabilityInfo = 0;
pEntry->PsMode = PWR_ACTIVE;
pEntry->PsQIdleCount = 0;
pEntry->NoDataIdleCount = 0;
pEntry->AssocDeadLine = MAC_TABLE_ASSOC_TIMEOUT;
pEntry->ContinueTxFailCnt = 0;
pEntry->TimeStamp_toTxRing = 0;
InitializeQueueHeader(&pEntry->PsQueue);
pAd->MacTab.Size ++;
/* Set the security mode of this entry as OPEN-NONE in ASIC */
RTMP_REMOVE_PAIRWISE_KEY_ENTRY(pAd, (UCHAR)i);
/* Add this entry into ASIC RX WCID search table */
RTMP_STA_ENTRY_ADD(pAd, pEntry);
#ifdef WSC_AP_SUPPORT
pEntry->bWscCapable = FALSE;
pEntry->Receive_EapolStart_EapRspId = 0;
#endif /* WSC_AP_SUPPORT */
DBGPRINT(RT_DEBUG_TRACE, ("MacTableInsertEntry - allocate entry #%d, Aid = %d, Total= %d\n",i, pEntry->Aid, pAd->MacTab.Size));
}
else
{
DBGPRINT(RT_DEBUG_ERROR, ("%s - exist entry #%d, Aid = %d, Total= %d\n", __FUNCTION__, i, pEntry->Aid, pAd->MacTab.Size));
NdisReleaseSpinLock(&pAd->MacTabLock);
return pEntry;
}
/* add this MAC entry into HASH table */
if (pEntry)
{
HashIdx = MAC_ADDR_HASH_INDEX(pAddr);
if (pAd->MacTab.Hash[HashIdx] == NULL)
{
pAd->MacTab.Hash[HashIdx] = pEntry;
}
else
{
pCurrEntry = pAd->MacTab.Hash[HashIdx];
while (pCurrEntry->pNext != NULL)
pCurrEntry = pCurrEntry->pNext;
pCurrEntry->pNext = pEntry;
}
}
NdisReleaseSpinLock(&pAd->MacTabLock);
return pEntry;
}
