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;
}
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;
}
/*
========================================================================
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 */
}
/*
========================================================================
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);
}
}