static VOID mt7628_bbp_adjust(RTMP_ADAPTER *pAd)
{
static char *ext_str[]={"extNone", "extAbove", "", "extBelow"};
UCHAR rf_bw, ext_ch;
#ifdef DOT11_N_SUPPORT
if (get_ht_cent_ch(pAd, &rf_bw, &ext_ch) == FALSE)
#endif /* DOT11_N_SUPPORT */
{
rf_bw = BW_20;
ext_ch = EXTCHA_NONE;
pAd->CommonCfg.CentralChannel = pAd->CommonCfg.Channel;
}
bbp_set_bw(pAd, rf_bw);
#ifdef DOT11_N_SUPPORT
MTWF_LOG(DBG_CAT_ALL, DBG_SUBCAT_ALL, DBG_LVL_TRACE, ("%s() : %s, ChannelWidth=%d, Channel=%d, ExtChanOffset=%d(%d) \n",
__FUNCTION__, ext_str[ext_ch],
pAd->CommonCfg.HtCapability.HtCapInfo.ChannelWidth,
pAd->CommonCfg.Channel,
pAd->CommonCfg.RegTransmitSetting.field.EXTCHA,
pAd->CommonCfg.AddHTInfo.AddHtInfo.ExtChanOffset));
#endif /* DOT11_N_SUPPORT */
}
VOID CFG80211DRV_DisableApInterface(PRTMP_ADAPTER pAd)
{
/*CFG_TODO: IT Should be set fRTMP_ADAPTER_HALT_IN_PROGRESS */
MULTISSID_STRUCT *pMbss = &pAd->ApCfg.MBSSID[MAIN_MBSSID];
struct wifi_dev *wdev = &pMbss->wdev;
pAd->ApCfg.MBSSID[MAIN_MBSSID].bBcnSntReq = FALSE;
wdev->Hostapd = Hostapd_Diable;
/* For AP - STA switch */
if (pAd->CommonCfg.BBPCurrentBW != BW_40)
{
CFG80211DBG(RT_DEBUG_TRACE, ("80211> %s, switch to BW_20\n", __FUNCTION__));
bbp_set_bw(pAd, BW_20);
}
/* Disable pre-TBTT interrupt */
AsicSetPreTbtt(pAd, FALSE);
if (!INFRA_ON(pAd))
{
/* Disable piggyback */
RTMPSetPiggyBack(pAd, FALSE);
AsicUpdateProtect(pAd, 0, (ALLN_SETPROTECT|CCKSETPROTECT|OFDMSETPROTECT), TRUE, FALSE);
}
if (!RTMP_TEST_FLAG(pAd, fRTMP_ADAPTER_NIC_NOT_EXIST))
{
AsicDisableSync(pAd);
}
OPSTATUS_CLEAR_FLAG(pAd, fOP_AP_STATUS_MEDIA_STATE_CONNECTED);
RTMP_IndicateMediaState(pAd, NdisMediaStateDisconnected);
}
INT dev_adjust_radio(RTMP_ADAPTER *pAd)
{
struct hw_setting new_cfg, *hw_cfg = &pAd->hw_cfg;
NdisZeroMemory(&new_cfg, sizeof(struct hw_setting));
/* For all wdev, find the maximum inter-set */
if (hw_cfg->bbp_bw != new_cfg.bbp_bw)
{
bbp_set_bw(pAd, new_cfg.bbp_bw);
hw_cfg->bbp_bw = new_cfg.bbp_bw;
}
if (hw_cfg->cent_ch != new_cfg.cent_ch)
{
UINT8 ext_ch = EXTCHA_NONE;
bbp_set_ctrlch(pAd, ext_ch);
AsicSetCtrlCh(pAd, ext_ch);
}
return TRUE;
}
static VOID ChipBBPAdjust(RTMP_ADAPTER *pAd)
{
UCHAR bbp_val;
UINT8 rf_bw, ext_ch;
#ifdef DOT11_N_SUPPORT
if (get_ht_cent_ch(pAd, &rf_bw, &ext_ch) == FALSE)
#endif /* DOT11_N_SUPPORT */
{
rf_bw = BW_20;
ext_ch = EXTCHA_NONE;
pAd->CommonCfg.CentralChannel = pAd->CommonCfg.Channel;
}
bbp_set_bw(pAd, rf_bw);
/* TX/RX : control channel setting */
AsicSetCtrlCh(pAd, ext_ch);
bbp_set_ctrlch(pAd, ext_ch);
/* request by Gary 20070208 for middle and long range G Band*/
#ifdef DOT11_N_SUPPORT
if (rf_bw == BW_40)
bbp_val = (pAd->CommonCfg.Channel > 14) ? 0x48 : 0x38;
else
#endif /* DOT11_N_SUPPORT */
bbp_val = (pAd->CommonCfg.Channel > 14) ? 0x40 : 0x38;
bbp_set_agc(pAd, bbp_val, RX_CHAIN_ALL);
if (pAd->MACVersion == 0x28600100)
{
#ifdef RT28xx
RT28xx_ch_tunning(pAd, BW_40);
#endif /* RT28xx */
}
else
{
RTMP_BBP_IO_WRITE8_BY_REG_ID(pAd, BBP_R69, 0x12);
RTMP_BBP_IO_WRITE8_BY_REG_ID(pAd, BBP_R70, 0x0A);
RTMP_BBP_IO_WRITE8_BY_REG_ID(pAd, BBP_R73, 0x10);
}
MTWF_LOG(DBG_CAT_ALL, DBG_SUBCAT_ALL, DBG_LVL_TRACE, ("%s(): BW_%s, ChannelWidth=%d, Channel=%d, ExtChanOffset=%d(%d) \n",
__FUNCTION__, (rf_bw == BW_40 ? "40" : "20"),
pAd->CommonCfg.HtCapability.HtCapInfo.ChannelWidth,
pAd->CommonCfg.Channel,
pAd->CommonCfg.RegTransmitSetting.field.EXTCHA,
pAd->CommonCfg.AddHTInfo.AddHtInfo.ExtChanOffset));
/* request by Gary 20070208 for middle and long range A Band*/
if (pAd->CommonCfg.Channel > 14)
bbp_val = 0x1D;
else
bbp_val = 0x2D;
RTMP_BBP_IO_WRITE8_BY_REG_ID(pAd, BBP_R62, bbp_val);
RTMP_BBP_IO_WRITE8_BY_REG_ID(pAd, BBP_R63, bbp_val);
RTMP_BBP_IO_WRITE8_BY_REG_ID(pAd, BBP_R64, bbp_val);
/*RTMP_BBP_IO_WRITE8_BY_REG_ID(pAd, BBP_R86, bbp_val);*/
}
static VOID ApCliMlmeScanReqAction(
IN RTMP_ADAPTER *pAd,
IN MLME_QUEUE_ELEM *Elem)
{
BOOLEAN Cancelled;
UCHAR Ssid[MAX_LEN_OF_SSID], SsidLen, ScanType, BssType;
/* Suspend MSDU transmission here */
RTMPSuspendMsduTransmission(pAd);
/* first check the parameter sanity */
if (MlmeScanReqSanity(pAd, Elem->Msg, Elem->MsgLen, &BssType, (PCHAR)Ssid, &SsidLen, &ScanType))
{
DBGPRINT(RT_DEBUG_TRACE, ("%s(): mlme scan req action!\n", __FUNCTION__));
NdisGetSystemUpTime(&pAd->ApCfg.LastScanTime);
RTMPCancelTimer(&pAd->MlmeAux.APScanTimer, &Cancelled);
/* record desired BSS parameters */
pAd->MlmeAux.BssType = BssType;
pAd->MlmeAux.ScanType = ScanType;
pAd->MlmeAux.SsidLen = SsidLen;
NdisMoveMemory(pAd->MlmeAux.Ssid, Ssid, SsidLen);
/* start from the first channel */
#ifdef AP_PARTIAL_SCAN_SUPPORT
pAd->MlmeAux.Channel = RTMPFindScanChannel(pAd, 0);
#else
pAd->MlmeAux.Channel = FirstChannel(pAd);
#endif /* AP_PARTIAL_SCAN_SUPPORT */
/* Let BBP register at 20MHz to do scan */
bbp_set_bw(pAd, BW_20);
DBGPRINT(RT_DEBUG_TRACE, ("SYNC - BBP R4 to 20MHz.l\n"));
#ifdef CONFIG_AP_SUPPORT
IF_DEV_CONFIG_OPMODE_ON_AP(pAd)
{
if (pAd->ApCfg.bAutoChannelAtBootup == TRUE)/* iwpriv set auto channel selection */
{
APAutoChannelInit(pAd);
pAd->ApCfg.AutoChannel_Channel = pAd->ChannelList[0].Channel;
}
#ifdef SMART_MESH
Set_Scan_False_CCA(pAd, 0, CCA_RESET);
#endif /* SMART_MESH */
}
#endif /* CONFIG_AP_SUPPORT */
ScanNextChannel(pAd, OPMODE_AP, INT_APCLI);
}
/*
channel : 0 ==> don't care
1 ==> park at channel 0 (means infra channel)
2 ==> park at channel 1 (means GO/GC channel)
*/
VOID Stop_MCC(RTMP_ADAPTER *pAd,INT channel)
{
#if defined(RT_CFG80211_SUPPORT) && defined(RT_CFG80211_P2P_CONCURRENT_DEVICE)
PMULTISSID_STRUCT pMbss = &pAd->ApCfg.MBSSID[CFG_GO_BSSID_IDX];
PAPCLI_STRUCT pApCliEntry = pApCliEntry = &pAd->ApCfg.ApCliTab[MAIN_MBSSID];
struct wifi_dev *p2p_wdev = &pMbss->wdev;
pAd->Mlme.bStartMcc = FALSE;
pAd->chipCap.tssi_enable = TRUE; //let host don't do tssi
printk("Stop_MCC swtich to channel %d \n",channel);
andes_mcc_stop(pAd, channel, 0, 0, 0); //park at p2p GO| CLI Cannel
if (channel == 1 )
{
AsicSwitchChannel(pAd, pAd->StaCfg.wdev.CentralChannel, FALSE);
bbp_set_bw(pAd, pAd->StaCfg.wdev.bw);
}
else if(channel == 2 )
{
if (RTMP_CFG80211_VIF_P2P_GO_ON(pAd))
p2p_wdev = &pMbss->wdev;
else if (RTMP_CFG80211_VIF_P2P_CLI_ON(pAd))
p2p_wdev = &(pApCliEntry->wdev);
AsicSwitchChannel(pAd, p2p_wdev->CentralChannel, FALSE);
bbp_set_bw(pAd, p2p_wdev->bw);
}
else
{
AsicSwitchChannel(pAd, pAd->StaCfg.wdev.CentralChannel, FALSE);
bbp_set_bw(pAd, pAd->StaCfg.wdev.bw);
}
#endif /* defined(RT_CFG80211_SUPPORT) && defined(CONFIG_AP_SUPPORT) */
}
VOID CFG80211DRV_DisableApInterface(PRTMP_ADAPTER pAd)
{
#ifdef RT_CFG80211_P2P_SUPPORT
UINT apidx = CFG_GO_BSSID_IDX;
#else
UINT apidx = MAIN_MBSSID;
#endif /* RT_CFG80211_P2P_SUPPORT */
// INT startWcid = 1;
/*CFG_TODO: IT Should be set fRTMP_ADAPTER_HALT_IN_PROGRESS */
pAd->ApCfg.MBSSID[apidx].bcn_buf.bBcnSntReq = FALSE;
/* For AP - STA switch */
if (pAd->CommonCfg.BBPCurrentBW != BW_40)
{
CFG80211DBG(DBG_LVL_TRACE, ("80211> %s, switch to BW_20\n", __FUNCTION__));
bbp_set_bw(pAd, BW_20);
}
/* Disable pre-TBTT interrupt */
AsicSetPreTbtt(pAd, FALSE);
if (!INFRA_ON(pAd))
{
/* Disable piggyback */
AsicSetPiggyBack(pAd, FALSE);
AsicUpdateProtect(pAd, 0, (ALLN_SETPROTECT|CCKSETPROTECT|OFDMSETPROTECT), TRUE, FALSE);
}
if (!RTMP_TEST_FLAG(pAd, fRTMP_ADAPTER_NIC_NOT_EXIST))
{
AsicDisableSync(pAd);
}
MacTableReset(pAd);
OPSTATUS_CLEAR_FLAG(pAd, fOP_AP_STATUS_MEDIA_STATE_CONNECTED);
RTMP_IndicateMediaState(pAd, NdisMediaStateDisconnected);
#ifdef CONFIG_STA_SUPPORT
#ifdef P2P_SINGLE_DEVICE
/* re-assoc to STA's wdev */
RTMP_OS_NETDEV_SET_WDEV(pAd->net_dev, &pAd->StaCfg.wdev);
#endif /* P2P_SINGLE_DEVICE */
#endif /*CONFIG_STA_SUPPORT*/
}
VOID CFG80211_SwitchTxChannel(RTMP_ADAPTER *pAd, ULONG Data)
{
//UCHAR lock_channel = CFG80211_getCenCh(pAd, Data);
BSS_STRUCT *pMbss = &pAd->ApCfg.MBSSID[MAIN_MBSSID];
struct wifi_dev *wdev = &pMbss->wdev;
UCHAR lock_channel = Data;
MTWF_LOG(DBG_CAT_ALL, DBG_SUBCAT_ALL, DBG_LVL_INFO,("%s\n", __FUNCTION__));
if(wdev->Hostapd == Hostapd_CFG && pAd->CommonCfg.BBPCurrentBW != BW_20)
return;
#ifdef RT_CFG80211_P2P_CONCURRENT_DEVICE
pMbss = &pAd->ApCfg.MBSSID[CFG_GO_BSSID_IDX];
wdev = &pMbss->wdev;
if(pAd->Mlme.bStartScc == TRUE)
{
MTWF_LOG(DBG_CAT_ALL, DBG_SUBCAT_ALL, DBG_LVL_TRACE, ("SCC Enabled, Do not switch channel for Tx %d\n",lock_channel));
return;
}
#endif /*RT_CFG80211_P2P_CONCURRENT_DEVICE */
if ( pAd->LatchRfRegs.Channel != lock_channel
#ifdef CONFIG_STA_SUPPORT
|| (INFRA_ON(pAd) && (((pAd->LatchRfRegs.Channel != pAd->StaCfg.wdev.CentralChannel) && (pAd->StaCfg.wdev.CentralChannel != 0))))
#endif /* CONFIG_STA_SUPPORT */
)
{
bbp_set_bw(pAd, BW_20);
AsicSwitchChannel(pAd, lock_channel, FALSE);
AsicLockChannel(pAd, lock_channel);
MTWF_LOG(DBG_CAT_ALL, DBG_SUBCAT_ALL, DBG_LVL_INFO, ("Off-Channel Send Packet: From(%d)-To(%d)\n",
pAd->LatchRfRegs.Channel, lock_channel));
}
else
MTWF_LOG(DBG_CAT_ALL, DBG_SUBCAT_ALL, DBG_LVL_INFO, ("Off-Channel Channel Equal: %d\n", pAd->LatchRfRegs.Channel));
}
VOID EnableAPMIMOPSv1(
IN RTMP_ADAPTER *pAd,
IN BOOLEAN ReduceCorePower)
{
UCHAR BBPR3 = 0,BBPR1 = 0;
ULONG TxPinCfg = 0x00050F0A;/*Gary 2007/08/09 0x050A0A*/
UCHAR BBPR4=0;
UCHAR CentralChannel;
if(pAd->CommonCfg.Channel>14)
TxPinCfg=0x00050F05;
TxPinCfg &= 0xFFFFFFF3;
TxPinCfg &= 0xFFFFF3FF;
pAd->ApCfg.bGreenAPActive=TRUE;
CentralChannel = pAd->CommonCfg.CentralChannel;
MTWF_LOG(DBG_CAT_ALL, DBG_SUBCAT_ALL, DBG_LVL_INFO, ("Run with BW_20\n"));
pAd->CommonCfg.CentralChannel = pAd->CommonCfg.Channel;
CentralChannel = pAd->CommonCfg.Channel;
/* Set BBP registers to BW20 */
bbp_set_bw(pAd, BW_20);
/* RF Bandwidth related registers would be set in AsicSwitchChannel() */
if (pAd->Antenna.field.RxPath>1||pAd->Antenna.field.TxPath>1)
{
/*Tx/Rx Stream*/
bbp_set_txdac(pAd, 0);
bbp_set_rxpath(pAd, 1);
RTMP_IO_WRITE32(pAd, TX_PIN_CFG, TxPinCfg);
}
AsicSwitchChannel(pAd, CentralChannel, FALSE);
MTWF_LOG(DBG_CAT_ALL, DBG_SUBCAT_ALL, DBG_LVL_INFO, ("EnableAPMIMOPS, 305x/28xx changes the # of antenna to 1\n"));
}
INT dev_adjust_radio(RTMP_ADAPTER *pAd)
{
struct hw_setting new_cfg, *hw_cfg = &pAd->hw_cfg;
NdisZeroMemory(&new_cfg, sizeof(struct hw_setting));
/* For all wdev, find the maximum inter-set */
if (hw_cfg->bbp_bw != new_cfg.bbp_bw)
{
bbp_set_bw(pAd, new_cfg.bbp_bw);
hw_cfg->bbp_bw = new_cfg.bbp_bw;
}
if (hw_cfg->cent_ch != new_cfg.cent_ch)
{
UINT8 ext_ch = EXTCHA_NONE;
bbp_set_ctrlch(pAd, ext_ch);
#if defined(RTMP_MAC) || defined(RLT_MAC)
if (pAd->chipCap.hif_type == HIF_RTMP || pAd->chipCap.hif_type == HIF_RLT)
rtmp_mac_set_ctrlch(pAd, ext_ch);
#endif /* defined(RTMP_MAC) || defined(RLT_MAC) */
#ifdef MT_MAC
if (pAd->chipCap.hif_type == HIF_MT)
mt_mac_set_ctrlch(pAd, ext_ch);
#endif /* MT_MAC */
}
return TRUE;
}
static INT scan_ch_restore(RTMP_ADAPTER *pAd, UCHAR OpMode)
{
INT bw, ch;
if (pAd->CommonCfg.BBPCurrentBW != pAd->hw_cfg.bbp_bw)
bbp_set_bw(pAd, pAd->hw_cfg.bbp_bw);
#ifdef DOT11_VHT_AC
if (pAd->hw_cfg.bbp_bw == BW_80)
ch = pAd->CommonCfg.vht_cent_ch;
else
#endif /* DOT11_VHT_AC */
if (pAd->hw_cfg.bbp_bw == BW_40)
ch = pAd->CommonCfg.CentralChannel;
else
ch = pAd->CommonCfg.Channel;
ASSERT((ch != 0));
AsicSwitchChannel(pAd, ch, FALSE);
AsicLockChannel(pAd, ch);
switch(pAd->CommonCfg.BBPCurrentBW)
{
case BW_80:
bw = 80;
break;
case BW_40:
bw = 40;
break;
case BW_10:
bw = 10;
break;
case BW_20:
default:
bw =20;
break;
}
DBGPRINT(RT_DEBUG_TRACE, ("SYNC - End of SCAN, restore to %dMHz channel %d, Total BSS[%02d]\n",
bw, ch, pAd->ScanTab.BssNr));
#ifdef CONFIG_AP_SUPPORT
if (OpMode == OPMODE_AP)
{
#ifdef APCLI_SUPPORT
#ifdef APCLI_AUTO_CONNECT_SUPPORT
if (pAd->ApCfg.ApCliAutoConnectRunning == TRUE)
{
if (!ApCliAutoConnectExec(pAd))
{
DBGPRINT(RT_DEBUG_ERROR, ("Error in %s\n", __FUNCTION__));
}
}
#endif /* APCLI_AUTO_CONNECT_SUPPORT */
#endif /* APCLI_SUPPORT */
pAd->Mlme.ApSyncMachine.CurrState = AP_SYNC_IDLE;
RTMPResumeMsduTransmission(pAd);
/* iwpriv set auto channel selection*/
/* scanned all channels*/
if (pAd->ApCfg.bAutoChannelAtBootup==TRUE)
{
pAd->CommonCfg.Channel = SelectBestChannel(pAd, pAd->ApCfg.AutoChannelAlg);
pAd->ApCfg.bAutoChannelAtBootup = FALSE;
#ifdef DOT11_N_SUPPORT
N_ChannelCheck(pAd);
#endif /* DOT11_N_SUPPORT */
APStop(pAd);
APStartUp(pAd);
}
if (!((pAd->CommonCfg.Channel > 14) && (pAd->CommonCfg.bIEEE80211H == TRUE) && (pAd->Dot11_H.RDMode != RD_NORMAL_MODE)))
AsicEnableBssSync(pAd, pAd->CommonCfg.BeaconPeriod);
}
#endif /* CONFIG_AP_SUPPORT */
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 */
}
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;
}
VOID CFG80211_SwitchTxChannel(RTMP_ADAPTER *pAd, ULONG Data)
{
//UCHAR lock_channel = CFG80211_getCenCh(pAd, Data);
UCHAR lock_channel = Data;
#ifdef CONFIG_MULTI_CHANNEL
#ifdef RT_CFG80211_P2P_SUPPORT
UINT apidx = CFG_GO_BSSID_IDX;
#else
UINT apidx = MAIN_MBSSID;
#endif /*RT_CFG80211_P2P_SUPPORT*/
PMULTISSID_STRUCT pMbss = &pAd->ApCfg.MBSSID[apidx];
struct wifi_dev *wdev = &pMbss->wdev;
if ((pAd->MCC_InfraConnect_Protect == TRUE) || (pAd->Mlme.bStartMcc == TRUE) || (pAd->MCC_GOConnect_Protect == TRUE))
{
// DBGPRINT(RT_DEBUG_TRACE, ("Connecting Or MCC Enabled, Do not switch channel for Tx lock_channel %d \n",lock_channel));
return;
}
if(pAd->Mlme.bStartScc == TRUE)
{
// DBGPRINT(RT_DEBUG_TRACE, ("SCC Enabled, Do not switch channel for Tx %d\n",lock_channel));
return;
}
#if 1
if (RTMP_CFG80211_VIF_P2P_GO_ON(pAd) && (wdev->channel == lock_channel) && (wdev->bw==1))
{
DBGPRINT(RT_DEBUG_TRACE, ("40 BW Enabled || GO enable , wait for CLI connect, Do not switch channel for Tx\n"));
DBGPRINT(RT_DEBUG_TRACE, ("GO wdev->channel %d lock_channel %d \n",wdev->channel,lock_channel));
return;
}
#endif
#endif /* CONFIG_MULTI_CHANNEL */
#ifdef CONFIG_MULTI_CHANNEL
if (INFRA_ON(pAd) &&
(((pAd->LatchRfRegs.Channel != pAd->StaCfg.wdev.CentralChannel) && (pAd->StaCfg.wdev.CentralChannel != 0)))
|| (pAd->LatchRfRegs.Channel != lock_channel)
)
#else /* CONFIG_MULTI_CHANNEL */
if (RTMP_GetPrimaryCh(pAd, pAd->LatchRfRegs.Channel) != lock_channel)
#endif /* CONFIG_MULTI_CHANNEL */
{
if (INFRA_ON(pAd))
{
DBGPRINT(RT_DEBUG_TRACE, ("CFG80211_NULL: STA PWR_SAVE ROC_START\n"));
RTMPSendNullFrame(pAd, pAd->CommonCfg.TxRate,
(OPSTATUS_TEST_FLAG(pAd, fOP_STATUS_WMM_INUSED) ? TRUE:FALSE),
PWR_SAVE);
}
DBGPRINT(RT_DEBUG_TRACE, ("Off-Channel Send Packet: From(%d)-To(%d)\n",
pAd->LatchRfRegs.Channel, lock_channel));
if(pAd->CommonCfg.BBPCurrentBW != BW_20)
bbp_set_bw(pAd, BW_20);
AsicSwitchChannel(pAd, lock_channel, FALSE);
AsicLockChannel(pAd, lock_channel);
}
else
DBGPRINT(RT_DEBUG_INFO, ("Off-Channel Channel Equal: %d\n", pAd->LatchRfRegs.Channel));
}
VOID RTMP_CFG80211_VirtualIF_Remove(
IN VOID *pAdSrc,
IN PNET_DEV dev_p,
IN UINT32 DevType)
{
PRTMP_ADAPTER pAd = (PRTMP_ADAPTER)pAdSrc;
BOOLEAN isGoOn = FALSE;
struct wifi_dev *wdev;
#ifdef RT_CFG80211_P2P_SUPPORT
UINT apidx = CFG_GO_BSSID_IDX;
#else
UINT apidx = MAIN_MBSSID;
#endif /*RT_CFG80211_P2P_SUPPORT*/
if (dev_p)
{
pAd->cfg80211_ctrl.Cfg80211VifDevSet.isGoingOn = FALSE;
RTMP_CFG80211_RemoveVifEntry(pAd, dev_p);
RTMP_OS_NETDEV_STOP_QUEUE(dev_p);
#ifdef RT_CFG80211_P2P_CONCURRENT_DEVICE
isGoOn = RTMP_CFG80211_VIF_P2P_GO_ON(pAd);
if (isGoOn)
{
wdev = &pAd->ApCfg.MBSSID[apidx].wdev;
BSS_STRUCT *pMbss = &pAd->ApCfg.MBSSID[CFG_GO_BSSID_IDX];
struct wifi_dev *pwdev = &pMbss->wdev;
if (pAd->Mlme.bStartScc == TRUE)
{
pAd->Mlme.bStartScc = FALSE;
AsicSwitchChannel(pAd, pAd->StaCfg.wdev.CentralChannel, FALSE);
AsicLockChannel(pAd, pAd->StaCfg.wdev.CentralChannel);
bbp_set_bw(pAd, pAd->StaCfg.wdev.bw);
}
pwdev->channel = 0;
pwdev->CentralChannel= 0;
pwdev->bw = 0;
pwdev->extcha = EXTCHA_NONE;
/*after p2p cli connect , neet to change to default configure*/
pAd->CommonCfg.RegTransmitSetting.field.EXTCHA = EXTCHA_BELOW;
pAd->CommonCfg.RegTransmitSetting.field.BW = BW_40;
pAd->CommonCfg.HT_Disable = 0;
SetCommonHT(pAd);
wdev_bcn_buf_deinit(pAd, &pAd->ApCfg.MBSSID[apidx].bcn_buf);
RtmpOSNetDevDetach(dev_p);
rtmp_wdev_idx_unreg(pAd, wdev);
wdev->if_dev = NULL;
}
else
#endif /* RT_CFG80211_P2P_CONCURRENT_DEVICE */
if (pAd->flg_apcli_init)
{
wdev = &pAd->ApCfg.ApCliTab[MAIN_MBSSID].wdev;
//actually not mcc still need to check this!
if (pAd->Mlme.bStartScc == TRUE)
{
printk("GC remove & switch to Infra BW = %d pAd->StaCfg.wdev.CentralChannel %d \n",pAd->StaCfg.wdev.bw,pAd->StaCfg.wdev.CentralChannel);
pAd->Mlme.bStartScc = FALSE;
AsicSwitchChannel(pAd, pAd->StaCfg.wdev.CentralChannel, FALSE);
AsicLockChannel(pAd, pAd->StaCfg.wdev.CentralChannel);
bbp_set_bw(pAd, pAd->StaCfg.wdev.bw);
}
wdev->CentralChannel = 0;
wdev->channel= 0;
wdev->bw = HT_BW_20;
wdev->extcha = EXTCHA_NONE;
OPSTATUS_CLEAR_FLAG(pAd, fOP_AP_STATUS_MEDIA_STATE_CONNECTED);
cfg80211_disconnected(dev_p, 0, NULL, 0, GFP_KERNEL);
NdisZeroMemory(pAd->ApCfg.ApCliTab[MAIN_MBSSID].CfgApCliBssid, MAC_ADDR_LEN);
RtmpOSNetDevDetach(dev_p);
rtmp_wdev_idx_unreg(pAd, wdev);
pAd->flg_apcli_init = FALSE;
wdev->if_dev = NULL;
}
else /* Never Opened When New Netdevice on */
{
RtmpOSNetDevDetach(dev_p);
}
if (dev_p->ieee80211_ptr)
{
kfree(dev_p->ieee80211_ptr);
dev_p->ieee80211_ptr = NULL;
}
}
}
VOID FT_OTD_PeerRspAtSeq2Action(
IN PRTMP_ADAPTER pAd,
IN MLME_QUEUE_ELEM *Elem)
{
UCHAR TargetAddr[MAC_ADDR_LEN];
USHORT Status;
BOOLEAN TimerCancelled;
ULONG BssIdx = 0;
FT_FTIE FtIe;
FT_MDIE MdIe;
PFRAME_802_11 pFrame = (PFRAME_802_11) Elem->Msg;
MLME_ASSOC_REQ_STRUCT AssocReq;
UCHAR BBPValue = 0;
DBGPRINT(RT_DEBUG_TRACE,
("FT_OTD_ACTION - PeerFtRspAtSeq2Action MlmeAux.Bssid = %02x:%02x:%02x:%02x:%02x:%02x\n",
PRINT_MAC(pAd->MlmeAux.Bssid)));
if (PeerFtRspSanity
(pAd, Elem->Msg, Elem->MsgLen, TargetAddr, &FtIe, &MdIe, &Status)) {
if (MAC_ADDR_EQUAL(pAd->CommonCfg.Bssid, pFrame->Hdr.Addr2)) {
DBGPRINT(RT_DEBUG_TRACE,
("FT_OTD_ACTION - Receive FT_RSP seq#2 to me ( Status=%d)\n",
Status));
RTMPCancelTimer(&pAd->MlmeAux.FtOtdActTimer,
&TimerCancelled);
if (Status == MLME_SUCCESS) {
UINT8 ptk_len;
PMAC_TABLE_ENTRY pEntry = &pAd->MacTab.Content[MCAST_WCID];
NdisMoveMemory(pEntry->SNonce, FtIe.SNonce, 32);
/* Get ANonce from authentication-response */
NdisMoveMemory(pEntry->ANonce, FtIe.ANonce, 32);
hex_dump("anonce", pEntry->ANonce, 32);
hex_dump("snonce", pEntry->SNonce, 32);
FT_DerivePMKR1(pAd->StaCfg.Dot11RCommInfo.PMKR0, pAd->StaCfg.Dot11RCommInfo.PMKR0Name, TargetAddr, /*pAd->MlmeAux.Bssid, */
pAd->CurrentAddress,
pEntry->FT_PMK_R1,
pEntry->FT_PMK_R1_NAME);
if (pEntry->WepStatus == Ndis802_11TKIPEnable)
ptk_len = 32 + 32;
else
ptk_len = 32 + 16;
/* Derive FT PTK and PTK-NAME */
FT_DerivePTK(pEntry->FT_PMK_R1, pEntry->FT_PMK_R1_NAME, pEntry->ANonce, pEntry->SNonce, TargetAddr, /*pAd->MlmeAux.Bssid, */
pAd->CurrentAddress,
ptk_len,
pEntry->PTK, pEntry->PTK_NAME);
/*
How to know there is resource request session now ????????
*/
if ((pAd->StaCfg.Dot11RCommInfo.bSupportResource)
&& (pAd->MlmeAux.MdIeInfo.FtCapPlc.field.RsrReqCap)) {
/* Prepare to send FT Confirm packet. */
DBGPRINT(RT_DEBUG_TRACE,
("FT_OTD_ACTION - Receive FT_RSP seq#2 to me, Prepare to send FT Confirm. \n"));
pAd->Mlme.FtOtdActMachine.CurrState =
FT_OTD_WAIT_SEQ4;
} else {
BSS_ENTRY *pBss = NULL;
/*
Doesn't need to send FT Confirm packet.
*/
DBGPRINT(RT_DEBUG_TRACE,
("FT_OTD_ACTION - Receive FT_RSP seq#2 to me, Prepare to send Reassoc. \n"));
pAd->StaCfg.Dot11RCommInfo.FtRspSuccess = FT_OTD_RESPONSE;
pAd->Mlme.FtOtdActMachine.CurrState = FT_OTD_IDLE;
RTMPMoveMemory(pAd->MlmeAux.Bssid, TargetAddr, MAC_ADDR_LEN);
/*
find the desired BSS in the latest SCAN result table
search 2.4G band first
*/
BssIdx = BssTableSearch(&pAd->ScanTab, TargetAddr, 1);
/*
search 5G band, if AP does not exist in 2.4G band
*/
if (BssIdx == BSS_NOT_FOUND)
BssIdx = BssTableSearch(&pAd->ScanTab, TargetAddr, 36);
if (BssIdx == BSS_NOT_FOUND) {
DBGPRINT(RT_DEBUG_TRACE,
("FT_OTD_ACTION - BSSID not found. reply NDIS_STATUS_NOT_ACCEPTED\n"));
pAd->Mlme.CntlMachine.CurrState = CNTL_IDLE;
return;
}
pBss = &pAd->ScanTab.BssEntry[BssIdx];
pAd->MlmeAux.Channel = pBss->Channel;
pAd->MlmeAux.CentralChannel = pBss->CentralChannel;
RTMPZeroMemory(pAd->MlmeAux.ExtRate,
MAX_LEN_OF_SUPPORTED_RATES);
RTMPZeroMemory(pAd->MlmeAux.SupRate,
MAX_LEN_OF_SUPPORTED_RATES);
pAd->MlmeAux.ExtRateLen = pBss->ExtRateLen;
RTMPMoveMemory(pAd->MlmeAux.ExtRate,
pBss->ExtRate,
pBss->ExtRateLen);
pAd->MlmeAux.SupRateLen = pBss->SupRateLen;
RTMPMoveMemory(pAd->MlmeAux.SupRate,
pBss->SupRate,
pBss->SupRateLen);
RTMPZeroMemory(pAd->MlmeAux.Ssid,
MAX_LEN_OF_SSID);
pAd->MlmeAux.SsidLen = pBss->SsidLen;
RTMPMoveMemory(pAd->MlmeAux.Ssid,
pBss->Ssid,
pBss->SsidLen);
/*
StaActive.SupportedHtPhy.MCSSet stores Peer AP's 11n Rx capability
*/
if (pBss->HtCapabilityLen) {
RTMPMoveMemory(pAd->StaActive.SupportedPhyInfo.MCSSet,
pBss->HtCapability.MCSSet, 16);
} else {
NdisZeroMemory(pAd->StaActive.SupportedPhyInfo.MCSSet, 16);
}
bbp_set_bw(pAd, BW_20);
AsicSwitchChannel(pAd, pAd->MlmeAux.Channel, FALSE);
AsicLockChannel(pAd, pAd->MlmeAux.Channel);
RTMPUpdateMlmeRate(pAd);
AssocParmFill(pAd, &AssocReq,
pAd->MlmeAux.Bssid,
pAd->MlmeAux.CapabilityInfo,
ASSOC_TIMEOUT,
pAd->StaCfg.DefaultListenCount);
MlmeEnqueue(pAd, ASSOC_STATE_MACHINE,
MT2_MLME_REASSOC_REQ,
sizeof
(MLME_ASSOC_REQ_STRUCT),
&AssocReq, 0);
pAd->Mlme.CntlMachine.CurrState = CNTL_WAIT_REASSOC;
}
} else {
pAd->StaCfg.AuthFailReason = Status;
COPY_MAC_ADDR(pAd->StaCfg.AuthFailSta, pFrame->Hdr.Addr2);
pAd->Mlme.FtOtdActMachine.CurrState = FT_OTD_IDLE;
MlmeEnqueue(pAd, MLME_CNTL_STATE_MACHINE,
MT2_FT_OTD_CONF, 2, &Status, 0);
}
}
} else {
DBGPRINT(RT_DEBUG_TRACE,
("FT_OTD_ACTION - PeerFtRspSanity() sanity check fail\n"));
}
}
