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 RTMPSetHT(
IN RTMP_ADAPTER *pAd,
IN OID_SET_HT_PHYMODE *pHTPhyMode)
{
UCHAR RxStream = pAd->CommonCfg.RxStream;
#ifdef CONFIG_AP_SUPPORT
INT apidx;
#endif /* CONFIG_AP_SUPPORT */
#ifdef CONFIG_MULTI_CHANNEL
#if defined(RT_CFG80211_SUPPORT) && defined(CONFIG_AP_SUPPORT)
BSS_STRUCT *pMbss = &pAd->ApCfg.MBSSID[CFG_GO_BSSID_IDX];
struct wifi_dev *wdev = &pMbss->wdev;
#endif /* defined(RT_CFG80211_SUPPORT) && defined(CONFIG_AP_SUPPORT) */
#endif /* CONFIG_MULTI_CHANNEL */
INT bw;
RT_HT_CAPABILITY *rt_ht_cap = &pAd->CommonCfg.DesiredHtPhy;
HT_CAPABILITY_IE *ht_cap= &pAd->CommonCfg.HtCapability;
#ifdef CONFIG_AP_SUPPORT
/* sanity check for extention channel */
if (CHAN_PropertyCheck(pAd, pAd->CommonCfg.Channel,
CHANNEL_NO_FAT_BELOW | CHANNEL_NO_FAT_ABOVE) == TRUE)
{
/* only 20MHz is allowed */
pHTPhyMode->BW = 0;
}
else if (pHTPhyMode->ExtOffset == EXTCHA_BELOW)
{
/* extension channel below this channel is not allowed */
if (CHAN_PropertyCheck(pAd, pAd->CommonCfg.Channel,
CHANNEL_NO_FAT_BELOW) == TRUE)
{
pHTPhyMode->ExtOffset = EXTCHA_ABOVE;
}
}
else if (pHTPhyMode->ExtOffset == EXTCHA_ABOVE)
{
/* extension channel above this channel is not allowed */
if (CHAN_PropertyCheck(pAd, pAd->CommonCfg.Channel,
CHANNEL_NO_FAT_ABOVE) == TRUE)
{
pHTPhyMode->ExtOffset = EXTCHA_BELOW;
}
}
#endif /* CONFIG_AP_SUPPORT */
MTWF_LOG(DBG_CAT_ALL, DBG_SUBCAT_ALL, DBG_LVL_TRACE, ("RTMPSetHT : HT_mode(%d), ExtOffset(%d), MCS(%d), BW(%d), STBC(%d), SHORTGI(%d)\n",
pHTPhyMode->HtMode, pHTPhyMode->ExtOffset,
pHTPhyMode->MCS, pHTPhyMode->BW,
pHTPhyMode->STBC, pHTPhyMode->SHORTGI));
/* Don't zero supportedHyPhy structure.*/
RTMPZeroMemory(ht_cap, sizeof(HT_CAPABILITY_IE));
RTMPZeroMemory(&pAd->CommonCfg.AddHTInfo, sizeof(pAd->CommonCfg.AddHTInfo));
RTMPZeroMemory(&pAd->CommonCfg.NewExtChanOffset, sizeof(pAd->CommonCfg.NewExtChanOffset));
RTMPZeroMemory(rt_ht_cap, sizeof(RT_HT_CAPABILITY));
if (pAd->CommonCfg.bRdg)
{
ht_cap->ExtHtCapInfo.PlusHTC = 1;
ht_cap->ExtHtCapInfo.RDGSupport = 1;
}
else
{
ht_cap->ExtHtCapInfo.PlusHTC = 0;
ht_cap->ExtHtCapInfo.RDGSupport = 0;
}
ht_cap->HtCapParm.MaxRAmpduFactor = pAd->chipCap.AMPDUFactor;
rt_ht_cap->MaxRAmpduFactor = pAd->chipCap.AMPDUFactor;
MTWF_LOG(DBG_CAT_ALL, DBG_SUBCAT_ALL, DBG_LVL_TRACE, ("RTMPSetHT : RxBAWinLimit = %d\n", pAd->CommonCfg.BACapability.field.RxBAWinLimit));
/* Mimo power save, A-MSDU size, */
rt_ht_cap->AmsduEnable = (USHORT)pAd->CommonCfg.BACapability.field.AmsduEnable;
rt_ht_cap->AmsduSize = (UCHAR)pAd->CommonCfg.BACapability.field.AmsduSize;
rt_ht_cap->MimoPs = (UCHAR)pAd->CommonCfg.BACapability.field.MMPSmode;
rt_ht_cap->MpduDensity = (UCHAR)pAd->CommonCfg.BACapability.field.MpduDensity;
ht_cap->HtCapInfo.AMsduSize = (USHORT)pAd->CommonCfg.BACapability.field.AmsduSize;
ht_cap->HtCapInfo.MimoPs = (USHORT)pAd->CommonCfg.BACapability.field.MMPSmode;
if (pAd->CommonCfg.ht_ldpc && (pAd->chipCap.phy_caps & fPHY_CAP_LDPC))
ht_cap->HtCapInfo.ht_rx_ldpc = 1;
else
ht_cap->HtCapInfo.ht_rx_ldpc = 0;
ht_cap->HtCapParm.MpduDensity = (UCHAR)pAd->CommonCfg.BACapability.field.MpduDensity;
MTWF_LOG(DBG_CAT_ALL, DBG_SUBCAT_ALL, DBG_LVL_TRACE, ("RTMPSetHT : AMsduSize = %d, MimoPs = %d, MpduDensity = %d, MaxRAmpduFactor = %d\n",
rt_ht_cap->AmsduSize,
rt_ht_cap->MimoPs,
rt_ht_cap->MpduDensity,
rt_ht_cap->MaxRAmpduFactor));
if(pHTPhyMode->HtMode == HTMODE_GF)
{
ht_cap->HtCapInfo.GF = 1;
rt_ht_cap->GF = 1;
}
else
rt_ht_cap->GF = 0;
/* Decide Rx MCSSet*/
switch (RxStream)
{
case 3:
ht_cap->MCSSet[2] = 0xff;
case 2:
ht_cap->MCSSet[1] = 0xff;
case 1:
default:
ht_cap->MCSSet[0] = 0xff;
break;
}
if (pAd->CommonCfg.bForty_Mhz_Intolerant && (pHTPhyMode->BW == BW_40))
{
pHTPhyMode->BW = BW_20;
ht_cap->HtCapInfo.Forty_Mhz_Intolerant = 1;
}
// TODO: shiang-6590, how about the "bw" when channel 14 for JP region???
//CFG_TODO
bw = BW_20;
if(pHTPhyMode->BW == BW_40)
{
ht_cap->MCSSet[4] = 0x1; /* MCS 32*/
ht_cap->HtCapInfo.ChannelWidth = 1;
if (pAd->CommonCfg.Channel <= 14)
ht_cap->HtCapInfo.CCKmodein40 = 1;
rt_ht_cap->ChannelWidth = 1;
pAd->CommonCfg.AddHTInfo.AddHtInfo.RecomWidth = 1;
pAd->CommonCfg.AddHTInfo.AddHtInfo.ExtChanOffset = (pHTPhyMode->ExtOffset == EXTCHA_BELOW)? (EXTCHA_BELOW): EXTCHA_ABOVE;
/* Set Regsiter for extension channel position.*/
AsicSetCtrlCh(pAd, pHTPhyMode->ExtOffset);
/* Turn on BBP 40MHz mode now only as AP . */
/* Sta can turn on BBP 40MHz after connection with 40MHz AP. Sta only broadcast 40MHz capability before connection.*/
if ((pAd->OpMode == OPMODE_AP) || INFRA_ON(pAd) || ADHOC_ON(pAd)
)
{
bbp_set_ctrlch(pAd, pHTPhyMode->ExtOffset);
#ifdef GREENAP_SUPPORT
if (pAd->ApCfg.bGreenAPActive == 1)
bw = BW_20;
else
#endif /* GREENAP_SUPPORT */
bw = BW_40;
}
}
else
{
ht_cap->HtCapInfo.ChannelWidth = 0;
rt_ht_cap->ChannelWidth = 0;
pAd->CommonCfg.AddHTInfo.AddHtInfo.RecomWidth = 0;
pAd->CommonCfg.AddHTInfo.AddHtInfo.ExtChanOffset = EXTCHA_NONE;
pAd->CommonCfg.CentralChannel = pAd->CommonCfg.Channel;
/* Turn on BBP 20MHz mode by request here.*/
bw = BW_20;
}
#ifdef DOT11_VHT_AC
if (pHTPhyMode->BW == BW_40 &&
pAd->CommonCfg.vht_bw == VHT_BW_80 &&
pAd->CommonCfg.vht_cent_ch)
bw = BW_80;
#endif /* DOT11_VHT_AC */
#ifdef CONFIG_MULTI_CHANNEL
#if defined(RT_CFG80211_SUPPORT) && defined(CONFIG_AP_SUPPORT)
if ((wdev->bw == BW_20) && (wdev->channel != 0))
bbp_set_bw(pAd, wdev->bw);
else if (INFRA_ON(pAd))
bbp_set_bw(pAd, pAd->StaCfg.wdev.bw);
else
#endif /* defined(RT_CFG80211_SUPPORT) && defined(CONFIG_AP_SUPPORT) */
#endif /* CONFIG_MULTI_CHANNEL */
bbp_set_bw(pAd, bw);
if(pHTPhyMode->STBC == STBC_USE)
{
if (pAd->Antenna.field.TxPath >= 2)
{
ht_cap->HtCapInfo.TxSTBC = 1;
rt_ht_cap->TxSTBC = 1;
}
else
{
ht_cap->HtCapInfo.TxSTBC = 0;
rt_ht_cap->TxSTBC = 0;
}
/*
RxSTBC
0: not support,
1: support for 1SS
2: support for 1SS, 2SS
3: support for 1SS, 2SS, 3SS
*/
if (pAd->Antenna.field.RxPath >= 1)
{
ht_cap->HtCapInfo.RxSTBC = 1;
rt_ht_cap->RxSTBC = 1;
}
else
{
ht_cap->HtCapInfo.RxSTBC = 0;
rt_ht_cap->RxSTBC = 0;
}
}
else
{
rt_ht_cap->TxSTBC = 0;
rt_ht_cap->RxSTBC = 0;
}
if(pHTPhyMode->SHORTGI == GI_400)
{
ht_cap->HtCapInfo.ShortGIfor20 = 1;
//ht_cap->HtCapInfo.ShortGIfor40 = 1;
rt_ht_cap->ShortGIfor20 = 1;
if(pHTPhyMode->BW == BW_40)
{
ht_cap->HtCapInfo.ShortGIfor40 = 1;
rt_ht_cap->ShortGIfor40 = 1;
}
else
{
ht_cap->HtCapInfo.ShortGIfor40 = 0;
rt_ht_cap->ShortGIfor40 = 0;
}
}
else
{
ht_cap->HtCapInfo.ShortGIfor20 = 0;
ht_cap->HtCapInfo.ShortGIfor40 = 0;
rt_ht_cap->ShortGIfor20 = 0;
rt_ht_cap->ShortGIfor40 = 0;
}
/* We support link adaptation for unsolicit MCS feedback, set to 2.*/
pAd->CommonCfg.AddHTInfo.ControlChan = pAd->CommonCfg.Channel;
/* 1, the extension channel above the control channel. */
/* EDCA parameters used for AP's own transmission*/
if (pAd->CommonCfg.APEdcaParm.bValid == FALSE)
set_default_ap_edca_param(pAd);
AsicSetEdcaParm(pAd, &pAd->CommonCfg.APEdcaParm);
#ifdef CONFIG_AP_SUPPORT
IF_DEV_CONFIG_OPMODE_ON_AP(pAd)
{
for (apidx = 0; apidx < pAd->ApCfg.BssidNum; apidx++)
RTMPSetIndividualHT(pAd, apidx);
#ifdef WDS_SUPPORT
for (apidx = 0; apidx < MAX_WDS_ENTRY; apidx++)
RTMPSetIndividualHT(pAd, apidx + MIN_NET_DEVICE_FOR_WDS);
#endif /* WDS_SUPPORT */
#ifdef APCLI_SUPPORT
for (apidx = 0; apidx < MAX_APCLI_NUM; apidx++)
RTMPSetIndividualHT(pAd, apidx + MIN_NET_DEVICE_FOR_APCLI);
#endif /* APCLI_SUPPORT */
}
#endif /* CONFIG_AP_SUPPORT */
}
/*
========================================================================
Routine Description:
Caller ensures we has 802.11n support.
Calls at setting HT from AP/STASetinformation
Arguments:
pAd - Pointer to our adapter
phymode -
========================================================================
*/
VOID RTMPSetHT(
IN struct rtmp_adapter *pAd,
IN OID_SET_HT_PHYMODE *pHTPhyMode)
{
u8 RxStream = pAd->CommonCfg.RxStream;
#ifdef CONFIG_AP_SUPPORT
INT apidx;
#endif /* CONFIG_AP_SUPPORT */
INT bw;
RT_HT_CAPABILITY *rt_ht_cap = &pAd->CommonCfg.DesiredHtPhy;
HT_CAPABILITY_IE *ht_cap= &pAd->CommonCfg.HtCapability;
#ifdef CONFIG_AP_SUPPORT
/* sanity check for extention channel */
if (CHAN_PropertyCheck(pAd, pAd->CommonCfg.Channel,
CHANNEL_NO_FAT_BELOW | CHANNEL_NO_FAT_ABOVE) == true)
{
/* only 20MHz is allowed */
pHTPhyMode->BW = 0;
}
else if (pHTPhyMode->ExtOffset == EXTCHA_BELOW)
{
/* extension channel below this channel is not allowed */
if (CHAN_PropertyCheck(pAd, pAd->CommonCfg.Channel,
CHANNEL_NO_FAT_BELOW) == true)
{
pHTPhyMode->ExtOffset = EXTCHA_ABOVE;
}
}
else if (pHTPhyMode->ExtOffset == EXTCHA_ABOVE)
{
/* extension channel above this channel is not allowed */
if (CHAN_PropertyCheck(pAd, pAd->CommonCfg.Channel,
CHANNEL_NO_FAT_ABOVE) == true)
{
pHTPhyMode->ExtOffset = EXTCHA_BELOW;
}
}
#endif /* CONFIG_AP_SUPPORT */
DBGPRINT(RT_DEBUG_TRACE, ("RTMPSetHT : HT_mode(%d), ExtOffset(%d), MCS(%d), BW(%d), STBC(%d), SHORTGI(%d)\n",
pHTPhyMode->HtMode, pHTPhyMode->ExtOffset,
pHTPhyMode->MCS, pHTPhyMode->BW,
pHTPhyMode->STBC, pHTPhyMode->SHORTGI));
/* Don't zero supportedHyPhy structure.*/
RTMPZeroMemory(ht_cap, sizeof(HT_CAPABILITY_IE));
RTMPZeroMemory(&pAd->CommonCfg.AddHTInfo, sizeof(pAd->CommonCfg.AddHTInfo));
RTMPZeroMemory(&pAd->CommonCfg.NewExtChanOffset, sizeof(pAd->CommonCfg.NewExtChanOffset));
RTMPZeroMemory(rt_ht_cap, sizeof(RT_HT_CAPABILITY));
if (pAd->CommonCfg.bRdg)
{
ht_cap->ExtHtCapInfo.PlusHTC = 1;
ht_cap->ExtHtCapInfo.RDGSupport = 1;
}
else
{
ht_cap->ExtHtCapInfo.PlusHTC = 0;
ht_cap->ExtHtCapInfo.RDGSupport = 0;
}
if (RxStream == 1)
{
ht_cap->HtCapParm.MaxRAmpduFactor = 2;
rt_ht_cap->MaxRAmpduFactor = 2;
}
else
{
ht_cap->HtCapParm.MaxRAmpduFactor = 3;
rt_ht_cap->MaxRAmpduFactor = 3;
}
DBGPRINT(RT_DEBUG_TRACE, ("RTMPSetHT : RxBAWinLimit = %d\n", pAd->CommonCfg.BACapability.field.RxBAWinLimit));
/* Mimo power save, A-MSDU size, */
rt_ht_cap->AmsduEnable = (unsigned short)pAd->CommonCfg.BACapability.field.AmsduEnable;
rt_ht_cap->AmsduSize = (u8)pAd->CommonCfg.BACapability.field.AmsduSize;
rt_ht_cap->MimoPs = (u8)pAd->CommonCfg.BACapability.field.MMPSmode;
rt_ht_cap->MpduDensity = (u8)pAd->CommonCfg.BACapability.field.MpduDensity;
ht_cap->HtCapInfo.AMsduSize = (unsigned short)pAd->CommonCfg.BACapability.field.AmsduSize;
ht_cap->HtCapInfo.MimoPs = (unsigned short)pAd->CommonCfg.BACapability.field.MMPSmode;
if (pAd->CommonCfg.ht_ldpc && (pAd->chipCap.phy_caps & fPHY_CAP_LDPC))
ht_cap->HtCapInfo.ht_rx_ldpc = 1;
else
ht_cap->HtCapInfo.ht_rx_ldpc = 0;
ht_cap->HtCapParm.MpduDensity = (u8)pAd->CommonCfg.BACapability.field.MpduDensity;
DBGPRINT(RT_DEBUG_TRACE, ("RTMPSetHT : AMsduSize = %d, MimoPs = %d, MpduDensity = %d, MaxRAmpduFactor = %d\n",
rt_ht_cap->AmsduSize,
rt_ht_cap->MimoPs,
rt_ht_cap->MpduDensity,
rt_ht_cap->MaxRAmpduFactor));
if(pHTPhyMode->HtMode == HTMODE_GF)
{
ht_cap->HtCapInfo.GF = 1;
rt_ht_cap->GF = 1;
}
else
rt_ht_cap->GF = 0;
/* Decide Rx MCSSet*/
switch (RxStream)
{
case 3:
ht_cap->MCSSet[2] = 0xff;
case 2:
ht_cap->MCSSet[1] = 0xff;
case 1:
default:
ht_cap->MCSSet[0] = 0xff;
break;
}
if (pAd->CommonCfg.bForty_Mhz_Intolerant && (pHTPhyMode->BW == BW_40))
{
pHTPhyMode->BW = BW_20;
ht_cap->HtCapInfo.Forty_Mhz_Intolerant = 1;
}
// TODO: shiang-6590, how about the "bw" when channel 14 for JP region???
//CFG_TODO
bw = BW_20;
if(pHTPhyMode->BW == BW_40)
{
ht_cap->MCSSet[4] = 0x1; /* MCS 32*/
ht_cap->HtCapInfo.ChannelWidth = 1;
if (pAd->CommonCfg.Channel <= 14)
ht_cap->HtCapInfo.CCKmodein40 = 1;
rt_ht_cap->ChannelWidth = 1;
pAd->CommonCfg.AddHTInfo.AddHtInfo.RecomWidth = 1;
pAd->CommonCfg.AddHTInfo.AddHtInfo.ExtChanOffset = (pHTPhyMode->ExtOffset == EXTCHA_BELOW)? (EXTCHA_BELOW): EXTCHA_ABOVE;
/* Set Regsiter for extension channel position.*/
mt7612u_mac_set_ctrlch(pAd, pHTPhyMode->ExtOffset);
/* Turn on BBP 40MHz mode now only as AP . */
/* Sta can turn on BBP 40MHz after connection with 40MHz AP. Sta only broadcast 40MHz capability before connection.*/
if ((pAd->OpMode == OPMODE_AP) || INFRA_ON(pAd) || ADHOC_ON(pAd)
)
{
mt7612u_bbp_set_ctrlch(pAd, pHTPhyMode->ExtOffset);
bw = BW_40;
}
}
else
{
ht_cap->HtCapInfo.ChannelWidth = 0;
rt_ht_cap->ChannelWidth = 0;
pAd->CommonCfg.AddHTInfo.AddHtInfo.RecomWidth = 0;
pAd->CommonCfg.AddHTInfo.AddHtInfo.ExtChanOffset = EXTCHA_NONE;
pAd->CommonCfg.CentralChannel = pAd->CommonCfg.Channel;
/* Turn on BBP 20MHz mode by request here.*/
bw = BW_20;
}
if (pHTPhyMode->BW == BW_40 &&
pAd->CommonCfg.vht_bw == VHT_BW_80 &&
pAd->CommonCfg.vht_cent_ch)
bw = BW_80;
mt7612u_bbp_set_bw(pAd, bw);
if(pHTPhyMode->STBC == STBC_USE)
{
if (pAd->Antenna.field.TxPath >= 2)
{
ht_cap->HtCapInfo.TxSTBC = 1;
rt_ht_cap->TxSTBC = 1;
}
else
{
ht_cap->HtCapInfo.TxSTBC = 0;
rt_ht_cap->TxSTBC = 0;
}
/*
RxSTBC
0: not support,
1: support for 1SS
2: support for 1SS, 2SS
3: support for 1SS, 2SS, 3SS
*/
if (pAd->Antenna.field.RxPath >= 1)
{
ht_cap->HtCapInfo.RxSTBC = 1;
rt_ht_cap->RxSTBC = 1;
}
else
{
ht_cap->HtCapInfo.RxSTBC = 0;
rt_ht_cap->RxSTBC = 0;
}
}
else
{
rt_ht_cap->TxSTBC = 0;
rt_ht_cap->RxSTBC = 0;
}
if(pHTPhyMode->SHORTGI == GI_400)
{
ht_cap->HtCapInfo.ShortGIfor20 = 1;
ht_cap->HtCapInfo.ShortGIfor40 = 1;
rt_ht_cap->ShortGIfor20 = 1;
rt_ht_cap->ShortGIfor40 = 1;
}
else
{
ht_cap->HtCapInfo.ShortGIfor20 = 0;
ht_cap->HtCapInfo.ShortGIfor40 = 0;
rt_ht_cap->ShortGIfor20 = 0;
rt_ht_cap->ShortGIfor40 = 0;
}
/* We support link adaptation for unsolicit MCS feedback, set to 2.*/
pAd->CommonCfg.AddHTInfo.ControlChan = pAd->CommonCfg.Channel;
/* 1, the extension channel above the control channel. */
/* EDCA parameters used for AP's own transmission*/
if (pAd->CommonCfg.APEdcaParm.bValid == false)
set_default_ap_edca_param(pAd);
AsicSetEdcaParm(pAd, &pAd->CommonCfg.APEdcaParm);
if (pAd->chipCap.FlgHwTxBfCap)
{
/* Set ETxBF */
setETxBFCap(pAd, &ht_cap->TxBFCap);
/* Check ITxBF */
pAd->CommonCfg.RegTransmitSetting.field.ITxBfEn &= rtmp_chk_itxbf_calibration(pAd);
/* Apply to ASIC */
rtmp_asic_set_bf(pAd);
}
#ifdef CONFIG_AP_SUPPORT
IF_DEV_CONFIG_OPMODE_ON_AP(pAd)
{
for (apidx = 0; apidx < pAd->ApCfg.BssidNum; apidx++)
RTMPSetIndividualHT(pAd, apidx);
}
#endif /* CONFIG_AP_SUPPORT */
#ifdef CONFIG_STA_SUPPORT
IF_DEV_CONFIG_OPMODE_ON_STA(pAd)
{
RTMPSetIndividualHT(pAd, 0);
}
#endif /* CONFIG_STA_SUPPORT */
}
