mirror of
https://github.com/aircrack-ng/rtl8812au.git
synced 2024-12-01 17:32:04 +00:00
4141 lines
120 KiB
C
4141 lines
120 KiB
C
/******************************************************************************
|
|
*
|
|
* 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
|
|
*
|
|
*
|
|
******************************************************************************/
|
|
#define _HAL_COM_PHYCFG_C_
|
|
|
|
#include <drv_types.h>
|
|
#include <hal_data.h>
|
|
|
|
|
|
//
|
|
// Description:
|
|
// Map Tx power index into dBm according to
|
|
// current HW model, for example, RF and PA, and
|
|
// current wireless mode.
|
|
// By Bruce, 2008-01-29.
|
|
//
|
|
s32
|
|
phy_TxPwrIdxToDbm(
|
|
IN PADAPTER Adapter,
|
|
IN WIRELESS_MODE WirelessMode,
|
|
IN u8 TxPwrIdx
|
|
)
|
|
{
|
|
s32 Offset = 0;
|
|
s32 PwrOutDbm = 0;
|
|
|
|
//
|
|
// Tested by MP, we found that CCK Index 0 equals to -7dbm, OFDM legacy equals to -8dbm.
|
|
// Note:
|
|
// The mapping may be different by different NICs. Do not use this formula for what needs accurate result.
|
|
// By Bruce, 2008-01-29.
|
|
//
|
|
switch(WirelessMode)
|
|
{
|
|
case WIRELESS_MODE_B:
|
|
Offset = -7;
|
|
break;
|
|
|
|
case WIRELESS_MODE_G:
|
|
case WIRELESS_MODE_N_24G:
|
|
Offset = -8;
|
|
break;
|
|
|
|
default: //for MacOSX compiler warning
|
|
break;
|
|
}
|
|
|
|
PwrOutDbm = TxPwrIdx / 2 + Offset; // Discard the decimal part.
|
|
|
|
return PwrOutDbm;
|
|
}
|
|
|
|
bool rtw_regsty_tx_power_by_rate_base_valid(
|
|
IN PADAPTER Adapter
|
|
)
|
|
{
|
|
/* TODO: check registry power by rate base valid */
|
|
return _FALSE;
|
|
}
|
|
|
|
u8 rtw_regsty_get_tx_power_by_rate_base(
|
|
IN PADAPTER Adapter,
|
|
IN u8 Band,
|
|
IN u8 RfPath,
|
|
IN u8 TxNum,
|
|
IN RATE_SECTION RateSection
|
|
)
|
|
{
|
|
/* TODO: return registry power by rate base */
|
|
return 0;
|
|
}
|
|
|
|
u8
|
|
PHY_GetTxPowerByRateBase(
|
|
IN PADAPTER Adapter,
|
|
IN u8 Band,
|
|
IN u8 RfPath,
|
|
IN u8 TxNum,
|
|
IN RATE_SECTION RateSection
|
|
)
|
|
{
|
|
HAL_DATA_TYPE *pHalData = GET_HAL_DATA(Adapter);
|
|
u8 value = 0;
|
|
|
|
if ( RfPath > ODM_RF_PATH_D )
|
|
{
|
|
DBG_871X("Invalid Rf Path %d in PHY_GetTxPowerByRateBase()\n", RfPath );
|
|
return 0;
|
|
}
|
|
|
|
if ( Band == BAND_ON_2_4G )
|
|
{
|
|
switch ( RateSection ) {
|
|
case CCK:
|
|
value = pHalData->TxPwrByRateBase2_4G[RfPath][TxNum][0];
|
|
break;
|
|
case OFDM:
|
|
value = pHalData->TxPwrByRateBase2_4G[RfPath][TxNum][1];
|
|
break;
|
|
case HT_MCS0_MCS7:
|
|
value = pHalData->TxPwrByRateBase2_4G[RfPath][TxNum][2];
|
|
break;
|
|
case HT_MCS8_MCS15:
|
|
value = pHalData->TxPwrByRateBase2_4G[RfPath][TxNum][3];
|
|
break;
|
|
case HT_MCS16_MCS23:
|
|
value = pHalData->TxPwrByRateBase2_4G[RfPath][TxNum][4];
|
|
break;
|
|
case HT_MCS24_MCS31:
|
|
value = pHalData->TxPwrByRateBase2_4G[RfPath][TxNum][5];
|
|
break;
|
|
case VHT_1SSMCS0_1SSMCS9:
|
|
value = pHalData->TxPwrByRateBase2_4G[RfPath][TxNum][6];
|
|
break;
|
|
case VHT_2SSMCS0_2SSMCS9:
|
|
value = pHalData->TxPwrByRateBase2_4G[RfPath][TxNum][7];
|
|
break;
|
|
case VHT_3SSMCS0_3SSMCS9:
|
|
value = pHalData->TxPwrByRateBase2_4G[RfPath][TxNum][8];
|
|
break;
|
|
case VHT_4SSMCS0_4SSMCS9:
|
|
value = pHalData->TxPwrByRateBase2_4G[RfPath][TxNum][9];
|
|
break;
|
|
default:
|
|
DBG_871X("Invalid RateSection %d in Band 2.4G, Rf Path %d, %dTx in PHY_GetTxPowerByRateBase()\n",
|
|
RateSection, RfPath, TxNum );
|
|
break;
|
|
|
|
};
|
|
}
|
|
else if ( Band == BAND_ON_5G )
|
|
{
|
|
switch ( RateSection ) {
|
|
case OFDM:
|
|
value = pHalData->TxPwrByRateBase5G[RfPath][TxNum][0];
|
|
break;
|
|
case HT_MCS0_MCS7:
|
|
value = pHalData->TxPwrByRateBase5G[RfPath][TxNum][1];
|
|
break;
|
|
case HT_MCS8_MCS15:
|
|
value = pHalData->TxPwrByRateBase5G[RfPath][TxNum][2];
|
|
break;
|
|
case HT_MCS16_MCS23:
|
|
value = pHalData->TxPwrByRateBase5G[RfPath][TxNum][3];
|
|
break;
|
|
case HT_MCS24_MCS31:
|
|
value = pHalData->TxPwrByRateBase5G[RfPath][TxNum][4];
|
|
break;
|
|
case VHT_1SSMCS0_1SSMCS9:
|
|
value = pHalData->TxPwrByRateBase5G[RfPath][TxNum][5];
|
|
break;
|
|
case VHT_2SSMCS0_2SSMCS9:
|
|
value = pHalData->TxPwrByRateBase5G[RfPath][TxNum][6];
|
|
break;
|
|
case VHT_3SSMCS0_3SSMCS9:
|
|
value = pHalData->TxPwrByRateBase5G[RfPath][TxNum][7];
|
|
break;
|
|
case VHT_4SSMCS0_4SSMCS9:
|
|
value = pHalData->TxPwrByRateBase5G[RfPath][TxNum][8];
|
|
break;
|
|
default:
|
|
DBG_871X("Invalid RateSection %d in Band 5G, Rf Path %d, %dTx in PHY_GetTxPowerByRateBase()\n",
|
|
RateSection, RfPath, TxNum );
|
|
break;
|
|
};
|
|
}
|
|
else
|
|
{
|
|
DBG_871X("Invalid Band %d in PHY_GetTxPowerByRateBase()\n", Band );
|
|
}
|
|
|
|
return value;
|
|
}
|
|
|
|
VOID
|
|
phy_SetTxPowerByRateBase(
|
|
IN PADAPTER Adapter,
|
|
IN u8 Band,
|
|
IN u8 RfPath,
|
|
IN RATE_SECTION RateSection,
|
|
IN u8 TxNum,
|
|
IN u8 Value
|
|
)
|
|
{
|
|
HAL_DATA_TYPE *pHalData = GET_HAL_DATA(Adapter);
|
|
|
|
if ( RfPath > ODM_RF_PATH_D )
|
|
{
|
|
DBG_871X("Invalid Rf Path %d in phy_SetTxPowerByRatBase()\n", RfPath );
|
|
return;
|
|
}
|
|
|
|
if ( Band == BAND_ON_2_4G )
|
|
{
|
|
switch ( RateSection ) {
|
|
case CCK:
|
|
pHalData->TxPwrByRateBase2_4G[RfPath][TxNum][0] = Value;
|
|
break;
|
|
case OFDM:
|
|
pHalData->TxPwrByRateBase2_4G[RfPath][TxNum][1] = Value;
|
|
break;
|
|
case HT_MCS0_MCS7:
|
|
pHalData->TxPwrByRateBase2_4G[RfPath][TxNum][2] = Value;
|
|
break;
|
|
case HT_MCS8_MCS15:
|
|
pHalData->TxPwrByRateBase2_4G[RfPath][TxNum][3] = Value;
|
|
break;
|
|
case HT_MCS16_MCS23:
|
|
pHalData->TxPwrByRateBase2_4G[RfPath][TxNum][4] = Value;
|
|
break;
|
|
case HT_MCS24_MCS31:
|
|
pHalData->TxPwrByRateBase2_4G[RfPath][TxNum][5] = Value;
|
|
break;
|
|
case VHT_1SSMCS0_1SSMCS9:
|
|
pHalData->TxPwrByRateBase2_4G[RfPath][TxNum][6] = Value;
|
|
break;
|
|
case VHT_2SSMCS0_2SSMCS9:
|
|
pHalData->TxPwrByRateBase2_4G[RfPath][TxNum][7] = Value;
|
|
break;
|
|
case VHT_3SSMCS0_3SSMCS9:
|
|
pHalData->TxPwrByRateBase2_4G[RfPath][TxNum][8] = Value;
|
|
break;
|
|
case VHT_4SSMCS0_4SSMCS9:
|
|
pHalData->TxPwrByRateBase2_4G[RfPath][TxNum][9] = Value;
|
|
break;
|
|
default:
|
|
DBG_871X("Invalid RateSection %d in Band 2.4G, Rf Path %d, %dTx in phy_SetTxPowerByRateBase()\n",
|
|
RateSection, RfPath, TxNum );
|
|
break;
|
|
};
|
|
}
|
|
else if ( Band == BAND_ON_5G )
|
|
{
|
|
switch ( RateSection ) {
|
|
case OFDM:
|
|
pHalData->TxPwrByRateBase5G[RfPath][TxNum][0] = Value;
|
|
break;
|
|
case HT_MCS0_MCS7:
|
|
pHalData->TxPwrByRateBase5G[RfPath][TxNum][1] = Value;
|
|
break;
|
|
case HT_MCS8_MCS15:
|
|
pHalData->TxPwrByRateBase5G[RfPath][TxNum][2] = Value;
|
|
break;
|
|
case HT_MCS16_MCS23:
|
|
pHalData->TxPwrByRateBase5G[RfPath][TxNum][3] = Value;
|
|
break;
|
|
case HT_MCS24_MCS31:
|
|
pHalData->TxPwrByRateBase5G[RfPath][TxNum][4] = Value;
|
|
break;
|
|
case VHT_1SSMCS0_1SSMCS9:
|
|
pHalData->TxPwrByRateBase5G[RfPath][TxNum][5] = Value;
|
|
break;
|
|
case VHT_2SSMCS0_2SSMCS9:
|
|
pHalData->TxPwrByRateBase5G[RfPath][TxNum][6] = Value;
|
|
break;
|
|
case VHT_3SSMCS0_3SSMCS9:
|
|
pHalData->TxPwrByRateBase5G[RfPath][TxNum][7] = Value;
|
|
break;
|
|
case VHT_4SSMCS0_4SSMCS9:
|
|
pHalData->TxPwrByRateBase5G[RfPath][TxNum][8] = Value;
|
|
break;
|
|
default:
|
|
DBG_871X("Invalid RateSection %d in Band 5G, Rf Path %d, %dTx in phy_SetTxPowerByRateBase()\n",
|
|
RateSection, RfPath, TxNum );
|
|
break;
|
|
};
|
|
}
|
|
else
|
|
{
|
|
DBG_871X("Invalid Band %d in phy_SetTxPowerByRateBase()\n", Band );
|
|
}
|
|
}
|
|
|
|
VOID
|
|
phy_StoreTxPowerByRateBaseOld(
|
|
IN PADAPTER pAdapter
|
|
)
|
|
{
|
|
HAL_DATA_TYPE *pHalData = GET_HAL_DATA( pAdapter );
|
|
u16 rawValue = 0;
|
|
u8 base = 0;
|
|
u8 path = 0;
|
|
|
|
rawValue = ( u16 ) ( pHalData->MCSTxPowerLevelOriginalOffset[0][7] >> 8 ) & 0xFF;
|
|
base = ( rawValue >> 4 ) * 10 + ( rawValue & 0xF );
|
|
phy_SetTxPowerByRateBase( pAdapter, BAND_ON_2_4G, ODM_RF_PATH_A, CCK, RF_1TX, base );
|
|
|
|
rawValue = ( u16 ) ( pHalData->MCSTxPowerLevelOriginalOffset[0][1] >> 24 ) & 0xFF;
|
|
base = ( rawValue >> 4 ) * 10 + ( rawValue & 0xF );
|
|
phy_SetTxPowerByRateBase( pAdapter, BAND_ON_2_4G, ODM_RF_PATH_A, OFDM, RF_1TX, base );
|
|
|
|
rawValue = ( u16 ) ( pHalData->MCSTxPowerLevelOriginalOffset[0][3] >> 24 ) & 0xFF;
|
|
base = ( rawValue >> 4 ) * 10 + ( rawValue & 0xF );
|
|
phy_SetTxPowerByRateBase( pAdapter, BAND_ON_2_4G, ODM_RF_PATH_A, HT_MCS0_MCS7, RF_1TX, base );
|
|
|
|
rawValue = ( u16 ) ( pHalData->MCSTxPowerLevelOriginalOffset[0][5] >> 24 ) & 0xFF;
|
|
base = ( rawValue >> 4) * 10 + ( rawValue & 0xF );
|
|
phy_SetTxPowerByRateBase( pAdapter, BAND_ON_2_4G, ODM_RF_PATH_A, HT_MCS8_MCS15, RF_2TX, base );
|
|
|
|
rawValue = ( u16 ) ( pHalData->MCSTxPowerLevelOriginalOffset[0][7] & 0xFF );
|
|
base = ( rawValue >> 4 ) * 10 + ( rawValue & 0xF );
|
|
phy_SetTxPowerByRateBase( pAdapter, BAND_ON_2_4G, ODM_RF_PATH_B, CCK, RF_1TX, base );
|
|
|
|
rawValue = ( u16 ) ( pHalData->MCSTxPowerLevelOriginalOffset[0][9] >> 24 ) & 0xFF;
|
|
base = ( rawValue >> 4 ) * 10 + ( rawValue & 0xF );
|
|
phy_SetTxPowerByRateBase( pAdapter, BAND_ON_2_4G, ODM_RF_PATH_B, OFDM, RF_1TX, base );
|
|
|
|
rawValue = ( u16 ) ( pHalData->MCSTxPowerLevelOriginalOffset[0][11] >> 24 ) & 0xFF;
|
|
base = ( rawValue >> 4 ) * 10 + ( rawValue & 0xF );
|
|
phy_SetTxPowerByRateBase( pAdapter, BAND_ON_2_4G, ODM_RF_PATH_B, HT_MCS0_MCS7, RF_1TX, base );
|
|
|
|
rawValue = ( u16 ) ( pHalData->MCSTxPowerLevelOriginalOffset[0][13] >> 24 ) & 0xFF;
|
|
base = ( rawValue >> 4 ) * 10 + ( rawValue & 0xF );
|
|
phy_SetTxPowerByRateBase( pAdapter, BAND_ON_2_4G, ODM_RF_PATH_B, HT_MCS8_MCS15, RF_2TX, base );
|
|
}
|
|
|
|
VOID
|
|
phy_StoreTxPowerByRateBase(
|
|
IN PADAPTER pAdapter
|
|
)
|
|
{
|
|
struct hal_spec_t *hal_spec = GET_HAL_SPEC(pAdapter);
|
|
|
|
u8 rate_sec_base[RATE_SECTION_NUM] = {
|
|
MGN_11M,
|
|
MGN_54M,
|
|
MGN_MCS7,
|
|
MGN_MCS15,
|
|
MGN_MCS23,
|
|
MGN_MCS31,
|
|
MGN_VHT1SS_MCS7,
|
|
MGN_VHT2SS_MCS7,
|
|
MGN_VHT3SS_MCS7,
|
|
MGN_VHT4SS_MCS7,
|
|
};
|
|
|
|
u8 band, path, rs, tx_num, base, index;
|
|
|
|
for (band = BAND_ON_2_4G; band <= BAND_ON_5G; band++) {
|
|
|
|
for (path = RF_PATH_A; path < RF_PATH_MAX; path++) {
|
|
/* TODO: 8814A's NumTotalRFPath differs at probe(3) and up(4), need fixed
|
|
if (path >= hal_data->NumTotalRFPath)
|
|
break;
|
|
*/
|
|
|
|
for (rs = 0; rs < RATE_SECTION_NUM; rs++) {
|
|
tx_num = rate_section_to_tx_num(rs);
|
|
if (tx_num >= hal_spec->nss_num)
|
|
continue;
|
|
|
|
if (band == BAND_ON_5G && IS_CCK_RATE_SECTION(rs))
|
|
continue;
|
|
|
|
base = PHY_GetTxPowerByRate(pAdapter, band, path, tx_num, rate_sec_base[rs]);
|
|
phy_SetTxPowerByRateBase(pAdapter, band, path, rs, tx_num, base);
|
|
}
|
|
}
|
|
}
|
|
}
|
|
|
|
u8
|
|
PHY_GetRateSectionIndexOfTxPowerByRate(
|
|
IN PADAPTER pAdapter,
|
|
IN u32 RegAddr,
|
|
IN u32 BitMask
|
|
)
|
|
{
|
|
HAL_DATA_TYPE *pHalData = GET_HAL_DATA( pAdapter );
|
|
PDM_ODM_T pDM_Odm = &pHalData->odmpriv;
|
|
u8 index = 0;
|
|
|
|
if ( pDM_Odm->PhyRegPgVersion == 0 )
|
|
{
|
|
switch ( RegAddr )
|
|
{
|
|
case rTxAGC_A_Rate18_06: index = 0; break;
|
|
case rTxAGC_A_Rate54_24: index = 1; break;
|
|
case rTxAGC_A_CCK1_Mcs32: index = 6; break;
|
|
case rTxAGC_B_CCK11_A_CCK2_11:
|
|
if ( BitMask == bMaskH3Bytes )
|
|
index = 7;
|
|
else if ( BitMask == 0x000000ff )
|
|
index = 15;
|
|
break;
|
|
|
|
case rTxAGC_A_Mcs03_Mcs00: index = 2; break;
|
|
case rTxAGC_A_Mcs07_Mcs04: index = 3; break;
|
|
case rTxAGC_A_Mcs11_Mcs08: index = 4; break;
|
|
case rTxAGC_A_Mcs15_Mcs12: index = 5; break;
|
|
case rTxAGC_B_Rate18_06: index = 8; break;
|
|
case rTxAGC_B_Rate54_24: index = 9; break;
|
|
case rTxAGC_B_CCK1_55_Mcs32: index = 14; break;
|
|
case rTxAGC_B_Mcs03_Mcs00: index = 10; break;
|
|
case rTxAGC_B_Mcs07_Mcs04: index = 11; break;
|
|
case rTxAGC_B_Mcs11_Mcs08: index = 12; break;
|
|
case rTxAGC_B_Mcs15_Mcs12: index = 13; break;
|
|
default:
|
|
DBG_871X("Invalid RegAddr 0x3%x in PHY_GetRateSectionIndexOfTxPowerByRate()", RegAddr );
|
|
break;
|
|
};
|
|
}
|
|
|
|
return index;
|
|
}
|
|
|
|
VOID
|
|
PHY_GetRateValuesOfTxPowerByRate(
|
|
IN PADAPTER pAdapter,
|
|
IN u32 RegAddr,
|
|
IN u32 BitMask,
|
|
IN u32 Value,
|
|
OUT u8 *Rate,
|
|
OUT s8 *PwrByRateVal,
|
|
OUT u8 *RateNum
|
|
)
|
|
{
|
|
HAL_DATA_TYPE *pHalData = GET_HAL_DATA( pAdapter );
|
|
PDM_ODM_T pDM_Odm = &pHalData->odmpriv;
|
|
u8 index = 0, i = 0;
|
|
|
|
switch ( RegAddr )
|
|
{
|
|
case rTxAGC_A_Rate18_06:
|
|
case rTxAGC_B_Rate18_06:
|
|
Rate[0] = MGN_6M;
|
|
Rate[1] = MGN_9M;
|
|
Rate[2] = MGN_12M;
|
|
Rate[3] = MGN_18M;
|
|
for ( i = 0; i < 4; ++ i )
|
|
{
|
|
PwrByRateVal[i] = ( s8 ) ( ( ( ( Value >> (i * 8 + 4) ) & 0xF ) ) * 10 +
|
|
( ( Value >> (i * 8) ) & 0xF ) );
|
|
}
|
|
*RateNum = 4;
|
|
break;
|
|
|
|
case rTxAGC_A_Rate54_24:
|
|
case rTxAGC_B_Rate54_24:
|
|
Rate[0] = MGN_24M;
|
|
Rate[1] = MGN_36M;
|
|
Rate[2] = MGN_48M;
|
|
Rate[3] = MGN_54M;
|
|
for ( i = 0; i < 4; ++ i )
|
|
{
|
|
PwrByRateVal[i] = ( s8 ) ( ( ( ( Value >> (i * 8 + 4) ) & 0xF ) ) * 10 +
|
|
( ( Value >> (i * 8) ) & 0xF ) );
|
|
}
|
|
*RateNum = 4;
|
|
break;
|
|
|
|
case rTxAGC_A_CCK1_Mcs32:
|
|
Rate[0] = MGN_1M;
|
|
PwrByRateVal[0] = ( s8 ) ( ( ( ( Value >> (8 + 4) ) & 0xF ) ) * 10 +
|
|
( ( Value >> 8 ) & 0xF ) );
|
|
*RateNum = 1;
|
|
break;
|
|
|
|
case rTxAGC_B_CCK11_A_CCK2_11:
|
|
if ( BitMask == 0xffffff00 )
|
|
{
|
|
Rate[0] = MGN_2M;
|
|
Rate[1] = MGN_5_5M;
|
|
Rate[2] = MGN_11M;
|
|
for ( i = 1; i < 4; ++ i )
|
|
{
|
|
PwrByRateVal[i - 1] = ( s8 ) ( ( ( ( Value >> (i * 8 + 4) ) & 0xF ) ) * 10 +
|
|
( ( Value >> (i * 8) ) & 0xF ) );
|
|
}
|
|
*RateNum = 3;
|
|
}
|
|
else if ( BitMask == 0x000000ff )
|
|
{
|
|
Rate[0] = MGN_11M;
|
|
PwrByRateVal[0] = ( s8 ) ( ( ( ( Value >> 4 ) & 0xF ) ) * 10 +
|
|
( Value & 0xF ) );
|
|
*RateNum = 1;
|
|
}
|
|
break;
|
|
|
|
case rTxAGC_A_Mcs03_Mcs00:
|
|
case rTxAGC_B_Mcs03_Mcs00:
|
|
Rate[0] = MGN_MCS0;
|
|
Rate[1] = MGN_MCS1;
|
|
Rate[2] = MGN_MCS2;
|
|
Rate[3] = MGN_MCS3;
|
|
for ( i = 0; i < 4; ++ i )
|
|
{
|
|
PwrByRateVal[i] = ( s8 ) ( ( ( ( Value >> (i * 8 + 4) ) & 0xF ) ) * 10 +
|
|
( ( Value >> (i * 8) ) & 0xF ) );
|
|
}
|
|
*RateNum = 4;
|
|
break;
|
|
|
|
case rTxAGC_A_Mcs07_Mcs04:
|
|
case rTxAGC_B_Mcs07_Mcs04:
|
|
Rate[0] = MGN_MCS4;
|
|
Rate[1] = MGN_MCS5;
|
|
Rate[2] = MGN_MCS6;
|
|
Rate[3] = MGN_MCS7;
|
|
for ( i = 0; i < 4; ++ i )
|
|
{
|
|
PwrByRateVal[i] = ( s8 ) ( ( ( ( Value >> (i * 8 + 4) ) & 0xF ) ) * 10 +
|
|
( ( Value >> (i * 8) ) & 0xF ) );
|
|
}
|
|
*RateNum = 4;
|
|
break;
|
|
|
|
case rTxAGC_A_Mcs11_Mcs08:
|
|
case rTxAGC_B_Mcs11_Mcs08:
|
|
Rate[0] = MGN_MCS8;
|
|
Rate[1] = MGN_MCS9;
|
|
Rate[2] = MGN_MCS10;
|
|
Rate[3] = MGN_MCS11;
|
|
for ( i = 0; i < 4; ++ i )
|
|
{
|
|
PwrByRateVal[i] = ( s8 ) ( ( ( ( Value >> (i * 8 + 4) ) & 0xF ) ) * 10 +
|
|
( ( Value >> (i * 8) ) & 0xF ) );
|
|
}
|
|
*RateNum = 4;
|
|
break;
|
|
|
|
case rTxAGC_A_Mcs15_Mcs12:
|
|
case rTxAGC_B_Mcs15_Mcs12:
|
|
Rate[0] = MGN_MCS12;
|
|
Rate[1] = MGN_MCS13;
|
|
Rate[2] = MGN_MCS14;
|
|
Rate[3] = MGN_MCS15;
|
|
for ( i = 0; i < 4; ++ i )
|
|
{
|
|
PwrByRateVal[i] = ( s8 ) ( ( ( ( Value >> (i * 8 + 4) ) & 0xF ) ) * 10 +
|
|
( ( Value >> (i * 8) ) & 0xF ) );
|
|
}
|
|
*RateNum = 4;
|
|
|
|
break;
|
|
|
|
case rTxAGC_B_CCK1_55_Mcs32:
|
|
Rate[0] = MGN_1M;
|
|
Rate[1] = MGN_2M;
|
|
Rate[2] = MGN_5_5M;
|
|
for ( i = 1; i < 4; ++ i )
|
|
{
|
|
PwrByRateVal[i - 1] = ( s8 ) ( ( ( ( Value >> ( i * 8 + 4) ) & 0xF ) ) * 10 +
|
|
( ( Value >> ( i * 8) ) & 0xF ) );
|
|
}
|
|
*RateNum = 3;
|
|
break;
|
|
|
|
case 0xC20:
|
|
case 0xE20:
|
|
case 0x1820:
|
|
case 0x1a20:
|
|
Rate[0] = MGN_1M;
|
|
Rate[1] = MGN_2M;
|
|
Rate[2] = MGN_5_5M;
|
|
Rate[3] = MGN_11M;
|
|
for ( i = 0; i < 4; ++ i )
|
|
{
|
|
PwrByRateVal[i] = ( s8 ) ( ( ( ( Value >> (i * 8 + 4) ) & 0xF ) ) * 10 +
|
|
( ( Value >> (i * 8) ) & 0xF ) );
|
|
}
|
|
*RateNum = 4;
|
|
break;
|
|
|
|
case 0xC24:
|
|
case 0xE24:
|
|
case 0x1824:
|
|
case 0x1a24:
|
|
Rate[0] = MGN_6M;
|
|
Rate[1] = MGN_9M;
|
|
Rate[2] = MGN_12M;
|
|
Rate[3] = MGN_18M;
|
|
for ( i = 0; i < 4; ++ i )
|
|
{
|
|
PwrByRateVal[i] = ( s8 ) ( ( ( ( Value >> (i * 8 + 4) ) & 0xF ) ) * 10 +
|
|
( ( Value >> (i * 8) ) & 0xF ) );
|
|
}
|
|
*RateNum = 4;
|
|
break;
|
|
|
|
case 0xC28:
|
|
case 0xE28:
|
|
case 0x1828:
|
|
case 0x1a28:
|
|
Rate[0] = MGN_24M;
|
|
Rate[1] = MGN_36M;
|
|
Rate[2] = MGN_48M;
|
|
Rate[3] = MGN_54M;
|
|
for ( i = 0; i < 4; ++ i )
|
|
{
|
|
PwrByRateVal[i] = ( s8 ) ( ( ( ( Value >> (i * 8 + 4) ) & 0xF ) ) * 10 +
|
|
( ( Value >> (i * 8) ) & 0xF ) );
|
|
}
|
|
*RateNum = 4;
|
|
break;
|
|
|
|
case 0xC2C:
|
|
case 0xE2C:
|
|
case 0x182C:
|
|
case 0x1a2C:
|
|
Rate[0] = MGN_MCS0;
|
|
Rate[1] = MGN_MCS1;
|
|
Rate[2] = MGN_MCS2;
|
|
Rate[3] = MGN_MCS3;
|
|
for ( i = 0; i < 4; ++ i )
|
|
{
|
|
PwrByRateVal[i] = ( s8 ) ( ( ( ( Value >> (i * 8 + 4) ) & 0xF ) ) * 10 +
|
|
( ( Value >> (i * 8) ) & 0xF ) );
|
|
}
|
|
*RateNum = 4;
|
|
break;
|
|
|
|
case 0xC30:
|
|
case 0xE30:
|
|
case 0x1830:
|
|
case 0x1a30:
|
|
Rate[0] = MGN_MCS4;
|
|
Rate[1] = MGN_MCS5;
|
|
Rate[2] = MGN_MCS6;
|
|
Rate[3] = MGN_MCS7;
|
|
for ( i = 0; i < 4; ++ i )
|
|
{
|
|
PwrByRateVal[i] = ( s8 ) ( ( ( ( Value >> (i * 8 + 4) ) & 0xF ) ) * 10 +
|
|
( ( Value >> (i * 8) ) & 0xF ) );
|
|
}
|
|
*RateNum = 4;
|
|
break;
|
|
|
|
case 0xC34:
|
|
case 0xE34:
|
|
case 0x1834:
|
|
case 0x1a34:
|
|
Rate[0] = MGN_MCS8;
|
|
Rate[1] = MGN_MCS9;
|
|
Rate[2] = MGN_MCS10;
|
|
Rate[3] = MGN_MCS11;
|
|
for ( i = 0; i < 4; ++ i )
|
|
{
|
|
PwrByRateVal[i] = ( s8 ) ( ( ( ( Value >> (i * 8 + 4) ) & 0xF ) ) * 10 +
|
|
( ( Value >> (i * 8) ) & 0xF ) );
|
|
}
|
|
*RateNum = 4;
|
|
break;
|
|
|
|
case 0xC38:
|
|
case 0xE38:
|
|
case 0x1838:
|
|
case 0x1a38:
|
|
Rate[0] = MGN_MCS12;
|
|
Rate[1] = MGN_MCS13;
|
|
Rate[2] = MGN_MCS14;
|
|
Rate[3] = MGN_MCS15;
|
|
for ( i = 0; i < 4; ++ i )
|
|
{
|
|
PwrByRateVal[i] = ( s8 ) ( ( ( ( Value >> (i * 8 + 4) ) & 0xF ) ) * 10 +
|
|
( ( Value >> (i * 8) ) & 0xF ) );
|
|
}
|
|
*RateNum = 4;
|
|
break;
|
|
|
|
case 0xC3C:
|
|
case 0xE3C:
|
|
case 0x183C:
|
|
case 0x1a3C:
|
|
Rate[0] = MGN_VHT1SS_MCS0;
|
|
Rate[1] = MGN_VHT1SS_MCS1;
|
|
Rate[2] = MGN_VHT1SS_MCS2;
|
|
Rate[3] = MGN_VHT1SS_MCS3;
|
|
for ( i = 0; i < 4; ++ i )
|
|
{
|
|
PwrByRateVal[i] = ( s8 ) ( ( ( ( Value >> (i * 8 + 4) ) & 0xF ) ) * 10 +
|
|
( ( Value >> (i * 8) ) & 0xF ) );
|
|
}
|
|
*RateNum = 4;
|
|
break;
|
|
|
|
case 0xC40:
|
|
case 0xE40:
|
|
case 0x1840:
|
|
case 0x1a40:
|
|
Rate[0] = MGN_VHT1SS_MCS4;
|
|
Rate[1] = MGN_VHT1SS_MCS5;
|
|
Rate[2] = MGN_VHT1SS_MCS6;
|
|
Rate[3] = MGN_VHT1SS_MCS7;
|
|
for ( i = 0; i < 4; ++ i )
|
|
{
|
|
PwrByRateVal[i] = ( s8 ) ( ( ( ( Value >> (i * 8 + 4) ) & 0xF ) ) * 10 +
|
|
( ( Value >> (i * 8) ) & 0xF ) );
|
|
}
|
|
*RateNum = 4;
|
|
break;
|
|
|
|
case 0xC44:
|
|
case 0xE44:
|
|
case 0x1844:
|
|
case 0x1a44:
|
|
Rate[0] = MGN_VHT1SS_MCS8;
|
|
Rate[1] = MGN_VHT1SS_MCS9;
|
|
Rate[2] = MGN_VHT2SS_MCS0;
|
|
Rate[3] = MGN_VHT2SS_MCS1;
|
|
for ( i = 0; i < 4; ++ i )
|
|
{
|
|
PwrByRateVal[i] = ( s8 ) ( ( ( ( Value >> (i * 8 + 4) ) & 0xF ) ) * 10 +
|
|
( ( Value >> (i * 8) ) & 0xF ) );
|
|
}
|
|
*RateNum = 4;
|
|
break;
|
|
|
|
case 0xC48:
|
|
case 0xE48:
|
|
case 0x1848:
|
|
case 0x1a48:
|
|
Rate[0] = MGN_VHT2SS_MCS2;
|
|
Rate[1] = MGN_VHT2SS_MCS3;
|
|
Rate[2] = MGN_VHT2SS_MCS4;
|
|
Rate[3] = MGN_VHT2SS_MCS5;
|
|
for ( i = 0; i < 4; ++ i )
|
|
{
|
|
PwrByRateVal[i] = ( s8 ) ( ( ( ( Value >> (i * 8 + 4) ) & 0xF ) ) * 10 +
|
|
( ( Value >> (i * 8) ) & 0xF ) );
|
|
}
|
|
*RateNum = 4;
|
|
break;
|
|
|
|
case 0xC4C:
|
|
case 0xE4C:
|
|
case 0x184C:
|
|
case 0x1a4C:
|
|
Rate[0] = MGN_VHT2SS_MCS6;
|
|
Rate[1] = MGN_VHT2SS_MCS7;
|
|
Rate[2] = MGN_VHT2SS_MCS8;
|
|
Rate[3] = MGN_VHT2SS_MCS9;
|
|
for ( i = 0; i < 4; ++ i )
|
|
{
|
|
PwrByRateVal[i] = ( s8 ) ( ( ( ( Value >> (i * 8 + 4) ) & 0xF ) ) * 10 +
|
|
( ( Value >> (i * 8) ) & 0xF ) );
|
|
}
|
|
*RateNum = 4;
|
|
break;
|
|
|
|
case 0xCD8:
|
|
case 0xED8:
|
|
case 0x18D8:
|
|
case 0x1aD8:
|
|
Rate[0] = MGN_MCS16;
|
|
Rate[1] = MGN_MCS17;
|
|
Rate[2] = MGN_MCS18;
|
|
Rate[3] = MGN_MCS19;
|
|
for ( i = 0; i < 4; ++ i )
|
|
{
|
|
PwrByRateVal[i] = ( s8 ) ( ( ( ( Value >> (i * 8 + 4) ) & 0xF ) ) * 10 +
|
|
( ( Value >> (i * 8) ) & 0xF ) );
|
|
}
|
|
*RateNum = 4;
|
|
break;
|
|
|
|
case 0xCDC:
|
|
case 0xEDC:
|
|
case 0x18DC:
|
|
case 0x1aDC:
|
|
Rate[0] = MGN_MCS20;
|
|
Rate[1] = MGN_MCS21;
|
|
Rate[2] = MGN_MCS22;
|
|
Rate[3] = MGN_MCS23;
|
|
for ( i = 0; i < 4; ++ i )
|
|
{
|
|
PwrByRateVal[i] = ( s8 ) ( ( ( ( Value >> (i * 8 + 4) ) & 0xF ) ) * 10 +
|
|
( ( Value >> (i * 8) ) & 0xF ) );
|
|
}
|
|
*RateNum = 4;
|
|
break;
|
|
|
|
case 0xCE0:
|
|
case 0xEE0:
|
|
case 0x18E0:
|
|
case 0x1aE0:
|
|
Rate[0] = MGN_VHT3SS_MCS0;
|
|
Rate[1] = MGN_VHT3SS_MCS1;
|
|
Rate[2] = MGN_VHT3SS_MCS2;
|
|
Rate[3] = MGN_VHT3SS_MCS3;
|
|
for ( i = 0; i < 4; ++ i )
|
|
{
|
|
PwrByRateVal[i] = ( s8 ) ( ( ( ( Value >> (i * 8 + 4) ) & 0xF ) ) * 10 +
|
|
( ( Value >> (i * 8) ) & 0xF ) );
|
|
}
|
|
*RateNum = 4;
|
|
break;
|
|
|
|
case 0xCE4:
|
|
case 0xEE4:
|
|
case 0x18E4:
|
|
case 0x1aE4:
|
|
Rate[0] = MGN_VHT3SS_MCS4;
|
|
Rate[1] = MGN_VHT3SS_MCS5;
|
|
Rate[2] = MGN_VHT3SS_MCS6;
|
|
Rate[3] = MGN_VHT3SS_MCS7;
|
|
for ( i = 0; i < 4; ++ i )
|
|
{
|
|
PwrByRateVal[i] = ( s8 ) ( ( ( ( Value >> (i * 8 + 4) ) & 0xF ) ) * 10 +
|
|
( ( Value >> (i * 8) ) & 0xF ) );
|
|
}
|
|
*RateNum = 4;
|
|
break;
|
|
|
|
case 0xCE8:
|
|
case 0xEE8:
|
|
case 0x18E8:
|
|
case 0x1aE8:
|
|
Rate[0] = MGN_VHT3SS_MCS8;
|
|
Rate[1] = MGN_VHT3SS_MCS9;
|
|
for ( i = 0; i < 2; ++ i )
|
|
{
|
|
PwrByRateVal[i] = ( s8 ) ( ( ( ( Value >> (i * 8 + 4) ) & 0xF ) ) * 10 +
|
|
( ( Value >> (i * 8) ) & 0xF ) );
|
|
}
|
|
*RateNum = 2;
|
|
break;
|
|
|
|
default:
|
|
DBG_871X_LEVEL(_drv_always_, "Invalid RegAddr 0x%x in %s()\n", RegAddr, __func__);
|
|
break;
|
|
};
|
|
}
|
|
|
|
void
|
|
PHY_StoreTxPowerByRateNew(
|
|
IN PADAPTER pAdapter,
|
|
IN u32 Band,
|
|
IN u32 RfPath,
|
|
IN u32 TxNum,
|
|
IN u32 RegAddr,
|
|
IN u32 BitMask,
|
|
IN u32 Data
|
|
)
|
|
{
|
|
HAL_DATA_TYPE *pHalData = GET_HAL_DATA(pAdapter);
|
|
u8 i = 0, rates[4] = {0}, rateNum = 0;
|
|
s8 PwrByRateVal[4] = {0};
|
|
|
|
PHY_GetRateValuesOfTxPowerByRate(pAdapter, RegAddr, BitMask, Data, rates, PwrByRateVal, &rateNum);
|
|
|
|
if (Band != BAND_ON_2_4G && Band != BAND_ON_5G) {
|
|
DBG_871X_LEVEL(_drv_always_, "Invalid Band %d\n", Band);
|
|
return;
|
|
}
|
|
|
|
if (RfPath > ODM_RF_PATH_D) {
|
|
DBG_871X_LEVEL(_drv_always_, "Invalid RfPath %d\n", RfPath);
|
|
return;
|
|
}
|
|
|
|
if (TxNum > ODM_RF_PATH_D) {
|
|
DBG_871X_LEVEL(_drv_always_, "Invalid TxNum %d\n", TxNum);
|
|
return;
|
|
}
|
|
|
|
for (i = 0; i < rateNum; ++i) {
|
|
u8 rate_idx = PHY_GetRateIndexOfTxPowerByRate(rates[i]);
|
|
|
|
if (IS_1T_RATE(rates[i]))
|
|
pHalData->TxPwrByRateOffset[Band][RfPath][RF_1TX][rate_idx] = PwrByRateVal[i];
|
|
else if (IS_2T_RATE(rates[i]))
|
|
pHalData->TxPwrByRateOffset[Band][RfPath][RF_2TX][rate_idx] = PwrByRateVal[i];
|
|
else if (IS_3T_RATE(rates[i]))
|
|
pHalData->TxPwrByRateOffset[Band][RfPath][RF_3TX][rate_idx] = PwrByRateVal[i];
|
|
else if (IS_4T_RATE(rates[i]))
|
|
pHalData->TxPwrByRateOffset[Band][RfPath][RF_4TX][rate_idx] = PwrByRateVal[i];
|
|
else
|
|
rtw_warn_on(1);
|
|
}
|
|
}
|
|
|
|
void
|
|
PHY_StoreTxPowerByRateOld(
|
|
IN PADAPTER pAdapter,
|
|
IN u32 RegAddr,
|
|
IN u32 BitMask,
|
|
IN u32 Data
|
|
)
|
|
{
|
|
HAL_DATA_TYPE *pHalData = GET_HAL_DATA(pAdapter);
|
|
u8 index = PHY_GetRateSectionIndexOfTxPowerByRate( pAdapter, RegAddr, BitMask );
|
|
|
|
pHalData->MCSTxPowerLevelOriginalOffset[pHalData->pwrGroupCnt][index] = Data;
|
|
//DBG_871X("MCSTxPowerLevelOriginalOffset[%d][0] = 0x%x\n", pHalData->pwrGroupCnt,
|
|
// pHalData->MCSTxPowerLevelOriginalOffset[pHalData->pwrGroupCnt][0]);
|
|
}
|
|
|
|
VOID
|
|
PHY_InitTxPowerByRate(
|
|
IN PADAPTER pAdapter
|
|
)
|
|
{
|
|
HAL_DATA_TYPE *pHalData = GET_HAL_DATA(pAdapter);
|
|
u8 band = 0, rfPath = 0, TxNum = 0, rate = 0, i = 0, j = 0;
|
|
|
|
if ( IS_HARDWARE_TYPE_8188E( pAdapter ) )
|
|
{
|
|
for ( i = 0; i < MAX_PG_GROUP; ++i )
|
|
for ( j = 0; j < 16; ++j )
|
|
pHalData->MCSTxPowerLevelOriginalOffset[i][j] = 0;
|
|
}
|
|
else
|
|
{
|
|
for ( band = BAND_ON_2_4G; band <= BAND_ON_5G; ++band )
|
|
for ( rfPath = 0; rfPath < TX_PWR_BY_RATE_NUM_RF; ++rfPath )
|
|
for ( TxNum = 0; TxNum < TX_PWR_BY_RATE_NUM_RF; ++TxNum )
|
|
for ( rate = 0; rate < TX_PWR_BY_RATE_NUM_RATE; ++rate )
|
|
pHalData->TxPwrByRateOffset[band][rfPath][TxNum][rate] = 0;
|
|
}
|
|
}
|
|
|
|
VOID
|
|
PHY_StoreTxPowerByRate(
|
|
IN PADAPTER pAdapter,
|
|
IN u32 Band,
|
|
IN u32 RfPath,
|
|
IN u32 TxNum,
|
|
IN u32 RegAddr,
|
|
IN u32 BitMask,
|
|
IN u32 Data
|
|
)
|
|
{
|
|
HAL_DATA_TYPE *pHalData = GET_HAL_DATA(pAdapter);
|
|
PDM_ODM_T pDM_Odm = &pHalData->odmpriv;
|
|
|
|
if ( pDM_Odm->PhyRegPgVersion > 0 )
|
|
{
|
|
PHY_StoreTxPowerByRateNew( pAdapter, Band, RfPath, TxNum, RegAddr, BitMask, Data );
|
|
}
|
|
else if ( pDM_Odm->PhyRegPgVersion == 0 )
|
|
{
|
|
PHY_StoreTxPowerByRateOld( pAdapter, RegAddr, BitMask, Data );
|
|
|
|
if ( RegAddr == rTxAGC_A_Mcs15_Mcs12 && pHalData->rf_type == RF_1T1R )
|
|
pHalData->pwrGroupCnt++;
|
|
else if ( RegAddr == rTxAGC_B_Mcs15_Mcs12 && pHalData->rf_type != RF_1T1R )
|
|
pHalData->pwrGroupCnt++;
|
|
}
|
|
else
|
|
DBG_871X("Invalid PHY_REG_PG.txt version %d\n", pDM_Odm->PhyRegPgVersion );
|
|
|
|
}
|
|
|
|
VOID
|
|
phy_ConvertTxPowerByRateByBase(
|
|
IN u32* pData,
|
|
IN u8 Start,
|
|
IN u8 End,
|
|
IN u8 BaseValue
|
|
)
|
|
{
|
|
s8 i = 0;
|
|
u8 TempValue = 0;
|
|
u32 TempData = 0;
|
|
|
|
for ( i = 3; i >= 0; --i )
|
|
{
|
|
if ( i >= Start && i <= End )
|
|
{
|
|
// Get the exact value
|
|
TempValue = ( u8 ) ( *pData >> ( i * 8 ) ) & 0xF;
|
|
TempValue += ( ( u8 ) ( ( *pData >> ( i * 8 + 4 ) ) & 0xF ) ) * 10;
|
|
|
|
// Change the value to a relative value
|
|
TempValue = ( TempValue > BaseValue ) ? TempValue - BaseValue : BaseValue - TempValue;
|
|
}
|
|
else
|
|
{
|
|
TempValue = ( u8 ) ( *pData >> ( i * 8 ) ) & 0xFF;
|
|
}
|
|
|
|
TempData <<= 8;
|
|
TempData |= TempValue;
|
|
}
|
|
|
|
*pData = TempData;
|
|
}
|
|
|
|
|
|
VOID
|
|
PHY_ConvertTxPowerByRateInDbmToRelativeValuesOld(
|
|
IN PADAPTER pAdapter
|
|
)
|
|
{
|
|
HAL_DATA_TYPE *pHalData = GET_HAL_DATA( pAdapter );
|
|
u8 base = 0;
|
|
|
|
//DBG_871X("===>PHY_ConvertTxPowerByRateInDbmToRelativeValuesOld()\n" );
|
|
|
|
// CCK
|
|
base = PHY_GetTxPowerByRateBase( pAdapter, BAND_ON_2_4G, ODM_RF_PATH_A, RF_1TX, CCK );
|
|
phy_ConvertTxPowerByRateByBase(
|
|
&( pHalData->MCSTxPowerLevelOriginalOffset[0][6] ), 1, 1, base );
|
|
phy_ConvertTxPowerByRateByBase(
|
|
&( pHalData->MCSTxPowerLevelOriginalOffset[0][7] ), 1, 3, base );
|
|
|
|
// OFDM
|
|
base = PHY_GetTxPowerByRateBase( pAdapter, BAND_ON_2_4G, ODM_RF_PATH_A, RF_1TX, OFDM );
|
|
phy_ConvertTxPowerByRateByBase(
|
|
&( pHalData->MCSTxPowerLevelOriginalOffset[0][0] ), 0, 3, base );
|
|
phy_ConvertTxPowerByRateByBase(
|
|
&( pHalData->MCSTxPowerLevelOriginalOffset[0][1] ), 0, 3, base );
|
|
|
|
// HT MCS0~7
|
|
base = PHY_GetTxPowerByRateBase( pAdapter, BAND_ON_2_4G, ODM_RF_PATH_A, RF_1TX, HT_MCS0_MCS7 );
|
|
phy_ConvertTxPowerByRateByBase(
|
|
&( pHalData->MCSTxPowerLevelOriginalOffset[0][2] ), 0, 3, base );
|
|
phy_ConvertTxPowerByRateByBase(
|
|
&( pHalData->MCSTxPowerLevelOriginalOffset[0][3] ), 0, 3, base );
|
|
|
|
// HT MCS8~15
|
|
base = PHY_GetTxPowerByRateBase( pAdapter, BAND_ON_2_4G, ODM_RF_PATH_A, RF_2TX, HT_MCS8_MCS15 );
|
|
phy_ConvertTxPowerByRateByBase(
|
|
&( pHalData->MCSTxPowerLevelOriginalOffset[0][4] ), 0, 3, base );
|
|
phy_ConvertTxPowerByRateByBase(
|
|
&( pHalData->MCSTxPowerLevelOriginalOffset[0][5] ), 0, 3, base );
|
|
|
|
// CCK
|
|
base = PHY_GetTxPowerByRateBase( pAdapter, BAND_ON_2_4G, ODM_RF_PATH_B, RF_1TX, CCK );
|
|
phy_ConvertTxPowerByRateByBase(
|
|
&( pHalData->MCSTxPowerLevelOriginalOffset[0][14] ), 1, 3, base );
|
|
phy_ConvertTxPowerByRateByBase(
|
|
&( pHalData->MCSTxPowerLevelOriginalOffset[0][15] ), 0, 0, base );
|
|
|
|
// OFDM
|
|
base = PHY_GetTxPowerByRateBase( pAdapter, BAND_ON_2_4G, ODM_RF_PATH_B, RF_1TX, OFDM );
|
|
phy_ConvertTxPowerByRateByBase(
|
|
&( pHalData->MCSTxPowerLevelOriginalOffset[0][8] ), 0, 3, base );
|
|
phy_ConvertTxPowerByRateByBase(
|
|
&( pHalData->MCSTxPowerLevelOriginalOffset[0][9] ), 0, 3, base );
|
|
|
|
// HT MCS0~7
|
|
base = PHY_GetTxPowerByRateBase( pAdapter, BAND_ON_2_4G, ODM_RF_PATH_B, RF_1TX, HT_MCS0_MCS7 );
|
|
phy_ConvertTxPowerByRateByBase(
|
|
&( pHalData->MCSTxPowerLevelOriginalOffset[0][10] ), 0, 3, base );
|
|
phy_ConvertTxPowerByRateByBase(
|
|
&( pHalData->MCSTxPowerLevelOriginalOffset[0][11] ), 0, 3, base );
|
|
|
|
// HT MCS8~15
|
|
base = PHY_GetTxPowerByRateBase( pAdapter, BAND_ON_2_4G, ODM_RF_PATH_B, RF_2TX, HT_MCS8_MCS15 );
|
|
phy_ConvertTxPowerByRateByBase(
|
|
&( pHalData->MCSTxPowerLevelOriginalOffset[0][12] ), 0, 3, base );
|
|
phy_ConvertTxPowerByRateByBase(
|
|
&( pHalData->MCSTxPowerLevelOriginalOffset[0][13] ), 0, 3, base );
|
|
|
|
//DBG_871X("<===PHY_ConvertTxPowerByRateInDbmToRelativeValuesOld()\n" );
|
|
}
|
|
|
|
VOID
|
|
phy_ConvertTxPowerByRateInDbmToRelativeValues(
|
|
IN PADAPTER pAdapter
|
|
)
|
|
{
|
|
HAL_DATA_TYPE *pHalData = GET_HAL_DATA( pAdapter );
|
|
u8 base = 0, i = 0, value = 0,
|
|
band = 0, path = 0, txNum = 0, index = 0,
|
|
startIndex = 0, endIndex = 0;
|
|
u8 cckRates[4] = {MGN_1M, MGN_2M, MGN_5_5M, MGN_11M},
|
|
ofdmRates[8] = {MGN_6M, MGN_9M, MGN_12M, MGN_18M, MGN_24M, MGN_36M, MGN_48M, MGN_54M},
|
|
mcs0_7Rates[8] = {MGN_MCS0, MGN_MCS1, MGN_MCS2, MGN_MCS3, MGN_MCS4, MGN_MCS5, MGN_MCS6, MGN_MCS7},
|
|
mcs8_15Rates[8] = {MGN_MCS8, MGN_MCS9, MGN_MCS10, MGN_MCS11, MGN_MCS12, MGN_MCS13, MGN_MCS14, MGN_MCS15},
|
|
mcs16_23Rates[8] = {MGN_MCS16, MGN_MCS17, MGN_MCS18, MGN_MCS19, MGN_MCS20, MGN_MCS21, MGN_MCS22, MGN_MCS23},
|
|
vht1ssRates[10] = {MGN_VHT1SS_MCS0, MGN_VHT1SS_MCS1, MGN_VHT1SS_MCS2, MGN_VHT1SS_MCS3, MGN_VHT1SS_MCS4,
|
|
MGN_VHT1SS_MCS5, MGN_VHT1SS_MCS6, MGN_VHT1SS_MCS7, MGN_VHT1SS_MCS8, MGN_VHT1SS_MCS9},
|
|
vht2ssRates[10] = {MGN_VHT2SS_MCS0, MGN_VHT2SS_MCS1, MGN_VHT2SS_MCS2, MGN_VHT2SS_MCS3, MGN_VHT2SS_MCS4,
|
|
MGN_VHT2SS_MCS5, MGN_VHT2SS_MCS6, MGN_VHT2SS_MCS7, MGN_VHT2SS_MCS8, MGN_VHT2SS_MCS9},
|
|
vht3ssRates[10] = {MGN_VHT3SS_MCS0, MGN_VHT3SS_MCS1, MGN_VHT3SS_MCS2, MGN_VHT3SS_MCS3, MGN_VHT3SS_MCS4,
|
|
MGN_VHT3SS_MCS5, MGN_VHT3SS_MCS6, MGN_VHT3SS_MCS7, MGN_VHT3SS_MCS8, MGN_VHT3SS_MCS9};
|
|
|
|
//DBG_871X("===>PHY_ConvertTxPowerByRateInDbmToRelativeValues()\n" );
|
|
|
|
for ( band = BAND_ON_2_4G; band <= BAND_ON_5G; ++band )
|
|
{
|
|
for ( path = ODM_RF_PATH_A; path <= ODM_RF_PATH_D; ++path )
|
|
{
|
|
for ( txNum = RF_1TX; txNum < RF_MAX_TX_NUM; ++txNum )
|
|
{
|
|
// CCK
|
|
base = PHY_GetTxPowerByRate( pAdapter, band, path, txNum, MGN_11M );
|
|
for ( i = 0; i < sizeof( cckRates ); ++i )
|
|
{
|
|
value = PHY_GetTxPowerByRate( pAdapter, band, path, txNum, cckRates[i] );
|
|
PHY_SetTxPowerByRate( pAdapter, band, path, txNum, cckRates[i], value - base );
|
|
}
|
|
|
|
// OFDM
|
|
base = PHY_GetTxPowerByRate( pAdapter, band, path, txNum, MGN_54M );
|
|
for ( i = 0; i < sizeof( ofdmRates ); ++i )
|
|
{
|
|
value = PHY_GetTxPowerByRate( pAdapter, band, path, txNum, ofdmRates[i] );
|
|
PHY_SetTxPowerByRate( pAdapter, band, path, txNum, ofdmRates[i], value - base );
|
|
}
|
|
|
|
// HT MCS0~7
|
|
base = PHY_GetTxPowerByRate( pAdapter, band, path, txNum, MGN_MCS7 );
|
|
for ( i = 0; i < sizeof( mcs0_7Rates ); ++i )
|
|
{
|
|
value = PHY_GetTxPowerByRate( pAdapter, band, path, txNum, mcs0_7Rates[i] );
|
|
PHY_SetTxPowerByRate( pAdapter, band, path, txNum, mcs0_7Rates[i], value - base );
|
|
}
|
|
|
|
// HT MCS8~15
|
|
base = PHY_GetTxPowerByRate( pAdapter, band, path, txNum, MGN_MCS15 );
|
|
for ( i = 0; i < sizeof( mcs8_15Rates ); ++i )
|
|
{
|
|
value = PHY_GetTxPowerByRate( pAdapter, band, path, txNum, mcs8_15Rates[i] );
|
|
PHY_SetTxPowerByRate( pAdapter, band, path, txNum, mcs8_15Rates[i], value - base );
|
|
}
|
|
|
|
// HT MCS16~23
|
|
base = PHY_GetTxPowerByRate( pAdapter, band, path, txNum, MGN_MCS23 );
|
|
for ( i = 0; i < sizeof( mcs16_23Rates ); ++i )
|
|
{
|
|
value = PHY_GetTxPowerByRate( pAdapter, band, path, txNum, mcs16_23Rates[i] );
|
|
PHY_SetTxPowerByRate( pAdapter, band, path, txNum, mcs16_23Rates[i], value - base );
|
|
}
|
|
|
|
// VHT 1SS
|
|
base = PHY_GetTxPowerByRate( pAdapter, band, path, txNum, MGN_VHT1SS_MCS7 );
|
|
for ( i = 0; i < sizeof( vht1ssRates ); ++i )
|
|
{
|
|
value = PHY_GetTxPowerByRate( pAdapter, band, path, txNum, vht1ssRates[i] );
|
|
PHY_SetTxPowerByRate( pAdapter, band, path, txNum, vht1ssRates[i], value - base );
|
|
}
|
|
|
|
// VHT 2SS
|
|
base = PHY_GetTxPowerByRate( pAdapter, band, path, txNum, MGN_VHT2SS_MCS7 );
|
|
for ( i = 0; i < sizeof( vht2ssRates ); ++i )
|
|
{
|
|
value = PHY_GetTxPowerByRate( pAdapter, band, path, txNum, vht2ssRates[i] );
|
|
PHY_SetTxPowerByRate( pAdapter, band, path, txNum, vht2ssRates[i], value - base );
|
|
}
|
|
|
|
// VHT 3SS
|
|
base = PHY_GetTxPowerByRate( pAdapter, band, path, txNum, MGN_VHT3SS_MCS7 );
|
|
for ( i = 0; i < sizeof( vht3ssRates ); ++i )
|
|
{
|
|
value = PHY_GetTxPowerByRate( pAdapter, band, path, txNum, vht3ssRates[i] );
|
|
PHY_SetTxPowerByRate( pAdapter, band, path, txNum, vht3ssRates[i], value - base );
|
|
}
|
|
}
|
|
}
|
|
}
|
|
|
|
//DBG_871X("<===PHY_ConvertTxPowerByRateInDbmToRelativeValues()\n" );
|
|
}
|
|
|
|
/*
|
|
* This function must be called if the value in the PHY_REG_PG.txt(or header)
|
|
* is exact dBm values
|
|
*/
|
|
VOID
|
|
PHY_TxPowerByRateConfiguration(
|
|
IN PADAPTER pAdapter
|
|
)
|
|
{
|
|
HAL_DATA_TYPE *pHalData = GET_HAL_DATA( pAdapter);
|
|
|
|
phy_StoreTxPowerByRateBase( pAdapter );
|
|
phy_ConvertTxPowerByRateInDbmToRelativeValues( pAdapter );
|
|
}
|
|
|
|
VOID
|
|
PHY_SetTxPowerIndexByRateSection(
|
|
IN PADAPTER pAdapter,
|
|
IN u8 RFPath,
|
|
IN u8 Channel,
|
|
IN u8 RateSection
|
|
)
|
|
{
|
|
PHAL_DATA_TYPE pHalData = GET_HAL_DATA(pAdapter);
|
|
|
|
if ( RateSection == CCK )
|
|
{
|
|
u8 cckRates[] = {MGN_1M, MGN_2M, MGN_5_5M, MGN_11M};
|
|
if ( pHalData->CurrentBandType == BAND_ON_2_4G )
|
|
PHY_SetTxPowerIndexByRateArray( pAdapter, RFPath, pHalData->CurrentChannelBW, Channel,
|
|
cckRates, sizeof(cckRates)/sizeof(u8) );
|
|
|
|
}
|
|
else if ( RateSection == OFDM )
|
|
{
|
|
u8 ofdmRates[] = {MGN_6M, MGN_9M, MGN_12M, MGN_18M, MGN_24M, MGN_36M, MGN_48M, MGN_54M};
|
|
PHY_SetTxPowerIndexByRateArray( pAdapter, RFPath, pHalData->CurrentChannelBW, Channel,
|
|
ofdmRates, sizeof(ofdmRates)/sizeof(u8));
|
|
|
|
}
|
|
else if ( RateSection == HT_MCS0_MCS7 )
|
|
{
|
|
u8 htRates1T[] = {MGN_MCS0, MGN_MCS1, MGN_MCS2, MGN_MCS3, MGN_MCS4, MGN_MCS5, MGN_MCS6, MGN_MCS7};
|
|
PHY_SetTxPowerIndexByRateArray( pAdapter, RFPath, pHalData->CurrentChannelBW, Channel,
|
|
htRates1T, sizeof(htRates1T)/sizeof(u8));
|
|
|
|
}
|
|
else if ( RateSection == HT_MCS8_MCS15 )
|
|
{
|
|
u8 htRates2T[] = {MGN_MCS8, MGN_MCS9, MGN_MCS10, MGN_MCS11, MGN_MCS12, MGN_MCS13, MGN_MCS14, MGN_MCS15};
|
|
PHY_SetTxPowerIndexByRateArray( pAdapter, RFPath, pHalData->CurrentChannelBW, Channel,
|
|
htRates2T, sizeof(htRates2T)/sizeof(u8));
|
|
|
|
}
|
|
else if ( RateSection == HT_MCS16_MCS23 )
|
|
{
|
|
u1Byte htRates3T[] = {MGN_MCS16, MGN_MCS17, MGN_MCS18, MGN_MCS19, MGN_MCS20, MGN_MCS21, MGN_MCS22, MGN_MCS23};
|
|
PHY_SetTxPowerIndexByRateArray( pAdapter, RFPath, pHalData->CurrentChannelBW, Channel,
|
|
htRates3T, sizeof(htRates3T)/sizeof(u1Byte));
|
|
|
|
}
|
|
else if ( RateSection == HT_MCS24_MCS31 )
|
|
{
|
|
u1Byte htRates4T[] = {MGN_MCS24, MGN_MCS25, MGN_MCS26, MGN_MCS27, MGN_MCS28, MGN_MCS29, MGN_MCS30, MGN_MCS31};
|
|
PHY_SetTxPowerIndexByRateArray( pAdapter, RFPath, pHalData->CurrentChannelBW, Channel,
|
|
htRates4T, sizeof(htRates4T)/sizeof(u1Byte));
|
|
|
|
}
|
|
else if ( RateSection == VHT_1SSMCS0_1SSMCS9 )
|
|
{
|
|
u8 vhtRates1T[] = {MGN_VHT1SS_MCS0, MGN_VHT1SS_MCS1, MGN_VHT1SS_MCS2, MGN_VHT1SS_MCS3, MGN_VHT1SS_MCS4,
|
|
MGN_VHT1SS_MCS5, MGN_VHT1SS_MCS6, MGN_VHT1SS_MCS7, MGN_VHT1SS_MCS8, MGN_VHT1SS_MCS9};
|
|
PHY_SetTxPowerIndexByRateArray( pAdapter, RFPath, pHalData->CurrentChannelBW, Channel,
|
|
vhtRates1T, sizeof(vhtRates1T)/sizeof(u8));
|
|
|
|
}
|
|
else if ( RateSection == VHT_2SSMCS0_2SSMCS9 )
|
|
{
|
|
u8 vhtRates2T[] = {MGN_VHT2SS_MCS0, MGN_VHT2SS_MCS1, MGN_VHT2SS_MCS2, MGN_VHT2SS_MCS3, MGN_VHT2SS_MCS4,
|
|
MGN_VHT2SS_MCS5, MGN_VHT2SS_MCS6, MGN_VHT2SS_MCS7, MGN_VHT2SS_MCS8, MGN_VHT2SS_MCS9};
|
|
|
|
PHY_SetTxPowerIndexByRateArray( pAdapter, RFPath, pHalData->CurrentChannelBW, Channel,
|
|
vhtRates2T, sizeof(vhtRates2T)/sizeof(u8));
|
|
}
|
|
else if ( RateSection == VHT_3SSMCS0_3SSMCS9 )
|
|
{
|
|
u1Byte vhtRates3T[] = {MGN_VHT3SS_MCS0, MGN_VHT3SS_MCS1, MGN_VHT3SS_MCS2, MGN_VHT3SS_MCS3, MGN_VHT3SS_MCS4,
|
|
MGN_VHT3SS_MCS5, MGN_VHT3SS_MCS6, MGN_VHT3SS_MCS7, MGN_VHT3SS_MCS8, MGN_VHT3SS_MCS9};
|
|
|
|
PHY_SetTxPowerIndexByRateArray( pAdapter, RFPath, pHalData->CurrentChannelBW, Channel,
|
|
vhtRates3T, sizeof(vhtRates3T)/sizeof(u1Byte));
|
|
}
|
|
else if ( RateSection == VHT_4SSMCS0_4SSMCS9 )
|
|
{
|
|
u1Byte vhtRates4T[] = {MGN_VHT4SS_MCS0, MGN_VHT4SS_MCS1, MGN_VHT4SS_MCS2, MGN_VHT4SS_MCS3, MGN_VHT4SS_MCS4,
|
|
MGN_VHT4SS_MCS5, MGN_VHT4SS_MCS6, MGN_VHT4SS_MCS7, MGN_VHT4SS_MCS8, MGN_VHT4SS_MCS9};
|
|
|
|
PHY_SetTxPowerIndexByRateArray( pAdapter, RFPath, pHalData->CurrentChannelBW, Channel,
|
|
vhtRates4T, sizeof(vhtRates4T)/sizeof(u1Byte));
|
|
}
|
|
else
|
|
{
|
|
DBG_871X("Invalid RateSection %d in %s", RateSection, __FUNCTION__ );
|
|
}
|
|
}
|
|
|
|
BOOLEAN
|
|
phy_GetChnlIndex(
|
|
IN u8 Channel,
|
|
OUT u8* ChannelIdx
|
|
)
|
|
{
|
|
u8 i = 0;
|
|
BOOLEAN bIn24G=_TRUE;
|
|
|
|
if (Channel <= 14) {
|
|
bIn24G = _TRUE;
|
|
*ChannelIdx = Channel - 1;
|
|
} else {
|
|
bIn24G = _FALSE;
|
|
|
|
for (i = 0; i < CENTER_CH_5G_ALL_NUM; ++i) {
|
|
if (center_ch_5g_all[i] == Channel) {
|
|
*ChannelIdx = i;
|
|
return bIn24G;
|
|
}
|
|
}
|
|
}
|
|
|
|
return bIn24G;
|
|
}
|
|
|
|
u8
|
|
PHY_GetTxPowerIndexBase(
|
|
IN PADAPTER pAdapter,
|
|
IN u8 RFPath,
|
|
IN u8 Rate,
|
|
IN CHANNEL_WIDTH BandWidth,
|
|
IN u8 Channel,
|
|
OUT PBOOLEAN bIn24G
|
|
)
|
|
{
|
|
PHAL_DATA_TYPE pHalData = GET_HAL_DATA(pAdapter);
|
|
PDM_ODM_T pDM_Odm = &pHalData->odmpriv;
|
|
u8 i = 0; //default set to 1S
|
|
u8 txPower = 0;
|
|
u8 chnlIdx = (Channel-1);
|
|
|
|
if (HAL_IsLegalChannel(pAdapter, Channel) == _FALSE)
|
|
{
|
|
chnlIdx = 0;
|
|
DBG_871X("Illegal channel!!\n");
|
|
}
|
|
|
|
*bIn24G = phy_GetChnlIndex(Channel, &chnlIdx);
|
|
|
|
//DBG_871X("[%s] Channel Index: %d\n", (*bIn24G?"2.4G":"5G"), chnlIdx);
|
|
|
|
if (*bIn24G) //3 ============================== 2.4 G ==============================
|
|
{
|
|
if ( IS_CCK_RATE(Rate) )
|
|
{
|
|
txPower = pHalData->Index24G_CCK_Base[RFPath][chnlIdx];
|
|
}
|
|
else if ( MGN_6M <= Rate )
|
|
{
|
|
txPower = pHalData->Index24G_BW40_Base[RFPath][chnlIdx];
|
|
}
|
|
else
|
|
{
|
|
DBG_871X("PHY_GetTxPowerIndexBase: INVALID Rate.\n");
|
|
}
|
|
|
|
//DBG_871X("Base Tx power(RF-%c, Rate #%d, Channel Index %d) = 0x%X\n",
|
|
// ((RFPath==0)?'A':'B'), Rate, chnlIdx, txPower);
|
|
|
|
// OFDM-1T
|
|
if ( (MGN_6M <= Rate && Rate <= MGN_54M) && ! IS_CCK_RATE(Rate) )
|
|
{
|
|
txPower += pHalData->OFDM_24G_Diff[RFPath][TX_1S];
|
|
//DBG_871X("+PowerDiff 2.4G (RF-%c): (OFDM-1T) = (%d)\n", ((RFPath==0)?'A':'B'), pHalData->OFDM_24G_Diff[RFPath][TX_1S]);
|
|
}
|
|
// BW20-1S, BW20-2S
|
|
if (BandWidth == CHANNEL_WIDTH_20)
|
|
{
|
|
if ( (MGN_MCS0 <= Rate && Rate <= MGN_MCS31) || (MGN_VHT1SS_MCS0 <= Rate && Rate <= MGN_VHT4SS_MCS9))
|
|
txPower += pHalData->BW20_24G_Diff[RFPath][TX_1S];
|
|
if ( (MGN_MCS8 <= Rate && Rate <= MGN_MCS31) || (MGN_VHT2SS_MCS0 <= Rate && Rate <= MGN_VHT4SS_MCS9))
|
|
txPower += pHalData->BW20_24G_Diff[RFPath][TX_2S];
|
|
if ( (MGN_MCS16 <= Rate && Rate <= MGN_MCS31) || (MGN_VHT3SS_MCS0 <= Rate && Rate <= MGN_VHT4SS_MCS9))
|
|
txPower += pHalData->BW20_24G_Diff[RFPath][TX_3S];
|
|
if ( (MGN_MCS24 <= Rate && Rate <= MGN_MCS31) || (MGN_VHT4SS_MCS0 <= Rate && Rate <= MGN_VHT4SS_MCS9))
|
|
txPower += pHalData->BW20_24G_Diff[RFPath][TX_4S];
|
|
|
|
//DBG_871X("+PowerDiff 2.4G (RF-%c): (BW20-1S, BW20-2S, BW20-3S, BW20-4S) = (%d, %d, %d, %d)\n", ((RFPath==0)?'A':(RFPath==1)?'B':(RFPath==2)?'C':'D'),
|
|
// pHalData->BW20_24G_Diff[RFPath][TX_1S], pHalData->BW20_24G_Diff[RFPath][TX_2S],
|
|
// pHalData->BW20_24G_Diff[RFPath][TX_3S], pHalData->BW20_24G_Diff[RFPath][TX_4S]);
|
|
}
|
|
// BW40-1S, BW40-2S
|
|
else if (BandWidth == CHANNEL_WIDTH_40)
|
|
{
|
|
if ( (MGN_MCS0 <= Rate && Rate <= MGN_MCS31) || (MGN_VHT1SS_MCS0 <= Rate && Rate <= MGN_VHT4SS_MCS9))
|
|
txPower += pHalData->BW40_24G_Diff[RFPath][TX_1S];
|
|
if ( (MGN_MCS8 <= Rate && Rate <= MGN_MCS31) || (MGN_VHT2SS_MCS0 <= Rate && Rate <= MGN_VHT4SS_MCS9))
|
|
txPower += pHalData->BW40_24G_Diff[RFPath][TX_2S];
|
|
if ( (MGN_MCS16 <= Rate && Rate <= MGN_MCS31) || (MGN_VHT3SS_MCS0 <= Rate && Rate <= MGN_VHT4SS_MCS9))
|
|
txPower += pHalData->BW40_24G_Diff[RFPath][TX_3S];
|
|
if ( (MGN_MCS24 <= Rate && Rate <= MGN_MCS31) || (MGN_VHT4SS_MCS0 <= Rate && Rate <= MGN_VHT4SS_MCS9))
|
|
txPower += pHalData->BW40_24G_Diff[RFPath][TX_4S];
|
|
|
|
//DBG_871X("+PowerDiff 2.4G (RF-%c): (BW40-1S, BW40-2S, BW40-3S, BW40-4S) = (%d, %d, %d, %d)\n", ((RFPath==0)?'A':(RFPath==1)?'B':(RFPath==2)?'C':'D'),
|
|
// pHalData->BW40_24G_Diff[RFPath][TX_1S], pHalData->BW40_24G_Diff[RFPath][TX_2S],
|
|
// pHalData->BW40_24G_Diff[RFPath][TX_3S], pHalData->BW40_24G_Diff[RFPath][TX_4S]);
|
|
}
|
|
// Willis suggest adopt BW 40M power index while in BW 80 mode
|
|
else if ( BandWidth == CHANNEL_WIDTH_80 )
|
|
{
|
|
if ( (MGN_MCS0 <= Rate && Rate <= MGN_MCS31) || (MGN_VHT1SS_MCS0 <= Rate && Rate <= MGN_VHT4SS_MCS9))
|
|
txPower += pHalData->BW40_24G_Diff[RFPath][TX_1S];
|
|
if ( (MGN_MCS8 <= Rate && Rate <= MGN_MCS31) || (MGN_VHT2SS_MCS0 <= Rate && Rate <= MGN_VHT4SS_MCS9))
|
|
txPower += pHalData->BW40_24G_Diff[RFPath][TX_2S];
|
|
if ( (MGN_MCS16 <= Rate && Rate <= MGN_MCS31) || (MGN_VHT3SS_MCS0 <= Rate && Rate <= MGN_VHT4SS_MCS9))
|
|
txPower += pHalData->BW40_24G_Diff[RFPath][TX_3S];
|
|
if ( (MGN_MCS24 <= Rate && Rate <= MGN_MCS31) || (MGN_VHT4SS_MCS0 <= Rate && Rate <= MGN_VHT4SS_MCS9))
|
|
txPower += pHalData->BW40_24G_Diff[RFPath][TX_4S];
|
|
|
|
//DBG_871X("+PowerDiff 2.4G (RF-%c): (BW40-1S, BW40-2S, BW40-3S, BW40-4T) = (%d, %d, %d, %d) P.S. Current is in BW 80MHz\n", ((RFPath==0)?'A':(RFPath==1)?'B':(RFPath==2)?'C':'D'),
|
|
// pHalData->BW40_24G_Diff[RFPath][TX_1S], pHalData->BW40_24G_Diff[RFPath][TX_2S],
|
|
// pHalData->BW40_24G_Diff[RFPath][TX_3S], pHalData->BW40_24G_Diff[RFPath][TX_4S]);
|
|
}
|
|
}
|
|
else //3 ============================== 5 G ==============================
|
|
{
|
|
if ( MGN_6M <= Rate )
|
|
{
|
|
txPower = pHalData->Index5G_BW40_Base[RFPath][chnlIdx];
|
|
}
|
|
else
|
|
{
|
|
DBG_871X("===> mpt_ProQueryCalTxPower_Jaguar: INVALID Rate.\n");
|
|
}
|
|
|
|
//DBG_871X("Base Tx power(RF-%c, Rate #%d, Channel Index %d) = 0x%X\n",
|
|
// ((RFPath==0)?'A':'B'), Rate, chnlIdx, txPower);
|
|
|
|
// OFDM-1T
|
|
if ( (MGN_6M <= Rate && Rate <= MGN_54M) && ! IS_CCK_RATE(Rate))
|
|
{
|
|
txPower += pHalData->OFDM_5G_Diff[RFPath][TX_1S];
|
|
//DBG_871X("+PowerDiff 5G (RF-%c): (OFDM-1T) = (%d)\n", ((RFPath==0)?'A':'B'), pHalData->OFDM_5G_Diff[RFPath][TX_1S]);
|
|
}
|
|
|
|
// BW20-1S, BW20-2S
|
|
if (BandWidth == CHANNEL_WIDTH_20)
|
|
{
|
|
if ( (MGN_MCS0 <= Rate && Rate <= MGN_MCS31) || (MGN_VHT1SS_MCS0 <= Rate && Rate <= MGN_VHT4SS_MCS9))
|
|
txPower += pHalData->BW20_5G_Diff[RFPath][TX_1S];
|
|
if ( (MGN_MCS8 <= Rate && Rate <= MGN_MCS31) || (MGN_VHT2SS_MCS0 <= Rate && Rate <= MGN_VHT4SS_MCS9))
|
|
txPower += pHalData->BW20_5G_Diff[RFPath][TX_2S];
|
|
if ( (MGN_MCS16 <= Rate && Rate <= MGN_MCS31) || (MGN_VHT3SS_MCS0 <= Rate && Rate <= MGN_VHT4SS_MCS9))
|
|
txPower += pHalData->BW20_5G_Diff[RFPath][TX_3S];
|
|
if ( (MGN_MCS24 <= Rate && Rate <= MGN_MCS31) || (MGN_VHT4SS_MCS0 <= Rate && Rate <= MGN_VHT4SS_MCS9))
|
|
txPower += pHalData->BW20_5G_Diff[RFPath][TX_4S];
|
|
|
|
//DBG_871X("+PowerDiff 5G (RF-%c): (BW20-1S, BW20-2S, BW20-3S, BW20-4S) = (%d, %d, %d, %d)\n", ((RFPath==0)?'A':(RFPath==1)?'B':(RFPath==2)?'C':'D'),
|
|
// pHalData->BW20_5G_Diff[RFPath][TX_1S], pHalData->BW20_5G_Diff[RFPath][TX_2S],
|
|
// pHalData->BW20_5G_Diff[RFPath][TX_3S], pHalData->BW20_5G_Diff[RFPath][TX_4S]);
|
|
}
|
|
// BW40-1S, BW40-2S
|
|
else if (BandWidth == CHANNEL_WIDTH_40)
|
|
{
|
|
if ( (MGN_MCS0 <= Rate && Rate <= MGN_MCS31) || (MGN_VHT1SS_MCS0 <= Rate && Rate <= MGN_VHT4SS_MCS9))
|
|
txPower += pHalData->BW40_5G_Diff[RFPath][TX_1S];
|
|
if ( (MGN_MCS8 <= Rate && Rate <= MGN_MCS31) || (MGN_VHT2SS_MCS0 <= Rate && Rate <= MGN_VHT4SS_MCS9))
|
|
txPower += pHalData->BW40_5G_Diff[RFPath][TX_2S];
|
|
if ( (MGN_MCS16 <= Rate && Rate <= MGN_MCS31) || (MGN_VHT3SS_MCS0 <= Rate && Rate <= MGN_VHT4SS_MCS9))
|
|
txPower += pHalData->BW40_5G_Diff[RFPath][TX_3S];
|
|
if ( (MGN_MCS24 <= Rate && Rate <= MGN_MCS31) || (MGN_VHT4SS_MCS0 <= Rate && Rate <= MGN_VHT4SS_MCS9))
|
|
txPower += pHalData->BW40_5G_Diff[RFPath][TX_4S];
|
|
|
|
//DBG_871X("+PowerDiff 5G(RF-%c): (BW40-1S, BW40-2S) = (%d, %d, %d, %d)\n", ((RFPath==0)?'A':(RFPath==1)?'B':(RFPath==2)?'C':'D'),
|
|
// pHalData->BW40_5G_Diff[RFPath][TX_1S], pHalData->BW40_5G_Diff[RFPath][TX_2S],
|
|
// pHalData->BW40_5G_Diff[RFPath][TX_3S], pHalData->BW40_5G_Diff[RFPath][TX_4S]);
|
|
}
|
|
// BW80-1S, BW80-2S
|
|
else if (BandWidth== CHANNEL_WIDTH_80)
|
|
{
|
|
// <20121220, Kordan> Get the index of array "Index5G_BW80_Base".
|
|
for (i = 0; i < CENTER_CH_5G_80M_NUM; ++i)
|
|
if (center_ch_5g_80m[i] == Channel)
|
|
chnlIdx = i;
|
|
|
|
txPower = pHalData->Index5G_BW80_Base[RFPath][chnlIdx];
|
|
|
|
if ( (MGN_MCS0 <= Rate && Rate <= MGN_MCS31) || (MGN_VHT1SS_MCS0 <= Rate && Rate <= MGN_VHT4SS_MCS9))
|
|
txPower += + pHalData->BW80_5G_Diff[RFPath][TX_1S];
|
|
if ( (MGN_MCS8 <= Rate && Rate <= MGN_MCS31) || (MGN_VHT2SS_MCS0 <= Rate && Rate <= MGN_VHT4SS_MCS9))
|
|
txPower += pHalData->BW80_5G_Diff[RFPath][TX_2S];
|
|
if ( (MGN_MCS16 <= Rate && Rate <= MGN_MCS31) || (MGN_VHT3SS_MCS0 <= Rate && Rate <= MGN_VHT4SS_MCS9))
|
|
txPower += pHalData->BW80_5G_Diff[RFPath][TX_3S];
|
|
if ( (MGN_MCS23 <= Rate && Rate <= MGN_MCS31) || (MGN_VHT4SS_MCS0 <= Rate && Rate <= MGN_VHT4SS_MCS9))
|
|
txPower += pHalData->BW80_5G_Diff[RFPath][TX_4S];
|
|
|
|
//DBG_871X("+PowerDiff 5G(RF-%c): (BW80-1S, BW80-2S, BW80-3S, BW80-4S) = (%d, %d, %d, %d)\n",((RFPath==0)?'A':(RFPath==1)?'B':(RFPath==2)?'C':'D'),
|
|
// pHalData->BW80_5G_Diff[RFPath][TX_1S], pHalData->BW80_5G_Diff[RFPath][TX_2S],
|
|
// pHalData->BW80_5G_Diff[RFPath][TX_3S], pHalData->BW80_5G_Diff[RFPath][TX_4S]);
|
|
}
|
|
}
|
|
|
|
return txPower;
|
|
}
|
|
|
|
s8
|
|
PHY_GetTxPowerTrackingOffset(
|
|
PADAPTER pAdapter,
|
|
u8 RFPath,
|
|
u8 Rate
|
|
)
|
|
{
|
|
PHAL_DATA_TYPE pHalData = GET_HAL_DATA(pAdapter);
|
|
PDM_ODM_T pDM_Odm = &pHalData->odmpriv;
|
|
s8 offset = 0;
|
|
|
|
if( pDM_Odm->RFCalibrateInfo.TxPowerTrackControl == _FALSE)
|
|
return offset;
|
|
|
|
if ((Rate == MGN_1M) ||(Rate == MGN_2M)||(Rate == MGN_5_5M)||(Rate == MGN_11M))
|
|
{
|
|
offset = pDM_Odm->RFCalibrateInfo.Remnant_CCKSwingIdx;
|
|
/*DBG_871X("+Remnant_CCKSwingIdx = 0x%x\n", RFPath, Rate, pRFCalibrateInfo->Remnant_CCKSwingIdx);*/
|
|
}
|
|
else
|
|
{
|
|
offset = pDM_Odm->RFCalibrateInfo.Remnant_OFDMSwingIdx[RFPath];
|
|
/*DBG_871X("+Remanant_OFDMSwingIdx[RFPath %u][Rate 0x%x] = 0x%x\n", RFPath, Rate, pRFCalibrateInfo->Remnant_OFDMSwingIdx[RFPath]); */
|
|
|
|
}
|
|
|
|
return offset;
|
|
}
|
|
|
|
u8
|
|
PHY_GetRateIndexOfTxPowerByRate(
|
|
IN u8 Rate
|
|
)
|
|
{
|
|
u8 index = 0;
|
|
switch ( Rate )
|
|
{
|
|
case MGN_1M: index = 0; break;
|
|
case MGN_2M: index = 1; break;
|
|
case MGN_5_5M: index = 2; break;
|
|
case MGN_11M: index = 3; break;
|
|
case MGN_6M: index = 4; break;
|
|
case MGN_9M: index = 5; break;
|
|
case MGN_12M: index = 6; break;
|
|
case MGN_18M: index = 7; break;
|
|
case MGN_24M: index = 8; break;
|
|
case MGN_36M: index = 9; break;
|
|
case MGN_48M: index = 10; break;
|
|
case MGN_54M: index = 11; break;
|
|
case MGN_MCS0: index = 12; break;
|
|
case MGN_MCS1: index = 13; break;
|
|
case MGN_MCS2: index = 14; break;
|
|
case MGN_MCS3: index = 15; break;
|
|
case MGN_MCS4: index = 16; break;
|
|
case MGN_MCS5: index = 17; break;
|
|
case MGN_MCS6: index = 18; break;
|
|
case MGN_MCS7: index = 19; break;
|
|
case MGN_MCS8: index = 20; break;
|
|
case MGN_MCS9: index = 21; break;
|
|
case MGN_MCS10: index = 22; break;
|
|
case MGN_MCS11: index = 23; break;
|
|
case MGN_MCS12: index = 24; break;
|
|
case MGN_MCS13: index = 25; break;
|
|
case MGN_MCS14: index = 26; break;
|
|
case MGN_MCS15: index = 27; break;
|
|
case MGN_MCS16: index = 28; break;
|
|
case MGN_MCS17: index = 29; break;
|
|
case MGN_MCS18: index = 30; break;
|
|
case MGN_MCS19: index = 31; break;
|
|
case MGN_MCS20: index = 32; break;
|
|
case MGN_MCS21: index = 33; break;
|
|
case MGN_MCS22: index = 34; break;
|
|
case MGN_MCS23: index = 35; break;
|
|
case MGN_MCS24: index = 36; break;
|
|
case MGN_MCS25: index = 37; break;
|
|
case MGN_MCS26: index = 38; break;
|
|
case MGN_MCS27: index = 39; break;
|
|
case MGN_MCS28: index = 40; break;
|
|
case MGN_MCS29: index = 41; break;
|
|
case MGN_MCS30: index = 42; break;
|
|
case MGN_MCS31: index = 43; break;
|
|
case MGN_VHT1SS_MCS0: index = 44; break;
|
|
case MGN_VHT1SS_MCS1: index = 45; break;
|
|
case MGN_VHT1SS_MCS2: index = 46; break;
|
|
case MGN_VHT1SS_MCS3: index = 47; break;
|
|
case MGN_VHT1SS_MCS4: index = 48; break;
|
|
case MGN_VHT1SS_MCS5: index = 49; break;
|
|
case MGN_VHT1SS_MCS6: index = 50; break;
|
|
case MGN_VHT1SS_MCS7: index = 51; break;
|
|
case MGN_VHT1SS_MCS8: index = 52; break;
|
|
case MGN_VHT1SS_MCS9: index = 53; break;
|
|
case MGN_VHT2SS_MCS0: index = 54; break;
|
|
case MGN_VHT2SS_MCS1: index = 55; break;
|
|
case MGN_VHT2SS_MCS2: index = 56; break;
|
|
case MGN_VHT2SS_MCS3: index = 57; break;
|
|
case MGN_VHT2SS_MCS4: index = 58; break;
|
|
case MGN_VHT2SS_MCS5: index = 59; break;
|
|
case MGN_VHT2SS_MCS6: index = 60; break;
|
|
case MGN_VHT2SS_MCS7: index = 61; break;
|
|
case MGN_VHT2SS_MCS8: index = 62; break;
|
|
case MGN_VHT2SS_MCS9: index = 63; break;
|
|
case MGN_VHT3SS_MCS0: index = 64; break;
|
|
case MGN_VHT3SS_MCS1: index = 65; break;
|
|
case MGN_VHT3SS_MCS2: index = 66; break;
|
|
case MGN_VHT3SS_MCS3: index = 67; break;
|
|
case MGN_VHT3SS_MCS4: index = 68; break;
|
|
case MGN_VHT3SS_MCS5: index = 69; break;
|
|
case MGN_VHT3SS_MCS6: index = 70; break;
|
|
case MGN_VHT3SS_MCS7: index = 71; break;
|
|
case MGN_VHT3SS_MCS8: index = 72; break;
|
|
case MGN_VHT3SS_MCS9: index = 73; break;
|
|
case MGN_VHT4SS_MCS0: index = 74; break;
|
|
case MGN_VHT4SS_MCS1: index = 75; break;
|
|
case MGN_VHT4SS_MCS2: index = 76; break;
|
|
case MGN_VHT4SS_MCS3: index = 77; break;
|
|
case MGN_VHT4SS_MCS4: index = 78; break;
|
|
case MGN_VHT4SS_MCS5: index = 79; break;
|
|
case MGN_VHT4SS_MCS6: index = 80; break;
|
|
case MGN_VHT4SS_MCS7: index = 81; break;
|
|
case MGN_VHT4SS_MCS8: index = 82; break;
|
|
case MGN_VHT4SS_MCS9: index = 83; break;
|
|
default:
|
|
DBG_871X("Invalid rate 0x%x in %s\n", Rate, __FUNCTION__ );
|
|
break;
|
|
};
|
|
|
|
return index;
|
|
}
|
|
|
|
s8
|
|
PHY_GetTxPowerByRate(
|
|
IN PADAPTER pAdapter,
|
|
IN u8 Band,
|
|
IN u8 RFPath,
|
|
IN u8 TxNum,
|
|
IN u8 Rate
|
|
)
|
|
{
|
|
HAL_DATA_TYPE *pHalData = GET_HAL_DATA( pAdapter );
|
|
s8 value = 0, limit = 0;
|
|
u8 rateIndex = PHY_GetRateIndexOfTxPowerByRate( Rate );
|
|
|
|
if ( ( pAdapter->registrypriv.RegEnableTxPowerByRate == 2 && pHalData->EEPROMRegulatory == 2 ) ||
|
|
pAdapter->registrypriv.RegEnableTxPowerByRate == 0 )
|
|
return 0;
|
|
|
|
if ( Band != BAND_ON_2_4G && Band != BAND_ON_5G )
|
|
{
|
|
DBG_871X("Invalid band %d in %s\n", Band, __FUNCTION__ );
|
|
return value;
|
|
}
|
|
if ( RFPath > ODM_RF_PATH_D )
|
|
{
|
|
DBG_871X("Invalid RfPath %d in %s\n", RFPath, __FUNCTION__ );
|
|
return value;
|
|
}
|
|
if ( TxNum >= RF_MAX_TX_NUM )
|
|
{
|
|
DBG_871X("Invalid TxNum %d in %s\n", TxNum, __FUNCTION__ );
|
|
return value;
|
|
}
|
|
if ( rateIndex >= TX_PWR_BY_RATE_NUM_RATE )
|
|
{
|
|
DBG_871X("Invalid RateIndex %d in %s\n", rateIndex, __FUNCTION__ );
|
|
return value;
|
|
}
|
|
|
|
value = pHalData->TxPwrByRateOffset[Band][RFPath][TxNum][rateIndex];
|
|
|
|
return value;
|
|
|
|
}
|
|
|
|
VOID
|
|
PHY_SetTxPowerByRate(
|
|
IN PADAPTER pAdapter,
|
|
IN u8 Band,
|
|
IN u8 RFPath,
|
|
IN u8 TxNum,
|
|
IN u8 Rate,
|
|
IN s8 Value
|
|
)
|
|
{
|
|
HAL_DATA_TYPE *pHalData = GET_HAL_DATA( pAdapter );
|
|
u8 rateIndex = PHY_GetRateIndexOfTxPowerByRate( Rate );
|
|
|
|
if ( Band != BAND_ON_2_4G && Band != BAND_ON_5G )
|
|
{
|
|
DBG_871X("Invalid band %d in %s\n", Band, __FUNCTION__ );
|
|
return;
|
|
}
|
|
if ( RFPath > ODM_RF_PATH_D )
|
|
{
|
|
DBG_871X("Invalid RfPath %d in %s\n", RFPath, __FUNCTION__ );
|
|
return;
|
|
}
|
|
if ( TxNum >= RF_MAX_TX_NUM )
|
|
{
|
|
DBG_871X( "Invalid TxNum %d in %s\n", TxNum, __FUNCTION__ );
|
|
return;
|
|
}
|
|
if ( rateIndex >= TX_PWR_BY_RATE_NUM_RATE )
|
|
{
|
|
DBG_871X("Invalid RateIndex %d in %s\n", rateIndex, __FUNCTION__ );
|
|
return;
|
|
}
|
|
|
|
pHalData->TxPwrByRateOffset[Band][RFPath][TxNum][rateIndex] = Value;
|
|
}
|
|
|
|
VOID
|
|
PHY_SetTxPowerLevelByPath(
|
|
IN PADAPTER Adapter,
|
|
IN u8 channel,
|
|
IN u8 path
|
|
)
|
|
{
|
|
PHAL_DATA_TYPE pHalData = GET_HAL_DATA(Adapter);
|
|
BOOLEAN bIsIn24G = (pHalData->CurrentBandType == BAND_ON_2_4G );
|
|
|
|
//if ( pMgntInfo->RegNByteAccess == 0 )
|
|
{
|
|
if ( bIsIn24G )
|
|
PHY_SetTxPowerIndexByRateSection( Adapter, path, channel, CCK );
|
|
|
|
PHY_SetTxPowerIndexByRateSection( Adapter, path, channel, OFDM );
|
|
PHY_SetTxPowerIndexByRateSection( Adapter, path, channel, HT_MCS0_MCS7 );
|
|
|
|
if (IS_HARDWARE_TYPE_JAGUAR(Adapter) || IS_HARDWARE_TYPE_8814A(Adapter))
|
|
PHY_SetTxPowerIndexByRateSection(Adapter, path, channel, VHT_1SSMCS0_1SSMCS9);
|
|
|
|
if (pHalData->NumTotalRFPath >= 2)
|
|
{
|
|
PHY_SetTxPowerIndexByRateSection( Adapter, path, channel, HT_MCS8_MCS15 );
|
|
|
|
if (IS_HARDWARE_TYPE_JAGUAR(Adapter) || IS_HARDWARE_TYPE_8814A(Adapter))
|
|
PHY_SetTxPowerIndexByRateSection(Adapter, path, channel, VHT_2SSMCS0_2SSMCS9);
|
|
|
|
if (IS_HARDWARE_TYPE_8814A(Adapter))
|
|
{
|
|
PHY_SetTxPowerIndexByRateSection( Adapter, path, channel, HT_MCS16_MCS23 );
|
|
PHY_SetTxPowerIndexByRateSection( Adapter, path, channel, VHT_3SSMCS0_3SSMCS9 );
|
|
}
|
|
}
|
|
}
|
|
}
|
|
|
|
VOID
|
|
PHY_SetTxPowerIndexByRateArray(
|
|
IN PADAPTER pAdapter,
|
|
IN u8 RFPath,
|
|
IN CHANNEL_WIDTH BandWidth,
|
|
IN u8 Channel,
|
|
IN u8* Rates,
|
|
IN u8 RateArraySize
|
|
)
|
|
{
|
|
u32 powerIndex = 0;
|
|
int i = 0;
|
|
|
|
for (i = 0; i < RateArraySize; ++i)
|
|
{
|
|
powerIndex = PHY_GetTxPowerIndex(pAdapter, RFPath, Rates[i], BandWidth, Channel);
|
|
PHY_SetTxPowerIndex(pAdapter, powerIndex, RFPath, Rates[i]);
|
|
}
|
|
}
|
|
|
|
s8
|
|
phy_GetWorldWideLimit(
|
|
s8* LimitTable
|
|
)
|
|
{
|
|
s8 min = LimitTable[0];
|
|
u8 i = 0;
|
|
|
|
for (i = 0; i < MAX_REGULATION_NUM; ++i) {
|
|
if (LimitTable[i] < min)
|
|
min = LimitTable[i];
|
|
}
|
|
|
|
return min;
|
|
}
|
|
|
|
s8
|
|
phy_GetChannelIndexOfTxPowerLimit(
|
|
IN u8 Band,
|
|
IN u8 Channel
|
|
)
|
|
{
|
|
s8 channelIndex = -1;
|
|
u8 i = 0;
|
|
|
|
if (Band == BAND_ON_2_4G) {
|
|
channelIndex = Channel - 1;
|
|
} else if (Band == BAND_ON_5G) {
|
|
for (i = 0; i < CENTER_CH_5G_ALL_NUM; ++i) {
|
|
if (center_ch_5g_all[i] == Channel)
|
|
channelIndex = i;
|
|
}
|
|
} else {
|
|
DBG_871X_LEVEL(_drv_always_, "Invalid Band %d in %s\n", Band, __func__);
|
|
}
|
|
|
|
if (channelIndex == -1)
|
|
DBG_871X_LEVEL(_drv_always_, "Invalid Channel %d of Band %d in %s\n", Channel, Band, __func__);
|
|
|
|
return channelIndex;
|
|
}
|
|
|
|
s8
|
|
PHY_GetTxPowerLimit(
|
|
IN PADAPTER Adapter,
|
|
IN u32 RegPwrTblSel,
|
|
IN BAND_TYPE Band,
|
|
IN CHANNEL_WIDTH Bandwidth,
|
|
IN u8 RfPath,
|
|
IN u8 DataRate,
|
|
IN u8 Channel
|
|
)
|
|
{
|
|
HAL_DATA_TYPE *pHalData = GET_HAL_DATA(Adapter);
|
|
s16 band = -1, regulation = -1, bandwidth = -1,
|
|
rateSection = -1, channel = -1;
|
|
s8 powerLimit = MAX_POWER_INDEX;
|
|
|
|
if ( ( Adapter->registrypriv.RegEnableTxPowerLimit == 2 && pHalData->EEPROMRegulatory != 1 ) ||
|
|
Adapter->registrypriv.RegEnableTxPowerLimit == 0 )
|
|
return MAX_POWER_INDEX;
|
|
|
|
switch (RegPwrTblSel) {
|
|
case 1:
|
|
regulation = TXPWR_LMT_ETSI;
|
|
break;
|
|
case 2:
|
|
regulation = TXPWR_LMT_MKK;
|
|
break;
|
|
case 3:
|
|
regulation = TXPWR_LMT_FCC;
|
|
break;
|
|
case 4:
|
|
regulation = TXPWR_LMT_WW;
|
|
break;
|
|
default:
|
|
regulation = (Band == BAND_ON_2_4G) ? pHalData->Regulation2_4G : pHalData->Regulation5G;
|
|
break;
|
|
}
|
|
|
|
//DBG_871X("pMgntInfo->RegPwrTblSel %d, final regulation %d\n", Adapter->registrypriv.RegPwrTblSel, regulation );
|
|
|
|
|
|
if ( Band == BAND_ON_2_4G ) band = 0;
|
|
else if ( Band == BAND_ON_5G ) band = 1;
|
|
|
|
if ( Bandwidth == CHANNEL_WIDTH_20 ) bandwidth = 0;
|
|
else if ( Bandwidth == CHANNEL_WIDTH_40 ) bandwidth = 1;
|
|
else if ( Bandwidth == CHANNEL_WIDTH_80 ) bandwidth = 2;
|
|
else if ( Bandwidth == CHANNEL_WIDTH_160 ) bandwidth = 3;
|
|
|
|
switch ( DataRate )
|
|
{
|
|
case MGN_1M: case MGN_2M: case MGN_5_5M: case MGN_11M:
|
|
rateSection = 0;
|
|
break;
|
|
|
|
case MGN_6M: case MGN_9M: case MGN_12M: case MGN_18M:
|
|
case MGN_24M: case MGN_36M: case MGN_48M: case MGN_54M:
|
|
rateSection = 1;
|
|
break;
|
|
|
|
case MGN_MCS0: case MGN_MCS1: case MGN_MCS2: case MGN_MCS3:
|
|
case MGN_MCS4: case MGN_MCS5: case MGN_MCS6: case MGN_MCS7:
|
|
rateSection = 2;
|
|
break;
|
|
|
|
case MGN_MCS8: case MGN_MCS9: case MGN_MCS10: case MGN_MCS11:
|
|
case MGN_MCS12: case MGN_MCS13: case MGN_MCS14: case MGN_MCS15:
|
|
rateSection = 3;
|
|
break;
|
|
|
|
case MGN_MCS16: case MGN_MCS17: case MGN_MCS18: case MGN_MCS19:
|
|
case MGN_MCS20: case MGN_MCS21: case MGN_MCS22: case MGN_MCS23:
|
|
rateSection = 4;
|
|
break;
|
|
|
|
case MGN_MCS24: case MGN_MCS25: case MGN_MCS26: case MGN_MCS27:
|
|
case MGN_MCS28: case MGN_MCS29: case MGN_MCS30: case MGN_MCS31:
|
|
rateSection = 5;
|
|
break;
|
|
|
|
case MGN_VHT1SS_MCS0: case MGN_VHT1SS_MCS1: case MGN_VHT1SS_MCS2:
|
|
case MGN_VHT1SS_MCS3: case MGN_VHT1SS_MCS4: case MGN_VHT1SS_MCS5:
|
|
case MGN_VHT1SS_MCS6: case MGN_VHT1SS_MCS7: case MGN_VHT1SS_MCS8:
|
|
case MGN_VHT1SS_MCS9:
|
|
rateSection = 6;
|
|
break;
|
|
|
|
case MGN_VHT2SS_MCS0: case MGN_VHT2SS_MCS1: case MGN_VHT2SS_MCS2:
|
|
case MGN_VHT2SS_MCS3: case MGN_VHT2SS_MCS4: case MGN_VHT2SS_MCS5:
|
|
case MGN_VHT2SS_MCS6: case MGN_VHT2SS_MCS7: case MGN_VHT2SS_MCS8:
|
|
case MGN_VHT2SS_MCS9:
|
|
rateSection = 7;
|
|
break;
|
|
|
|
case MGN_VHT3SS_MCS0: case MGN_VHT3SS_MCS1: case MGN_VHT3SS_MCS2:
|
|
case MGN_VHT3SS_MCS3: case MGN_VHT3SS_MCS4: case MGN_VHT3SS_MCS5:
|
|
case MGN_VHT3SS_MCS6: case MGN_VHT3SS_MCS7: case MGN_VHT3SS_MCS8:
|
|
case MGN_VHT3SS_MCS9:
|
|
rateSection = 8;
|
|
break;
|
|
|
|
case MGN_VHT4SS_MCS0: case MGN_VHT4SS_MCS1: case MGN_VHT4SS_MCS2:
|
|
case MGN_VHT4SS_MCS3: case MGN_VHT4SS_MCS4: case MGN_VHT4SS_MCS5:
|
|
case MGN_VHT4SS_MCS6: case MGN_VHT4SS_MCS7: case MGN_VHT4SS_MCS8:
|
|
case MGN_VHT4SS_MCS9:
|
|
rateSection = 9;
|
|
break;
|
|
|
|
default:
|
|
DBG_871X("Wrong rate 0x%x\n", DataRate );
|
|
break;
|
|
}
|
|
|
|
if ( Band == BAND_ON_5G && rateSection == 0 )
|
|
DBG_871X("Wrong rate 0x%x: No CCK in 5G Band\n", DataRate );
|
|
|
|
// workaround for wrong index combination to obtain tx power limit,
|
|
// OFDM only exists in BW 20M
|
|
if ( rateSection == 1 )
|
|
bandwidth = 0;
|
|
|
|
// workaround for wrong index combination to obtain tx power limit,
|
|
// CCK table will only be given in BW 20M
|
|
if ( rateSection == 0 )
|
|
bandwidth = 0;
|
|
|
|
// workaround for wrong indxe combination to obtain tx power limit,
|
|
// HT on 80M will reference to HT on 40M
|
|
if ( ( rateSection == 2 || rateSection == 3 ) && Band == BAND_ON_5G && bandwidth == 2 ) {
|
|
bandwidth = 1;
|
|
}
|
|
|
|
if ( Band == BAND_ON_2_4G )
|
|
channel = phy_GetChannelIndexOfTxPowerLimit( BAND_ON_2_4G, Channel );
|
|
else if ( Band == BAND_ON_5G )
|
|
channel = phy_GetChannelIndexOfTxPowerLimit( BAND_ON_5G, Channel );
|
|
else if ( Band == BAND_ON_BOTH )
|
|
{
|
|
// BAND_ON_BOTH don't care temporarily
|
|
}
|
|
|
|
if ( band == -1 || regulation == -1 || bandwidth == -1 ||
|
|
rateSection == -1 || channel == -1 )
|
|
{
|
|
//DBG_871X("Wrong index value to access power limit table [band %d][regulation %d][bandwidth %d][rf_path %d][rate_section %d][chnlGroup %d]\n",
|
|
// band, regulation, bandwidth, RfPath, rateSection, channelGroup );
|
|
|
|
return MAX_POWER_INDEX;
|
|
}
|
|
|
|
if ( Band == BAND_ON_2_4G ) {
|
|
s8 limits[10] = {0}; u8 i = 0;
|
|
if (bandwidth >= MAX_2_4G_BANDWIDTH_NUM)
|
|
bandwidth = MAX_2_4G_BANDWIDTH_NUM - 1;
|
|
for (i = 0; i < MAX_REGULATION_NUM; ++i)
|
|
limits[i] = pHalData->TxPwrLimit_2_4G[i][bandwidth][rateSection][channel][RfPath];
|
|
|
|
powerLimit = (regulation == TXPWR_LMT_WW) ? phy_GetWorldWideLimit(limits) :
|
|
pHalData->TxPwrLimit_2_4G[regulation][bandwidth][rateSection][channel][RfPath];
|
|
|
|
} else if ( Band == BAND_ON_5G ) {
|
|
s8 limits[10] = {0}; u8 i = 0;
|
|
for (i = 0; i < MAX_REGULATION_NUM; ++i)
|
|
limits[i] = pHalData->TxPwrLimit_5G[i][bandwidth][rateSection][channel][RfPath];
|
|
|
|
powerLimit = (regulation == TXPWR_LMT_WW) ? phy_GetWorldWideLimit(limits) :
|
|
pHalData->TxPwrLimit_5G[regulation][bandwidth][rateSection][channel][RfPath];
|
|
} else
|
|
DBG_871X("No power limit table of the specified band\n" );
|
|
|
|
// combine 5G VHT & HT rate
|
|
// 5G 20M and 40M HT and VHT can cross reference
|
|
/*
|
|
if ( Band == BAND_ON_5G && powerLimit == MAX_POWER_INDEX ) {
|
|
if ( bandwidth == 0 || bandwidth == 1 ) {
|
|
RT_TRACE( COMP_INIT, DBG_LOUD, ( "No power limit table of the specified band %d, bandwidth %d, ratesection %d, rf path %d\n",
|
|
band, bandwidth, rateSection, RfPath ) );
|
|
if ( rateSection == 2 )
|
|
powerLimit = pHalData->TxPwrLimit_5G[regulation]
|
|
[bandwidth][4][channelGroup][RfPath];
|
|
else if ( rateSection == 4 )
|
|
powerLimit = pHalData->TxPwrLimit_5G[regulation]
|
|
[bandwidth][2][channelGroup][RfPath];
|
|
else if ( rateSection == 3 )
|
|
powerLimit = pHalData->TxPwrLimit_5G[regulation]
|
|
[bandwidth][5][channelGroup][RfPath];
|
|
else if ( rateSection == 5 )
|
|
powerLimit = pHalData->TxPwrLimit_5G[regulation]
|
|
[bandwidth][3][channelGroup][RfPath];
|
|
}
|
|
}
|
|
*/
|
|
//DBG_871X("TxPwrLmt[Regulation %d][Band %d][BW %d][RFPath %d][Rate 0x%x][Chnl %d] = %d\n",
|
|
// regulation, pHalData->CurrentBandType, Bandwidth, RfPath, DataRate, Channel, powerLimit);
|
|
return powerLimit;
|
|
}
|
|
|
|
VOID
|
|
phy_CrossReferenceHTAndVHTTxPowerLimit(
|
|
IN PADAPTER pAdapter
|
|
)
|
|
{
|
|
HAL_DATA_TYPE *pHalData = GET_HAL_DATA(pAdapter);
|
|
u8 regulation, bw, channel, rs, ref_rs;
|
|
int ht_ref_vht_5g_20_40 = 0;
|
|
int vht_ref_ht_5g_20_40 = 0;
|
|
int ht_has_ref_5g_20_40 = 0;
|
|
int vht_has_ref_5g_20_40 = 0;
|
|
|
|
pHalData->tx_pwr_lmt_5g_20_40_ref = 0;
|
|
|
|
for (regulation = 0; regulation < MAX_REGULATION_NUM; ++regulation) {
|
|
|
|
for (bw = 0; bw < MAX_5G_BANDWIDTH_NUM; ++bw) {
|
|
|
|
for (channel = 0; channel < CENTER_CH_5G_ALL_NUM; ++channel) {
|
|
|
|
for (rs = 0; rs < MAX_RATE_SECTION_NUM; ++rs) {
|
|
|
|
/* 5G 20M 40M VHT and HT can cross reference */
|
|
if (bw == CHANNEL_WIDTH_20 || bw == CHANNEL_WIDTH_40) {
|
|
if (rs == HT_1SS)
|
|
ref_rs = VHT_1SS;
|
|
else if (rs == HT_2SS)
|
|
ref_rs = VHT_2SS;
|
|
else if (rs == HT_3SS)
|
|
ref_rs = VHT_3SS;
|
|
else if (rs == HT_4SS)
|
|
ref_rs = VHT_4SS;
|
|
else if (rs == VHT_1SS)
|
|
ref_rs = HT_1SS;
|
|
else if (rs == VHT_2SS)
|
|
ref_rs = HT_2SS;
|
|
else if (rs == VHT_3SS)
|
|
ref_rs = HT_3SS;
|
|
else if (rs == VHT_4SS)
|
|
ref_rs = HT_4SS;
|
|
else
|
|
continue;
|
|
|
|
if (pHalData->TxPwrLimit_5G[regulation][bw][ref_rs][channel][RF_PATH_A] == MAX_POWER_INDEX)
|
|
continue;
|
|
|
|
if (IS_HT_RATE_SECTION(rs))
|
|
ht_has_ref_5g_20_40++;
|
|
else if (IS_VHT_RATE_SECTION(rs))
|
|
vht_has_ref_5g_20_40++;
|
|
else
|
|
continue;
|
|
|
|
if (pHalData->TxPwrLimit_5G[regulation][bw][rs][channel][RF_PATH_A] != MAX_POWER_INDEX)
|
|
continue;
|
|
|
|
if (IS_HT_RATE_SECTION(rs) && IS_VHT_RATE_SECTION(ref_rs))
|
|
ht_ref_vht_5g_20_40++;
|
|
else if (IS_VHT_RATE_SECTION(rs) && IS_HT_RATE_SECTION(ref_rs))
|
|
vht_ref_ht_5g_20_40++;
|
|
|
|
if (0)
|
|
DBG_871X("reg:%u, bw:%u, ch:%u, %s ref %s\n"
|
|
, regulation, bw, channel
|
|
, rate_section_str(rs), rate_section_str(ref_rs));
|
|
|
|
pHalData->TxPwrLimit_5G[regulation][bw][rs][channel][RF_PATH_A] =
|
|
pHalData->TxPwrLimit_5G[regulation][bw][ref_rs][channel][RF_PATH_A];
|
|
}
|
|
|
|
}
|
|
}
|
|
}
|
|
}
|
|
|
|
if (0) {
|
|
DBG_871X("ht_ref_vht_5g_20_40:%d, ht_has_ref_5g_20_40:%d\n", ht_ref_vht_5g_20_40, ht_has_ref_5g_20_40);
|
|
DBG_871X("vht_ref_hht_5g_20_40:%d, vht_has_ref_5g_20_40:%d\n", vht_ref_ht_5g_20_40, vht_has_ref_5g_20_40);
|
|
}
|
|
|
|
/* 5G 20M&40M HT all come from VHT*/
|
|
if (ht_ref_vht_5g_20_40 && ht_has_ref_5g_20_40 == ht_ref_vht_5g_20_40)
|
|
pHalData->tx_pwr_lmt_5g_20_40_ref |= TX_PWR_LMT_REF_HT_FROM_VHT;
|
|
|
|
/* 5G 20M&40M VHT all come from HT*/
|
|
if (vht_ref_ht_5g_20_40 && vht_has_ref_5g_20_40 == vht_ref_ht_5g_20_40)
|
|
pHalData->tx_pwr_lmt_5g_20_40_ref |= TX_PWR_LMT_REF_VHT_FROM_HT;
|
|
}
|
|
|
|
VOID
|
|
PHY_ConvertTxPowerLimitToPowerIndex(
|
|
IN PADAPTER Adapter
|
|
)
|
|
{
|
|
HAL_DATA_TYPE *pHalData = GET_HAL_DATA(Adapter);
|
|
u8 base;
|
|
u8 regulation, bw, channel, rateSection;
|
|
s8 tempValue = 0, tempPwrLmt = 0;
|
|
u8 rfPath = 0;
|
|
u8 tx_num;
|
|
|
|
if (pHalData->odmpriv.PhyRegPgValueType != PHY_REG_PG_EXACT_VALUE) {
|
|
rtw_warn_on(1);
|
|
return;
|
|
}
|
|
|
|
phy_CrossReferenceHTAndVHTTxPowerLimit(Adapter);
|
|
|
|
for (regulation = 0; regulation < MAX_REGULATION_NUM; ++regulation) {
|
|
|
|
for (bw = 0; bw < MAX_2_4G_BANDWIDTH_NUM; ++bw) {
|
|
|
|
for (channel = 0; channel < CENTER_CH_2G_NUM; ++channel) {
|
|
|
|
for (rateSection = CCK; rateSection <= HT_4SS; ++rateSection) {
|
|
tx_num = rate_section_to_tx_num(rateSection);
|
|
tempPwrLmt = pHalData->TxPwrLimit_2_4G[regulation][bw][rateSection][channel][RF_PATH_A];
|
|
|
|
if (tempPwrLmt != MAX_POWER_INDEX) {
|
|
|
|
for (rfPath = RF_PATH_A; rfPath < MAX_RF_PATH; ++rfPath) {
|
|
|
|
if (rtw_regsty_tx_power_by_rate_base_valid(Adapter) == _TRUE)
|
|
base = rtw_regsty_get_tx_power_by_rate_base(Adapter, BAND_ON_2_4G, rfPath, tx_num, rateSection);
|
|
else
|
|
base = PHY_GetTxPowerByRateBase(Adapter, BAND_ON_2_4G, rfPath, tx_num, rateSection);
|
|
|
|
tempValue = tempPwrLmt - base;
|
|
pHalData->TxPwrLimit_2_4G[regulation][bw][rateSection][channel][rfPath] = tempValue;
|
|
}
|
|
}
|
|
}
|
|
}
|
|
}
|
|
}
|
|
|
|
if (IS_HARDWARE_TYPE_JAGUAR_AND_JAGUAR2(Adapter)) {
|
|
|
|
for (regulation = 0; regulation < MAX_REGULATION_NUM; ++regulation) {
|
|
|
|
for (bw = 0; bw < MAX_5G_BANDWIDTH_NUM; ++bw) {
|
|
|
|
for (channel = 0; channel < CENTER_CH_5G_ALL_NUM; ++channel) {
|
|
|
|
for (rateSection = OFDM; rateSection <= VHT_4SS; ++rateSection) {
|
|
tx_num = rate_section_to_tx_num(rateSection);
|
|
tempPwrLmt = pHalData->TxPwrLimit_5G[regulation][bw][rateSection][channel][RF_PATH_A];
|
|
|
|
if (tempPwrLmt != MAX_POWER_INDEX) {
|
|
|
|
for (rfPath = RF_PATH_A; rfPath < MAX_RF_PATH; ++rfPath) {
|
|
|
|
if (rtw_regsty_tx_power_by_rate_base_valid(Adapter) == _TRUE)
|
|
base = rtw_regsty_get_tx_power_by_rate_base(Adapter, BAND_ON_5G, rfPath, tx_num, rateSection);
|
|
else
|
|
base = PHY_GetTxPowerByRateBase(Adapter, BAND_ON_5G, rfPath, tx_num, rateSection);
|
|
|
|
tempValue = tempPwrLmt - base;
|
|
pHalData->TxPwrLimit_5G[regulation][bw][rateSection][channel][rfPath] = tempValue;
|
|
}
|
|
}
|
|
}
|
|
}
|
|
}
|
|
}
|
|
}
|
|
}
|
|
|
|
/*
|
|
* PHY_InitTxPowerLimit - Set all hal_data.TxPwrLimit_2_4G, TxPwrLimit_5G array to MAX_POWER_INDEX
|
|
*/
|
|
VOID
|
|
PHY_InitTxPowerLimit(
|
|
IN PADAPTER Adapter
|
|
)
|
|
{
|
|
HAL_DATA_TYPE *pHalData = GET_HAL_DATA(Adapter);
|
|
u8 i, j, k, l, m;
|
|
|
|
for (i = 0; i < MAX_REGULATION_NUM; ++i)
|
|
for (j = 0; j < MAX_2_4G_BANDWIDTH_NUM; ++j)
|
|
for (k = 0; k < MAX_RATE_SECTION_NUM; ++k)
|
|
for (m = 0; m < CENTER_CH_2G_NUM; ++m)
|
|
for (l = 0; l < MAX_RF_PATH; ++l)
|
|
pHalData->TxPwrLimit_2_4G[i][j][k][m][l] = MAX_POWER_INDEX;
|
|
|
|
for (i = 0; i < MAX_REGULATION_NUM; ++i)
|
|
for (j = 0; j < MAX_5G_BANDWIDTH_NUM; ++j)
|
|
for (k = 0; k < MAX_RATE_SECTION_NUM; ++k)
|
|
for (m = 0; m < CENTER_CH_5G_ALL_NUM; ++m)
|
|
for (l = 0; l < MAX_RF_PATH; ++l)
|
|
pHalData->TxPwrLimit_5G[i][j][k][m][l] = MAX_POWER_INDEX;
|
|
}
|
|
|
|
VOID
|
|
PHY_SetTxPowerLimit(
|
|
IN PDM_ODM_T pDM_Odm,
|
|
IN u8 *Regulation,
|
|
IN u8 *Band,
|
|
IN u8 *Bandwidth,
|
|
IN u8 *RateSection,
|
|
IN u8 *RfPath,
|
|
IN u8 *Channel,
|
|
IN u8 *PowerLimit
|
|
)
|
|
{
|
|
PADAPTER Adapter = pDM_Odm->Adapter;
|
|
HAL_DATA_TYPE *pHalData = GET_HAL_DATA( Adapter );
|
|
u8 regulation=0, bandwidth=0, rateSection=0,
|
|
channel;
|
|
s8 powerLimit = 0, prevPowerLimit, channelIndex;
|
|
|
|
//DBG_871X( "Index of power limit table [band %s][regulation %s][bw %s][rate section %s][rf path %s][chnl %s][val %s]\n",
|
|
// Band, Regulation, Bandwidth, RateSection, RfPath, Channel, PowerLimit );
|
|
|
|
if ( !GetU1ByteIntegerFromStringInDecimal( (s8 *)Channel, &channel ) ||
|
|
!GetU1ByteIntegerFromStringInDecimal( (s8 *)PowerLimit, &powerLimit ) )
|
|
{
|
|
DBG_871X("Illegal index of power limit table [chnl %s][val %s]\n", Channel, PowerLimit );
|
|
}
|
|
|
|
powerLimit = powerLimit > MAX_POWER_INDEX ? MAX_POWER_INDEX : powerLimit;
|
|
|
|
if ( eqNByte( Regulation, (u8 *)("FCC"), 3 ) ) regulation = 0;
|
|
else if ( eqNByte( Regulation, (u8 *)("MKK"), 3 ) ) regulation = 1;
|
|
else if ( eqNByte( Regulation, (u8 *)("ETSI"), 4 ) ) regulation = 2;
|
|
else if ( eqNByte( Regulation, (u8 *)("WW13"), 4 ) ) regulation = 3;
|
|
|
|
if ( eqNByte( RateSection, (u8 *)("CCK"), 3 ) && eqNByte( RfPath, (u8 *)("1T"), 2 ) )
|
|
rateSection = 0;
|
|
else if ( eqNByte( RateSection, (u8 *)("OFDM"), 4 ) && eqNByte( RfPath, (u8 *)("1T"), 2 ) )
|
|
rateSection = 1;
|
|
else if ( eqNByte( RateSection, (u8 *)("HT"), 2 ) && eqNByte( RfPath, (u8 *)("1T"), 2 ) )
|
|
rateSection = 2;
|
|
else if ( eqNByte( RateSection, (u8 *)("HT"), 2 ) && eqNByte( RfPath, (u8 *)("2T"), 2 ) )
|
|
rateSection = 3;
|
|
else if ( eqNByte( RateSection, (u8 *)("HT"), 2 ) && eqNByte( RfPath, (u8 *)("3T"), 2 ) )
|
|
rateSection = 4;
|
|
else if ( eqNByte( RateSection, (u8 *)("HT"), 2 ) && eqNByte( RfPath, (u8 *)("4T"), 2 ) )
|
|
rateSection = 5;
|
|
else if ( eqNByte( RateSection, (u8 *)("VHT"), 3 ) && eqNByte( RfPath, (u8 *)("1T"), 2 ) )
|
|
rateSection = 6;
|
|
else if ( eqNByte( RateSection, (u8 *)("VHT"), 3 ) && eqNByte( RfPath, (u8 *)("2T"), 2 ) )
|
|
rateSection = 7;
|
|
else if ( eqNByte( RateSection, (u8 *)("VHT"), 3 ) && eqNByte( RfPath, (u8 *)("3T"), 2 ) )
|
|
rateSection = 8;
|
|
else if ( eqNByte( RateSection, (u8 *)("VHT"), 3 ) && eqNByte( RfPath, (u8 *)("4T"), 2 ) )
|
|
rateSection = 9;
|
|
else
|
|
{
|
|
DBG_871X("Wrong rate section!\n");
|
|
return;
|
|
}
|
|
|
|
|
|
if ( eqNByte( Bandwidth, (u8 *)("20M"), 3 ) ) bandwidth = 0;
|
|
else if ( eqNByte( Bandwidth, (u8 *)("40M"), 3 ) ) bandwidth = 1;
|
|
else if ( eqNByte( Bandwidth, (u8 *)("80M"), 3 ) ) bandwidth = 2;
|
|
else if ( eqNByte( Bandwidth, (u8 *)("160M"), 4 ) ) bandwidth = 3;
|
|
|
|
if ( eqNByte( Band, (u8 *)("2.4G"), 4 ) )
|
|
{
|
|
channelIndex = phy_GetChannelIndexOfTxPowerLimit( BAND_ON_2_4G, channel );
|
|
|
|
if ( channelIndex == -1 )
|
|
return;
|
|
|
|
if (bandwidth >= MAX_2_4G_BANDWIDTH_NUM)
|
|
bandwidth = MAX_2_4G_BANDWIDTH_NUM - 1;
|
|
|
|
prevPowerLimit = pHalData->TxPwrLimit_2_4G[regulation][bandwidth][rateSection][channelIndex][ODM_RF_PATH_A];
|
|
|
|
if ( powerLimit < prevPowerLimit )
|
|
pHalData->TxPwrLimit_2_4G[regulation][bandwidth][rateSection][channelIndex][ODM_RF_PATH_A] = powerLimit;
|
|
|
|
//DBG_871X( "2.4G Band value : [regulation %d][bw %d][rate_section %d][chnl %d][val %d]\n",
|
|
// regulation, bandwidth, rateSection, channelIndex, pHalData->TxPwrLimit_2_4G[regulation][bandwidth][rateSection][channelIndex][ODM_RF_PATH_A] );
|
|
}
|
|
else if ( eqNByte( Band, (u8 *)("5G"), 2 ) )
|
|
{
|
|
channelIndex = phy_GetChannelIndexOfTxPowerLimit( BAND_ON_5G, channel );
|
|
|
|
if ( channelIndex == -1 )
|
|
return;
|
|
|
|
prevPowerLimit = pHalData->TxPwrLimit_5G[regulation][bandwidth][rateSection][channelIndex][ODM_RF_PATH_A];
|
|
|
|
if ( powerLimit < prevPowerLimit )
|
|
pHalData->TxPwrLimit_5G[regulation][bandwidth][rateSection][channelIndex][ODM_RF_PATH_A] = powerLimit;
|
|
|
|
//DBG_871X( "5G Band value : [regulation %d][bw %d][rate_section %d][chnl %d][val %d]\n",
|
|
// regulation, bandwidth, rateSection, channel, pHalData->TxPwrLimit_5G[regulation][bandwidth][rateSection][channelIndex][ODM_RF_PATH_A] );
|
|
}
|
|
else
|
|
{
|
|
DBG_871X("Cannot recognize the band info in %s\n", Band );
|
|
return;
|
|
}
|
|
}
|
|
|
|
u8
|
|
PHY_GetTxPowerIndex(
|
|
IN PADAPTER pAdapter,
|
|
IN u8 RFPath,
|
|
IN u8 Rate,
|
|
IN CHANNEL_WIDTH BandWidth,
|
|
IN u8 Channel
|
|
)
|
|
{
|
|
u8 txPower = 0x3E;
|
|
|
|
if (IS_HARDWARE_TYPE_8814A(pAdapter)) {
|
|
#if (RTL8814A_SUPPORT == 1)
|
|
txPower = PHY_GetTxPowerIndex_8814A(pAdapter, RFPath, Rate, BandWidth, Channel);
|
|
#endif
|
|
} else if (IS_HARDWARE_TYPE_JAGUAR(pAdapter)) {
|
|
#if ((RTL8812A_SUPPORT == 1) || (RTL8821A_SUPPORT == 1))
|
|
txPower = PHY_GetTxPowerIndex_8812A(pAdapter, RFPath, Rate, BandWidth, Channel);
|
|
#endif
|
|
}
|
|
else if (IS_HARDWARE_TYPE_8723B(pAdapter)) {
|
|
#if (RTL8723B_SUPPORT == 1)
|
|
txPower = PHY_GetTxPowerIndex_8723B(pAdapter, RFPath, Rate, BandWidth, Channel);
|
|
#endif
|
|
}
|
|
else if (IS_HARDWARE_TYPE_8703B(pAdapter)) {
|
|
#if (RTL8703B_SUPPORT == 1)
|
|
txPower = PHY_GetTxPowerIndex_8703B(pAdapter, RFPath, Rate, BandWidth, Channel);
|
|
#endif
|
|
}
|
|
else if (IS_HARDWARE_TYPE_8192E(pAdapter)) {
|
|
#if (RTL8192E_SUPPORT==1)
|
|
txPower = PHY_GetTxPowerIndex_8192E(pAdapter, RFPath, Rate, BandWidth, Channel);
|
|
#endif
|
|
}
|
|
else if (IS_HARDWARE_TYPE_8188E(pAdapter)) {
|
|
#if (RTL8188E_SUPPORT==1)
|
|
txPower = PHY_GetTxPowerIndex_8188E(pAdapter, RFPath, Rate, BandWidth, Channel);
|
|
#endif
|
|
} else if (IS_HARDWARE_TYPE_8188F(pAdapter)) {
|
|
#if (RTL8188F_SUPPORT == 1)
|
|
txPower = PHY_GetTxPowerIndex_8188F(pAdapter, RFPath, Rate, BandWidth, Channel);
|
|
#endif
|
|
}
|
|
|
|
return txPower;
|
|
}
|
|
|
|
VOID
|
|
PHY_SetTxPowerIndex(
|
|
IN PADAPTER pAdapter,
|
|
IN u32 PowerIndex,
|
|
IN u8 RFPath,
|
|
IN u8 Rate
|
|
)
|
|
{
|
|
if (IS_HARDWARE_TYPE_8814A(pAdapter)) {
|
|
#if (RTL8814A_SUPPORT == 1)
|
|
PHY_SetTxPowerIndex_8814A(pAdapter, PowerIndex, RFPath, Rate);
|
|
#endif
|
|
}
|
|
else if (IS_HARDWARE_TYPE_JAGUAR(pAdapter)) {
|
|
#if ((RTL8812A_SUPPORT==1) || (RTL8821A_SUPPORT == 1))
|
|
PHY_SetTxPowerIndex_8812A( pAdapter, PowerIndex, RFPath, Rate );
|
|
#endif
|
|
}
|
|
else if (IS_HARDWARE_TYPE_8723B(pAdapter)) {
|
|
#if (RTL8723B_SUPPORT==1)
|
|
PHY_SetTxPowerIndex_8723B( pAdapter, PowerIndex, RFPath, Rate );
|
|
#endif
|
|
}
|
|
else if (IS_HARDWARE_TYPE_8703B(pAdapter)) {
|
|
#if (RTL8703B_SUPPORT==1)
|
|
PHY_SetTxPowerIndex_8703B( pAdapter, PowerIndex, RFPath, Rate );
|
|
#endif
|
|
}
|
|
else if (IS_HARDWARE_TYPE_8192E(pAdapter)) {
|
|
#if (RTL8192E_SUPPORT==1)
|
|
PHY_SetTxPowerIndex_8192E( pAdapter, PowerIndex, RFPath, Rate );
|
|
#endif
|
|
}
|
|
else if (IS_HARDWARE_TYPE_8188E(pAdapter)) {
|
|
#if (RTL8188E_SUPPORT==1)
|
|
PHY_SetTxPowerIndex_8188E( pAdapter, PowerIndex, RFPath, Rate );
|
|
#endif
|
|
} else if (IS_HARDWARE_TYPE_8188F(pAdapter)) {
|
|
#if (RTL8188F_SUPPORT == 1)
|
|
PHY_SetTxPowerIndex_8188F(pAdapter, PowerIndex, RFPath, Rate);
|
|
#endif
|
|
}
|
|
}
|
|
|
|
void dump_tx_power_by_rate_base(void *sel, _adapter *adapter)
|
|
{
|
|
struct hal_spec_t *hal_spec = GET_HAL_SPEC(adapter);
|
|
HAL_DATA_TYPE *hal_data = GET_HAL_DATA(adapter);
|
|
int path, tx_num, band, rs;
|
|
|
|
for (band = BAND_ON_2_4G; band <= BAND_ON_5G; band++) {
|
|
/* TODO: hal capbility to distinguish 2.4G/5G support */
|
|
if (band == BAND_ON_5G && !(IS_HARDWARE_TYPE_JAGUAR_AND_JAGUAR2(adapter) || IS_HARDWARE_TYPE_8192D(adapter)))
|
|
continue;
|
|
|
|
for (path = 0; path < RF_PATH_MAX; path++) {
|
|
if (path >= hal_data->NumTotalRFPath)
|
|
break;
|
|
|
|
DBG_871X_SEL_NL(sel, "[%sG][%c]\n", (band == BAND_ON_2_4G ? "2.4" : "5"), rf_path_char(path));
|
|
|
|
for (rs = 0; rs < RATE_SECTION_NUM; rs++) {
|
|
tx_num = rate_section_to_tx_num(rs);
|
|
if (tx_num >= hal_spec->nss_num)
|
|
continue;
|
|
|
|
if (band == BAND_ON_5G && IS_CCK_RATE_SECTION(rs))
|
|
continue;
|
|
|
|
if (IS_VHT_RATE_SECTION(rs) && !IS_HARDWARE_TYPE_JAGUAR_AND_JAGUAR2(adapter))
|
|
continue;
|
|
|
|
DBG_871X_SEL_NL(sel, "%7s: %3d\n"
|
|
, rate_section_str(rs)
|
|
, PHY_GetTxPowerByRateBase(adapter, band, path, tx_num, rs)
|
|
);
|
|
}
|
|
}
|
|
}
|
|
}
|
|
|
|
void dump_tx_power_by_rate(void *sel, _adapter *adapter)
|
|
{
|
|
struct hal_spec_t *hal_spec = GET_HAL_SPEC(adapter);
|
|
HAL_DATA_TYPE *hal_data = GET_HAL_DATA(adapter);
|
|
int path, tx_num, band, n, rs;
|
|
u8 rate_num, max_rate_num, base;
|
|
s8 by_rate_offset;
|
|
|
|
for (band = BAND_ON_2_4G; band <= BAND_ON_5G; band++) {
|
|
/* TODO: hal capbility to distinguish 2.4G/5G support */
|
|
if (band == BAND_ON_5G && !(IS_HARDWARE_TYPE_JAGUAR_AND_JAGUAR2(adapter) || IS_HARDWARE_TYPE_8192D(adapter)))
|
|
continue;
|
|
|
|
for (path = 0; path < RF_PATH_MAX; path++) {
|
|
if (path >= hal_data->NumTotalRFPath)
|
|
break;
|
|
|
|
DBG_871X_SEL_NL(sel, "[%sG][%c]\n", (band == BAND_ON_2_4G ? "2.4" : "5"), rf_path_char(path));
|
|
|
|
for (rs = 0; rs < RATE_SECTION_NUM; rs++) {
|
|
tx_num = rate_section_to_tx_num(rs);
|
|
if (tx_num >= hal_spec->nss_num)
|
|
continue;
|
|
|
|
if (band == BAND_ON_5G && IS_CCK_RATE_SECTION(rs))
|
|
continue;
|
|
|
|
if (IS_VHT_RATE_SECTION(rs) && !IS_HARDWARE_TYPE_JAGUAR_AND_JAGUAR2(adapter))
|
|
continue;
|
|
|
|
if (IS_HARDWARE_TYPE_JAGUAR_AND_JAGUAR2(adapter))
|
|
max_rate_num = 10;
|
|
else
|
|
max_rate_num = 8;
|
|
rate_num = rate_section_rate_num(rs);
|
|
base = PHY_GetTxPowerByRateBase(adapter, band, path, tx_num, rs);
|
|
|
|
DBG_871X_SEL_NL(sel, "%7s: ", rate_section_str(rs));
|
|
|
|
/* dump power by rate in db */
|
|
for (n = rate_num - 1; n >= 0; n--) {
|
|
by_rate_offset = PHY_GetTxPowerByRate(adapter, band, path, tx_num, rates_by_sections[rs].rates[n]);
|
|
|
|
if ((base + by_rate_offset) % 2)
|
|
DBG_871X_SEL(sel, "%2d.5 ", (base + by_rate_offset) / 2);
|
|
else
|
|
DBG_871X_SEL(sel, "%4d ", (base + by_rate_offset) / 2);
|
|
}
|
|
for (n = 0; n < max_rate_num - rate_num; n++)
|
|
DBG_871X_SEL(sel, "%4s ", "");
|
|
|
|
DBG_871X_SEL(sel, "|");
|
|
|
|
/* dump power by rate in offset */
|
|
for (n = rate_num - 1; n >= 0; n--) {
|
|
by_rate_offset = PHY_GetTxPowerByRate(adapter, band, path, tx_num, rates_by_sections[rs].rates[n]);
|
|
DBG_871X_SEL(sel, "%3d ", by_rate_offset);
|
|
}
|
|
DBG_871X_SEL_NL(sel, "\n");
|
|
|
|
}
|
|
}
|
|
}
|
|
}
|
|
|
|
void dump_tx_power_limit(void *sel, _adapter *adapter)
|
|
{
|
|
struct hal_spec_t *hal_spec = GET_HAL_SPEC(adapter);
|
|
HAL_DATA_TYPE *hal_data = GET_HAL_DATA(adapter);
|
|
struct registry_priv *regsty = dvobj_to_regsty(adapter_to_dvobj(adapter));
|
|
|
|
int bw, band, ch_num, rs, i, path;
|
|
u8 ch, n, rd;
|
|
|
|
if (IS_HARDWARE_TYPE_JAGUAR_AND_JAGUAR2(adapter))
|
|
DBG_871X_SEL_NL(sel, "tx_pwr_lmt_5g_20_40_ref:0x%02x\n", hal_data->tx_pwr_lmt_5g_20_40_ref);
|
|
|
|
for (band = BAND_ON_2_4G; band <= BAND_ON_5G; band++) {
|
|
/* TODO: hal capbility to distinguish 2.4G/5G support */
|
|
if (band == BAND_ON_5G && !IS_HARDWARE_TYPE_JAGUAR_AND_JAGUAR2(adapter))
|
|
continue;
|
|
|
|
rd = (band == BAND_ON_2_4G ? hal_data->Regulation2_4G : hal_data->Regulation5G);
|
|
|
|
for (bw = 0; bw < MAX_5G_BANDWIDTH_NUM; bw++) {
|
|
/* TODO: hal capbility to distinguish bandwidth support */
|
|
|
|
if (bw >= CHANNEL_WIDTH_160)
|
|
break;
|
|
if (band == BAND_ON_2_4G && bw >= CHANNEL_WIDTH_80)
|
|
break;
|
|
|
|
if (band == BAND_ON_2_4G)
|
|
ch_num = CENTER_CH_2G_NUM;
|
|
else
|
|
ch_num = center_chs_5g_num(bw);
|
|
|
|
if (ch_num == 0) {
|
|
rtw_warn_on(1);
|
|
break;
|
|
}
|
|
|
|
for (rs = 0; rs < RATE_SECTION_NUM; rs++) {
|
|
if (band == BAND_ON_2_4G && IS_VHT_RATE_SECTION(rs))
|
|
continue;
|
|
if (band == BAND_ON_5G && IS_CCK_RATE_SECTION(rs))
|
|
continue;
|
|
if (bw > CHANNEL_WIDTH_20 && (IS_CCK_RATE_SECTION(rs) || IS_OFDM_RATE_SECTION(rs)))
|
|
continue;
|
|
if (bw > CHANNEL_WIDTH_40 && IS_HT_RATE_SECTION(rs))
|
|
continue;
|
|
|
|
if (rate_section_to_tx_num(rs) >= hal_spec->nss_num)
|
|
continue;
|
|
|
|
if (IS_VHT_RATE_SECTION(rs) && !IS_HARDWARE_TYPE_JAGUAR_AND_JAGUAR2(adapter))
|
|
continue;
|
|
|
|
/* by pass 5G 20M, 40M pure reference */
|
|
if (band == BAND_ON_5G && (bw == CHANNEL_WIDTH_20 || bw == CHANNEL_WIDTH_40)) {
|
|
if (hal_data->tx_pwr_lmt_5g_20_40_ref == TX_PWR_LMT_REF_HT_FROM_VHT) {
|
|
if (IS_HT_RATE_SECTION(rs))
|
|
continue;
|
|
} else if (hal_data->tx_pwr_lmt_5g_20_40_ref == TX_PWR_LMT_REF_VHT_FROM_HT) {
|
|
if (IS_VHT_RATE_SECTION(rs) && bw <= CHANNEL_WIDTH_40)
|
|
continue;
|
|
}
|
|
}
|
|
|
|
DBG_871X_SEL_NL(sel, "[%sG][%s][%s]\n"
|
|
, (band == BAND_ON_2_4G ? "2.4" : "5")
|
|
, ch_width_str(bw)
|
|
, rate_section_str(rs)
|
|
);
|
|
|
|
/* header for limit in db */
|
|
DBG_871X_SEL_NL(sel, "%3s %5s %5s %5s %5s "
|
|
, "ch"
|
|
, (rd == TXPWR_LMT_FCC ? "*FCC" : "FCC")
|
|
, (rd == TXPWR_LMT_ETSI ? "*ETSI" : "ETSI")
|
|
, (rd == TXPWR_LMT_MKK ? "*MKK" : "MKK")
|
|
, (rd == TXPWR_LMT_WW ? "*WW" : "WW")
|
|
);
|
|
|
|
/* header for limit offset */
|
|
for (path = 0; path < RF_PATH_MAX; path++) {
|
|
if (path >= hal_data->NumTotalRFPath)
|
|
break;
|
|
DBG_871X_SEL(sel, "|%3c %3c %3c %3c "
|
|
, (rd == TXPWR_LMT_FCC ? rf_path_char(path) : ' ')
|
|
, (rd == TXPWR_LMT_ETSI ? rf_path_char(path) : ' ')
|
|
, (rd == TXPWR_LMT_MKK ? rf_path_char(path) : ' ')
|
|
, (rd == TXPWR_LMT_WW ? rf_path_char(path) : ' ')
|
|
);
|
|
}
|
|
DBG_871X_SEL(sel, "\n");
|
|
|
|
for (n = 0; n < ch_num; n++) {
|
|
s8 limit_idx[RF_PATH_MAX][MAX_REGULATION_NUM];
|
|
s8 limit_offset[MAX_REGULATION_NUM];
|
|
u8 base;
|
|
|
|
if (band == BAND_ON_2_4G)
|
|
ch = n + 1;
|
|
else
|
|
ch = center_chs_5g(bw, n);
|
|
|
|
if (ch == 0) {
|
|
rtw_warn_on(1);
|
|
break;
|
|
}
|
|
|
|
/* dump limit in db (calculate from path A) */
|
|
limit_offset[0] = PHY_GetTxPowerLimit(adapter, 3, band, bw, RF_PATH_A, rates_by_sections[rs].rates[0], ch); /* FCC */
|
|
limit_offset[1] = PHY_GetTxPowerLimit(adapter, 1, band, bw, RF_PATH_A, rates_by_sections[rs].rates[0], ch); /* ETSI */
|
|
limit_offset[2] = PHY_GetTxPowerLimit(adapter, 2, band, bw, RF_PATH_A, rates_by_sections[rs].rates[0], ch); /* MKK */
|
|
limit_offset[3] = PHY_GetTxPowerLimit(adapter, 4, band, bw, RF_PATH_A, rates_by_sections[rs].rates[0], ch); /* WW */
|
|
|
|
base = PHY_GetTxPowerByRateBase(adapter, band, RF_PATH_A, rate_section_to_tx_num(rs), rs);
|
|
|
|
DBG_871X_SEL_NL(sel, "%3u ", ch);
|
|
for (i = 0; i < MAX_REGULATION_NUM; i++) {
|
|
if (limit_offset[i] == MAX_POWER_INDEX) {
|
|
limit_idx[0][i] = MAX_POWER_INDEX;
|
|
DBG_871X_SEL(sel, "%5s ", "NA");
|
|
} else {
|
|
limit_idx[0][i] = limit_offset[i] + base;
|
|
if ((limit_offset[i] + base) % 2)
|
|
DBG_871X_SEL(sel, "%3d.5 ", (limit_offset[i] + base) / 2);
|
|
else
|
|
DBG_871X_SEL(sel, "%5d ", (limit_offset[i] + base) / 2);
|
|
}
|
|
}
|
|
|
|
/* dump limit offset of each path */
|
|
for (path = 0; path < RF_PATH_MAX; path++) {
|
|
if (path >= hal_data->NumTotalRFPath)
|
|
break;
|
|
limit_offset[0] = PHY_GetTxPowerLimit(adapter, 3, band, bw, path, rates_by_sections[rs].rates[0], ch); /* FCC */
|
|
limit_offset[1] = PHY_GetTxPowerLimit(adapter, 1, band, bw, path, rates_by_sections[rs].rates[0], ch); /* ETSI */
|
|
limit_offset[2] = PHY_GetTxPowerLimit(adapter, 2, band, bw, path, rates_by_sections[rs].rates[0], ch); /* MKK */
|
|
limit_offset[3] = PHY_GetTxPowerLimit(adapter, 4, band, bw, path, rates_by_sections[rs].rates[0], ch); /* WW */
|
|
|
|
base = PHY_GetTxPowerByRateBase(adapter, band, path, rate_section_to_tx_num(rs), rs);
|
|
|
|
DBG_871X_SEL(sel, "|");
|
|
for (i = 0; i < MAX_REGULATION_NUM; i++) {
|
|
if (limit_offset[i] == MAX_POWER_INDEX) {
|
|
limit_idx[path][i] = MAX_POWER_INDEX;
|
|
DBG_871X_SEL(sel, "%3s ", "NA");
|
|
} else {
|
|
limit_idx[path][i] = limit_offset[i] + base;
|
|
DBG_871X_SEL(sel, "%3d ", limit_offset[i]);
|
|
}
|
|
}
|
|
}
|
|
|
|
/* compare limit_idx of each path, print 'x' when mismatch */
|
|
if (hal_data->NumTotalRFPath > 1) {
|
|
for (i = 0; i < MAX_REGULATION_NUM; i++) {
|
|
for (path = 0; path < RF_PATH_MAX; path++) {
|
|
if (path >= hal_data->NumTotalRFPath)
|
|
break;
|
|
if (limit_idx[path][i] != limit_idx[(path + 1) % hal_data->NumTotalRFPath][i])
|
|
break;
|
|
}
|
|
if (path >= hal_data->NumTotalRFPath)
|
|
DBG_871X_SEL(sel, " ");
|
|
else
|
|
DBG_871X_SEL(sel, "x");
|
|
}
|
|
}
|
|
DBG_871X_SEL(sel, "\n");
|
|
|
|
}
|
|
DBG_871X_SEL_NL(sel, "\n");
|
|
}
|
|
}
|
|
}
|
|
}
|
|
|
|
#ifdef CONFIG_LOAD_PHY_PARA_FROM_FILE
|
|
int
|
|
phy_ConfigMACWithParaFile(
|
|
IN PADAPTER Adapter,
|
|
IN char* pFileName
|
|
)
|
|
{
|
|
PHAL_DATA_TYPE pHalData = GET_HAL_DATA(Adapter);
|
|
int rlen = 0, rtStatus = _FAIL;
|
|
char *szLine, *ptmp;
|
|
u32 u4bRegOffset, u4bRegValue, u4bMove;
|
|
|
|
if(!(Adapter->registrypriv.load_phy_file & LOAD_MAC_PARA_FILE))
|
|
return rtStatus;
|
|
|
|
_rtw_memset(pHalData->para_file_buf, 0, MAX_PARA_FILE_BUF_LEN);
|
|
|
|
if ((pHalData->mac_reg_len == 0) && (pHalData->mac_reg == NULL))
|
|
{
|
|
rtw_merge_string(rtw_phy_para_file_path, PATH_LENGTH_MAX, rtw_phy_file_path, pFileName);
|
|
|
|
if (rtw_is_file_readable(rtw_phy_para_file_path) == _TRUE)
|
|
{
|
|
rlen = rtw_retrieve_from_file(rtw_phy_para_file_path, pHalData->para_file_buf, MAX_PARA_FILE_BUF_LEN);
|
|
if (rlen > 0)
|
|
{
|
|
rtStatus = _SUCCESS;
|
|
pHalData->mac_reg = rtw_zvmalloc(rlen);
|
|
if(pHalData->mac_reg) {
|
|
_rtw_memcpy(pHalData->mac_reg, pHalData->para_file_buf, rlen);
|
|
pHalData->mac_reg_len = rlen;
|
|
}
|
|
else {
|
|
DBG_871X("%s mac_reg alloc fail !\n",__FUNCTION__);
|
|
}
|
|
}
|
|
}
|
|
}
|
|
else
|
|
{
|
|
if ((pHalData->mac_reg_len != 0) && (pHalData->mac_reg != NULL)) {
|
|
_rtw_memcpy(pHalData->para_file_buf, pHalData->mac_reg, pHalData->mac_reg_len);
|
|
rtStatus = _SUCCESS;
|
|
}
|
|
else {
|
|
DBG_871X("%s(): Critical Error !!!\n",__FUNCTION__);
|
|
}
|
|
}
|
|
|
|
if (rtStatus == _SUCCESS)
|
|
{
|
|
ptmp = pHalData->para_file_buf;
|
|
for (szLine = GetLineFromBuffer(ptmp); szLine != NULL; szLine = GetLineFromBuffer(ptmp))
|
|
{
|
|
if(!IsCommentString(szLine))
|
|
{
|
|
// Get 1st hex value as register offset
|
|
if(GetHexValueFromString(szLine, &u4bRegOffset, &u4bMove))
|
|
{
|
|
if(u4bRegOffset == 0xffff)
|
|
{ // Ending.
|
|
break;
|
|
}
|
|
|
|
// Get 2nd hex value as register value.
|
|
szLine += u4bMove;
|
|
if(GetHexValueFromString(szLine, &u4bRegValue, &u4bMove))
|
|
{
|
|
rtw_write8(Adapter, u4bRegOffset, (u8)u4bRegValue);
|
|
}
|
|
}
|
|
}
|
|
}
|
|
}
|
|
else
|
|
{
|
|
DBG_871X("%s(): No File %s, Load from HWImg Array!\n", __FUNCTION__, pFileName);
|
|
}
|
|
|
|
return rtStatus;
|
|
}
|
|
|
|
int
|
|
phy_ConfigBBWithParaFile(
|
|
IN PADAPTER Adapter,
|
|
IN char* pFileName,
|
|
IN u32 ConfigType
|
|
)
|
|
{
|
|
HAL_DATA_TYPE *pHalData = GET_HAL_DATA(Adapter);
|
|
int rlen = 0, rtStatus = _FAIL;
|
|
char *szLine, *ptmp;
|
|
u32 u4bRegOffset, u4bRegValue, u4bMove;
|
|
char *pBuf = NULL;
|
|
u32 *pBufLen = NULL;
|
|
|
|
if(!(Adapter->registrypriv.load_phy_file & LOAD_BB_PARA_FILE))
|
|
return rtStatus;
|
|
|
|
switch(ConfigType)
|
|
{
|
|
case CONFIG_BB_PHY_REG:
|
|
pBuf = pHalData->bb_phy_reg;
|
|
pBufLen = &pHalData->bb_phy_reg_len;
|
|
break;
|
|
case CONFIG_BB_AGC_TAB:
|
|
pBuf = pHalData->bb_agc_tab;
|
|
pBufLen = &pHalData->bb_agc_tab_len;
|
|
break;
|
|
default:
|
|
DBG_871X("Unknown ConfigType!! %d\r\n", ConfigType);
|
|
break;
|
|
}
|
|
|
|
_rtw_memset(pHalData->para_file_buf, 0, MAX_PARA_FILE_BUF_LEN);
|
|
|
|
if ((pBufLen != NULL) && (*pBufLen == 0) && (pBuf == NULL))
|
|
{
|
|
rtw_merge_string(rtw_phy_para_file_path, PATH_LENGTH_MAX, rtw_phy_file_path, pFileName);
|
|
|
|
if (rtw_is_file_readable(rtw_phy_para_file_path) == _TRUE)
|
|
{
|
|
rlen = rtw_retrieve_from_file(rtw_phy_para_file_path, pHalData->para_file_buf, MAX_PARA_FILE_BUF_LEN);
|
|
if (rlen > 0)
|
|
{
|
|
rtStatus = _SUCCESS;
|
|
pBuf = rtw_zvmalloc(rlen);
|
|
if(pBuf) {
|
|
_rtw_memcpy(pBuf, pHalData->para_file_buf, rlen);
|
|
*pBufLen = rlen;
|
|
|
|
switch(ConfigType)
|
|
{
|
|
case CONFIG_BB_PHY_REG:
|
|
pHalData->bb_phy_reg = pBuf;
|
|
break;
|
|
case CONFIG_BB_AGC_TAB:
|
|
pHalData->bb_agc_tab = pBuf;
|
|
break;
|
|
}
|
|
}
|
|
else {
|
|
DBG_871X("%s(): ConfigType %d alloc fail !\n",__FUNCTION__,ConfigType);
|
|
}
|
|
}
|
|
}
|
|
}
|
|
else
|
|
{
|
|
if ((pBufLen != NULL) && (*pBufLen == 0) && (pBuf == NULL)) {
|
|
_rtw_memcpy(pHalData->para_file_buf, pBuf, *pBufLen);
|
|
rtStatus = _SUCCESS;
|
|
}
|
|
else {
|
|
DBG_871X("%s(): Critical Error !!!\n",__FUNCTION__);
|
|
}
|
|
}
|
|
|
|
if (rtStatus == _SUCCESS)
|
|
{
|
|
ptmp = pHalData->para_file_buf;
|
|
for (szLine = GetLineFromBuffer(ptmp); szLine != NULL; szLine = GetLineFromBuffer(ptmp))
|
|
{
|
|
if(!IsCommentString(szLine))
|
|
{
|
|
// Get 1st hex value as register offset.
|
|
if(GetHexValueFromString(szLine, &u4bRegOffset, &u4bMove))
|
|
{
|
|
if(u4bRegOffset == 0xffff)
|
|
{ // Ending.
|
|
break;
|
|
}
|
|
else if (u4bRegOffset == 0xfe || u4bRegOffset == 0xffe)
|
|
{
|
|
#ifdef CONFIG_LONG_DELAY_ISSUE
|
|
rtw_msleep_os(50);
|
|
#else
|
|
rtw_mdelay_os(50);
|
|
#endif
|
|
}
|
|
else if (u4bRegOffset == 0xfd)
|
|
{
|
|
rtw_mdelay_os(5);
|
|
}
|
|
else if (u4bRegOffset == 0xfc)
|
|
{
|
|
rtw_mdelay_os(1);
|
|
}
|
|
else if (u4bRegOffset == 0xfb)
|
|
{
|
|
rtw_udelay_os(50);
|
|
}
|
|
else if (u4bRegOffset == 0xfa)
|
|
{
|
|
rtw_udelay_os(5);
|
|
}
|
|
else if (u4bRegOffset == 0xf9)
|
|
{
|
|
rtw_udelay_os(1);
|
|
}
|
|
|
|
// Get 2nd hex value as register value.
|
|
szLine += u4bMove;
|
|
if(GetHexValueFromString(szLine, &u4bRegValue, &u4bMove))
|
|
{
|
|
//DBG_871X("[BB-ADDR]%03lX=%08lX\n", u4bRegOffset, u4bRegValue);
|
|
PHY_SetBBReg(Adapter, u4bRegOffset, bMaskDWord, u4bRegValue);
|
|
|
|
if (u4bRegOffset == 0xa24)
|
|
pHalData->odmpriv.RFCalibrateInfo.RegA24 = u4bRegValue;
|
|
|
|
// Add 1us delay between BB/RF register setting.
|
|
rtw_udelay_os(1);
|
|
}
|
|
}
|
|
}
|
|
}
|
|
}
|
|
else
|
|
{
|
|
DBG_871X("%s(): No File %s, Load from HWImg Array!\n", __FUNCTION__, pFileName);
|
|
}
|
|
|
|
return rtStatus;
|
|
}
|
|
|
|
VOID
|
|
phy_DecryptBBPgParaFile(
|
|
PADAPTER Adapter,
|
|
char* buffer
|
|
)
|
|
{
|
|
u32 i = 0, j = 0;
|
|
u8 map[95] = {0};
|
|
u8 currentChar;
|
|
char *BufOfLines, *ptmp;
|
|
|
|
//DBG_871X("=====>phy_DecryptBBPgParaFile()\n");
|
|
// 32 the ascii code of the first visable char, 126 the last one
|
|
for ( i = 0; i < 95; ++i )
|
|
map[i] = ( u8 ) ( 94 - i );
|
|
|
|
ptmp = buffer;
|
|
i = 0;
|
|
for (BufOfLines = GetLineFromBuffer(ptmp); BufOfLines != NULL; BufOfLines = GetLineFromBuffer(ptmp))
|
|
{
|
|
//DBG_871X("Encrypted Line: %s\n", BufOfLines);
|
|
|
|
for ( j = 0; j < strlen(BufOfLines); ++j )
|
|
{
|
|
currentChar = BufOfLines[j];
|
|
|
|
if ( currentChar == '\0' )
|
|
break;
|
|
|
|
currentChar -= (u8) ( ( ( ( i + j ) * 3 ) % 128 ) );
|
|
|
|
BufOfLines[j] = map[currentChar - 32] + 32;
|
|
}
|
|
//DBG_871X("Decrypted Line: %s\n", BufOfLines );
|
|
if (strlen(BufOfLines) != 0)
|
|
i++;
|
|
BufOfLines[strlen(BufOfLines)] = '\n';
|
|
}
|
|
}
|
|
|
|
int
|
|
phy_ParseBBPgParaFile(
|
|
PADAPTER Adapter,
|
|
char* buffer
|
|
)
|
|
{
|
|
int rtStatus = _SUCCESS;
|
|
HAL_DATA_TYPE *pHalData = GET_HAL_DATA(Adapter);
|
|
char *szLine, *ptmp;
|
|
u32 u4bRegOffset, u4bRegMask, u4bRegValue;
|
|
u32 u4bMove;
|
|
BOOLEAN firstLine = _TRUE;
|
|
u8 tx_num = 0;
|
|
u8 band = 0, rf_path = 0;
|
|
|
|
//DBG_871X("=====>phy_ParseBBPgParaFile()\n");
|
|
|
|
if ( Adapter->registrypriv.RegDecryptCustomFile == 1 )
|
|
phy_DecryptBBPgParaFile( Adapter, buffer);
|
|
|
|
ptmp = buffer;
|
|
for (szLine = GetLineFromBuffer(ptmp); szLine != NULL; szLine = GetLineFromBuffer(ptmp))
|
|
{
|
|
if(!IsCommentString(szLine))
|
|
{
|
|
if( isAllSpaceOrTab( szLine, sizeof( *szLine ) ) )
|
|
continue;
|
|
|
|
// Get header info (relative value or exact value)
|
|
if ( firstLine )
|
|
{
|
|
if ( eqNByte( szLine, (u8 *)("#[v1]"), 5 ) )
|
|
{
|
|
|
|
pHalData->odmpriv.PhyRegPgVersion = szLine[3] - '0';
|
|
//DBG_871X("This is a new format PHY_REG_PG.txt \n");
|
|
}
|
|
else if ( eqNByte( szLine, (u8 *)("#[v0]"), 5 ))
|
|
{
|
|
pHalData->odmpriv.PhyRegPgVersion = szLine[3] - '0';
|
|
//DBG_871X("This is a old format PHY_REG_PG.txt ok\n");
|
|
}
|
|
else
|
|
{
|
|
DBG_871X("The format in PHY_REG_PG are invalid %s\n", szLine);
|
|
return _FAIL;
|
|
}
|
|
|
|
if ( eqNByte( szLine + 5, (u8 *)("[Exact]#"), 8 ) )
|
|
{
|
|
pHalData->odmpriv.PhyRegPgValueType = PHY_REG_PG_EXACT_VALUE;
|
|
//DBG_871X("The values in PHY_REG_PG are exact values ok\n");
|
|
firstLine = _FALSE;
|
|
continue;
|
|
}
|
|
else if ( eqNByte( szLine + 5, (pu1Byte)("[Relative]#"), 11 ) )
|
|
{
|
|
pHalData->odmpriv.PhyRegPgValueType = PHY_REG_PG_RELATIVE_VALUE;
|
|
//DBG_871X("The values in PHY_REG_PG are relative values ok\n");
|
|
firstLine = _FALSE;
|
|
continue;
|
|
}
|
|
else
|
|
{
|
|
DBG_871X("The values in PHY_REG_PG are invalid %s\n", szLine);
|
|
return _FAIL;
|
|
}
|
|
}
|
|
|
|
if ( pHalData->odmpriv.PhyRegPgVersion == 0 )
|
|
{
|
|
// Get 1st hex value as register offset.
|
|
if(GetHexValueFromString(szLine, &u4bRegOffset, &u4bMove))
|
|
{
|
|
szLine += u4bMove;
|
|
if(u4bRegOffset == 0xffff)
|
|
{ // Ending.
|
|
break;
|
|
}
|
|
|
|
// Get 2nd hex value as register mask.
|
|
if ( GetHexValueFromString(szLine, &u4bRegMask, &u4bMove) )
|
|
szLine += u4bMove;
|
|
else
|
|
return _FAIL;
|
|
|
|
if ( pHalData->odmpriv.PhyRegPgValueType == PHY_REG_PG_RELATIVE_VALUE )
|
|
{
|
|
// Get 3rd hex value as register value.
|
|
if(GetHexValueFromString(szLine, &u4bRegValue, &u4bMove))
|
|
{
|
|
PHY_StoreTxPowerByRate(Adapter, 0, 0, 1, u4bRegOffset, u4bRegMask, u4bRegValue);
|
|
//DBG_871X("[ADDR] %03X=%08X Mask=%08x\n", u4bRegOffset, u4bRegValue, u4bRegMask);
|
|
}
|
|
else
|
|
{
|
|
return _FAIL;
|
|
}
|
|
}
|
|
else if ( pHalData->odmpriv.PhyRegPgValueType == PHY_REG_PG_EXACT_VALUE )
|
|
{
|
|
u32 combineValue = 0;
|
|
u8 integer = 0, fraction = 0;
|
|
|
|
if ( GetFractionValueFromString( szLine, &integer, &fraction, &u4bMove ) )
|
|
szLine += u4bMove;
|
|
else
|
|
return _FAIL;
|
|
|
|
integer *= 2;
|
|
if ( fraction == 5 ) integer += 1;
|
|
combineValue |= ( ( ( integer / 10 ) << 4 ) + ( integer % 10 ) );
|
|
//DBG_871X(" %d", integer );
|
|
|
|
if ( GetFractionValueFromString( szLine, &integer, &fraction, &u4bMove ) )
|
|
szLine += u4bMove;
|
|
else
|
|
return _FAIL;
|
|
|
|
integer *= 2;
|
|
if ( fraction == 5 ) integer += 1;
|
|
combineValue <<= 8;
|
|
combineValue |= ( ( ( integer / 10 ) << 4 ) + ( integer % 10 ) );
|
|
//DBG_871X(" %d", integer );
|
|
|
|
if ( GetFractionValueFromString( szLine, &integer, &fraction, &u4bMove ) )
|
|
szLine += u4bMove;
|
|
else
|
|
return _FAIL;
|
|
|
|
integer *= 2;
|
|
if ( fraction == 5 ) integer += 1;
|
|
combineValue <<= 8;
|
|
combineValue |= ( ( ( integer / 10 ) << 4 ) + ( integer % 10 ) );
|
|
//DBG_871X(" %d", integer );
|
|
|
|
if ( GetFractionValueFromString( szLine, &integer, &fraction, &u4bMove ) )
|
|
szLine += u4bMove;
|
|
else
|
|
return _FAIL;
|
|
|
|
integer *= 2;
|
|
if ( fraction == 5 ) integer += 1;
|
|
combineValue <<= 8;
|
|
combineValue |= ( ( ( integer / 10 ) << 4 ) + ( integer % 10 ) );
|
|
//DBG_871X(" %d", integer );
|
|
PHY_StoreTxPowerByRate(Adapter, 0, 0, 1, u4bRegOffset, u4bRegMask, combineValue);
|
|
|
|
//DBG_871X("[ADDR] 0x%3x = 0x%4x\n", u4bRegOffset, combineValue );
|
|
}
|
|
}
|
|
}
|
|
else if ( pHalData->odmpriv.PhyRegPgVersion > 0 )
|
|
{
|
|
u32 index = 0, cnt = 0;
|
|
|
|
if ( eqNByte( szLine, "0xffff", 6 ) )
|
|
break;
|
|
|
|
if( !eqNByte( "#[END]#", szLine, 7 ) )
|
|
{
|
|
// load the table label info
|
|
if ( szLine[0] == '#' )
|
|
{
|
|
index = 0;
|
|
if ( eqNByte( szLine, "#[2.4G]" , 7 ) )
|
|
{
|
|
band = BAND_ON_2_4G;
|
|
index += 8;
|
|
}
|
|
else if ( eqNByte( szLine, "#[5G]", 5) )
|
|
{
|
|
band = BAND_ON_5G;
|
|
index += 6;
|
|
}
|
|
else
|
|
{
|
|
DBG_871X("Invalid band %s in PHY_REG_PG.txt \n", szLine );
|
|
return _FAIL;
|
|
}
|
|
|
|
rf_path= szLine[index] - 'A';
|
|
//DBG_871X(" Table label Band %d, RfPath %d\n", band, rf_path );
|
|
}
|
|
else // load rows of tables
|
|
{
|
|
if ( szLine[1] == '1' )
|
|
tx_num = RF_1TX;
|
|
else if ( szLine[1] == '2' )
|
|
tx_num = RF_2TX;
|
|
else if ( szLine[1] == '3' )
|
|
tx_num = RF_3TX;
|
|
else if ( szLine[1] == '4' )
|
|
tx_num = RF_4TX;
|
|
else
|
|
{
|
|
DBG_871X("Invalid row in PHY_REG_PG.txt %c\n", szLine[1] );
|
|
return _FAIL;
|
|
}
|
|
|
|
while ( szLine[index] != ']' )
|
|
++index;
|
|
++index;// skip ]
|
|
|
|
// Get 2nd hex value as register offset.
|
|
szLine += index;
|
|
if ( GetHexValueFromString(szLine, &u4bRegOffset, &u4bMove) )
|
|
szLine += u4bMove;
|
|
else
|
|
return _FAIL;
|
|
|
|
// Get 2nd hex value as register mask.
|
|
if ( GetHexValueFromString(szLine, &u4bRegMask, &u4bMove) )
|
|
szLine += u4bMove;
|
|
else
|
|
return _FAIL;
|
|
|
|
if ( pHalData->odmpriv.PhyRegPgValueType == PHY_REG_PG_RELATIVE_VALUE )
|
|
{
|
|
// Get 3rd hex value as register value.
|
|
if(GetHexValueFromString(szLine, &u4bRegValue, &u4bMove))
|
|
{
|
|
PHY_StoreTxPowerByRate(Adapter, band, rf_path, tx_num, u4bRegOffset, u4bRegMask, u4bRegValue);
|
|
//DBG_871X("[ADDR] %03X (tx_num %d) =%08X Mask=%08x\n", u4bRegOffset, tx_num, u4bRegValue, u4bRegMask);
|
|
}
|
|
else
|
|
{
|
|
return _FAIL;
|
|
}
|
|
}
|
|
else if ( pHalData->odmpriv.PhyRegPgValueType == PHY_REG_PG_EXACT_VALUE )
|
|
{
|
|
u32 combineValue = 0;
|
|
u8 integer = 0, fraction = 0;
|
|
|
|
if ( GetFractionValueFromString( szLine, &integer, &fraction, &u4bMove ) )
|
|
szLine += u4bMove;
|
|
else
|
|
return _FAIL;
|
|
|
|
integer *= 2;
|
|
if ( fraction == 5 ) integer += 1;
|
|
combineValue |= ( ( ( integer / 10 ) << 4 ) + ( integer % 10 ) );
|
|
//DBG_871X(" %d", integer );
|
|
|
|
if ( GetFractionValueFromString( szLine, &integer, &fraction, &u4bMove ) )
|
|
szLine += u4bMove;
|
|
else
|
|
return _FAIL;
|
|
|
|
integer *= 2;
|
|
if ( fraction == 5 ) integer += 1;
|
|
combineValue <<= 8;
|
|
combineValue |= ( ( ( integer / 10 ) << 4 ) + ( integer % 10 ) );
|
|
//DBG_871X(" %d", integer );
|
|
|
|
if ( GetFractionValueFromString( szLine, &integer, &fraction, &u4bMove ) )
|
|
szLine += u4bMove;
|
|
else
|
|
return _FAIL;
|
|
|
|
integer *= 2;
|
|
if ( fraction == 5 ) integer += 1;
|
|
combineValue <<= 8;
|
|
combineValue |= ( ( ( integer / 10 ) << 4 ) + ( integer % 10 ) );
|
|
//DBG_871X(" %d", integer );
|
|
|
|
if ( GetFractionValueFromString( szLine, &integer, &fraction, &u4bMove ) )
|
|
szLine += u4bMove;
|
|
else
|
|
return _FAIL;
|
|
|
|
integer *= 2;
|
|
if ( fraction == 5 ) integer += 1;
|
|
combineValue <<= 8;
|
|
combineValue |= ( ( ( integer / 10 ) << 4 ) + ( integer % 10 ) );
|
|
//DBG_871X(" %d", integer );
|
|
PHY_StoreTxPowerByRate(Adapter, band, rf_path, tx_num, u4bRegOffset, u4bRegMask, combineValue);
|
|
|
|
//DBG_871X("[ADDR] 0x%3x (tx_num %d) = 0x%4x\n", u4bRegOffset, tx_num, combineValue );
|
|
}
|
|
}
|
|
}
|
|
}
|
|
}
|
|
}
|
|
//DBG_871X("<=====phy_ParseBBPgParaFile()\n");
|
|
return rtStatus;
|
|
}
|
|
|
|
int
|
|
phy_ConfigBBWithPgParaFile(
|
|
IN PADAPTER Adapter,
|
|
IN char* pFileName)
|
|
{
|
|
HAL_DATA_TYPE *pHalData = GET_HAL_DATA(Adapter);
|
|
int rlen = 0, rtStatus = _FAIL;
|
|
|
|
if(!(Adapter->registrypriv.load_phy_file & LOAD_BB_PG_PARA_FILE))
|
|
return rtStatus;
|
|
|
|
_rtw_memset(pHalData->para_file_buf, 0, MAX_PARA_FILE_BUF_LEN);
|
|
|
|
if ((pHalData->bb_phy_reg_pg_len == 0) && (pHalData->bb_phy_reg_pg == NULL))
|
|
{
|
|
rtw_merge_string(rtw_phy_para_file_path, PATH_LENGTH_MAX, rtw_phy_file_path, pFileName);
|
|
|
|
if (rtw_is_file_readable(rtw_phy_para_file_path) == _TRUE)
|
|
{
|
|
rlen = rtw_retrieve_from_file(rtw_phy_para_file_path, pHalData->para_file_buf, MAX_PARA_FILE_BUF_LEN);
|
|
if (rlen > 0)
|
|
{
|
|
rtStatus = _SUCCESS;
|
|
pHalData->bb_phy_reg_pg = rtw_zvmalloc(rlen);
|
|
if(pHalData->bb_phy_reg_pg) {
|
|
_rtw_memcpy(pHalData->bb_phy_reg_pg, pHalData->para_file_buf, rlen);
|
|
pHalData->bb_phy_reg_pg_len = rlen;
|
|
}
|
|
else {
|
|
DBG_871X("%s bb_phy_reg_pg alloc fail !\n",__FUNCTION__);
|
|
}
|
|
}
|
|
}
|
|
}
|
|
else
|
|
{
|
|
if ((pHalData->bb_phy_reg_pg_len != 0) && (pHalData->bb_phy_reg_pg != NULL)) {
|
|
_rtw_memcpy(pHalData->para_file_buf, pHalData->bb_phy_reg_pg, pHalData->bb_phy_reg_pg_len);
|
|
rtStatus = _SUCCESS;
|
|
}
|
|
else {
|
|
DBG_871X("%s(): Critical Error !!!\n",__FUNCTION__);
|
|
}
|
|
}
|
|
|
|
if(rtStatus == _SUCCESS)
|
|
{
|
|
//DBG_871X("phy_ConfigBBWithPgParaFile(): read %s ok\n", pFileName);
|
|
phy_ParseBBPgParaFile(Adapter, pHalData->para_file_buf);
|
|
}
|
|
else
|
|
{
|
|
DBG_871X("%s(): No File %s, Load from HWImg Array!\n", __FUNCTION__, pFileName);
|
|
}
|
|
|
|
return rtStatus;
|
|
}
|
|
|
|
#if (MP_DRIVER == 1 )
|
|
|
|
int
|
|
phy_ConfigBBWithMpParaFile(
|
|
IN PADAPTER Adapter,
|
|
IN char* pFileName
|
|
)
|
|
{
|
|
HAL_DATA_TYPE *pHalData = GET_HAL_DATA(Adapter);
|
|
int rlen = 0, rtStatus = _FAIL;
|
|
char *szLine, *ptmp;
|
|
u32 u4bRegOffset, u4bRegValue, u4bMove;
|
|
|
|
if(!(Adapter->registrypriv.load_phy_file & LOAD_BB_MP_PARA_FILE))
|
|
return rtStatus;
|
|
|
|
_rtw_memset(pHalData->para_file_buf, 0, MAX_PARA_FILE_BUF_LEN);
|
|
|
|
if ((pHalData->bb_phy_reg_mp_len == 0) && (pHalData->bb_phy_reg_mp == NULL))
|
|
{
|
|
rtw_merge_string(rtw_phy_para_file_path, PATH_LENGTH_MAX, rtw_phy_file_path, pFileName);
|
|
|
|
if (rtw_is_file_readable(rtw_phy_para_file_path) == _TRUE)
|
|
{
|
|
rlen = rtw_retrieve_from_file(rtw_phy_para_file_path, pHalData->para_file_buf, MAX_PARA_FILE_BUF_LEN);
|
|
if (rlen > 0)
|
|
{
|
|
rtStatus = _SUCCESS;
|
|
pHalData->bb_phy_reg_mp = rtw_zvmalloc(rlen);
|
|
if(pHalData->bb_phy_reg_mp) {
|
|
_rtw_memcpy(pHalData->bb_phy_reg_mp, pHalData->para_file_buf, rlen);
|
|
pHalData->bb_phy_reg_mp_len = rlen;
|
|
}
|
|
else {
|
|
DBG_871X("%s bb_phy_reg_mp alloc fail !\n",__FUNCTION__);
|
|
}
|
|
}
|
|
}
|
|
}
|
|
else
|
|
{
|
|
if ((pHalData->bb_phy_reg_mp_len != 0) && (pHalData->bb_phy_reg_mp != NULL)) {
|
|
_rtw_memcpy(pHalData->para_file_buf, pHalData->bb_phy_reg_mp, pHalData->bb_phy_reg_mp_len);
|
|
rtStatus = _SUCCESS;
|
|
}
|
|
else {
|
|
DBG_871X("%s(): Critical Error !!!\n",__FUNCTION__);
|
|
}
|
|
}
|
|
|
|
if(rtStatus == _SUCCESS)
|
|
{
|
|
//DBG_871X("phy_ConfigBBWithMpParaFile(): read %s ok\n", pFileName);
|
|
|
|
ptmp = pHalData->para_file_buf;
|
|
for (szLine = GetLineFromBuffer(ptmp); szLine != NULL; szLine = GetLineFromBuffer(ptmp))
|
|
{
|
|
if(!IsCommentString(szLine))
|
|
{
|
|
// Get 1st hex value as register offset.
|
|
if(GetHexValueFromString(szLine, &u4bRegOffset, &u4bMove))
|
|
{
|
|
if(u4bRegOffset == 0xffff)
|
|
{ // Ending.
|
|
break;
|
|
}
|
|
else if (u4bRegOffset == 0xfe || u4bRegOffset == 0xffe)
|
|
{
|
|
#ifdef CONFIG_LONG_DELAY_ISSUE
|
|
rtw_msleep_os(50);
|
|
#else
|
|
rtw_mdelay_os(50);
|
|
#endif
|
|
}
|
|
else if (u4bRegOffset == 0xfd)
|
|
{
|
|
rtw_mdelay_os(5);
|
|
}
|
|
else if (u4bRegOffset == 0xfc)
|
|
{
|
|
rtw_mdelay_os(1);
|
|
}
|
|
else if (u4bRegOffset == 0xfb)
|
|
{
|
|
rtw_udelay_os(50);
|
|
}
|
|
else if (u4bRegOffset == 0xfa)
|
|
{
|
|
rtw_udelay_os(5);
|
|
}
|
|
else if (u4bRegOffset == 0xf9)
|
|
{
|
|
rtw_udelay_os(1);
|
|
}
|
|
|
|
// Get 2nd hex value as register value.
|
|
szLine += u4bMove;
|
|
if(GetHexValueFromString(szLine, &u4bRegValue, &u4bMove))
|
|
{
|
|
//DBG_871X("[ADDR]%03lX=%08lX\n", u4bRegOffset, u4bRegValue);
|
|
PHY_SetBBReg(Adapter, u4bRegOffset, bMaskDWord, u4bRegValue);
|
|
|
|
// Add 1us delay between BB/RF register setting.
|
|
rtw_udelay_os(1);
|
|
}
|
|
}
|
|
}
|
|
}
|
|
}
|
|
else
|
|
{
|
|
DBG_871X("%s(): No File %s, Load from HWImg Array!\n", __FUNCTION__, pFileName);
|
|
}
|
|
|
|
return rtStatus;
|
|
}
|
|
|
|
#endif
|
|
|
|
int
|
|
PHY_ConfigRFWithParaFile(
|
|
IN PADAPTER Adapter,
|
|
IN char* pFileName,
|
|
IN u8 eRFPath
|
|
)
|
|
{
|
|
HAL_DATA_TYPE *pHalData = GET_HAL_DATA(Adapter);
|
|
int rlen = 0, rtStatus = _FAIL;
|
|
char *szLine, *ptmp;
|
|
u32 u4bRegOffset, u4bRegValue, u4bMove;
|
|
u16 i;
|
|
char *pBuf = NULL;
|
|
u32 *pBufLen = NULL;
|
|
|
|
if(!(Adapter->registrypriv.load_phy_file & LOAD_RF_PARA_FILE))
|
|
return rtStatus;
|
|
|
|
switch(eRFPath)
|
|
{
|
|
case ODM_RF_PATH_A:
|
|
pBuf = pHalData->rf_radio_a;
|
|
pBufLen = &pHalData->rf_radio_a_len;
|
|
break;
|
|
case ODM_RF_PATH_B:
|
|
pBuf = pHalData->rf_radio_b;
|
|
pBufLen = &pHalData->rf_radio_b_len;
|
|
break;
|
|
default:
|
|
DBG_871X("Unknown RF path!! %d\r\n", eRFPath);
|
|
break;
|
|
}
|
|
|
|
_rtw_memset(pHalData->para_file_buf, 0, MAX_PARA_FILE_BUF_LEN);
|
|
|
|
if ((pBufLen != NULL) && (*pBufLen == 0) && (pBuf == NULL))
|
|
{
|
|
rtw_merge_string(rtw_phy_para_file_path, PATH_LENGTH_MAX, rtw_phy_file_path, pFileName);
|
|
|
|
if (rtw_is_file_readable(rtw_phy_para_file_path) == _TRUE)
|
|
{
|
|
rlen = rtw_retrieve_from_file(rtw_phy_para_file_path, pHalData->para_file_buf, MAX_PARA_FILE_BUF_LEN);
|
|
if (rlen > 0)
|
|
{
|
|
rtStatus = _SUCCESS;
|
|
pBuf = rtw_zvmalloc(rlen);
|
|
if(pBuf) {
|
|
_rtw_memcpy(pBuf, pHalData->para_file_buf, rlen);
|
|
*pBufLen = rlen;
|
|
|
|
switch(eRFPath)
|
|
{
|
|
case ODM_RF_PATH_A:
|
|
pHalData->rf_radio_a = pBuf;
|
|
break;
|
|
case ODM_RF_PATH_B:
|
|
pHalData->rf_radio_b = pBuf;
|
|
break;
|
|
}
|
|
}
|
|
else {
|
|
DBG_871X("%s(): eRFPath=%d alloc fail !\n",__FUNCTION__,eRFPath);
|
|
}
|
|
}
|
|
}
|
|
}
|
|
else
|
|
{
|
|
if ((pBufLen != NULL) && (*pBufLen == 0) && (pBuf == NULL)) {
|
|
_rtw_memcpy(pHalData->para_file_buf, pBuf, *pBufLen);
|
|
rtStatus = _SUCCESS;
|
|
}
|
|
else {
|
|
DBG_871X("%s(): Critical Error !!!\n",__FUNCTION__);
|
|
}
|
|
}
|
|
|
|
if(rtStatus == _SUCCESS)
|
|
{
|
|
//DBG_871X("%s(): read %s successfully\n", __FUNCTION__, pFileName);
|
|
|
|
ptmp = pHalData->para_file_buf;
|
|
for (szLine = GetLineFromBuffer(ptmp); szLine != NULL; szLine = GetLineFromBuffer(ptmp))
|
|
{
|
|
if(!IsCommentString(szLine))
|
|
{
|
|
// Get 1st hex value as register offset.
|
|
if(GetHexValueFromString(szLine, &u4bRegOffset, &u4bMove))
|
|
{
|
|
if(u4bRegOffset == 0xfe || u4bRegOffset == 0xffe)
|
|
{ // Deay specific ms. Only RF configuration require delay.
|
|
#ifdef CONFIG_LONG_DELAY_ISSUE
|
|
rtw_msleep_os(50);
|
|
#else
|
|
rtw_mdelay_os(50);
|
|
#endif
|
|
}
|
|
else if (u4bRegOffset == 0xfd)
|
|
{
|
|
//delay_ms(5);
|
|
for(i=0;i<100;i++)
|
|
rtw_udelay_os(MAX_STALL_TIME);
|
|
}
|
|
else if (u4bRegOffset == 0xfc)
|
|
{
|
|
//delay_ms(1);
|
|
for(i=0;i<20;i++)
|
|
rtw_udelay_os(MAX_STALL_TIME);
|
|
}
|
|
else if (u4bRegOffset == 0xfb)
|
|
{
|
|
rtw_udelay_os(50);
|
|
}
|
|
else if (u4bRegOffset == 0xfa)
|
|
{
|
|
rtw_udelay_os(5);
|
|
}
|
|
else if (u4bRegOffset == 0xf9)
|
|
{
|
|
rtw_udelay_os(1);
|
|
}
|
|
else if(u4bRegOffset == 0xffff)
|
|
{
|
|
break;
|
|
}
|
|
|
|
// Get 2nd hex value as register value.
|
|
szLine += u4bMove;
|
|
if(GetHexValueFromString(szLine, &u4bRegValue, &u4bMove))
|
|
{
|
|
PHY_SetRFReg(Adapter, eRFPath, u4bRegOffset, bRFRegOffsetMask, u4bRegValue);
|
|
|
|
// Temp add, for frequency lock, if no delay, that may cause
|
|
// frequency shift, ex: 2412MHz => 2417MHz
|
|
// If frequency shift, the following action may works.
|
|
// Fractional-N table in radio_a.txt
|
|
//0x2a 0x00001 // channel 1
|
|
//0x2b 0x00808 frequency divider.
|
|
//0x2b 0x53333
|
|
//0x2c 0x0000c
|
|
rtw_udelay_os(1);
|
|
}
|
|
}
|
|
}
|
|
}
|
|
}
|
|
else
|
|
{
|
|
DBG_871X("%s(): No File %s, Load from HWImg Array!\n", __FUNCTION__, pFileName);
|
|
}
|
|
|
|
return rtStatus;
|
|
}
|
|
|
|
VOID
|
|
initDeltaSwingIndexTables(
|
|
PADAPTER Adapter,
|
|
char* Band,
|
|
char* Path,
|
|
char* Sign,
|
|
char* Channel,
|
|
char* Rate,
|
|
char* Data
|
|
)
|
|
{
|
|
#define STR_EQUAL_5G(_band, _path, _sign, _rate, _chnl) \
|
|
((strcmp(Band, _band) == 0) && (strcmp(Path, _path) == 0) && (strcmp(Sign, _sign) == 0) &&\
|
|
(strcmp(Rate, _rate) == 0) && (strcmp(Channel, _chnl) == 0)\
|
|
)
|
|
#define STR_EQUAL_2G(_band, _path, _sign, _rate) \
|
|
((strcmp(Band, _band) == 0) && (strcmp(Path, _path) == 0) && (strcmp(Sign, _sign) == 0) &&\
|
|
(strcmp(Rate, _rate) == 0)\
|
|
)
|
|
|
|
#define STORE_SWING_TABLE(_array, _iteratedIdx) \
|
|
for(token = strsep(&Data, delim); token != NULL; token = strsep(&Data, delim))\
|
|
{\
|
|
sscanf(token, "%d", &idx);\
|
|
_array[_iteratedIdx++] = (u8)idx;\
|
|
}\
|
|
|
|
HAL_DATA_TYPE *pHalData = GET_HAL_DATA(Adapter);
|
|
PDM_ODM_T pDM_Odm = &pHalData->odmpriv;
|
|
PODM_RF_CAL_T pRFCalibrateInfo = &(pDM_Odm->RFCalibrateInfo);
|
|
u32 j = 0;
|
|
char *token;
|
|
char delim[] = ",";
|
|
u32 idx = 0;
|
|
|
|
//DBG_871X("===>initDeltaSwingIndexTables(): Band: %s;\nPath: %s;\nSign: %s;\nChannel: %s;\nRate: %s;\n, Data: %s;\n",
|
|
// Band, Path, Sign, Channel, Rate, Data);
|
|
|
|
if ( STR_EQUAL_2G("2G", "A", "+", "CCK") )
|
|
{
|
|
STORE_SWING_TABLE(pRFCalibrateInfo->DeltaSwingTableIdx_2GCCKA_P, j);
|
|
}
|
|
else if ( STR_EQUAL_2G("2G", "A", "-", "CCK") )
|
|
{
|
|
STORE_SWING_TABLE(pRFCalibrateInfo->DeltaSwingTableIdx_2GCCKA_N, j);
|
|
}
|
|
else if ( STR_EQUAL_2G("2G", "B", "+", "CCK") )
|
|
{
|
|
STORE_SWING_TABLE(pRFCalibrateInfo->DeltaSwingTableIdx_2GCCKB_P, j);
|
|
}
|
|
else if ( STR_EQUAL_2G("2G", "B", "-", "CCK") )
|
|
{
|
|
STORE_SWING_TABLE(pRFCalibrateInfo->DeltaSwingTableIdx_2GCCKB_N, j);
|
|
}
|
|
else if ( STR_EQUAL_2G("2G", "A", "+", "ALL") )
|
|
{
|
|
STORE_SWING_TABLE(pRFCalibrateInfo->DeltaSwingTableIdx_2GA_P, j);
|
|
}
|
|
else if ( STR_EQUAL_2G("2G", "A", "-", "ALL") )
|
|
{
|
|
STORE_SWING_TABLE(pRFCalibrateInfo->DeltaSwingTableIdx_2GA_N, j);
|
|
}
|
|
else if ( STR_EQUAL_2G("2G", "B", "+", "ALL") )
|
|
{
|
|
STORE_SWING_TABLE(pRFCalibrateInfo->DeltaSwingTableIdx_2GB_P, j);
|
|
}
|
|
else if ( STR_EQUAL_2G("2G", "B", "-", "ALL") )
|
|
{
|
|
STORE_SWING_TABLE(pRFCalibrateInfo->DeltaSwingTableIdx_2GB_N, j);
|
|
}
|
|
else if ( STR_EQUAL_5G("5G", "A", "+", "ALL", "0") )
|
|
{
|
|
STORE_SWING_TABLE(pRFCalibrateInfo->DeltaSwingTableIdx_5GA_P[0], j);
|
|
}
|
|
else if ( STR_EQUAL_5G("5G", "A", "-", "ALL", "0") )
|
|
{
|
|
STORE_SWING_TABLE(pRFCalibrateInfo->DeltaSwingTableIdx_5GA_N[0], j);
|
|
}
|
|
else if ( STR_EQUAL_5G("5G", "B", "+", "ALL", "0") )
|
|
{
|
|
STORE_SWING_TABLE(pRFCalibrateInfo->DeltaSwingTableIdx_5GB_P[0], j);
|
|
}
|
|
else if ( STR_EQUAL_5G("5G", "B", "-", "ALL", "0") )
|
|
{
|
|
STORE_SWING_TABLE(pRFCalibrateInfo->DeltaSwingTableIdx_5GB_N[0], j);
|
|
}
|
|
else if ( STR_EQUAL_5G("5G", "A", "+", "ALL", "1") )
|
|
{
|
|
STORE_SWING_TABLE(pRFCalibrateInfo->DeltaSwingTableIdx_5GA_P[1], j);
|
|
}
|
|
else if ( STR_EQUAL_5G("5G", "A", "-", "ALL", "1") )
|
|
{
|
|
STORE_SWING_TABLE(pRFCalibrateInfo->DeltaSwingTableIdx_5GA_N[1], j);
|
|
}
|
|
else if ( STR_EQUAL_5G("5G", "B", "+", "ALL", "1") )
|
|
{
|
|
STORE_SWING_TABLE(pRFCalibrateInfo->DeltaSwingTableIdx_5GB_P[1], j);
|
|
}
|
|
else if ( STR_EQUAL_5G("5G", "B", "-", "ALL", "1") )
|
|
{
|
|
STORE_SWING_TABLE(pRFCalibrateInfo->DeltaSwingTableIdx_5GB_N[1], j);
|
|
}
|
|
else if ( STR_EQUAL_5G("5G", "A", "+", "ALL", "2") )
|
|
{
|
|
STORE_SWING_TABLE(pRFCalibrateInfo->DeltaSwingTableIdx_5GA_P[2], j);
|
|
}
|
|
else if ( STR_EQUAL_5G("5G", "A", "-", "ALL", "2") )
|
|
{
|
|
STORE_SWING_TABLE(pRFCalibrateInfo->DeltaSwingTableIdx_5GA_N[2], j);
|
|
}
|
|
else if ( STR_EQUAL_5G("5G", "B", "+", "ALL", "2") )
|
|
{
|
|
STORE_SWING_TABLE(pRFCalibrateInfo->DeltaSwingTableIdx_5GB_P[2], j);
|
|
}
|
|
else if ( STR_EQUAL_5G("5G", "B", "-", "ALL", "2") )
|
|
{
|
|
STORE_SWING_TABLE(pRFCalibrateInfo->DeltaSwingTableIdx_5GB_N[2], j);
|
|
}
|
|
else if ( STR_EQUAL_5G("5G", "A", "+", "ALL", "3") )
|
|
{
|
|
STORE_SWING_TABLE(pRFCalibrateInfo->DeltaSwingTableIdx_5GA_P[3], j);
|
|
}
|
|
else if ( STR_EQUAL_5G("5G", "A", "-", "ALL", "3") )
|
|
{
|
|
STORE_SWING_TABLE(pRFCalibrateInfo->DeltaSwingTableIdx_5GA_N[3], j);
|
|
}
|
|
else if ( STR_EQUAL_5G("5G", "B", "+", "ALL", "3") )
|
|
{
|
|
STORE_SWING_TABLE(pRFCalibrateInfo->DeltaSwingTableIdx_5GB_P[3], j);
|
|
}
|
|
else if ( STR_EQUAL_5G("5G", "B", "-", "ALL", "3") )
|
|
{
|
|
STORE_SWING_TABLE(pRFCalibrateInfo->DeltaSwingTableIdx_5GB_N[3], j);
|
|
}
|
|
else
|
|
{
|
|
DBG_871X("===>initDeltaSwingIndexTables(): The input is invalid!!\n");
|
|
}
|
|
}
|
|
|
|
int
|
|
PHY_ConfigRFWithTxPwrTrackParaFile(
|
|
IN PADAPTER Adapter,
|
|
IN char* pFileName
|
|
)
|
|
{
|
|
HAL_DATA_TYPE *pHalData = GET_HAL_DATA(Adapter);
|
|
PDM_ODM_T pDM_Odm = &pHalData->odmpriv;
|
|
PODM_RF_CAL_T pRFCalibrateInfo = &(pDM_Odm->RFCalibrateInfo);
|
|
int rlen = 0, rtStatus = _FAIL;
|
|
char *szLine, *ptmp;
|
|
u32 i = 0, j = 0;
|
|
char c = 0;
|
|
|
|
if(!(Adapter->registrypriv.load_phy_file & LOAD_RF_TXPWR_TRACK_PARA_FILE))
|
|
return rtStatus;
|
|
|
|
_rtw_memset(pHalData->para_file_buf, 0, MAX_PARA_FILE_BUF_LEN);
|
|
|
|
if ((pHalData->rf_tx_pwr_track_len == 0) && (pHalData->rf_tx_pwr_track == NULL))
|
|
{
|
|
rtw_merge_string(rtw_phy_para_file_path, PATH_LENGTH_MAX, rtw_phy_file_path, pFileName);
|
|
|
|
if (rtw_is_file_readable(rtw_phy_para_file_path) == _TRUE)
|
|
{
|
|
rlen = rtw_retrieve_from_file(rtw_phy_para_file_path, pHalData->para_file_buf, MAX_PARA_FILE_BUF_LEN);
|
|
if (rlen > 0)
|
|
{
|
|
rtStatus = _SUCCESS;
|
|
pHalData->rf_tx_pwr_track = rtw_zvmalloc(rlen);
|
|
if(pHalData->rf_tx_pwr_track) {
|
|
_rtw_memcpy(pHalData->rf_tx_pwr_track, pHalData->para_file_buf, rlen);
|
|
pHalData->rf_tx_pwr_track_len = rlen;
|
|
}
|
|
else {
|
|
DBG_871X("%s rf_tx_pwr_track alloc fail !\n",__FUNCTION__);
|
|
}
|
|
}
|
|
}
|
|
}
|
|
else
|
|
{
|
|
if ((pHalData->rf_tx_pwr_track_len != 0) && (pHalData->rf_tx_pwr_track != NULL)) {
|
|
_rtw_memcpy(pHalData->para_file_buf, pHalData->rf_tx_pwr_track, pHalData->rf_tx_pwr_track_len);
|
|
rtStatus = _SUCCESS;
|
|
}
|
|
else {
|
|
DBG_871X("%s(): Critical Error !!!\n",__FUNCTION__);
|
|
}
|
|
}
|
|
|
|
if(rtStatus == _SUCCESS)
|
|
{
|
|
//DBG_871X("%s(): read %s successfully\n", __FUNCTION__, pFileName);
|
|
|
|
ptmp = pHalData->para_file_buf;
|
|
for (szLine = GetLineFromBuffer(ptmp); szLine != NULL; szLine = GetLineFromBuffer(ptmp))
|
|
{
|
|
if ( ! IsCommentString(szLine) )
|
|
{
|
|
char band[5]="", path[5]="", sign[5] = "";
|
|
char chnl[5]="", rate[10]="";
|
|
char data[300]=""; // 100 is too small
|
|
|
|
if (strlen(szLine) < 10 || szLine[0] != '[')
|
|
continue;
|
|
|
|
strncpy(band, szLine+1, 2);
|
|
strncpy(path, szLine+5, 1);
|
|
strncpy(sign, szLine+8, 1);
|
|
|
|
i = 10; // szLine+10
|
|
if ( ! ParseQualifiedString(szLine, &i, rate, '[', ']') ) {
|
|
//DBG_871X("Fail to parse rate!\n");
|
|
}
|
|
if ( ! ParseQualifiedString(szLine, &i, chnl, '[', ']') ) {
|
|
//DBG_871X("Fail to parse channel group!\n");
|
|
}
|
|
while ( szLine[i] != '{' && i < strlen(szLine))
|
|
i++;
|
|
if ( ! ParseQualifiedString(szLine, &i, data, '{', '}') ) {
|
|
//DBG_871X("Fail to parse data!\n");
|
|
}
|
|
|
|
initDeltaSwingIndexTables(Adapter, band, path, sign, chnl, rate, data);
|
|
}
|
|
}
|
|
}
|
|
else
|
|
{
|
|
DBG_871X("%s(): No File %s, Load from HWImg Array!\n", __FUNCTION__, pFileName);
|
|
}
|
|
#if 0
|
|
for (i = 0; i < DELTA_SWINGIDX_SIZE; ++i)
|
|
{
|
|
DBG_871X("pRFCalibrateInfo->DeltaSwingTableIdx_2GA_P[%d] = %d\n", i, pRFCalibrateInfo->DeltaSwingTableIdx_2GA_P[i]);
|
|
DBG_871X("pRFCalibrateInfo->DeltaSwingTableIdx_2GA_N[%d] = %d\n", i, pRFCalibrateInfo->DeltaSwingTableIdx_2GA_N[i]);
|
|
DBG_871X("pRFCalibrateInfo->DeltaSwingTableIdx_2GB_P[%d] = %d\n", i, pRFCalibrateInfo->DeltaSwingTableIdx_2GB_P[i]);
|
|
DBG_871X("pRFCalibrateInfo->DeltaSwingTableIdx_2GB_N[%d] = %d\n", i, pRFCalibrateInfo->DeltaSwingTableIdx_2GB_N[i]);
|
|
DBG_871X("pRFCalibrateInfo->DeltaSwingTableIdx_2GCCKA_P[%d] = %d\n", i, pRFCalibrateInfo->DeltaSwingTableIdx_2GCCKA_P[i]);
|
|
DBG_871X("pRFCalibrateInfo->DeltaSwingTableIdx_2GCCKA_N[%d] = %d\n", i, pRFCalibrateInfo->DeltaSwingTableIdx_2GCCKA_N[i]);
|
|
DBG_871X("pRFCalibrateInfo->DeltaSwingTableIdx_2GCCKB_P[%d] = %d\n", i, pRFCalibrateInfo->DeltaSwingTableIdx_2GCCKB_P[i]);
|
|
DBG_871X("pRFCalibrateInfo->DeltaSwingTableIdx_2GCCKB_N[%d] = %d\n", i, pRFCalibrateInfo->DeltaSwingTableIdx_2GCCKB_N[i]);
|
|
|
|
for (j = 0; j < 3; ++j)
|
|
{
|
|
DBG_871X("pRFCalibrateInfo->DeltaSwingTableIdx_5GA_P[%d][%d] = %d\n", j, i, pRFCalibrateInfo->DeltaSwingTableIdx_5GA_P[j][i]);
|
|
DBG_871X("pRFCalibrateInfo->DeltaSwingTableIdx_5GA_N[%d][%d] = %d\n", j, i, pRFCalibrateInfo->DeltaSwingTableIdx_5GA_N[j][i]);
|
|
DBG_871X("pRFCalibrateInfo->DeltaSwingTableIdx_5GB_P[%d][%d] = %d\n", j, i, pRFCalibrateInfo->DeltaSwingTableIdx_5GB_P[j][i]);
|
|
DBG_871X("pRFCalibrateInfo->DeltaSwingTableIdx_5GB_N[%d][%d] = %d\n", j, i, pRFCalibrateInfo->DeltaSwingTableIdx_5GB_N[j][i]);
|
|
}
|
|
}
|
|
#endif
|
|
return rtStatus;
|
|
}
|
|
|
|
int
|
|
phy_ParsePowerLimitTableFile(
|
|
PADAPTER Adapter,
|
|
char* buffer
|
|
)
|
|
{
|
|
HAL_DATA_TYPE *pHalData = GET_HAL_DATA(Adapter);
|
|
PDM_ODM_T pDM_Odm = &(pHalData->odmpriv);
|
|
u32 i = 0, forCnt = 0;
|
|
u8 loadingStage = 0, limitValue = 0, fraction = 0;
|
|
char *szLine, *ptmp;
|
|
int rtStatus = _SUCCESS;
|
|
char band[10], bandwidth[10], rateSection[10],
|
|
regulation[TXPWR_LMT_MAX_REGULATION_NUM][10], rfPath[10],colNumBuf[10];
|
|
u8 colNum = 0;
|
|
|
|
DBG_871X("===>phy_ParsePowerLimitTableFile()\n" );
|
|
|
|
if ( Adapter->registrypriv.RegDecryptCustomFile == 1 )
|
|
phy_DecryptBBPgParaFile( Adapter, buffer);
|
|
|
|
ptmp = buffer;
|
|
for (szLine = GetLineFromBuffer(ptmp); szLine != NULL; szLine = GetLineFromBuffer(ptmp))
|
|
{
|
|
// skip comment
|
|
if ( IsCommentString( szLine ) ) {
|
|
continue;
|
|
}
|
|
|
|
if( loadingStage == 0 ) {
|
|
for ( forCnt = 0; forCnt < TXPWR_LMT_MAX_REGULATION_NUM; ++forCnt )
|
|
_rtw_memset( ( PVOID ) regulation[forCnt], 0, 10 );
|
|
_rtw_memset( ( PVOID ) band, 0, 10 );
|
|
_rtw_memset( ( PVOID ) bandwidth, 0, 10 );
|
|
_rtw_memset( ( PVOID ) rateSection, 0, 10 );
|
|
_rtw_memset( ( PVOID ) rfPath, 0, 10 );
|
|
_rtw_memset( ( PVOID ) colNumBuf, 0, 10 );
|
|
|
|
if ( szLine[0] != '#' || szLine[1] != '#' )
|
|
continue;
|
|
|
|
// skip the space
|
|
i = 2;
|
|
while ( szLine[i] == ' ' || szLine[i] == '\t' )
|
|
++i;
|
|
|
|
szLine[--i] = ' '; // return the space in front of the regulation info
|
|
|
|
// Parse the label of the table
|
|
if ( ! ParseQualifiedString( szLine, &i, band, ' ', ',' ) ) {
|
|
DBG_871X( "Fail to parse band!\n");
|
|
return _FAIL;
|
|
}
|
|
if ( ! ParseQualifiedString( szLine, &i, bandwidth, ' ', ',' ) ) {
|
|
DBG_871X("Fail to parse bandwidth!\n");
|
|
return _FAIL;
|
|
}
|
|
if ( ! ParseQualifiedString( szLine, &i, rfPath, ' ', ',' ) ) {
|
|
DBG_871X("Fail to parse rf path!\n");
|
|
return _FAIL;
|
|
}
|
|
if ( ! ParseQualifiedString( szLine, &i, rateSection, ' ', ',' ) ) {
|
|
DBG_871X("Fail to parse rate!\n");
|
|
return _FAIL;
|
|
}
|
|
|
|
loadingStage = 1;
|
|
}
|
|
else if ( loadingStage == 1 )
|
|
{
|
|
if ( szLine[0] != '#' || szLine[1] != '#' )
|
|
continue;
|
|
|
|
// skip the space
|
|
i = 2;
|
|
while ( szLine[i] == ' ' || szLine[i] == '\t' )
|
|
++i;
|
|
|
|
if ( !eqNByte( (u8 *)(szLine + i), (u8 *)("START"), 5 ) ) {
|
|
DBG_871X("Lost \"## START\" label\n");
|
|
return _FAIL;
|
|
}
|
|
|
|
loadingStage = 2;
|
|
}
|
|
else if ( loadingStage == 2 )
|
|
{
|
|
if ( szLine[0] != '#' || szLine[1] != '#' )
|
|
continue;
|
|
|
|
// skip the space
|
|
i = 2;
|
|
while ( szLine[i] == ' ' || szLine[i] == '\t' )
|
|
++i;
|
|
|
|
if ( ! ParseQualifiedString( szLine, &i, colNumBuf, '#', '#' ) ) {
|
|
DBG_871X("Fail to parse column number!\n");
|
|
return _FAIL;
|
|
}
|
|
|
|
if ( !GetU1ByteIntegerFromStringInDecimal( colNumBuf, &colNum ) )
|
|
return _FAIL;
|
|
|
|
if ( colNum > TXPWR_LMT_MAX_REGULATION_NUM ) {
|
|
DBG_871X("unvalid col number %d (greater than max %d)\n",
|
|
colNum, TXPWR_LMT_MAX_REGULATION_NUM );
|
|
return _FAIL;
|
|
}
|
|
|
|
for ( forCnt = 0; forCnt < colNum; ++forCnt )
|
|
{
|
|
u8 regulation_name_cnt = 0;
|
|
|
|
// skip the space
|
|
while ( szLine[i] == ' ' || szLine[i] == '\t' )
|
|
++i;
|
|
|
|
while ( szLine[i] != ' ' && szLine[i] != '\t' && szLine[i] != '\0' )
|
|
regulation[forCnt][regulation_name_cnt++] = szLine[i++];
|
|
//DBG_871X("regulation %s!\n", regulation[forCnt]);
|
|
|
|
if ( regulation_name_cnt == 0 ) {
|
|
DBG_871X("unvalid number of regulation!\n");
|
|
return _FAIL;
|
|
}
|
|
}
|
|
|
|
loadingStage = 3;
|
|
}
|
|
else if ( loadingStage == 3 )
|
|
{
|
|
char channel[10] = {0}, powerLimit[10] = {0};
|
|
u8 cnt = 0;
|
|
|
|
// the table ends
|
|
if ( szLine[0] == '#' && szLine[1] == '#' ) {
|
|
i = 2;
|
|
while ( szLine[i] == ' ' || szLine[i] == '\t' )
|
|
++i;
|
|
|
|
if ( eqNByte( (u8 *)(szLine + i), (u8 *)("END"), 3 ) ) {
|
|
loadingStage = 0;
|
|
continue;
|
|
}
|
|
else {
|
|
DBG_871X("Wrong format\n");
|
|
DBG_871X("<===== phy_ParsePowerLimitTableFile()\n");
|
|
return _FAIL;
|
|
}
|
|
}
|
|
|
|
if ( ( szLine[0] != 'c' && szLine[0] != 'C' ) ||
|
|
( szLine[1] != 'h' && szLine[1] != 'H' ) ) {
|
|
DBG_871X("Meet wrong channel => power limt pair\n");
|
|
continue;
|
|
}
|
|
i = 2;// move to the location behind 'h'
|
|
|
|
// load the channel number
|
|
cnt = 0;
|
|
while ( szLine[i] >= '0' && szLine[i] <= '9' ) {
|
|
channel[cnt] = szLine[i];
|
|
++cnt;
|
|
++i;
|
|
}
|
|
//DBG_871X("chnl %s!\n", channel);
|
|
|
|
for ( forCnt = 0; forCnt < colNum; ++forCnt )
|
|
{
|
|
// skip the space between channel number and the power limit value
|
|
while ( szLine[i] == ' ' || szLine[i] == '\t' )
|
|
++i;
|
|
|
|
// load the power limit value
|
|
cnt = 0;
|
|
fraction = 0;
|
|
_rtw_memset( ( PVOID ) powerLimit, 0, 10 );
|
|
while ( ( szLine[i] >= '0' && szLine[i] <= '9' ) || szLine[i] == '.' )
|
|
{
|
|
if ( szLine[i] == '.' ){
|
|
if ( ( szLine[i+1] >= '0' && szLine[i+1] <= '9' ) ) {
|
|
fraction = szLine[i+1];
|
|
i += 2;
|
|
}
|
|
else {
|
|
DBG_871X("Wrong fraction in TXPWR_LMT.txt\n");
|
|
return _FAIL;
|
|
}
|
|
|
|
break;
|
|
}
|
|
|
|
powerLimit[cnt] = szLine[i];
|
|
++cnt;
|
|
++i;
|
|
}
|
|
|
|
if ( powerLimit[0] == '\0' ) {
|
|
powerLimit[0] = '6';
|
|
powerLimit[1] = '3';
|
|
i += 2;
|
|
}
|
|
else {
|
|
if ( !GetU1ByteIntegerFromStringInDecimal( powerLimit, &limitValue ) )
|
|
return _FAIL;
|
|
|
|
limitValue *= 2;
|
|
cnt = 0;
|
|
if ( fraction == '5' )
|
|
++limitValue;
|
|
|
|
// the value is greater or equal to 100
|
|
if ( limitValue >= 100 ) {
|
|
powerLimit[cnt++] = limitValue/100 + '0';
|
|
limitValue %= 100;
|
|
|
|
if ( limitValue >= 10 ) {
|
|
powerLimit[cnt++] = limitValue/10 + '0';
|
|
limitValue %= 10;
|
|
}
|
|
else {
|
|
powerLimit[cnt++] = '0';
|
|
}
|
|
|
|
powerLimit[cnt++] = limitValue + '0';
|
|
}
|
|
// the value is greater or equal to 10
|
|
else if ( limitValue >= 10 ) {
|
|
powerLimit[cnt++] = limitValue/10 + '0';
|
|
limitValue %= 10;
|
|
powerLimit[cnt++] = limitValue + '0';
|
|
}
|
|
// the value is less than 10
|
|
else
|
|
powerLimit[cnt++] = limitValue + '0';
|
|
|
|
powerLimit[cnt] = '\0';
|
|
}
|
|
|
|
//DBG_871X("ch%s => %s\n", channel, powerLimit);
|
|
|
|
// store the power limit value
|
|
PHY_SetTxPowerLimit(pDM_Odm, (u8 *)regulation[forCnt], (u8 *)band,
|
|
(u8 *)bandwidth, (u8 *)rateSection, (u8 *)rfPath, (u8 *)channel, (u8 *)powerLimit );
|
|
|
|
}
|
|
}
|
|
else
|
|
{
|
|
DBG_871X("Abnormal loading stage in phy_ParsePowerLimitTableFile()!\n");
|
|
rtStatus = _FAIL;
|
|
break;
|
|
}
|
|
}
|
|
|
|
DBG_871X("<===phy_ParsePowerLimitTableFile()\n");
|
|
return rtStatus;
|
|
}
|
|
|
|
int
|
|
PHY_ConfigRFWithPowerLimitTableParaFile(
|
|
IN PADAPTER Adapter,
|
|
IN char* pFileName
|
|
)
|
|
{
|
|
HAL_DATA_TYPE *pHalData = GET_HAL_DATA(Adapter);
|
|
int rlen = 0, rtStatus = _FAIL;
|
|
|
|
if(!(Adapter->registrypriv.load_phy_file & LOAD_RF_TXPWR_LMT_PARA_FILE))
|
|
return rtStatus;
|
|
|
|
_rtw_memset(pHalData->para_file_buf, 0, MAX_PARA_FILE_BUF_LEN);
|
|
|
|
if ((pHalData->rf_tx_pwr_lmt_len == 0) && (pHalData->rf_tx_pwr_lmt == NULL))
|
|
{
|
|
rtw_merge_string(rtw_phy_para_file_path, PATH_LENGTH_MAX, rtw_phy_file_path, pFileName);
|
|
|
|
if (rtw_is_file_readable(rtw_phy_para_file_path) == _TRUE)
|
|
{
|
|
rlen = rtw_retrieve_from_file(rtw_phy_para_file_path, pHalData->para_file_buf, MAX_PARA_FILE_BUF_LEN);
|
|
if (rlen > 0)
|
|
{
|
|
rtStatus = _SUCCESS;
|
|
pHalData->rf_tx_pwr_lmt = rtw_zvmalloc(rlen);
|
|
if(pHalData->rf_tx_pwr_lmt) {
|
|
_rtw_memcpy(pHalData->rf_tx_pwr_lmt, pHalData->para_file_buf, rlen);
|
|
pHalData->rf_tx_pwr_lmt_len = rlen;
|
|
}
|
|
else {
|
|
DBG_871X("%s rf_tx_pwr_lmt alloc fail !\n",__FUNCTION__);
|
|
}
|
|
}
|
|
}
|
|
}
|
|
else
|
|
{
|
|
if ((pHalData->rf_tx_pwr_lmt_len != 0) && (pHalData->rf_tx_pwr_lmt != NULL)) {
|
|
_rtw_memcpy(pHalData->para_file_buf, pHalData->rf_tx_pwr_lmt, pHalData->rf_tx_pwr_lmt_len);
|
|
rtStatus = _SUCCESS;
|
|
}
|
|
else {
|
|
DBG_871X("%s(): Critical Error !!!\n",__FUNCTION__);
|
|
}
|
|
}
|
|
|
|
if(rtStatus == _SUCCESS)
|
|
{
|
|
//DBG_871X("%s(): read %s ok\n", __FUNCTION__, pFileName);
|
|
rtStatus = phy_ParsePowerLimitTableFile( Adapter, pHalData->para_file_buf );
|
|
}
|
|
else
|
|
{
|
|
DBG_871X("%s(): No File %s, Load from HWImg Array!\n", __FUNCTION__, pFileName);
|
|
}
|
|
|
|
return rtStatus;
|
|
}
|
|
|
|
void phy_free_filebuf(_adapter *padapter)
|
|
{
|
|
HAL_DATA_TYPE *pHalData = GET_HAL_DATA(padapter);
|
|
|
|
if(pHalData->mac_reg)
|
|
rtw_vmfree(pHalData->mac_reg, pHalData->mac_reg_len);
|
|
if(pHalData->bb_phy_reg)
|
|
rtw_vmfree(pHalData->bb_phy_reg, pHalData->bb_phy_reg_len);
|
|
if(pHalData->bb_agc_tab)
|
|
rtw_vmfree(pHalData->bb_agc_tab, pHalData->bb_agc_tab_len);
|
|
if(pHalData->bb_phy_reg_pg)
|
|
rtw_vmfree(pHalData->bb_phy_reg_pg, pHalData->bb_phy_reg_pg_len);
|
|
if(pHalData->bb_phy_reg_mp)
|
|
rtw_vmfree(pHalData->bb_phy_reg_mp, pHalData->bb_phy_reg_mp_len);
|
|
if(pHalData->rf_radio_a)
|
|
rtw_vmfree(pHalData->rf_radio_a, pHalData->rf_radio_a_len);
|
|
if(pHalData->rf_radio_b)
|
|
rtw_vmfree(pHalData->rf_radio_b, pHalData->rf_radio_b_len);
|
|
if(pHalData->rf_tx_pwr_track)
|
|
rtw_vmfree(pHalData->rf_tx_pwr_track, pHalData->rf_tx_pwr_track_len);
|
|
if(pHalData->rf_tx_pwr_lmt)
|
|
rtw_vmfree(pHalData->rf_tx_pwr_lmt, pHalData->rf_tx_pwr_lmt_len);
|
|
|
|
}
|
|
|
|
#endif
|