/******************************************************************************
|
*
|
* Copyright(c) 2007 - 2011 Realtek Corporation. All rights reserved.
|
*
|
* This program is free software; you can redistribute it and/or modify it
|
* under the terms of version 2 of the GNU General Public License as
|
* published by the Free Software Foundation.
|
*
|
* This program is distributed in the hope that it will be useful, but WITHOUT
|
* ANY WARRANTY; without even the implied warranty of MERCHANTABILITY or
|
* FITNESS FOR A PARTICULAR PURPOSE. See the GNU General Public License for
|
* more details.
|
*
|
* You should have received a copy of the GNU General Public License along with
|
* this program; if not, write to the Free Software Foundation, Inc.,
|
* 51 Franklin Street, Fifth Floor, Boston, MA 02110, USA
|
*
|
*
|
******************************************************************************/
|
|
//============================================================
|
// include files
|
//============================================================
|
#include "mp_precomp.h"
|
#include "phydm_precomp.h"
|
|
#if (DM_ODM_SUPPORT_TYPE & ODM_WIN)
|
#if WPP_SOFTWARE_TRACE
|
#include "PhyDM_Adaptivity.tmh"
|
#endif
|
#endif
|
|
|
VOID
|
Phydm_CheckAdaptivity(
|
IN PVOID pDM_VOID
|
)
|
{
|
PDM_ODM_T pDM_Odm = (PDM_ODM_T)pDM_VOID;
|
PADAPTIVITY_STATISTICS Adaptivity = (PADAPTIVITY_STATISTICS)PhyDM_Get_Structure(pDM_Odm, PHYDM_ADAPTIVITY);
|
|
if (pDM_Odm->SupportAbility & ODM_BB_ADAPTIVITY) {
|
#if (DM_ODM_SUPPORT_TYPE == ODM_WIN)
|
if (pDM_Odm->APTotalNum > Adaptivity->APNumTH) {
|
pDM_Odm->Adaptivity_enable = FALSE;
|
pDM_Odm->adaptivity_flag = FALSE;
|
ODM_RT_TRACE(pDM_Odm, PHYDM_COMP_ADAPTIVITY, ODM_DBG_LOUD, ("AP total num > %d!!, disable adaptivity\n", Adaptivity->APNumTH));
|
} else
|
#endif
|
{
|
if (Adaptivity->DynamicLinkAdaptivity == TRUE) {
|
if (pDM_Odm->bLinked && Adaptivity->bCheck == FALSE) {
|
Phydm_NHMCounterStatistics(pDM_Odm);
|
Phydm_CheckEnvironment(pDM_Odm);
|
} else if (!pDM_Odm->bLinked)
|
Adaptivity->bCheck = FALSE;
|
} else {
|
pDM_Odm->Adaptivity_enable = TRUE;
|
|
if (pDM_Odm->SupportICType & (ODM_IC_11AC_GAIN_IDX_EDCCA | ODM_IC_11N_GAIN_IDX_EDCCA))
|
pDM_Odm->adaptivity_flag = FALSE;
|
else
|
pDM_Odm->adaptivity_flag = TRUE;
|
}
|
}
|
} else {
|
pDM_Odm->Adaptivity_enable = FALSE;
|
pDM_Odm->adaptivity_flag = FALSE;
|
}
|
|
|
|
}
|
|
#if (DM_ODM_SUPPORT_TYPE == ODM_WIN)
|
BOOLEAN
|
Phydm_CheckChannelPlan(
|
IN PVOID pDM_VOID
|
)
|
{
|
PDM_ODM_T pDM_Odm = (PDM_ODM_T)pDM_VOID;
|
PADAPTER pAdapter = pDM_Odm->Adapter;
|
HAL_DATA_TYPE *pHalData = GET_HAL_DATA(pAdapter);
|
PMGNT_INFO pMgntInfo = &(pAdapter->MgntInfo);
|
|
if (pMgntInfo->RegEnableAdaptivity == 2) {
|
if (pDM_Odm->Carrier_Sense_enable == FALSE) { /*check domain Code for Adaptivity or CarrierSense*/
|
if ((*pDM_Odm->pBandType == ODM_BAND_5G) &&
|
!(pDM_Odm->odm_Regulation5G == REGULATION_ETSI || pDM_Odm->odm_Regulation5G == REGULATION_WW)) {
|
ODM_RT_TRACE(pDM_Odm, PHYDM_COMP_ADAPTIVITY, ODM_DBG_LOUD, ("Adaptivity skip 5G domain code : %d\n", pDM_Odm->odm_Regulation5G));
|
pDM_Odm->Adaptivity_enable = FALSE;
|
pDM_Odm->adaptivity_flag = FALSE;
|
return TRUE;
|
} else if ((*pDM_Odm->pBandType == ODM_BAND_2_4G) &&
|
!(pDM_Odm->odm_Regulation2_4G == REGULATION_ETSI || pDM_Odm->odm_Regulation2_4G == REGULATION_WW)) {
|
ODM_RT_TRACE(pDM_Odm, PHYDM_COMP_ADAPTIVITY, ODM_DBG_LOUD, ("Adaptivity skip 2.4G domain code : %d\n", pDM_Odm->odm_Regulation2_4G));
|
pDM_Odm->Adaptivity_enable = FALSE;
|
pDM_Odm->adaptivity_flag = FALSE;
|
return TRUE;
|
|
} else if ((*pDM_Odm->pBandType != ODM_BAND_2_4G) && (*pDM_Odm->pBandType != ODM_BAND_5G)) {
|
ODM_RT_TRACE(pDM_Odm, PHYDM_COMP_ADAPTIVITY, ODM_DBG_LOUD, ("Adaptivity neither 2G nor 5G band, return\n"));
|
pDM_Odm->Adaptivity_enable = FALSE;
|
pDM_Odm->adaptivity_flag = FALSE;
|
return TRUE;
|
}
|
} else {
|
if ((*pDM_Odm->pBandType == ODM_BAND_5G) &&
|
!(pDM_Odm->odm_Regulation5G == REGULATION_MKK || pDM_Odm->odm_Regulation5G == REGULATION_WW)) {
|
ODM_RT_TRACE(pDM_Odm, PHYDM_COMP_ADAPTIVITY, ODM_DBG_LOUD, ("CarrierSense skip 5G domain code : %d\n", pDM_Odm->odm_Regulation5G));
|
pDM_Odm->Adaptivity_enable = FALSE;
|
pDM_Odm->adaptivity_flag = FALSE;
|
return TRUE;
|
}
|
|
else if ((*pDM_Odm->pBandType == ODM_BAND_2_4G) &&
|
!(pDM_Odm->odm_Regulation2_4G == REGULATION_MKK || pDM_Odm->odm_Regulation2_4G == REGULATION_WW)) {
|
ODM_RT_TRACE(pDM_Odm, PHYDM_COMP_ADAPTIVITY, ODM_DBG_LOUD, ("CarrierSense skip 2.4G domain code : %d\n", pDM_Odm->odm_Regulation2_4G));
|
pDM_Odm->Adaptivity_enable = FALSE;
|
pDM_Odm->adaptivity_flag = FALSE;
|
return TRUE;
|
|
} else if ((*pDM_Odm->pBandType != ODM_BAND_2_4G) && (*pDM_Odm->pBandType != ODM_BAND_5G)) {
|
ODM_RT_TRACE(pDM_Odm, PHYDM_COMP_ADAPTIVITY, ODM_DBG_LOUD, ("CarrierSense neither 2G nor 5G band, return\n"));
|
pDM_Odm->Adaptivity_enable = FALSE;
|
pDM_Odm->adaptivity_flag = FALSE;
|
return TRUE;
|
}
|
}
|
}
|
|
return FALSE;
|
|
}
|
#endif
|
|
VOID
|
Phydm_NHMCounterStatisticsInit(
|
IN PVOID pDM_VOID
|
)
|
{
|
PDM_ODM_T pDM_Odm = (PDM_ODM_T)pDM_VOID;
|
|
if (pDM_Odm->SupportICType & ODM_IC_11N_SERIES) {
|
/*PHY parameters initialize for n series*/
|
ODM_Write2Byte(pDM_Odm, ODM_REG_NHM_TIMER_11N + 2, 0xC350); /*0x894[31:16]=0x0xC350 Time duration for NHM unit: us, 0xc350=200ms*/
|
ODM_Write2Byte(pDM_Odm, ODM_REG_NHM_TH9_TH10_11N + 2, 0xffff); /*0x890[31:16]=0xffff th_9, th_10*/
|
ODM_Write4Byte(pDM_Odm, ODM_REG_NHM_TH3_TO_TH0_11N, 0xffffff50); /*0x898=0xffffff52 th_3, th_2, th_1, th_0*/
|
ODM_Write4Byte(pDM_Odm, ODM_REG_NHM_TH7_TO_TH4_11N, 0xffffffff); /*0x89c=0xffffffff th_7, th_6, th_5, th_4*/
|
ODM_SetBBReg(pDM_Odm, ODM_REG_FPGA0_IQK_11N, bMaskByte0, 0xff); /*0xe28[7:0]=0xff th_8*/
|
ODM_SetBBReg(pDM_Odm, ODM_REG_NHM_TH9_TH10_11N, BIT10 | BIT9 | BIT8, 0x1); /*0x890[10:8]=1 ignoreCCA ignore PHYTXON enable CCX*/
|
ODM_SetBBReg(pDM_Odm, ODM_REG_OFDM_FA_RSTC_11N, BIT7, 0x1); /*0xc0c[7]=1 max power among all RX ants*/
|
}
|
#if (RTL8195A_SUPPORT == 0)
|
else if (pDM_Odm->SupportICType & ODM_IC_11AC_SERIES) {
|
/*PHY parameters initialize for ac series*/
|
ODM_Write2Byte(pDM_Odm, ODM_REG_NHM_TIMER_11AC + 2, 0xC350); /*0x990[31:16]=0xC350 Time duration for NHM unit: us, 0xc350=200ms*/
|
ODM_Write2Byte(pDM_Odm, ODM_REG_NHM_TH9_TH10_11AC + 2, 0xffff); /*0x994[31:16]=0xffff th_9, th_10*/
|
ODM_Write4Byte(pDM_Odm, ODM_REG_NHM_TH3_TO_TH0_11AC, 0xffffff50); /*0x998=0xffffff52 th_3, th_2, th_1, th_0*/
|
ODM_Write4Byte(pDM_Odm, ODM_REG_NHM_TH7_TO_TH4_11AC, 0xffffffff); /*0x99c=0xffffffff th_7, th_6, th_5, th_4*/
|
ODM_SetBBReg(pDM_Odm, ODM_REG_NHM_TH8_11AC, bMaskByte0, 0xff); /*0x9a0[7:0]=0xff th_8*/
|
ODM_SetBBReg(pDM_Odm, ODM_REG_NHM_TH9_TH10_11AC, BIT8 | BIT9 | BIT10, 0x1); /*0x994[10:8]=1 ignoreCCA ignore PHYTXON enable CCX*/
|
ODM_SetBBReg(pDM_Odm, ODM_REG_NHM_9E8_11AC, BIT0, 0x1); /*0x9e8[7]=1 max power among all RX ants*/
|
|
}
|
#endif
|
}
|
|
VOID
|
Phydm_NHMCounterStatistics(
|
IN PVOID pDM_VOID
|
)
|
{
|
PDM_ODM_T pDM_Odm = (PDM_ODM_T)pDM_VOID;
|
|
if (!(pDM_Odm->SupportAbility & ODM_BB_NHM_CNT))
|
return;
|
|
/*Get NHM report*/
|
Phydm_GetNHMCounterStatistics(pDM_Odm);
|
|
/*Reset NHM counter*/
|
Phydm_NHMCounterStatisticsReset(pDM_Odm);
|
}
|
|
VOID
|
Phydm_GetNHMCounterStatistics(
|
IN PVOID pDM_VOID
|
)
|
{
|
PDM_ODM_T pDM_Odm = (PDM_ODM_T)pDM_VOID;
|
u4Byte value32 = 0;
|
#if (RTL8195A_SUPPORT == 0)
|
if (pDM_Odm->SupportICType & ODM_IC_11AC_SERIES)
|
value32 = ODM_GetBBReg(pDM_Odm, ODM_REG_NHM_CNT_11AC, bMaskDWord);
|
else if (pDM_Odm->SupportICType & ODM_IC_11N_SERIES)
|
#endif
|
value32 = ODM_GetBBReg(pDM_Odm, ODM_REG_NHM_CNT_11N, bMaskDWord);
|
|
pDM_Odm->NHM_cnt_0 = (u1Byte)(value32 & bMaskByte0);
|
pDM_Odm->NHM_cnt_1 = (u1Byte)((value32 & bMaskByte1) >> 8);
|
|
}
|
|
VOID
|
Phydm_NHMCounterStatisticsReset(
|
IN PVOID pDM_VOID
|
)
|
{
|
PDM_ODM_T pDM_Odm = (PDM_ODM_T)pDM_VOID;
|
|
if (pDM_Odm->SupportICType & ODM_IC_11N_SERIES) {
|
ODM_SetBBReg(pDM_Odm, ODM_REG_NHM_TH9_TH10_11N, BIT1, 0);
|
ODM_SetBBReg(pDM_Odm, ODM_REG_NHM_TH9_TH10_11N, BIT1, 1);
|
}
|
#if (RTL8195A_SUPPORT == 0)
|
else if (pDM_Odm->SupportICType & ODM_IC_11AC_SERIES) {
|
ODM_SetBBReg(pDM_Odm, ODM_REG_NHM_TH9_TH10_11AC, BIT1, 0);
|
ODM_SetBBReg(pDM_Odm, ODM_REG_NHM_TH9_TH10_11AC, BIT1, 1);
|
}
|
|
#endif
|
|
}
|
|
VOID
|
Phydm_SetEDCCAThreshold(
|
IN PVOID pDM_VOID,
|
IN s1Byte H2L,
|
IN s1Byte L2H
|
)
|
{
|
PDM_ODM_T pDM_Odm = (PDM_ODM_T)pDM_VOID;
|
|
if (pDM_Odm->SupportICType & ODM_IC_11N_SERIES) {
|
ODM_SetBBReg(pDM_Odm, rOFDM0_ECCAThreshold, bMaskByte0, (u1Byte)L2H);
|
ODM_SetBBReg(pDM_Odm, rOFDM0_ECCAThreshold, bMaskByte2, (u1Byte)H2L);
|
}
|
#if (RTL8195A_SUPPORT == 0)
|
else if (pDM_Odm->SupportICType & ODM_IC_11AC_SERIES) {
|
ODM_SetBBReg(pDM_Odm, rFPGA0_XB_LSSIReadBack, bMaskByte0, (u1Byte)L2H);
|
ODM_SetBBReg(pDM_Odm, rFPGA0_XB_LSSIReadBack, bMaskByte1, (u1Byte)H2L);
|
}
|
#endif
|
|
}
|
|
VOID
|
Phydm_SetTRxMux(
|
IN PVOID pDM_VOID,
|
IN PhyDM_Trx_MUX_Type txMode,
|
IN PhyDM_Trx_MUX_Type rxMode
|
)
|
{
|
PDM_ODM_T pDM_Odm = (PDM_ODM_T)pDM_VOID;
|
|
if (pDM_Odm->SupportICType & ODM_IC_11N_SERIES) {
|
ODM_SetBBReg(pDM_Odm, ODM_REG_CCK_RPT_FORMAT_11N, BIT3 | BIT2 | BIT1, txMode); /*set TXmod to standby mode to remove outside noise affect*/
|
ODM_SetBBReg(pDM_Odm, ODM_REG_CCK_RPT_FORMAT_11N, BIT22 | BIT21 | BIT20, rxMode); /*set RXmod to standby mode to remove outside noise affect*/
|
if (pDM_Odm->RFType > ODM_1T1R) {
|
ODM_SetBBReg(pDM_Odm, ODM_REG_CCK_RPT_FORMAT_11N_B, BIT3 | BIT2 | BIT1, txMode); /*set TXmod to standby mode to remove outside noise affect*/
|
ODM_SetBBReg(pDM_Odm, ODM_REG_CCK_RPT_FORMAT_11N_B, BIT22 | BIT21 | BIT20, rxMode); /*set RXmod to standby mode to remove outside noise affect*/
|
}
|
}
|
#if (RTL8195A_SUPPORT == 0)
|
else if (pDM_Odm->SupportICType & ODM_IC_11AC_SERIES) {
|
ODM_SetBBReg(pDM_Odm, ODM_REG_TRMUX_11AC, BIT11 | BIT10 | BIT9 | BIT8, txMode); /*set TXmod to standby mode to remove outside noise affect*/
|
ODM_SetBBReg(pDM_Odm, ODM_REG_TRMUX_11AC, BIT7 | BIT6 | BIT5 | BIT4, rxMode); /*set RXmod to standby mode to remove outside noise affect*/
|
if (pDM_Odm->RFType > ODM_1T1R) {
|
ODM_SetBBReg(pDM_Odm, ODM_REG_TRMUX_11AC_B, BIT11 | BIT10 | BIT9 | BIT8, txMode); /*set TXmod to standby mode to remove outside noise affect*/
|
ODM_SetBBReg(pDM_Odm, ODM_REG_TRMUX_11AC_B, BIT7 | BIT6 | BIT5 | BIT4, rxMode); /*set RXmod to standby mode to remove outside noise affect*/
|
}
|
}
|
#endif
|
|
}
|
|
VOID
|
Phydm_MACEDCCAState(
|
IN PVOID pDM_VOID,
|
IN PhyDM_MACEDCCA_Type State
|
)
|
{
|
PDM_ODM_T pDM_Odm = (PDM_ODM_T)pDM_VOID;
|
if (State == PhyDM_IGNORE_EDCCA) {
|
ODM_SetMACReg(pDM_Odm, REG_TX_PTCL_CTRL, BIT15, 1); /*ignore EDCCA reg520[15]=1*/
|
ODM_SetMACReg(pDM_Odm, REG_RD_CTRL, BIT11, 0); /*reg524[11]=0*/
|
} else { /*don't set MAC ignore EDCCA signal*/
|
ODM_SetMACReg(pDM_Odm, REG_TX_PTCL_CTRL, BIT15, 0); /*don't ignore EDCCA reg520[15]=0*/
|
ODM_SetMACReg(pDM_Odm, REG_RD_CTRL, BIT11, 1); /*reg524[11]=1 */
|
}
|
ODM_RT_TRACE(pDM_Odm, PHYDM_COMP_ADAPTIVITY, ODM_DBG_LOUD, ("EDCCA enable State = %d\n", State));
|
|
}
|
|
BOOLEAN
|
Phydm_CalNHMcnt(
|
IN PVOID pDM_VOID
|
)
|
{
|
PDM_ODM_T pDM_Odm = (PDM_ODM_T)pDM_VOID;
|
u2Byte Base = 0;
|
|
Base = pDM_Odm->NHM_cnt_0 + pDM_Odm->NHM_cnt_1;
|
|
if (Base != 0) {
|
pDM_Odm->NHM_cnt_0 = ((pDM_Odm->NHM_cnt_0) << 8) / Base;
|
pDM_Odm->NHM_cnt_1 = ((pDM_Odm->NHM_cnt_1) << 8) / Base;
|
}
|
if ((pDM_Odm->NHM_cnt_0 - pDM_Odm->NHM_cnt_1) >= 100)
|
return TRUE; /*clean environment*/
|
else
|
return FALSE; /*noisy environment*/
|
|
}
|
|
|
VOID
|
Phydm_CheckEnvironment(
|
IN PVOID pDM_VOID
|
)
|
{
|
PDM_ODM_T pDM_Odm = (PDM_ODM_T)pDM_VOID;
|
PADAPTIVITY_STATISTICS Adaptivity = (PADAPTIVITY_STATISTICS)PhyDM_Get_Structure(pDM_Odm, PHYDM_ADAPTIVITY);
|
BOOLEAN isCleanEnvironment = FALSE;
|
|
if (Adaptivity->bFirstLink == TRUE) {
|
if (pDM_Odm->SupportICType & (ODM_IC_11AC_GAIN_IDX_EDCCA | ODM_IC_11N_GAIN_IDX_EDCCA))
|
pDM_Odm->adaptivity_flag = FALSE;
|
else
|
pDM_Odm->adaptivity_flag = TRUE;
|
|
Adaptivity->bFirstLink = FALSE;
|
return;
|
} else {
|
if (Adaptivity->NHMWait < 3) { /*Start enter NHM after 4 NHMWait*/
|
Adaptivity->NHMWait++;
|
Phydm_NHMCounterStatistics(pDM_Odm);
|
return;
|
} else {
|
Phydm_NHMCounterStatistics(pDM_Odm);
|
isCleanEnvironment = Phydm_CalNHMcnt(pDM_Odm);
|
if (isCleanEnvironment == TRUE) {
|
pDM_Odm->TH_L2H_ini = Adaptivity->TH_L2H_ini_backup; /*adaptivity mode*/
|
pDM_Odm->TH_EDCCA_HL_diff = Adaptivity->TH_EDCCA_HL_diff_backup;
|
|
pDM_Odm->Adaptivity_enable = TRUE;
|
|
if (pDM_Odm->SupportICType & (ODM_IC_11AC_GAIN_IDX_EDCCA | ODM_IC_11N_GAIN_IDX_EDCCA))
|
pDM_Odm->adaptivity_flag = FALSE;
|
else
|
pDM_Odm->adaptivity_flag = TRUE;
|
} else {
|
pDM_Odm->TH_L2H_ini = pDM_Odm->TH_L2H_ini_mode2; /*mode2*/
|
pDM_Odm->TH_EDCCA_HL_diff = pDM_Odm->TH_EDCCA_HL_diff_mode2;
|
|
pDM_Odm->adaptivity_flag = FALSE;
|
pDM_Odm->Adaptivity_enable = FALSE;
|
}
|
Adaptivity->NHMWait = 0;
|
Adaptivity->bFirstLink = TRUE;
|
Adaptivity->bCheck = TRUE;
|
}
|
|
}
|
|
|
}
|
|
VOID
|
Phydm_SearchPwdBLowerBound(
|
IN PVOID pDM_VOID
|
)
|
{
|
PDM_ODM_T pDM_Odm = (PDM_ODM_T)pDM_VOID;
|
PADAPTIVITY_STATISTICS Adaptivity = (PADAPTIVITY_STATISTICS)PhyDM_Get_Structure(pDM_Odm, PHYDM_ADAPTIVITY);
|
u4Byte value32 = 0;
|
u1Byte cnt, IGI_Pause = 0x7f, IGI_Resume = 0x20, IGI = 0x45; /*IGI = 0x50 for cal EDCCA lower bound*/
|
u1Byte txEdcca1 = 0, txEdcca0 = 0;
|
BOOLEAN bAdjust = TRUE;
|
s1Byte TH_L2H_dmc, TH_H2L_dmc, IGI_target = 0x32;
|
s1Byte Diff;
|
|
Phydm_SetTRxMux(pDM_Odm, PhyDM_STANDBY_MODE, PhyDM_STANDBY_MODE);
|
ODM_Write_DIG(pDM_Odm, IGI_Pause);
|
|
Diff = IGI_target - (s1Byte)IGI;
|
TH_L2H_dmc = pDM_Odm->TH_L2H_ini + Diff;
|
if (TH_L2H_dmc > 10)
|
TH_L2H_dmc = 10;
|
TH_H2L_dmc = TH_L2H_dmc - pDM_Odm->TH_EDCCA_HL_diff;
|
|
Phydm_SetEDCCAThreshold(pDM_Odm, TH_H2L_dmc, TH_L2H_dmc);
|
ODM_delay_ms(5);
|
|
while (bAdjust) {
|
for (cnt = 0; cnt < 20; cnt++) {
|
if (pDM_Odm->SupportICType & ODM_IC_11N_SERIES)
|
value32 = ODM_GetBBReg(pDM_Odm, ODM_REG_RPT_11N, bMaskDWord);
|
#if (RTL8195A_SUPPORT == 0)
|
else if (pDM_Odm->SupportICType & ODM_IC_11AC_SERIES)
|
value32 = ODM_GetBBReg(pDM_Odm, ODM_REG_RPT_11AC, bMaskDWord);
|
#endif
|
if (value32 & BIT30 && (pDM_Odm->SupportICType & (ODM_RTL8723A | ODM_RTL8723B | ODM_RTL8188E)))
|
txEdcca1 = txEdcca1 + 1;
|
else if (value32 & BIT29)
|
txEdcca1 = txEdcca1 + 1;
|
else
|
txEdcca0 = txEdcca0 + 1;
|
}
|
|
if (txEdcca1 > 1) {
|
IGI = IGI - 1;
|
TH_L2H_dmc = TH_L2H_dmc + 1;
|
if (TH_L2H_dmc > 10)
|
TH_L2H_dmc = 10;
|
TH_H2L_dmc = TH_L2H_dmc - pDM_Odm->TH_EDCCA_HL_diff;
|
|
Phydm_SetEDCCAThreshold(pDM_Odm, TH_H2L_dmc, TH_L2H_dmc);
|
if (TH_L2H_dmc == 10) {
|
bAdjust = FALSE;
|
Adaptivity->H2L_lb = TH_H2L_dmc;
|
Adaptivity->L2H_lb = TH_L2H_dmc;
|
pDM_Odm->Adaptivity_IGI_upper = IGI;
|
}
|
|
txEdcca1 = 0;
|
txEdcca0 = 0;
|
|
} else {
|
bAdjust = FALSE;
|
Adaptivity->H2L_lb = TH_H2L_dmc;
|
Adaptivity->L2H_lb = TH_L2H_dmc;
|
pDM_Odm->Adaptivity_IGI_upper = IGI;
|
txEdcca1 = 0;
|
txEdcca0 = 0;
|
}
|
}
|
|
pDM_Odm->Adaptivity_IGI_upper = pDM_Odm->Adaptivity_IGI_upper - pDM_Odm->DCbackoff;
|
Adaptivity->H2L_lb = Adaptivity->H2L_lb + pDM_Odm->DCbackoff;
|
Adaptivity->L2H_lb = Adaptivity->L2H_lb + pDM_Odm->DCbackoff;
|
|
Phydm_SetTRxMux(pDM_Odm, PhyDM_TX_MODE, PhyDM_RX_MODE);
|
ODM_Write_DIG(pDM_Odm, IGI_Resume);
|
Phydm_SetEDCCAThreshold(pDM_Odm, 0x7f, 0x7f); /*resume to no link state*/
|
}
|
|
VOID
|
Phydm_AdaptivityInit(
|
IN PVOID pDM_VOID
|
)
|
{
|
PDM_ODM_T pDM_Odm = (PDM_ODM_T)pDM_VOID;
|
PADAPTIVITY_STATISTICS Adaptivity = (PADAPTIVITY_STATISTICS)PhyDM_Get_Structure(pDM_Odm, PHYDM_ADAPTIVITY);
|
#if(DM_ODM_SUPPORT_TYPE == ODM_WIN)
|
PADAPTER pAdapter = pDM_Odm->Adapter;
|
PMGNT_INFO pMgntInfo = &(pAdapter->MgntInfo);
|
pDM_Odm->Carrier_Sense_enable = (BOOLEAN)pMgntInfo->RegEnableCarrierSense;
|
pDM_Odm->DCbackoff = (u1Byte)pMgntInfo->RegDCbackoff;
|
Adaptivity->DynamicLinkAdaptivity = (BOOLEAN)pMgntInfo->RegDmLinkAdaptivity;
|
Adaptivity->APNumTH = (u1Byte)pMgntInfo->RegAPNumTH;
|
#elif(DM_ODM_SUPPORT_TYPE == ODM_CE)
|
pDM_Odm->Carrier_Sense_enable = (pDM_Odm->Adapter->registrypriv.adaptivity_mode != 0) ? TRUE : FALSE;
|
pDM_Odm->DCbackoff = pDM_Odm->Adapter->registrypriv.adaptivity_dc_backoff;
|
Adaptivity->DynamicLinkAdaptivity = (pDM_Odm->Adapter->registrypriv.adaptivity_dml != 0) ? TRUE : FALSE;
|
#endif
|
|
#if(DM_ODM_SUPPORT_TYPE & (ODM_CE|ODM_WIN))
|
|
if (pDM_Odm->Carrier_Sense_enable == FALSE) {
|
#if(DM_ODM_SUPPORT_TYPE == ODM_WIN)
|
if (pMgntInfo->RegL2HForAdaptivity != 0)
|
pDM_Odm->TH_L2H_ini = pMgntInfo->RegL2HForAdaptivity;
|
else
|
#endif
|
pDM_Odm->TH_L2H_ini = 0xf5;
|
} else
|
pDM_Odm->TH_L2H_ini = 0xa;
|
|
#if(DM_ODM_SUPPORT_TYPE == ODM_WIN)
|
if (pMgntInfo->RegHLDiffForAdaptivity != 0)
|
pDM_Odm->TH_EDCCA_HL_diff = pMgntInfo->RegHLDiffForAdaptivity;
|
else
|
#endif
|
pDM_Odm->TH_EDCCA_HL_diff = 7;
|
|
Adaptivity->TH_L2H_ini_backup = pDM_Odm->TH_L2H_ini;
|
Adaptivity->TH_EDCCA_HL_diff_backup = pDM_Odm->TH_EDCCA_HL_diff;
|
|
#elif (DM_ODM_SUPPORT_TYPE & (ODM_AP|ODM_ADSL))
|
prtl8192cd_priv priv = pDM_Odm->priv;
|
|
if (pDM_Odm->Carrier_Sense_enable) {
|
pDM_Odm->TH_L2H_ini = 0xa;
|
pDM_Odm->TH_EDCCA_HL_diff = 7;
|
} else {
|
Adaptivity->TH_L2H_ini_backup = pDM_Odm->TH_L2H_ini; /*set by mib*/
|
pDM_Odm->TH_EDCCA_HL_diff = 7;
|
}
|
|
Adaptivity->TH_EDCCA_HL_diff_backup = pDM_Odm->TH_EDCCA_HL_diff;
|
if (priv->pshare->rf_ft_var.adaptivity_enable == 2)
|
Adaptivity->DynamicLinkAdaptivity = TRUE;
|
else
|
Adaptivity->DynamicLinkAdaptivity = FALSE;
|
|
#endif
|
|
pDM_Odm->Adaptivity_IGI_upper = 0;
|
pDM_Odm->Adaptivity_enable = FALSE; /*use this flag to decide enable or disable*/
|
|
pDM_Odm->EDCCA_enable = TRUE; /*even no adaptivity, we still enable EDCCA*/
|
|
pDM_Odm->TH_L2H_ini_mode2 = 20;
|
pDM_Odm->TH_EDCCA_HL_diff_mode2 = 8;
|
|
Adaptivity->IGI_Base = 0x32;
|
Adaptivity->IGI_target = 0x1c;
|
Adaptivity->H2L_lb = 0;
|
Adaptivity->L2H_lb = 0;
|
Adaptivity->NHMWait = 0;
|
Adaptivity->bCheck = FALSE;
|
Adaptivity->bFirstLink = TRUE;
|
|
Phydm_MACEDCCAState(pDM_Odm, PhyDM_DONT_IGNORE_EDCCA);
|
|
/*Search pwdB lower bound*/
|
if (pDM_Odm->SupportICType & ODM_IC_11N_SERIES)
|
ODM_SetBBReg(pDM_Odm, ODM_REG_DBG_RPT_11N, bMaskDWord, 0x208);
|
#if (RTL8195A_SUPPORT == 0)
|
else if (pDM_Odm->SupportICType & ODM_IC_11AC_SERIES)
|
ODM_SetBBReg(pDM_Odm, ODM_REG_DBG_RPT_11AC, bMaskDWord, 0x209);
|
#endif
|
|
if (pDM_Odm->SupportICType & ODM_IC_11N_GAIN_IDX_EDCCA) {
|
ODM_SetBBReg(pDM_Odm, ODM_REG_EDCCA_DOWN_OPT_11N, BIT12 | BIT11 | BIT10, 0x7); /*interfernce need > 2^x us, and then EDCCA will be 1*/
|
ODM_SetBBReg(pDM_Odm, ODM_REG_EDCCA_DCNF_11N, BIT21 | BIT20, 0x1); /*0:rx_dfir, 1: dcnf_out, 2 :rx_iq, 3: rx_nbi_nf_out*/
|
}
|
#if (RTL8195A_SUPPORT == 0)
|
if (pDM_Odm->SupportICType & ODM_IC_11AC_GAIN_IDX_EDCCA) { /*8814a no need to find pwdB lower bound, maybe*/
|
ODM_SetBBReg(pDM_Odm, ODM_REG_EDCCA_DOWN_OPT, BIT30 | BIT29 | BIT28, 0x7); /*interfernce need > 2^x us, and then EDCCA will be 1*/
|
ODM_SetBBReg(pDM_Odm, ODM_REG_ACBB_EDCCA_ENHANCE, BIT29 | BIT28, 0x1); /*0:rx_dfir, 1: dcnf_out, 2 :rx_iq, 3: rx_nbi_nf_out*/
|
}
|
|
if(!(pDM_Odm->SupportICType & (ODM_IC_11AC_GAIN_IDX_EDCCA | ODM_IC_11N_GAIN_IDX_EDCCA)))
|
Phydm_SearchPwdBLowerBound(pDM_Odm);
|
#endif
|
|
ODM_RT_TRACE(pDM_Odm, PHYDM_COMP_ADAPTIVITY, ODM_DBG_LOUD, ("TH_L2H_ini = 0x%x, TH_EDCCA_HL_diff = 0x%x\n", pDM_Odm->TH_L2H_ini, pDM_Odm->TH_EDCCA_HL_diff));
|
|
}
|
|
|
VOID
|
Phydm_Adaptivity(
|
IN PVOID pDM_VOID,
|
IN u1Byte IGI
|
)
|
{
|
PDM_ODM_T pDM_Odm = (PDM_ODM_T)pDM_VOID;
|
s1Byte TH_L2H_dmc, TH_H2L_dmc;
|
s1Byte Diff, IGI_target;
|
PADAPTIVITY_STATISTICS Adaptivity = (PADAPTIVITY_STATISTICS)PhyDM_Get_Structure(pDM_Odm, PHYDM_ADAPTIVITY);
|
#if (DM_ODM_SUPPORT_TYPE == ODM_WIN)
|
PADAPTER pAdapter = pDM_Odm->Adapter;
|
BOOLEAN bFwCurrentInPSMode = FALSE;
|
PMGNT_INFO pMgntInfo = &(pAdapter->MgntInfo);
|
|
pAdapter->HalFunc.GetHwRegHandler(pAdapter, HW_VAR_FW_PSMODE_STATUS, (pu1Byte)(&bFwCurrentInPSMode));
|
|
/*Disable EDCCA mode while under LPS mode, added by Roger, 2012.09.14.*/
|
if (bFwCurrentInPSMode)
|
return;
|
#endif
|
|
if (pDM_Odm->EDCCA_enable == FALSE) {
|
ODM_RT_TRACE(pDM_Odm, PHYDM_COMP_ADAPTIVITY, ODM_DBG_LOUD, ("Disable EDCCA!!!\n"));
|
return;
|
}
|
|
if (!(pDM_Odm->SupportAbility & ODM_BB_ADAPTIVITY)) {
|
ODM_RT_TRACE(pDM_Odm, PHYDM_COMP_ADAPTIVITY, ODM_DBG_LOUD, ("adaptivity disable, enable EDCCA mode!!!\n"));
|
pDM_Odm->TH_L2H_ini = pDM_Odm->TH_L2H_ini_mode2;
|
pDM_Odm->TH_EDCCA_HL_diff = pDM_Odm->TH_EDCCA_HL_diff_mode2;
|
}
|
#if (DM_ODM_SUPPORT_TYPE == ODM_WIN)
|
else{
|
if (Phydm_CheckChannelPlan(pDM_Odm) || (pDM_Odm->APTotalNum > Adaptivity->APNumTH)) {
|
pDM_Odm->TH_L2H_ini = pDM_Odm->TH_L2H_ini_mode2;
|
pDM_Odm->TH_EDCCA_HL_diff = pDM_Odm->TH_EDCCA_HL_diff_mode2;
|
}
|
}
|
#endif
|
|
ODM_RT_TRACE(pDM_Odm, PHYDM_COMP_ADAPTIVITY, ODM_DBG_LOUD, ("odm_Adaptivity() =====>\n"));
|
ODM_RT_TRACE(pDM_Odm, PHYDM_COMP_ADAPTIVITY, ODM_DBG_LOUD, ("IGI_Base=0x%x, TH_L2H_ini = %d, TH_EDCCA_HL_diff = %d\n",
|
Adaptivity->IGI_Base, pDM_Odm->TH_L2H_ini, pDM_Odm->TH_EDCCA_HL_diff));
|
#if (RTL8195A_SUPPORT == 0)
|
if (pDM_Odm->SupportICType & ODM_IC_11AC_SERIES) {
|
/*fix AC series when enable EDCCA hang issue*/
|
ODM_SetBBReg(pDM_Odm, 0x800, BIT10, 1); /*ADC_mask disable*/
|
ODM_SetBBReg(pDM_Odm, 0x800, BIT10, 0); /*ADC_mask enable*/
|
}
|
#endif
|
if (*pDM_Odm->pBandWidth == ODM_BW20M) /*CHANNEL_WIDTH_20*/
|
IGI_target = Adaptivity->IGI_Base;
|
else if (*pDM_Odm->pBandWidth == ODM_BW40M)
|
IGI_target = Adaptivity->IGI_Base + 2;
|
#if (RTL8195A_SUPPORT == 0)
|
else if (*pDM_Odm->pBandWidth == ODM_BW80M)
|
IGI_target = Adaptivity->IGI_Base + 2;
|
#endif
|
else
|
IGI_target = Adaptivity->IGI_Base;
|
Adaptivity->IGI_target = (u1Byte) IGI_target;
|
|
ODM_RT_TRACE(pDM_Odm, PHYDM_COMP_ADAPTIVITY, ODM_DBG_LOUD, ("BandWidth=%s, IGI_target=0x%x, DynamicLinkAdaptivity = %d\n",
|
(*pDM_Odm->pBandWidth == ODM_BW80M) ? "80M" : ((*pDM_Odm->pBandWidth == ODM_BW40M) ? "40M" : "20M"), IGI_target, Adaptivity->DynamicLinkAdaptivity));
|
ODM_RT_TRACE(pDM_Odm, PHYDM_COMP_ADAPTIVITY, ODM_DBG_LOUD, ("RSSI_min = %d, AdapIGIUpper= 0x%x, adaptivity_flag = %d, Adaptivity_enable = %d\n",
|
pDM_Odm->RSSI_Min, pDM_Odm->Adaptivity_IGI_upper, pDM_Odm->adaptivity_flag, pDM_Odm->Adaptivity_enable));
|
|
if ((Adaptivity->DynamicLinkAdaptivity == TRUE) && (!pDM_Odm->bLinked) && (pDM_Odm->Adaptivity_enable == FALSE)) {
|
Phydm_SetEDCCAThreshold(pDM_Odm, 0x7f, 0x7f);
|
ODM_RT_TRACE(pDM_Odm, PHYDM_COMP_ADAPTIVITY, ODM_DBG_LOUD, ("In DynamicLink mode(noisy) and No link, Turn off EDCCA!!\n"));
|
return;
|
}
|
|
if (pDM_Odm->SupportICType & (ODM_IC_11AC_GAIN_IDX_EDCCA | ODM_IC_11N_GAIN_IDX_EDCCA)) {
|
TH_L2H_dmc = (s1Byte)pDM_Odm->TH_L2H_ini + IGI_target;
|
TH_H2L_dmc = TH_L2H_dmc - pDM_Odm->TH_EDCCA_HL_diff;
|
}
|
#if (RTL8195A_SUPPORT == 0)
|
else {
|
Diff = IGI_target - (s1Byte)IGI;
|
TH_L2H_dmc = pDM_Odm->TH_L2H_ini + Diff;
|
if (TH_L2H_dmc > 10)
|
TH_L2H_dmc = 10;
|
|
TH_H2L_dmc = TH_L2H_dmc - pDM_Odm->TH_EDCCA_HL_diff;
|
|
/*replace lower bound to prevent EDCCA always equal 1*/
|
if (TH_H2L_dmc < Adaptivity->H2L_lb)
|
TH_H2L_dmc = Adaptivity->H2L_lb;
|
if (TH_L2H_dmc < Adaptivity->L2H_lb)
|
TH_L2H_dmc = Adaptivity->L2H_lb;
|
}
|
#endif
|
ODM_RT_TRACE(pDM_Odm, PHYDM_COMP_ADAPTIVITY, ODM_DBG_LOUD, ("IGI=0x%x, TH_L2H_dmc = %d, TH_H2L_dmc = %d\n", IGI, TH_L2H_dmc, TH_H2L_dmc));
|
ODM_RT_TRACE(pDM_Odm, PHYDM_COMP_ADAPTIVITY, ODM_DBG_LOUD, ("Adaptivity_IGI_upper=0x%x, H2L_lb = 0x%x, L2H_lb = 0x%x\n", pDM_Odm->Adaptivity_IGI_upper, Adaptivity->H2L_lb, Adaptivity->L2H_lb));
|
|
Phydm_SetEDCCAThreshold(pDM_Odm, TH_H2L_dmc, TH_L2H_dmc);
|
return;
|
}
|
|
|
#if (DM_ODM_SUPPORT_TYPE == ODM_WIN)
|
|
VOID
|
Phydm_AdaptivityBSOD(
|
IN PVOID pDM_VOID
|
)
|
{
|
PDM_ODM_T pDM_Odm = (PDM_ODM_T)pDM_VOID;
|
PADAPTER pAdapter = pDM_Odm->Adapter;
|
PMGNT_INFO pMgntInfo = &(pAdapter->MgntInfo);
|
u1Byte count = 0;
|
u4Byte u4Value;
|
|
/*
|
1. turn off RF (TRX Mux in standby mode)
|
2. H2C mac id drop
|
3. ignore EDCCA
|
4. wait for clear FIFO
|
5. don't ignore EDCCA
|
6. turn on RF (TRX Mux in TRx mdoe)
|
7. H2C mac id resume
|
*/
|
|
RT_TRACE(COMP_MLME, DBG_WARNING, ("MAC id drop packet!!!!!\n"));
|
|
pAdapter->dropPktByMacIdCnt++;
|
pMgntInfo->bDropPktInProgress = TRUE;
|
|
pAdapter->HalFunc.GetHwRegHandler(pAdapter, HW_VAR_MAX_Q_PAGE_NUM, (pu1Byte)(&u4Value));
|
RT_TRACE(COMP_INIT, DBG_LOUD, ("Queue Reserved Page Number = 0x%08x\n", u4Value));
|
pAdapter->HalFunc.GetHwRegHandler(pAdapter, HW_VAR_AVBL_Q_PAGE_NUM, (pu1Byte)(&u4Value));
|
RT_TRACE(COMP_INIT, DBG_LOUD, ("Available Queue Page Number = 0x%08x\n", u4Value));
|
|
#if 1
|
|
/*Standby mode*/
|
Phydm_SetTRxMux(pDM_Odm, PhyDM_STANDBY_MODE, PhyDM_STANDBY_MODE);
|
ODM_Write_DIG(pDM_Odm, 0x20);
|
|
/*H2C mac id drop*/
|
MacIdIndicateDisconnect(pAdapter);
|
|
/*Ignore EDCCA*/
|
Phydm_MACEDCCAState(pDM_Odm, PhyDM_IGNORE_EDCCA);
|
|
delay_ms(50);
|
count = 5;
|
|
#else
|
|
do {
|
|
u8Byte diffTime, curTime, oldestTime;
|
u1Byte queueIdx
|
|
//3 Standby mode
|
Phydm_SetTRxMux(pDM_Odm, PhyDM_STANDBY_MODE, PhyDM_STANDBY_MODE);
|
ODM_Write_DIG(pDM_Odm, 0x20);
|
|
//3 H2C mac id drop
|
MacIdIndicateDisconnect(pAdapter);
|
|
//3 Ignore EDCCA
|
Phydm_MACEDCCAState(pDM_Odm, PhyDM_IGNORE_EDCCA);
|
|
count++;
|
delay_ms(10);
|
|
// Check latest packet
|
curTime = PlatformGetCurrentTime();
|
oldestTime = 0xFFFFFFFFFFFFFFFF;
|
|
for (queueIdx = 0; queueIdx < MAX_TX_QUEUE; queueIdx++) {
|
if (!IS_DATA_QUEUE(queueIdx))
|
continue;
|
|
if (!pAdapter->bTcbBusyQEmpty[queueIdx]) {
|
RT_TRACE(COMP_MLME, DBG_WARNING, ("oldestTime = %llu\n", oldestTime));
|
RT_TRACE(COMP_MLME, DBG_WARNING, ("Q[%d] = %llu\n", queueIdx, pAdapter->firstTcbSysTime[queueIdx]));
|
if (pAdapter->firstTcbSysTime[queueIdx] < oldestTime)
|
oldestTime = pAdapter->firstTcbSysTime[queueIdx];
|
}
|
}
|
|
diffTime = curTime - oldestTime;
|
|
RT_TRACE(COMP_MLME, DBG_WARNING, ("diff s = %llu\n", (diffTime / 1000000)));
|
|
} while (((diffTime / 1000000) >= 4) && (oldestTime != 0xFFFFFFFFFFFFFFFF));
|
#endif
|
|
/*Resume EDCCA*/
|
Phydm_MACEDCCAState(pDM_Odm, PhyDM_DONT_IGNORE_EDCCA);
|
|
/*Turn on TRx mode*/
|
Phydm_SetTRxMux(pDM_Odm, PhyDM_TX_MODE, PhyDM_RX_MODE);
|
ODM_Write_DIG(pDM_Odm, 0x20);
|
|
/*Resume H2C macid*/
|
MacIdRecoverMediaStatus(pAdapter);
|
|
pAdapter->HalFunc.GetHwRegHandler(pAdapter, HW_VAR_AVBL_Q_PAGE_NUM, (pu1Byte)(&u4Value));
|
RT_TRACE(COMP_INIT, DBG_LOUD, ("Available Queue Page Number = 0x%08x\n", u4Value));
|
|
pMgntInfo->bDropPktInProgress = FALSE;
|
RT_TRACE(COMP_MLME, DBG_WARNING, ("End of MAC id drop packet, spent %dms\n", count * 10));
|
|
}
|
|
#endif
|
|
VOID
|
phydm_setEDCCAThresholdAPI(
|
IN PVOID pDM_VOID,
|
IN u1Byte IGI
|
)
|
{
|
PDM_ODM_T pDM_Odm = (PDM_ODM_T)pDM_VOID;
|
PADAPTIVITY_STATISTICS Adaptivity = (PADAPTIVITY_STATISTICS)PhyDM_Get_Structure(pDM_Odm, PHYDM_ADAPTIVITY);
|
s1Byte TH_L2H_dmc, TH_H2L_dmc;
|
s1Byte Diff = 0, IGI_target = 0x32;
|
|
Diff = IGI_target - (s1Byte)IGI;
|
TH_L2H_dmc = pDM_Odm->TH_L2H_ini + Diff;
|
if (TH_L2H_dmc > 10)
|
TH_L2H_dmc = 10;
|
|
TH_H2L_dmc = TH_L2H_dmc - pDM_Odm->TH_EDCCA_HL_diff;
|
|
/*replace lower bound to prevent EDCCA always equal 1*/
|
if (TH_H2L_dmc < Adaptivity->H2L_lb)
|
TH_H2L_dmc = Adaptivity->H2L_lb;
|
if (TH_L2H_dmc < Adaptivity->L2H_lb)
|
TH_L2H_dmc = Adaptivity->L2H_lb;
|
|
ODM_RT_TRACE(pDM_Odm, PHYDM_COMP_ADAPTIVITY, ODM_DBG_LOUD, ("API :IGI=0x%x, TH_L2H_dmc = %d, TH_H2L_dmc = %d\n", IGI, TH_L2H_dmc, TH_H2L_dmc));
|
ODM_RT_TRACE(pDM_Odm, PHYDM_COMP_ADAPTIVITY, ODM_DBG_LOUD, ("API :Adaptivity_IGI_upper=0x%x, H2L_lb = 0x%x, L2H_lb = 0x%x\n", pDM_Odm->Adaptivity_IGI_upper, Adaptivity->H2L_lb, Adaptivity->L2H_lb));
|
|
Phydm_SetEDCCAThreshold(pDM_Odm, TH_H2L_dmc, TH_L2H_dmc);
|
|
}
|
