/*
========================================================================
Routine Description:
Remove Multi-BSS network interface.
Arguments:
pAd points to our adapter
Return Value:
None
Note:
FIRST_MBSSID = 1
Main BSS is not removed here.
========================================================================
*/
VOID MBSS_Remove(RTMP_ADAPTER *pAd)
{
struct wifi_dev *wdev;
UINT IdBss;
for(IdBss=FIRST_MBSSID; IdBss<MAX_MBSSID_NUM(pAd); IdBss++)
{
wdev = &pAd->ApCfg.MBSSID[IdBss].wdev;
if (wdev->if_dev)
{
RtmpOSNetDevProtect(1);
RtmpOSNetDevDetach(wdev->if_dev);
RtmpOSNetDevProtect(0);
rtmp_wdev_idx_unreg(pAd, wdev);
RtmpOSNetDevFree(wdev->if_dev);
wdev->if_dev = NULL;
}
}
}
/*
========================================================================
Routine Description:
Remove Multi-BSS network interface.
Arguments:
pAd points to our adapter
Return Value:
None
Note:
FIRST_MBSSID = 1
Main BSS is not removed here.
========================================================================
*/
VOID MBSS_Remove(RTMP_ADAPTER *pAd)
{
struct wifi_dev *wdev;
UINT IdBss;
#ifdef RELEASE_EXCLUDE
DBGPRINT(RT_DEBUG_INFO, ("%s --->\n", __FUNCTION__));
#endif /* RELEASE_EXCLUDE */
for(IdBss=FIRST_MBSSID; IdBss<MAX_MBSSID_NUM(pAd); IdBss++)
{
wdev = &pAd->ApCfg.MBSSID[IdBss].wdev;
if (wdev->if_dev)
{
RtmpOSNetDevDetach(wdev->if_dev);
rtmp_wdev_idx_unreg(pAd, wdev);
RtmpOSNetDevFree(wdev->if_dev);
wdev->if_dev = NULL;
}
}
}
/*
========================================================================
Routine Description:
Remove Multi-BSS network interface.
Arguments:
pAd points to our adapter
Return Value:
None
Note:
FIRST_MBSSID = 1
Main BSS is not removed here.
========================================================================
*/
VOID MBSS_Remove(
IN PRTMP_ADAPTER pAd)
{
MULTISSID_STRUCT *pMbss;
UINT IdBss;
for(IdBss=FIRST_MBSSID; IdBss<MAX_MBSSID_NUM(pAd); IdBss++)
{
pMbss = &pAd->ApCfg.MBSSID[IdBss];
if (pMbss->MSSIDDev)
{
RtmpOSNetDevDetach(pMbss->MSSIDDev);
RtmpOSNetDevFree(pMbss->MSSIDDev);
/* clear it as NULL to prevent latter access error */
pMbss->MSSIDDev = NULL;
}
}
} /* End of RT28xx_MBSS_Remove */
VOID RRM_CfgInit(
IN PRTMP_ADAPTER pAd)
{
INT loop;
PRRM_CONFIG pRrmCfg;
for (loop = 0; loop < MAX_MBSSID_NUM(pAd); loop++)
{
pRrmCfg = &pAd->ApCfg.MBSSID[loop].RrmCfg;
pRrmCfg->QuietCB.QuietPeriod = RRM_DEFAULT_QUIET_PERIOD;
pRrmCfg->QuietCB.QuietDuration = RRM_DEFAULT_QUIET_DURATION;
pRrmCfg->QuietCB.QuietOffset = RRM_DEFAULT_QUIET_OFFSET;
RTMPInitTimer(pAd, &pRrmCfg->QuietCB.QuietOffsetTimer, GET_TIMER_FUNCTION(RRM_QuietOffsetTimeout), pAd, FALSE);
RTMPInitTimer(pAd, &pRrmCfg->QuietCB.QuietTimer, GET_TIMER_FUNCTION(RRM_QuietTimeout), pAd, FALSE);
pRrmCfg->QuietCB.QuietState = RRM_QUIET_IDLE;
pRrmCfg->QuietCB.CurAid = 1;
pRrmCfg->bDot11kRRMEnable = TRUE;
pRrmCfg->bDot11kRRMNeighborRepTSFEnable = FALSE;
}
return;
}
VOID RTMPMaintainPMKIDCache(
IN struct rtmp_adapter * pAd)
{
INT i, j;
ULONG Now;
for (i = 0; i < MAX_MBSSID_NUM(pAd); i++)
{
PMULTISSID_STRUCT pMbss = &pAd->ApCfg.MBSSID[i];
for (j = 0; j < MAX_PMKID_COUNT; j++)
{
PAP_BSSID_INFO pBssInfo = &pMbss->PMKIDCache.BSSIDInfo[j];
NdisGetSystemUpTime(&Now);
if ((pBssInfo->Valid)
&& /*((Now - pBssInfo->RefreshTime) >= pMbss->PMKCachePeriod)*/
(RTMP_TIME_AFTER(Now, (pBssInfo->RefreshTime + pMbss->PMKCachePeriod))))
{
RTMPDeletePMKIDCache(pAd, i, j);
}
}
}
}
/*
========================================================================
Routine Description:
Caller ensures we has 802.11n support.
Calls at setting HT from AP/STASetinformation
Arguments:
pAd - Pointer to our adapter
phymode -
========================================================================
*/
VOID RTMPSetIndividualHT(
IN RTMP_ADAPTER *pAd,
IN UCHAR apidx)
{
RT_PHY_INFO *pDesired_ht_phy = NULL;
UCHAR TxStream = pAd->CommonCfg.TxStream;
UCHAR DesiredMcs = MCS_AUTO;
UCHAR encrypt_mode = Ndis802_11EncryptionDisabled;
do
{
#ifdef CONFIG_AP_SUPPORT
#ifdef APCLI_SUPPORT
if (apidx >= MIN_NET_DEVICE_FOR_APCLI)
{
UCHAR idx = apidx - MIN_NET_DEVICE_FOR_APCLI;
if (idx < MAX_APCLI_NUM)
{
pDesired_ht_phy = &pAd->ApCfg.ApCliTab[idx].DesiredHtPhyInfo;
DesiredMcs = pAd->ApCfg.ApCliTab[idx].DesiredTransmitSetting.field.MCS;
encrypt_mode = pAd->ApCfg.ApCliTab[idx].WepStatus;
pAd->ApCfg.ApCliTab[idx].bAutoTxRateSwitch = (DesiredMcs == MCS_AUTO) ? TRUE : FALSE;
break;
}
else
{
DBGPRINT(RT_DEBUG_ERROR, ("RTMPSetIndividualHT: invalid idx(%d)\n", idx));
return;
}
}
#endif /* APCLI_SUPPORT */
IF_DEV_CONFIG_OPMODE_ON_AP(pAd)
{
#ifdef WDS_SUPPORT
if (apidx >= MIN_NET_DEVICE_FOR_WDS)
{
UCHAR idx = apidx - MIN_NET_DEVICE_FOR_WDS;
if (idx < MAX_WDS_ENTRY)
{
pDesired_ht_phy = &pAd->WdsTab.WdsEntry[idx].DesiredHtPhyInfo;
DesiredMcs = pAd->WdsTab.WdsEntry[idx].DesiredTransmitSetting.field.MCS;
/*encrypt_mode = pAd->WdsTab.WdsEntry[idx].WepStatus;*/
pAd->WdsTab.WdsEntry[idx].bAutoTxRateSwitch = (DesiredMcs == MCS_AUTO) ? TRUE : FALSE;
break;
}
else
{
DBGPRINT(RT_DEBUG_ERROR, ("RTMPSetIndividualHT: invalid apidx(%d)\n", apidx));
return;
}
}
#endif /* WDS_SUPPORT */
if ((apidx < pAd->ApCfg.BssidNum) && (apidx < MAX_MBSSID_NUM(pAd)) && (apidx < HW_BEACON_MAX_NUM))
{
pDesired_ht_phy = &pAd->ApCfg.MBSSID[apidx].DesiredHtPhyInfo;
DesiredMcs = pAd->ApCfg.MBSSID[apidx].DesiredTransmitSetting.field.MCS;
encrypt_mode = pAd->ApCfg.MBSSID[apidx].WepStatus;
pAd->ApCfg.MBSSID[apidx].bWmmCapable = TRUE;
pAd->ApCfg.MBSSID[apidx].bAutoTxRateSwitch = (DesiredMcs == MCS_AUTO) ? TRUE : FALSE;
break;
}
DBGPRINT(RT_DEBUG_ERROR, ("RTMPSetIndividualHT: invalid apidx(%d)\n", apidx));
return;
}
#endif /* CONFIG_AP_SUPPORT */
} while (FALSE);
if (pDesired_ht_phy == NULL)
{
DBGPRINT(RT_DEBUG_ERROR, ("RTMPSetIndividualHT: invalid apidx(%d)\n", apidx));
return;
}
RTMPZeroMemory(pDesired_ht_phy, sizeof(RT_PHY_INFO));
DBGPRINT(RT_DEBUG_TRACE, ("RTMPSetIndividualHT : Desired MCS = %d\n", DesiredMcs));
/* Check the validity of MCS */
if ((TxStream == 1) && ((DesiredMcs >= MCS_8) && (DesiredMcs <= MCS_15)))
{
DBGPRINT(RT_DEBUG_WARN, ("RTMPSetIndividualHT: MCS(%d) is invalid in 1S, reset it as MCS_7\n", DesiredMcs));
DesiredMcs = MCS_7;
}
if ((pAd->CommonCfg.DesiredHtPhy.ChannelWidth == BW_20) && (DesiredMcs == MCS_32))
{
DBGPRINT(RT_DEBUG_WARN, ("RTMPSetIndividualHT: MCS_32 is only supported in 40-MHz, reset it as MCS_0\n"));
DesiredMcs = MCS_0;
}
/*
WFA recommend to restrict the encryption type in 11n-HT mode.
So, the WEP and TKIP are not allowed in HT rate.
*/
if (pAd->CommonCfg.HT_DisallowTKIP && IS_INVALID_HT_SECURITY(encrypt_mode))
{
DBGPRINT(RT_DEBUG_WARN, ("%s : Use legacy rate in WEP/TKIP encryption mode (apidx=%d)\n",
__FUNCTION__, apidx));
return;
}
if (pAd->CommonCfg.HT_Disable)
{
DBGPRINT(RT_DEBUG_TRACE, ("%s : HT is disabled\n", __FUNCTION__));
return;
}
pDesired_ht_phy->bHtEnable = TRUE;
/* Decide desired Tx MCS*/
switch (TxStream)
{
case 1:
if (DesiredMcs == MCS_AUTO)
pDesired_ht_phy->MCSSet[0]= 0xff;
else if (DesiredMcs <= MCS_7)
pDesired_ht_phy->MCSSet[0]= 1<<DesiredMcs;
break;
case 2:
if (DesiredMcs == MCS_AUTO)
{
pDesired_ht_phy->MCSSet[0]= 0xff;
pDesired_ht_phy->MCSSet[1]= 0xff;
}
else if (DesiredMcs <= MCS_15)
{
ULONG mode;
mode = DesiredMcs / 8;
if (mode < 2)
pDesired_ht_phy->MCSSet[mode] = (1 << (DesiredMcs - mode * 8));
}
break;
case 3:
if (DesiredMcs == MCS_AUTO)
{
/* MCS0 ~ MCS23, 3 bytes */
pDesired_ht_phy->MCSSet[0]= 0xff;
pDesired_ht_phy->MCSSet[1]= 0xff;
pDesired_ht_phy->MCSSet[2]= 0xff;
}
else if (DesiredMcs <= MCS_23)
{
ULONG mode;
mode = DesiredMcs / 8;
if (mode < 3)
pDesired_ht_phy->MCSSet[mode] = (1 << (DesiredMcs - mode * 8));
}
break;
}
if(pAd->CommonCfg.DesiredHtPhy.ChannelWidth == BW_40)
{
if (DesiredMcs == MCS_AUTO || DesiredMcs == MCS_32)
pDesired_ht_phy->MCSSet[4] = 0x1;
}
/* update HT Rate setting */
if (pAd->OpMode == OPMODE_STA)
{
MlmeUpdateHtTxRates(pAd, BSS0);
}
else
MlmeUpdateHtTxRates(pAd, apidx);
#ifdef DOT11_VHT_AC
if (WMODE_CAP_AC(pAd->CommonCfg.PhyMode)) {
pDesired_ht_phy->bVhtEnable = TRUE;
rtmp_set_vht(pAd, pDesired_ht_phy);
}
#endif /* DOT11_VHT_AC */
}
VOID MBSS_Init(
IN PRTMP_ADAPTER pAd,
IN RTMP_OS_NETDEV_OP_HOOK *pNetDevOps)
{
#define MBSS_MAX_DEV_NUM 32
PNET_DEV pDevNew;
INT32 IdBss, MaxNumBss;
int status;
RTMP_OS_NETDEV_OP_HOOK netDevHook;
/* sanity check to avoid redundant virtual interfaces are created */
if (pAd->FlgMbssInit != FALSE)
return;
/* init */
MaxNumBss = pAd->ApCfg.BssidNum;
if (MaxNumBss > MAX_MBSSID_NUM(pAd))
MaxNumBss = MAX_MBSSID_NUM(pAd);
/* first IdBss must not be 0 (BSS0), must be 1 (BSS1) */
for(IdBss=FIRST_MBSSID; IdBss<MAX_MBSSID_NUM(pAd); IdBss++)
pAd->ApCfg.MBSSID[IdBss].MSSIDDev = NULL;
/* create virtual network interface */
for(IdBss=FIRST_MBSSID; IdBss<MaxNumBss; IdBss++)
{
UINT32 MC_RowID = 0, IoctlIF = 0;
#ifdef MULTIPLE_CARD_SUPPORT
MC_RowID = pAd->MC_RowID;
#endif /* MULTIPLE_CARD_SUPPORT */
#ifdef HOSTAPD_SUPPORT
IoctlIF = pAd->IoctlIF;
#endif /* HOSTAPD_SUPPORT */
pDevNew = RtmpOSNetDevCreate(MC_RowID, &IoctlIF, INT_MBSSID, IdBss, sizeof(PRTMP_ADAPTER), INF_MBSSID_DEV_NAME);
#ifdef HOSTAPD_SUPPORT
pAd->IoctlIF = IoctlIF;
#endif /* HOSTAPD_SUPPORT */
if (pDevNew == NULL)
{
/* allocation fail, exit */
pAd->ApCfg.BssidNum = IdBss; /* re-assign new MBSS number */
DBGPRINT(RT_DEBUG_ERROR,
("Allocate network device fail (MBSS)...\n"));
break;
}
else
{
DBGPRINT(RT_DEBUG_TRACE, ("Register MBSSID IF (%s)\n", RTMP_OS_NETDEV_GET_DEVNAME(pDevNew)));
}
RTMP_OS_NETDEV_SET_PRIV(pDevNew, pAd);
/* init operation functions and flags */
NdisCopyMemory(&netDevHook, pNetDevOps, sizeof(netDevHook));
netDevHook.priv_flags = INT_MBSSID; /* We are virtual interface */
netDevHook.needProtcted = TRUE;
/* Init MAC address of virtual network interface */
NdisMoveMemory(&netDevHook.devAddr[0], &pAd->ApCfg.MBSSID[IdBss].Bssid[0], MAC_ADDR_LEN);
/* backup our virtual network interface */
pAd->ApCfg.MBSSID[IdBss].MSSIDDev = pDevNew;
/* register this device to OS */
status = RtmpOSNetDevAttach(pAd->OpMode, pDevNew, &netDevHook);
}
pAd->FlgMbssInit = TRUE;
}
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;
}
VOID RTMPGetTxTscFromAsic(
IN PRTMP_ADAPTER pAd,
IN UCHAR apidx,
OUT PUCHAR pTxTsc)
{
USHORT Wcid;
USHORT offset;
UCHAR IvEiv[8];
int i;
/* Sanity check of apidx */
if (apidx >= MAX_MBSSID_NUM(pAd))
{
DBGPRINT(RT_DEBUG_ERROR, ("RTMPGetTxTscFromAsic : invalid apidx(%d)\n", apidx));
return;
}
/* Initial value */
NdisZeroMemory(IvEiv, 8);
NdisZeroMemory(pTxTsc, 6);
/* Get apidx for this BSSID */
GET_GroupKey_WCID(pAd, Wcid, apidx);
/* When the group rekey action is triggered, a count-down(3 seconds) is started.
During the count-down, use the initial PN as TSC.
Otherwise, get the IVEIV from ASIC. */
if (pAd->ApCfg.MBSSID[apidx].RekeyCountDown > 0)
{
/*
In IEEE 802.11-2007 8.3.3.4.3 described :
The PN shall be implemented as a 48-bit monotonically incrementing
non-negative integer, initialized to 1 when the corresponding
temporal key is initialized or refreshed. */
IvEiv[0] = 1;
}
else
{
UINT32 temp1, temp2;
/* Read IVEIV from Asic */
offset = MAC_IVEIV_TABLE_BASE + (Wcid * HW_IVEIV_ENTRY_SIZE);
/* Use Read32 to avoid endian problem */
RTMP_IO_READ32(pAd, offset, &temp1);
RTMP_IO_READ32(pAd, offset+4, &temp2);
for ( i=0; i<4; i++)
{
IvEiv[i] = (UCHAR)(temp1 >> (i*8));
IvEiv[i+4] = (UCHAR)(temp2 >> (i*8));
}
}
/* Record current TxTsc */
if (pAd->ApCfg.MBSSID[apidx].GroupKeyWepStatus == Ndis802_11Encryption3Enabled)
{ /* AES */
*pTxTsc = IvEiv[0];
*(pTxTsc+1) = IvEiv[1];
*(pTxTsc+2) = IvEiv[4];
*(pTxTsc+3) = IvEiv[5];
*(pTxTsc+4) = IvEiv[6];
*(pTxTsc+5) = IvEiv[7];
}
else
{ /* TKIP */
*pTxTsc = IvEiv[2];
*(pTxTsc+1) = IvEiv[0];
*(pTxTsc+2) = IvEiv[4];
*(pTxTsc+3) = IvEiv[5];
*(pTxTsc+4) = IvEiv[6];
*(pTxTsc+5) = IvEiv[7];
}
DBGPRINT(RT_DEBUG_TRACE, ("RTMPGetTxTscFromAsic : WCID(%d) TxTsc 0x%02x-0x%02x-0x%02x-0x%02x-0x%02x-0x%02x \n",
Wcid, *pTxTsc, *(pTxTsc+1), *(pTxTsc+2), *(pTxTsc+3), *(pTxTsc+4), *(pTxTsc+5)));
}
/*
========================================================================
Routine Description:
Initialize Multi-BSS function.
Arguments:
pAd points to our adapter
pDevMain points to the main BSS network interface
Return Value:
None
Note:
1. Only create and initialize virtual network interfaces.
2. No main network interface here.
3. If you down ra0 and modify the BssNum of RT2860AP.dat/RT2870AP.dat,
it will not work! You must rmmod rt2860ap.ko and lsmod rt2860ap.ko again.
========================================================================
*/
VOID MBSS_Init(RTMP_ADAPTER *pAd, RTMP_OS_NETDEV_OP_HOOK *pNetDevOps)
{
#define MBSS_MAX_DEV_NUM 32
PNET_DEV pDevNew;
INT32 IdBss, MaxNumBss;
INT status;
RTMP_OS_NETDEV_OP_HOOK netDevHook;
/* sanity check to avoid redundant virtual interfaces are created */
if (pAd->FlgMbssInit != FALSE)
return;
MaxNumBss = pAd->ApCfg.BssidNum;
if (MaxNumBss > MAX_MBSSID_NUM(pAd))
MaxNumBss = MAX_MBSSID_NUM(pAd);
/* first IdBss must not be 0 (BSS0), must be 1 (BSS1) */
for(IdBss=FIRST_MBSSID; IdBss<MAX_MBSSID_NUM(pAd); IdBss++)
pAd->ApCfg.MBSSID[IdBss].wdev.if_dev = NULL;
/* create virtual network interface */
for(IdBss=FIRST_MBSSID; IdBss<MaxNumBss; IdBss++)
{
struct wifi_dev *wdev;
UINT32 MC_RowID = 0, IoctlIF = 0;
char *dev_name;
#ifdef MULTIPLE_CARD_SUPPORT
MC_RowID = pAd->MC_RowID;
#endif /* MULTIPLE_CARD_SUPPORT */
#ifdef HOSTAPD_SUPPORT
IoctlIF = pAd->IoctlIF;
#endif /* HOSTAPD_SUPPORT */
dev_name = get_dev_name_prefix(pAd, INT_MBSSID);
pDevNew = RtmpOSNetDevCreate(MC_RowID, &IoctlIF, INT_MBSSID, IdBss, sizeof(struct mt_dev_priv), dev_name);
#ifdef HOSTAPD_SUPPORT
pAd->IoctlIF = IoctlIF;
#endif /* HOSTAPD_SUPPORT */
if (pDevNew == NULL)
{
pAd->ApCfg.BssidNum = IdBss; /* re-assign new MBSS number */
break;
}
else
{
DBGPRINT(RT_DEBUG_TRACE, ("Register MBSSID IF (%s)\n", RTMP_OS_NETDEV_GET_DEVNAME(pDevNew)));
}
wdev = &pAd->ApCfg.MBSSID[IdBss].wdev;
wdev->wdev_type = WDEV_TYPE_AP;
wdev->func_dev = &pAd->ApCfg.MBSSID[IdBss];
wdev->sys_handle = (void *)pAd;
wdev->if_dev = pDevNew;
if (rtmp_wdev_idx_reg(pAd, wdev) < 0) {
DBGPRINT(RT_DEBUG_ERROR, ("Assign wdev idx for %s failed, free net device!\n",
RTMP_OS_NETDEV_GET_DEVNAME(pDevNew)));
RtmpOSNetDevFree(pDevNew);
break;
}
wdev->tx_pkt_allowed = ApAllowToSendPacket;
RTMP_OS_NETDEV_SET_PRIV(pDevNew, pAd);
RTMP_OS_NETDEV_SET_WDEV(pDevNew, wdev);
/* init operation functions and flags */
NdisCopyMemory(&netDevHook, pNetDevOps, sizeof(netDevHook));
netDevHook.priv_flags = INT_MBSSID;
netDevHook.needProtcted = TRUE;
netDevHook.wdev = wdev;
/* Init MAC address of virtual network interface */
NdisMoveMemory(&netDevHook.devAddr[0], &wdev->bssid[0], MAC_ADDR_LEN);
/* register this device to OS */
status = RtmpOSNetDevAttach(pAd->OpMode, pDevNew, &netDevHook);
}
pAd->FlgMbssInit = TRUE;
}
MAC_TABLE_ENTRY *MacTableInsertEntry(
IN RTMP_ADAPTER *pAd,
IN UCHAR *pAddr,
IN struct wifi_dev *wdev,
IN UINT32 ent_type,
IN UCHAR OpMode,
IN BOOLEAN CleanAll)
{
UCHAR HashIdx;
int i, FirstWcid;
MAC_TABLE_ENTRY *pEntry = NULL, *pCurrEntry;
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];
mac_entry_reset(pAd, pEntry, CleanAll);
/* ENTRY PREEMPTION: initialize the entry */
pEntry->wdev = wdev;
pEntry->wcid = i;
pEntry->func_tb_idx = wdev->func_idx;
pEntry->bIAmBadAtheros = FALSE;
pEntry->pAd = pAd;
pEntry->CMTimerRunning = FALSE;
COPY_MAC_ADDR(pEntry->Addr, pAddr);
pEntry->Sst = SST_NOT_AUTH;
pEntry->AuthState = AS_NOT_AUTH;
pEntry->Aid = (USHORT)i;
pEntry->CapabilityInfo = 0;
pEntry->AssocDeadLine = MAC_TABLE_ASSOC_TIMEOUT;
pEntry->PsMode = PWR_ACTIVE;
pEntry->NoDataIdleCount = 0;
pEntry->ContinueTxFailCnt = 0;
#ifdef WDS_SUPPORT
pEntry->LockEntryTx = FALSE;
#endif /* WDS_SUPPORT */
pEntry->TimeStamp_toTxRing = 0;
// TODO: shiang-usw, remove upper setting becasue we need to migrate to tr_entry!
pAd->MacTab.tr_entry[i].PsMode = PWR_ACTIVE;
pAd->MacTab.tr_entry[i].NoDataIdleCount = 0;
pAd->MacTab.tr_entry[i].ContinueTxFailCnt = 0;
pAd->MacTab.tr_entry[i].LockEntryTx = FALSE;
pAd->MacTab.tr_entry[i].TimeStamp_toTxRing = 0;
pAd->MacTab.tr_entry[i].PsDeQWaitCnt = 0;
pEntry->EnqueueEapolStartTimerRunning = EAPOL_START_DISABLE;
pEntry->GTKState = REKEY_NEGOTIATING;
pEntry->PairwiseKey.KeyLen = 0;
pEntry->PairwiseKey.CipherAlg = CIPHER_NONE;
pEntry->PMKID_CacheIdx = ENTRY_NOT_FOUND;
pEntry->RSNIE_Len = 0;
NdisZeroMemory(pEntry->R_Counter, sizeof(pEntry->R_Counter));
pEntry->ReTryCounter = PEER_MSG1_RETRY_TIMER_CTR;
do
{
#ifdef CONFIG_AP_SUPPORT
#ifdef APCLI_SUPPORT
if (ent_type == ENTRY_APCLI)
{
SET_ENTRY_APCLI(pEntry);
//SET_ENTRY_AP(pEntry);//Carter, why set entry to APCLI then set to AP????
COPY_MAC_ADDR(pEntry->bssid, pAddr);
pEntry->AuthMode = pAd->ApCfg.ApCliTab[pEntry->func_tb_idx].wdev.AuthMode;
pEntry->WepStatus = pAd->ApCfg.ApCliTab[pEntry->func_tb_idx].wdev.WepStatus;
if (pEntry->AuthMode < Ndis802_11AuthModeWPA)
{
pEntry->WpaState = AS_NOTUSE;
pEntry->PrivacyFilter = Ndis802_11PrivFilterAcceptAll;
}
else
{
pEntry->WpaState = AS_PTKSTART;
pEntry->PrivacyFilter = Ndis802_11PrivFilter8021xWEP;
}
break;
}
#endif /* APCLI_SUPPORT */
#ifdef WDS_SUPPORT
if (ent_type == ENTRY_WDS)
{
SET_ENTRY_WDS(pEntry);
COPY_MAC_ADDR(pEntry->bssid, pAd->ApCfg.MBSSID[MAIN_MBSSID].wdev.bssid);
pEntry->AuthMode = Ndis802_11AuthModeOpen;
pEntry->WepStatus = Ndis802_11EncryptionDisabled;
break;
}
#endif /* WDS_SUPPORT */
#endif /* CONFIG_AP_SUPPORT */
#ifdef CONFIG_AP_SUPPORT
if (ent_type == ENTRY_CLIENT)
{ /* be a regular-entry*/
if ((pEntry->func_tb_idx < pAd->ApCfg.BssidNum) &&
(pEntry->func_tb_idx < MAX_MBSSID_NUM(pAd)) &&
((pEntry->func_tb_idx < HW_BEACON_MAX_NUM)) &&
(pAd->ApCfg.MBSSID[pEntry->func_tb_idx].MaxStaNum != 0) &&
(pAd->ApCfg.MBSSID[pEntry->func_tb_idx].StaCount >= pAd->ApCfg.MBSSID[pEntry->func_tb_idx].MaxStaNum))
{
DBGPRINT(RT_DEBUG_WARN, ("%s: The connection table is full in ra%d.\n", __FUNCTION__, pEntry->func_tb_idx));
NdisReleaseSpinLock(&pAd->MacTabLock);
return NULL;
}
ASSERT((wdev == &pAd->ApCfg.MBSSID[pEntry->func_tb_idx].wdev));
SET_ENTRY_CLIENT(pEntry);
pEntry->pMbss = &pAd->ApCfg.MBSSID[pEntry->func_tb_idx];
MBSS_MR_APIDX_SANITY_CHECK(pAd, pEntry->func_tb_idx);
COPY_MAC_ADDR(pEntry->bssid, wdev->bssid);
pEntry->AuthMode = wdev->AuthMode;
pEntry->WepStatus = wdev->WepStatus;
pEntry->GroupKeyWepStatus = wdev->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[pEntry->func_tb_idx].StaCount++;
pAd->ApCfg.EntryClientCount++;
break;
}
#endif /* CONFIG_AP_SUPPORT */
} while (FALSE);
tr_tb_set_entry(pAd, i, pEntry);
RTMPInitTimer(pAd, &pEntry->EnqueueStartForPSKTimer, GET_TIMER_FUNCTION(EnqueueStartForPSKExec), pEntry, FALSE);
#ifdef CONFIG_AP_SUPPORT
{
if (IS_ENTRY_CLIENT(pEntry)) /* Only Client entry need the retry timer.*/
{
RTMPInitTimer(pAd, &pEntry->RetryTimer, GET_TIMER_FUNCTION(WPARetryExec), pEntry, FALSE);
#ifdef DOT11W_PMF_SUPPORT
RTMPInitTimer(pAd, &pEntry->SAQueryTimer, GET_TIMER_FUNCTION(PMF_SAQueryTimeOut), pEntry, FALSE);
RTMPInitTimer(pAd, &pEntry->SAQueryConfirmTimer, GET_TIMER_FUNCTION(PMF_SAQueryConfirmTimeOut), pEntry, FALSE);
#endif /* DOT11W_PMF_SUPPORT */
}
#ifdef APCLI_SUPPORT
if (IS_ENTRY_APCLI(pEntry))
RTMPInitTimer(pAd, &pEntry->RetryTimer, GET_TIMER_FUNCTION(WPARetryExec), pEntry, FALSE);
#endif /* APCLI_SUPPORT */
}
#endif /* CONFIG_AP_SUPPORT */
#ifdef STREAM_MODE_SUPPORT
/* Enable Stream mode for first three entries in MAC table */
#endif /* STREAM_MODE_SUPPORT */
#ifdef UAPSD_SUPPORT
/* Ralink WDS doesn't support any power saving.*/
if (IS_ENTRY_CLIENT(pEntry)
)
{
/* init U-APSD enhancement related parameters */
UAPSD_MR_ENTRY_INIT(pEntry);
}
#endif /* UAPSD_SUPPORT */
pAd->MacTab.Size ++;
/* Set the security mode of this entry as OPEN-NONE in ASIC */
RTMP_REMOVE_PAIRWISE_KEY_ENTRY(pAd, (UCHAR)i);
#ifdef MT_MAC
if (pAd->chipCap.hif_type == HIF_MT)
MT_ADDREMOVE_KEY(pAd, 1, pEntry->apidx, 0, pEntry->wcid, PAIRWISEKEYTABLE, &pEntry->PairwiseKey, pEntry->Addr);
#endif
/* 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 */
DBGPRINT(RT_DEBUG_TRACE, ("%s(): alloc entry #%d, Total= %d\n",
__FUNCTION__, i, pAd->MacTab.Size));
break;
}
}
INT RTMP_COM_IoctlHandle(
IN VOID *pAdSrc,
IN RTMP_IOCTL_INPUT_STRUCT *wrq,
IN INT cmd,
IN USHORT subcmd,
IN VOID *pData,
IN ULONG Data)
{
PRTMP_ADAPTER pAd = (PRTMP_ADAPTER)pAdSrc;
POS_COOKIE pObj = (POS_COOKIE)pAd->OS_Cookie;
INT Status = NDIS_STATUS_SUCCESS, i;
pObj = pObj; /* avoid compile warning */
switch(cmd)
{
case CMD_RTPRIV_IOCTL_NETDEV_GET:
/* get main net_dev */
{
VOID **ppNetDev = (VOID **)pData;
*ppNetDev = (VOID *)(pAd->net_dev);
}
break;
case CMD_RTPRIV_IOCTL_NETDEV_SET:
{
struct wifi_dev *wdev = NULL;
/* set main net_dev */
pAd->net_dev = pData;
#ifdef CONFIG_AP_SUPPORT
if (pAd->OpMode == OPMODE_AP) {
pAd->ApCfg.MBSSID[MAIN_MBSSID].wdev.if_dev = (void *)pData;
pAd->ApCfg.MBSSID[MAIN_MBSSID].wdev.func_dev = (void *)&pAd->ApCfg.MBSSID[MAIN_MBSSID];
pAd->ApCfg.MBSSID[MAIN_MBSSID].wdev.sys_handle = (void *)pAd;
RTMP_OS_NETDEV_SET_WDEV(pData, &pAd->ApCfg.MBSSID[MAIN_MBSSID].wdev);
wdev = &pAd->ApCfg.MBSSID[MAIN_MBSSID].wdev;
}
#endif /* CONFIG_AP_SUPPORT */
if (wdev) {
if (rtmp_wdev_idx_reg(pAd, wdev) < 0) {
DBGPRINT(RT_DEBUG_ERROR, ("Assign wdev idx for %s failed, free net device!\n",
RTMP_OS_NETDEV_GET_DEVNAME(pAd->net_dev)));
RtmpOSNetDevFree(pAd->net_dev);
}
}
break;
}
case CMD_RTPRIV_IOCTL_OPMODE_GET:
/* get Operation Mode */
*(ULONG *)pData = pAd->OpMode;
break;
case CMD_RTPRIV_IOCTL_TASK_LIST_GET:
/* get all Tasks */
{
RT_CMD_WAIT_QUEUE_LIST *pList = (RT_CMD_WAIT_QUEUE_LIST *)pData;
pList->pMlmeTask = &pAd->mlmeTask;
#ifdef RTMP_TIMER_TASK_SUPPORT
pList->pTimerTask = &pAd->timerTask;
#endif /* RTMP_TIMER_TASK_SUPPORT */
pList->pCmdQTask = &pAd->cmdQTask;
#ifdef WSC_INCLUDED
pList->pWscTask = &pAd->wscTask;
#endif /* WSC_INCLUDED */
}
break;
#ifdef RTMP_MAC_PCI
case CMD_RTPRIV_IOCTL_IRQ_INIT:
/* init IRQ */
rtmp_irq_init(pAd);
break;
#endif /* RTMP_MAC_PCI */
case CMD_RTPRIV_IOCTL_IRQ_RELEASE:
/* release IRQ */
RTMP_OS_IRQ_RELEASE(pAd, pAd->net_dev);
break;
#ifdef RTMP_MAC_PCI
case CMD_RTPRIV_IOCTL_MSI_ENABLE:
/* enable MSI */
RTMP_MSI_ENABLE(pAd);
*(ULONG **)pData = (ULONG *)(pObj->pci_dev);
break;
#endif /* RTMP_MAC_PCI */
case CMD_RTPRIV_IOCTL_NIC_NOT_EXIST:
/* set driver state to fRTMP_ADAPTER_NIC_NOT_EXIST */
RTMP_SET_FLAG(pAd, fRTMP_ADAPTER_NIC_NOT_EXIST);
break;
case CMD_RTPRIV_IOCTL_MCU_SLEEP_CLEAR:
RTMP_CLEAR_PSFLAG(pAd, fRTMP_PS_MCU_SLEEP);
break;
case CMD_RTPRIV_IOCTL_SANITY_CHECK:
/* sanity check before IOCTL */
if ((!RTMP_TEST_FLAG(pAd, fRTMP_ADAPTER_INTERRUPT_IN_USE))
#ifdef IFUP_IN_PROBE
|| (RTMP_TEST_FLAG(pAd, fRTMP_ADAPTER_RESET_IN_PROGRESS))
|| (RTMP_TEST_FLAG(pAd, fRTMP_ADAPTER_HALT_IN_PROGRESS))
|| (RTMP_TEST_FLAG(pAd, fRTMP_ADAPTER_NIC_NOT_EXIST))
#endif /* IFUP_IN_PROBE */
)
{
if(pData == NULL || RT_isLegalCmdBeforeInfUp((PSTRING) pData) == FALSE)
return NDIS_STATUS_FAILURE;
}
break;
case CMD_RTPRIV_IOCTL_SIOCGIWFREQ:
/* get channel number */
*(ULONG *)pData = pAd->CommonCfg.Channel;
break;
#ifdef CONFIG_SNIFFER_SUPPORT
case CMD_RTPRIV_IOCTL_SNIFF_INIT:
Monitor_Init(pAd, pData);
break;
case CMD_RTPRIV_IOCTL_SNIFF_OPEN:
if (Monitor_Open(pAd, pData) != TRUE)
return NDIS_STATUS_FAILURE;
break;
case CMD_RTPRIV_IOCTL_SNIFF_CLOSE:
if (Monitor_Close(pAd, pData) != TRUE)
return NDIS_STATUS_FAILURE;
break;
case CMD_RTPRIV_IOCTL_SNIFF_REMOVE:
Monitor_Remove(pAd);
break;
#endif /*CONFIG_SNIFFER_SUPPORT*/
case CMD_RTPRIV_IOCTL_BEACON_UPDATE:
/* update all beacon contents */
#ifdef CONFIG_AP_SUPPORT
APMakeAllBssBeacon(pAd);
APUpdateAllBeaconFrame(pAd);
#endif /* CONFIG_AP_SUPPORT */
break;
case CMD_RTPRIV_IOCTL_RXPATH_GET:
/* get the number of rx path */
*(ULONG *)pData = pAd->Antenna.field.RxPath;
break;
case CMD_RTPRIV_IOCTL_CHAN_LIST_NUM_GET:
*(ULONG *)pData = pAd->ChannelListNum;
break;
case CMD_RTPRIV_IOCTL_CHAN_LIST_GET:
{
UINT32 i;
UCHAR *pChannel = (UCHAR *)pData;
for (i = 1; i <= pAd->ChannelListNum; i++)
{
*pChannel = pAd->ChannelList[i-1].Channel;
pChannel ++;
}
}
break;
case CMD_RTPRIV_IOCTL_FREQ_LIST_GET:
{
UINT32 i;
UINT32 *pFreq = (UINT32 *)pData;
UINT32 m;
for (i = 1; i <= pAd->ChannelListNum; i++)
{
m = 2412000;
MAP_CHANNEL_ID_TO_KHZ(pAd->ChannelList[i-1].Channel, m);
(*pFreq) = m;
pFreq ++;
}
}
break;
#ifdef EXT_BUILD_CHANNEL_LIST
case CMD_RTPRIV_SET_PRECONFIG_VALUE:
/* Set some preconfigured value before interface up*/
pAd->CommonCfg.DfsType = MAX_RD_REGION;
break;
#endif /* EXT_BUILD_CHANNEL_LIST */
#ifdef RTMP_PCI_SUPPORT
case CMD_RTPRIV_IOCTL_PCI_SUSPEND:
RTMP_SET_FLAG(pAd, fRTMP_ADAPTER_HALT_IN_PROGRESS);
RTMP_SET_FLAG(pAd, fRTMP_ADAPTER_RADIO_OFF);
break;
case CMD_RTPRIV_IOCTL_PCI_RESUME:
RTMP_CLEAR_FLAG(pAd, fRTMP_ADAPTER_HALT_IN_PROGRESS);
RTMP_CLEAR_FLAG(pAd, fRTMP_ADAPTER_RADIO_OFF);
break;
case CMD_RTPRIV_IOCTL_PCI_CSR_SET:
pAd->CSRBaseAddress = (PUCHAR)Data;
DBGPRINT(RT_DEBUG_ERROR, ("pAd->CSRBaseAddress =0x%lx, csr_addr=0x%lx!\n", (ULONG)pAd->CSRBaseAddress, (ULONG)Data));
break;
case CMD_RTPRIV_IOCTL_PCIE_INIT:
RTMPInitPCIeDevice(pData, pAd);
break;
#endif /* RTMP_PCI_SUPPORT */
#ifdef RT_CFG80211_SUPPORT
case CMD_RTPRIV_IOCTL_CFG80211_CFG_START:
RT_CFG80211_REINIT(pAd);
RT_CFG80211_CRDA_REG_RULE_APPLY(pAd);
break;
#endif /* RT_CFG80211_SUPPORT */
#ifdef INF_PPA_SUPPORT
case CMD_RTPRIV_IOCTL_INF_PPA_INIT:
os_alloc_mem(NULL, (UCHAR **)&(pAd->pDirectpathCb), sizeof(PPA_DIRECTPATH_CB));
break;
case CMD_RTPRIV_IOCTL_INF_PPA_EXIT:
if (ppa_hook_directpath_register_dev_fn && (pAd->PPAEnable == TRUE))
{
UINT status;
status = ppa_hook_directpath_register_dev_fn(&pAd->g_if_id, pAd->net_dev, NULL, 0);
DBGPRINT(RT_DEBUG_TRACE, ("Unregister PPA::status=%d, if_id=%d\n", status, pAd->g_if_id));
}
os_free_mem(NULL, pAd->pDirectpathCb);
break;
#endif /* INF_PPA_SUPPORT*/
case CMD_RTPRIV_IOCTL_VIRTUAL_INF_UP:
/* interface up */
{
RT_CMD_INF_UP_DOWN *pInfConf = (RT_CMD_INF_UP_DOWN *)pData;
if (VIRTUAL_IF_NUM(pAd) == 0)
{
if (pInfConf->rt28xx_open(pAd->net_dev) != 0)
{
DBGPRINT(RT_DEBUG_TRACE, ("rt28xx_open return fail!\n"));
return NDIS_STATUS_FAILURE;
}
}
else
{
#ifdef CONFIG_AP_SUPPORT
extern VOID APMakeAllBssBeacon(IN PRTMP_ADAPTER pAd);
extern VOID APUpdateAllBeaconFrame(IN PRTMP_ADAPTER pAd);
APMakeAllBssBeacon(pAd);
APUpdateAllBeaconFrame(pAd);
#endif /* CONFIG_AP_SUPPORT */
}
VIRTUAL_IF_INC(pAd);
}
break;
case CMD_RTPRIV_IOCTL_VIRTUAL_INF_DOWN:
/* interface down */
{
RT_CMD_INF_UP_DOWN *pInfConf = (RT_CMD_INF_UP_DOWN *)pData;
VIRTUAL_IF_DEC(pAd);
if (VIRTUAL_IF_NUM(pAd) == 0)
pInfConf->rt28xx_close(pAd->net_dev);
}
break;
case CMD_RTPRIV_IOCTL_VIRTUAL_INF_GET:
/* get virtual interface number */
*(ULONG *)pData = VIRTUAL_IF_NUM(pAd);
break;
case CMD_RTPRIV_IOCTL_INF_TYPE_GET:
/* get current interface type */
*(ULONG *)pData = pAd->infType;
break;
case CMD_RTPRIV_IOCTL_INF_STATS_GET:
/* get statistics */
{
RT_CMD_STATS *pStats = (RT_CMD_STATS *)pData;
pStats->pStats = pAd->stats;
if(pAd->OpMode == OPMODE_STA)
{
pStats->rx_packets = pAd->WlanCounters.ReceivedFragmentCount.QuadPart;
pStats->tx_packets = pAd->WlanCounters.TransmittedFragmentCount.QuadPart;
pStats->rx_bytes = pAd->RalinkCounters.ReceivedByteCount;
pStats->tx_bytes = pAd->RalinkCounters.TransmittedByteCount;
pStats->rx_errors = pAd->Counters8023.RxErrors;
pStats->tx_errors = pAd->Counters8023.TxErrors;
pStats->multicast = pAd->WlanCounters.MulticastReceivedFrameCount.QuadPart; /* multicast packets received*/
pStats->collisions = 0; /* Collision packets*/
pStats->rx_over_errors = pAd->Counters8023.RxNoBuffer; /* receiver ring buff overflow*/
pStats->rx_crc_errors = 0;/*pAd->WlanCounters.FCSErrorCount; recved pkt with crc error*/
pStats->rx_frame_errors = 0; /* recv'd frame alignment error*/
pStats->rx_fifo_errors = pAd->Counters8023.RxNoBuffer; /* recv'r fifo overrun*/
}
#ifdef CONFIG_AP_SUPPORT
else if(pAd->OpMode == OPMODE_AP)
{
INT index;
for(index = 0; index < MAX_MBSSID_NUM(pAd); index++)
{
if (pAd->ApCfg.MBSSID[index].wdev.if_dev == (PNET_DEV)(pStats->pNetDev))
{
break;
}
}
if(index >= MAX_MBSSID_NUM(pAd))
{
//reset counters
pStats->rx_packets = 0;
pStats->tx_packets = 0;
pStats->rx_bytes = 0;
pStats->tx_bytes = 0;
pStats->rx_errors = 0;
pStats->tx_errors = 0;
pStats->multicast = 0; /* multicast packets received*/
pStats->collisions = 0; /* Collision packets*/
pStats->rx_over_errors = 0; /* receiver ring buff overflow*/
pStats->rx_crc_errors = 0; /* recved pkt with crc error*/
pStats->rx_frame_errors = 0; /* recv'd frame alignment error*/
pStats->rx_fifo_errors = 0; /* recv'r fifo overrun*/
DBGPRINT(RT_DEBUG_ERROR, ("CMD_RTPRIV_IOCTL_INF_STATS_GET: can not find mbss I/F\n"));
return NDIS_STATUS_FAILURE;
}
pStats->rx_packets = pAd->ApCfg.MBSSID[index].RxCount;
pStats->tx_packets = pAd->ApCfg.MBSSID[index].TxCount;
pStats->rx_bytes = pAd->ApCfg.MBSSID[index].ReceivedByteCount;
pStats->tx_bytes = pAd->ApCfg.MBSSID[index].TransmittedByteCount;
pStats->rx_errors = pAd->ApCfg.MBSSID[index].RxErrorCount;
pStats->tx_errors = pAd->ApCfg.MBSSID[index].TxErrorCount;
pStats->multicast = pAd->ApCfg.MBSSID[index].mcPktsRx; /* multicast packets received */
pStats->collisions = 0; /* Collision packets*/
pStats->rx_over_errors = 0; /* receiver ring buff overflow*/
pStats->rx_crc_errors = 0;/* recved pkt with crc error*/
pStats->rx_frame_errors = 0; /* recv'd frame alignment error*/
pStats->rx_fifo_errors = 0; /* recv'r fifo overrun*/
}
#endif
}
break;
case CMD_RTPRIV_IOCTL_INF_IW_STATUS_GET:
/* get wireless statistics */
{
UCHAR CurOpMode = OPMODE_AP;
#ifdef CONFIG_AP_SUPPORT
PMAC_TABLE_ENTRY pMacEntry = NULL;
#endif /* CONFIG_AP_SUPPORT */
RT_CMD_IW_STATS *pStats = (RT_CMD_IW_STATS *)pData;
pStats->qual = 0;
pStats->level = 0;
pStats->noise = 0;
pStats->pStats = pAd->iw_stats;
/*check if the interface is down*/
if(!RTMP_TEST_FLAG(pAd, fRTMP_ADAPTER_INTERRUPT_IN_USE))
return NDIS_STATUS_FAILURE;
#ifdef CONFIG_AP_SUPPORT
if (CurOpMode == OPMODE_AP)
{
#ifdef APCLI_SUPPORT
if ((pStats->priv_flags == INT_APCLI)
)
{
INT ApCliIdx = ApCliIfLookUp(pAd, (PUCHAR)pStats->dev_addr);
if ((ApCliIdx >= 0) && VALID_WCID(pAd->ApCfg.ApCliTab[ApCliIdx].MacTabWCID))
pMacEntry = &pAd->MacTab.Content[pAd->ApCfg.ApCliTab[ApCliIdx].MacTabWCID];
}
else
#endif /* APCLI_SUPPORT */
{
/*
only AP client support wireless stats function.
return NULL pointer for all other cases.
*/
pMacEntry = NULL;
}
}
#endif /* CONFIG_AP_SUPPORT */
#ifdef CONFIG_AP_SUPPORT
if (CurOpMode == OPMODE_AP)
{
if (pMacEntry != NULL)
pStats->qual = ((pMacEntry->ChannelQuality * 12)/10 + 10);
else
pStats->qual = ((pAd->Mlme.ChannelQuality * 12)/10 + 10);
}
#endif /* CONFIG_AP_SUPPORT */
if (pStats->qual > 100)
pStats->qual = 100;
#ifdef CONFIG_AP_SUPPORT
if (CurOpMode == OPMODE_AP)
{
if (pMacEntry != NULL)
pStats->level =
RTMPMaxRssi(pAd, pMacEntry->RssiSample.AvgRssi0,
pMacEntry->RssiSample.AvgRssi1,
pMacEntry->RssiSample.AvgRssi2);
}
#endif /* CONFIG_AP_SUPPORT */
#ifdef CONFIG_AP_SUPPORT
pStats->noise = RTMPMaxRssi(pAd, pAd->ApCfg.RssiSample.AvgRssi0,
pAd->ApCfg.RssiSample.AvgRssi1,
pAd->ApCfg.RssiSample.AvgRssi2) -
RTMPMinSnr(pAd, pAd->ApCfg.RssiSample.AvgSnr0,
pAd->ApCfg.RssiSample.AvgSnr1);
#endif /* CONFIG_AP_SUPPORT */
}
break;
case CMD_RTPRIV_IOCTL_INF_MAIN_CREATE:
*(VOID **)pData = RtmpPhyNetDevMainCreate(pAd);
break;
case CMD_RTPRIV_IOCTL_INF_MAIN_ID_GET:
*(ULONG *)pData = INT_MAIN;
break;
case CMD_RTPRIV_IOCTL_INF_MAIN_CHECK:
if (Data != INT_MAIN)
return NDIS_STATUS_FAILURE;
break;
case CMD_RTPRIV_IOCTL_INF_P2P_CHECK:
if (Data != INT_P2P)
return NDIS_STATUS_FAILURE;
break;
#ifdef WDS_SUPPORT
case CMD_RTPRIV_IOCTL_WDS_INIT:
WDS_Init(pAd, pData);
break;
case CMD_RTPRIV_IOCTL_WDS_REMOVE:
WDS_Remove(pAd);
break;
case CMD_RTPRIV_IOCTL_WDS_STATS_GET:
if (Data == INT_WDS)
{
if (WDS_StatsGet(pAd, pData) != TRUE)
return NDIS_STATUS_FAILURE;
}
else
return NDIS_STATUS_FAILURE;
break;
#endif /* WDS_SUPPORT */
#ifdef RALINK_ATE
#ifdef RALINK_QA
case CMD_RTPRIV_IOCTL_ATE:
RtmpDoAte(pAd, wrq, pData);
break;
#endif /* RALINK_QA */
#endif /* RALINK_ATE */
case CMD_RTPRIV_IOCTL_MAC_ADDR_GET:
{
UCHAR mac_addr[MAC_ADDR_LEN];
USHORT Addr01, Addr23, Addr45;
RT28xx_EEPROM_READ16(pAd, 0x04, Addr01);
RT28xx_EEPROM_READ16(pAd, 0x06, Addr23);
RT28xx_EEPROM_READ16(pAd, 0x08, Addr45);
mac_addr[0] = (UCHAR)(Addr01 & 0xff);
mac_addr[1] = (UCHAR)(Addr01 >> 8);
mac_addr[2] = (UCHAR)(Addr23 & 0xff);
mac_addr[3] = (UCHAR)(Addr23 >> 8);
mac_addr[4] = (UCHAR)(Addr45 & 0xff);
mac_addr[5] = (UCHAR)(Addr45 >> 8);
for(i=0; i<6; i++)
*(UCHAR *)(pData+i) = mac_addr[i];
break;
}
#ifdef CONFIG_AP_SUPPORT
case CMD_RTPRIV_IOCTL_AP_SIOCGIWRATEQ:
/* handle for SIOCGIWRATEQ */
{
RT_CMD_IOCTL_RATE *pRate = (RT_CMD_IOCTL_RATE *)pData;
HTTRANSMIT_SETTING HtPhyMode;
UINT8 BW = 0, GI = 0, MCS = 0;
#ifdef APCLI_SUPPORT
if (pRate->priv_flags == INT_APCLI)
memcpy(&HtPhyMode, &pAd->ApCfg.ApCliTab[pObj->ioctl_if].wdev.HTPhyMode, sizeof(HTTRANSMIT_SETTING));
else
#endif /* APCLI_SUPPORT */
#ifdef WDS_SUPPORT
if (pRate->priv_flags == INT_WDS)
memcpy(&HtPhyMode, &pAd->WdsTab.WdsEntry[pObj->ioctl_if].wdev.HTPhyMode, sizeof(HTTRANSMIT_SETTING));
else
#endif /* WDS_SUPPORT */
{
memcpy(&HtPhyMode, &pAd->ApCfg.MBSSID[pObj->ioctl_if].wdev.HTPhyMode, sizeof(HTTRANSMIT_SETTING));
#ifdef MBSS_SUPPORT
/* reset phy mode for MBSS */
MBSS_PHY_MODE_RESET(pObj->ioctl_if, HtPhyMode);
#endif /* MBSS_SUPPORT */
}
#ifdef DOT11_VHT_AC
if (HtPhyMode.field.BW == BW_40 && pAd->CommonCfg.vht_bw == VHT_BW_80 && HtPhyMode.field.MODE >= MODE_VHT) {
BW = 2;
GI = pAd->CommonCfg.vht_sgi_80;
}
else
#endif /* DOT11_VHT_AC */
{
BW = HtPhyMode.field.BW;
GI = HtPhyMode.field.ShortGI;
}
RtmpDrvRateGet(pAd, HtPhyMode.field.MODE, GI,
BW, HtPhyMode.field.MCS,
pAd->Antenna.field.TxPath,
(UINT32 *)&pRate->BitRate);
}
break;
#endif /* CONFIG_AP_SUPPORT */
case CMD_RTPRIV_IOCTL_SIOCGIWNAME:
RtmpIoctl_rt_ioctl_giwname(pAd, pData, 0);
break;
}
#ifdef RT_CFG80211_SUPPORT
if ((CMD_RTPRIV_IOCTL_80211_START <= cmd) &&
(cmd <= CMD_RTPRIV_IOCTL_80211_END))
{
Status = CFG80211DRV_IoctlHandle(pAd, wrq, cmd, subcmd, pData, Data);
}
#endif /* RT_CFG80211_SUPPORT */
if (cmd >= CMD_RTPRIV_IOCTL_80211_COM_LATEST_ONE)
return NDIS_STATUS_FAILURE;
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;
}
}
VOID RTMPHandleIdsEvent(
IN PRTMP_ADAPTER pAd)
{
INT i, j;
UINT32 FloodFrameCount[IW_FLOOD_EVENT_TYPE_NUM];
UINT32 FloodFrameThreshold[IW_FLOOD_EVENT_TYPE_NUM];
FloodFrameCount[0] = pAd->ApCfg.RcvdAuthCount;
FloodFrameCount[1] = pAd->ApCfg.RcvdAssocReqCount;
FloodFrameCount[2] = pAd->ApCfg.RcvdReassocReqCount;
FloodFrameCount[3] = pAd->ApCfg.RcvdProbeReqCount;
FloodFrameCount[4] = pAd->ApCfg.RcvdDisassocCount;
FloodFrameCount[5] = pAd->ApCfg.RcvdDeauthCount;
FloodFrameCount[6] = pAd->ApCfg.RcvdEapReqCount;
FloodFrameThreshold[0] = pAd->ApCfg.AuthFloodThreshold;
FloodFrameThreshold[1] = pAd->ApCfg.AssocReqFloodThreshold;
FloodFrameThreshold[2] = pAd->ApCfg.ReassocReqFloodThreshold;
FloodFrameThreshold[3] = pAd->ApCfg.ProbeReqFloodThreshold;
FloodFrameThreshold[4] = pAd->ApCfg.DisassocFloodThreshold;
FloodFrameThreshold[5] = pAd->ApCfg.DeauthFloodThreshold;
FloodFrameThreshold[6] = pAd->ApCfg.EapReqFloodThreshold;
/* trigger flooding traffic event */
for (j = 0; j < IW_FLOOD_EVENT_TYPE_NUM; j++)
{
if ((FloodFrameThreshold[j] > 0) && (FloodFrameCount[j] > FloodFrameThreshold[j]))
{
RTMPSendWirelessEvent(pAd, IW_FLOOD_AUTH_EVENT_FLAG + j, NULL, MAX_MBSSID_NUM(pAd), 0);
/*MTWF_LOG(DBG_CAT_ALL, DBG_SUBCAT_ALL, DBG_LVL_TRACE, ("flooding traffic event(%d) - %d\n", IW_FLOOD_AUTH_EVENT_FLAG + j, FloodFrameCount[j])); */
}
}
for (i = 0; i < pAd->ApCfg.BssidNum; i++)
{
UINT32 SpoofedFrameCount[IW_SPOOF_EVENT_TYPE_NUM];
CHAR RssiOfSpoofedFrame[IW_SPOOF_EVENT_TYPE_NUM];
INT k;
SpoofedFrameCount[0] = pAd->ApCfg.MBSSID[i].RcvdConflictSsidCount;
SpoofedFrameCount[1] = pAd->ApCfg.MBSSID[i].RcvdSpoofedAssocRespCount;
SpoofedFrameCount[2] = pAd->ApCfg.MBSSID[i].RcvdSpoofedReassocRespCount;
SpoofedFrameCount[3] = pAd->ApCfg.MBSSID[i].RcvdSpoofedProbeRespCount;
SpoofedFrameCount[4] = pAd->ApCfg.MBSSID[i].RcvdSpoofedBeaconCount;
SpoofedFrameCount[5] = pAd->ApCfg.MBSSID[i].RcvdSpoofedDisassocCount;
SpoofedFrameCount[6] = pAd->ApCfg.MBSSID[i].RcvdSpoofedAuthCount;
SpoofedFrameCount[7] = pAd->ApCfg.MBSSID[i].RcvdSpoofedDeauthCount;
SpoofedFrameCount[8] = pAd->ApCfg.MBSSID[i].RcvdSpoofedUnknownMgmtCount;
SpoofedFrameCount[9] = pAd->ApCfg.MBSSID[i].RcvdReplayAttackCount;
RssiOfSpoofedFrame[0] = pAd->ApCfg.MBSSID[i].RssiOfRcvdConflictSsid;
RssiOfSpoofedFrame[1] = pAd->ApCfg.MBSSID[i].RssiOfRcvdSpoofedAssocResp;
RssiOfSpoofedFrame[2] = pAd->ApCfg.MBSSID[i].RssiOfRcvdSpoofedReassocResp;
RssiOfSpoofedFrame[3] = pAd->ApCfg.MBSSID[i].RssiOfRcvdSpoofedProbeResp;
RssiOfSpoofedFrame[4] = pAd->ApCfg.MBSSID[i].RssiOfRcvdSpoofedBeacon;
RssiOfSpoofedFrame[5] = pAd->ApCfg.MBSSID[i].RssiOfRcvdSpoofedDisassoc;
RssiOfSpoofedFrame[6] = pAd->ApCfg.MBSSID[i].RssiOfRcvdSpoofedAuth;
RssiOfSpoofedFrame[7] = pAd->ApCfg.MBSSID[i].RssiOfRcvdSpoofedDeauth;
RssiOfSpoofedFrame[8] = pAd->ApCfg.MBSSID[i].RssiOfRcvdSpoofedUnknownMgmt;
RssiOfSpoofedFrame[9] = pAd->ApCfg.MBSSID[i].RssiOfRcvdReplayAttack;
/* trigger spoofed attack event */
for (k = 0; k < IW_SPOOF_EVENT_TYPE_NUM; k++)
{
if (SpoofedFrameCount[k] > 0)
{
RTMPSendWirelessEvent(pAd, IW_CONFLICT_SSID_EVENT_FLAG + k, NULL, i, RssiOfSpoofedFrame[k]);
/*MTWF_LOG(DBG_CAT_ALL, DBG_SUBCAT_ALL, DBG_LVL_TRACE, ("spoofed attack event(%d) - %d\n", IW_CONFLICT_SSID_EVENT_FLAG + k, SpoofedFrameCount[k])); */
}
}
}
}
INT RTMP_COM_IoctlHandle(
IN VOID *pAdSrc,
IN RTMP_IOCTL_INPUT_STRUCT *wrq,
IN INT cmd,
IN USHORT subcmd,
IN VOID *pData,
IN ULONG Data)
{
PRTMP_ADAPTER pAd = (PRTMP_ADAPTER)pAdSrc;
POS_COOKIE pObj = (POS_COOKIE)pAd->OS_Cookie;
INT Status = NDIS_STATUS_SUCCESS, i;
pObj = pObj; /* avoid compile warning */
switch(cmd)
{
case CMD_RTPRIV_IOCTL_NETDEV_GET:
/* get main net_dev */
{
VOID **ppNetDev = (VOID **)pData;
*ppNetDev = (VOID *)(pAd->net_dev);
}
break;
case CMD_RTPRIV_IOCTL_NETDEV_SET:
{
struct wifi_dev *wdev = NULL;
/* set main net_dev */
pAd->net_dev = pData;
#ifdef CONFIG_AP_SUPPORT
if (pAd->OpMode == OPMODE_AP) {
pAd->ApCfg.MBSSID[MAIN_MBSSID].wdev.if_dev = (void *)pData;
pAd->ApCfg.MBSSID[MAIN_MBSSID].wdev.func_dev = (void *)&pAd->ApCfg.MBSSID[MAIN_MBSSID];
pAd->ApCfg.MBSSID[MAIN_MBSSID].wdev.sys_handle = (void *)pAd;
RTMP_OS_NETDEV_SET_WDEV(pData, &pAd->ApCfg.MBSSID[MAIN_MBSSID].wdev);
wdev = &pAd->ApCfg.MBSSID[MAIN_MBSSID].wdev;
}
#endif /* CONFIG_AP_SUPPORT */
#ifdef CONFIG_STA_SUPPORT
if (pAd->OpMode == OPMODE_STA) {
pAd->StaCfg.wdev.if_dev = pData;
pAd->StaCfg.wdev.func_dev = (void *)&pAd->StaCfg;
pAd->StaCfg.wdev.sys_handle = (void *)pAd;
RTMP_OS_NETDEV_SET_WDEV(pData, &pAd->StaCfg.wdev);
wdev = &pAd->StaCfg.wdev;
}
#endif /* CONFIG_STA_SUPPORT */
if (wdev) {
if (rtmp_wdev_idx_reg(pAd, wdev) < 0) {
DBGPRINT(RT_DEBUG_ERROR, ("Assign wdev idx for %s failed, free net device!\n",
RTMP_OS_NETDEV_GET_DEVNAME(pAd->net_dev)));
RtmpOSNetDevFree(pAd->net_dev);
}
}
break;
}
case CMD_RTPRIV_IOCTL_OPMODE_GET:
/* get Operation Mode */
*(ULONG *)pData = pAd->OpMode;
break;
case CMD_RTPRIV_IOCTL_TASK_LIST_GET:
/* get all Tasks */
{
RT_CMD_WAIT_QUEUE_LIST *pList = (RT_CMD_WAIT_QUEUE_LIST *)pData;
pList->pMlmeTask = &pAd->mlmeTask;
#ifdef RTMP_TIMER_TASK_SUPPORT
pList->pTimerTask = &pAd->timerTask;
#endif /* RTMP_TIMER_TASK_SUPPORT */
pList->pCmdQTask = &pAd->cmdQTask;
}
break;
case CMD_RTPRIV_IOCTL_IRQ_RELEASE:
/* release IRQ */
RTMP_OS_IRQ_RELEASE(pAd, pAd->net_dev);
break;
case CMD_RTPRIV_IOCTL_NIC_NOT_EXIST:
/* set driver state to fRTMP_ADAPTER_NIC_NOT_EXIST */
RTMP_SET_FLAG(pAd, fRTMP_ADAPTER_NIC_NOT_EXIST);
break;
case CMD_RTPRIV_IOCTL_MCU_SLEEP_CLEAR:
RTMP_CLEAR_PSFLAG(pAd, fRTMP_PS_MCU_SLEEP);
break;
#ifdef CONFIG_STA_SUPPORT
#ifdef CONFIG_PM
#ifdef USB_SUPPORT_SELECTIVE_SUSPEND
case CMD_RTPRIV_IOCTL_USB_DEV_GET:
/* get USB DEV */
{
VOID **ppUsb_Dev = (VOID **)pData;
*ppUsb_Dev = (VOID *)(pObj->pUsb_Dev);
}
break;
case CMD_RTPRIV_IOCTL_USB_INTF_GET:
/* get USB INTF */
{
VOID **ppINTF = (VOID **)pData;
*ppINTF = (VOID *)(pObj->intf);
}
break;
case CMD_RTPRIV_IOCTL_ADAPTER_SUSPEND_SET:
/* set driver state to fRTMP_ADAPTER_SUSPEND */
RTMP_SET_FLAG(pAd,fRTMP_ADAPTER_SUSPEND);
break;
case CMD_RTPRIV_IOCTL_ADAPTER_SUSPEND_CLEAR:
/* clear driver state to fRTMP_ADAPTER_SUSPEND */
RTMP_CLEAR_FLAG(pAd,fRTMP_ADAPTER_SUSPEND);
RTMP_CLEAR_FLAG(pAd, fRTMP_ADAPTER_MCU_SEND_IN_BAND_CMD);
RTMP_CLEAR_PSFLAG(pAd, fRTMP_PS_MCU_SLEEP);
break;
case CMD_RTPRIV_IOCTL_ADAPTER_SEND_DISSASSOCIATE:
/* clear driver state to fRTMP_ADAPTER_SUSPEND */
if (INFRA_ON(pAd) &&
(!RTMP_TEST_FLAG(pAd, fRTMP_ADAPTER_NIC_NOT_EXIST)))
{
MLME_DISASSOC_REQ_STRUCT DisReq;
MLME_QUEUE_ELEM *MsgElem;
os_alloc_mem(NULL, (UCHAR **)&MsgElem, sizeof(MLME_QUEUE_ELEM));
if (MsgElem)
{
COPY_MAC_ADDR(DisReq.Addr, pAd->CommonCfg.Bssid);
DisReq.Reason = REASON_DEAUTH_STA_LEAVING;
MsgElem->Machine = ASSOC_STATE_MACHINE;
MsgElem->MsgType = MT2_MLME_DISASSOC_REQ;
MsgElem->MsgLen = sizeof(MLME_DISASSOC_REQ_STRUCT);
NdisMoveMemory(MsgElem->Msg, &DisReq, sizeof(MLME_DISASSOC_REQ_STRUCT));
/* Prevent to connect AP again in STAMlmePeriodicExec*/
pAd->MlmeAux.AutoReconnectSsidLen= 32;
NdisZeroMemory(pAd->MlmeAux.AutoReconnectSsid, pAd->MlmeAux.AutoReconnectSsidLen);
pAd->Mlme.CntlMachine.CurrState = CNTL_WAIT_OID_DISASSOC;
MlmeDisassocReqAction(pAd, MsgElem);
os_free_mem(NULL, MsgElem);
}
/* RtmpusecDelay(1000);*/
RtmpOSWrielessEventSend(pAd->net_dev, RT_WLAN_EVENT_CGIWAP, -1, NULL, NULL, 0);
}
break;
case CMD_RTPRIV_IOCTL_ADAPTER_SUSPEND_TEST:
/* test driver state to fRTMP_ADAPTER_SUSPEND */
*(UCHAR *)pData = RTMP_TEST_FLAG(pAd,fRTMP_ADAPTER_SUSPEND);
break;
case CMD_RTPRIV_IOCTL_ADAPTER_IDLE_RADIO_OFF_TEST:
/* test driver state to fRTMP_ADAPTER_IDLE_RADIO_OFF */
*(UCHAR *)pData = RTMP_TEST_FLAG(pAd,fRTMP_ADAPTER_IDLE_RADIO_OFF);
break;
case CMD_RTPRIV_IOCTL_ADAPTER_RT28XX_USB_ASICRADIO_OFF:
ASIC_RADIO_OFF(pAd, SUSPEND_RADIO_OFF);
break;
case CMD_RTPRIV_IOCTL_ADAPTER_RT28XX_USB_ASICRADIO_ON:
ASIC_RADIO_ON(pAd, RESUME_RADIO_ON);
break;
#endif /* USB_SUPPORT_SELECTIVE_SUSPEND */
#if (defined(WOW_SUPPORT) && defined(RTMP_MAC_USB)) || defined(NEW_WOW_SUPPORT)
case CMD_RTPRIV_IOCTL_ADAPTER_RT28XX_WOW_STATUS:
*(UCHAR *)pData = (UCHAR)pAd->WOW_Cfg.bEnable;
break;
case CMD_RTPRIV_IOCTL_ADAPTER_RT28XX_WOW_ENABLE:
ASIC_WOW_ENABLE(pAd);
break;
case CMD_RTPRIV_IOCTL_ADAPTER_RT28XX_WOW_DISABLE:
ASIC_WOW_DISABLE(pAd);
break;
#endif /* (defined(WOW_SUPPORT) && defined(RTMP_MAC_USB)) || defined(NEW_WOW_SUPPORT) */
#endif /* CONFIG_PM */
case CMD_RTPRIV_IOCTL_AP_BSSID_GET:
if (pAd->StaCfg.wdev.PortSecured == WPA_802_1X_PORT_NOT_SECURED)
NdisCopyMemory(pData, pAd->MlmeAux.Bssid, 6);
else
return NDIS_STATUS_FAILURE;
break;
case CMD_RTPRIV_IOCTL_ADAPTER_SUSPEND_SET:
/* set driver state to fRTMP_ADAPTER_SUSPEND */
RTMP_SET_FLAG(pAd,fRTMP_ADAPTER_SUSPEND);
break;
case CMD_RTPRIV_IOCTL_ADAPTER_SUSPEND_CLEAR:
/* clear driver state to fRTMP_ADAPTER_SUSPEND */
RTMP_CLEAR_FLAG(pAd,fRTMP_ADAPTER_SUSPEND);
break;
case CMD_RTPRIV_IOCTL_ADAPTER_RT28XX_USB_ASICRADIO_OFF:
/* RT28xxUsbAsicRadioOff */
//RT28xxUsbAsicRadioOff(pAd);
ASIC_RADIO_OFF(pAd, SUSPEND_RADIO_OFF);
break;
case CMD_RTPRIV_IOCTL_ADAPTER_RT28XX_USB_ASICRADIO_ON:
/* RT28xxUsbAsicRadioOn */
//RT28xxUsbAsicRadioOn(pAd);
ASIC_RADIO_ON(pAd, RESUME_RADIO_ON);
break;
#endif /* CONFIG_STA_SUPPORT */
case CMD_RTPRIV_IOCTL_SANITY_CHECK:
/* sanity check before IOCTL */
if ((!RTMP_TEST_FLAG(pAd, fRTMP_ADAPTER_INTERRUPT_IN_USE))
#ifdef IFUP_IN_PROBE
|| (RTMP_TEST_FLAG(pAd, fRTMP_ADAPTER_RESET_IN_PROGRESS))
|| (RTMP_TEST_FLAG(pAd, fRTMP_ADAPTER_HALT_IN_PROGRESS))
|| (RTMP_TEST_FLAG(pAd, fRTMP_ADAPTER_NIC_NOT_EXIST))
#endif /* IFUP_IN_PROBE */
)
{
if(pData == NULL || RT_isLegalCmdBeforeInfUp((PSTRING) pData) == FALSE)
return NDIS_STATUS_FAILURE;
}
break;
case CMD_RTPRIV_IOCTL_SIOCGIWFREQ:
/* get channel number */
*(ULONG *)pData = pAd->CommonCfg.Channel;
break;
case CMD_RTPRIV_IOCTL_BEACON_UPDATE:
/* update all beacon contents */
#ifdef CONFIG_AP_SUPPORT
APMakeAllBssBeacon(pAd);
APUpdateAllBeaconFrame(pAd);
#endif /* CONFIG_AP_SUPPORT */
break;
case CMD_RTPRIV_IOCTL_RXPATH_GET:
/* get the number of rx path */
*(ULONG *)pData = pAd->Antenna.field.RxPath;
break;
case CMD_RTPRIV_IOCTL_CHAN_LIST_NUM_GET:
*(ULONG *)pData = pAd->ChannelListNum;
break;
case CMD_RTPRIV_IOCTL_CHAN_LIST_GET:
{
UINT32 i;
UCHAR *pChannel = (UCHAR *)pData;
for (i = 1; i <= pAd->ChannelListNum; i++)
{
*pChannel = pAd->ChannelList[i-1].Channel;
pChannel ++;
}
}
break;
case CMD_RTPRIV_IOCTL_FREQ_LIST_GET:
{
UINT32 i;
UINT32 *pFreq = (UINT32 *)pData;
UINT32 m;
for (i = 1; i <= pAd->ChannelListNum; i++)
{
m = 2412000;
MAP_CHANNEL_ID_TO_KHZ(pAd->ChannelList[i-1].Channel, m);
(*pFreq) = m;
pFreq ++;
}
}
break;
#ifdef EXT_BUILD_CHANNEL_LIST
case CMD_RTPRIV_SET_PRECONFIG_VALUE:
/* Set some preconfigured value before interface up*/
pAd->CommonCfg.DfsType = MAX_RD_REGION;
break;
#endif /* EXT_BUILD_CHANNEL_LIST */
#ifdef RTMP_USB_SUPPORT
case CMD_RTPRIV_IOCTL_USB_MORE_FLAG_SET:
{
RT_CMD_USB_MORE_FLAG_CONFIG *pConfig;
UINT32 VendorID, ProductID;
pConfig = (RT_CMD_USB_MORE_FLAG_CONFIG *)pData;
VendorID = pConfig->VendorID;
ProductID = pConfig->ProductID;
if (VendorID == 0x0DB0)
{
if ((ProductID == 0x871C) || (ProductID == 0x822C))
{
RTMP_SET_MORE_FLAG(pAd, (fRTMP_ADAPTER_DISABLE_DOT_11N | fRTMP_ADAPTER_WSC_PBC_PIN0));
}
if ((ProductID == 0x871A) || (ProductID == 0x822A))
{
RTMP_SET_MORE_FLAG(pAd, fRTMP_ADAPTER_DISABLE_DOT_11N);
}
if ((ProductID == 0x871B) || (ProductID == 0x822B))
{
RTMP_SET_MORE_FLAG(pAd, fRTMP_ADAPTER_WSC_PBC_PIN0);
}
}
if (VendorID == 0x07D1)
{
if (ProductID == 0x3C0F)
RTMP_SET_MORE_FLAG(pAd, fRTMP_ADAPTER_DISABLE_DOT_11N);
}
}
break;
case CMD_RTPRIV_IOCTL_USB_CONFIG_INIT:
{
RT_CMD_USB_DEV_CONFIG *pConfig;
UINT32 i;
pConfig = (RT_CMD_USB_DEV_CONFIG *)pData;
pAd->NumberOfPipes = pConfig->NumberOfPipes;
pAd->BulkInMaxPacketSize = pConfig->BulkInMaxPacketSize;
pAd->BulkOutMaxPacketSize = pConfig->BulkOutMaxPacketSize;
for (i = 0; i < 6; i++)
pAd->BulkOutEpAddr[i] = pConfig->BulkOutEpAddr[i];
for (i = 0; i < 2; i++)
pAd->BulkInEpAddr[i] = pConfig->BulkInEpAddr[i];
pAd->config = pConfig->pConfig;
}
break;
case CMD_RTPRIV_IOCTL_USB_SUSPEND:
pAd->PM_FlgSuspend = 1;
if (Data)
{
RTUSBCancelPendingBulkInIRP(pAd);
RTUSBCancelPendingBulkOutIRP(pAd);
}
break;
case CMD_RTPRIV_IOCTL_USB_RESUME:
pAd->PM_FlgSuspend = 0;
break;
case CMD_RTPRIV_IOCTL_USB_INIT:
InitUSBDevice(pData, pAd);
break;
#endif /* RTMP_USB_SUPPORT */
#ifdef RT_CFG80211_SUPPORT
case CMD_RTPRIV_IOCTL_CFG80211_CFG_START:
RT_CFG80211_REINIT(pAd);
RT_CFG80211_CRDA_REG_RULE_APPLY(pAd);
break;
#endif /* RT_CFG80211_SUPPORT */
#ifdef INF_PPA_SUPPORT
case CMD_RTPRIV_IOCTL_INF_PPA_INIT:
os_alloc_mem(NULL, (UCHAR **)&(pAd->pDirectpathCb), sizeof(PPA_DIRECTPATH_CB));
break;
case CMD_RTPRIV_IOCTL_INF_PPA_EXIT:
if (ppa_hook_directpath_register_dev_fn && (pAd->PPAEnable == TRUE))
{
UINT status;
status = ppa_hook_directpath_register_dev_fn(&pAd->g_if_id, pAd->net_dev, NULL, 0);
DBGPRINT(RT_DEBUG_TRACE, ("Unregister PPA::status=%d, if_id=%d\n", status, pAd->g_if_id));
}
os_free_mem(NULL, pAd->pDirectpathCb);
break;
#endif /* INF_PPA_SUPPORT*/
case CMD_RTPRIV_IOCTL_VIRTUAL_INF_UP:
/* interface up */
{
RT_CMD_INF_UP_DOWN *pInfConf = (RT_CMD_INF_UP_DOWN *)pData;
if (VIRTUAL_IF_NUM(pAd) == 0)
{
if (pInfConf->rt28xx_open(pAd->net_dev) != 0)
{
DBGPRINT(RT_DEBUG_TRACE, ("rt28xx_open return fail!\n"));
return NDIS_STATUS_FAILURE;
}
}
else
{
#ifdef CONFIG_AP_SUPPORT
extern VOID APMakeAllBssBeacon(IN PRTMP_ADAPTER pAd);
extern VOID APUpdateAllBeaconFrame(IN PRTMP_ADAPTER pAd);
APMakeAllBssBeacon(pAd);
APUpdateAllBeaconFrame(pAd);
#endif /* CONFIG_AP_SUPPORT */
}
VIRTUAL_IF_INC(pAd);
}
break;
case CMD_RTPRIV_IOCTL_VIRTUAL_INF_DOWN:
/* interface down */
{
RT_CMD_INF_UP_DOWN *pInfConf = (RT_CMD_INF_UP_DOWN *)pData;
VIRTUAL_IF_DEC(pAd);
if (VIRTUAL_IF_NUM(pAd) == 0)
pInfConf->rt28xx_close(pAd->net_dev);
}
break;
case CMD_RTPRIV_IOCTL_VIRTUAL_INF_GET:
/* get virtual interface number */
*(ULONG *)pData = VIRTUAL_IF_NUM(pAd);
break;
case CMD_RTPRIV_IOCTL_INF_TYPE_GET:
/* get current interface type */
*(ULONG *)pData = pAd->infType;
break;
case CMD_RTPRIV_IOCTL_INF_STATS_GET:
/* get statistics */
{
RT_CMD_STATS *pStats = (RT_CMD_STATS *)pData;
pStats->pStats = pAd->stats;
if(pAd->OpMode == OPMODE_STA)
{
pStats->rx_packets = pAd->WlanCounters.ReceivedFragmentCount.QuadPart;
pStats->tx_packets = pAd->WlanCounters.TransmittedFragmentCount.QuadPart;
pStats->rx_bytes = pAd->RalinkCounters.ReceivedByteCount;
pStats->tx_bytes = pAd->RalinkCounters.TransmittedByteCount;
pStats->rx_errors = pAd->Counters8023.RxErrors;
pStats->tx_errors = pAd->Counters8023.TxErrors;
pStats->multicast = pAd->WlanCounters.MulticastReceivedFrameCount.QuadPart; /* multicast packets received*/
pStats->collisions = 0; /* Collision packets*/
pStats->rx_over_errors = pAd->Counters8023.RxNoBuffer; /* receiver ring buff overflow*/
pStats->rx_crc_errors = 0;/*pAd->WlanCounters.FCSErrorCount; recved pkt with crc error*/
pStats->rx_frame_errors = 0; /* recv'd frame alignment error*/
pStats->rx_fifo_errors = pAd->Counters8023.RxNoBuffer; /* recv'r fifo overrun*/
}
#ifdef CONFIG_AP_SUPPORT
else if(pAd->OpMode == OPMODE_AP)
{
INT index;
for(index = 0; index < MAX_MBSSID_NUM(pAd); index++)
{
if (pAd->ApCfg.MBSSID[index].wdev.if_dev == (PNET_DEV)(pStats->pNetDev))
{
break;
}
}
if(index >= MAX_MBSSID_NUM(pAd))
{
//reset counters
pStats->rx_packets = 0;
pStats->tx_packets = 0;
pStats->rx_bytes = 0;
pStats->tx_bytes = 0;
pStats->rx_errors = 0;
pStats->tx_errors = 0;
pStats->multicast = 0; /* multicast packets received*/
pStats->collisions = 0; /* Collision packets*/
pStats->rx_over_errors = 0; /* receiver ring buff overflow*/
pStats->rx_crc_errors = 0; /* recved pkt with crc error*/
pStats->rx_frame_errors = 0; /* recv'd frame alignment error*/
pStats->rx_fifo_errors = 0; /* recv'r fifo overrun*/
DBGPRINT(RT_DEBUG_ERROR, ("CMD_RTPRIV_IOCTL_INF_STATS_GET: can not find mbss I/F\n"));
return NDIS_STATUS_FAILURE;
}
pStats->rx_packets = pAd->ApCfg.MBSSID[index].RxCount;
pStats->tx_packets = pAd->ApCfg.MBSSID[index].TxCount;
pStats->rx_bytes = pAd->ApCfg.MBSSID[index].ReceivedByteCount;
pStats->tx_bytes = pAd->ApCfg.MBSSID[index].TransmittedByteCount;
pStats->rx_errors = pAd->ApCfg.MBSSID[index].RxErrorCount;
pStats->tx_errors = pAd->ApCfg.MBSSID[index].TxErrorCount;
pStats->multicast = pAd->ApCfg.MBSSID[index].mcPktsRx; /* multicast packets received */
pStats->collisions = 0; /* Collision packets*/
pStats->rx_over_errors = 0; /* receiver ring buff overflow*/
pStats->rx_crc_errors = 0;/* recved pkt with crc error*/
pStats->rx_frame_errors = 0; /* recv'd frame alignment error*/
pStats->rx_fifo_errors = 0; /* recv'r fifo overrun*/
}
#endif
}
break;
case CMD_RTPRIV_IOCTL_INF_IW_STATUS_GET:
/* get wireless statistics */
{
UCHAR CurOpMode = OPMODE_AP;
#ifdef CONFIG_AP_SUPPORT
PMAC_TABLE_ENTRY pMacEntry = NULL;
#endif /* CONFIG_AP_SUPPORT */
RT_CMD_IW_STATS *pStats = (RT_CMD_IW_STATS *)pData;
pStats->qual = 0;
pStats->level = 0;
pStats->noise = 0;
pStats->pStats = pAd->iw_stats;
#ifdef CONFIG_STA_SUPPORT
if (pAd->OpMode == OPMODE_STA)
{
CurOpMode = OPMODE_STA;
}
#endif /* CONFIG_STA_SUPPORT */
/*check if the interface is down*/
if(!RTMP_TEST_FLAG(pAd, fRTMP_ADAPTER_INTERRUPT_IN_USE))
return NDIS_STATUS_FAILURE;
#ifdef CONFIG_AP_SUPPORT
if (CurOpMode == OPMODE_AP)
{
#ifdef APCLI_SUPPORT
if ((pStats->priv_flags == INT_APCLI)
)
{
INT ApCliIdx = ApCliIfLookUp(pAd, (PUCHAR)pStats->dev_addr);
if ((ApCliIdx >= 0) && VALID_WCID(pAd->ApCfg.ApCliTab[ApCliIdx].MacTabWCID))
pMacEntry = &pAd->MacTab.Content[pAd->ApCfg.ApCliTab[ApCliIdx].MacTabWCID];
}
else
#endif /* APCLI_SUPPORT */
{
/*
only AP client support wireless stats function.
return NULL pointer for all other cases.
*/
pMacEntry = NULL;
}
}
#endif /* CONFIG_AP_SUPPORT */
#ifdef CONFIG_STA_SUPPORT
if (CurOpMode == OPMODE_STA)
pStats->qual = ((pAd->Mlme.ChannelQuality * 12)/10 + 10);
#endif /* CONFIG_STA_SUPPORT */
#ifdef CONFIG_AP_SUPPORT
if (CurOpMode == OPMODE_AP)
{
if (pMacEntry != NULL)
pStats->qual = ((pMacEntry->ChannelQuality * 12)/10 + 10);
else
pStats->qual = ((pAd->Mlme.ChannelQuality * 12)/10 + 10);
}
#endif /* CONFIG_AP_SUPPORT */
if (pStats->qual > 100)
pStats->qual = 100;
#ifdef CONFIG_STA_SUPPORT
if (CurOpMode == OPMODE_STA)
{
pStats->level =
RTMPMaxRssi(pAd, pAd->StaCfg.RssiSample.AvgRssi0,
pAd->StaCfg.RssiSample.AvgRssi1,
pAd->StaCfg.RssiSample.AvgRssi2);
}
#endif /* CONFIG_STA_SUPPORT */
#ifdef CONFIG_AP_SUPPORT
if (CurOpMode == OPMODE_AP)
{
if (pMacEntry != NULL)
pStats->level =
RTMPMaxRssi(pAd, pMacEntry->RssiSample.AvgRssi0,
pMacEntry->RssiSample.AvgRssi1,
pMacEntry->RssiSample.AvgRssi2);
}
#endif /* CONFIG_AP_SUPPORT */
#ifdef CONFIG_AP_SUPPORT
pStats->noise = RTMPMaxRssi(pAd, pAd->ApCfg.RssiSample.AvgRssi0,
pAd->ApCfg.RssiSample.AvgRssi1,
pAd->ApCfg.RssiSample.AvgRssi2) -
RTMPMinSnr(pAd, pAd->ApCfg.RssiSample.AvgSnr0,
pAd->ApCfg.RssiSample.AvgSnr1);
#endif /* CONFIG_AP_SUPPORT */
#ifdef CONFIG_STA_SUPPORT
pStats->noise = RTMPMaxRssi(pAd, pAd->StaCfg.RssiSample.AvgRssi0,
pAd->StaCfg.RssiSample.AvgRssi1,
pAd->StaCfg.RssiSample.AvgRssi2) -
RTMPMinSnr(pAd, pAd->StaCfg.RssiSample.AvgSnr0,
pAd->StaCfg.RssiSample.AvgSnr1);
#endif /* CONFIG_STA_SUPPORT */
}
break;
case CMD_RTPRIV_IOCTL_INF_MAIN_CREATE:
*(VOID **)pData = RtmpPhyNetDevMainCreate(pAd);
break;
case CMD_RTPRIV_IOCTL_INF_MAIN_ID_GET:
*(ULONG *)pData = INT_MAIN;
break;
case CMD_RTPRIV_IOCTL_INF_MAIN_CHECK:
if (Data != INT_MAIN)
return NDIS_STATUS_FAILURE;
break;
case CMD_RTPRIV_IOCTL_INF_P2P_CHECK:
if (Data != INT_P2P)
return NDIS_STATUS_FAILURE;
break;
#ifdef RALINK_ATE
#endif /* RALINK_ATE */
case CMD_RTPRIV_IOCTL_MAC_ADDR_GET:
{
UCHAR mac_addr[MAC_ADDR_LEN];
USHORT Addr01, Addr23, Addr45;
RT28xx_EEPROM_READ16(pAd, 0x04, Addr01);
RT28xx_EEPROM_READ16(pAd, 0x06, Addr23);
RT28xx_EEPROM_READ16(pAd, 0x08, Addr45);
mac_addr[0] = (UCHAR)(Addr01 & 0xff);
mac_addr[1] = (UCHAR)(Addr01 >> 8);
mac_addr[2] = (UCHAR)(Addr23 & 0xff);
mac_addr[3] = (UCHAR)(Addr23 >> 8);
mac_addr[4] = (UCHAR)(Addr45 & 0xff);
mac_addr[5] = (UCHAR)(Addr45 >> 8);
for(i=0; i<6; i++)
*(UCHAR *)(pData+i) = mac_addr[i];
break;
}
#ifdef CONFIG_AP_SUPPORT
case CMD_RTPRIV_IOCTL_AP_SIOCGIWRATEQ:
/* handle for SIOCGIWRATEQ */
{
RT_CMD_IOCTL_RATE *pRate = (RT_CMD_IOCTL_RATE *)pData;
HTTRANSMIT_SETTING HtPhyMode;
UINT8 BW = 0, GI = 0, MCS = 0;
#ifdef APCLI_SUPPORT
if (pRate->priv_flags == INT_APCLI)
memcpy(&HtPhyMode, &pAd->ApCfg.ApCliTab[pObj->ioctl_if].wdev.HTPhyMode, sizeof(HTTRANSMIT_SETTING));
else
#endif /* APCLI_SUPPORT */
{
memcpy(&HtPhyMode, &pAd->ApCfg.MBSSID[pObj->ioctl_if].wdev.HTPhyMode, sizeof(HTTRANSMIT_SETTING));
#ifdef MBSS_SUPPORT
/* reset phy mode for MBSS */
MBSS_PHY_MODE_RESET(pObj->ioctl_if, HtPhyMode);
#endif /* MBSS_SUPPORT */
}
#ifdef DOT11_VHT_AC
if (HtPhyMode.field.BW == BW_40 && pAd->CommonCfg.vht_bw == VHT_BW_80 && HtPhyMode.field.MODE >= MODE_VHT) {
BW = 2;
GI = pAd->CommonCfg.vht_sgi_80;
}
else
#endif /* DOT11_VHT_AC */
{
BW = HtPhyMode.field.BW;
GI = HtPhyMode.field.ShortGI;
}
RtmpDrvRateGet(pAd, HtPhyMode.field.MODE, GI,
BW, HtPhyMode.field.MCS,
pAd->Antenna.field.TxPath,
(UINT32 *)&pRate->BitRate);
}
break;
#endif /* CONFIG_AP_SUPPORT */
case CMD_RTPRIV_IOCTL_SIOCGIWNAME:
RtmpIoctl_rt_ioctl_giwname(pAd, pData, 0);
break;
}
#ifdef RT_CFG80211_SUPPORT
if ((CMD_RTPRIV_IOCTL_80211_START <= cmd) &&
(cmd <= CMD_RTPRIV_IOCTL_80211_END))
{
Status = CFG80211DRV_IoctlHandle(pAd, wrq, cmd, subcmd, pData, Data);
}
#endif /* RT_CFG80211_SUPPORT */
if (cmd >= CMD_RTPRIV_IOCTL_80211_COM_LATEST_ONE)
return NDIS_STATUS_FAILURE;
return Status;
}
INT RTMP_COM_IoctlHandle(
IN VOID *pAdSrc,
IN RTMP_IOCTL_INPUT_STRUCT *wrq,
IN INT cmd,
IN USHORT subcmd,
IN VOID *pData,
IN ULONG Data)
{
PRTMP_ADAPTER pAd = (PRTMP_ADAPTER)pAdSrc;
POS_COOKIE pObj = (POS_COOKIE)pAd->OS_Cookie;
INT Status = NDIS_STATUS_SUCCESS, i;
UCHAR PermanentAddress[MAC_ADDR_LEN];
USHORT Addr01, Addr23, Addr45;
pObj = pObj; /* avoid compile warning */
switch(cmd)
{
case CMD_RTPRIV_IOCTL_NETDEV_GET:
/* get main net_dev */
{
VOID **ppNetDev = (VOID **)pData;
*ppNetDev = (VOID *)(pAd->net_dev);
}
break;
case CMD_RTPRIV_IOCTL_NETDEV_SET:
/* set main net_dev */
pAd->net_dev = pData;
#ifdef CONFIG_AP_SUPPORT
pAd->ApCfg.MBSSID[MAIN_MBSSID].MSSIDDev = pData;
#endif /* CONFIG_AP_SUPPORT */
break;
case CMD_RTPRIV_IOCTL_OPMODE_GET:
/* get Operation Mode */
*(ULONG *)pData = pAd->OpMode;
break;
case CMD_RTPRIV_IOCTL_TASK_LIST_GET:
/* get all Tasks */
{
RT_CMD_WAIT_QUEUE_LIST *pList = (RT_CMD_WAIT_QUEUE_LIST *)pData;
pList->pMlmeTask = &pAd->mlmeTask;
#ifdef RTMP_TIMER_TASK_SUPPORT
pList->pTimerTask = &pAd->timerTask;
#endif /* RTMP_TIMER_TASK_SUPPORT */
pList->pCmdQTask = &pAd->cmdQTask;
#ifdef WSC_INCLUDED
pList->pWscTask = &pAd->wscTask;
#endif /* WSC_INCLUDED */
}
break;
case CMD_RTPRIV_IOCTL_IRQ_INIT:
/* init IRQ */
RTMP_IRQ_INIT(pAd);
break;
case CMD_RTPRIV_IOCTL_IRQ_RELEASE:
/* release IRQ */
RTMP_OS_IRQ_RELEASE(pAd, pAd->net_dev);
break;
case CMD_RTPRIV_IOCTL_NIC_NOT_EXIST:
/* set driver state to fRTMP_ADAPTER_NIC_NOT_EXIST */
RTMP_SET_FLAG(pAd, fRTMP_ADAPTER_NIC_NOT_EXIST);
break;
case CMD_RTPRIV_IOCTL_MCU_SLEEP_CLEAR:
RTMP_CLEAR_PSFLAG(pAd, fRTMP_PS_MCU_SLEEP);
break;
#ifdef CONFIG_APSTA_MIXED_SUPPORT
case CMD_RTPRIV_IOCTL_MAX_IN_BIT:
/* set MAX_IN_BIT for WMM */
CW_MAX_IN_BITS = Data;
break;
#endif /* CONFIG_APSTA_MIXED_SUPPORT */
case CMD_RTPRIV_IOCTL_ADAPTER_SUSPEND_SET:
/* set driver state to fRTMP_ADAPTER_SUSPEND */
RTMP_SET_FLAG(pAd,fRTMP_ADAPTER_SUSPEND);
break;
case CMD_RTPRIV_IOCTL_ADAPTER_SUSPEND_CLEAR:
/* clear driver state to fRTMP_ADAPTER_SUSPEND */
RTMP_CLEAR_FLAG(pAd,fRTMP_ADAPTER_SUSPEND);
break;
case CMD_RTPRIV_IOCTL_ADAPTER_RT28XX_USB_ASICRADIO_OFF:
/* RT28xxUsbAsicRadioOff */
//RT28xxUsbAsicRadioOff(pAd);
ASIC_RADIO_OFF(pAd, SUSPEND_RADIO_OFF);
break;
case CMD_RTPRIV_IOCTL_ADAPTER_RT28XX_USB_ASICRADIO_ON:
/* RT28xxUsbAsicRadioOn */
//RT28xxUsbAsicRadioOn(pAd);
ASIC_RADIO_ON(pAd, RESUME_RADIO_ON);
break;
case CMD_RTPRIV_IOCTL_SANITY_CHECK:
/* sanity check before IOCTL */
if ((!RTMP_TEST_FLAG(pAd, fRTMP_ADAPTER_INTERRUPT_IN_USE))
#ifdef IFUP_IN_PROBE
|| (RTMP_TEST_FLAG(pAd, fRTMP_ADAPTER_RESET_IN_PROGRESS))
|| (RTMP_TEST_FLAG(pAd, fRTMP_ADAPTER_HALT_IN_PROGRESS))
|| (RTMP_TEST_FLAG(pAd, fRTMP_ADAPTER_NIC_NOT_EXIST))
#endif /* IFUP_IN_PROBE */
)
{
if(pData == NULL || RT_isLegalCmdBeforeInfUp((PSTRING) pData) == FALSE)
return NDIS_STATUS_FAILURE;
}
break;
case CMD_RTPRIV_IOCTL_SIOCGIWFREQ:
/* get channel number */
*(ULONG *)pData = pAd->CommonCfg.Channel;
break;
case CMD_RTPRIV_IOCTL_BEACON_UPDATE:
/* update all beacon contents */
#ifdef CONFIG_AP_SUPPORT
APMakeAllBssBeacon(pAd);
APUpdateAllBeaconFrame(pAd);
#endif /* CONFIG_AP_SUPPORT */
break;
case CMD_RTPRIV_IOCTL_RXPATH_GET:
/* get the number of rx path */
*(ULONG *)pData = pAd->Antenna.field.RxPath;
break;
case CMD_RTPRIV_IOCTL_CHAN_LIST_NUM_GET:
*(ULONG *)pData = pAd->ChannelListNum;
break;
case CMD_RTPRIV_IOCTL_CHAN_LIST_GET:
{
UINT32 i;
UCHAR *pChannel = (UCHAR *)pData;
for (i = 1; i <= pAd->ChannelListNum; i++)
{
*pChannel = pAd->ChannelList[i-1].Channel;
pChannel ++;
}
}
break;
case CMD_RTPRIV_IOCTL_FREQ_LIST_GET:
{
UINT32 i;
UINT32 *pFreq = (UINT32 *)pData;
UINT32 m;
for (i = 1; i <= pAd->ChannelListNum; i++)
{
m = 2412000;
MAP_CHANNEL_ID_TO_KHZ(pAd->ChannelList[i-1].Channel, m);
(*pFreq) = m;
pFreq++;
}
}
break;
#ifdef EXT_BUILD_CHANNEL_LIST
case CMD_RTPRIV_SET_PRECONFIG_VALUE:
/* Set some preconfigured value before interface up*/
pAd->CommonCfg.DfsType = MAX_RD_REGION;
break;
#endif /* EXT_BUILD_CHANNEL_LIST */
#ifdef RTMP_USB_SUPPORT
case CMD_RTPRIV_IOCTL_USB_MORE_FLAG_SET:
{
RT_CMD_USB_MORE_FLAG_CONFIG *pConfig;
UINT32 VendorID, ProductID;
pConfig = (RT_CMD_USB_MORE_FLAG_CONFIG *)pData;
VendorID = pConfig->VendorID;
ProductID = pConfig->ProductID;
if (VendorID == 0x0DB0)
{
if ((ProductID == 0x871C) || (ProductID == 0x822C))
RTMP_SET_MORE_FLAG(pAd, (fRTMP_ADAPTER_DISABLE_DOT_11N | fRTMP_ADAPTER_WSC_PBC_PIN0));
if ((ProductID == 0x871A) || (ProductID == 0x822A))
RTMP_SET_MORE_FLAG(pAd, fRTMP_ADAPTER_DISABLE_DOT_11N);
if ((ProductID == 0x871B) || (ProductID == 0x822B))
RTMP_SET_MORE_FLAG(pAd, fRTMP_ADAPTER_WSC_PBC_PIN0);
}
if (VendorID == 0x07D1)
{
if (ProductID == 0x3C0F)
RTMP_SET_MORE_FLAG(pAd, fRTMP_ADAPTER_DISABLE_DOT_11N);
}
}
break;
case CMD_RTPRIV_IOCTL_USB_CONFIG_INIT:
{
RT_CMD_USB_DEV_CONFIG *pConfig;
UINT32 i;
pConfig = (RT_CMD_USB_DEV_CONFIG *)pData;
pAd->NumberOfPipes = pConfig->NumberOfPipes;
pAd->BulkInMaxPacketSize = pConfig->BulkInMaxPacketSize;
pAd->BulkOutMaxPacketSize = pConfig->BulkOutMaxPacketSize;
for (i = 0; i < 6; i++) {
pAd->BulkOutEpAddr[i] = pConfig->BulkOutEpAddr[i];
DBGPRINT(RT_DEBUG_OFF, ("%s():pAd->BulkOutEpAddr=0x%x\n", __FUNCTION__, pAd->BulkOutEpAddr[i]));
}
for (i = 0; i < 2; i++)
pAd->BulkInEpAddr[i] = pConfig->BulkInEpAddr[i];
pAd->config = pConfig->pConfig;
}
break;
case CMD_RTPRIV_IOCTL_USB_SUSPEND:
pAd->PM_FlgSuspend = 1;
if (Data)
{
RTUSBCancelPendingBulkInIRP(pAd);
RTUSBCancelPendingBulkOutIRP(pAd);
}
break;
case CMD_RTPRIV_IOCTL_USB_RESUME:
pAd->PM_FlgSuspend = 0;
break;
#endif /* RTMP_USB_SUPPORT */
#ifdef RT_CFG80211_SUPPORT
case CMD_RTPRIV_IOCTL_CFG80211_CFG_START:
RT_CFG80211_REINIT(pAd);
RT_CFG80211_CRDA_REG_RULE_APPLY(pAd);
break;
#endif /* RT_CFG80211_SUPPORT */
#ifdef INF_PPA_SUPPORT
case CMD_RTPRIV_IOCTL_INF_PPA_INIT:
os_alloc_mem(NULL, (UCHAR **)&(pAd->pDirectpathCb), sizeof(PPA_DIRECTPATH_CB));
break;
case CMD_RTPRIV_IOCTL_INF_PPA_EXIT:
if (ppa_hook_directpath_register_dev_fn && pAd->PPAEnable==TRUE)
{
UINT status;
status=ppa_hook_directpath_register_dev_fn(&pAd->g_if_id, pAd->net_dev, NULL, 0);
DBGPRINT(RT_DEBUG_TRACE, ("unregister PPA:g_if_id=%d status=%d\n",pAd->g_if_id,status));
}
os_free_mem(NULL, pAd->pDirectpathCb);
break;
#endif /* INF_PPA_SUPPORT*/
case CMD_RTPRIV_IOCTL_VIRTUAL_INF_UP:
/* interface up */
{
RT_CMD_INF_UP_DOWN *pInfConf = (RT_CMD_INF_UP_DOWN *)pData;
if (VIRTUAL_IF_NUM(pAd) == 0)
{
if (pInfConf->rt28xx_open(pAd->net_dev) != 0)
{
DBGPRINT(RT_DEBUG_TRACE, ("rt28xx_open return fail!\n"));
return NDIS_STATUS_FAILURE;
}
}
#ifdef CONFIG_AP_SUPPORT
else
{
extern VOID APMakeAllBssBeacon(IN PRTMP_ADAPTER pAd);
extern VOID APUpdateAllBeaconFrame(IN PRTMP_ADAPTER pAd);
APMakeAllBssBeacon(pAd);
APUpdateAllBeaconFrame(pAd);
#endif /* CONFIG_AP_SUPPORT */
}
VIRTUAL_IF_INC(pAd);
}
break;
case CMD_RTPRIV_IOCTL_VIRTUAL_INF_DOWN:
/* interface down */
{
RT_CMD_INF_UP_DOWN *pInfConf = (RT_CMD_INF_UP_DOWN *)pData;
VIRTUAL_IF_DEC(pAd);
if (VIRTUAL_IF_NUM(pAd) == 0)
pInfConf->rt28xx_close(pAd->net_dev);
}
break;
case CMD_RTPRIV_IOCTL_VIRTUAL_INF_GET:
/* get virtual interface number */
*(ULONG *)pData = VIRTUAL_IF_NUM(pAd);
break;
case CMD_RTPRIV_IOCTL_INF_TYPE_GET:
/* get current interface type */
*(ULONG *)pData = pAd->infType;
break;
case CMD_RTPRIV_IOCTL_INF_STATS_GET:
/* get statistics */
{
RT_CMD_STATS *pStats = (RT_CMD_STATS *)pData;
pStats->pStats = pAd->stats;
if(pAd->OpMode == OPMODE_STA)
{
pStats->rx_packets = pAd->WlanCounters.ReceivedFragmentCount.QuadPart;
pStats->tx_packets = pAd->WlanCounters.TransmittedFragmentCount.QuadPart;
pStats->rx_bytes = pAd->RalinkCounters.ReceivedByteCount;
pStats->tx_bytes = pAd->RalinkCounters.TransmittedByteCount;
pStats->rx_errors = pAd->Counters8023.RxErrors;
pStats->tx_errors = pAd->Counters8023.TxErrors;
pStats->multicast = pAd->WlanCounters.MulticastReceivedFrameCount.QuadPart; /* multicast packets received*/
pStats->collisions = pAd->Counters8023.OneCollision + pAd->Counters8023.MoreCollisions; /* Collision packets*/
pStats->rx_over_errors = pAd->Counters8023.RxNoBuffer; /* receiver ring buff overflow*/
pStats->rx_crc_errors = 0;/*pAd->WlanCounters.FCSErrorCount; recved pkt with crc error*/
pStats->rx_frame_errors = pAd->Counters8023.RcvAlignmentErrors; /* recv'd frame alignment error*/
pStats->rx_fifo_errors = pAd->Counters8023.RxNoBuffer; /* recv'r fifo overrun*/
}
#ifdef CONFIG_AP_SUPPORT
else if (pAd->OpMode == OPMODE_AP)
{
INT index;
for(index = 0; index < MAX_MBSSID_NUM(pAd); index++)
{
if (pAd->ApCfg.MBSSID[index].MSSIDDev == (PNET_DEV)(pStats->pNetDev))
break;
}
if (index >= MAX_MBSSID_NUM(pAd))
{
//reset counters
pStats->rx_packets = 0;
pStats->tx_packets = 0;
pStats->rx_bytes = 0;
pStats->tx_bytes = 0;
pStats->rx_errors = 0;
pStats->tx_errors = 0;
pStats->multicast = 0; /* multicast packets received*/
pStats->collisions = 0; /* Collision packets*/
pStats->rx_over_errors = 0; /* receiver ring buff overflow*/
pStats->rx_crc_errors = 0; /* recved pkt with crc error*/
pStats->rx_frame_errors = 0; /* recv'd frame alignment error*/
pStats->rx_fifo_errors = 0; /* recv'r fifo overrun*/
DBGPRINT(RT_DEBUG_ERROR, ("CMD_RTPRIV_IOCTL_INF_STATS_GET: can not find mbss I/F\n"));
return NDIS_STATUS_FAILURE;
}
pStats->rx_packets = pAd->ApCfg.MBSSID[index].RxCount;
pStats->tx_packets = pAd->ApCfg.MBSSID[index].TxCount;
pStats->rx_bytes = pAd->ApCfg.MBSSID[index].ReceivedByteCount;
pStats->tx_bytes = pAd->ApCfg.MBSSID[index].TransmittedByteCount;
pStats->rx_errors = pAd->ApCfg.MBSSID[index].RxErrorCount;
pStats->tx_errors = pAd->ApCfg.MBSSID[index].TxErrorCount;
pStats->multicast = pAd->ApCfg.MBSSID[index].mcPktsRx; /* multicast packets received */
pStats->collisions = 0; /* Collision packets*/
pStats->rx_over_errors = 0; /* receiver ring buff overflow*/
pStats->rx_crc_errors = 0; /* recved pkt with crc error*/
pStats->rx_frame_errors = 0; /* recv'd frame alignment error*/
pStats->rx_fifo_errors = 0; /* recv'r fifo overrun*/
}
#endif
}
break;
case CMD_RTPRIV_IOCTL_INF_IW_STATUS_GET:
/* get wireless statistics */
{
UCHAR CurOpMode = OPMODE_AP;
#ifdef CONFIG_AP_SUPPORT
PMAC_TABLE_ENTRY pMacEntry = NULL;
#endif /* CONFIG_AP_SUPPORT */
RT_CMD_IW_STATS *pStats = (RT_CMD_IW_STATS *)pData;
pStats->qual = 0;
pStats->level = 0;
pStats->noise = 0;
pStats->pStats = pAd->iw_stats;
/*check if the interface is down*/
if(!RTMP_TEST_FLAG(pAd, fRTMP_ADAPTER_INTERRUPT_IN_USE))
return NDIS_STATUS_FAILURE;
#ifdef CONFIG_AP_SUPPORT
if (CurOpMode == OPMODE_AP)
{
#ifdef APCLI_SUPPORT
if ((pStats->priv_flags == INT_APCLI))
{
INT ApCliIdx = ApCliIfLookUp(pAd, (PUCHAR)pStats->dev_addr);
if ((ApCliIdx >= 0) && VALID_WCID(pAd->ApCfg.ApCliTab[ApCliIdx].MacTabWCID))
pMacEntry = &pAd->MacTab.Content[pAd->ApCfg.ApCliTab[ApCliIdx].MacTabWCID];
}
else
#endif /* APCLI_SUPPORT */
{
/*
only AP client support wireless stats function.
return NULL pointer for all other cases.
*/
pMacEntry = NULL;
}
}
#endif /* CONFIG_AP_SUPPORT */
#ifdef CONFIG_AP_SUPPORT
if (CurOpMode == OPMODE_AP)
{
if (pMacEntry != NULL)
pStats->qual = ((pMacEntry->ChannelQuality * 12) / 10 + 10);
else
pStats->qual = ((pAd->Mlme.ChannelQuality * 12) / 10 + 10);
}
#endif /* CONFIG_AP_SUPPORT */
if (pStats->qual > 100)
pStats->qual = 100;
#ifdef CONFIG_AP_SUPPORT
if (CurOpMode == OPMODE_AP)
{
if (pMacEntry != NULL)
pStats->level = RTMPMaxRssi(pAd, pMacEntry->RssiSample.AvgRssi0,
pMacEntry->RssiSample.AvgRssi1,
pMacEntry->RssiSample.AvgRssi2);
}
#endif /* CONFIG_AP_SUPPORT */
#ifdef CONFIG_AP_SUPPORT
pStats->noise = RTMPMaxRssi(pAd, pAd->ApCfg.RssiSample.AvgRssi0,
pAd->ApCfg.RssiSample.AvgRssi1,
pAd->ApCfg.RssiSample.AvgRssi2) -
RTMPMinSnr(pAd, pAd->ApCfg.RssiSample.AvgSnr0,
pAd->ApCfg.RssiSample.AvgSnr1);
#endif /* CONFIG_AP_SUPPORT */
}
break;
case CMD_RTPRIV_IOCTL_INF_MAIN_CREATE:
*(VOID **)pData = RtmpPhyNetDevMainCreate(pAd);
break;
case CMD_RTPRIV_IOCTL_INF_MAIN_ID_GET:
*(ULONG *)pData = INT_MAIN;
break;
case CMD_RTPRIV_IOCTL_INF_MAIN_CHECK:
if (Data != INT_MAIN)
return NDIS_STATUS_FAILURE;
break;
case CMD_RTPRIV_IOCTL_INF_P2P_CHECK:
if (Data != INT_P2P)
return NDIS_STATUS_FAILURE;
break;
#ifdef WDS_SUPPORT
case CMD_RTPRIV_IOCTL_WDS_INIT:
WDS_Init(pAd, pData);
break;
case CMD_RTPRIV_IOCTL_WDS_REMOVE:
WDS_Remove(pAd);
break;
case CMD_RTPRIV_IOCTL_WDS_STATS_GET:
if (Data == INT_WDS)
{
if (WDS_StatsGet(pAd, pData) != TRUE)
return NDIS_STATUS_FAILURE;
}
else
return NDIS_STATUS_FAILURE;
break;
#endif /* WDS_SUPPORT */
#ifdef RALINK_ATE
#ifdef RALINK_QA
case CMD_RTPRIV_IOCTL_ATE:
RtmpDoAte(pAd, wrq, pData);
break;
#endif /* RALINK_QA */
#endif /* RALINK_ATE */
case CMD_RTPRIV_IOCTL_MAC_ADDR_GET:
RT28xx_EEPROM_READ16(pAd, 0x04, Addr01);
RT28xx_EEPROM_READ16(pAd, 0x06, Addr23);
RT28xx_EEPROM_READ16(pAd, 0x08, Addr45);
PermanentAddress[0] = (UCHAR)(Addr01 & 0xff);
PermanentAddress[1] = (UCHAR)(Addr01 >> 8);
PermanentAddress[2] = (UCHAR)(Addr23 & 0xff);
PermanentAddress[3] = (UCHAR)(Addr23 >> 8);
PermanentAddress[4] = (UCHAR)(Addr45 & 0xff);
PermanentAddress[5] = (UCHAR)(Addr45 >> 8);
for(i = 0; i < 6; i++)
*(UCHAR *)(pData+i) = PermanentAddress[i];
break;
#ifdef CONFIG_AP_SUPPORT
case CMD_RTPRIV_IOCTL_AP_SIOCGIWRATEQ:
/* handle for SIOCGIWRATEQ */
{
RT_CMD_IOCTL_RATE *pRate = (RT_CMD_IOCTL_RATE *)pData;
HTTRANSMIT_SETTING HtPhyMode;
#ifdef APCLI_SUPPORT
if (pRate->priv_flags == INT_APCLI)
HtPhyMode = pAd->ApCfg.ApCliTab[pObj->ioctl_if].HTPhyMode;
else
#endif /* APCLI_SUPPORT */
#ifdef WDS_SUPPORT
if (pRate->priv_flags == INT_WDS)
HtPhyMode = pAd->WdsTab.WdsEntry[pObj->ioctl_if].HTPhyMode;
else
#endif /* WDS_SUPPORT */
{
HtPhyMode = pAd->ApCfg.MBSSID[pObj->ioctl_if].HTPhyMode;
#ifdef MBSS_SUPPORT
/* reset phy mode for MBSS */
MBSS_PHY_MODE_RESET(pObj->ioctl_if, HtPhyMode);
#endif /* MBSS_SUPPORT */
}
RtmpDrvMaxRateGet(pAd, HtPhyMode.field.MODE, HtPhyMode.field.ShortGI,
HtPhyMode.field.BW, HtPhyMode.field.MCS,
(UINT32 *)&pRate->BitRate);
}
break;
#endif /* CONFIG_AP_SUPPORT */
case CMD_RTPRIV_IOCTL_SIOCGIWNAME:
RtmpIoctl_rt_ioctl_giwname(pAd, pData, 0);
break;
#if defined(CONFIG_CSO_SUPPORT) || defined(CONFIG_RX_CSO_SUPPORT)
case CMD_RTPRIV_IOCTL_ADAPTER_CSO_SUPPORT_TEST:
*(UCHAR *)pData = (pAd->MoreFlags & fASIC_CAP_CSO) ? 1:0;
break;
#endif /* defined(CONFIG_CSO_SUPPORT) || defined(CONFIG_RX_CSO_SUPPORT) */
}
#ifdef RT_CFG80211_SUPPORT
if ((CMD_RTPRIV_IOCTL_80211_START <= cmd) &&
(cmd <= CMD_RTPRIV_IOCTL_80211_END))
CFG80211DRV_IoctlHandle(pAd, wrq, cmd, subcmd, pData, Data);
#endif /* RT_CFG80211_SUPPORT */
if (cmd >= CMD_RTPRIV_IOCTL_80211_COM_LATEST_ONE)
return NDIS_STATUS_FAILURE;
return Status;
}
/*
========================================================================
Routine Description:
Initialize Multi-BSS function.
Arguments:
pAd points to our adapter
pDevMain points to the main BSS network interface
Return Value:
None
Note:
1. Only create and initialize virtual network interfaces.
2. No main network interface here.
3. If you down ra0 and modify the BssNum of RT2860AP.dat/RT2870AP.dat,
it will not work! You must rmmod rt2860ap.ko and lsmod rt2860ap.ko again.
========================================================================
*/
VOID RT28xx_MBSS_Init(
IN PRTMP_ADAPTER pAd,
IN PNET_DEV pDevMain)
{
PNET_DEV pDevNew;
INT32 IdBss, MaxNumBss;
INT status;
RTMP_OS_NETDEV_OP_HOOK netDevHook;
/* init */
MaxNumBss = pAd->ApCfg.BssidNum;
if (MaxNumBss > MAX_MBSSID_NUM(pAd))
MaxNumBss = MAX_MBSSID_NUM(pAd);
/* End of if */
if (!pAd->FlgMbssInit)
{
/* first IdBss must not be 0 (BSS0), must be 1 (BSS1) */
for(IdBss=FIRST_MBSSID; IdBss<MAX_MBSSID_NUM(pAd); IdBss++)
pAd->ApCfg.MBSSID[IdBss].MSSIDDev = NULL;
/* End of for */
}
/* create virtual network interface */
for(IdBss=FIRST_MBSSID; IdBss<MaxNumBss; IdBss++)
{
if (pAd->ApCfg.MBSSID[IdBss].MSSIDDev)
{
continue;
}
pDevNew = RtmpOSNetDevCreate(pAd, INT_MBSSID, IdBss, sizeof(PRTMP_ADAPTER), INF_MBSSID_DEV_NAME);
if (pDevNew == NULL)
{
/* allocation fail, exit */
pAd->ApCfg.BssidNum = IdBss; /* re-assign new MBSS number */
DBGPRINT(RT_DEBUG_ERROR, ("Allocate network device fail (MBSS)...\n"));
break;
}
else
{
DBGPRINT(RT_DEBUG_TRACE, ("Register MBSSID IF (%s)\n", RTMP_OS_NETDEV_GET_DEVNAME(pDevNew)));
}
RTMP_OS_NETDEV_SET_PRIV(pDevNew, pAd);
/* init operation functions and flags */
NdisZeroMemory(&netDevHook, sizeof(netDevHook));
netDevHook.open = MBSS_VirtualIF_Open; // device opem hook point
netDevHook.stop = MBSS_VirtualIF_Close; // device close hook point
netDevHook.xmit = MBSS_VirtualIF_PacketSend; // hard transmit hook point
netDevHook.ioctl = MBSS_VirtualIF_Ioctl; // ioctl hook point
netDevHook.priv_flags = INT_MBSSID; // We are virtual interface
netDevHook.needProtcted = TRUE;
/* Init MAC address of virtual network interface */
NdisMoveMemory(&netDevHook.devAddr[0], &pAd->ApCfg.MBSSID[IdBss].Bssid[0], MAC_ADDR_LEN);
/* backup our virtual network interface */
pAd->ApCfg.MBSSID[IdBss].MSSIDDev = pDevNew;
/* register this device to OS */
status = RtmpOSNetDevAttach(pDevNew, &netDevHook);
}
pAd->FlgMbssInit = TRUE;
}
/*
========================================================================
Routine Description:
Send log message through wireless event
Support standard iw_event with IWEVCUSTOM. It is used below.
iwreq_data.data.flags is used to store event_flag that is defined by user.
iwreq_data.data.length is the length of the event log.
The format of the event log is composed of the entry's MAC address and
the desired log message (refer to pWirelessEventText).
ex: 11:22:33:44:55:66 has associated successfully
p.s. The requirement of Wireless Extension is v15 or newer.
========================================================================
*/
VOID RtmpDrvSendWirelessEvent(
IN VOID *pAdSrc,
IN USHORT Event_flag,
IN PUCHAR pAddr,
IN UCHAR BssIdx,
IN CHAR Rssi)
{
PRTMP_ADAPTER pAd = (PRTMP_ADAPTER)pAdSrc;
PSTRING pBuf = NULL, pBufPtr = NULL;
USHORT event, type, BufLen;
UCHAR event_table_len = 0;
if (pAd->CommonCfg.bWirelessEvent == FALSE)
return;
type = Event_flag & 0xFF00;
event = Event_flag & 0x00FF;
switch (type)
{
case IW_SYS_EVENT_FLAG_START:
event_table_len = IW_SYS_EVENT_TYPE_NUM;
break;
#ifdef IDS_SUPPORT
case IW_SPOOF_EVENT_FLAG_START:
event_table_len = IW_SPOOF_EVENT_TYPE_NUM;
break;
case IW_FLOOD_EVENT_FLAG_START:
event_table_len = IW_FLOOD_EVENT_TYPE_NUM;
break;
#endif /* IDS_SUPPORT */
}
if (event_table_len == 0)
{
DBGPRINT(RT_DEBUG_ERROR, ("%s : The type(%0x02x) is not valid.\n", __FUNCTION__, type));
return;
}
if (event >= event_table_len)
{
DBGPRINT(RT_DEBUG_ERROR, ("%s : The event(%0x02x) is not valid.\n", __FUNCTION__, event));
return;
}
/*Allocate memory and copy the msg. */
/* if((pBuf = kmalloc(IW_CUSTOM_MAX_LEN, GFP_ATOMIC)) != NULL) */
os_alloc_mem(NULL, (UCHAR **)&pBuf, IW_CUSTOM_MAX_LEN);
if(pBuf != NULL)
{
/*Prepare the payload */
memset(pBuf, 0, IW_CUSTOM_MAX_LEN);
pBufPtr = pBuf;
if (pAddr)
pBufPtr += sprintf(pBufPtr, "(RT2860) STA(%02x:%02x:%02x:%02x:%02x:%02x) ", PRINT_MAC(pAddr));
else if (BssIdx < MAX_MBSSID_NUM(pAd))
pBufPtr += sprintf(pBufPtr, "(RT2860) BSS(ra%d) ", BssIdx);
else
pBufPtr += sprintf(pBufPtr, "(RT2860) ");
if (type == IW_SYS_EVENT_FLAG_START)
{
pBufPtr += sprintf(pBufPtr, "%s", pWirelessSysEventText[event]);
if (Event_flag == IW_CHANNEL_CHANGE_EVENT_FLAG)
{
pBufPtr += sprintf(pBufPtr, "%3d", Rssi);
}
}
#ifdef IDS_SUPPORT
else if (type == IW_SPOOF_EVENT_FLAG_START)
pBufPtr += sprintf(pBufPtr, "%s (RSSI=%d)", pWirelessSpoofEventText[event], Rssi);
else if (type == IW_FLOOD_EVENT_FLAG_START)
pBufPtr += sprintf(pBufPtr, "%s", pWirelessFloodEventText[event]);
#endif /* IDS_SUPPORT */
else
pBufPtr += sprintf(pBufPtr, "%s", "unknown event");
pBufPtr[pBufPtr - pBuf] = '\0';
BufLen = pBufPtr - pBuf;
RtmpOSWrielessEventSend(pAd->net_dev, RT_WLAN_EVENT_CUSTOM, Event_flag, NULL, (PUCHAR)pBuf, BufLen);
/*DBGPRINT(RT_DEBUG_TRACE, ("%s : %s\n", __FUNCTION__, pBuf)); */
/* kfree(pBuf); */
os_free_mem(NULL, pBuf);
}
else
DBGPRINT(RT_DEBUG_ERROR, ("%s : Can't allocate memory for wireless event.\n", __FUNCTION__));
}
/*
========================================================================
Routine Description:
Caller ensures we has 802.11n support.
Calls at setting HT from AP/STASetinformation
Arguments:
pAd - Pointer to our adapter
phymode -
========================================================================
*/
VOID RTMPSetIndividualHT(struct rtmp_adapter *pAd, u8 apidx)
{
RT_PHY_INFO *pDesired_ht_phy = NULL;
u8 TxStream = pAd->CommonCfg.TxStream;
u8 DesiredMcs = MCS_AUTO;
u8 encrypt_mode = Ndis802_11EncryptionDisabled;
struct rtmp_wifi_dev *wdev;
do
{
#ifdef CONFIG_AP_SUPPORT
IF_DEV_CONFIG_OPMODE_ON_AP(pAd)
{
if ((apidx < pAd->ApCfg.BssidNum) && (apidx < MAX_MBSSID_NUM(pAd)) && (apidx < HW_BEACON_MAX_NUM))
{
wdev = &pAd->ApCfg.MBSSID[apidx].wdev;
pDesired_ht_phy = &wdev->DesiredHtPhyInfo;
DesiredMcs = wdev->DesiredTransmitSetting.field.MCS;
#ifdef WFA_VHT_PF
// TODO: Sigma, this code segment used to work around for Sigma Automation!
if (WMODE_CAP_AC(pAd->CommonCfg.PhyMode) && (DesiredMcs != MCS_AUTO)) {
DesiredMcs += ((TxStream - 1) << 4);
pAd->ApCfg.MBSSID[apidx].DesiredTransmitSetting.field.FixedTxMode = FIXED_TXMODE_VHT;
RT_CfgSetAutoFallBack(pAd, "0");
} else {
RT_CfgSetAutoFallBack(pAd, "1");
}
#endif /* WFA_VHT_PF */
encrypt_mode = wdev->WepStatus;
pAd->ApCfg.MBSSID[apidx].wdev.bWmmCapable = true;
wdev->bAutoTxRateSwitch = (DesiredMcs == MCS_AUTO) ? true : false;
break;
}
DBGPRINT(RT_DEBUG_ERROR, ("RTMPSetIndividualHT: invalid apidx(%d)\n", apidx));
return;
}
#endif /* CONFIG_AP_SUPPORT */
#ifdef CONFIG_STA_SUPPORT
IF_DEV_CONFIG_OPMODE_ON_STA(pAd)
{
wdev = &pAd->StaCfg.wdev;
pDesired_ht_phy = &wdev->DesiredHtPhyInfo;
DesiredMcs = wdev->DesiredTransmitSetting.field.MCS;
encrypt_mode = wdev->WepStatus;
break;
}
#endif /* CONFIG_STA_SUPPORT */
} while (false);
if (pDesired_ht_phy == NULL)
{
DBGPRINT(RT_DEBUG_ERROR, ("RTMPSetIndividualHT: invalid apidx(%d)\n", apidx));
return;
}
RTMPZeroMemory(pDesired_ht_phy, sizeof(RT_PHY_INFO));
DBGPRINT(RT_DEBUG_TRACE, ("RTMPSetIndividualHT : Desired MCS = %d\n", DesiredMcs));
/* Check the validity of MCS */
if ((TxStream == 1) && ((DesiredMcs >= MCS_8) && (DesiredMcs <= MCS_15)))
{
DBGPRINT(RT_DEBUG_WARN, ("RTMPSetIndividualHT: MCS(%d) is invalid in 1S, reset it as MCS_7\n", DesiredMcs));
DesiredMcs = MCS_7;
}
if ((pAd->CommonCfg.DesiredHtPhy.ChannelWidth == BW_20) && (DesiredMcs == MCS_32))
{
DBGPRINT(RT_DEBUG_WARN, ("RTMPSetIndividualHT: MCS_32 is only supported in 40-MHz, reset it as MCS_0\n"));
DesiredMcs = MCS_0;
}
#ifdef CONFIG_STA_SUPPORT
if ((pAd->OpMode == OPMODE_STA) && (pAd->StaCfg.BssType == BSS_INFRA) && (apidx == MIN_NET_DEVICE_FOR_MBSSID))
;
else
#endif /* CONFIG_STA_SUPPORT */
/*
WFA recommend to restrict the encryption type in 11n-HT mode.
So, the WEP and TKIP are not allowed in HT rate.
*/
if (pAd->CommonCfg.HT_DisallowTKIP && IS_INVALID_HT_SECURITY(encrypt_mode))
{
#ifdef CONFIG_STA_SUPPORT
pAd->StaCfg.bAdhocN = false;
#endif /* CONFIG_STA_SUPPORT */
DBGPRINT(RT_DEBUG_WARN, ("%s : Use legacy rate in WEP/TKIP encryption mode (apidx=%d)\n",
__FUNCTION__, apidx));
return;
}
if (pAd->CommonCfg.HT_Disable)
{
#ifdef CONFIG_STA_SUPPORT
pAd->StaCfg.bAdhocN = false;
#endif /* CONFIG_STA_SUPPORT */
DBGPRINT(RT_DEBUG_TRACE, ("%s : HT is disabled\n", __FUNCTION__));
return;
}
pDesired_ht_phy->bHtEnable = true;
/* Decide desired Tx MCS*/
switch (TxStream)
{
case 1:
if (DesiredMcs == MCS_AUTO)
pDesired_ht_phy->MCSSet[0]= 0xff;
else if (DesiredMcs <= MCS_7)
pDesired_ht_phy->MCSSet[0]= 1<<DesiredMcs;
break;
case 2:
if (DesiredMcs == MCS_AUTO)
{
pDesired_ht_phy->MCSSet[0]= 0xff;
pDesired_ht_phy->MCSSet[1]= 0xff;
}
else if (DesiredMcs <= MCS_15)
{
ULONG mode;
mode = DesiredMcs / 8;
if (mode < 2)
pDesired_ht_phy->MCSSet[mode] = (1 << (DesiredMcs - mode * 8));
}
break;
case 3:
if (DesiredMcs == MCS_AUTO)
{
/* MCS0 ~ MCS23, 3 bytes */
pDesired_ht_phy->MCSSet[0]= 0xff;
pDesired_ht_phy->MCSSet[1]= 0xff;
pDesired_ht_phy->MCSSet[2]= 0xff;
}
else if (DesiredMcs <= MCS_23)
{
ULONG mode;
mode = DesiredMcs / 8;
if (mode < 3)
pDesired_ht_phy->MCSSet[mode] = (1 << (DesiredMcs - mode * 8));
}
break;
}
if(pAd->CommonCfg.DesiredHtPhy.ChannelWidth == BW_40)
{
if (DesiredMcs == MCS_AUTO || DesiredMcs == MCS_32)
pDesired_ht_phy->MCSSet[4] = 0x1;
}
/* update HT Rate setting */
if (pAd->OpMode == OPMODE_STA)
{
MlmeUpdateHtTxRates(pAd, BSS0);
}
else
MlmeUpdateHtTxRates(pAd, apidx);
if (WMODE_CAP_AC(pAd->CommonCfg.PhyMode)) {
pDesired_ht_phy->bVhtEnable = true;
rtmp_set_vht(pAd, pDesired_ht_phy);
}
}
