BOOLEAN CFG80211DRV_OpsBeaconAdd(VOID *pAdOrg, VOID *pData)
{
PRTMP_ADAPTER pAd = (PRTMP_ADAPTER)pAdOrg;
CMD_RTPRIV_IOCTL_80211_BEACON *pBeacon;
UINT32 rx_filter_flag;
BOOLEAN Cancelled;
INT i;
PMULTISSID_STRUCT pMbss = &pAd->ApCfg.MBSSID[MAIN_MBSSID];
struct wifi_dev *wdev = &pMbss->wdev;
CFG80211DBG(RT_DEBUG_TRACE, ("80211> %s ==>\n", __FUNCTION__));
pBeacon = (CMD_RTPRIV_IOCTL_80211_BEACON *)pData;
#ifdef UAPSD_SUPPORT
pAd->ApCfg.MBSSID[0].UapsdInfo.bAPSDCapable = TRUE;
wdev->UapsdInfo.bAPSDCapable = TRUE;
pMbss->CapabilityInfo |= 0x0800;
#endif /* UAPSD_SUPPORT */
CFG80211DRV_UpdateApSettingFromBeacon(pAd, MAIN_MBSSID, pBeacon);
rx_filter_flag = APNORMAL;
RTMP_IO_WRITE32(pAd, RX_FILTR_CFG, rx_filter_flag); /* enable RX of DMA block */
pAd->ApCfg.BssidNum = 1;
pAd->MacTab.MsduLifeTime = 20; /* default 5 seconds */
/* CFG_TODO */
pAd->ApCfg.MBSSID[MAIN_MBSSID].BcnBufIdx = 0 ;
for(i = 0; i < WLAN_MAX_NUM_OF_TIM; i++)
pAd->ApCfg.MBSSID[MAIN_MBSSID].TimBitmaps[i] = 0;
pMbss->bBcnSntReq = TRUE;
/* For GO Timeout */
pAd->ApCfg.StaIdleTimeout = 300;
pMbss->StationKeepAliveTime = 0;
AsicDisableSync(pAd);
if (pAd->CommonCfg.Channel > 14)
pAd->CommonCfg.PhyMode = (WMODE_A | WMODE_AN);
else
pAd->CommonCfg.PhyMode = (WMODE_B | WMODE_G |WMODE_GN);
/* cfg_todo */
wdev->bWmmCapable = TRUE;
wdev->wdev_type = WDEV_TYPE_AP;
wdev->tx_pkt_allowed = ApAllowToSendPacket;
wdev->allow_data_tx = TRUE;
wdev->func_dev = (void *)&pAd->ApCfg.MBSSID[MAIN_MBSSID];
wdev->sys_handle = (void *)pAd;
#ifdef RT_CFG80211_P2P_CONCURRENT_DEVICE
/* Using netDev ptr from VifList if VifDevList Exist */
PNET_DEV pNetDev = NULL;
if ((pAd->cfg80211_ctrl.Cfg80211VifDevSet.vifDevList.size > 0) &&
((pNetDev = RTMP_CFG80211_FindVifEntry_ByType(pAd, RT_CMD_80211_IFTYPE_P2P_GO)) != NULL))
{
pMbss->MSSIDDev = pNetDev;
wdev->if_dev = pNetDev;
COPY_MAC_ADDR(wdev->bssid, pNetDev->dev_addr);
COPY_MAC_ADDR(wdev->if_addr, pNetDev->dev_addr);
RTMP_OS_NETDEV_SET_WDEV(pNetDev, wdev);
}
else
#endif /* RT_CFG80211_P2P_CONCURRENT_DEVICE */
{
pMbss->MSSIDDev = pAd->net_dev;
wdev->if_dev = pAd->net_dev;
COPY_MAC_ADDR(wdev->bssid, pAd->CurrentAddress);
COPY_MAC_ADDR(wdev->if_addr, pAd->CurrentAddress);
/* assoc to MBSSID's wdev */
RTMP_OS_NETDEV_SET_WDEV(pAd->net_dev, wdev);
}
DBGPRINT(RT_DEBUG_TRACE, ("New AP BSSID %02x:%02x:%02x:%02x:%02x:%02x (%d)\n",
PRINT_MAC(wdev->bssid), pAd->CommonCfg.PhyMode));
RTMPSetPhyMode(pAd, pAd->CommonCfg.PhyMode);
#ifdef DOT11_N_SUPPORT
if (WMODE_CAP_N(pAd->CommonCfg.PhyMode) && (pAd->Antenna.field.TxPath == 2))
bbp_set_txdac(pAd, 2);
else
#endif /* DOT11_N_SUPPORT */
bbp_set_txdac(pAd, 0);
/* Receiver Antenna selection */
bbp_set_rxpath(pAd, pAd->Antenna.field.RxPath);
if(!OPSTATUS_TEST_FLAG(pAd, fOP_STATUS_MEDIA_STATE_CONNECTED))
{
if (WMODE_CAP_N(pAd->CommonCfg.PhyMode) || wdev->bWmmCapable)
{
/* EDCA parameters used for AP's own transmission */
if (pAd->CommonCfg.APEdcaParm.bValid == FALSE)
set_default_ap_edca_param(pAd);
/* EDCA parameters to be annouced in outgoing BEACON, used by WMM STA */
if (pAd->ApCfg.BssEdcaParm.bValid == FALSE)
set_default_sta_edca_param(pAd);
AsicSetEdcaParm(pAd, &pAd->CommonCfg.APEdcaParm);
}
else
AsicSetEdcaParm(pAd, NULL);
}
#ifdef DOT11_N_SUPPORT
AsicSetRDG(pAd, pAd->CommonCfg.bRdg);
AsicSetRalinkBurstMode(pAd, pAd->CommonCfg.bRalinkBurstMode);
#endif /* DOT11_N_SUPPORT */
AsicSetBssid(pAd, pAd->CurrentAddress);
mgmt_tb_set_mcast_entry(pAd);
DBGPRINT(RT_DEBUG_TRACE, ("%s():Reset WCID Table\n", __FUNCTION__));
AsicDelWcidTab(pAd, WCID_ALL);
pAd->MacTab.Content[0].Addr[0] = 0x01;
pAd->MacTab.Content[0].HTPhyMode.field.MODE = MODE_OFDM;
pAd->MacTab.Content[0].HTPhyMode.field.MCS = 3;
pAd->CommonCfg.CentralChannel = pAd->CommonCfg.Channel;
AsicBBPAdjust(pAd);
//MlmeSetTxPreamble(pAd, (USHORT)pAd->CommonCfg.TxPreamble);
#ifdef RT_CFG80211_P2P_CONCURRENT_DEVICE
/* P2P_GO */
MlmeUpdateTxRates(pAd, FALSE, MAIN_MBSSID + MIN_NET_DEVICE_FOR_CFG80211_VIF_P2P_GO);
#endif /* RT_CFG80211_P2P_CONCURRENT_DEVICE */
/*AP */
#ifdef RT_CFG80211_P2P_SUPPORT
if (!RTMP_CFG80211_VIF_P2P_GO_ON(pAd))
#endif
MlmeUpdateTxRates(pAd, FALSE, MIN_NET_DEVICE_FOR_MBSSID);
#ifdef DOT11_N_SUPPORT
if (WMODE_CAP_N(pAd->CommonCfg.PhyMode))
MlmeUpdateHtTxRates(pAd, MIN_NET_DEVICE_FOR_MBSSID);
#endif /* DOT11_N_SUPPORT */
/* Disable Protection first. */
if (!INFRA_ON(pAd))
AsicUpdateProtect(pAd, 0, (ALLN_SETPROTECT|CCKSETPROTECT|OFDMSETPROTECT), TRUE, FALSE);
APUpdateCapabilityAndErpIe(pAd);
#ifdef DOT11_N_SUPPORT
APUpdateOperationMode(pAd);
#endif /* DOT11_N_SUPPORT */
CFG80211_UpdateBeacon(pAd, pBeacon->beacon_head, pBeacon->beacon_head_len,
pBeacon->beacon_tail, pBeacon->beacon_tail_len,
TRUE);
/* Enable BSS Sync*/
AsicEnableApBssSync(pAd);
//pAd->P2pCfg.bSentProbeRSP = TRUE;
AsicSetPreTbtt(pAd, TRUE);
OPSTATUS_SET_FLAG(pAd, fOP_AP_STATUS_MEDIA_STATE_CONNECTED);
RTMP_IndicateMediaState(pAd, NdisMediaStateConnected);
#ifdef RT_CFG80211_SUPPORT
#ifdef RT_CFG80211_P2P_SUPPORT
if (!RTMP_CFG80211_VIF_P2P_GO_ON(pAd))
#endif /*RT_CFG80211_P2P_SUPPORT*/
wdev->Hostapd=Hostapd_CFG;
#endif /*RT_CFG80211_SUPPORT*/
return TRUE;
}
/*
==========================================================================
Description:
This routine is executed every second -
1. Decide the overall channel quality
2. Check if need to upgrade the TX rate to any client
3. perform MAC table maintenance, including ageout no-traffic clients,
and release packet buffer in PSQ is fail to TX in time.
==========================================================================
*/
VOID APMlmePeriodicExec(
PRTMP_ADAPTER pAd)
{
/*
Reqeust by David 2005/05/12
It make sense to disable Adjust Tx Power on AP mode, since we can't
take care all of the client's situation
ToDo: need to verify compatibility issue with WiFi product.
*/
#ifdef CARRIER_DETECTION_SUPPORT
if (isCarrierDetectExist(pAd) == TRUE)
{
PCARRIER_DETECTION_STRUCT pCarrierDetect = &pAd->CommonCfg.CarrierDetect;
if (pCarrierDetect->OneSecIntCount < pCarrierDetect->CarrierGoneThreshold)
{
pCarrierDetect->CD_State = CD_NORMAL;
pCarrierDetect->recheck = pCarrierDetect->recheck1;
if (pCarrierDetect->Debug != RT_DEBUG_TRACE)
{
DBGPRINT(RT_DEBUG_TRACE, ("Carrier gone\n"));
/* start all TX actions. */
APMakeAllBssBeacon(pAd);
APUpdateAllBeaconFrame(pAd);
AsicEnableBssSync(pAd);
}
else
{
printk("Carrier gone\n");
}
}
pCarrierDetect->OneSecIntCount = 0;
}
#endif /* CARRIER_DETECTION_SUPPORT */
RTMP_CHIP_HIGH_POWER_TUNING(pAd, &pAd->ApCfg.RssiSample);
/* Disable Adjust Tx Power for WPA WiFi-test. */
/* Because high TX power results in the abnormal disconnection of Intel BG-STA. */
/*#ifndef WIFI_TEST */
/* if (pAd->CommonCfg.bWiFiTest == FALSE) */
/* for SmartBit 64-byte stream test */
/* removed based on the decision of Ralink congress at 2011/7/06 */
/* if (pAd->MacTab.Size > 0) */
AsicAdjustTxPower(pAd);
/*#endif // WIFI_TEST */
#ifdef RTMP_TEMPERATURE_COMPENSATION
MT76x0_TemperatureCompensation(pAd);
#endif /* RTMP_TEMPERATURE_COMPENSATION */
/* BBP TUNING: dynamic tune BBP R66 to find a balance between sensibility
and noise isolation */
/* AsicBbpTuning2(pAd); */
/* walk through MAC table, see if switching TX rate is required */
/* MAC table maintenance */
if (pAd->Mlme.PeriodicRound % MLME_TASK_EXEC_MULTIPLE == 0)
{
/* one second timer */
MacTableMaintenance(pAd);
#ifdef FPGA_MODE
if (pAd->fpga_tr_stop)
{
UINT32 mac_val;
/* enable/disable tx/rx*/
RTMP_IO_READ32(pAd, MAC_SYS_CTRL, &mac_val);
switch (pAd->fpga_tr_stop)
{
case 3: //stop tx + rx
mac_val &= (~0xc);
break;
case 2: // stop rx
mac_val &= (~0x8);
break;
case 1: // stop tx
mac_val &= (~0x4);
break;
case 4:
default:
mac_val |= 0x0c;
break;
}
RTMP_IO_WRITE32(pAd, MAC_SYS_CTRL, mac_val);
}
#endif /* FGPA_MODE */
RTMPMaintainPMKIDCache(pAd);
#ifdef WDS_SUPPORT
WdsTableMaintenance(pAd);
#endif /* WDS_SUPPORT */
#ifdef CLIENT_WDS
CliWds_ProxyTabMaintain(pAd);
#endif /* CLIENT_WDS */
}
APUpdateCapabilityAndErpIe(pAd);
#ifdef APCLI_SUPPORT
if (pAd->Mlme.OneSecPeriodicRound % 2 == 0)
ApCliIfMonitor(pAd);
if (pAd->Mlme.OneSecPeriodicRound % 2 == 1)
ApCliIfUp(pAd);
{
INT loop;
ULONG Now32;
UINT32 MaxWcidNum = MAX_LEN_OF_MAC_TABLE;
#ifdef MAC_REPEATER_SUPPORT
if (pAd->ApCfg.bMACRepeaterEn)
{
MaxWcidNum = MAX_MAC_TABLE_SIZE_WITH_REPEATER;
#ifdef APCLI_AUTO_CONNECT_SUPPORT
RTMPRepeaterReconnectionCheck(pAd);
#endif /* APCLI_AUTO_CONNECT_SUPPORT */
}
#endif /* MAC_REPEATER_SUPPORT */
NdisGetSystemUpTime(&Now32);
for (loop = 0; loop < MAX_APCLI_NUM; loop++)
{
PAPCLI_STRUCT pApCliEntry = &pAd->ApCfg.ApCliTab[loop];
if ((pApCliEntry->Valid == TRUE)
&& (pApCliEntry->MacTabWCID < MaxWcidNum))
{
/* update channel quality for Roaming and UI LinkQuality display */
MlmeCalculateChannelQuality(pAd,
&pAd->MacTab.Content[pApCliEntry->MacTabWCID], Now32);
}
}
}
#endif /* APCLI_SUPPORT */
#ifdef DOT11_N_SUPPORT
if (pAd->CommonCfg.bHTProtect)
{
/*APUpdateCapabilityAndErpIe(pAd); */
APUpdateOperationMode(pAd);
if (pAd->CommonCfg.IOTestParm.bRTSLongProtOn == FALSE)
{
AsicUpdateProtect(pAd, (USHORT)pAd->CommonCfg.AddHTInfo.AddHtInfo2.OperaionMode, ALLN_SETPROTECT, FALSE, pAd->MacTab.fAnyStationNonGF);
}
}
#endif /* DOT11_N_SUPPORT */
#ifdef A_BAND_SUPPORT
if ( (pAd->CommonCfg.Channel > 14)
&& (pAd->CommonCfg.bIEEE80211H == 1)
)
{
#ifdef DFS_SUPPORT
ApRadarDetectPeriodic(pAd);
#else
pAd->Dot11_H.InServiceMonitorCount++;
if (pAd->Dot11_H.RDMode == RD_SILENCE_MODE)
{
if (pAd->Dot11_H.RDCount++ > pAd->Dot11_H.ChMovingTime)
{
AsicEnableBssSync(pAd);
pAd->Dot11_H.RDMode = RD_NORMAL_MODE;
}
}
#endif /* !DFS_SUPPORT */
}
#endif /* A_BAND_SUPPORT */
/* resume Improved Scanning*/
if ((pAd->ApCfg.bImprovedScan) &&
(!RTMP_TEST_FLAG(pAd, fRTMP_ADAPTER_BSS_SCAN_IN_PROGRESS)) &&
(pAd->Mlme.ApSyncMachine.CurrState == AP_SCAN_PENDING))
{
MLME_SCAN_REQ_STRUCT ScanReq;
AsicDisableSync(pAd);
RTMPZeroMemory(ScanReq.Ssid, MAX_LEN_OF_SSID);
ScanReq.SsidLen = pAd->MlmeAux.SsidLen;
NdisMoveMemory(ScanReq.Ssid, pAd->MlmeAux.Ssid, ScanReq.SsidLen);
ScanReq.BssType = BSS_ANY;
#ifdef APCLI_CONNECTION_TRIAL
ScanReq.ScanType = FAST_SCAN_ACTIVE;
#else
ScanReq.ScanType = SCAN_ACTIVE;
#endif /* APCLI_CONNECTION_TRIAL */
MlmeEnqueue(pAd, AP_SYNC_STATE_MACHINE, APMT2_MLME_SCAN_REQ, sizeof(MLME_SCAN_REQ_STRUCT), &ScanReq, 0);
RTMP_MLME_HANDLER(pAd);
DBGPRINT(RT_DEBUG_TRACE, ("bImprovedScan ............. Resume for bImprovedScan, SCAN_PENDING .............. \n"));
}
}
/*
==========================================================================
Description:
This routine is executed every second -
1. Decide the overall channel quality
2. Check if need to upgrade the TX rate to any client
3. perform MAC table maintenance, including ageout no-traffic clients,
and release packet buffer in PSQ is fail to TX in time.
==========================================================================
*/
VOID APMlmePeriodicExec(
PRTMP_ADAPTER pAd)
{
/*
Reqeust by David 2005/05/12
It make sense to disable Adjust Tx Power on AP mode, since we can't
take care all of the client's situation
ToDo: need to verify compatibility issue with WiFi product.
*/
/*
We return here in ATE mode, because the statistics
that ATE need are not collected via this routine.
*/
#ifdef RALINK_ATE
if (ATE_ON(pAd))
return;
#endif /* RALINK_ATE */
#ifdef CARRIER_DETECTION_SUPPORT
if (isCarrierDetectExist(pAd) == TRUE)
{
if (pAd->CommonCfg.CarrierDetect.OneSecIntCount < pAd->CommonCfg.CarrierDetect.CarrierGoneThreshold)
{
pAd->CommonCfg.CarrierDetect.CD_State = CD_NORMAL;
pAd->CommonCfg.CarrierDetect.recheck = pAd->CommonCfg.CarrierDetect.recheck1;
if (pAd->CommonCfg.CarrierDetect.Debug != RT_DEBUG_TRACE)
{
DBGPRINT(RT_DEBUG_TRACE, ("Carrier gone\n"));
/* start all TX actions. */
APMakeAllBssBeacon(pAd);
APUpdateAllBeaconFrame(pAd);
AsicEnableBssSync(pAd);
}
else
{
printk("Carrier gone\n");
}
}
}
pAd->CommonCfg.CarrierDetect.OneSecIntCount = 0;
#endif /* CARRIER_DETECTION_SUPPORT */
RTMP_CHIP_HIGH_POWER_TUNING(pAd, &pAd->ApCfg.RssiSample);
/* Disable Adjust Tx Power for WPA WiFi-test. */
/* Because high TX power results in the abnormal disconnection of Intel BG-STA. */
/*#ifndef WIFI_TEST */
/* if (pAd->CommonCfg.bWiFiTest == FALSE) */
/* for SmartBit 64-byte stream test */
/* removed based on the decision of Ralink congress at 2011/7/06 */
/* if (pAd->MacTab.Size > 0) */
AsicAdjustTxPower(pAd);
/*#endif // WIFI_TEST */
/* BBP TUNING: dynamic tune BBP R66 to find a balance between sensibility
and noise isolation */
/* AsicBbpTuning2(pAd); */
/* walk through MAC table, see if switching TX rate is required */
/* MAC table maintenance */
if (pAd->Mlme.PeriodicRound % MLME_TASK_EXEC_MULTIPLE == 0)
{
/* one second timer */
MacTableMaintenance(pAd);
RTMPMaintainPMKIDCache(pAd);
#ifdef WDS_SUPPORT
WdsTableMaintenance(pAd);
#endif /* WDS_SUPPORT */
#ifdef CLIENT_WDS
CliWds_ProxyTabMaintain(pAd);
#endif /* CLIENT_WDS */
}
APUpdateCapabilityAndErpIe(pAd);
#ifdef APCLI_SUPPORT
if (pAd->Mlme.OneSecPeriodicRound % 2 == 0)
ApCliIfMonitor(pAd);
if (pAd->Mlme.OneSecPeriodicRound % 2 == 1)
ApCliIfUp(pAd);
{
INT loop;
ULONG Now32;
NdisGetSystemUpTime(&Now32);
for (loop = 0; loop < MAX_APCLI_NUM; loop++)
{
PAPCLI_STRUCT pApCliEntry = &pAd->ApCfg.ApCliTab[loop];
if ((pApCliEntry->Valid == TRUE)
&& (pApCliEntry->MacTabWCID < MAX_LEN_OF_MAC_TABLE))
{
/* update channel quality for Roaming and UI LinkQuality display */
MlmeCalculateChannelQuality(pAd,
&pAd->MacTab.Content[pApCliEntry->MacTabWCID], Now32);
}
}
}
#endif /* APCLI_SUPPORT */
#ifdef DOT11_N_SUPPORT
if (pAd->CommonCfg.bHTProtect)
{
/*APUpdateCapabilityAndErpIe(pAd); */
APUpdateOperationMode(pAd);
if (pAd->CommonCfg.IOTestParm.bRTSLongProtOn == FALSE)
{
AsicUpdateProtect(pAd, (USHORT)pAd->CommonCfg.AddHTInfo.AddHtInfo2.OperaionMode, ALLN_SETPROTECT, FALSE, pAd->MacTab.fAnyStationNonGF);
}
}
#endif /* DOT11_N_SUPPORT */
#ifdef A_BAND_SUPPORT
if ( (pAd->CommonCfg.Channel > 14)
&& (pAd->CommonCfg.bIEEE80211H == 1)
)
{
#ifdef DFS_SUPPORT
ApRadarDetectPeriodic(pAd);
#else
pAd->CommonCfg.InServiceMonitorCount++;
if (pAd->CommonCfg.RDMode == RD_SILENCE_MODE)
{
if (pAd->CommonCfg.RDCount++ > pAd->CommonCfg.ChMovingTime)
{
AsicEnableBssSync(pAd);
pAd->CommonCfg.RDMode = RD_NORMAL_MODE;
}
}
#endif /* DFS_SUPPORT */
}
#endif /* A_BAND_SUPPORT */
}
/*
==========================================================================
Description:
This routine is executed every second -
1. Decide the overall channel quality
2. Check if need to upgrade the TX rate to any client
3. perform MAC table maintenance, including ageout no-traffic clients,
and release packet buffer in PSQ is fail to TX in time.
==========================================================================
*/
VOID APMlmePeriodicExec(
PRTMP_ADAPTER pAd)
{
/*
Reqeust by David 2005/05/12
It make sense to disable Adjust Tx Power on AP mode, since we can't
take care all of the client's situation
ToDo: need to verify compatibility issue with WiFi product.
*/
#ifdef CARRIER_DETECTION_SUPPORT
if (isCarrierDetectExist(pAd) == TRUE)
{
PCARRIER_DETECTION_STRUCT pCarrierDetect = &pAd->CommonCfg.CarrierDetect;
if (pCarrierDetect->OneSecIntCount < pCarrierDetect->CarrierGoneThreshold)
{
pCarrierDetect->CD_State = CD_NORMAL;
pCarrierDetect->recheck = pCarrierDetect->recheck1;
if (pCarrierDetect->Debug != RT_DEBUG_TRACE)
{
DBGPRINT(RT_DEBUG_TRACE, ("Carrier gone\n"));
/* start all TX actions. */
APMakeAllBssBeacon(pAd);
APUpdateAllBeaconFrame(pAd);
AsicEnableBssSync(pAd, pAd->CommonCfg.BeaconPeriod);
}
else
{
DBGPRINT(RT_DEBUG_TRACE, ("Carrier gone\n"));
}
}
pCarrierDetect->OneSecIntCount = 0;
}
#endif /* CARRIER_DETECTION_SUPPORT */
RTMP_CHIP_HIGH_POWER_TUNING(pAd, &pAd->ApCfg.RssiSample);
/* Disable Adjust Tx Power for WPA WiFi-test. */
/* Because high TX power results in the abnormal disconnection of Intel BG-STA. */
/*#ifndef WIFI_TEST */
/* if (pAd->CommonCfg.bWiFiTest == FALSE) */
/* for SmartBit 64-byte stream test */
/* removed based on the decision of Ralink congress at 2011/7/06 */
/* if (pAd->MacTab.Size > 0) */
RTMP_CHIP_ASIC_ADJUST_TX_POWER(pAd);
/*#endif // WIFI_TEST */
RTMP_CHIP_ASIC_TEMPERATURE_COMPENSATION(pAd);
/* walk through MAC table, see if switching TX rate is required */
/* MAC table maintenance */
if (pAd->Mlme.PeriodicRound % MLME_TASK_EXEC_MULTIPLE == 0)
{
/* one second timer */
MacTableMaintenance(pAd);
#ifdef CONFIG_FPGA_MODE
if (pAd->fpga_ctl.fpga_tr_stop)
{
INT enable = FALSE, ctrl_type;
/* enable/disable tx/rx*/
switch (pAd->fpga_ctl.fpga_tr_stop)
{
case 3: //stop tx + rx
ctrl_type = ASIC_MAC_TXRX;
break;
case 2: // stop rx
ctrl_type = ASIC_MAC_RX;
break;
case 1: // stop tx
ctrl_type = ASIC_MAC_TX;
break;
case 4:
default:
enable = TRUE;
ctrl_type = ASIC_MAC_TXRX;
break;
}
AsicSetMacTxRx(pAd, ctrl_type, enable);
}
#endif /* CONFIG_FPGA_MODE */
RTMPMaintainPMKIDCache(pAd);
#ifdef WDS_SUPPORT
WdsTableMaintenance(pAd);
#endif /* WDS_SUPPORT */
#ifdef CLIENT_WDS
CliWds_ProxyTabMaintain(pAd);
#endif /* CLIENT_WDS */
}
#ifdef AP_SCAN_SUPPORT
AutoChannelSelCheck(pAd);
#endif /* AP_SCAN_SUPPORT */
APUpdateCapabilityAndErpIe(pAd);
#ifdef APCLI_SUPPORT
if (pAd->Mlme.OneSecPeriodicRound % 2 == 0)
ApCliIfMonitor(pAd);
if (pAd->Mlme.OneSecPeriodicRound % 2 == 1
#ifdef APCLI_AUTO_CONNECT_SUPPORT
&& (pAd->ApCfg.ApCliAutoConnectChannelSwitching == FALSE)
#endif /* APCLI_AUTO_CONNECT_SUPPORT */
) {
ApCliIfUp(pAd);
}
{
INT loop;
ULONG Now32;
#ifdef MAC_REPEATER_SUPPORT
if (pAd->ApCfg.bMACRepeaterEn)
{
RTMPRepeaterReconnectionCheck(pAd);
}
#endif /* MAC_REPEATER_SUPPORT */
NdisGetSystemUpTime(&Now32);
for (loop = 0; loop < MAX_APCLI_NUM; loop++)
{
PAPCLI_STRUCT pApCliEntry = &pAd->ApCfg.ApCliTab[loop];
if ((pApCliEntry->Valid == TRUE)
&& (pApCliEntry->MacTabWCID < MAX_LEN_OF_MAC_TABLE))
{
/* update channel quality for Roaming and UI LinkQuality display */
MlmeCalculateChannelQuality(pAd,
&pAd->MacTab.Content[pApCliEntry->MacTabWCID], Now32);
}
}
}
#endif /* APCLI_SUPPORT */
#ifdef DOT11_N_SUPPORT
if (pAd->CommonCfg.bHTProtect) {
/*APUpdateCapabilityAndErpIe(pAd); */
APUpdateOperationMode(pAd);
if (pAd->CommonCfg.IOTestParm.bRTSLongProtOn == FALSE)
AsicUpdateProtect(pAd, (USHORT)pAd->CommonCfg.AddHTInfo.AddHtInfo2.OperaionMode,
ALLN_SETPROTECT, FALSE, pAd->MacTab.fAnyStationNonGF);
}
#endif /* DOT11_N_SUPPORT */
#ifdef A_BAND_SUPPORT
if ( (pAd->CommonCfg.Channel > 14)
&& (pAd->CommonCfg.bIEEE80211H == 1))
{
#ifdef DFS_SUPPORT
ApRadarDetectPeriodic(pAd);
#else
pAd->Dot11_H.InServiceMonitorCount++;
if (pAd->Dot11_H.RDMode == RD_SILENCE_MODE)
{
if (pAd->Dot11_H.RDCount++ > pAd->Dot11_H.ChMovingTime)
{
AsicEnableBssSync(pAd, pAd->CommonCfg.BeaconPeriod);
pAd->Dot11_H.RDMode = RD_NORMAL_MODE;
}
}
#endif /* !DFS_SUPPORT */
}
#endif /* A_BAND_SUPPORT */
}
BOOLEAN CFG80211DRV_OpsBeaconAdd(VOID *pAdOrg, VOID *pData)
{
PRTMP_ADAPTER pAd = (PRTMP_ADAPTER)pAdOrg;
CMD_RTPRIV_IOCTL_80211_BEACON *pBeacon;
// BOOLEAN Cancelled;
UINT i = 0;
#ifdef RT_CFG80211_P2P_SUPPORT
UINT apidx = CFG_GO_BSSID_IDX;
#else
UINT apidx = MAIN_MBSSID;
#endif /*RT_CFG80211_P2P_SUPPORT*/
BSS_STRUCT *pMbss = &pAd->ApCfg.MBSSID[apidx];
struct wifi_dev *wdev = &pMbss->wdev;
CHAR tr_tb_idx = MAX_LEN_OF_MAC_TABLE + apidx;
/* for Concurrent, AP/P2P GO use HW_BSSID 1 */
//wdev->hw_bssid_idx = CFG_GO_BSSID_IDX;
wdev->hw_bssid_idx = apidx;
#ifdef RT_CFG80211_SUPPORT
#ifdef RT_CFG80211_P2P_SUPPORT
if (!RTMP_CFG80211_VIF_P2P_GO_ON(pAd))
#endif /* RT_CFG80211_P2P_SUPPORT */
wdev->Hostapd=Hostapd_CFG;
#endif /* RT_CFG80211_SUPPORT */
CFG80211DBG(RT_DEBUG_TRACE, ("80211> %s ==>\n", __FUNCTION__));
#ifdef CONFIG_AP_SUPPORT
#endif /* CONFIG_AP_SUPPORT */
pBeacon = (CMD_RTPRIV_IOCTL_80211_BEACON *)pData;
#ifdef UAPSD_SUPPORT
wdev->UapsdInfo.bAPSDCapable = TRUE;
pMbss->CapabilityInfo |= 0x0800;
#endif /* UAPSD_SUPPORT */
CFG80211DRV_UpdateApSettingFromBeacon(pAd, apidx, pBeacon);
AsicSetRxFilter(pAd);
/* Start from 0 & MT_MAC using HW_BSSID 1, TODO */
#ifdef RT_CFG80211_P2P_SUPPORT
pAd->ApCfg.BssidNum = (CFG_GO_BSSID_IDX + 1);
#else
pAd->ApCfg.BssidNum = (MAIN_MBSSID + 1);
#endif /*RT_CFG80211_P2P_SUPPORT*/
pAd->MacTab.MsduLifeTime = 20; /* pEntry's UAPSD Q Idle Threshold */
/* CFG_TODO */
pAd->ApCfg.MBSSID[apidx].bcn_buf.BcnBufIdx = 0 ;
for(i = 0; i < WLAN_MAX_NUM_OF_TIM; i++)
pAd->ApCfg.MBSSID[apidx].TimBitmaps[i] = 0;
pMbss->bcn_buf.bBcnSntReq = TRUE;
/* For GO Timeout */
#ifdef RT_CFG80211_P2P_MULTI_CHAN_SUPPORT
pAd->ApCfg.StaIdleTimeout = 300;
pMbss->StationKeepAliveTime = 60;
#else
pAd->ApCfg.StaIdleTimeout = 300;
pMbss->StationKeepAliveTime = 0;
#endif /* RT_CFG80211_P2P_MULTI_CHAN_SUPPORT */
AsicDisableSync(pAd);
if (pAd->CommonCfg.Channel > 14)
pAd->CommonCfg.PhyMode = (WMODE_A | WMODE_AN);
else
pAd->CommonCfg.PhyMode = (WMODE_B | WMODE_G |WMODE_GN);
/* cfg_todo */
wdev->bWmmCapable = TRUE;
wdev->wdev_type = WDEV_TYPE_AP;
wdev->func_dev = (void *)&pAd->ApCfg.MBSSID[apidx];
wdev->sys_handle = (void *)pAd;
wdev->func_idx = apidx; //NEW
#ifdef RT_CFG80211_P2P_CONCURRENT_DEVICE
/* Using netDev ptr from VifList if VifDevList Exist */
PNET_DEV pNetDev = NULL;
if ((pAd->cfg80211_ctrl.Cfg80211VifDevSet.vifDevList.size > 0) &&
((pNetDev = RTMP_CFG80211_FindVifEntry_ByType(pAd, RT_CMD_80211_IFTYPE_P2P_GO)) != NULL))
{
wdev->if_dev = pNetDev;
COPY_MAC_ADDR(wdev->bssid, pNetDev->dev_addr);
COPY_MAC_ADDR(wdev->if_addr, pNetDev->dev_addr);
RTMP_OS_NETDEV_SET_WDEV(pNetDev, wdev);
RTMP_OS_NETDEV_SET_PRIV(pNetDev, pAd);
}
else
#endif /* RT_CFG80211_P2P_CONCURRENT_DEVICE */
{
wdev->if_dev = pAd->net_dev;
COPY_MAC_ADDR(wdev->bssid, pAd->CurrentAddress);
COPY_MAC_ADDR(wdev->if_addr, pAd->CurrentAddress);
/* assoc to MBSSID's wdev */
RTMP_OS_NETDEV_SET_WDEV(pAd->net_dev, wdev);
RTMP_OS_NETDEV_SET_PRIV(pAd->net_dev, pAd);
//reset to INT_MAIN , because SET_PRIV would clear priv_flag
RT_DEV_PRIV_FLAGS_SET(pAd->net_dev,INT_MAIN);
}
/* BC/MC Handling */
wdev->tr_tb_idx = tr_tb_idx;
tr_tb_set_mcast_entry(pAd, tr_tb_idx, wdev);
/* TX */
wdev->tx_pkt_allowed = ApAllowToSendPacket;
wdev->wdev_hard_tx = APHardTransmit;
wdev->tx_pkt_handle = APSendPacket;
/* RX */
wdev->rx_pkt_allowed = ap_rx_pkt_allow;
wdev->rx_pkt_foward = ap_rx_foward_handle;
wdev->rx_ps_handle = ap_rx_ps_handle;
wdev_bcn_buf_init(pAd, &pAd->ApCfg.MBSSID[apidx].bcn_buf);
if (rtmp_wdev_idx_reg(pAd, wdev) < 0)
{
DBGPRINT(RT_DEBUG_TRACE, ("%s(): register wdev fail\n", __FUNCTION__));
}
wdev->allow_data_tx = TRUE;
AsicSetBssid(pAd, wdev->if_addr, 0x1);
AsicSetDevMac(pAd, wdev->if_addr, 0x1);
DBGPRINT(RT_DEBUG_TRACE, ("New AP BSSID %02x:%02x:%02x:%02x:%02x:%02x (%d)\n",
PRINT_MAC(wdev->bssid), pAd->CommonCfg.PhyMode));
RTMPSetPhyMode(pAd, pAd->CommonCfg.PhyMode);
#ifdef DOT11_N_SUPPORT
if (WMODE_CAP_N(pAd->CommonCfg.PhyMode) && (pAd->Antenna.field.TxPath == 2))
bbp_set_txdac(pAd, 2);
else
#endif /* DOT11_N_SUPPORT */
bbp_set_txdac(pAd, 0);
/* Receiver Antenna selection */
bbp_set_rxpath(pAd, pAd->Antenna.field.RxPath);
if(!OPSTATUS_TEST_FLAG(pAd, fOP_STATUS_MEDIA_STATE_CONNECTED))
{
if (WMODE_CAP_N(pAd->CommonCfg.PhyMode) || wdev->bWmmCapable)
{
/* EDCA parameters used for AP's own transmission */
if (pAd->CommonCfg.APEdcaParm.bValid == FALSE)
set_default_ap_edca_param(pAd);
/* EDCA parameters to be annouced in outgoing BEACON, used by WMM STA */
if (pAd->ApCfg.BssEdcaParm.bValid == FALSE)
set_default_sta_edca_param(pAd);
AsicSetEdcaParm(pAd, &pAd->CommonCfg.APEdcaParm);
}
else
AsicSetEdcaParm(pAd, NULL);
}
#ifdef DOT11_N_SUPPORT
#ifndef RT_CFG80211_P2P_MULTI_CHAN_SUPPORT
if (WMODE_CAP_N(pAd->CommonCfg.PhyMode))
pAd->CommonCfg.HtCapability.HtCapInfo.ChannelWidth = BW_20; /* Patch UI */
#endif /* RT_CFG80211_P2P_MULTI_CHAN_SUPPORT */
AsicSetRDG(pAd, pAd->CommonCfg.bRdg);
AsicSetRalinkBurstMode(pAd, pAd->CommonCfg.bRalinkBurstMode);
#endif /* DOT11_N_SUPPORT */
//AsicSetBssid(pAd, pAd->CurrentAddress, 0x0);
MTWF_LOG(DBG_CAT_ALL, DBG_SUBCAT_ALL, DBG_LVL_TRACE, ("%s():Reset WCID Table\n", __FUNCTION__));
AsicDelWcidTab(pAd, WCID_ALL);
pAd->MacTab.Content[0].Addr[0] = 0x01;
pAd->MacTab.Content[0].HTPhyMode.field.MODE = MODE_OFDM;
pAd->MacTab.Content[0].HTPhyMode.field.MCS = 3;
#ifdef DOT11_N_SUPPORT
SetCommonHT(pAd);
#endif /* DOT11_N_SUPPORT */
/*In MCC & p2p GO not support VHT now, */
/*change here for support P2P GO 40 BW*/
/* pAd->CommonCfg.vht_bw = 0;*/
if(pAd->CommonCfg.RegTransmitSetting.field.EXTCHA == EXTCHA_BELOW)
pAd->CommonCfg.CentralChannel = pAd->CommonCfg.Channel - 2;
else if (pAd->CommonCfg.RegTransmitSetting.field.EXTCHA == EXTCHA_ABOVE)
pAd->CommonCfg.CentralChannel = pAd->CommonCfg.Channel + 2;
else
pAd->CommonCfg.CentralChannel = pAd->CommonCfg.Channel;
AsicSwitchChannel(pAd, pAd->CommonCfg.CentralChannel,FALSE);
AsicLockChannel(pAd, pAd->CommonCfg.CentralChannel);
#ifdef RT_CFG80211_P2P_MULTI_CHAN_SUPPORT
bbp_set_bw(pAd, wdev->bw);
#else
bbp_set_bw(pAd, pAd->CommonCfg.RegTransmitSetting.field.BW);
#endif /* RT_CFG80211_P2P_MULTI_CHAN_SUPPORT */
AsicBBPAdjust(pAd);
//MlmeSetTxPreamble(pAd, (USHORT)pAd->CommonCfg.TxPreamble);
//MlmeUpdateTxRates(pAd, FALSE, MIN_NET_DEVICE_FOR_MBSSID);
#ifdef RT_CFG80211_P2P_SUPPORT
MlmeUpdateTxRates(pAd, FALSE, MIN_NET_DEVICE_FOR_CFG80211_VIF_P2P_GO + apidx);
#else
MlmeUpdateTxRates(pAd, FALSE, apidx);
#endif /*RT_CFG80211_P2P_SUPPORT*/
#ifdef DOT11_N_SUPPORT
if (WMODE_CAP_N(pAd->CommonCfg.PhyMode))
MlmeUpdateHtTxRates(pAd, MIN_NET_DEVICE_FOR_MBSSID);
#endif /* DOT11_N_SUPPORT */
/* Disable Protection first. */
if (!INFRA_ON(pAd))
AsicUpdateProtect(pAd, 0, (ALLN_SETPROTECT|CCKSETPROTECT|OFDMSETPROTECT), TRUE, FALSE);
APUpdateCapabilityAndErpIe(pAd);
#ifdef DOT11_N_SUPPORT
APUpdateOperationMode(pAd);
#endif /* DOT11_N_SUPPORT */
CFG80211_UpdateBeacon(pAd, pBeacon->beacon_head, pBeacon->beacon_head_len,
pBeacon->beacon_tail, pBeacon->beacon_tail_len, TRUE);
#ifdef RT_CFG80211_P2P_MULTI_CHAN_SUPPORT
if (INFRA_ON(pAd))
{
ULONG BPtoJiffies;
LONG timeDiff;
INT starttime= pAd->Mlme.channel_1st_staytime;
NdisGetSystemUpTime(&pAd->Mlme.BeaconNow32);
timeDiff = (pAd->Mlme.BeaconNow32 - pAd->StaCfg.LastBeaconRxTime) % (pAd->CommonCfg.BeaconPeriod);
DBGPRINT(RT_DEBUG_TRACE, ("#####pAd->Mlme.Now32 %d pAd->StaCfg.LastBeaconRxTime %d \n",pAd->Mlme.BeaconNow32,pAd->StaCfg.LastBeaconRxTime));
DBGPRINT(RT_DEBUG_TRACE, ("#### timeDiff %d \n",timeDiff));
if (starttime > timeDiff)
{
OS_WAIT((starttime - timeDiff));
}
else{
OS_WAIT((starttime + (pAd->CommonCfg.BeaconPeriod - timeDiff)));
}
}
#endif /* RT_CFG80211_P2P_MULTI_CHAN_SUPPORT */
/* Enable BSS Sync*/
#ifdef RT_CFG80211_P2P_MULTI_CHAN_SUPPORT
if (INFRA_ON(pAd))
{
ULONG BPtoJiffies;
LONG timeDiff;
INT starttime= pAd->Mlme.channel_1st_staytime;
NdisGetSystemUpTime(&pAd->Mlme.BeaconNow32);
timeDiff = (pAd->Mlme.BeaconNow32 - pAd->StaCfg.LastBeaconRxTime) % (pAd->CommonCfg.BeaconPeriod);
DBGPRINT(RT_DEBUG_TRACE, ("#####pAd->Mlme.Now32 %d pAd->StaCfg.LastBeaconRxTime %d \n",pAd->Mlme.BeaconNow32,pAd->StaCfg.LastBeaconRxTime));
DBGPRINT(RT_DEBUG_TRACE, ("#### timeDiff %d \n",timeDiff));
if (starttime > timeDiff)
{
OS_WAIT((starttime - timeDiff));
}
else{
OS_WAIT((starttime + (pAd->CommonCfg.BeaconPeriod - timeDiff)));
}
}
#endif /* RT_CFG80211_P2P_MULTI_CHAN_SUPPORT */
AsicEnableApBssSync(pAd, pAd->CommonCfg.BeaconPeriod);
//pAd->P2pCfg.bSentProbeRSP = TRUE;
AsicSetPreTbtt(pAd, TRUE);
OPSTATUS_SET_FLAG(pAd, fOP_AP_STATUS_MEDIA_STATE_CONNECTED);
RTMP_IndicateMediaState(pAd, NdisMediaStateConnected);
return TRUE;
}
static USHORT update_associated_mac_entry(
IN RTMP_ADAPTER *pAd,
IN MAC_TABLE_ENTRY *pEntry,
IN IE_LISTS *ie_list,
IN UCHAR MaxSupportedRate)
{
MULTISSID_STRUCT *wdev;
#ifdef TXBF_SUPPORT
BOOLEAN supportsETxBF = FALSE;
#endif // TXBF_SUPPORT //
wdev = &pAd->ApCfg.MBSSID[pEntry->apidx];
/* Update auth, wep, legacy transmit rate setting . */
pEntry->Sst = SST_ASSOC;
pEntry->MaxSupportedRate = min(pAd->CommonCfg.MaxTxRate, MaxSupportedRate);
set_entry_phy_cfg(pAd, pEntry);
pEntry->CapabilityInfo = ie_list->CapabilityInfo;
if ((pEntry->AuthMode == Ndis802_11AuthModeWPAPSK) || (pEntry->AuthMode == Ndis802_11AuthModeWPA2PSK))
{
pEntry->PrivacyFilter = Ndis802_11PrivFilter8021xWEP;
pEntry->WpaState = AS_INITPSK;
}
#ifdef DOT1X_SUPPORT
else if ((pEntry->AuthMode == Ndis802_11AuthModeWPA) ||
(pEntry->AuthMode == Ndis802_11AuthModeWPA2) ||
(wdev->IEEE8021X == TRUE))
{
pEntry->PrivacyFilter = Ndis802_11PrivFilter8021xWEP;
pEntry->WpaState = AS_AUTHENTICATION;
}
#endif /* DOT1X_SUPPORT */
/*if (ClientRalinkIe & 0x00000004) */
if (ie_list->RalinkIe != 0x0)
CLIENT_STATUS_SET_FLAG(pEntry, fCLIENT_STATUS_RALINK_CHIPSET);
else
CLIENT_STATUS_CLEAR_FLAG(pEntry, fCLIENT_STATUS_RALINK_CHIPSET);
/* Ralink proprietary Piggyback and Aggregation support for legacy RT61 chip */
CLIENT_STATUS_CLEAR_FLAG(pEntry, fCLIENT_STATUS_AGGREGATION_CAPABLE);
CLIENT_STATUS_CLEAR_FLAG(pEntry, fCLIENT_STATUS_PIGGYBACK_CAPABLE);
#ifdef AGGREGATION_SUPPORT
if ((pAd->CommonCfg.bAggregationCapable) && (ie_list->RalinkIe & 0x00000001))
{
CLIENT_STATUS_SET_FLAG(pEntry, fCLIENT_STATUS_AGGREGATION_CAPABLE);
DBGPRINT(RT_DEBUG_TRACE, ("ASSOC -RaAggregate= 1\n"));
}
#endif /* AGGREGATION_SUPPORT */
#ifdef PIGGYBACK_SUPPORT
if ((pAd->CommonCfg.bPiggyBackCapable) && (ie_list->RalinkIe & 0x00000002))
{
CLIENT_STATUS_SET_FLAG(pEntry, fCLIENT_STATUS_PIGGYBACK_CAPABLE);
DBGPRINT(RT_DEBUG_TRACE, ("ASSOC -PiggyBack= 1\n"));
}
#endif /* PIGGYBACK_SUPPORT */
/* In WPA or 802.1x mode, the port is not secured, otherwise is secued. */
if ((pEntry->AuthMode >= Ndis802_11AuthModeWPA)
#ifdef DOT1X_SUPPORT
|| (wdev->IEEE8021X == TRUE)
#endif /* DOT1X_SUPPORT */
)
pEntry->PortSecured = WPA_802_1X_PORT_NOT_SECURED;
else
pEntry->PortSecured = WPA_802_1X_PORT_SECURED;
#ifdef SOFT_ENCRYPT
/* There are some situation to need to encryption by software
1. The Client support PMF. It shall ony support AES cipher.
2. The Client support WAPI.
If use RT3883 or later, HW can handle the above.
*/
#endif /* SOFT_ENCRYPT */
#ifdef DOT11_N_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(pEntry->WepStatus))
{
/* Force to None-HT mode due to WiFi 11n policy */
ie_list->ht_cap_len = 0;
DBGPRINT(RT_DEBUG_TRACE, ("%s : Force the STA as Non-HT mode\n", __FUNCTION__));
}
/* If this Entry supports 802.11n, upgrade to HT rate. */
if ((ie_list->ht_cap_len != 0) &&
(wdev->DesiredHtPhyInfo.bHtEnable) &&
WMODE_CAP_N(pAd->CommonCfg.PhyMode))
{
ht_mode_adjust(pAd, pEntry, &ie_list->HTCapability, &pAd->CommonCfg.DesiredHtPhy);
#ifdef DOT11N_DRAFT3
if (ie_list->ExtCapInfo.BssCoexistMgmtSupport)
pEntry->BSS2040CoexistenceMgmtSupport = 1;
#endif /* DOT11N_DRAFT3 */
/* 40Mhz BSS Width Trigger events */
if (ie_list->HTCapability.HtCapInfo.Forty_Mhz_Intolerant)
{
#ifdef DOT11N_DRAFT3
pEntry->bForty_Mhz_Intolerant = TRUE;
pAd->MacTab.fAnyStaFortyIntolerant = TRUE;
if(((pAd->CommonCfg.HtCapability.HtCapInfo.ChannelWidth == BW_40) &&
(pAd->CommonCfg.Channel <=14)) &&
((pAd->CommonCfg.bBssCoexEnable == TRUE) &&
(pAd->CommonCfg.AddHTInfo.AddHtInfo.RecomWidth != 0) &&
(pAd->CommonCfg.AddHTInfo.AddHtInfo.ExtChanOffset != 0))
)
{
pAd->CommonCfg.LastBSSCoexist2040.field.BSS20WidthReq = 1;
pAd->CommonCfg.AddHTInfo.AddHtInfo.RecomWidth = 0;
pAd->CommonCfg.AddHTInfo.AddHtInfo.ExtChanOffset = 0;
pAd->CommonCfg.Bss2040CoexistFlag |= BSS_2040_COEXIST_INFO_SYNC;
}
DBGPRINT(RT_DEBUG_TRACE, ("pEntry set 40MHz Intolerant as 1\n"));
#endif /* DOT11N_DRAFT3 */
Handle_BSS_Width_Trigger_Events(pAd);
}
#ifdef TXBF_SUPPORT
supportsETxBF = clientSupportsETxBF(pAd, &ie_list->HtCapability.TxBFCap);
#endif /* TXBF_SUPPORT */
/* find max fixed rate */
pEntry->MaxHTPhyMode.field.MCS = get_ht_max_mcs(pAd, &wdev->DesiredHtPhyInfo.MCSSet[0],
&ie_list->HTCapability.MCSSet[0]);
if (wdev->DesiredTransmitSetting.field.MCS != MCS_AUTO)
{
DBGPRINT(RT_DEBUG_TRACE, ("@@@ IF-ra%d DesiredTransmitSetting.field.MCS = %d\n",
pEntry->apidx,
wdev->DesiredTransmitSetting.field.MCS));
set_ht_fixed_mcs(pAd, pEntry, wdev->DesiredTransmitSetting.field.MCS, wdev->HTPhyMode.field.MCS);
}
pEntry->MaxHTPhyMode.field.STBC = (ie_list->HTCapability.HtCapInfo.RxSTBC & (pAd->CommonCfg.DesiredHtPhy.TxSTBC));
// TODO: shiang-6590, check if this is necessary here, perforce didn't have this
if (ie_list->HTCapability.HtCapParm.MpduDensity < 5)
ie_list->HTCapability.HtCapParm.MpduDensity = 5;
pEntry->MpduDensity = ie_list->HTCapability.HtCapParm.MpduDensity;
pEntry->MaxRAmpduFactor = ie_list->HTCapability.HtCapParm.MaxRAmpduFactor;
pEntry->MmpsMode = (UCHAR)ie_list->HTCapability.HtCapInfo.MimoPs;
pEntry->AMsduSize = (UCHAR)ie_list->HTCapability.HtCapInfo.AMsduSize;
if (pAd->CommonCfg.DesiredHtPhy.AmsduEnable && (pAd->CommonCfg.REGBACapability.field.AutoBA == FALSE))
CLIENT_STATUS_SET_FLAG(pEntry, fCLIENT_STATUS_AMSDU_INUSED);
if (ie_list->HTCapability.HtCapInfo.ShortGIfor20)
CLIENT_STATUS_SET_FLAG(pEntry, fCLIENT_STATUS_SGI20_CAPABLE);
if (ie_list->HTCapability.HtCapInfo.ShortGIfor40)
CLIENT_STATUS_SET_FLAG(pEntry, fCLIENT_STATUS_SGI40_CAPABLE);
if (ie_list->HTCapability.HtCapInfo.TxSTBC)
CLIENT_STATUS_SET_FLAG(pEntry, fCLIENT_STATUS_TxSTBC_CAPABLE);
if (ie_list->HTCapability.HtCapInfo.RxSTBC)
CLIENT_STATUS_SET_FLAG(pEntry, fCLIENT_STATUS_RxSTBC_CAPABLE);
if (ie_list->HTCapability.ExtHtCapInfo.PlusHTC)
CLIENT_STATUS_SET_FLAG(pEntry, fCLIENT_STATUS_HTC_CAPABLE);
if (pAd->CommonCfg.bRdg && ie_list->HTCapability.ExtHtCapInfo.RDGSupport)
CLIENT_STATUS_SET_FLAG(pEntry, fCLIENT_STATUS_RDG_CAPABLE);
if (ie_list->HTCapability.ExtHtCapInfo.MCSFeedback == 0x03)
CLIENT_STATUS_SET_FLAG(pEntry, fCLIENT_STATUS_MCSFEEDBACK_CAPABLE);
/* Record the received capability from association request */
NdisMoveMemory(&pEntry->HTCapability, &ie_list->HTCapability, sizeof(HT_CAPABILITY_IE));
#ifdef DOT11_VHT_AC
if (WMODE_CAP_AC(pAd->CommonCfg.PhyMode) &&
(pAd->CommonCfg.Channel > 14) &&
ie_list->vht_cap_len)
{
pEntry->MaxHTPhyMode.field.MODE = MODE_VHT;
if ((pEntry->MaxHTPhyMode.field.BW== BW_40) && (wdev->DesiredHtPhyInfo.vht_bw))
pEntry->MaxHTPhyMode.field.BW = BW_80;
NdisMoveMemory(&pEntry->vht_cap_ie, &ie_list->vht_cap, sizeof(VHT_CAP_IE));
}
#endif /* DOT11_VHT_AC */
}
else
{
pAd->MacTab.fAnyStationIsLegacy = TRUE;
NdisZeroMemory(&pEntry->HTCapability, sizeof(HT_CAPABILITY_IE));
}
#endif /* DOT11_N_SUPPORT */
pEntry->HTPhyMode.word = pEntry->MaxHTPhyMode.word;
pEntry->CurrTxRate = pEntry->MaxSupportedRate;
#ifdef MFB_SUPPORT
pEntry->lastLegalMfb = 0;
pEntry->isMfbChanged = FALSE;
pEntry->fLastChangeAccordingMfb = FALSE;
pEntry->toTxMrq = TRUE;
pEntry->msiToTx = 0;/*has to increment whenever a mrq is sent */
pEntry->mrqCnt = 0;
pEntry->pendingMfsi = 0;
pEntry->toTxMfb = FALSE;
pEntry->mfbToTx = 0;
pEntry->mfb0 = 0;
pEntry->mfb1 = 0;
#endif /* MFB_SUPPORT */
pEntry->freqOffsetValid = FALSE;
#ifdef TXBF_SUPPORT
if (pAd->chipCap.FlgHwTxBfCap)
TxBFInit(pAd, pEntry, supportsETxBF);
#endif // TXBF_SUPPORT //
// Initialize Rate Adaptation
MlmeRAInit(pAd, pEntry);
/* Set asic auto fall back */
if (wdev->bAutoTxRateSwitch == TRUE)
{
UCHAR TableSize = 0;
MlmeSelectTxRateTable(pAd, pEntry, &pEntry->pTable, &TableSize, &pEntry->CurrTxRateIndex);
MlmeNewTxRate(pAd, pEntry);
pEntry->bAutoTxRateSwitch = TRUE;
#ifdef NEW_RATE_ADAPT_SUPPORT
if (! ADAPT_RATE_TABLE(pEntry->pTable))
#endif /* NEW_RATE_ADAPT_SUPPORT */
pEntry->HTPhyMode.field.ShortGI = GI_800;
}
else
{
pEntry->HTPhyMode.field.MCS = wdev->HTPhyMode.field.MCS;
pEntry->bAutoTxRateSwitch = FALSE;
/* If the legacy mode is set, overwrite the transmit setting of this entry. */
RTMPUpdateLegacyTxSetting((UCHAR)wdev->DesiredTransmitSetting.field.FixedTxMode, pEntry);
}
if (pEntry->AuthMode < Ndis802_11AuthModeWPA)
ApLogEvent(pAd, pEntry->Addr, EVENT_ASSOCIATED);
APUpdateCapabilityAndErpIe(pAd);
#ifdef DOT11_N_SUPPORT
APUpdateOperationMode(pAd);
#endif /* DOT11_N_SUPPORT */
pEntry->ReTryCounter = PEER_MSG1_RETRY_TIMER_CTR;
#ifdef HOSTAPD_SUPPORT
if((wdev->Hostapd == TRUE) &&
((wdev->AuthMode >= Ndis802_11AuthModeWPA) || wdev->IEEE8021X))
{
RtmpOSWrielessEventSendExt(pAd->net_dev, RT_WLAN_EVENT_EXPIRED,
-1, pEntry->Addr, NULL, 0,
((pEntry->CapabilityInfo & 0x0010) == 0 ? 0xFFFD : 0xFFFC));
}
#endif /*HOSTAPD_SUPPORT*/
return MLME_SUCCESS;
}
/*
==========================================================================
Description:
This routine is executed every second -
1. Decide the overall channel quality
2. Check if need to upgrade the TX rate to any client
3. perform MAC table maintenance, including ageout no-traffic clients,
and release packet buffer in PSQ is fail to TX in time.
==========================================================================
*/
VOID APMlmePeriodicExec(
PRTMP_ADAPTER pAd)
{
/*
Reqeust by David 2005/05/12
It make sense to disable Adjust Tx Power on AP mode, since we can't
take care all of the client's situation
ToDo: need to verify compatibility issue with WiFi product.
*/
#ifdef CARRIER_DETECTION_SUPPORT
if (isCarrierDetectExist(pAd) == TRUE)
{
PCARRIER_DETECTION_STRUCT pCarrierDetect = &pAd->CommonCfg.CarrierDetect;
if (pCarrierDetect->OneSecIntCount < pCarrierDetect->CarrierGoneThreshold)
{
pCarrierDetect->CD_State = CD_NORMAL;
pCarrierDetect->recheck = pCarrierDetect->recheck1;
if (pCarrierDetect->Debug != RT_DEBUG_TRACE)
{
DBGPRINT(RT_DEBUG_TRACE, ("Carrier gone\n"));
/* start all TX actions. */
APMakeAllBssBeacon(pAd);
APUpdateAllBeaconFrame(pAd);
AsicEnableBssSync(pAd);
}
else
{
DBGPRINT(RT_DEBUG_TRACE, ("Carrier gone\n"));
}
}
pCarrierDetect->OneSecIntCount = 0;
}
#endif /* CARRIER_DETECTION_SUPPORT */
RTMP_CHIP_HIGH_POWER_TUNING(pAd, &pAd->ApCfg.RssiSample);
/* Disable Adjust Tx Power for WPA WiFi-test. */
/* Because high TX power results in the abnormal disconnection of Intel BG-STA. */
/*#ifndef WIFI_TEST */
/* if (pAd->CommonCfg.bWiFiTest == FALSE) */
/* for SmartBit 64-byte stream test */
/* removed based on the decision of Ralink congress at 2011/7/06 */
/* if (pAd->MacTab.Size > 0) */
#ifdef RT6352
if (IS_RT6352(pAd))
RT6352_AsicAdjustTxPower(pAd);
else
#endif /* RT6352 */
AsicAdjustTxPower(pAd);
/*#endif // WIFI_TEST */
#ifdef THERMAL_PROTECT_SUPPORT
thermal_protection(pAd);
#endif /* THERMAL_PROTECT_SUPPORT */
RTMP_CHIP_ASIC_TEMPERATURE_COMPENSATION(pAd);
/* walk through MAC table, see if switching TX rate is required */
/* MAC table maintenance */
if (pAd->Mlme.PeriodicRound % MLME_TASK_EXEC_MULTIPLE == 0)
{
/* one second timer */
MacTableMaintenance(pAd);
#ifdef CONFIG_FPGA_MODE
if (pAd->fpga_ctl.fpga_tr_stop)
{
UINT32 mac_val;
/* enable/disable tx/rx*/
RTMP_IO_READ32(pAd, MAC_SYS_CTRL, &mac_val);
switch (pAd->fpga_ctl.fpga_tr_stop)
{
case 3: //stop tx + rx
mac_val &= (~0xc);
break;
case 2: // stop rx
mac_val &= (~0x8);
break;
case 1: // stop tx
mac_val &= (~0x4);
break;
case 4:
default:
mac_val |= 0x0c;
break;
}
RTMP_IO_WRITE32(pAd, MAC_SYS_CTRL, mac_val);
}
#endif /* CONFIG_FPGA_MODE */
RTMPMaintainPMKIDCache(pAd);
#ifdef WDS_SUPPORT
WdsTableMaintenance(pAd);
#endif /* WDS_SUPPORT */
#ifdef CLIENT_WDS
CliWds_ProxyTabMaintain(pAd);
#endif /* CLIENT_WDS */
}
#ifdef AP_SCAN_SUPPORT
AutoChannelSelCheck(pAd);
#endif /* AP_SCAN_SUPPORT */
APUpdateCapabilityAndErpIe(pAd);
#ifdef APCLI_SUPPORT
if (pAd->Mlme.OneSecPeriodicRound % 2 == 0)
ApCliIfMonitor(pAd);
if (pAd->Mlme.OneSecPeriodicRound % 2 == 1)
#ifdef APCLI_AUTO_CONNECT_SUPPORT
if (pAd->ApCfg.ApCliAutoConnectChannelSwitching == FALSE)
#endif /* APCLI_AUTO_CONNECT_SUPPORT */
ApCliIfUp(pAd);
{
INT loop;
ULONG Now32;
#ifdef APCLI_CERT_SUPPORT
BOOLEAN IsUseBA = TRUE;
#endif /* APCLI_CERT_SUPPORT */
#ifdef MAC_REPEATER_SUPPORT
if (pAd->ApCfg.bMACRepeaterEn == TRUE)
{
#ifdef APCLI_AUTO_CONNECT_SUPPORT
RTMPRepeaterReconnectionCheck(pAd);
#endif /* APCLI_AUTO_CONNECT_SUPPORT */
}
#endif /* MAC_REPEATER_SUPPORT */
NdisGetSystemUpTime(&Now32);
for (loop = 0; loop < MAX_APCLI_NUM; loop++)
{
PAPCLI_STRUCT pApCliEntry = &pAd->ApCfg.ApCliTab[loop];
if (pAd->ApCfg.ApCliTab[loop].bBlockAssoc ==TRUE && pAd->ApCfg.ApCliTab[loop].bBlockAssoc &&
RTMP_TIME_AFTER(Now32, pAd->ApCfg.ApCliTab[loop].LastMicErrorTime + (60*OS_HZ)))
pAd->ApCfg.ApCliTab[loop].bBlockAssoc = FALSE;
if ((pApCliEntry->Valid == TRUE)
&& (pApCliEntry->MacTabWCID < MAX_LEN_OF_MAC_TABLE))
{
/* update channel quality for Roaming and UI LinkQuality display */
MlmeCalculateChannelQuality(pAd,
&pAd->MacTab.Content[pApCliEntry->MacTabWCID], Now32);
/* WPA MIC error should block association attempt for 60 seconds*/
#ifdef APCLI_CERT_SUPPORT
if (pAd->bApCliCertTest == TRUE)
{
PMAC_TABLE_ENTRY pEntry = &pAd->MacTab.Content[pApCliEntry->MacTabWCID];
struct wifi_dev *wdev = NULL;
wdev = &pApCliEntry->wdev;
if (pEntry->RXBAbitmap == 0 && pEntry->TXBAbitmap == 0)
IsUseBA = FALSE;
if( wdev->DesiredHtPhyInfo.bHtEnable &&
IsUseBA == FALSE )
{
EDCA_AC_CFG_STRUC Ac2Cfg, Ac1Cfg;
RTMP_IO_READ32(pAd, EDCA_AC2_CFG, &Ac2Cfg.word);
RTMP_IO_READ32(pAd, EDCA_AC1_CFG, &Ac1Cfg.word);
if ((pAd->RalinkCounters.OneSecOsTxCount[QID_AC_VO] == 0) &&
(pAd->RalinkCounters.OneSecOsTxCount[QID_AC_BK] >= 1000) &&
(pAd->RalinkCounters.OneSecOsTxCount[QID_AC_VI] == 0))
{
/*5.2.27 T7 */
if (Ac1Cfg.field.Aifsn!=0x1)
{
Ac1Cfg.field.Aifsn = 0x1;
RTMP_IO_WRITE32(pAd, EDCA_AC1_CFG, Ac1Cfg.word);
printk("Change EDCA_AC1_CFG to %x \n", Ac1Cfg.word);
}
}
else if ((pAd->RalinkCounters.OneSecOsTxCount[QID_AC_VO] == 0) &&
(pAd->RalinkCounters.OneSecOsTxCount[QID_AC_BK] == 0) &&
(pAd->RalinkCounters.OneSecOsTxCount[QID_AC_VI] == 0) &&
(pAd->RalinkCounters.OneSecOsTxCount[QID_AC_BE] < 10))
{
/* restore default parameter of BK*/
if (Ac1Cfg.field.Aifsn!=0x7)
{
Ac1Cfg.field.Aifsn = 0x7;
RTMP_IO_WRITE32(pAd, EDCA_AC1_CFG, Ac1Cfg.word);
printk("Restore EDCA_AC1_CFG to %x \n", Ac1Cfg.word);
}
}
pAd->RalinkCounters.OneSecOsTxCount[QID_AC_BE] = 0;
pAd->RalinkCounters.OneSecOsTxCount[QID_AC_BK] = 0;
pAd->RalinkCounters.OneSecOsTxCount[QID_AC_VI] = 0;
pAd->RalinkCounters.OneSecOsTxCount[QID_AC_VO] = 0;
}
}
#endif /* APCLI_CERT_SUPPORT */
}
}
}
#endif /* APCLI_SUPPORT */
#ifdef DOT11_N_SUPPORT
if (pAd->CommonCfg.bHTProtect)
{
/*APUpdateCapabilityAndErpIe(pAd); */
APUpdateOperationMode(pAd);
if (pAd->CommonCfg.IOTestParm.bRTSLongProtOn == FALSE)
{
AsicUpdateProtect(pAd, (USHORT)pAd->CommonCfg.AddHTInfo.AddHtInfo2.OperaionMode, ALLN_SETPROTECT, FALSE, pAd->MacTab.fAnyStationNonGF);
}
}
#endif /* DOT11_N_SUPPORT */
#ifdef A_BAND_SUPPORT
if ( (pAd->CommonCfg.Channel > 14)
&& (pAd->CommonCfg.bIEEE80211H == 1)
)
{
#ifdef DFS_SUPPORT
ApRadarDetectPeriodic(pAd);
#else
pAd->Dot11_H.InServiceMonitorCount++;
if (pAd->Dot11_H.RDMode == RD_SILENCE_MODE)
{
if (pAd->Dot11_H.RDCount++ > pAd->Dot11_H.ChMovingTime)
{
AsicEnableBssSync(pAd);
pAd->Dot11_H.RDMode = RD_NORMAL_MODE;
}
}
#endif /* !DFS_SUPPORT */
}
#endif /* A_BAND_SUPPORT */
#ifdef APCLI_SUPPORT
#ifdef DOT11_N_SUPPORT
#ifdef DOT11N_DRAFT3
#ifdef APCLI_CERT_SUPPORT
/* Perform 20/40 BSS COEX scan every Dot11BssWidthTriggerScanInt */
if (APCLI_IF_UP_CHECK(pAd, 0) && (pAd->bApCliCertTest == TRUE))
{
if ((OPSTATUS_TEST_FLAG(pAd, fOP_STATUS_SCAN_2040)) &&
(pAd->CommonCfg.Dot11BssWidthTriggerScanInt != 0) &&
((pAd->Mlme.OneSecPeriodicRound % pAd->CommonCfg.Dot11BssWidthTriggerScanInt) == (pAd->CommonCfg.Dot11BssWidthTriggerScanInt-1)))
{
DBGPRINT(RT_DEBUG_TRACE, ("MMCHK - LastOneSecTotalTxCount/LastOneSecRxOkDataCnt = %d/%d \n",
pAd->RalinkCounters.LastOneSecTotalTxCount,
pAd->RalinkCounters.LastOneSecRxOkDataCnt));
/* Check last scan time at least 30 seconds from now. */
/* Check traffic is less than about 1.5~2Mbps.*/
/* it might cause data lost if we enqueue scanning.*/
/* This criteria needs to be considered*/
if ((pAd->RalinkCounters.LastOneSecTotalTxCount < 70) && (pAd->RalinkCounters.LastOneSecRxOkDataCnt < 70)
/*&& ((pAd->StaCfg.LastScanTime + 10 * OS_HZ) < pAd->Mlme.Now32) */)
{
MLME_SCAN_REQ_STRUCT ScanReq;
/* Fill out stuff for scan request and kick to scan*/
ScanParmFill(pAd, &ScanReq, ZeroSsid, 0, BSS_ANY, SCAN_2040_BSS_COEXIST);
/* Before scan, reset trigger event table. */
TriEventInit(pAd);
MlmeEnqueue(pAd, AP_SYNC_STATE_MACHINE, APMT2_MLME_SCAN_REQ, sizeof(MLME_SCAN_REQ_STRUCT), &ScanReq, 0);
/* Set InfoReq = 1, So after scan , alwats sebd 20/40 Coexistence frame to AP*/
pAd->CommonCfg.BSSCoexist2040.field.InfoReq = 1;
RTMP_MLME_HANDLER(pAd);
}
DBGPRINT(RT_DEBUG_TRACE, (" LastOneSecTotalTxCount/LastOneSecRxOkDataCnt = %d/%d \n",
pAd->RalinkCounters.LastOneSecTotalTxCount,
pAd->RalinkCounters.LastOneSecRxOkDataCnt));
}
}
#endif /* APCLI_CERT_SUPPORT */
#endif /* DOT11N_DRAFT3 */
#endif /* DOT11_N_SUPPORT */
#endif /* APCLI_SUPPORT */
}
