mirror of
https://github.com/YikeStone/MT7601u.git
synced 2025-08-02 19:04:09 +05:30
133 lines
3.3 KiB
C
133 lines
3.3 KiB
C
#ifdef BLOCK_NET_IF
|
|
|
|
#include "rt_config.h"
|
|
#include "netif_block.h"
|
|
|
|
static NETIF_ENTRY freeNetIfEntryPool[FREE_NETIF_POOL_SIZE];
|
|
static LIST_HEADER freeNetIfEntryList;
|
|
|
|
void initblockQueueTab(
|
|
IN PRTMP_ADAPTER pAd)
|
|
{
|
|
int i;
|
|
|
|
initList(&freeNetIfEntryList);
|
|
for (i = 0; i < FREE_NETIF_POOL_SIZE; i++)
|
|
insertTailList(&freeNetIfEntryList, (PLIST_ENTRY)&freeNetIfEntryPool[i]);
|
|
|
|
for (i=0; i < NUM_OF_TX_RING; i++)
|
|
initList(&pAd->blockQueueTab[i].NetIfList);
|
|
|
|
return;
|
|
}
|
|
|
|
BOOLEAN blockNetIf(
|
|
IN PBLOCK_QUEUE_ENTRY pBlockQueueEntry,
|
|
IN PNET_DEV pNetDev)
|
|
{
|
|
PNETIF_ENTRY pNetIfEntry = NULL;
|
|
|
|
if ((pNetIfEntry = (PNETIF_ENTRY)removeHeadList(&freeNetIfEntryList)) != NULL)
|
|
{
|
|
RTMP_OS_NETDEV_STOP_QUEUE(pNetDev);
|
|
pNetIfEntry->pNetDev = pNetDev;
|
|
insertTailList(&pBlockQueueEntry->NetIfList, (PLIST_ENTRY)pNetIfEntry);
|
|
|
|
pBlockQueueEntry->SwTxQueueBlockFlag = TRUE;
|
|
DBGPRINT(RT_DEBUG_TRACE, ("RTMP_OS_NETDEV_STOP_QUEUE(%s)\n", RTMP_OS_NETDEV_GET_DEVNAME(pNetDev)));
|
|
}
|
|
else
|
|
return FALSE;
|
|
|
|
return TRUE;
|
|
}
|
|
|
|
VOID releaseNetIf(
|
|
IN PBLOCK_QUEUE_ENTRY pBlockQueueEntry)
|
|
{
|
|
PNETIF_ENTRY pNetIfEntry = NULL;
|
|
PLIST_HEADER pNetIfList = &pBlockQueueEntry->NetIfList;
|
|
|
|
while((pNetIfEntry = (PNETIF_ENTRY)removeHeadList(pNetIfList)) != NULL)
|
|
{
|
|
PNET_DEV pNetDev = pNetIfEntry->pNetDev;
|
|
RTMP_OS_NETDEV_WAKE_QUEUE(pNetDev);
|
|
insertTailList(&freeNetIfEntryList, (PLIST_ENTRY)pNetIfEntry);
|
|
|
|
DBGPRINT(RT_DEBUG_TRACE, ("RTMP_OS_NETDEV_WAKE_QUEUE(%s)\n", RTMP_OS_NETDEV_GET_DEVNAME(pNetDev)));
|
|
}
|
|
pBlockQueueEntry->SwTxQueueBlockFlag = FALSE;
|
|
return;
|
|
}
|
|
|
|
|
|
VOID StopNetIfQueue(
|
|
IN PRTMP_ADAPTER pAd,
|
|
IN UCHAR QueIdx,
|
|
IN PNDIS_PACKET pPacket)
|
|
{
|
|
PNET_DEV NetDev = NULL;
|
|
UCHAR IfIdx = 0;
|
|
BOOLEAN valid = FALSE;
|
|
|
|
|
|
#ifdef P2P_SUPPORT
|
|
if (RTMP_GET_PACKET_NET_DEVICE(pPacket) >= MIN_NET_DEVICE_FOR_P2P_GO)
|
|
{
|
|
IfIdx = (RTMP_GET_PACKET_NET_DEVICE(pPacket) - MIN_NET_DEVICE_FOR_P2P_GO) % MAX_P2P_NUM;
|
|
NetDev = pAd->ApCfg.MBSSID[IfIdx].MSSIDDev;
|
|
}
|
|
else
|
|
#endif /* P2P_SUPPORT */
|
|
#ifdef APCLI_SUPPORT
|
|
if (RTMP_GET_PACKET_NET_DEVICE(pPacket) >= MIN_NET_DEVICE_FOR_APCLI)
|
|
{
|
|
IfIdx = (RTMP_GET_PACKET_NET_DEVICE(pPacket) - MIN_NET_DEVICE_FOR_APCLI) % MAX_APCLI_NUM;
|
|
NetDev = pAd->ApCfg.ApCliTab[IfIdx].dev;
|
|
}
|
|
else
|
|
#endif /* APCLI_SUPPORT */
|
|
{
|
|
#ifdef MBSS_SUPPORT
|
|
if (pAd->OpMode == OPMODE_AP)
|
|
{
|
|
IfIdx = (RTMP_GET_PACKET_NET_DEVICE(pPacket) - MIN_NET_DEVICE_FOR_MBSSID) % MAX_MBSSID_NUM(pAd);
|
|
NetDev = pAd->ApCfg.MBSSID[IfIdx].MSSIDDev;
|
|
}
|
|
else
|
|
{
|
|
IfIdx = MAIN_MBSSID;
|
|
NetDev = pAd->net_dev;
|
|
}
|
|
#else
|
|
IfIdx = MAIN_MBSSID;
|
|
NetDev = pAd->net_dev;
|
|
#endif
|
|
}
|
|
|
|
/* WMM support 4 software queues.*/
|
|
/* One software queue full doesn't mean device have no capbility to transmit packet.*/
|
|
/* So disable block Net-If queue function while WMM enable.*/
|
|
#ifdef CONFIG_AP_SUPPORT
|
|
IF_DEV_CONFIG_OPMODE_ON_AP(pAd)
|
|
valid = (pAd->ApCfg.MBSSID[IfIdx].bWmmCapable == TRUE) ? FALSE : TRUE;
|
|
#endif /* CONFIG_AP_SUPPORT */
|
|
#ifdef CONFIG_STA_SUPPORT
|
|
{
|
|
#ifdef P2P_SUPPORT
|
|
if (RTMP_GET_PACKET_NET_DEVICE(pPacket) >= MIN_NET_DEVICE_FOR_P2P_GO)
|
|
valid = (pAd->ApCfg.MBSSID[IfIdx].bWmmCapable == TRUE) ? FALSE : TRUE;
|
|
else
|
|
#endif /* P2P_SUPPORT */
|
|
IF_DEV_CONFIG_OPMODE_ON_STA(pAd)
|
|
valid = (pAd->CommonCfg.bWmmCapable == TRUE) ? FALSE : TRUE;
|
|
}
|
|
#endif /* CONFIG_STA_SUPPORT */
|
|
|
|
if (valid)
|
|
blockNetIf(&pAd->blockQueueTab[QueIdx], NetDev);
|
|
return;
|
|
}
|
|
|
|
#endif /* BLOCK_NET_IF */
|