/*
========================================================================
Routine Description:
This routine is used to do insert packet into power-saveing queue.
Arguments:
pAd: Pointer to our adapter
pPacket: Pointer to send packet
pMacEntry: portint to entry of MacTab. the pMacEntry store attribute of client (STA).
QueIdx: Priority queue idex.
Return Value:
NDIS_STATUS_SUCCESS:If succes to queue the packet into TxSwQueue.
NDIS_STATUS_FAILURE: If failed to do en-queue.
========================================================================
*/
NDIS_STATUS RtmpInsertPsQueue(
IN PRTMP_ADAPTER pAd,
IN PNDIS_PACKET pPacket,
IN MAC_TABLE_ENTRY *pMacEntry,
IN UCHAR QueIdx)
{
ULONG IrqFlags;
#ifdef UAPSD_SUPPORT
/* put the U-APSD packet to its U-APSD queue by AC ID */
UINT32 ac_id = QueIdx - QID_AC_BE; /* should be >= 0 */
if (UAPSD_MR_IS_UAPSD_AC(pMacEntry, ac_id))
{
UAPSD_PacketEnqueue(pAd, pMacEntry, pPacket, ac_id);
#ifdef DOT11Z_TDLS_SUPPORT
TDLS_UAPSDP_TrafficIndSend(pAd, pMacEntry->Addr);
#endif /* DOT11Z_TDLS_SUPPORT */
}
else
#endif /* UAPSD_SUPPORT */
{
if (pMacEntry->PsQueue.Number >= MAX_PACKETS_IN_PS_QUEUE)
{
RELEASE_NDIS_PACKET(pAd, pPacket, NDIS_STATUS_FAILURE);
return NDIS_STATUS_FAILURE;
}
else
{
DBGPRINT(RT_DEBUG_TRACE, ("legacy ps> queue a packet!\n"));
RTMP_IRQ_LOCK(&pAd->irq_lock, IrqFlags);
InsertTailQueue(&pMacEntry->PsQueue, PACKET_TO_QUEUE_ENTRY(pPacket));
RTMP_IRQ_UNLOCK(&pAd->irq_lock, IrqFlags);
}
}
#ifdef CONFIG_AP_SUPPORT
/* mark corresponding TIM bit in outgoing BEACON frame */
#ifdef UAPSD_SUPPORT
if (UAPSD_MR_IS_NOT_TIM_BIT_NEEDED_HANDLED(pMacEntry, QueIdx))
{
/* 1. the station is UAPSD station;
2. one of AC is non-UAPSD (legacy) AC;
3. the destinated AC of the packet is UAPSD AC. */
/* So we can not set TIM bit due to one of AC is legacy AC */
}
else
#endif /* UAPSD_SUPPORT */
{
WLAN_MR_TIM_BIT_SET(pAd, pMacEntry->apidx, pMacEntry->Aid);
}
#endif /* CONFIG_AP_SUPPORT */
return NDIS_STATUS_SUCCESS;
}
/*
========================================================================
Description:
This routine frees all packets in PSQ that's destined to a specific DA.
BCAST/MCAST in DTIMCount=0 case is also handled here, just like a PS-POLL
is received from a WSTA which has MAC address FF:FF:FF:FF:FF:FF
========================================================================
*/
VOID MtHandleRxPsPoll(RTMP_ADAPTER *pAd, UCHAR *pAddr, USHORT wcid, BOOLEAN isActive)
{
#ifdef CONFIG_AP_SUPPORT
#if defined(MT_PS) || defined(UAPSD_SUPPORT)
MAC_TABLE_ENTRY *pMacEntry;
#endif
STA_TR_ENTRY *tr_entry;
BOOLEAN IsDequeu= FALSE;
INT DequeuAC = QID_AC_BE;
INT DequeuCOUNT;
#ifdef MT_PS
INT i, Total_Packet_Number = 0;
#endif /* MT_PS */
//struct tx_swq_fifo *fifo_swq;
ASSERT(wcid < MAX_LEN_OF_MAC_TABLE);
#if defined(MT_PS) || defined(UAPSD_SUPPORT)
pMacEntry = &pAd->MacTab.Content[wcid];
#endif
tr_entry = &pAd->MacTab.tr_entry[wcid];
if (isActive == FALSE) /* ps poll */
{
#ifdef MT_PS
if (tr_entry->ps_state == APPS_RETRIEVE_DONE) /*state is finish(sleep)*/
{
if (pMacEntry->i_psm == I_PSM_DISABLE)
{
MT_SET_IGNORE_PSM(pAd, pMacEntry, I_PSM_ENABLE);
}
}
if(tr_entry->ps_state == APPS_RETRIEVE_DONE || tr_entry->ps_state == APPS_RETRIEVE_IDLE)
{
for (i = 0; i < WMM_QUE_NUM; i++)
Total_Packet_Number = Total_Packet_Number + tr_entry->tx_queue[i].Number;
if (Total_Packet_Number > 0)
{
{
DBGPRINT(RT_DEBUG_TRACE | DBG_FUNC_PS, ("RtmpHandleRxPsPoll fetch tx queue tr_entry->ps_queue.Number= %x tr_entry->tx_queue[0].Number=%x Total_Packet_Number=%x\n",
tr_entry->ps_queue.Number, tr_entry->tx_queue[QID_AC_BE].Number, Total_Packet_Number));
for (i = (WMM_QUE_NUM - 1); i >=0; i--)
{
if (tr_entry->tx_queue[i].Head)
{
if (Total_Packet_Number > 1)
{
RTMP_SET_PACKET_MOREDATA(RTPKT_TO_OSPKT(tr_entry->tx_queue[i].Head), TRUE);
}
RTMP_SET_PACKET_TXTYPE(RTPKT_TO_OSPKT(tr_entry->tx_queue[i].Head), TX_LEGACY_FRAME);
DequeuAC = i;
IsDequeu = TRUE;
DequeuCOUNT = 1;
tr_entry->PsQIdleCount = 0;
break;
}
}
}
}
else /* Recieve ps_poll but no packet==>send NULL Packet */
{
BOOLEAN bQosNull = FALSE;
DBGPRINT(RT_DEBUG_INFO | DBG_FUNC_PS, ("RtmpHandleRxPsPoll no packet tr_entry->ps_queue.Number= %x tr_entry->tx_queue[0].Number=%x Total_Packet_Number=%x\n"
,tr_entry->ps_queue.Number, tr_entry->tx_queue[QID_AC_BE].Number, Total_Packet_Number));
if (CLIENT_STATUS_TEST_FLAG(pMacEntry, fCLIENT_STATUS_WMM_CAPABLE))
bQosNull = TRUE;
RtmpEnqueueNullFrame(pAd, pMacEntry->Addr, tr_entry->CurrTxRate,
pMacEntry->Aid, pMacEntry->func_tb_idx,
bQosNull, TRUE, 0);
}
if (Total_Packet_Number >1)
{
WLAN_MR_TIM_BIT_SET(pAd, tr_entry->func_tb_idx, tr_entry->wcid);
}
else
{
WLAN_MR_TIM_BIT_CLEAR(pAd, tr_entry->func_tb_idx, tr_entry->wcid);
}
} else
tr_entry->PsDeQWaitCnt = 0;
#else
/*
Need to check !! @20140212
New architecture has per AC sw-Q for per entry.
We should check packets by ACs priority --> 1. VO, 2. VI, 3. BE, 4. BK
*/
DequeuAC = QID_AC_BE;
IsDequeu = TRUE;
DequeuCOUNT = 1;
tr_entry->PsQIdleCount = 0;
#endif /* Ps_poll and ifndef MT_PS */
}
else /* Receive Power bit 0 frame */
{
WLAN_MR_TIM_BIT_CLEAR(pAd, tr_entry->func_tb_idx, tr_entry->wcid);
#ifdef MT_PS
if (pMacEntry->i_psm == I_PSM_ENABLE)
{
MT_SET_IGNORE_PSM(pAd, pMacEntry, I_PSM_DISABLE);
}
#endif /*Power bit is 1 and ifndef MT_PS */
DBGPRINT(RT_DEBUG_INFO | DBG_FUNC_PS, ("RtmpHandleRxPsPoll null0/1 wcid = %x mt_ps_queue.Number = %d\n",
tr_entry->wcid,
tr_entry->ps_queue.Number));
DBGPRINT(RT_DEBUG_INFO | DBG_FUNC_PS, ("%s(%d) tx_queue.Number = BE:%d, BK:%d, VI:%d, VO:%d, ps_state:%x, tx_queue.TokenCount = BE:%d, BK:%d, VI:%d, VO:%d\n",
__FUNCTION__, __LINE__,
tr_entry->tx_queue[QID_AC_BE].Number,
tr_entry->tx_queue[QID_AC_BK].Number,
tr_entry->tx_queue[QID_AC_VI].Number,
tr_entry->tx_queue[QID_AC_VO].Number,
tr_entry->ps_state,
tr_entry->TokenCount[QID_AC_BE],
tr_entry->TokenCount[QID_AC_BK],
tr_entry->TokenCount[QID_AC_VI],
tr_entry->TokenCount[QID_AC_VO]));
#ifdef UAPSD_SUPPORT
if (CLIENT_STATUS_TEST_FLAG(pMacEntry, fCLIENT_STATUS_APSD_CAPABLE))
{
/* deliver all queued UAPSD packets */
UAPSD_AllPacketDeliver(pAd, pMacEntry);
/* end the SP if exists */
UAPSD_MR_ENTRY_RESET(pAd, pMacEntry);
}
#endif /* UAPSD_SUPPORT */
if (tr_entry->enqCount > 0)
{
IsDequeu = TRUE;
DequeuAC = NUM_OF_TX_RING;
if (tr_entry->enqCount > MAX_TX_PROCESS)
{
DequeuCOUNT = MAX_TX_PROCESS;
rtmp_ps_enq(pAd,tr_entry);
}
else
{
DequeuCOUNT = tr_entry->enqCount;
}
}
}
if (IsDequeu == TRUE)
{
RTMPDeQueuePacket(pAd, FALSE, DequeuAC, tr_entry->wcid, DequeuCOUNT);
DBGPRINT(RT_DEBUG_INFO | DBG_FUNC_PS, ("RtmpHandleRxPsPoll IsDequeu == TRUE tr_entry->wcid=%x DequeuCOUNT=%d, ps_state=%d\n",tr_entry->wcid, DequeuCOUNT, tr_entry->ps_state));
}
return;
#endif /* CONFIG_AP_SUPPORT */
}
NDIS_STATUS IgmpPktClone(
IN PRTMP_ADAPTER pAd,
IN PNDIS_PACKET pPacket,
IN INT IgmpPktInGroup,
IN PMULTICAST_FILTER_TABLE_ENTRY pGroupEntry,
IN UCHAR QueIdx,
IN UINT8 UserPriority,
IN PNET_DEV pNetDev)
{
PNDIS_PACKET pSkbClone = NULL;
PMEMBER_ENTRY pMemberEntry = NULL;
MAC_TABLE_ENTRY *pMacEntry = NULL;
STA_TR_ENTRY *tr_entry = NULL;
USHORT Aid;
SST Sst = SST_ASSOC;
UCHAR PsMode = PWR_ACTIVE;
UCHAR Rate;
#ifndef MT_MAC
unsigned long IrqFlags;
#endif
INT MacEntryIdx;
BOOLEAN bContinue;
PUCHAR pMemberAddr = NULL;
bContinue = FALSE;
if ((IgmpPktInGroup == IGMP_IN_GROUP) && (pGroupEntry == NULL))
return NDIS_STATUS_FAILURE;
if (IgmpPktInGroup == IGMP_IN_GROUP)
{
pMemberEntry = (PMEMBER_ENTRY)pGroupEntry->MemberList.pHead;
if (pMemberEntry)
{
pMemberAddr = pMemberEntry->Addr;
pMacEntry = APSsPsInquiry(pAd, pMemberAddr, &Sst, &Aid, &PsMode, &Rate);
bContinue = TRUE;
}
}
else if (IgmpPktInGroup == IGMP_PKT)
{
PUCHAR src_addr = GET_OS_PKT_DATAPTR(pPacket);
src_addr += 6;
for(MacEntryIdx=1; MacEntryIdx<MAX_NUMBER_OF_MAC; MacEntryIdx++)
{
pMemberAddr = pAd->MacTab.Content[MacEntryIdx].Addr;
pMacEntry = APSsPsInquiry(pAd, pMemberAddr, &Sst, &Aid, &PsMode, &Rate);
// TODO: shiang-usw, check get_netdev_from_bssid() here!!
if (pMacEntry && IS_ENTRY_CLIENT(pMacEntry)
&& get_netdev_from_bssid(pAd, pMacEntry->wdev->wdev_idx) == pNetDev
&& (!NdisEqualMemory(src_addr, pMacEntry->Addr, MAC_ADDR_LEN)))
{
pMemberAddr = pMacEntry->Addr;
bContinue = TRUE;
break;
}
}
}
else
return NDIS_STATUS_FAILURE;
/* check all members of the IGMP group. */
while(bContinue == TRUE)
{
if (pMacEntry && (Sst == SST_ASSOC) &&
(pAd->MacTab.tr_entry[pMacEntry->wcid].PortSecured == WPA_802_1X_PORT_SECURED))
{
OS_PKT_CLONE(pAd, pPacket, pSkbClone, MEM_ALLOC_FLAG);
if ((pSkbClone)
#ifdef DOT11V_WNM_SUPPORT
&& (pMacEntry->Beclone == FALSE)
#endif /* DOT11V_WNM_SUPPORT */
)
{
RTMP_SET_PACKET_WCID(pSkbClone, (UCHAR)pMacEntry->Aid);
//copy APSendPacket() unicast check portion.
#ifdef MT_MAC
if (pAd->chipCap.hif_type == HIF_MT)
{
tr_entry = &pAd->MacTab.tr_entry[pMacEntry->wcid];
if ((tr_entry->EntryType != ENTRY_CAT_MCAST) && (tr_entry->PsMode == PWR_SAVE))
{
if (tr_entry->tx_queue[QID_AC_BE].Number+tr_entry->tx_queue[QID_AC_BK].Number+tr_entry->tx_queue[QID_AC_VI].Number+tr_entry->tx_queue[QID_AC_VO].Number > MAX_PACKETS_IN_PS_QUEUE)
{
DBGPRINT(RT_DEBUG_TRACE, ("%s(%d): (wcid=%u)STA tx_queue full\n", __FUNCTION__, __LINE__,pMacEntry->wcid));
RELEASE_NDIS_PACKET(pAd, pSkbClone, NDIS_STATUS_FAILURE);
return NDIS_STATUS_FAILURE;
}
}
#if defined(RTMP_MAC) || defined(RLT_MAC)
/* detect AC Category of tx packets to tune AC0(BE) TX_OP (MAC reg 0x1300) */
// TODO: shiang-usw, check this for REG access, it should not be here!
if ((pAd->chipCap.hif_type == HIF_RTMP) || (pAd->chipCap.hif_type == HIF_RLT))
detect_wmm_traffic(pAd, UserPriority, 1);
#endif /* defined(RTMP_MAC) || defined(RLT_MAC) */
RTMP_SET_PACKET_UP(pSkbClone, UserPriority);
if (rtmp_enq_req(pAd, pSkbClone, QueIdx, tr_entry, FALSE, NULL) == FALSE)
{
DBGPRINT(RT_DEBUG_TRACE, ("%s(%d): (wcid=%u)STA rtmp_enq_req() fail!\n", __FUNCTION__, __LINE__,pMacEntry->wcid));
RELEASE_NDIS_PACKET(pAd, pSkbClone, NDIS_STATUS_FAILURE);
return NDIS_STATUS_FAILURE;
}
if (tr_entry->EntryType == ENTRY_CAT_MCAST) //should not be here!!
{
DBGPRINT(RT_DEBUG_TRACE, ("%s(%d): (wcid=%u) ENTRY_CAT_MCAST !! ERROR check should not be here!\n", __FUNCTION__, __LINE__,pMacEntry->wcid));
if (pAd->MacTab.fAnyStationInPsm == 1)
WLAN_MR_TIM_BCMC_SET(tr_entry->func_tb_idx); /* mark MCAST/BCAST TIM bit */
}
else
{
if (IS_ENTRY_CLIENT(tr_entry) && (tr_entry->PsMode == PWR_SAVE))
{
/* mark corresponding TIM bit in outgoing BEACON frame */
#ifdef UAPSD_SUPPORT
if (UAPSD_MR_IS_NOT_TIM_BIT_NEEDED_HANDLED(&pAd->MacTab.Content[tr_entry->wcid], QueIdx))
{
/*
1. the station is UAPSD station;
2. one of AC is non-UAPSD (legacy) AC;
3. the destinated AC of the packet is UAPSD AC.
*/
/* So we can not set TIM bit due to one of AC is legacy AC */
}
else
#endif /* UAPSD_SUPPORT */
{
WLAN_MR_TIM_BIT_SET(pAd, tr_entry->func_tb_idx, tr_entry->wcid);
}
}
}
}
#endif /* MT_MAC */
}
else
{
if (IgmpPktInGroup == IGMP_IN_GROUP)
{
pMemberEntry = pMemberEntry->pNext;
if (pMemberEntry != NULL)
{
pMemberAddr = pMemberEntry->Addr;
pMacEntry = APSsPsInquiry(pAd, pMemberAddr, &Sst, &Aid, &PsMode, &Rate);
bContinue = TRUE;
}
else
bContinue = FALSE;
}
else if (IgmpPktInGroup == IGMP_PKT)
{
PUCHAR src_addr = GET_OS_PKT_DATAPTR(pPacket);
src_addr += 6;
for(MacEntryIdx=pMacEntry->Aid + 1; MacEntryIdx<MAX_NUMBER_OF_MAC; MacEntryIdx++)
{
pMemberAddr = pAd->MacTab.Content[MacEntryIdx].Addr;
pMacEntry = APSsPsInquiry(pAd, pMemberAddr, &Sst, &Aid, &PsMode, &Rate);
if (pMacEntry && IS_ENTRY_CLIENT(pMacEntry)
&& get_netdev_from_bssid(pAd, pMacEntry->wdev->wdev_idx) == pNetDev
&& (!NdisEqualMemory(src_addr, pMacEntry->Addr, MAC_ADDR_LEN)))
{
pMemberAddr = pMacEntry->Addr;
bContinue = TRUE;
break;
}
}
if (MacEntryIdx == MAX_NUMBER_OF_MAC)
bContinue = FALSE;
}
else
bContinue = FALSE;
#ifdef DOT11V_WNM_SUPPORT
pMacEntry->Beclone = FALSE;
#endif /* DOT11V_WNM_SUPPORT */
continue;
}
#ifndef MT_MAC
/*did't queue to AC queue for MT_MAC */
if (PsMode == PWR_SAVE)
{
APInsertPsQueue(pAd, pSkbClone, pMacEntry, QueIdx);
}
else
{
if (pAd->TxSwQueue[QueIdx].Number >= pAd->TxSwQMaxLen)
{
#ifdef BLOCK_NET_IF
StopNetIfQueue(pAd, QueIdx, pSkbClone);
#endif /* BLOCK_NET_IF */
RELEASE_NDIS_PACKET(pAd, pSkbClone, NDIS_STATUS_FAILURE);
return NDIS_STATUS_FAILURE;
}
else
{
RTMP_IRQ_LOCK(&pAd->irq_lock, IrqFlags);
InsertTailQueueAc(pAd, pMacEntry, &pAd->TxSwQueue[QueIdx], PACKET_TO_QUEUE_ENTRY(pSkbClone));
RTMP_IRQ_UNLOCK(&pAd->irq_lock, IrqFlags);
}
}
#endif /* !MT_MAC */
#ifdef DOT11_N_SUPPORT
RTMP_BASetup(pAd, tr_entry, UserPriority);
#endif /* DOT11_N_SUPPORT */
}
if (IgmpPktInGroup == IGMP_IN_GROUP)
{
pMemberEntry = pMemberEntry->pNext;
if (pMemberEntry != NULL)
{
pMemberAddr = pMemberEntry->Addr;
pMacEntry = APSsPsInquiry(pAd, pMemberAddr, &Sst, &Aid, &PsMode, &Rate);
bContinue = TRUE;
}
else
bContinue = FALSE;
}
else if (IgmpPktInGroup == IGMP_PKT)
{
for(MacEntryIdx=pMacEntry->Aid + 1; MacEntryIdx<MAX_NUMBER_OF_MAC; MacEntryIdx++)
{
pMemberAddr = pAd->MacTab.Content[MacEntryIdx].Addr;
pMacEntry = APSsPsInquiry(pAd, pMemberAddr, &Sst, &Aid, &PsMode, &Rate);
// TODO: shiang-usw, check for pMacEntry->wdev->wdev_idx here!
if (pMacEntry && IS_ENTRY_CLIENT(pMacEntry)
&& get_netdev_from_bssid(pAd, pMacEntry->wdev->wdev_idx) == pNetDev)
{
pMemberAddr = pMacEntry->Addr;
bContinue = TRUE;
break;
}
}
if (MacEntryIdx == MAX_NUMBER_OF_MAC)
bContinue = FALSE;
}
else
bContinue = FALSE;
}
return NDIS_STATUS_SUCCESS;
}
