/****************************************************************************** * * Copyright(c) 2007 - 2017 Realtek Corporation. * * 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. * *****************************************************************************/ #define _HAL_COM_PHYCFG_C_ #include #include #define PG_TXPWR_1PATH_BYTE_NUM_2G 18 #define PG_TXPWR_BASE_BYTE_NUM_2G 11 #define PG_TXPWR_1PATH_BYTE_NUM_5G 24 #define PG_TXPWR_BASE_BYTE_NUM_5G 14 #define PG_TXPWR_MSB_DIFF_S4BIT(_pg_v) (((_pg_v) & 0xf0) >> 4) #define PG_TXPWR_LSB_DIFF_S4BIT(_pg_v) ((_pg_v) & 0x0f) #define PG_TXPWR_MSB_DIFF_TO_S8BIT(_pg_v) ((PG_TXPWR_MSB_DIFF_S4BIT(_pg_v) & BIT3) ? (PG_TXPWR_MSB_DIFF_S4BIT(_pg_v) | 0xF0) : PG_TXPWR_MSB_DIFF_S4BIT(_pg_v)) #define PG_TXPWR_LSB_DIFF_TO_S8BIT(_pg_v) ((PG_TXPWR_LSB_DIFF_S4BIT(_pg_v) & BIT3) ? (PG_TXPWR_LSB_DIFF_S4BIT(_pg_v) | 0xF0) : PG_TXPWR_LSB_DIFF_S4BIT(_pg_v)) #define IS_PG_TXPWR_BASE_INVALID(hal_spec, _base) ((_base) > hal_spec->txgi_max) #define IS_PG_TXPWR_DIFF_INVALID(_diff) ((_diff) > 7 || (_diff) < -8) #define PG_TXPWR_INVALID_BASE 255 #define PG_TXPWR_INVALID_DIFF 8 #if !IS_PG_TXPWR_DIFF_INVALID(PG_TXPWR_INVALID_DIFF) #error "PG_TXPWR_DIFF definition has problem" #endif #define PG_TXPWR_SRC_PG_DATA 0 #define PG_TXPWR_SRC_IC_DEF 1 #define PG_TXPWR_SRC_DEF 2 #define PG_TXPWR_SRC_NUM 3 const char *const _pg_txpwr_src_str[] = { "PG_DATA", "IC_DEF", "DEF", "UNKNOWN" }; #define pg_txpwr_src_str(src) (((src) >= PG_TXPWR_SRC_NUM) ? _pg_txpwr_src_str[PG_TXPWR_SRC_NUM] : _pg_txpwr_src_str[(src)]) const char *const _txpwr_pg_mode_str[] = { "PWR_IDX", "TSSI_OFFSET", "UNKNOWN", }; static const 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, }; #ifdef CONFIG_TXPWR_PG_WITH_PWR_IDX typedef struct _TxPowerInfo24G { u8 IndexCCK_Base[MAX_RF_PATH][MAX_CHNL_GROUP_24G]; u8 IndexBW40_Base[MAX_RF_PATH][MAX_CHNL_GROUP_24G]; /* If only one tx, only BW20 and OFDM are used. */ s8 CCK_Diff[MAX_RF_PATH][MAX_TX_COUNT]; s8 OFDM_Diff[MAX_RF_PATH][MAX_TX_COUNT]; s8 BW20_Diff[MAX_RF_PATH][MAX_TX_COUNT]; s8 BW40_Diff[MAX_RF_PATH][MAX_TX_COUNT]; } TxPowerInfo24G; typedef struct _TxPowerInfo5G { u8 IndexBW40_Base[MAX_RF_PATH][MAX_CHNL_GROUP_5G]; /* If only one tx, only BW20, OFDM, BW80 and BW160 are used. */ s8 OFDM_Diff[MAX_RF_PATH][MAX_TX_COUNT]; s8 BW20_Diff[MAX_RF_PATH][MAX_TX_COUNT]; s8 BW40_Diff[MAX_RF_PATH][MAX_TX_COUNT]; s8 BW80_Diff[MAX_RF_PATH][MAX_TX_COUNT]; s8 BW160_Diff[MAX_RF_PATH][MAX_TX_COUNT]; } TxPowerInfo5G; #ifndef DBG_PG_TXPWR_READ #define DBG_PG_TXPWR_READ 0 #endif #if DBG_PG_TXPWR_READ static void dump_pg_txpwr_info_2g(void *sel, TxPowerInfo24G *txpwr_info, u8 rfpath_num, u8 max_tx_cnt) { int path, group, tx_idx; RTW_PRINT_SEL(sel, "2.4G\n"); RTW_PRINT_SEL(sel, "CCK-1T base:\n"); RTW_PRINT_SEL(sel, "%4s ", ""); for (group = 0; group < MAX_CHNL_GROUP_24G; group++) _RTW_PRINT_SEL(sel, "G%02d ", group); _RTW_PRINT_SEL(sel, "\n"); for (path = 0; path < MAX_RF_PATH && path < rfpath_num; path++) { RTW_PRINT_SEL(sel, "[%c]: ", rf_path_char(path)); for (group = 0; group < MAX_CHNL_GROUP_24G; group++) _RTW_PRINT_SEL(sel, "%3u ", txpwr_info->IndexCCK_Base[path][group]); _RTW_PRINT_SEL(sel, "\n"); } RTW_PRINT_SEL(sel, "\n"); RTW_PRINT_SEL(sel, "CCK diff:\n"); RTW_PRINT_SEL(sel, "%4s ", ""); for (path = 0; path < MAX_RF_PATH && path < rfpath_num; path++) _RTW_PRINT_SEL(sel, "%dT ", path + 1); _RTW_PRINT_SEL(sel, "\n"); for (path = 0; path < MAX_RF_PATH && path < rfpath_num; path++) { RTW_PRINT_SEL(sel, "[%c]: ", rf_path_char(path)); for (tx_idx = RF_1TX; tx_idx < MAX_TX_COUNT && tx_idx < max_tx_cnt; tx_idx++) _RTW_PRINT_SEL(sel, "%2d ", txpwr_info->CCK_Diff[path][tx_idx]); _RTW_PRINT_SEL(sel, "\n"); } RTW_PRINT_SEL(sel, "\n"); RTW_PRINT_SEL(sel, "BW40-1S base:\n"); RTW_PRINT_SEL(sel, "%4s ", ""); for (group = 0; group < MAX_CHNL_GROUP_24G - 1; group++) _RTW_PRINT_SEL(sel, "G%02d ", group); _RTW_PRINT_SEL(sel, "\n"); for (path = 0; path < MAX_RF_PATH && path < rfpath_num; path++) { RTW_PRINT_SEL(sel, "[%c]: ", rf_path_char(path)); for (group = 0; group < MAX_CHNL_GROUP_24G - 1; group++) _RTW_PRINT_SEL(sel, "%3u ", txpwr_info->IndexBW40_Base[path][group]); _RTW_PRINT_SEL(sel, "\n"); } RTW_PRINT_SEL(sel, "\n"); RTW_PRINT_SEL(sel, "OFDM diff:\n"); RTW_PRINT_SEL(sel, "%4s ", ""); for (path = 0; path < MAX_RF_PATH && path < rfpath_num; path++) _RTW_PRINT_SEL(sel, "%dT ", path + 1); _RTW_PRINT_SEL(sel, "\n"); for (path = 0; path < MAX_RF_PATH && path < rfpath_num; path++) { RTW_PRINT_SEL(sel, "[%c]: ", rf_path_char(path)); for (tx_idx = RF_1TX; tx_idx < MAX_TX_COUNT && tx_idx < max_tx_cnt; tx_idx++) _RTW_PRINT_SEL(sel, "%2d ", txpwr_info->OFDM_Diff[path][tx_idx]); _RTW_PRINT_SEL(sel, "\n"); } RTW_PRINT_SEL(sel, "\n"); RTW_PRINT_SEL(sel, "BW20 diff:\n"); RTW_PRINT_SEL(sel, "%4s ", ""); for (path = 0; path < MAX_RF_PATH && path < rfpath_num; path++) _RTW_PRINT_SEL(sel, "%dS ", path + 1); _RTW_PRINT_SEL(sel, "\n"); for (path = 0; path < MAX_RF_PATH && path < rfpath_num; path++) { RTW_PRINT_SEL(sel, "[%c]: ", rf_path_char(path)); for (tx_idx = RF_1TX; tx_idx < MAX_TX_COUNT && tx_idx < max_tx_cnt; tx_idx++) _RTW_PRINT_SEL(sel, "%2d ", txpwr_info->BW20_Diff[path][tx_idx]); _RTW_PRINT_SEL(sel, "\n"); } RTW_PRINT_SEL(sel, "\n"); RTW_PRINT_SEL(sel, "BW40 diff:\n"); RTW_PRINT_SEL(sel, "%4s ", ""); for (path = 0; path < MAX_RF_PATH && path < rfpath_num; path++) _RTW_PRINT_SEL(sel, "%dS ", path + 1); _RTW_PRINT_SEL(sel, "\n"); for (path = 0; path < MAX_RF_PATH && path < rfpath_num; path++) { RTW_PRINT_SEL(sel, "[%c]: ", rf_path_char(path)); for (tx_idx = RF_1TX; tx_idx < MAX_TX_COUNT && tx_idx < max_tx_cnt; tx_idx++) _RTW_PRINT_SEL(sel, "%2d ", txpwr_info->BW40_Diff[path][tx_idx]); _RTW_PRINT_SEL(sel, "\n"); } RTW_PRINT_SEL(sel, "\n"); } static void dump_pg_txpwr_info_5g(void *sel, TxPowerInfo5G *txpwr_info, u8 rfpath_num, u8 max_tx_cnt) { int path, group, tx_idx; RTW_PRINT_SEL(sel, "5G\n"); RTW_PRINT_SEL(sel, "BW40-1S base:\n"); RTW_PRINT_SEL(sel, "%4s ", ""); for (group = 0; group < MAX_CHNL_GROUP_5G; group++) _RTW_PRINT_SEL(sel, "G%02d ", group); _RTW_PRINT_SEL(sel, "\n"); for (path = 0; path < MAX_RF_PATH && path < rfpath_num; path++) { RTW_PRINT_SEL(sel, "[%c]: ", rf_path_char(path)); for (group = 0; group < MAX_CHNL_GROUP_5G; group++) _RTW_PRINT_SEL(sel, "%3u ", txpwr_info->IndexBW40_Base[path][group]); _RTW_PRINT_SEL(sel, "\n"); } RTW_PRINT_SEL(sel, "\n"); RTW_PRINT_SEL(sel, "OFDM diff:\n"); RTW_PRINT_SEL(sel, "%4s ", ""); for (path = 0; path < MAX_RF_PATH && path < rfpath_num; path++) _RTW_PRINT_SEL(sel, "%dT ", path + 1); _RTW_PRINT_SEL(sel, "\n"); for (path = 0; path < MAX_RF_PATH && path < rfpath_num; path++) { RTW_PRINT_SEL(sel, "[%c]: ", rf_path_char(path)); for (tx_idx = RF_1TX; tx_idx < MAX_TX_COUNT && tx_idx < max_tx_cnt; tx_idx++) _RTW_PRINT_SEL(sel, "%2d ", txpwr_info->OFDM_Diff[path][tx_idx]); _RTW_PRINT_SEL(sel, "\n"); } RTW_PRINT_SEL(sel, "\n"); RTW_PRINT_SEL(sel, "BW20 diff:\n"); RTW_PRINT_SEL(sel, "%4s ", ""); for (path = 0; path < MAX_RF_PATH && path < rfpath_num; path++) _RTW_PRINT_SEL(sel, "%dS ", path + 1); _RTW_PRINT_SEL(sel, "\n"); for (path = 0; path < MAX_RF_PATH && path < rfpath_num; path++) { RTW_PRINT_SEL(sel, "[%c]: ", rf_path_char(path)); for (tx_idx = RF_1TX; tx_idx < MAX_TX_COUNT && tx_idx < max_tx_cnt; tx_idx++) _RTW_PRINT_SEL(sel, "%2d ", txpwr_info->BW20_Diff[path][tx_idx]); _RTW_PRINT_SEL(sel, "\n"); } RTW_PRINT_SEL(sel, "\n"); RTW_PRINT_SEL(sel, "BW40 diff:\n"); RTW_PRINT_SEL(sel, "%4s ", ""); for (path = 0; path < MAX_RF_PATH && path < rfpath_num; path++) _RTW_PRINT_SEL(sel, "%dS ", path + 1); _RTW_PRINT_SEL(sel, "\n"); for (path = 0; path < MAX_RF_PATH && path < rfpath_num; path++) { RTW_PRINT_SEL(sel, "[%c]: ", rf_path_char(path)); for (tx_idx = RF_1TX; tx_idx < MAX_TX_COUNT && tx_idx < max_tx_cnt; tx_idx++) _RTW_PRINT_SEL(sel, "%2d ", txpwr_info->BW40_Diff[path][tx_idx]); _RTW_PRINT_SEL(sel, "\n"); } RTW_PRINT_SEL(sel, "\n"); RTW_PRINT_SEL(sel, "BW80 diff:\n"); RTW_PRINT_SEL(sel, "%4s ", ""); for (path = 0; path < MAX_RF_PATH && path < rfpath_num; path++) _RTW_PRINT_SEL(sel, "%dS ", path + 1); _RTW_PRINT_SEL(sel, "\n"); for (path = 0; path < MAX_RF_PATH && path < rfpath_num; path++) { RTW_PRINT_SEL(sel, "[%c]: ", rf_path_char(path)); for (tx_idx = RF_1TX; tx_idx < MAX_TX_COUNT && tx_idx < max_tx_cnt; tx_idx++) _RTW_PRINT_SEL(sel, "%2d ", txpwr_info->BW80_Diff[path][tx_idx]); _RTW_PRINT_SEL(sel, "\n"); } RTW_PRINT_SEL(sel, "\n"); RTW_PRINT_SEL(sel, "BW160 diff:\n"); RTW_PRINT_SEL(sel, "%4s ", ""); for (path = 0; path < MAX_RF_PATH && path < rfpath_num; path++) _RTW_PRINT_SEL(sel, "%dS ", path + 1); _RTW_PRINT_SEL(sel, "\n"); for (path = 0; path < MAX_RF_PATH && path < rfpath_num; path++) { RTW_PRINT_SEL(sel, "[%c]: ", rf_path_char(path)); for (tx_idx = RF_1TX; tx_idx < MAX_TX_COUNT && tx_idx < max_tx_cnt; tx_idx++) _RTW_PRINT_SEL(sel, "%2d ", txpwr_info->BW160_Diff[path][tx_idx]); _RTW_PRINT_SEL(sel, "\n"); } RTW_PRINT_SEL(sel, "\n"); } #endif /* DBG_PG_TXPWR_READ */ const struct map_t pg_txpwr_def_info = MAP_ENT(0xB8, 1, 0xFF , MAPSEG_ARRAY_ENT(0x10, 168, 0x2D, 0x2D, 0x2D, 0x2D, 0x2D, 0x2D, 0x2D, 0x2D, 0x2D, 0x2D, 0x2D, 0x24, 0xEE, 0xEE, 0xEE, 0xEE, 0xEE, 0xEE, 0x2A, 0x2A, 0x2A, 0x2A, 0x2A, 0x2A, 0x2A, 0x2A, 0x2A, 0x2A, 0x2A, 0x2A, 0x2A, 0x2A, 0x04, 0xEE, 0xEE, 0xEE, 0xEE, 0xEE, 0xEE, 0xEE, 0xEE, 0xEE, 0x2D, 0x2D, 0x2D, 0x2D, 0x2D, 0x2D, 0x2D, 0x2D, 0x2D, 0x2D, 0x2D, 0x24, 0xEE, 0xEE, 0xEE, 0xEE, 0xEE, 0xEE, 0x2A, 0x2A, 0x2A, 0x2A, 0x2A, 0x2A, 0x2A, 0x2A, 0x2A, 0x2A, 0x2A, 0x2A, 0x2A, 0x2A, 0x04, 0xEE, 0xEE, 0xEE, 0xEE, 0xEE, 0xEE, 0xEE, 0xEE, 0xEE, 0x2D, 0x2D, 0x2D, 0x2D, 0x2D, 0x2D, 0x2D, 0x2D, 0x2D, 0x2D, 0x2D, 0x24, 0xEE, 0xEE, 0xEE, 0xEE, 0xEE, 0xEE, 0x2A, 0x2A, 0x2A, 0x2A, 0x2A, 0x2A, 0x2A, 0x2A, 0x2A, 0x2A, 0x2A, 0x2A, 0x2A, 0x2A, 0x04, 0xEE, 0xEE, 0xEE, 0xEE, 0xEE, 0xEE, 0xEE, 0xEE, 0xEE, 0x2D, 0x2D, 0x2D, 0x2D, 0x2D, 0x2D, 0x2D, 0x2D, 0x2D, 0x2D, 0x2D, 0x24, 0xEE, 0xEE, 0xEE, 0xEE, 0xEE, 0xEE, 0x2A, 0x2A, 0x2A, 0x2A, 0x2A, 0x2A, 0x2A, 0x2A, 0x2A, 0x2A, 0x2A, 0x2A, 0x2A, 0x2A, 0x04, 0xEE, 0xEE, 0xEE, 0xEE, 0xEE, 0xEE, 0xEE, 0xEE, 0xEE) ); #ifdef CONFIG_RTL8188E static const struct map_t rtl8188e_pg_txpwr_def_info = MAP_ENT(0xB8, 1, 0xFF , MAPSEG_ARRAY_ENT(0x10, 12, 0x2D, 0x2D, 0x2D, 0x2D, 0x2D, 0x2D, 0x2D, 0x2D, 0x2D, 0x2D, 0x2D, 0x24) ); #endif #ifdef CONFIG_RTL8188F static const struct map_t rtl8188f_pg_txpwr_def_info = MAP_ENT(0xB8, 1, 0xFF , MAPSEG_ARRAY_ENT(0x10, 12, 0x22, 0x22, 0x22, 0x22, 0x22, 0x22, 0x27, 0x27, 0x27, 0x27, 0x27, 0x24) ); #endif #ifdef CONFIG_RTL8188GTV static const struct map_t rtl8188gtv_pg_txpwr_def_info = MAP_ENT(0xB8, 1, 0xFF , MAPSEG_ARRAY_ENT(0x10, 12, 0x22, 0x22, 0x22, 0x22, 0x22, 0x22, 0x27, 0x27, 0x27, 0x27, 0x27, 0x24) ); #endif #ifdef CONFIG_RTL8723B static const struct map_t rtl8723b_pg_txpwr_def_info = MAP_ENT(0xB8, 2, 0xFF , MAPSEG_ARRAY_ENT(0x10, 12, 0x2D, 0x2D, 0x2D, 0x2D, 0x2D, 0x2D, 0x2D, 0x2D, 0x2D, 0x2D, 0x2D, 0xE0) , MAPSEG_ARRAY_ENT(0x3A, 12, 0x2D, 0x2D, 0x2D, 0x2D, 0x2D, 0x2D, 0x2D, 0x2D, 0x2D, 0x2D, 0x2D, 0xE0) ); #endif #ifdef CONFIG_RTL8703B static const struct map_t rtl8703b_pg_txpwr_def_info = MAP_ENT(0xB8, 1, 0xFF , MAPSEG_ARRAY_ENT(0x10, 12, 0x2D, 0x2D, 0x2D, 0x2D, 0x2D, 0x2D, 0x2D, 0x2D, 0x2D, 0x2D, 0x2D, 0x02) ); #endif #ifdef CONFIG_RTL8723D static const struct map_t rtl8723d_pg_txpwr_def_info = MAP_ENT(0xB8, 2, 0xFF , MAPSEG_ARRAY_ENT(0x10, 12, 0x2D, 0x2D, 0x2D, 0x2D, 0x2D, 0x2D, 0x2D, 0x2D, 0x2D, 0x2D, 0x2D, 0x02) , MAPSEG_ARRAY_ENT(0x3A, 12, 0x22, 0x22, 0x22, 0x22, 0x22, 0x22, 0x21, 0x21, 0x21, 0x21, 0x21, 0x02) ); #endif #ifdef CONFIG_RTL8192E static const struct map_t rtl8192e_pg_txpwr_def_info = MAP_ENT(0xB8, 2, 0xFF , MAPSEG_ARRAY_ENT(0x10, 14, 0x2D, 0x2D, 0x2D, 0x2D, 0x2D, 0x2D, 0x2D, 0x2D, 0x2D, 0x2D, 0x2D, 0x24, 0xEE, 0xEE) , MAPSEG_ARRAY_ENT(0x3A, 14, 0x2D, 0x2D, 0x2D, 0x2D, 0x2D, 0x2D, 0x2D, 0x2D, 0x2D, 0x2D, 0x2D, 0x24, 0xEE, 0xEE) ); #endif #ifdef CONFIG_RTL8821A static const struct map_t rtl8821a_pg_txpwr_def_info = MAP_ENT(0xB8, 1, 0xFF , MAPSEG_ARRAY_ENT(0x10, 39, 0x2D, 0x2D, 0x2D, 0x2D, 0x2D, 0x2D, 0x2D, 0x2D, 0x2D, 0x2D, 0x2D, 0x24, 0xFF, 0xFF, 0xFF, 0xFF, 0xFF, 0xFF, 0x2A, 0x2A, 0x2A, 0x2A, 0x2A, 0x2A, 0x2A, 0x2A, 0x2A, 0x2A, 0x2A, 0x2A, 0x2A, 0x2A, 0x04, 0xFF, 0xFF, 0xFF, 0xFF, 0xFF, 0x00) ); #endif #ifdef CONFIG_RTL8821C static const struct map_t rtl8821c_pg_txpwr_def_info = MAP_ENT(0xB8, 1, 0xFF , MAPSEG_ARRAY_ENT(0x10, 54, 0x2D, 0x2D, 0x2D, 0x2D, 0x2D, 0x2D, 0x2D, 0x2D, 0x2D, 0x2D, 0x2D, 0x02, 0xFF, 0xFF, 0xFF, 0xFF, 0xFF, 0xFF, 0x28, 0x28, 0x28, 0x28, 0x28, 0x28, 0x28, 0x28, 0x28, 0x28, 0x28, 0x28, 0x28, 0x28, 0x02, 0xFF, 0xFF, 0xFF, 0xFF, 0xFF, 0xEC, 0xFF, 0xFF, 0xFF, 0x2D, 0x2D, 0x2D, 0x2D, 0x2D, 0x2D, 0x2D, 0x2D, 0x2D, 0x2D, 0x2D, 0x02) ); #endif #ifdef CONFIG_RTL8710B static const struct map_t rtl8710b_pg_txpwr_def_info = MAP_ENT(0xC8, 1, 0xFF , MAPSEG_ARRAY_ENT(0x20, 12, 0x2D, 0x2D, 0x2D, 0x2D, 0x2D, 0x2D, 0x2D, 0x2D, 0x2D, 0x2D, 0x2D, 0x20) ); #endif #ifdef CONFIG_RTL8812A static const struct map_t rtl8812a_pg_txpwr_def_info = MAP_ENT(0xB8, 1, 0xFF , MAPSEG_ARRAY_ENT(0x10, 82, 0x2D, 0x2D, 0x2D, 0x2D, 0x2D, 0x2D, 0x2D, 0x2D, 0x2D, 0x2D, 0x2D, 0x02, 0xEE, 0xEE, 0xFF, 0xFF, 0xFF, 0xFF, 0x2A, 0x2A, 0x2A, 0x2A, 0x2A, 0x2A, 0x2A, 0x2A, 0x2A, 0x2A, 0x2A, 0x2A, 0x2A, 0x2A, 0x02, 0xEE, 0xFF, 0xFF, 0xEE, 0xFF, 0x00, 0xEE, 0xFF, 0xFF, 0x2D, 0x2D, 0x2D, 0x2D, 0x2D, 0x2D, 0x2D, 0x2D, 0x2D, 0x2D, 0x2D, 0x02, 0xEE, 0xEE, 0xFF, 0xFF, 0xFF, 0xFF, 0x2A, 0x2A, 0x2A, 0x2A, 0x2A, 0x2A, 0x2A, 0x2A, 0x2A, 0x2A, 0x2A, 0x2A, 0x2A, 0x2A, 0x02, 0xEE, 0xFF, 0xFF, 0xEE, 0xFF, 0x00, 0xEE) ); #endif #ifdef CONFIG_RTL8822B static const struct map_t rtl8822b_pg_txpwr_def_info = MAP_ENT(0xB8, 1, 0xFF , MAPSEG_ARRAY_ENT(0x10, 82, 0x2D, 0x2D, 0x2D, 0x2D, 0x2D, 0x2D, 0x2D, 0x2D, 0x2D, 0x2D, 0x2D, 0x02, 0xEE, 0xEE, 0xFF, 0xFF, 0xFF, 0xFF, 0x2A, 0x2A, 0x2A, 0x2A, 0x2A, 0x2A, 0x2A, 0x2A, 0x2A, 0x2A, 0x2A, 0x2A, 0x2A, 0x2A, 0x02, 0xEE, 0xFF, 0xFF, 0xEE, 0xFF, 0xEC, 0xEC, 0xFF, 0xFF, 0x2D, 0x2D, 0x2D, 0x2D, 0x2D, 0x2D, 0x2D, 0x2D, 0x2D, 0x2D, 0x2D, 0x02, 0xEE, 0xEE, 0xFF, 0xFF, 0xFF, 0xFF, 0x2A, 0x2A, 0x2A, 0x2A, 0x2A, 0x2A, 0x2A, 0x2A, 0x2A, 0x2A, 0x2A, 0x2A, 0x2A, 0x2A, 0x02, 0xEE, 0xFF, 0xFF, 0xEE, 0xFF, 0xEC, 0xEC) ); #endif #ifdef CONFIG_RTL8822C static const struct map_t rtl8822c_pg_txpwr_def_info = MAP_ENT(0xB8, 1, 0xFF , MAPSEG_ARRAY_ENT(0x10, 82, 0x33, 0x33, 0x33, 0x33, 0x33, 0x33, 0x33, 0x33, 0x33, 0x33, 0x33, 0x02, 0x00, 0x00, 0xFF, 0xFF, 0xFF, 0xFF, 0x33, 0x33, 0x33, 0x33, 0x33, 0x33, 0x33, 0x33, 0x33, 0x33, 0x33, 0x33, 0x33, 0x33, 0x02, 0x00, 0xFF, 0xFF, 0x00, 0xFF, 0x00, 0x00, 0xFF, 0xFF, 0x33, 0x33, 0x33, 0x33, 0x33, 0x33, 0x33, 0x33, 0x33, 0x33, 0x33, 0x02, 0x00, 0x00, 0xFF, 0xFF, 0xFF, 0xFF, 0x33, 0x33, 0x33, 0x33, 0x33, 0x33, 0x33, 0x33, 0x33, 0x33, 0x33, 0x33, 0x33, 0x33, 0x02, 0x00, 0xFF, 0xFF, 0x00, 0xFF, 0x00, 0x00) ); #endif #ifdef CONFIG_RTL8814A static const struct map_t rtl8814a_pg_txpwr_def_info = MAP_ENT(0xB8, 1, 0xFF , MAPSEG_ARRAY_ENT(0x10, 168, 0x2D, 0x2D, 0x2D, 0x2D, 0x2D, 0x2D, 0x2D, 0x2D, 0x2D, 0x2D, 0x2D, 0x02, 0xEE, 0xEE, 0xEE, 0xEE, 0xEE, 0xEE, 0x2A, 0x2A, 0x2A, 0x2A, 0x2A, 0x2A, 0x2A, 0x2A, 0x2A, 0x2A, 0x2A, 0x2A, 0x2A, 0x2A, 0x02, 0xEE, 0xEE, 0xEE, 0xEE, 0xEE, 0x00, 0xEE, 0xEE, 0xEE, 0x2D, 0x2D, 0x2D, 0x2D, 0x2D, 0x2D, 0x2D, 0x2D, 0x2D, 0x2D, 0x2D, 0x02, 0xEE, 0xEE, 0xEE, 0xEE, 0xEE, 0xEE, 0x2A, 0x2A, 0x2A, 0x2A, 0x2A, 0x2A, 0x2A, 0x2A, 0x2A, 0x2A, 0x2A, 0x2A, 0x2A, 0x2A, 0x02, 0xEE, 0xEE, 0xEE, 0xEE, 0xEE, 0x00, 0xEE, 0xEE, 0xEE, 0x2D, 0x2D, 0x2D, 0x2D, 0x2D, 0x2D, 0x2D, 0x2D, 0x2D, 0x2D, 0x2D, 0x02, 0xEE, 0xEE, 0xEE, 0xEE, 0xEE, 0xEE, 0x2A, 0x2A, 0x2A, 0x2A, 0x2A, 0x2A, 0x2A, 0x2A, 0x2A, 0x2A, 0x2A, 0x2A, 0x2A, 0x2A, 0x02, 0xEE, 0xEE, 0xEE, 0xEE, 0xEE, 0x00, 0xEE, 0xEE, 0xEE, 0x2D, 0x2D, 0x2D, 0x2D, 0x2D, 0x2D, 0x2D, 0x2D, 0x2D, 0x2D, 0x2D, 0x02, 0xEE, 0xEE, 0xEE, 0xEE, 0xEE, 0xEE, 0x2A, 0x2A, 0x2A, 0x2A, 0x2A, 0x2A, 0x2A, 0x2A, 0x2A, 0x2A, 0x2A, 0x2A, 0x2A, 0x2A, 0x02, 0xEE, 0xEE, 0xEE, 0xEE, 0xEE, 0x00, 0xEE, 0xEE, 0xEE) ); #endif #ifdef CONFIG_RTL8192F/*use 8192F default,no document*/ static const struct map_t rtl8192f_pg_txpwr_def_info = MAP_ENT(0xB8, 2, 0xFF , MAPSEG_ARRAY_ENT(0x10, 14, 0x2D, 0x2D, 0x2D, 0x2D, 0x2D, 0x2D, 0x2D, 0x2D, 0x2D, 0x2D, 0x2D, 0x24, 0xEE, 0xEE) , MAPSEG_ARRAY_ENT(0x3A, 14, 0x2D, 0x2D, 0x2D, 0x2D, 0x2D, 0x2D, 0x2D, 0x2D, 0x2D, 0x2D, 0x2D, 0x24, 0xEE, 0xEE) ); #endif #ifdef CONFIG_RTL8814B static const struct map_t rtl8814b_pg_txpwr_def_info = MAP_ENT(0xB8, 1, 0xFF , MAPSEG_ARRAY_ENT(0x10, 168, 0x28, 0x28, 0x28, 0x28, 0x28, 0x28, 0x28, 0x28, 0x28, 0x28, 0x28, 0x02, 0xFF, 0xFF, 0xFF, 0xFF, 0xFF, 0xFF, 0x28, 0x28, 0x28, 0x28, 0x28, 0x28, 0x28, 0x28, 0x28, 0x28, 0x28, 0x28, 0x28, 0x28, 0x02, 0xFF, 0xFF, 0xFF, 0xFF, 0xFF, 0xEC, 0xFF, 0xFF, 0xFF, 0x28, 0x28, 0x28, 0x28, 0x28, 0x28, 0x28, 0x28, 0x28, 0x28, 0x28, 0x02, 0xFF, 0xFF, 0xFF, 0xFF, 0xFF, 0xFF, 0xFF, 0xFF, 0xFF, 0xFF, 0xFF, 0xFF, 0xFF, 0xFF, 0xFF, 0xFF, 0xFF, 0xFF, 0xFF, 0xFF, 0xFF, 0xFF, 0xFF, 0xFF, 0xFF, 0xFF, 0xFF, 0xFF, 0xFF, 0xFF, 0xFF, 0xFF, 0xFF, 0xFF, 0xFF, 0xFF, 0xFF, 0xFF, 0xFF, 0xFF, 0xFF, 0xFF, 0xFF, 0xFF, 0xFF, 0xFF, 0xFF, 0xFF, 0xFF, 0xFF, 0xFF, 0xFF, 0xFF, 0xFF, 0xFF, 0xFF, 0xFF, 0xFF, 0xFF, 0xFF, 0xFF, 0xFF, 0xFF, 0xFF, 0xFF, 0xFF, 0xFF, 0xFF, 0xFF, 0xFF, 0xFF, 0xFF, 0xFF, 0xFF, 0xFF, 0xFF, 0xFF, 0xFF, 0xFF, 0xFF, 0xFF, 0xFF, 0xFF, 0xFF, 0xFF, 0xFF, 0xFF, 0xFF, 0xFF, 0xFF, 0xFF, 0xFF, 0xFF, 0xFF, 0xFF, 0xFF, 0xFF, 0xFF, 0xFF, 0xFF, 0xFF, 0xFF, 0xFF, 0xFF, 0xFF, 0xFF, 0xFF, 0xFF, 0xFF, 0xFF, 0xFF, 0xFF, 0xFF, 0xFF) ); #endif const struct map_t *hal_pg_txpwr_def_info(_adapter *adapter) { u8 interface_type = 0; const struct map_t *map = NULL; interface_type = rtw_get_intf_type(adapter); switch (rtw_get_chip_type(adapter)) { #ifdef CONFIG_RTL8723B case RTL8723B: map = &rtl8723b_pg_txpwr_def_info; break; #endif #ifdef CONFIG_RTL8703B case RTL8703B: map = &rtl8703b_pg_txpwr_def_info; break; #endif #ifdef CONFIG_RTL8723D case RTL8723D: map = &rtl8723d_pg_txpwr_def_info; break; #endif #ifdef CONFIG_RTL8188E case RTL8188E: map = &rtl8188e_pg_txpwr_def_info; break; #endif #ifdef CONFIG_RTL8188F case RTL8188F: map = &rtl8188f_pg_txpwr_def_info; break; #endif #ifdef CONFIG_RTL8188GTV case RTL8188GTV: map = &rtl8188gtv_pg_txpwr_def_info; break; #endif #ifdef CONFIG_RTL8812A case RTL8812: map = &rtl8812a_pg_txpwr_def_info; break; #endif #ifdef CONFIG_RTL8821A case RTL8821: map = &rtl8821a_pg_txpwr_def_info; break; #endif #ifdef CONFIG_RTL8192E case RTL8192E: map = &rtl8192e_pg_txpwr_def_info; break; #endif #ifdef CONFIG_RTL8814A case RTL8814A: map = &rtl8814a_pg_txpwr_def_info; break; #endif #ifdef CONFIG_RTL8822B case RTL8822B: map = &rtl8822b_pg_txpwr_def_info; break; #endif #ifdef CONFIG_RTL8821C case RTL8821C: map = &rtl8821c_pg_txpwr_def_info; break; #endif #ifdef CONFIG_RTL8710B case RTL8710B: map = &rtl8710b_pg_txpwr_def_info; break; #endif #ifdef CONFIG_RTL8192F case RTL8192F: map = &rtl8192f_pg_txpwr_def_info; break; #endif #ifdef CONFIG_RTL8822C case RTL8822C: map = &rtl8822c_pg_txpwr_def_info; break; #endif #ifdef CONFIG_RTL8814B case RTL8814B: map = &rtl8814b_pg_txpwr_def_info; break; #endif } if (map == NULL) { RTW_ERR("%s: unknown chip_type:%u\n" , __func__, rtw_get_chip_type(adapter)); rtw_warn_on(1); } return map; } static u8 hal_chk_pg_txpwr_info_2g(_adapter *adapter, TxPowerInfo24G *pwr_info) { HAL_DATA_TYPE *hal_data = GET_HAL_DATA(adapter); struct hal_spec_t *hal_spec = GET_HAL_SPEC(adapter); u8 path, group, tx_idx; if (pwr_info == NULL || !hal_chk_band_cap(adapter, BAND_CAP_2G)) return _SUCCESS; for (path = 0; path < MAX_RF_PATH; path++) { if (!HAL_SPEC_CHK_RF_PATH_2G(hal_spec, path)) continue; for (group = 0; group < MAX_CHNL_GROUP_24G; group++) { if (IS_PG_TXPWR_BASE_INVALID(hal_spec, pwr_info->IndexCCK_Base[path][group]) || IS_PG_TXPWR_BASE_INVALID(hal_spec, pwr_info->IndexBW40_Base[path][group])) return _FAIL; } for (tx_idx = 0; tx_idx < MAX_TX_COUNT; tx_idx++) { if (tx_idx + 1 > hal_data->max_tx_cnt) continue; if (IS_PG_TXPWR_DIFF_INVALID(pwr_info->CCK_Diff[path][tx_idx]) || IS_PG_TXPWR_DIFF_INVALID(pwr_info->OFDM_Diff[path][tx_idx]) || IS_PG_TXPWR_DIFF_INVALID(pwr_info->BW20_Diff[path][tx_idx]) || IS_PG_TXPWR_DIFF_INVALID(pwr_info->BW40_Diff[path][tx_idx])) return _FAIL; } } return _SUCCESS; } static u8 hal_chk_pg_txpwr_info_5g(_adapter *adapter, TxPowerInfo5G *pwr_info) { #if CONFIG_IEEE80211_BAND_5GHZ HAL_DATA_TYPE *hal_data = GET_HAL_DATA(adapter); struct hal_spec_t *hal_spec = GET_HAL_SPEC(adapter); u8 path, group, tx_idx; if (pwr_info == NULL || !hal_chk_band_cap(adapter, BAND_CAP_5G)) return _SUCCESS; for (path = 0; path < MAX_RF_PATH; path++) { if (!HAL_SPEC_CHK_RF_PATH_5G(hal_spec, path)) continue; for (group = 0; group < MAX_CHNL_GROUP_5G; group++) if (IS_PG_TXPWR_BASE_INVALID(hal_spec, pwr_info->IndexBW40_Base[path][group])) return _FAIL; for (tx_idx = 0; tx_idx < MAX_TX_COUNT; tx_idx++) { if (tx_idx + 1 > hal_data->max_tx_cnt) continue; if (IS_PG_TXPWR_DIFF_INVALID(pwr_info->OFDM_Diff[path][tx_idx]) || IS_PG_TXPWR_DIFF_INVALID(pwr_info->BW20_Diff[path][tx_idx]) || IS_PG_TXPWR_DIFF_INVALID(pwr_info->BW40_Diff[path][tx_idx]) || IS_PG_TXPWR_DIFF_INVALID(pwr_info->BW80_Diff[path][tx_idx]) || IS_PG_TXPWR_DIFF_INVALID(pwr_info->BW160_Diff[path][tx_idx])) return _FAIL; } } #endif /* CONFIG_IEEE80211_BAND_5GHZ */ return _SUCCESS; } static inline void hal_init_pg_txpwr_info_2g(_adapter *adapter, TxPowerInfo24G *pwr_info) { struct hal_spec_t *hal_spec = GET_HAL_SPEC(adapter); u8 path, group, tx_idx; if (pwr_info == NULL) return; _rtw_memset(pwr_info, 0, sizeof(TxPowerInfo24G)); /* init with invalid value */ for (path = 0; path < MAX_RF_PATH; path++) { for (group = 0; group < MAX_CHNL_GROUP_24G; group++) { pwr_info->IndexCCK_Base[path][group] = PG_TXPWR_INVALID_BASE; pwr_info->IndexBW40_Base[path][group] = PG_TXPWR_INVALID_BASE; } for (tx_idx = 0; tx_idx < MAX_TX_COUNT; tx_idx++) { pwr_info->CCK_Diff[path][tx_idx] = PG_TXPWR_INVALID_DIFF; pwr_info->OFDM_Diff[path][tx_idx] = PG_TXPWR_INVALID_DIFF; pwr_info->BW20_Diff[path][tx_idx] = PG_TXPWR_INVALID_DIFF; pwr_info->BW40_Diff[path][tx_idx] = PG_TXPWR_INVALID_DIFF; } } /* init for dummy base and diff */ for (path = 0; path < MAX_RF_PATH; path++) { if (!HAL_SPEC_CHK_RF_PATH_2G(hal_spec, path)) break; /* 2.4G BW40 base has 1 less group than CCK base*/ pwr_info->IndexBW40_Base[path][MAX_CHNL_GROUP_24G - 1] = 0; /* dummy diff */ pwr_info->CCK_Diff[path][0] = 0; /* 2.4G CCK-1TX */ pwr_info->BW40_Diff[path][0] = 0; /* 2.4G BW40-1S */ } } static inline void hal_init_pg_txpwr_info_5g(_adapter *adapter, TxPowerInfo5G *pwr_info) { #if CONFIG_IEEE80211_BAND_5GHZ struct hal_spec_t *hal_spec = GET_HAL_SPEC(adapter); u8 path, group, tx_idx; if (pwr_info == NULL) return; _rtw_memset(pwr_info, 0, sizeof(TxPowerInfo5G)); /* init with invalid value */ for (path = 0; path < MAX_RF_PATH; path++) { for (group = 0; group < MAX_CHNL_GROUP_5G; group++) pwr_info->IndexBW40_Base[path][group] = PG_TXPWR_INVALID_BASE; for (tx_idx = 0; tx_idx < MAX_TX_COUNT; tx_idx++) { pwr_info->OFDM_Diff[path][tx_idx] = PG_TXPWR_INVALID_DIFF; pwr_info->BW20_Diff[path][tx_idx] = PG_TXPWR_INVALID_DIFF; pwr_info->BW40_Diff[path][tx_idx] = PG_TXPWR_INVALID_DIFF; pwr_info->BW80_Diff[path][tx_idx] = PG_TXPWR_INVALID_DIFF; pwr_info->BW160_Diff[path][tx_idx] = PG_TXPWR_INVALID_DIFF; } } for (path = 0; path < MAX_RF_PATH; path++) { if (!HAL_SPEC_CHK_RF_PATH_5G(hal_spec, path)) break; /* dummy diff */ pwr_info->BW40_Diff[path][0] = 0; /* 5G BW40-1S */ } #endif /* CONFIG_IEEE80211_BAND_5GHZ */ } #if DBG_PG_TXPWR_READ #define LOAD_PG_TXPWR_WARN_COND(_txpwr_src) 1 #else #define LOAD_PG_TXPWR_WARN_COND(_txpwr_src) (_txpwr_src > PG_TXPWR_SRC_PG_DATA) #endif u16 hal_load_pg_txpwr_info_path_2g( _adapter *adapter, TxPowerInfo24G *pwr_info, u32 path, u8 txpwr_src, const struct map_t *txpwr_map, u16 pg_offset) { HAL_DATA_TYPE *hal_data = GET_HAL_DATA(adapter); struct hal_spec_t *hal_spec = GET_HAL_SPEC(adapter); u16 offset = pg_offset; u8 group, tx_idx; u8 val; u8 tmp_base; s8 tmp_diff; if (pwr_info == NULL || !hal_chk_band_cap(adapter, BAND_CAP_2G)) { offset += PG_TXPWR_1PATH_BYTE_NUM_2G; goto exit; } if (DBG_PG_TXPWR_READ) RTW_INFO("%s [%c] offset:0x%03x\n", __func__, rf_path_char(path), offset); for (group = 0; group < MAX_CHNL_GROUP_24G; group++) { if (HAL_SPEC_CHK_RF_PATH_2G(hal_spec, path)) { tmp_base = map_read8(txpwr_map, offset); if (!IS_PG_TXPWR_BASE_INVALID(hal_spec, tmp_base) && IS_PG_TXPWR_BASE_INVALID(hal_spec, pwr_info->IndexCCK_Base[path][group]) ) { pwr_info->IndexCCK_Base[path][group] = tmp_base; if (LOAD_PG_TXPWR_WARN_COND(txpwr_src)) RTW_INFO("[%c] 2G G%02d CCK-1T base:%u from %s\n", rf_path_char(path), group, tmp_base, pg_txpwr_src_str(txpwr_src)); } } offset++; } for (group = 0; group < MAX_CHNL_GROUP_24G - 1; group++) { if (HAL_SPEC_CHK_RF_PATH_2G(hal_spec, path)) { tmp_base = map_read8(txpwr_map, offset); if (!IS_PG_TXPWR_BASE_INVALID(hal_spec, tmp_base) && IS_PG_TXPWR_BASE_INVALID(hal_spec, pwr_info->IndexBW40_Base[path][group]) ) { pwr_info->IndexBW40_Base[path][group] = tmp_base; if (LOAD_PG_TXPWR_WARN_COND(txpwr_src)) RTW_INFO("[%c] 2G G%02d BW40-1S base:%u from %s\n", rf_path_char(path), group, tmp_base, pg_txpwr_src_str(txpwr_src)); } } offset++; } for (tx_idx = 0; tx_idx < MAX_TX_COUNT; tx_idx++) { if (tx_idx == 0) { if (HAL_SPEC_CHK_RF_PATH_2G(hal_spec, path)) { val = map_read8(txpwr_map, offset); tmp_diff = PG_TXPWR_MSB_DIFF_TO_S8BIT(val); if (!IS_PG_TXPWR_DIFF_INVALID(tmp_diff) && IS_PG_TXPWR_DIFF_INVALID(pwr_info->BW20_Diff[path][tx_idx]) ) { pwr_info->BW20_Diff[path][tx_idx] = tmp_diff; if (LOAD_PG_TXPWR_WARN_COND(txpwr_src)) RTW_INFO("[%c] 2G BW20-%dS diff:%d from %s\n", rf_path_char(path), tx_idx + 1, tmp_diff, pg_txpwr_src_str(txpwr_src)); } tmp_diff = PG_TXPWR_LSB_DIFF_TO_S8BIT(val); if (!IS_PG_TXPWR_DIFF_INVALID(tmp_diff) && IS_PG_TXPWR_DIFF_INVALID(pwr_info->OFDM_Diff[path][tx_idx]) ) { pwr_info->OFDM_Diff[path][tx_idx] = tmp_diff; if (LOAD_PG_TXPWR_WARN_COND(txpwr_src)) RTW_INFO("[%c] 2G OFDM-%dT diff:%d from %s\n", rf_path_char(path), tx_idx + 1, tmp_diff, pg_txpwr_src_str(txpwr_src)); } } offset++; } else { if (HAL_SPEC_CHK_RF_PATH_2G(hal_spec, path) && tx_idx + 1 <= hal_data->max_tx_cnt) { val = map_read8(txpwr_map, offset); tmp_diff = PG_TXPWR_MSB_DIFF_TO_S8BIT(val); if (!IS_PG_TXPWR_DIFF_INVALID(tmp_diff) && IS_PG_TXPWR_DIFF_INVALID(pwr_info->BW40_Diff[path][tx_idx]) ) { pwr_info->BW40_Diff[path][tx_idx] = tmp_diff; if (LOAD_PG_TXPWR_WARN_COND(txpwr_src)) RTW_INFO("[%c] 2G BW40-%dS diff:%d from %s\n", rf_path_char(path), tx_idx + 1, tmp_diff, pg_txpwr_src_str(txpwr_src)); } tmp_diff = PG_TXPWR_LSB_DIFF_TO_S8BIT(val); if (!IS_PG_TXPWR_DIFF_INVALID(tmp_diff) && IS_PG_TXPWR_DIFF_INVALID(pwr_info->BW20_Diff[path][tx_idx]) ) { pwr_info->BW20_Diff[path][tx_idx] = tmp_diff; if (LOAD_PG_TXPWR_WARN_COND(txpwr_src)) RTW_INFO("[%c] 2G BW20-%dS diff:%d from %s\n", rf_path_char(path), tx_idx + 1, tmp_diff, pg_txpwr_src_str(txpwr_src)); } } offset++; if (HAL_SPEC_CHK_RF_PATH_2G(hal_spec, path) && tx_idx + 1 <= hal_data->max_tx_cnt) { val = map_read8(txpwr_map, offset); tmp_diff = PG_TXPWR_MSB_DIFF_TO_S8BIT(val); if (!IS_PG_TXPWR_DIFF_INVALID(tmp_diff) && IS_PG_TXPWR_DIFF_INVALID(pwr_info->OFDM_Diff[path][tx_idx]) ) { pwr_info->OFDM_Diff[path][tx_idx] = tmp_diff; if (LOAD_PG_TXPWR_WARN_COND(txpwr_src)) RTW_INFO("[%c] 2G OFDM-%dT diff:%d from %s\n", rf_path_char(path), tx_idx + 1, tmp_diff, pg_txpwr_src_str(txpwr_src)); } tmp_diff = PG_TXPWR_LSB_DIFF_TO_S8BIT(val); if (!IS_PG_TXPWR_DIFF_INVALID(tmp_diff) && IS_PG_TXPWR_DIFF_INVALID(pwr_info->CCK_Diff[path][tx_idx]) ) { pwr_info->CCK_Diff[path][tx_idx] = tmp_diff; if (LOAD_PG_TXPWR_WARN_COND(txpwr_src)) RTW_INFO("[%c] 2G CCK-%dT diff:%d from %s\n", rf_path_char(path), tx_idx + 1, tmp_diff, pg_txpwr_src_str(txpwr_src)); } } offset++; } } if (offset != pg_offset + PG_TXPWR_1PATH_BYTE_NUM_2G) { RTW_ERR("%s parse %d bytes != %d\n", __func__, offset - pg_offset, PG_TXPWR_1PATH_BYTE_NUM_2G); rtw_warn_on(1); } exit: return offset; } u16 hal_load_pg_txpwr_info_path_5g( _adapter *adapter, TxPowerInfo5G *pwr_info, u32 path, u8 txpwr_src, const struct map_t *txpwr_map, u16 pg_offset) { HAL_DATA_TYPE *hal_data = GET_HAL_DATA(adapter); struct hal_spec_t *hal_spec = GET_HAL_SPEC(adapter); u16 offset = pg_offset; u8 group, tx_idx; u8 val; u8 tmp_base; s8 tmp_diff; #if CONFIG_IEEE80211_BAND_5GHZ if (pwr_info == NULL || !hal_chk_band_cap(adapter, BAND_CAP_5G)) #endif { offset += PG_TXPWR_1PATH_BYTE_NUM_5G; goto exit; } #if CONFIG_IEEE80211_BAND_5GHZ if (DBG_PG_TXPWR_READ) RTW_INFO("%s[%c] eaddr:0x%03x\n", __func__, rf_path_char(path), offset); for (group = 0; group < MAX_CHNL_GROUP_5G; group++) { if (HAL_SPEC_CHK_RF_PATH_5G(hal_spec, path)) { tmp_base = map_read8(txpwr_map, offset); if (!IS_PG_TXPWR_BASE_INVALID(hal_spec, tmp_base) && IS_PG_TXPWR_BASE_INVALID(hal_spec, pwr_info->IndexBW40_Base[path][group]) ) { pwr_info->IndexBW40_Base[path][group] = tmp_base; if (LOAD_PG_TXPWR_WARN_COND(txpwr_src)) RTW_INFO("[%c] 5G G%02d BW40-1S base:%u from %s\n", rf_path_char(path), group, tmp_base, pg_txpwr_src_str(txpwr_src)); } } offset++; } for (tx_idx = 0; tx_idx < MAX_TX_COUNT; tx_idx++) { if (tx_idx == 0) { if (HAL_SPEC_CHK_RF_PATH_5G(hal_spec, path)) { val = map_read8(txpwr_map, offset); tmp_diff = PG_TXPWR_MSB_DIFF_TO_S8BIT(val); if (!IS_PG_TXPWR_DIFF_INVALID(tmp_diff) && IS_PG_TXPWR_DIFF_INVALID(pwr_info->BW20_Diff[path][tx_idx]) ) { pwr_info->BW20_Diff[path][tx_idx] = tmp_diff; if (LOAD_PG_TXPWR_WARN_COND(txpwr_src)) RTW_INFO("[%c] 5G BW20-%dS diff:%d from %s\n", rf_path_char(path), tx_idx + 1, tmp_diff, pg_txpwr_src_str(txpwr_src)); } tmp_diff = PG_TXPWR_LSB_DIFF_TO_S8BIT(val); if (!IS_PG_TXPWR_DIFF_INVALID(tmp_diff) && IS_PG_TXPWR_DIFF_INVALID(pwr_info->OFDM_Diff[path][tx_idx]) ) { pwr_info->OFDM_Diff[path][tx_idx] = tmp_diff; if (LOAD_PG_TXPWR_WARN_COND(txpwr_src)) RTW_INFO("[%c] 5G OFDM-%dT diff:%d from %s\n", rf_path_char(path), tx_idx + 1, tmp_diff, pg_txpwr_src_str(txpwr_src)); } } offset++; } else { if (HAL_SPEC_CHK_RF_PATH_5G(hal_spec, path) && tx_idx + 1 <= hal_data->max_tx_cnt) { val = map_read8(txpwr_map, offset); tmp_diff = PG_TXPWR_MSB_DIFF_TO_S8BIT(val); if (!IS_PG_TXPWR_DIFF_INVALID(tmp_diff) && IS_PG_TXPWR_DIFF_INVALID(pwr_info->BW40_Diff[path][tx_idx]) ) { pwr_info->BW40_Diff[path][tx_idx] = tmp_diff; if (LOAD_PG_TXPWR_WARN_COND(txpwr_src)) RTW_INFO("[%c] 5G BW40-%dS diff:%d from %s\n", rf_path_char(path), tx_idx + 1, tmp_diff, pg_txpwr_src_str(txpwr_src)); } tmp_diff = PG_TXPWR_LSB_DIFF_TO_S8BIT(val); if (!IS_PG_TXPWR_DIFF_INVALID(tmp_diff) && IS_PG_TXPWR_DIFF_INVALID(pwr_info->BW20_Diff[path][tx_idx]) ) { pwr_info->BW20_Diff[path][tx_idx] = tmp_diff; if (LOAD_PG_TXPWR_WARN_COND(txpwr_src)) RTW_INFO("[%c] 5G BW20-%dS diff:%d from %s\n", rf_path_char(path), tx_idx + 1, tmp_diff, pg_txpwr_src_str(txpwr_src)); } } offset++; } } /* OFDM diff 2T ~ 3T */ if (HAL_SPEC_CHK_RF_PATH_5G(hal_spec, path) && hal_data->max_tx_cnt > 1) { val = map_read8(txpwr_map, offset); tmp_diff = PG_TXPWR_MSB_DIFF_TO_S8BIT(val); if (!IS_PG_TXPWR_DIFF_INVALID(tmp_diff) && IS_PG_TXPWR_DIFF_INVALID(pwr_info->OFDM_Diff[path][1]) ) { pwr_info->OFDM_Diff[path][1] = tmp_diff; if (LOAD_PG_TXPWR_WARN_COND(txpwr_src)) RTW_INFO("[%c] 5G OFDM-%dT diff:%d from %s\n", rf_path_char(path), 2, tmp_diff, pg_txpwr_src_str(txpwr_src)); } if (hal_data->max_tx_cnt > 2) { tmp_diff = PG_TXPWR_LSB_DIFF_TO_S8BIT(val); if (!IS_PG_TXPWR_DIFF_INVALID(tmp_diff) && IS_PG_TXPWR_DIFF_INVALID(pwr_info->OFDM_Diff[path][2]) ) { pwr_info->OFDM_Diff[path][2] = tmp_diff; if (LOAD_PG_TXPWR_WARN_COND(txpwr_src)) RTW_INFO("[%c] 5G OFDM-%dT diff:%d from %s\n", rf_path_char(path), 3, tmp_diff, pg_txpwr_src_str(txpwr_src)); } } } offset++; /* OFDM diff 4T */ if (HAL_SPEC_CHK_RF_PATH_5G(hal_spec, path) && hal_data->max_tx_cnt > 3) { val = map_read8(txpwr_map, offset); tmp_diff = PG_TXPWR_LSB_DIFF_TO_S8BIT(val); if (!IS_PG_TXPWR_DIFF_INVALID(tmp_diff) && IS_PG_TXPWR_DIFF_INVALID(pwr_info->OFDM_Diff[path][3]) ) { pwr_info->OFDM_Diff[path][3] = tmp_diff; if (LOAD_PG_TXPWR_WARN_COND(txpwr_src)) RTW_INFO("[%c] 5G OFDM-%dT diff:%d from %s\n", rf_path_char(path), 4, tmp_diff, pg_txpwr_src_str(txpwr_src)); } } offset++; for (tx_idx = 0; tx_idx < MAX_TX_COUNT; tx_idx++) { if (HAL_SPEC_CHK_RF_PATH_5G(hal_spec, path) && tx_idx + 1 <= hal_data->max_tx_cnt) { val = map_read8(txpwr_map, offset); tmp_diff = PG_TXPWR_MSB_DIFF_TO_S8BIT(val); if (!IS_PG_TXPWR_DIFF_INVALID(tmp_diff) && IS_PG_TXPWR_DIFF_INVALID(pwr_info->BW80_Diff[path][tx_idx]) ) { pwr_info->BW80_Diff[path][tx_idx] = tmp_diff; if (LOAD_PG_TXPWR_WARN_COND(txpwr_src)) RTW_INFO("[%c] 5G BW80-%dS diff:%d from %s\n", rf_path_char(path), tx_idx + 1, tmp_diff, pg_txpwr_src_str(txpwr_src)); } tmp_diff = PG_TXPWR_LSB_DIFF_TO_S8BIT(val); if (!IS_PG_TXPWR_DIFF_INVALID(tmp_diff) && IS_PG_TXPWR_DIFF_INVALID(pwr_info->BW160_Diff[path][tx_idx]) ) { pwr_info->BW160_Diff[path][tx_idx] = tmp_diff; if (LOAD_PG_TXPWR_WARN_COND(txpwr_src)) RTW_INFO("[%c] 5G BW160-%dS diff:%d from %s\n", rf_path_char(path), tx_idx + 1, tmp_diff, pg_txpwr_src_str(txpwr_src)); } } offset++; } if (offset != pg_offset + PG_TXPWR_1PATH_BYTE_NUM_5G) { RTW_ERR("%s parse %d bytes != %d\n", __func__, offset - pg_offset, PG_TXPWR_1PATH_BYTE_NUM_5G); rtw_warn_on(1); } #endif /* CONFIG_IEEE80211_BAND_5GHZ */ exit: return offset; } void hal_load_pg_txpwr_info( _adapter *adapter, TxPowerInfo24G *pwr_info_2g, TxPowerInfo5G *pwr_info_5g, u8 *pg_data, BOOLEAN AutoLoadFail ) { struct hal_spec_t *hal_spec = GET_HAL_SPEC(adapter); u8 path; u16 pg_offset; u8 txpwr_src = PG_TXPWR_SRC_PG_DATA; struct map_t pg_data_map = MAP_ENT(184, 1, 0xFF, MAPSEG_PTR_ENT(0x00, 184, pg_data)); const struct map_t *txpwr_map = NULL; /* init with invalid value and some dummy base and diff */ hal_init_pg_txpwr_info_2g(adapter, pwr_info_2g); hal_init_pg_txpwr_info_5g(adapter, pwr_info_5g); select_src: pg_offset = hal_spec->pg_txpwr_saddr; switch (txpwr_src) { case PG_TXPWR_SRC_PG_DATA: txpwr_map = &pg_data_map; break; case PG_TXPWR_SRC_IC_DEF: txpwr_map = hal_pg_txpwr_def_info(adapter); break; case PG_TXPWR_SRC_DEF: default: txpwr_map = &pg_txpwr_def_info; break; }; if (txpwr_map == NULL) goto end_parse; for (path = 0; path < MAX_RF_PATH ; path++) { if (!HAL_SPEC_CHK_RF_PATH_2G(hal_spec, path) && !HAL_SPEC_CHK_RF_PATH_5G(hal_spec, path)) break; pg_offset = hal_load_pg_txpwr_info_path_2g(adapter, pwr_info_2g, path, txpwr_src, txpwr_map, pg_offset); pg_offset = hal_load_pg_txpwr_info_path_5g(adapter, pwr_info_5g, path, txpwr_src, txpwr_map, pg_offset); } if (hal_chk_pg_txpwr_info_2g(adapter, pwr_info_2g) == _SUCCESS && hal_chk_pg_txpwr_info_5g(adapter, pwr_info_5g) == _SUCCESS) goto exit; end_parse: txpwr_src++; if (txpwr_src < PG_TXPWR_SRC_NUM) goto select_src; if (hal_chk_pg_txpwr_info_2g(adapter, pwr_info_2g) != _SUCCESS || hal_chk_pg_txpwr_info_5g(adapter, pwr_info_5g) != _SUCCESS) rtw_warn_on(1); exit: #if DBG_PG_TXPWR_READ if (pwr_info_2g) dump_pg_txpwr_info_2g(RTW_DBGDUMP, pwr_info_2g, 4, 4); if (pwr_info_5g) dump_pg_txpwr_info_5g(RTW_DBGDUMP, pwr_info_5g, 4, 4); #endif return; } #endif /* CONFIG_TXPWR_PG_WITH_PWR_IDX */ #ifdef CONFIG_EFUSE_CONFIG_FILE #define EFUSE_POWER_INDEX_INVALID 0xFF static u8 _check_phy_efuse_tx_power_info_valid(u8 *pg_data, int chk_len, u16 pg_offset) { int ff_cnt = 0; int i; for (i = 0; i < chk_len; i++) { if (*(pg_data + pg_offset + i) == 0xFF) ff_cnt++; } if (ff_cnt == 0) return _TRUE; else if (ff_cnt == chk_len) return _FALSE; else return EFUSE_POWER_INDEX_INVALID; } int check_phy_efuse_tx_power_info_valid(_adapter *adapter) { struct hal_spec_t *hal_spec = GET_HAL_SPEC(adapter); HAL_DATA_TYPE *hal_data = GET_HAL_DATA(adapter); u8 *pg_data = hal_data->efuse_eeprom_data; u16 pg_offset = hal_spec->pg_txpwr_saddr; u8 path; u8 valid_2g_path_bmp = 0; #if CONFIG_IEEE80211_BAND_5GHZ u8 valid_5g_path_bmp = 0; #endif /* NOTE: TSSI offset use the same layout as TXPWR base */ for (path = 0; path < MAX_RF_PATH; path++) { u8 ret = _FALSE; if (!HAL_SPEC_CHK_RF_PATH_2G(hal_spec, path) && !HAL_SPEC_CHK_RF_PATH_5G(hal_spec, path)) break; if (HAL_SPEC_CHK_RF_PATH_2G(hal_spec, path)) { ret = _check_phy_efuse_tx_power_info_valid(pg_data, PG_TXPWR_BASE_BYTE_NUM_2G, pg_offset); if (ret == _TRUE) valid_2g_path_bmp |= BIT(path); else if (ret == EFUSE_POWER_INDEX_INVALID) return _FALSE; } pg_offset += PG_TXPWR_1PATH_BYTE_NUM_2G; #if CONFIG_IEEE80211_BAND_5GHZ if (HAL_SPEC_CHK_RF_PATH_5G(hal_spec, path)) { ret = _check_phy_efuse_tx_power_info_valid(pg_data, PG_TXPWR_BASE_BYTE_NUM_5G, pg_offset); if (ret == _TRUE) valid_5g_path_bmp |= BIT(path); else if (ret == EFUSE_POWER_INDEX_INVALID) return _FALSE; } #endif pg_offset += PG_TXPWR_1PATH_BYTE_NUM_5G; } if ((hal_chk_band_cap(adapter, BAND_CAP_2G) && valid_2g_path_bmp) #if CONFIG_IEEE80211_BAND_5GHZ || (hal_chk_band_cap(adapter, BAND_CAP_5G) && valid_5g_path_bmp) #endif ) return _TRUE; return _FALSE; } #endif /* CONFIG_EFUSE_CONFIG_FILE */ #ifdef CONFIG_TXPWR_PG_WITH_PWR_IDX void hal_load_txpwr_info(_adapter *adapter) { HAL_DATA_TYPE *hal_data = GET_HAL_DATA(adapter); struct hal_spec_t *hal_spec = GET_HAL_SPEC(adapter); u8 max_tx_cnt = hal_data->max_tx_cnt; u8 *pg_data = hal_data->efuse_eeprom_data; TxPowerInfo24G *pwr_info_2g = NULL; TxPowerInfo5G *pwr_info_5g = NULL; u8 rfpath, ch_idx, group, tx_idx; if (hal_chk_band_cap(adapter, BAND_CAP_2G)) pwr_info_2g = rtw_vmalloc(sizeof(TxPowerInfo24G)); #if CONFIG_IEEE80211_BAND_5GHZ if (hal_chk_band_cap(adapter, BAND_CAP_5G)) pwr_info_5g = rtw_vmalloc(sizeof(TxPowerInfo5G)); #endif /* load from pg data (or default value) */ hal_load_pg_txpwr_info(adapter, pwr_info_2g, pwr_info_5g, pg_data, _FALSE); /* transform to hal_data */ for (rfpath = 0; rfpath < MAX_RF_PATH; rfpath++) { if (!pwr_info_2g || !HAL_SPEC_CHK_RF_PATH_2G(hal_spec, rfpath)) goto bypass_2g; /* 2.4G base */ for (ch_idx = 0; ch_idx < CENTER_CH_2G_NUM; ch_idx++) { u8 cck_group; if (rtw_get_ch_group(ch_idx + 1, &group, &cck_group) != BAND_ON_2_4G) continue; hal_data->Index24G_CCK_Base[rfpath][ch_idx] = pwr_info_2g->IndexCCK_Base[rfpath][cck_group]; hal_data->Index24G_BW40_Base[rfpath][ch_idx] = pwr_info_2g->IndexBW40_Base[rfpath][group]; } /* 2.4G diff */ for (tx_idx = 0; tx_idx < MAX_TX_COUNT; tx_idx++) { if (tx_idx + 1 > max_tx_cnt) break; hal_data->CCK_24G_Diff[rfpath][tx_idx] = pwr_info_2g->CCK_Diff[rfpath][tx_idx] * hal_spec->pg_txgi_diff_factor; hal_data->OFDM_24G_Diff[rfpath][tx_idx] = pwr_info_2g->OFDM_Diff[rfpath][tx_idx] * hal_spec->pg_txgi_diff_factor; hal_data->BW20_24G_Diff[rfpath][tx_idx] = pwr_info_2g->BW20_Diff[rfpath][tx_idx] * hal_spec->pg_txgi_diff_factor; hal_data->BW40_24G_Diff[rfpath][tx_idx] = pwr_info_2g->BW40_Diff[rfpath][tx_idx] * hal_spec->pg_txgi_diff_factor; } bypass_2g: ; #if CONFIG_IEEE80211_BAND_5GHZ if (!pwr_info_5g || !HAL_SPEC_CHK_RF_PATH_5G(hal_spec, rfpath)) goto bypass_5g; /* 5G base */ for (ch_idx = 0; ch_idx < CENTER_CH_5G_ALL_NUM; ch_idx++) { if (rtw_get_ch_group(center_ch_5g_all[ch_idx], &group, NULL) != BAND_ON_5G) continue; hal_data->Index5G_BW40_Base[rfpath][ch_idx] = pwr_info_5g->IndexBW40_Base[rfpath][group]; } for (ch_idx = 0 ; ch_idx < CENTER_CH_5G_80M_NUM; ch_idx++) { u8 upper, lower; if (rtw_get_ch_group(center_ch_5g_80m[ch_idx], &group, NULL) != BAND_ON_5G) continue; upper = pwr_info_5g->IndexBW40_Base[rfpath][group]; lower = pwr_info_5g->IndexBW40_Base[rfpath][group + 1]; hal_data->Index5G_BW80_Base[rfpath][ch_idx] = (upper + lower) / 2; } /* 5G diff */ for (tx_idx = 0; tx_idx < MAX_TX_COUNT; tx_idx++) { if (tx_idx + 1 > max_tx_cnt) break; hal_data->OFDM_5G_Diff[rfpath][tx_idx] = pwr_info_5g->OFDM_Diff[rfpath][tx_idx] * hal_spec->pg_txgi_diff_factor; hal_data->BW20_5G_Diff[rfpath][tx_idx] = pwr_info_5g->BW20_Diff[rfpath][tx_idx] * hal_spec->pg_txgi_diff_factor; hal_data->BW40_5G_Diff[rfpath][tx_idx] = pwr_info_5g->BW40_Diff[rfpath][tx_idx] * hal_spec->pg_txgi_diff_factor; hal_data->BW80_5G_Diff[rfpath][tx_idx] = pwr_info_5g->BW80_Diff[rfpath][tx_idx] * hal_spec->pg_txgi_diff_factor; } bypass_5g: ; #endif /* CONFIG_IEEE80211_BAND_5GHZ */ } if (pwr_info_2g) rtw_vmfree(pwr_info_2g, sizeof(TxPowerInfo24G)); if (pwr_info_5g) rtw_vmfree(pwr_info_5g, sizeof(TxPowerInfo5G)); } void dump_hal_txpwr_info_2g(void *sel, _adapter *adapter, u8 rfpath_num, u8 max_tx_cnt) { HAL_DATA_TYPE *hal_data = GET_HAL_DATA(adapter); int path, ch_idx, tx_idx; RTW_PRINT_SEL(sel, "2.4G\n"); RTW_PRINT_SEL(sel, "CCK-1T base:\n"); RTW_PRINT_SEL(sel, "%4s ", ""); for (ch_idx = 0; ch_idx < CENTER_CH_2G_NUM; ch_idx++) _RTW_PRINT_SEL(sel, "%3d ", center_ch_2g[ch_idx]); _RTW_PRINT_SEL(sel, "\n"); for (path = 0; path < MAX_RF_PATH && path < rfpath_num; path++) { RTW_PRINT_SEL(sel, "[%c]: ", rf_path_char(path)); for (ch_idx = 0; ch_idx < CENTER_CH_2G_NUM; ch_idx++) _RTW_PRINT_SEL(sel, "%3u ", hal_data->Index24G_CCK_Base[path][ch_idx]); _RTW_PRINT_SEL(sel, "\n"); } RTW_PRINT_SEL(sel, "\n"); RTW_PRINT_SEL(sel, "CCK diff:\n"); RTW_PRINT_SEL(sel, "%4s ", ""); for (tx_idx = RF_1TX; tx_idx < MAX_TX_COUNT && tx_idx < max_tx_cnt; tx_idx++) _RTW_PRINT_SEL(sel, "%dT ", tx_idx + 1); _RTW_PRINT_SEL(sel, "\n"); for (path = 0; path < MAX_RF_PATH && path < rfpath_num; path++) { RTW_PRINT_SEL(sel, "[%c]: ", rf_path_char(path)); for (tx_idx = RF_1TX; tx_idx < MAX_TX_COUNT && tx_idx < max_tx_cnt; tx_idx++) _RTW_PRINT_SEL(sel, "%2d ", hal_data->CCK_24G_Diff[path][tx_idx]); _RTW_PRINT_SEL(sel, "\n"); } RTW_PRINT_SEL(sel, "\n"); RTW_PRINT_SEL(sel, "BW40-1S base:\n"); RTW_PRINT_SEL(sel, "%4s ", ""); for (ch_idx = 0; ch_idx < CENTER_CH_2G_NUM; ch_idx++) _RTW_PRINT_SEL(sel, "%3d ", center_ch_2g[ch_idx]); _RTW_PRINT_SEL(sel, "\n"); for (path = 0; path < MAX_RF_PATH && path < rfpath_num; path++) { RTW_PRINT_SEL(sel, "[%c]: ", rf_path_char(path)); for (ch_idx = 0; ch_idx < CENTER_CH_2G_NUM; ch_idx++) _RTW_PRINT_SEL(sel, "%3u ", hal_data->Index24G_BW40_Base[path][ch_idx]); _RTW_PRINT_SEL(sel, "\n"); } RTW_PRINT_SEL(sel, "\n"); RTW_PRINT_SEL(sel, "OFDM diff:\n"); RTW_PRINT_SEL(sel, "%4s ", ""); for (tx_idx = RF_1TX; tx_idx < MAX_TX_COUNT && tx_idx < max_tx_cnt; tx_idx++) _RTW_PRINT_SEL(sel, "%dT ", tx_idx + 1); _RTW_PRINT_SEL(sel, "\n"); for (path = 0; path < MAX_RF_PATH && path < rfpath_num; path++) { RTW_PRINT_SEL(sel, "[%c]: ", rf_path_char(path)); for (tx_idx = RF_1TX; tx_idx < MAX_TX_COUNT && tx_idx < max_tx_cnt; tx_idx++) _RTW_PRINT_SEL(sel, "%2d ", hal_data->OFDM_24G_Diff[path][tx_idx]); _RTW_PRINT_SEL(sel, "\n"); } RTW_PRINT_SEL(sel, "\n"); RTW_PRINT_SEL(sel, "BW20 diff:\n"); RTW_PRINT_SEL(sel, "%4s ", ""); for (tx_idx = RF_1TX; tx_idx < MAX_TX_COUNT && tx_idx < max_tx_cnt; tx_idx++) _RTW_PRINT_SEL(sel, "%dS ", tx_idx + 1); _RTW_PRINT_SEL(sel, "\n"); for (path = 0; path < MAX_RF_PATH && path < rfpath_num; path++) { RTW_PRINT_SEL(sel, "[%c]: ", rf_path_char(path)); for (tx_idx = RF_1TX; tx_idx < MAX_TX_COUNT && tx_idx < max_tx_cnt; tx_idx++) _RTW_PRINT_SEL(sel, "%2d ", hal_data->BW20_24G_Diff[path][tx_idx]); _RTW_PRINT_SEL(sel, "\n"); } RTW_PRINT_SEL(sel, "\n"); RTW_PRINT_SEL(sel, "BW40 diff:\n"); RTW_PRINT_SEL(sel, "%4s ", ""); for (tx_idx = RF_1TX; tx_idx < MAX_TX_COUNT && tx_idx < max_tx_cnt; tx_idx++) _RTW_PRINT_SEL(sel, "%dS ", tx_idx + 1); _RTW_PRINT_SEL(sel, "\n"); for (path = 0; path < MAX_RF_PATH && path < rfpath_num; path++) { RTW_PRINT_SEL(sel, "[%c]: ", rf_path_char(path)); for (tx_idx = RF_1TX; tx_idx < MAX_TX_COUNT && tx_idx < max_tx_cnt; tx_idx++) _RTW_PRINT_SEL(sel, "%2d ", hal_data->BW40_24G_Diff[path][tx_idx]); _RTW_PRINT_SEL(sel, "\n"); } RTW_PRINT_SEL(sel, "\n"); } void dump_hal_txpwr_info_5g(void *sel, _adapter *adapter, u8 rfpath_num, u8 max_tx_cnt) { #if CONFIG_IEEE80211_BAND_5GHZ HAL_DATA_TYPE *hal_data = GET_HAL_DATA(adapter); int path, ch_idx, tx_idx; u8 dump_section = 0; u8 ch_idx_s = 0; RTW_PRINT_SEL(sel, "5G\n"); RTW_PRINT_SEL(sel, "BW40-1S base:\n"); do { #define DUMP_5G_BW40_BASE_SECTION_NUM 3 u8 end[DUMP_5G_BW40_BASE_SECTION_NUM] = {64, 144, 177}; RTW_PRINT_SEL(sel, "%4s ", ""); for (ch_idx = ch_idx_s; ch_idx < CENTER_CH_5G_ALL_NUM; ch_idx++) { _RTW_PRINT_SEL(sel, "%3d ", center_ch_5g_all[ch_idx]); if (end[dump_section] == center_ch_5g_all[ch_idx]) break; } _RTW_PRINT_SEL(sel, "\n"); for (path = 0; path < MAX_RF_PATH && path < rfpath_num; path++) { RTW_PRINT_SEL(sel, "[%c]: ", rf_path_char(path)); for (ch_idx = ch_idx_s; ch_idx < CENTER_CH_5G_ALL_NUM; ch_idx++) { _RTW_PRINT_SEL(sel, "%3u ", hal_data->Index5G_BW40_Base[path][ch_idx]); if (end[dump_section] == center_ch_5g_all[ch_idx]) break; } _RTW_PRINT_SEL(sel, "\n"); } RTW_PRINT_SEL(sel, "\n"); ch_idx_s = ch_idx + 1; dump_section++; if (dump_section >= DUMP_5G_BW40_BASE_SECTION_NUM) break; } while (1); RTW_PRINT_SEL(sel, "BW80-1S base:\n"); RTW_PRINT_SEL(sel, "%4s ", ""); for (ch_idx = 0; ch_idx < CENTER_CH_5G_80M_NUM; ch_idx++) _RTW_PRINT_SEL(sel, "%3d ", center_ch_5g_80m[ch_idx]); _RTW_PRINT_SEL(sel, "\n"); for (path = 0; path < MAX_RF_PATH && path < rfpath_num; path++) { RTW_PRINT_SEL(sel, "[%c]: ", rf_path_char(path)); for (ch_idx = 0; ch_idx < CENTER_CH_5G_80M_NUM; ch_idx++) _RTW_PRINT_SEL(sel, "%3u ", hal_data->Index5G_BW80_Base[path][ch_idx]); _RTW_PRINT_SEL(sel, "\n"); } RTW_PRINT_SEL(sel, "\n"); RTW_PRINT_SEL(sel, "OFDM diff:\n"); RTW_PRINT_SEL(sel, "%4s ", ""); for (tx_idx = RF_1TX; tx_idx < MAX_TX_COUNT && tx_idx < max_tx_cnt; tx_idx++) _RTW_PRINT_SEL(sel, "%dT ", tx_idx + 1); _RTW_PRINT_SEL(sel, "\n"); for (path = 0; path < MAX_RF_PATH && path < rfpath_num; path++) { RTW_PRINT_SEL(sel, "[%c]: ", rf_path_char(path)); for (tx_idx = RF_1TX; tx_idx < MAX_TX_COUNT && tx_idx < max_tx_cnt; tx_idx++) _RTW_PRINT_SEL(sel, "%2d ", hal_data->OFDM_5G_Diff[path][tx_idx]); _RTW_PRINT_SEL(sel, "\n"); } RTW_PRINT_SEL(sel, "\n"); RTW_PRINT_SEL(sel, "BW20 diff:\n"); RTW_PRINT_SEL(sel, "%4s ", ""); for (tx_idx = RF_1TX; tx_idx < MAX_TX_COUNT && tx_idx < max_tx_cnt; tx_idx++) _RTW_PRINT_SEL(sel, "%dS ", tx_idx + 1); _RTW_PRINT_SEL(sel, "\n"); for (path = 0; path < MAX_RF_PATH && path < rfpath_num; path++) { RTW_PRINT_SEL(sel, "[%c]: ", rf_path_char(path)); for (tx_idx = RF_1TX; tx_idx < MAX_TX_COUNT && tx_idx < max_tx_cnt; tx_idx++) _RTW_PRINT_SEL(sel, "%2d ", hal_data->BW20_5G_Diff[path][tx_idx]); _RTW_PRINT_SEL(sel, "\n"); } RTW_PRINT_SEL(sel, "\n"); RTW_PRINT_SEL(sel, "BW40 diff:\n"); RTW_PRINT_SEL(sel, "%4s ", ""); for (tx_idx = RF_1TX; tx_idx < MAX_TX_COUNT && tx_idx < max_tx_cnt; tx_idx++) _RTW_PRINT_SEL(sel, "%dS ", tx_idx + 1); _RTW_PRINT_SEL(sel, "\n"); for (path = 0; path < MAX_RF_PATH && path < rfpath_num; path++) { RTW_PRINT_SEL(sel, "[%c]: ", rf_path_char(path)); for (tx_idx = RF_1TX; tx_idx < MAX_TX_COUNT && tx_idx < max_tx_cnt; tx_idx++) _RTW_PRINT_SEL(sel, "%2d ", hal_data->BW40_5G_Diff[path][tx_idx]); _RTW_PRINT_SEL(sel, "\n"); } RTW_PRINT_SEL(sel, "\n"); RTW_PRINT_SEL(sel, "BW80 diff:\n"); RTW_PRINT_SEL(sel, "%4s ", ""); for (tx_idx = RF_1TX; tx_idx < MAX_TX_COUNT && tx_idx < max_tx_cnt; tx_idx++) _RTW_PRINT_SEL(sel, "%dS ", tx_idx + 1); _RTW_PRINT_SEL(sel, "\n"); for (path = 0; path < MAX_RF_PATH && path < rfpath_num; path++) { RTW_PRINT_SEL(sel, "[%c]: ", rf_path_char(path)); for (tx_idx = RF_1TX; tx_idx < MAX_TX_COUNT && tx_idx < max_tx_cnt; tx_idx++) _RTW_PRINT_SEL(sel, "%2d ", hal_data->BW80_5G_Diff[path][tx_idx]); _RTW_PRINT_SEL(sel, "\n"); } RTW_PRINT_SEL(sel, "\n"); #endif /* CONFIG_IEEE80211_BAND_5GHZ */ } #endif /* CONFIG_TXPWR_PG_WITH_PWR_IDX */ /* * rtw_regsty_get_target_tx_power - * * Return dBm or -1 for undefined */ s8 rtw_regsty_get_target_tx_power( PADAPTER Adapter, u8 Band, u8 RfPath, RATE_SECTION RateSection ) { struct registry_priv *regsty = adapter_to_regsty(Adapter); s8 value = 0; if (RfPath > RF_PATH_D) { RTW_PRINT("%s invalid RfPath:%d\n", __func__, RfPath); return -1; } if (Band != BAND_ON_2_4G #if CONFIG_IEEE80211_BAND_5GHZ && Band != BAND_ON_5G #endif ) { RTW_PRINT("%s invalid Band:%d\n", __func__, Band); return -1; } if (RateSection >= RATE_SECTION_NUM #if CONFIG_IEEE80211_BAND_5GHZ || (Band == BAND_ON_5G && RateSection == CCK) #endif ) { RTW_PRINT("%s invalid RateSection:%d in Band:%d, RfPath:%d\n", __func__ , RateSection, Band, RfPath); return -1; } if (Band == BAND_ON_2_4G) value = regsty->target_tx_pwr_2g[RfPath][RateSection]; #if CONFIG_IEEE80211_BAND_5GHZ else /* BAND_ON_5G */ value = regsty->target_tx_pwr_5g[RfPath][RateSection - 1]; #endif return value; } bool rtw_regsty_chk_target_tx_power_valid(_adapter *adapter) { struct hal_spec_t *hal_spec = GET_HAL_SPEC(adapter); int path, tx_num, band, rs; s8 target; for (band = BAND_ON_2_4G; band <= BAND_ON_5G; band++) { if (!hal_is_band_support(adapter, band)) continue; for (path = 0; path < RF_PATH_MAX; path++) { if (!HAL_SPEC_CHK_RF_PATH(hal_spec, band, path)) break; for (rs = 0; rs < RATE_SECTION_NUM; rs++) { tx_num = rate_section_to_tx_num(rs); if (tx_num + 1 > GET_HAL_TX_NSS(adapter)) continue; if (band == BAND_ON_5G && IS_CCK_RATE_SECTION(rs)) continue; if (IS_VHT_RATE_SECTION(rs) && !IS_HARDWARE_TYPE_JAGUAR_ALL(adapter)) continue; target = rtw_regsty_get_target_tx_power(adapter, band, path, rs); if (target == -1) { RTW_PRINT("%s return _FALSE for band:%d, path:%d, rs:%d, t:%d\n", __func__, band, path, rs, target); return _FALSE; } } } } return _TRUE; } /* * phy_get_target_txpwr - * * Return value in unit of TX Gain Index */ u8 phy_get_target_txpwr( PADAPTER Adapter, u8 Band, u8 RfPath, RATE_SECTION RateSection ) { HAL_DATA_TYPE *pHalData = GET_HAL_DATA(Adapter); u8 value = 0; if (RfPath > RF_PATH_D) { RTW_PRINT("%s invalid RfPath:%d\n", __func__, RfPath); return 0; } if (Band != BAND_ON_2_4G && Band != BAND_ON_5G) { RTW_PRINT("%s invalid Band:%d\n", __func__, Band); return 0; } if (RateSection >= RATE_SECTION_NUM || (Band == BAND_ON_5G && RateSection == CCK) ) { RTW_PRINT("%s invalid RateSection:%d in Band:%d, RfPath:%d\n", __func__ , RateSection, Band, RfPath); return 0; } if (Band == BAND_ON_2_4G) value = pHalData->target_txpwr_2g[RfPath][RateSection]; else if (Band == BAND_ON_5G) value = pHalData->target_txpwr_5g[RfPath][RateSection - 1]; return value; } static void phy_set_target_txpwr( PADAPTER Adapter, u8 Band, u8 RfPath, RATE_SECTION RateSection, u8 Value ) { HAL_DATA_TYPE *pHalData = GET_HAL_DATA(Adapter); if (RfPath > RF_PATH_D) { RTW_PRINT("%s invalid RfPath:%d\n", __func__, RfPath); return; } if (Band != BAND_ON_2_4G && Band != BAND_ON_5G) { RTW_PRINT("%s invalid Band:%d\n", __func__, Band); return; } if (RateSection >= RATE_SECTION_NUM || (Band == BAND_ON_5G && RateSection == CCK) ) { RTW_PRINT("%s invalid RateSection:%d in %sG, RfPath:%d\n", __func__ , RateSection, (Band == BAND_ON_2_4G) ? "2.4" : "5", RfPath); return; } if (Band == BAND_ON_2_4G) pHalData->target_txpwr_2g[RfPath][RateSection] = Value; else /* BAND_ON_5G */ pHalData->target_txpwr_5g[RfPath][RateSection - 1] = Value; } static inline BOOLEAN phy_is_txpwr_by_rate_undefined_of_band_path(_adapter *adapter, u8 band, u8 path) { HAL_DATA_TYPE *hal_data = GET_HAL_DATA(adapter); struct hal_spec_t *hal_spec = GET_HAL_SPEC(adapter); u8 rate_idx = 0; for (rate_idx = 0; rate_idx < TX_PWR_BY_RATE_NUM_RATE; rate_idx++) { if (hal_data->TxPwrByRate[band][path][rate_idx] != hal_spec->txgi_max) goto exit; } exit: return rate_idx >= TX_PWR_BY_RATE_NUM_RATE ? _TRUE : _FALSE; } static inline void phy_txpwr_by_rate_duplicate_band_path(_adapter *adapter, u8 band, u8 s_path, u8 t_path) { HAL_DATA_TYPE *hal_data = GET_HAL_DATA(adapter); u8 rate_idx = 0; for (rate_idx = 0; rate_idx < TX_PWR_BY_RATE_NUM_RATE; rate_idx++) hal_data->TxPwrByRate[band][t_path][rate_idx] = hal_data->TxPwrByRate[band][s_path][rate_idx]; } static void phy_txpwr_by_rate_chk_for_path_dup(_adapter *adapter) { struct hal_spec_t *hal_spec = GET_HAL_SPEC(adapter); HAL_DATA_TYPE *hal_data = GET_HAL_DATA(adapter); u8 band, path; s8 src_path; for (band = BAND_ON_2_4G; band <= BAND_ON_5G; band++) for (path = RF_PATH_A; path < RF_PATH_MAX; path++) hal_data->txpwr_by_rate_undefined_band_path[band][path] = 0; for (band = BAND_ON_2_4G; band <= BAND_ON_5G; band++) { if (!hal_is_band_support(adapter, band)) continue; for (path = RF_PATH_A; path < RF_PATH_MAX; path++) { if (!HAL_SPEC_CHK_RF_PATH(hal_spec, band, path)) continue; if (phy_is_txpwr_by_rate_undefined_of_band_path(adapter, band, path)) hal_data->txpwr_by_rate_undefined_band_path[band][path] = 1; } } for (band = BAND_ON_2_4G; band <= BAND_ON_5G; band++) { if (!hal_is_band_support(adapter, band)) continue; src_path = -1; for (path = RF_PATH_A; path < RF_PATH_MAX; path++) { if (!HAL_SPEC_CHK_RF_PATH(hal_spec, band, path)) continue; /* find src */ if (src_path == -1 && hal_data->txpwr_by_rate_undefined_band_path[band][path] == 0) src_path = path; } if (src_path == -1) { RTW_ERR("%s all power by rate undefined\n", __func__); continue; } for (path = RF_PATH_A; path < RF_PATH_MAX; path++) { if (!HAL_SPEC_CHK_RF_PATH(hal_spec, band, path)) continue; /* duplicate src to undefined one */ if (hal_data->txpwr_by_rate_undefined_band_path[band][path] == 1) { RTW_INFO("%s duplicate %s [%c] to [%c]\n", __func__ , band_str(band), rf_path_char(src_path), rf_path_char(path)); phy_txpwr_by_rate_duplicate_band_path(adapter, band, src_path, path); } } } } void phy_store_target_tx_power(PADAPTER pAdapter) { struct hal_spec_t *hal_spec = GET_HAL_SPEC(pAdapter); struct registry_priv *regsty = adapter_to_regsty(pAdapter); u8 band, path, rs, tx_num, base; for (band = BAND_ON_2_4G; band <= BAND_ON_5G; band++) { if (!hal_is_band_support(pAdapter, band)) continue; for (path = RF_PATH_A; path < RF_PATH_MAX; path++) { if (!HAL_SPEC_CHK_RF_PATH(hal_spec, band, path)) break; for (rs = 0; rs < RATE_SECTION_NUM; rs++) { tx_num = rate_section_to_tx_num(rs); if (tx_num + 1 > GET_HAL_TX_NSS(pAdapter)) continue; if (band == BAND_ON_5G && IS_CCK_RATE_SECTION(rs)) continue; if (IS_VHT_RATE_SECTION(rs) && !IS_HARDWARE_TYPE_JAGUAR_ALL(pAdapter)) continue; if (regsty->target_tx_pwr_valid == _TRUE) base = hal_spec->txgi_pdbm * rtw_regsty_get_target_tx_power(pAdapter, band, path, rs); else base = _PHY_GetTxPowerByRate(pAdapter, band, path, rate_sec_base[rs]); phy_set_target_txpwr(pAdapter, band, path, rs, base); } } } } static u8 get_val_from_dhex(u32 dhex, u8 i) { return (((dhex >> (i * 8 + 4)) & 0xF)) * 10 + ((dhex >> (i * 8)) & 0xF); } static u8 get_val_from_hex(u32 hex, u8 i) { return (hex >> (i * 8)) & 0xFF; } void PHY_GetRateValuesOfTxPowerByRate( PADAPTER pAdapter, u32 RegAddr, u32 BitMask, u32 Value, u8 *Rate, s8 *PwrByRateVal, u8 *RateNum ) { HAL_DATA_TYPE *pHalData = GET_HAL_DATA(pAdapter); struct dm_struct *pDM_Odm = &pHalData->odmpriv; u8 i = 0; u8 (*get_val)(u32, u8); if (pDM_Odm->phy_reg_pg_version == 1) get_val = get_val_from_dhex; else get_val = get_val_from_hex; 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)get_val(Value, i); *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)get_val(Value, i); *RateNum = 4; break; case rTxAGC_A_CCK1_Mcs32: Rate[0] = MGN_1M; PwrByRateVal[0] = (s8)get_val(Value, 1); *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)get_val(Value, i); *RateNum = 3; } else if (BitMask == 0x000000ff) { Rate[0] = MGN_11M; PwrByRateVal[0] = (s8)get_val(Value, 0); *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)get_val(Value, i); *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)get_val(Value, i); *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)get_val(Value, i); *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)get_val(Value, i); *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)get_val(Value, i); *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)get_val(Value, i); *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)get_val(Value, i); *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)get_val(Value, i); *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)get_val(Value, i); *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)get_val(Value, i); *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)get_val(Value, i); *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)get_val(Value, i); *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)get_val(Value, i); *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)get_val(Value, i); *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)get_val(Value, i); *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)get_val(Value, i); *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)get_val(Value, i); *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)get_val(Value, i); *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)get_val(Value, i); *RateNum = 4; break; case 0x3a24: /* HT MCS24-27 */ Rate[0] = MGN_MCS24; Rate[1] = MGN_MCS25; Rate[2] = MGN_MCS26; Rate[3] = MGN_MCS27; for (i = 0; i < 4; ++i) PwrByRateVal[i] = (s8)get_val(Value, i); *RateNum = 4; break; case 0x3a28: /* HT MCS28-31 */ Rate[0] = MGN_MCS28; Rate[1] = MGN_MCS29; Rate[2] = MGN_MCS30; Rate[3] = MGN_MCS31; for (i = 0; i < 4; ++i) PwrByRateVal[i] = (s8)get_val(Value, i); *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)get_val(Value, i); *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)get_val(Value, i); *RateNum = 4; break; case 0xCE8: case 0xEE8: case 0x18E8: case 0x1aE8: case 0x3a48: Rate[0] = MGN_VHT3SS_MCS8; Rate[1] = MGN_VHT3SS_MCS9; Rate[2] = MGN_VHT4SS_MCS0; Rate[3] = MGN_VHT4SS_MCS1; for (i = 0; i < 4; ++i) PwrByRateVal[i] = (s8)get_val(Value, i); *RateNum = 4; break; case 0x3a4c: Rate[0] = MGN_VHT4SS_MCS2; Rate[1] = MGN_VHT4SS_MCS3; Rate[2] = MGN_VHT4SS_MCS4; Rate[3] = MGN_VHT4SS_MCS5; for (i = 0; i < 4; ++i) PwrByRateVal[i] = (s8)get_val(Value, i); *RateNum = 4; break; case 0x3a50: Rate[0] = MGN_VHT4SS_MCS6; Rate[1] = MGN_VHT4SS_MCS7; Rate[2] = MGN_VHT4SS_MCS8; Rate[3] = MGN_VHT4SS_MCS9; for (i = 0; i < 4; ++i) PwrByRateVal[i] = (s8)get_val(Value, i); *RateNum = 4; break; default: RTW_PRINT("Invalid RegAddr 0x%x in %s()\n", RegAddr, __func__); break; }; } void PHY_StoreTxPowerByRateNew( PADAPTER pAdapter, u32 Band, u32 RfPath, u32 RegAddr, u32 BitMask, 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) { RTW_PRINT("Invalid Band %d\n", Band); return; } if (RfPath > RF_PATH_D) { RTW_PRINT("Invalid RfPath %d\n", RfPath); return; } for (i = 0; i < rateNum; ++i) { u8 rate_idx = PHY_GetRateIndexOfTxPowerByRate(rates[i]); pHalData->TxPwrByRate[Band][RfPath][rate_idx] = PwrByRateVal[i]; } } void PHY_InitTxPowerByRate( PADAPTER pAdapter ) { HAL_DATA_TYPE *pHalData = GET_HAL_DATA(pAdapter); struct hal_spec_t *hal_spec = GET_HAL_SPEC(pAdapter); u8 band = 0, rfPath = 0, rate = 0; for (band = BAND_ON_2_4G; band <= BAND_ON_5G; ++band) for (rfPath = 0; rfPath < TX_PWR_BY_RATE_NUM_RF; ++rfPath) for (rate = 0; rate < TX_PWR_BY_RATE_NUM_RATE; ++rate) pHalData->TxPwrByRate[band][rfPath][rate] = hal_spec->txgi_max; } void phy_store_tx_power_by_rate( PADAPTER pAdapter, u32 Band, u32 RfPath, u32 TxNum, u32 RegAddr, u32 BitMask, u32 Data ) { HAL_DATA_TYPE *pHalData = GET_HAL_DATA(pAdapter); struct dm_struct *pDM_Odm = &pHalData->odmpriv; if (pDM_Odm->phy_reg_pg_version > 0) PHY_StoreTxPowerByRateNew(pAdapter, Band, RfPath, RegAddr, BitMask, Data); else RTW_INFO("Invalid PHY_REG_PG.txt version %d\n", pDM_Odm->phy_reg_pg_version); } /* * This function must be called if the value in the PHY_REG_PG.txt(or header) * is exact dBm values */ void PHY_TxPowerByRateConfiguration( PADAPTER pAdapter ) { phy_txpwr_by_rate_chk_for_path_dup(pAdapter); phy_store_target_tx_power(pAdapter); } #ifdef CONFIG_FW_OFFLOAD_SET_TXPWR_IDX extern bool phy_set_txpwr_idx_offload(_adapter *adapter); #endif void phy_set_tx_power_index_by_rate_section( PADAPTER pAdapter, enum rf_path RFPath, u8 Channel, u8 rs ) { PHAL_DATA_TYPE hal_data = GET_HAL_DATA(pAdapter); u8 band = hal_data->current_band_type; u8 bw = hal_data->current_channel_bw; u32 powerIndex = 0; int i = 0; if (rs >= RATE_SECTION_NUM) { RTW_INFO("Invalid RateSection %d in %s", rs, __func__); rtw_warn_on(1); goto exit; } if (rs == CCK && bw != BAND_ON_2_4G) goto exit; for (i = 0; i < rates_by_sections[rs].rate_num; ++i) { #if DBG_TX_POWER_IDX struct txpwr_idx_comp tic; powerIndex = rtw_hal_get_tx_power_index(pAdapter, RFPath , rs, rates_by_sections[rs].rates[i], bw, band, Channel, 0, &tic); dump_tx_power_index_inline(RTW_DBGDUMP, pAdapter, RFPath, bw, Channel , rates_by_sections[rs].rates[i], powerIndex, &tic); #else powerIndex = phy_get_tx_power_index_ex(pAdapter, RFPath , rs, rates_by_sections[rs].rates[i], bw, band, Channel, 0); #endif PHY_SetTxPowerIndex(pAdapter, powerIndex, RFPath, rates_by_sections[rs].rates[i]); } #ifdef CONFIG_FW_OFFLOAD_SET_TXPWR_IDX if (!hal_data->set_entire_txpwr && phy_set_txpwr_idx_offload(pAdapter)) rtw_hal_set_txpwr_done(pAdapter); #endif exit: return; } bool phy_get_ch_idx(u8 ch, u8 *ch_idx) { u8 i = 0; BOOLEAN bIn24G = _TRUE; if (ch > 0 && ch <= 14) { bIn24G = _TRUE; *ch_idx = ch - 1; } else { bIn24G = _FALSE; for (i = 0; i < CENTER_CH_5G_ALL_NUM; ++i) { if (center_ch_5g_all[i] == ch) { *ch_idx = i; break; } } } return bIn24G; } bool phy_chk_ch_setting_consistency(_adapter *adapter, u8 ch) { HAL_DATA_TYPE *hal_data = GET_HAL_DATA(adapter); u8 ch_idx = 0xFF; u8 ret = _FAIL; phy_get_ch_idx(ch, &ch_idx); if (ch_idx == 0xFF) { rtw_warn_on(1); goto exit; } if (ch != hal_data->current_channel) { rtw_warn_on(1); goto exit; } if (ch <= 14) { if (hal_data->current_band_type != BAND_ON_2_4G) { rtw_warn_on(1); goto exit; } if (hal_data->current_channel_bw > CHANNEL_WIDTH_40) { rtw_warn_on(1); goto exit; } } if (ch > 14) { if (hal_data->current_band_type != BAND_ON_5G) { rtw_warn_on(1); goto exit; } if (hal_data->current_channel_bw > CHANNEL_WIDTH_160) { rtw_warn_on(1); goto exit; } } ret = _SUCCESS; exit: if (ret != _SUCCESS) RTW_WARN("ch:%u, hal band:%u, ch:%u, bw:%u\n", ch , hal_data->current_band_type, hal_data->current_channel, hal_data->current_channel_bw); return ret; } #ifdef CONFIG_TXPWR_PG_WITH_PWR_IDX u8 phy_get_pg_txpwr_idx(_adapter *pAdapter , enum rf_path RFPath, RATE_SECTION rs, u8 ntx_idx , enum channel_width BandWidth, u8 band, u8 Channel) { PHAL_DATA_TYPE pHalData = GET_HAL_DATA(pAdapter); u8 i; u8 txPower = 0; u8 chnlIdx = (Channel - 1); if (HAL_IsLegalChannel(pAdapter, Channel) == _FALSE) { chnlIdx = 0; RTW_INFO("Illegal channel!!\n"); } phy_get_ch_idx(Channel, &chnlIdx); if (0) RTW_INFO("[%s] Channel Index: %d\n", band_str(band), chnlIdx); if (band == BAND_ON_2_4G) { if (IS_CCK_RATE_SECTION(rs)) { /* CCK-nTX */ txPower = pHalData->Index24G_CCK_Base[RFPath][chnlIdx]; txPower += pHalData->CCK_24G_Diff[RFPath][RF_1TX]; if (ntx_idx >= RF_2TX) txPower += pHalData->CCK_24G_Diff[RFPath][RF_2TX]; if (ntx_idx >= RF_3TX) txPower += pHalData->CCK_24G_Diff[RFPath][RF_3TX]; if (ntx_idx >= RF_4TX) txPower += pHalData->CCK_24G_Diff[RFPath][RF_4TX]; goto exit; } txPower = pHalData->Index24G_BW40_Base[RFPath][chnlIdx]; /* OFDM-nTX */ if (IS_OFDM_RATE_SECTION(rs)) { txPower += pHalData->OFDM_24G_Diff[RFPath][RF_1TX]; if (ntx_idx >= RF_2TX) txPower += pHalData->OFDM_24G_Diff[RFPath][RF_2TX]; if (ntx_idx >= RF_3TX) txPower += pHalData->OFDM_24G_Diff[RFPath][RF_3TX]; if (ntx_idx >= RF_4TX) txPower += pHalData->OFDM_24G_Diff[RFPath][RF_4TX]; goto exit; } /* BW20-nS */ if (BandWidth == CHANNEL_WIDTH_20) { txPower += pHalData->BW20_24G_Diff[RFPath][RF_1TX]; if (rate_section_to_tx_num(rs) >= RF_2TX) txPower += pHalData->BW20_24G_Diff[RFPath][RF_2TX]; if (rate_section_to_tx_num(rs) >= RF_3TX) txPower += pHalData->BW20_24G_Diff[RFPath][RF_3TX]; if (rate_section_to_tx_num(rs) >= RF_4TX) txPower += pHalData->BW20_24G_Diff[RFPath][RF_4TX]; goto exit; } /* BW40-nS */ if (BandWidth == CHANNEL_WIDTH_40 /* Willis suggest adopt BW 40M power index while in BW 80 mode */ || BandWidth == CHANNEL_WIDTH_80 ) { txPower += pHalData->BW40_24G_Diff[RFPath][RF_1TX]; if (rate_section_to_tx_num(rs) >= RF_2TX) txPower += pHalData->BW40_24G_Diff[RFPath][RF_2TX]; if (rate_section_to_tx_num(rs) >= RF_3TX) txPower += pHalData->BW40_24G_Diff[RFPath][RF_3TX]; if (rate_section_to_tx_num(rs) >= RF_4TX) txPower += pHalData->BW40_24G_Diff[RFPath][RF_4TX]; goto exit; } } #if CONFIG_IEEE80211_BAND_5GHZ else if (band == BAND_ON_5G) { if (IS_CCK_RATE_SECTION(rs)) { RTW_WARN("===>%s: INVALID, CCK on 5G\n", __func__); goto exit; } txPower = pHalData->Index5G_BW40_Base[RFPath][chnlIdx]; /* OFDM-nTX */ if (IS_OFDM_RATE_SECTION(rs)) { txPower += pHalData->OFDM_5G_Diff[RFPath][RF_1TX]; if (ntx_idx >= RF_2TX) txPower += pHalData->OFDM_5G_Diff[RFPath][RF_2TX]; if (ntx_idx >= RF_3TX) txPower += pHalData->OFDM_5G_Diff[RFPath][RF_3TX]; if (ntx_idx >= RF_4TX) txPower += pHalData->OFDM_5G_Diff[RFPath][RF_4TX]; goto exit; } /* BW20-nS */ if (BandWidth == CHANNEL_WIDTH_20) { txPower += pHalData->BW20_5G_Diff[RFPath][RF_1TX]; if (rate_section_to_tx_num(rs) >= RF_2TX) txPower += pHalData->BW20_5G_Diff[RFPath][RF_2TX]; if (rate_section_to_tx_num(rs) >= RF_3TX) txPower += pHalData->BW20_5G_Diff[RFPath][RF_3TX]; if (rate_section_to_tx_num(rs) >= RF_4TX) txPower += pHalData->BW20_5G_Diff[RFPath][RF_4TX]; goto exit; } /* BW40-nS */ if (BandWidth == CHANNEL_WIDTH_40) { txPower += pHalData->BW40_5G_Diff[RFPath][RF_1TX]; if (rate_section_to_tx_num(rs) >= RF_2TX) txPower += pHalData->BW40_5G_Diff[RFPath][RF_2TX]; if (rate_section_to_tx_num(rs) >= RF_3TX) txPower += pHalData->BW40_5G_Diff[RFPath][RF_3TX]; if (rate_section_to_tx_num(rs) >= RF_4TX) txPower += pHalData->BW40_5G_Diff[RFPath][RF_4TX]; goto exit; } /* BW80-nS */ if (BandWidth == CHANNEL_WIDTH_80) { /* get 80MHz cch index */ for (i = 0; i < CENTER_CH_5G_80M_NUM; ++i) { if (center_ch_5g_80m[i] == Channel) { chnlIdx = i; break; } } if (i >= CENTER_CH_5G_80M_NUM) { #ifdef CONFIG_MP_INCLUDED if (rtw_mp_mode_check(pAdapter) == _FALSE) #endif rtw_warn_on(1); txPower = 0; goto exit; } txPower = pHalData->Index5G_BW80_Base[RFPath][chnlIdx]; txPower += + pHalData->BW80_5G_Diff[RFPath][RF_1TX]; if (rate_section_to_tx_num(rs) >= RF_2TX) txPower += pHalData->BW80_5G_Diff[RFPath][RF_2TX]; if (rate_section_to_tx_num(rs) >= RF_3TX) txPower += pHalData->BW80_5G_Diff[RFPath][RF_3TX]; if (rate_section_to_tx_num(rs) >= RF_4TX) txPower += pHalData->BW80_5G_Diff[RFPath][RF_4TX]; goto exit; } /* TODO: BW160-nS */ rtw_warn_on(1); } #endif /* CONFIG_IEEE80211_BAND_5GHZ */ exit: return txPower; } #endif /* CONFIG_TXPWR_PG_WITH_PWR_IDX */ s8 PHY_GetTxPowerTrackingOffset( PADAPTER pAdapter, enum rf_path RFPath, u8 Rate ) { PHAL_DATA_TYPE pHalData = GET_HAL_DATA(pAdapter); struct dm_struct *pDM_Odm = &pHalData->odmpriv; s8 offset = 0; if (pDM_Odm->rf_calibrate_info.txpowertrack_control == _FALSE) return offset; if ((Rate == MGN_1M) || (Rate == MGN_2M) || (Rate == MGN_5_5M) || (Rate == MGN_11M)) { offset = pDM_Odm->rf_calibrate_info.remnant_cck_swing_idx; /*RTW_INFO("+Remnant_CCKSwingIdx = 0x%x\n", RFPath, Rate, pRFCalibrateInfo->Remnant_CCKSwingIdx);*/ } else { offset = pDM_Odm->rf_calibrate_info.remnant_ofdm_swing_idx[RFPath]; /*RTW_INFO("+Remanant_OFDMSwingIdx[RFPath %u][Rate 0x%x] = 0x%x\n", RFPath, Rate, pRFCalibrateInfo->Remnant_OFDMSwingIdx[RFPath]); */ } return offset; } /*The same as MRateToHwRate in hal_com.c*/ u8 PHY_GetRateIndexOfTxPowerByRate( 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: RTW_INFO("Invalid rate 0x%x in %s\n", Rate, __FUNCTION__); break; }; return index; } s8 _PHY_GetTxPowerByRate( PADAPTER pAdapter, u8 Band, enum rf_path RFPath, u8 Rate ) { HAL_DATA_TYPE *pHalData = GET_HAL_DATA(pAdapter); s8 value = 0; u8 rateIndex = PHY_GetRateIndexOfTxPowerByRate(Rate); if (Band != BAND_ON_2_4G && Band != BAND_ON_5G) { RTW_INFO("Invalid band %d in %s\n", Band, __func__); goto exit; } if (RFPath > RF_PATH_D) { RTW_INFO("Invalid RfPath %d in %s\n", RFPath, __func__); goto exit; } if (rateIndex >= TX_PWR_BY_RATE_NUM_RATE) { RTW_INFO("Invalid RateIndex %d in %s\n", rateIndex, __func__); goto exit; } value = pHalData->TxPwrByRate[Band][RFPath][rateIndex]; exit: return value; } s8 PHY_GetTxPowerByRate( PADAPTER pAdapter, u8 Band, enum rf_path RFPath, RATE_SECTION rs, enum MGN_RATE rate ) { if (phy_is_tx_power_by_rate_needed(pAdapter)) return _PHY_GetTxPowerByRate(pAdapter, Band, RFPath, rate); return phy_get_target_txpwr(pAdapter, Band, RFPath, rs); } void PHY_SetTxPowerByRate( PADAPTER pAdapter, u8 Band, enum rf_path RFPath, u8 Rate, 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) { RTW_INFO("Invalid band %d in %s\n", Band, __FUNCTION__); return; } if (RFPath > RF_PATH_D) { RTW_INFO("Invalid RfPath %d in %s\n", RFPath, __FUNCTION__); return; } if (rateIndex >= TX_PWR_BY_RATE_NUM_RATE) { RTW_INFO("Invalid RateIndex %d in %s\n", rateIndex, __FUNCTION__); return; } pHalData->TxPwrByRate[Band][RFPath][rateIndex] = Value; } u8 phy_check_under_survey_ch(_adapter *adapter) { struct dvobj_priv *dvobj = adapter_to_dvobj(adapter); _adapter *iface; struct mlme_ext_priv *mlmeext; u8 ret = _FALSE; int i; for (i = 0; i < dvobj->iface_nums; i++) { iface = dvobj->padapters[i]; if (!iface) continue; mlmeext = &iface->mlmeextpriv; /* check scan state */ if (mlmeext_scan_state(mlmeext) != SCAN_DISABLE && mlmeext_scan_state(mlmeext) != SCAN_COMPLETE && mlmeext_scan_state(mlmeext) != SCAN_BACKING_OP) { ret = _TRUE; } else if (mlmeext_scan_state(mlmeext) == SCAN_BACKING_OP && !mlmeext_chk_scan_backop_flags(mlmeext, SS_BACKOP_TX_RESUME)) { ret = _TRUE; } } return ret; } void phy_set_tx_power_level_by_path( PADAPTER Adapter, u8 channel, u8 path ) { PHAL_DATA_TYPE pHalData = GET_HAL_DATA(Adapter); BOOLEAN bIsIn24G = (pHalData->current_band_type == BAND_ON_2_4G); u8 under_survey_ch = phy_check_under_survey_ch(Adapter); /* if ( pMgntInfo->RegNByteAccess == 0 ) */ { if (bIsIn24G) phy_set_tx_power_index_by_rate_section(Adapter, path, channel, CCK); phy_set_tx_power_index_by_rate_section(Adapter, path, channel, OFDM); if (!under_survey_ch) { phy_set_tx_power_index_by_rate_section(Adapter, path, channel, HT_MCS0_MCS7); if (IS_HARDWARE_TYPE_JAGUAR(Adapter) || IS_HARDWARE_TYPE_8814A(Adapter)) phy_set_tx_power_index_by_rate_section(Adapter, path, channel, VHT_1SSMCS0_1SSMCS9); if (pHalData->tx_nss >= 2) { phy_set_tx_power_index_by_rate_section(Adapter, path, channel, HT_MCS8_MCS15); if (IS_HARDWARE_TYPE_JAGUAR(Adapter) || IS_HARDWARE_TYPE_8814A(Adapter)) phy_set_tx_power_index_by_rate_section(Adapter, path, channel, VHT_2SSMCS0_2SSMCS9); if (IS_HARDWARE_TYPE_8814A(Adapter)) { phy_set_tx_power_index_by_rate_section(Adapter, path, channel, HT_MCS16_MCS23); phy_set_tx_power_index_by_rate_section(Adapter, path, channel, VHT_3SSMCS0_3SSMCS9); } } } } } #if CONFIG_TXPWR_LIMIT const char *const _txpwr_lmt_rs_str[] = { "CCK", "OFDM", "HT", "VHT", "UNKNOWN", }; static s8 phy_GetChannelIndexOfTxPowerLimit( u8 Band, 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 RTW_PRINT("Invalid Band %d in %s\n", Band, __func__); if (channelIndex == -1) RTW_PRINT("Invalid Channel %d of Band %d in %s\n", Channel, Band, __func__); return channelIndex; } static s8 phy_txpwr_ww_lmt_value(_adapter *adapter) { struct hal_spec_t *hal_spec = GET_HAL_SPEC(adapter); if (hal_spec->txgi_max == 63) return -63; else if (hal_spec->txgi_max == 127) return -128; rtw_warn_on(1); return -128; } /* * return txpwr limit in unit of TX Gain Index * hsl_spec->txgi_max is returned when NO limit */ s8 phy_get_txpwr_lmt( PADAPTER Adapter, const char *regd_name, BAND_TYPE Band, enum channel_width bw, u8 tlrs, u8 ntx_idx, u8 cch, u8 lock ) { struct dvobj_priv *dvobj = adapter_to_dvobj(Adapter); struct rf_ctl_t *rfctl = adapter_to_rfctl(Adapter); HAL_DATA_TYPE *hal_data = GET_HAL_DATA(Adapter); struct hal_spec_t *hal_spec = GET_HAL_SPEC(Adapter); struct txpwr_lmt_ent *ent = NULL; _irqL irqL; _list *cur, *head; s8 ch_idx; u8 is_ww_regd = 0; s8 ww_lmt_val = phy_txpwr_ww_lmt_value(Adapter); s8 lmt = hal_spec->txgi_max; if ((Adapter->registrypriv.RegEnableTxPowerLimit == 2 && hal_data->EEPROMRegulatory != 1) || Adapter->registrypriv.RegEnableTxPowerLimit == 0) goto exit; if (Band != BAND_ON_2_4G && Band != BAND_ON_5G) { RTW_ERR("%s invalid band:%u\n", __func__, Band); rtw_warn_on(1); goto exit; } if (Band == BAND_ON_5G && tlrs == TXPWR_LMT_RS_CCK) { RTW_ERR("5G has no CCK\n"); goto exit; } if (lock) _enter_critical_mutex(&rfctl->txpwr_lmt_mutex, &irqL); if (!regd_name) /* no regd_name specified, use currnet */ regd_name = rfctl->regd_name; if (rfctl->txpwr_regd_num == 0 || strcmp(regd_name, regd_str(TXPWR_LMT_NONE)) == 0) goto release_lock; if (strcmp(regd_name, regd_str(TXPWR_LMT_WW)) == 0) is_ww_regd = 1; if (!is_ww_regd) { ent = _rtw_txpwr_lmt_get_by_name(rfctl, regd_name); if (!ent) goto release_lock; } ch_idx = phy_GetChannelIndexOfTxPowerLimit(Band, cch); if (ch_idx == -1) goto release_lock; if (Band == BAND_ON_2_4G) { if (!is_ww_regd) { lmt = ent->lmt_2g[bw][tlrs][ch_idx][ntx_idx]; if (lmt != ww_lmt_val) goto release_lock; } /* search for min value for WW regd or WW limit */ lmt = hal_spec->txgi_max; head = &rfctl->txpwr_lmt_list; cur = get_next(head); while ((rtw_end_of_queue_search(head, cur)) == _FALSE) { ent = LIST_CONTAINOR(cur, struct txpwr_lmt_ent, list); cur = get_next(cur); if (ent->lmt_2g[bw][tlrs][ch_idx][ntx_idx] != ww_lmt_val) lmt = rtw_min(lmt, ent->lmt_2g[bw][tlrs][ch_idx][ntx_idx]); } } #if CONFIG_IEEE80211_BAND_5GHZ else if (Band == BAND_ON_5G) { if (!is_ww_regd) { lmt = ent->lmt_5g[bw][tlrs - 1][ch_idx][ntx_idx]; if (lmt != ww_lmt_val) goto release_lock; } /* search for min value for WW regd or WW limit */ lmt = hal_spec->txgi_max; head = &rfctl->txpwr_lmt_list; cur = get_next(head); while ((rtw_end_of_queue_search(head, cur)) == _FALSE) { ent = LIST_CONTAINOR(cur, struct txpwr_lmt_ent, list); cur = get_next(cur); if (ent->lmt_5g[bw][tlrs - 1][ch_idx][ntx_idx] != ww_lmt_val) lmt = rtw_min(lmt, ent->lmt_5g[bw][tlrs - 1][ch_idx][ntx_idx]); } } #endif release_lock: if (lock) _exit_critical_mutex(&rfctl->txpwr_lmt_mutex, &irqL); exit: return lmt; } /* * return txpwr limit diff value to target of its rate section in unit of TX Gain Index * hal_spec->txgi_max is returned when NO limit */ inline s8 phy_get_txpwr_lmt_diff(_adapter *adapter , const char *regd_name , BAND_TYPE band, enum channel_width bw , u8 rfpath, u8 rs, u8 tlrs, u8 ntx_idx, u8 cch, u8 lock ) { HAL_DATA_TYPE *hal_data = GET_HAL_DATA(adapter); struct hal_spec_t *hal_spec = GET_HAL_SPEC(adapter); s8 lmt = phy_get_txpwr_lmt(adapter, regd_name, band, bw, tlrs, ntx_idx, cch, lock); if (lmt != hal_spec->txgi_max) { /* return diff value */ lmt = lmt - phy_get_target_txpwr(adapter, band, rfpath, rs); } return lmt; } /* * May search for secondary channels for min limit * @opch: used to specify operating channel position to get * cch of every bandwidths which differ from current hal_data.cch20, 40, 80... * * return txpwr limit in unit of TX Gain Index * hsl_spec->txgi_max is returned when NO limit */ s8 phy_get_txpwr_lmt_sub_chs(_adapter *adapter , const char *regd_name , BAND_TYPE band, enum channel_width bw , u8 rfpath, u8 rate, u8 ntx_idx, u8 cch, u8 opch) { struct dvobj_priv *dvobj = adapter_to_dvobj(adapter); struct rf_ctl_t *rfctl = adapter_to_rfctl(adapter); HAL_DATA_TYPE *hal_data = GET_HAL_DATA(adapter); struct hal_spec_t *hal_spec = GET_HAL_SPEC(adapter); BOOLEAN no_sc = _FALSE; u8 cch_20 = hal_data->cch_20, cch_40 = hal_data->cch_40, cch_80 = hal_data->cch_80; s8 tlrs = -1; s8 lmt = hal_spec->txgi_max; u8 tmp_cch = 0; u8 tmp_bw; u8 bw_bmp = 0; s8 min_lmt = hal_spec->txgi_max; u8 final_bw = bw, final_cch = cch; _irqL irqL; #ifdef CONFIG_MP_INCLUDED /* MP mode channel don't use secondary channel */ if (rtw_mp_mode_check(adapter) == _TRUE) no_sc = _TRUE; #endif if (IS_CCK_RATE(rate)) tlrs = TXPWR_LMT_RS_CCK; else if (IS_OFDM_RATE(rate)) tlrs = TXPWR_LMT_RS_OFDM; else if (IS_HT_RATE(rate)) tlrs = TXPWR_LMT_RS_HT; else if (IS_VHT_RATE(rate)) tlrs = TXPWR_LMT_RS_VHT; else { RTW_ERR("%s invalid rate 0x%x\n", __func__, rate); rtw_warn_on(1); goto exit; } if (no_sc == _TRUE) { /* use the input center channel and bandwidth directly */ tmp_cch = cch; bw_bmp = ch_width_to_bw_cap(bw); } else { /* decide center channel of each bandwidth */ if (opch != 0) { cch_80 = bw == CHANNEL_WIDTH_80 ? cch : 0; cch_40 = bw == CHANNEL_WIDTH_40 ? cch : 0; cch_20 = bw == CHANNEL_WIDTH_20 ? cch : 0; if (cch_80 != 0) cch_40 = rtw_get_scch_by_cch_opch(cch_80, CHANNEL_WIDTH_80, opch); if (cch_40 != 0) cch_20 = rtw_get_scch_by_cch_opch(cch_40, CHANNEL_WIDTH_40, opch); } /* * find the possible tx bandwidth bmp for this rate, and then will get center channel for each bandwidth * if no possible tx bandwidth bmp, select valid bandwidth up to current RF bandwidth into bmp */ if (tlrs == TXPWR_LMT_RS_CCK || tlrs == TXPWR_LMT_RS_OFDM) bw_bmp = BW_CAP_20M; /* CCK, OFDM only BW 20M */ else if (tlrs == TXPWR_LMT_RS_HT) { bw_bmp = rtw_get_tx_bw_bmp_of_ht_rate(dvobj, rate, bw); if (bw_bmp == 0) bw_bmp = ch_width_to_bw_cap(bw > CHANNEL_WIDTH_40 ? CHANNEL_WIDTH_40 : bw); } else if (tlrs == TXPWR_LMT_RS_VHT) { bw_bmp = rtw_get_tx_bw_bmp_of_vht_rate(dvobj, rate, bw); if (bw_bmp == 0) bw_bmp = ch_width_to_bw_cap(bw > CHANNEL_WIDTH_160 ? CHANNEL_WIDTH_160 : bw); } else rtw_warn_on(1); } if (bw_bmp == 0) goto exit; _enter_critical_mutex(&rfctl->txpwr_lmt_mutex, &irqL); /* loop for each possible tx bandwidth to find minimum limit */ for (tmp_bw = CHANNEL_WIDTH_20; tmp_bw <= bw; tmp_bw++) { if (!(ch_width_to_bw_cap(tmp_bw) & bw_bmp)) continue; if (no_sc == _FALSE) { if (tmp_bw == CHANNEL_WIDTH_20) tmp_cch = cch_20; else if (tmp_bw == CHANNEL_WIDTH_40) tmp_cch = cch_40; else if (tmp_bw == CHANNEL_WIDTH_80) tmp_cch = cch_80; else { tmp_cch = 0; rtw_warn_on(1); } } lmt = phy_get_txpwr_lmt(adapter, regd_name, band, tmp_bw, tlrs, ntx_idx, tmp_cch, 0); if (min_lmt >= lmt) { min_lmt = lmt; final_cch = tmp_cch; final_bw = tmp_bw; } } _exit_critical_mutex(&rfctl->txpwr_lmt_mutex, &irqL); exit: if (0) { if (final_bw != bw && (IS_HT_RATE(rate) || IS_VHT_RATE(rate))) RTW_INFO("%s min_lmt: %s ch%u -> %s ch%u\n" , MGN_RATE_STR(rate) , ch_width_str(bw), cch , ch_width_str(final_bw), final_cch); } return min_lmt; } static void phy_txpwr_lmt_cck_ofdm_mt_chk(_adapter *adapter) { struct rf_ctl_t *rfctl = adapter_to_rfctl(adapter); struct hal_spec_t *hal_spec = GET_HAL_SPEC(adapter); struct txpwr_lmt_ent *ent; _list *cur, *head; u8 channel, tlrs, ntx_idx; rfctl->txpwr_lmt_2g_cck_ofdm_state = 0; #if CONFIG_IEEE80211_BAND_5GHZ rfctl->txpwr_lmt_5g_cck_ofdm_state = 0; #endif head = &rfctl->txpwr_lmt_list; cur = get_next(head); while ((rtw_end_of_queue_search(head, cur)) == _FALSE) { ent = LIST_CONTAINOR(cur, struct txpwr_lmt_ent, list); cur = get_next(cur); /* check 2G CCK, OFDM state*/ for (tlrs = TXPWR_LMT_RS_CCK; tlrs <= TXPWR_LMT_RS_OFDM; tlrs++) { for (ntx_idx = RF_1TX; ntx_idx < MAX_TX_COUNT; ntx_idx++) { for (channel = 0; channel < CENTER_CH_2G_NUM; ++channel) { if (ent->lmt_2g[CHANNEL_WIDTH_20][tlrs][channel][ntx_idx] != hal_spec->txgi_max) { if (tlrs == TXPWR_LMT_RS_CCK) rfctl->txpwr_lmt_2g_cck_ofdm_state |= TXPWR_LMT_HAS_CCK_1T << ntx_idx; else rfctl->txpwr_lmt_2g_cck_ofdm_state |= TXPWR_LMT_HAS_OFDM_1T << ntx_idx; break; } } } } /* if 2G OFDM multi-TX is not defined, reference HT20 */ for (channel = 0; channel < CENTER_CH_2G_NUM; ++channel) { for (ntx_idx = RF_2TX; ntx_idx < MAX_TX_COUNT; ntx_idx++) { if (rfctl->txpwr_lmt_2g_cck_ofdm_state & (TXPWR_LMT_HAS_OFDM_1T << ntx_idx)) continue; ent->lmt_2g[CHANNEL_WIDTH_20][TXPWR_LMT_RS_OFDM][channel][ntx_idx] = ent->lmt_2g[CHANNEL_WIDTH_20][TXPWR_LMT_RS_HT][channel][ntx_idx]; } } #if CONFIG_IEEE80211_BAND_5GHZ /* check 5G OFDM state*/ for (ntx_idx = RF_1TX; ntx_idx < MAX_TX_COUNT; ntx_idx++) { for (channel = 0; channel < CENTER_CH_5G_ALL_NUM; ++channel) { if (ent->lmt_5g[CHANNEL_WIDTH_20][TXPWR_LMT_RS_OFDM - 1][channel][ntx_idx] != hal_spec->txgi_max) { rfctl->txpwr_lmt_5g_cck_ofdm_state |= TXPWR_LMT_HAS_OFDM_1T << ntx_idx; break; } } } for (channel = 0; channel < CENTER_CH_5G_ALL_NUM; ++channel) { for (ntx_idx = RF_2TX; ntx_idx < MAX_TX_COUNT; ntx_idx++) { if (rfctl->txpwr_lmt_5g_cck_ofdm_state & (TXPWR_LMT_HAS_OFDM_1T << ntx_idx)) continue; /* if 5G OFDM multi-TX is not defined, reference HT20 */ ent->lmt_5g[CHANNEL_WIDTH_20][TXPWR_LMT_RS_OFDM - 1][channel][ntx_idx] = ent->lmt_5g[CHANNEL_WIDTH_20][TXPWR_LMT_RS_HT - 1][channel][ntx_idx]; } } #endif /* CONFIG_IEEE80211_BAND_5GHZ */ } } #if CONFIG_IEEE80211_BAND_5GHZ static void phy_txpwr_lmt_cross_ref_ht_vht(_adapter *adapter) { struct rf_ctl_t *rfctl = adapter_to_rfctl(adapter); struct hal_spec_t *hal_spec = GET_HAL_SPEC(adapter); struct txpwr_lmt_ent *ent; _list *cur, *head; u8 bw, channel, tlrs, ref_tlrs, ntx_idx; 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; rfctl->txpwr_lmt_5g_20_40_ref = 0; head = &rfctl->txpwr_lmt_list; cur = get_next(head); while ((rtw_end_of_queue_search(head, cur)) == _FALSE) { ent = LIST_CONTAINOR(cur, struct txpwr_lmt_ent, list); cur = get_next(cur); for (bw = 0; bw < MAX_5G_BANDWIDTH_NUM; ++bw) { for (channel = 0; channel < CENTER_CH_5G_ALL_NUM; ++channel) { for (tlrs = TXPWR_LMT_RS_HT; tlrs < TXPWR_LMT_RS_NUM; ++tlrs) { /* 5G 20M 40M VHT and HT can cross reference */ if (bw == CHANNEL_WIDTH_20 || bw == CHANNEL_WIDTH_40) { if (tlrs == TXPWR_LMT_RS_HT) ref_tlrs = TXPWR_LMT_RS_VHT; else if (tlrs == TXPWR_LMT_RS_VHT) ref_tlrs = TXPWR_LMT_RS_HT; else continue; for (ntx_idx = RF_1TX; ntx_idx < MAX_TX_COUNT; ntx_idx++) { if (ent->lmt_5g[bw][ref_tlrs - 1][channel][ntx_idx] == hal_spec->txgi_max) continue; if (tlrs == TXPWR_LMT_RS_HT) ht_has_ref_5g_20_40++; else if (tlrs == TXPWR_LMT_RS_VHT) vht_has_ref_5g_20_40++; else continue; if (ent->lmt_5g[bw][tlrs - 1][channel][ntx_idx] != hal_spec->txgi_max) continue; if (tlrs == TXPWR_LMT_RS_HT && ref_tlrs == TXPWR_LMT_RS_VHT) ht_ref_vht_5g_20_40++; else if (tlrs == TXPWR_LMT_RS_VHT && ref_tlrs == TXPWR_LMT_RS_HT) vht_ref_ht_5g_20_40++; if (0) RTW_INFO("reg:%s, bw:%u, ch:%u, %s-%uT ref %s-%uT\n" , ent->regd_name, bw, channel , txpwr_lmt_rs_str(tlrs), ntx_idx + 1 , txpwr_lmt_rs_str(ref_tlrs), ntx_idx + 1); ent->lmt_5g[bw][tlrs - 1][channel][ntx_idx] = ent->lmt_5g[bw][ref_tlrs - 1][channel][ntx_idx]; } } } } } } if (0) { RTW_INFO("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); RTW_INFO("vht_ref_ht_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) rfctl->txpwr_lmt_5g_20_40_ref |= TXPWR_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) rfctl->txpwr_lmt_5g_20_40_ref |= TXPWR_LMT_REF_VHT_FROM_HT; } #endif /* CONFIG_IEEE80211_BAND_5GHZ */ #ifndef DBG_TXPWR_LMT_BAND_CHK #define DBG_TXPWR_LMT_BAND_CHK 0 #endif #if DBG_TXPWR_LMT_BAND_CHK /* check if larger bandwidth limit is less than smaller bandwidth for HT & VHT rate */ void phy_txpwr_limit_bandwidth_chk(_adapter *adapter) { struct rf_ctl_t *rfctl = adapter_to_rfctl(adapter); HAL_DATA_TYPE *hal_data = GET_HAL_DATA(adapter); struct hal_spec_t *hal_spec = GET_HAL_SPEC(adapter); u8 band, bw, path, tlrs, ntx_idx, cch, offset, scch; u8 ch_num, n, i; for (band = BAND_ON_2_4G; band <= BAND_ON_5G; band++) { if (!hal_is_band_support(adapter, band)) continue; for (bw = CHANNEL_WIDTH_40; bw <= CHANNEL_WIDTH_80; bw++) { if (bw >= CHANNEL_WIDTH_160) continue; if (band == BAND_ON_2_4G && bw >= CHANNEL_WIDTH_80) continue; if (band == BAND_ON_2_4G) ch_num = center_chs_2g_num(bw); else ch_num = center_chs_5g_num(bw); if (ch_num == 0) { rtw_warn_on(1); break; } for (tlrs = TXPWR_LMT_RS_HT; tlrs < TXPWR_LMT_RS_NUM; tlrs++) { if (band == BAND_ON_2_4G && tlrs == TXPWR_LMT_RS_VHT) continue; if (band == BAND_ON_5G && tlrs == TXPWR_LMT_RS_CCK) continue; if (bw > CHANNEL_WIDTH_20 && (tlrs == TXPWR_LMT_RS_CCK || tlrs == TXPWR_LMT_RS_OFDM)) continue; if (bw > CHANNEL_WIDTH_40 && tlrs == TXPWR_LMT_RS_HT) continue; if (tlrs == TXPWR_LMT_RS_VHT && !IS_HARDWARE_TYPE_JAGUAR_ALL(adapter)) continue; for (ntx_idx = RF_1TX; ntx_idx < MAX_TX_COUNT; ntx_idx++) { struct txpwr_lmt_ent *ent; _list *cur, *head; if (ntx_idx + 1 > hal_data->max_tx_cnt) continue; /* bypass CCK multi-TX is not defined */ if (tlrs == TXPWR_LMT_RS_CCK && ntx_idx > RF_1TX) { if (band == BAND_ON_2_4G && !(rfctl->txpwr_lmt_2g_cck_ofdm_state & (TXPWR_LMT_HAS_CCK_1T << ntx_idx))) continue; } /* bypass OFDM multi-TX is not defined */ if (tlrs == TXPWR_LMT_RS_OFDM && ntx_idx > RF_1TX) { if (band == BAND_ON_2_4G && !(rfctl->txpwr_lmt_2g_cck_ofdm_state & (TXPWR_LMT_HAS_OFDM_1T << ntx_idx))) continue; #if CONFIG_IEEE80211_BAND_5GHZ if (band == BAND_ON_5G && !(rfctl->txpwr_lmt_5g_cck_ofdm_state & (TXPWR_LMT_HAS_OFDM_1T << ntx_idx))) continue; #endif } /* bypass 5G 20M, 40M pure reference */ #if CONFIG_IEEE80211_BAND_5GHZ if (band == BAND_ON_5G && (bw == CHANNEL_WIDTH_20 || bw == CHANNEL_WIDTH_40)) { if (rfctl->txpwr_lmt_5g_20_40_ref == TXPWR_LMT_REF_HT_FROM_VHT) { if (tlrs == TXPWR_LMT_RS_HT) continue; } else if (rfctl->txpwr_lmt_5g_20_40_ref == TXPWR_LMT_REF_VHT_FROM_HT) { if (tlrs == TXPWR_LMT_RS_VHT && bw <= CHANNEL_WIDTH_40) continue; } } #endif for (n = 0; n < ch_num; n++) { u8 cch_by_bw[3]; u8 offset_by_bw; /* bitmap, 0 for lower, 1 for upper */ u8 bw_pos; s8 lmt[3]; if (band == BAND_ON_2_4G) cch = center_chs_2g(bw, n); else cch = center_chs_5g(bw, n); if (cch == 0) { rtw_warn_on(1); break; } _rtw_memset(cch_by_bw, 0, 3); cch_by_bw[bw] = cch; offset_by_bw = 0x01; do { for (bw_pos = bw; bw_pos >= CHANNEL_WIDTH_40; bw_pos--) cch_by_bw[bw_pos - 1] = rtw_get_scch_by_cch_offset(cch_by_bw[bw_pos], bw_pos, offset_by_bw & BIT(bw_pos) ? HAL_PRIME_CHNL_OFFSET_UPPER : HAL_PRIME_CHNL_OFFSET_LOWER); head = &rfctl->txpwr_lmt_list; cur = get_next(head); while ((rtw_end_of_queue_search(head, cur)) == _FALSE) { ent = LIST_CONTAINOR(cur, struct txpwr_lmt_ent, list); cur = get_next(cur); for (bw_pos = bw; bw_pos < CHANNEL_WIDTH_160; bw_pos--) lmt[bw_pos] = phy_get_txpwr_lmt(adapter, ent->regd_name, band, bw_pos, tlrs, ntx_idx, cch_by_bw[bw_pos], 0); for (bw_pos = bw; bw_pos > CHANNEL_WIDTH_20; bw_pos--) if (lmt[bw_pos] > lmt[bw_pos - 1]) break; if (bw_pos == CHANNEL_WIDTH_20) continue; RTW_PRINT_SEL(RTW_DBGDUMP, "[%s][%s][%s][%uT][%-4s] cch:" , band_str(band) , ch_width_str(bw) , txpwr_lmt_rs_str(tlrs) , ntx_idx + 1 , ent->regd_name ); for (bw_pos = bw; bw_pos < CHANNEL_WIDTH_160; bw_pos--) _RTW_PRINT_SEL(RTW_DBGDUMP, "%03u ", cch_by_bw[bw_pos]); _RTW_PRINT_SEL(RTW_DBGDUMP, "limit:"); for (bw_pos = bw; bw_pos < CHANNEL_WIDTH_160; bw_pos--) { if (lmt[bw_pos] == hal_spec->txgi_max) _RTW_PRINT_SEL(RTW_DBGDUMP, "N/A "); else if (lmt[bw_pos] > -hal_spec->txgi_pdbm && lmt[bw_pos] < 0) /* -1 < value < 0 */ _RTW_PRINT_SEL(RTW_DBGDUMP, "-0.%d", (rtw_abs(lmt[bw_pos]) % hal_spec->txgi_pdbm) * 100 / hal_spec->txgi_pdbm); else if (lmt[bw_pos] % hal_spec->txgi_pdbm) _RTW_PRINT_SEL(RTW_DBGDUMP, "%2d.%d ", lmt[bw_pos] / hal_spec->txgi_pdbm, (rtw_abs(lmt[bw_pos]) % hal_spec->txgi_pdbm) * 100 / hal_spec->txgi_pdbm); else _RTW_PRINT_SEL(RTW_DBGDUMP, "%2d ", lmt[bw_pos] / hal_spec->txgi_pdbm); } _RTW_PRINT_SEL(RTW_DBGDUMP, "\n"); } for (bw_pos = bw; bw_pos < CHANNEL_WIDTH_160; bw_pos--) lmt[bw_pos] = phy_get_txpwr_lmt(adapter, regd_str(TXPWR_LMT_WW), band, bw_pos, tlrs, ntx_idx, cch_by_bw[bw_pos], 0); for (bw_pos = bw; bw_pos > CHANNEL_WIDTH_20; bw_pos--) if (lmt[bw_pos] > lmt[bw_pos - 1]) break; if (bw_pos != CHANNEL_WIDTH_20) { RTW_PRINT_SEL(RTW_DBGDUMP, "[%s][%s][%s][%uT][%-4s] cch:" , band_str(band) , ch_width_str(bw) , txpwr_lmt_rs_str(tlrs) , ntx_idx + 1 , regd_str(TXPWR_LMT_WW) ); for (bw_pos = bw; bw_pos < CHANNEL_WIDTH_160; bw_pos--) _RTW_PRINT_SEL(RTW_DBGDUMP, "%03u ", cch_by_bw[bw_pos]); _RTW_PRINT_SEL(RTW_DBGDUMP, "limit:"); for (bw_pos = bw; bw_pos < CHANNEL_WIDTH_160; bw_pos--) { if (lmt[bw_pos] == hal_spec->txgi_max) _RTW_PRINT_SEL(RTW_DBGDUMP, "N/A "); else if (lmt[bw_pos] > -hal_spec->txgi_pdbm && lmt[bw_pos] < 0) /* -1 < value < 0 */ _RTW_PRINT_SEL(RTW_DBGDUMP, "-0.%d", (rtw_abs(lmt[bw_pos]) % hal_spec->txgi_pdbm) * 100 / hal_spec->txgi_pdbm); else if (lmt[bw_pos] % hal_spec->txgi_pdbm) _RTW_PRINT_SEL(RTW_DBGDUMP, "%2d.%d ", lmt[bw_pos] / hal_spec->txgi_pdbm, (rtw_abs(lmt[bw_pos]) % hal_spec->txgi_pdbm) * 100 / hal_spec->txgi_pdbm); else _RTW_PRINT_SEL(RTW_DBGDUMP, "%2d ", lmt[bw_pos] / hal_spec->txgi_pdbm); } _RTW_PRINT_SEL(RTW_DBGDUMP, "\n"); } offset_by_bw += 2; if (offset_by_bw & BIT(bw + 1)) break; } while (1); /* loop for all ch combinations */ } /* loop for center channels */ } /* loop fo each ntx_idx */ } /* loop for tlrs */ } /* loop for bandwidth */ } /* loop for band */ } #endif /* DBG_TXPWR_LMT_BAND_CHK */ static void phy_txpwr_lmt_post_hdl(_adapter *adapter) { struct rf_ctl_t *rfctl = adapter_to_rfctl(adapter); _irqL irqL; _enter_critical_mutex(&rfctl->txpwr_lmt_mutex, &irqL); #if CONFIG_IEEE80211_BAND_5GHZ if (IS_HARDWARE_TYPE_JAGUAR_ALL(adapter)) phy_txpwr_lmt_cross_ref_ht_vht(adapter); #endif phy_txpwr_lmt_cck_ofdm_mt_chk(adapter); #if DBG_TXPWR_LMT_BAND_CHK phy_txpwr_limit_bandwidth_chk(adapter); #endif _exit_critical_mutex(&rfctl->txpwr_lmt_mutex, &irqL); } BOOLEAN GetS1ByteIntegerFromStringInDecimal( char *str, s8 *val ) { u8 negative = 0; u16 i = 0; *val = 0; while (str[i] != '\0') { if (i == 0 && (str[i] == '+' || str[i] == '-')) { if (str[i] == '-') negative = 1; } else if (str[i] >= '0' && str[i] <= '9') { *val *= 10; *val += (str[i] - '0'); } else return _FALSE; ++i; } if (negative) *val = -*val; return _TRUE; } #endif /* CONFIG_TXPWR_LIMIT */ /* * phy_set_tx_power_limit - Parsing TX power limit from phydm array, called by odm_ConfigBB_TXPWR_LMT_XXX in phydm */ void phy_set_tx_power_limit( struct dm_struct *pDM_Odm, u8 *Regulation, u8 *Band, u8 *Bandwidth, u8 *RateSection, u8 *ntx, u8 *Channel, u8 *PowerLimit ) { #if CONFIG_TXPWR_LIMIT PADAPTER Adapter = pDM_Odm->adapter; HAL_DATA_TYPE *pHalData = GET_HAL_DATA(Adapter); struct hal_spec_t *hal_spec = GET_HAL_SPEC(Adapter); u8 band = 0, bandwidth = 0, tlrs = 0, channel; u8 ntx_idx; s8 powerLimit = 0, prevPowerLimit, channelIndex; s8 ww_lmt_val = phy_txpwr_ww_lmt_value(Adapter); if (0) RTW_INFO("Index of power limit table [regulation %s][band %s][bw %s][rate section %s][ntx %s][chnl %s][val %s]\n" , Regulation, Band, Bandwidth, RateSection, ntx, Channel, PowerLimit); if (GetU1ByteIntegerFromStringInDecimal((char *)Channel, &channel) == _FALSE || GetS1ByteIntegerFromStringInDecimal((char *)PowerLimit, &powerLimit) == _FALSE ) { RTW_PRINT("Illegal index of power limit table [ch %s][val %s]\n", Channel, PowerLimit); return; } if (powerLimit != ww_lmt_val) { if (powerLimit < -hal_spec->txgi_max || powerLimit > hal_spec->txgi_max) RTW_PRINT("Illegal power limit value [ch %s][val %s]\n", Channel, PowerLimit); if (powerLimit > hal_spec->txgi_max) powerLimit = hal_spec->txgi_max; else if (powerLimit < -hal_spec->txgi_max) powerLimit = ww_lmt_val + 1; } if (strncmp(RateSection, "CCK", 3) == 0) tlrs = TXPWR_LMT_RS_CCK; else if (strncmp(RateSection, "OFDM", 4) == 0) tlrs = TXPWR_LMT_RS_OFDM; else if (strncmp(RateSection, "HT", 2) == 0) tlrs = TXPWR_LMT_RS_HT; else if (strncmp(RateSection, "VHT", 3) == 0) tlrs = TXPWR_LMT_RS_VHT; else { RTW_PRINT("Wrong rate section:%s\n", RateSection); return; } if (strncmp(ntx, "1T", 2) == 0) ntx_idx = RF_1TX; else if (strncmp(ntx, "2T", 2) == 0) ntx_idx = RF_2TX; else if (strncmp(ntx, "3T", 2) == 0) ntx_idx = RF_3TX; else if (strncmp(ntx, "4T", 2) == 0) ntx_idx = RF_4TX; else { RTW_PRINT("Wrong tx num:%s\n", ntx); return; } if (strncmp(Bandwidth, "20M", 3) == 0) bandwidth = CHANNEL_WIDTH_20; else if (strncmp(Bandwidth, "40M", 3) == 0) bandwidth = CHANNEL_WIDTH_40; else if (strncmp(Bandwidth, "80M", 3) == 0) bandwidth = CHANNEL_WIDTH_80; else if (strncmp(Bandwidth, "160M", 4) == 0) bandwidth = CHANNEL_WIDTH_160; else { RTW_PRINT("unknown bandwidth: %s\n", Bandwidth); return; } if (strncmp(Band, "2.4G", 4) == 0) { band = BAND_ON_2_4G; channelIndex = phy_GetChannelIndexOfTxPowerLimit(BAND_ON_2_4G, channel); if (channelIndex == -1) { RTW_PRINT("unsupported channel: %d at 2.4G\n", channel); return; } if (bandwidth >= MAX_2_4G_BANDWIDTH_NUM) { RTW_PRINT("unsupported bandwidth: %s at 2.4G\n", Bandwidth); return; } rtw_txpwr_lmt_add(adapter_to_rfctl(Adapter), Regulation, band, bandwidth, tlrs, ntx_idx, channelIndex, powerLimit); } #if CONFIG_IEEE80211_BAND_5GHZ else if (strncmp(Band, "5G", 2) == 0) { band = BAND_ON_5G; channelIndex = phy_GetChannelIndexOfTxPowerLimit(BAND_ON_5G, channel); if (channelIndex == -1) { RTW_PRINT("unsupported channel: %d at 5G\n", channel); return; } rtw_txpwr_lmt_add(adapter_to_rfctl(Adapter), Regulation, band, bandwidth, tlrs, ntx_idx, channelIndex, powerLimit); } #endif else { RTW_PRINT("unknown/unsupported band:%s\n", Band); return; } #endif } u8 phy_get_tx_power_index_ex(_adapter *adapter , enum rf_path rfpath, RATE_SECTION rs, enum MGN_RATE rate , enum channel_width bw, BAND_TYPE band, u8 cch, u8 opch) { return rtw_hal_get_tx_power_index(adapter, rfpath, rs, rate, bw, band, cch, opch, NULL); } u8 phy_get_tx_power_index( PADAPTER pAdapter, enum rf_path RFPath, u8 Rate, enum channel_width BandWidth, u8 Channel ) { RATE_SECTION rs = mgn_rate_to_rs(Rate); BAND_TYPE band = Channel <= 14 ? BAND_ON_2_4G : BAND_ON_5G; return rtw_hal_get_tx_power_index(pAdapter, RFPath, rs, Rate, BandWidth, band, Channel, 0, NULL); } void PHY_SetTxPowerIndex( PADAPTER pAdapter, u32 PowerIndex, enum rf_path RFPath, u8 Rate ) { rtw_hal_set_tx_power_index(pAdapter, PowerIndex, RFPath, Rate); } void dump_tx_power_index_inline(void *sel, _adapter *adapter, u8 rfpath, enum channel_width bw, u8 cch, enum MGN_RATE rate, u8 pwr_idx, struct txpwr_idx_comp *tic) { struct hal_spec_t *hal_spec = GET_HAL_SPEC(adapter); if (tic->utarget == hal_spec->txgi_max) { RTW_PRINT_SEL(sel, "TXPWR: [%c][%s]cch:%u, %s %uT, idx:%u(0x%02x) = base(%d) + min((byr(%d) + btc(%d) + extra(%d)), lmt(%d), ulmt(%d)) + tpt(%d) + dpd(%d)\n" , rf_path_char(rfpath), ch_width_str(bw), cch , MGN_RATE_STR(rate), tic->ntx_idx + 1 , pwr_idx, pwr_idx, tic->base , tic->by_rate, tic->btc, tic->extra, tic->limit, tic->ulimit , tic->tpt, tic->dpd); } else { RTW_PRINT_SEL(sel, "TXPWR: [%c][%s]cch:%u, %s %uT, idx:%u(0x%02x) = base(%d) + min(utgt(%d), lmt(%d), ulmt(%d)) + tpt(%d) + dpd(%d)\n" , rf_path_char(rfpath), ch_width_str(bw), cch , MGN_RATE_STR(rate), tic->ntx_idx + 1 , pwr_idx, pwr_idx, tic->base , tic->utarget, tic->limit, tic->ulimit , tic->tpt, tic->dpd); } } void dump_tx_power_idx_value(void *sel, _adapter *adapter, u8 rfpath, enum MGN_RATE rate, u8 pwr_idx, struct txpwr_idx_comp *tic) { struct hal_spec_t *hal_spec = GET_HAL_SPEC(adapter); char tmp_str[8]; txpwr_idx_get_dbm_str(tic->target, hal_spec->txgi_max, hal_spec->txgi_pdbm, 0, tmp_str, 8); if (tic->utarget == hal_spec->txgi_max) { RTW_PRINT_SEL(sel, "%4c %9s %uT %s %3u(0x%02x)" " %4d ((%4d %3d %5d) %4d %4d) %3d %3d\n" , rf_path_char(rfpath), MGN_RATE_STR(rate), tic->ntx_idx + 1 , tmp_str, pwr_idx, pwr_idx , tic->base, tic->by_rate, tic->btc, tic->extra, tic->limit, tic->ulimit , tic->tpt, tic->dpd); } else { RTW_PRINT_SEL(sel, "%4c %9s %uT %s %3u(0x%02x)" " %4d (%4d %4d %4d) %3d %3d\n" , rf_path_char(rfpath), MGN_RATE_STR(rate), tic->ntx_idx + 1 , tmp_str, pwr_idx, pwr_idx , tic->base, tic->utarget, tic->limit, tic->ulimit , tic->tpt, tic->dpd); } } void dump_tx_power_idx_title(void *sel, _adapter *adapter, enum channel_width bw, u8 cch, u8 opch) { u8 cch_20, cch_40, cch_80; cch_80 = bw == CHANNEL_WIDTH_80 ? cch : 0; cch_40 = bw == CHANNEL_WIDTH_40 ? cch : 0; cch_20 = bw == CHANNEL_WIDTH_20 ? cch : 0; if (cch_80 != 0) cch_40 = rtw_get_scch_by_cch_opch(cch_80, CHANNEL_WIDTH_80, opch); if (cch_40 != 0) cch_20 = rtw_get_scch_by_cch_opch(cch_40, CHANNEL_WIDTH_40, opch); RTW_PRINT_SEL(sel, "%s", ch_width_str(bw)); if (bw >= CHANNEL_WIDTH_80) _RTW_PRINT_SEL(sel, ", cch80:%u", cch_80); if (bw >= CHANNEL_WIDTH_40) _RTW_PRINT_SEL(sel, ", cch40:%u", cch_40); _RTW_PRINT_SEL(sel, ", cch20:%u\n", cch_20); if (!phy_is_txpwr_user_target_specified(adapter)) { RTW_PRINT_SEL(sel, "%-4s %-9s %2s %-6s %-3s%6s" " = %-4s + min((%-4s + %-3s + %-5s), %-4s, %-4s) + %-3s + %-3s\n" , "path", "rate", "", "dBm", "idx", "" , "base", "byr", "btc", "extra", "lmt", "ulmt" , "tpt", "dpd"); } else { RTW_PRINT_SEL(sel, "%-4s %-9s %2s %-6s %-3s%6s" " = %-4s + min(%-4s, %-4s, %-4s) + %-3s + %-3s\n" , "path", "rate", "", "dBm", "idx", "" , "base", "utgt", "lmt", "ulmt" , "tpt", "dpd"); } } void dump_tx_power_idx_by_path_rs(void *sel, _adapter *adapter, u8 rfpath , RATE_SECTION rs, enum channel_width bw, u8 cch, u8 opch) { HAL_DATA_TYPE *hal_data = GET_HAL_DATA(adapter); struct hal_spec_t *hal_spec = GET_HAL_SPEC(adapter); u8 power_idx; struct txpwr_idx_comp tic; u8 tx_num, i; u8 band = cch > 14 ? BAND_ON_5G : BAND_ON_2_4G; if (!HAL_SPEC_CHK_RF_PATH(hal_spec, band, rfpath)) return; if (rs >= RATE_SECTION_NUM) return; tx_num = rate_section_to_tx_num(rs); if (tx_num + 1 > hal_data->tx_nss) return; if (band == BAND_ON_5G && IS_CCK_RATE_SECTION(rs)) return; if (IS_VHT_RATE_SECTION(rs) && !IS_HARDWARE_TYPE_JAGUAR_ALL(adapter)) return; for (i = 0; i < rates_by_sections[rs].rate_num; i++) { power_idx = rtw_hal_get_tx_power_index(adapter, rfpath, rs, rates_by_sections[rs].rates[i], bw, band, cch, opch, &tic); dump_tx_power_idx_value(sel, adapter, rfpath, rates_by_sections[rs].rates[i], power_idx, &tic); } } void dump_tx_power_idx(void *sel, _adapter *adapter, enum channel_width bw, u8 cch, u8 opch) { u8 rfpath, rs; dump_tx_power_idx_title(sel, adapter, bw, cch, opch); for (rfpath = RF_PATH_A; rfpath < RF_PATH_MAX; rfpath++) for (rs = CCK; rs < RATE_SECTION_NUM; rs++) dump_tx_power_idx_by_path_rs(sel, adapter, rfpath, rs, bw, cch, opch); } void dump_txpwr_total_dbm_value(void *sel, _adapter *adapter, enum MGN_RATE rate, u8 ntx_idx , s16 target, s16 byr, s16 btc, s16 extra, s16 lmt, s16 ulmt) { char target_str[8]; char byr_str[8]; char btc_str[8]; char extra_str[8]; char lmt_str[8]; char ulmt_str[8]; txpwr_mbm_get_dbm_str(target, 0, target_str, 8); txpwr_mbm_get_dbm_str(byr, 0, byr_str, 8); txpwr_mbm_get_dbm_str(btc, 0, btc_str, 8); txpwr_mbm_get_dbm_str(extra, 0, extra_str, 8); txpwr_mbm_get_dbm_str(lmt, 0, lmt_str, 8); txpwr_mbm_get_dbm_str(ulmt, 0, ulmt_str, 8); RTW_PRINT_SEL(sel, "%9s %uT %s = ((%s %s %s), %s, %s)\n" , MGN_RATE_STR(rate), ntx_idx + 1 , target_str, byr_str, btc_str, extra_str, lmt_str, ulmt_str); } void dump_txpwr_total_dbm_value_utgt(void *sel, _adapter *adapter, enum MGN_RATE rate, u8 ntx_idx , s16 target, s16 utgt, s16 lmt, s16 ulmt) { char target_str[8]; char utgt_str[8]; char lmt_str[8]; char ulmt_str[8]; txpwr_mbm_get_dbm_str(target, 0, target_str, 8); txpwr_mbm_get_dbm_str(utgt, 0, utgt_str, 8); txpwr_mbm_get_dbm_str(lmt, 0, lmt_str, 8); txpwr_mbm_get_dbm_str(ulmt, 0, ulmt_str, 8); RTW_PRINT_SEL(sel, "%9s %uT %s = (%s, %s, %s)\n" , MGN_RATE_STR(rate), ntx_idx + 1 , target_str, utgt_str, lmt_str, ulmt_str); } void dump_txpwr_total_dbm_title(void *sel, _adapter *adapter, enum channel_width bw, u8 cch, u8 opch) { u8 cch_20, cch_40, cch_80; cch_80 = bw == CHANNEL_WIDTH_80 ? cch : 0; cch_40 = bw == CHANNEL_WIDTH_40 ? cch : 0; cch_20 = bw == CHANNEL_WIDTH_20 ? cch : 0; if (cch_80 != 0) cch_40 = rtw_get_scch_by_cch_opch(cch_80, CHANNEL_WIDTH_80, opch); if (cch_40 != 0) cch_20 = rtw_get_scch_by_cch_opch(cch_40, CHANNEL_WIDTH_40, opch); RTW_PRINT_SEL(sel, "%s", ch_width_str(bw)); if (bw >= CHANNEL_WIDTH_80) _RTW_PRINT_SEL(sel, ", cch80:%u", cch_80); if (bw >= CHANNEL_WIDTH_40) _RTW_PRINT_SEL(sel, ", cch40:%u", cch_40); _RTW_PRINT_SEL(sel, ", cch20:%u\n", cch_20); if (!phy_is_txpwr_user_target_specified(adapter)) { RTW_PRINT_SEL(sel, "%-9s %2s %-6s = min((%-6s + %-6s + %-6s), %-6s, %-6s)\n" , "rate", "", "target", "byr", "btc", "extra", "lmt", "ulmt"); } else { RTW_PRINT_SEL(sel, "%-9s %2s %-6s = min(%-6s, %-6s, %-6s)\n" , "rate", "", "target", "utgt", "lmt", "ulmt"); } } void dump_txpwr_total_dbm_by_rs(void *sel, _adapter *adapter, u8 rs, enum channel_width bw, u8 cch, u8 opch) { HAL_DATA_TYPE *hal_data = GET_HAL_DATA(adapter); struct hal_spec_t *hal_spec = GET_HAL_SPEC(adapter); u8 i; u8 band = cch > 14 ? BAND_ON_5G : BAND_ON_2_4G; if (rs >= RATE_SECTION_NUM) return; if (rate_section_to_tx_num(rs) + 1 > hal_data->tx_nss) return; if (band == BAND_ON_5G && IS_CCK_RATE_SECTION(rs)) return; if (IS_VHT_RATE_SECTION(rs) && !IS_HARDWARE_TYPE_JAGUAR_ALL(adapter)) return; for (i = 0; i < rates_by_sections[rs].rate_num; i++) { struct txpwr_idx_comp tic; s16 target, byr, btc, extra, utgt, lmt, ulmt; u8 tx_num; target = phy_get_txpwr_total_mbm(adapter, rs, rates_by_sections[rs].rates[i], bw, cch, opch, &tic); tx_num = tic.ntx_idx + 1; if (tic.limit == hal_spec->txgi_max) lmt = UNSPECIFIED_MBM; else lmt = ((tic.limit * MBM_PDBM) / hal_spec->txgi_pdbm) + mb_of_ntx(tx_num); if (tic.ulimit == hal_spec->txgi_max) ulmt = UNSPECIFIED_MBM; else ulmt = ((tic.ulimit * MBM_PDBM) / hal_spec->txgi_pdbm) + mb_of_ntx(tx_num); if (tic.utarget == hal_spec->txgi_max) { byr = ((tic.by_rate * MBM_PDBM) / hal_spec->txgi_pdbm) + mb_of_ntx(tx_num); btc = (tic.btc * MBM_PDBM) / hal_spec->txgi_pdbm; extra = (tic.extra * MBM_PDBM) / hal_spec->txgi_pdbm; dump_txpwr_total_dbm_value(sel, adapter, rates_by_sections[rs].rates[i], tic.ntx_idx , target, byr, btc, extra, lmt, ulmt); } else { utgt = ((tic.utarget * MBM_PDBM) / hal_spec->txgi_pdbm) + mb_of_ntx(tx_num); dump_txpwr_total_dbm_value_utgt(sel, adapter, rates_by_sections[rs].rates[i], tic.ntx_idx , target, utgt, lmt, ulmt); } } } /* dump txpowr in dBm with effect of N-TX */ void dump_txpwr_total_dbm(void *sel, _adapter *adapter, enum channel_width bw, u8 cch, u8 opch) { u8 rs; dump_txpwr_total_dbm_title(sel, adapter, bw, cch, opch); for (rs = CCK; rs < RATE_SECTION_NUM; rs++) dump_txpwr_total_dbm_by_rs(sel, adapter, rs, bw, cch, opch); } bool phy_is_tx_power_limit_needed(_adapter *adapter) { #if CONFIG_TXPWR_LIMIT HAL_DATA_TYPE *hal_data = GET_HAL_DATA(adapter); struct registry_priv *regsty = dvobj_to_regsty(adapter_to_dvobj(adapter)); if (regsty->RegEnableTxPowerLimit == 1 || (regsty->RegEnableTxPowerLimit == 2 && hal_data->EEPROMRegulatory == 1)) return _TRUE; #endif return _FALSE; } bool phy_is_tx_power_by_rate_needed(_adapter *adapter) { HAL_DATA_TYPE *hal_data = GET_HAL_DATA(adapter); struct registry_priv *regsty = dvobj_to_regsty(adapter_to_dvobj(adapter)); if (regsty->RegEnableTxPowerByRate == 1 || (regsty->RegEnableTxPowerByRate == 2 && hal_data->EEPROMRegulatory != 2)) return _TRUE; return _FALSE; } int phy_load_tx_power_by_rate(_adapter *adapter, u8 chk_file) { HAL_DATA_TYPE *hal_data = GET_HAL_DATA(adapter); int ret = _FAIL; hal_data->txpwr_by_rate_loaded = 0; PHY_InitTxPowerByRate(adapter); /* tx power limit is based on tx power by rate */ hal_data->txpwr_limit_loaded = 0; #ifdef CONFIG_LOAD_PHY_PARA_FROM_FILE if (chk_file && phy_ConfigBBWithPgParaFile(adapter, PHY_FILE_PHY_REG_PG) == _SUCCESS ) { hal_data->txpwr_by_rate_from_file = 1; goto post_hdl; } #endif #ifdef CONFIG_EMBEDDED_FWIMG if (HAL_STATUS_SUCCESS == odm_config_bb_with_header_file(&hal_data->odmpriv, CONFIG_BB_PHY_REG_PG)) { RTW_INFO("default power by rate loaded\n"); hal_data->txpwr_by_rate_from_file = 0; goto post_hdl; } #endif RTW_ERR("%s():Read Tx power by rate fail\n", __func__); goto exit; post_hdl: if (hal_data->odmpriv.phy_reg_pg_value_type != PHY_REG_PG_EXACT_VALUE) { rtw_warn_on(1); goto exit; } PHY_TxPowerByRateConfiguration(adapter); hal_data->txpwr_by_rate_loaded = 1; ret = _SUCCESS; exit: return ret; } #if CONFIG_TXPWR_LIMIT int phy_load_tx_power_limit(_adapter *adapter, u8 chk_file) { HAL_DATA_TYPE *hal_data = GET_HAL_DATA(adapter); struct registry_priv *regsty = dvobj_to_regsty(adapter_to_dvobj(adapter)); struct rf_ctl_t *rfctl = adapter_to_rfctl(adapter); int ret = _FAIL; hal_data->txpwr_limit_loaded = 0; rtw_regd_exc_list_free(rfctl); rtw_txpwr_lmt_list_free(rfctl); if (!hal_data->txpwr_by_rate_loaded && regsty->target_tx_pwr_valid != _TRUE) { RTW_ERR("%s():Read Tx power limit before target tx power is specify\n", __func__); goto exit; } #ifdef CONFIG_LOAD_PHY_PARA_FROM_FILE if (chk_file && PHY_ConfigRFWithPowerLimitTableParaFile(adapter, PHY_FILE_TXPWR_LMT) == _SUCCESS ) { hal_data->txpwr_limit_from_file = 1; goto post_hdl; } #endif #ifdef CONFIG_EMBEDDED_FWIMG if (odm_config_rf_with_header_file(&hal_data->odmpriv, CONFIG_RF_TXPWR_LMT, RF_PATH_A) == HAL_STATUS_SUCCESS) { RTW_INFO("default power limit loaded\n"); hal_data->txpwr_limit_from_file = 0; goto post_hdl; } #endif RTW_ERR("%s():Read Tx power limit fail\n", __func__); goto exit; post_hdl: phy_txpwr_lmt_post_hdl(adapter); rtw_txpwr_init_regd(rfctl); hal_data->txpwr_limit_loaded = 1; ret = _SUCCESS; exit: return ret; } #endif /* CONFIG_TXPWR_LIMIT */ void phy_load_tx_power_ext_info(_adapter *adapter, u8 chk_file) { struct registry_priv *regsty = adapter_to_regsty(adapter); /* check registy target tx power */ regsty->target_tx_pwr_valid = rtw_regsty_chk_target_tx_power_valid(adapter); /* power by rate */ if (phy_is_tx_power_by_rate_needed(adapter) || regsty->target_tx_pwr_valid != _TRUE /* need target tx power from by rate table */ ) phy_load_tx_power_by_rate(adapter, chk_file); /* power limit */ #if CONFIG_TXPWR_LIMIT if (phy_is_tx_power_limit_needed(adapter)) phy_load_tx_power_limit(adapter, chk_file); #endif } inline void phy_reload_tx_power_ext_info(_adapter *adapter) { phy_load_tx_power_ext_info(adapter, 1); } inline void phy_reload_default_tx_power_ext_info(_adapter *adapter) { phy_load_tx_power_ext_info(adapter, 0); } void dump_tx_power_ext_info(void *sel, _adapter *adapter) { struct registry_priv *regsty = adapter_to_regsty(adapter); HAL_DATA_TYPE *hal_data = GET_HAL_DATA(adapter); RTW_PRINT_SEL(sel, "txpwr_pg_mode: %s\n", txpwr_pg_mode_str(hal_data->txpwr_pg_mode)); if (regsty->target_tx_pwr_valid == _TRUE) RTW_PRINT_SEL(sel, "target_tx_power: from registry\n"); else if (hal_data->txpwr_by_rate_loaded) RTW_PRINT_SEL(sel, "target_tx_power: from power by rate\n"); else RTW_PRINT_SEL(sel, "target_tx_power: unavailable\n"); RTW_PRINT_SEL(sel, "tx_power_by_rate: %s, %s, %s\n" , phy_is_tx_power_by_rate_needed(adapter) ? "enabled" : "disabled" , hal_data->txpwr_by_rate_loaded ? "loaded" : "unloaded" , hal_data->txpwr_by_rate_from_file ? "file" : "default" ); RTW_PRINT_SEL(sel, "tx_power_limit: %s, %s, %s\n" , phy_is_tx_power_limit_needed(adapter) ? "enabled" : "disabled" , hal_data->txpwr_limit_loaded ? "loaded" : "unloaded" , hal_data->txpwr_limit_from_file ? "file" : "default" ); } void dump_target_tx_power(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 = adapter_to_regsty(adapter); int path, tx_num, band, rs; u8 target; for (band = BAND_ON_2_4G; band <= BAND_ON_5G; band++) { if (!hal_is_band_support(adapter, band)) continue; for (path = 0; path < RF_PATH_MAX; path++) { if (!HAL_SPEC_CHK_RF_PATH(hal_spec, band, path)) break; RTW_PRINT_SEL(sel, "[%s][%c]%s\n", band_str(band), rf_path_char(path) , (regsty->target_tx_pwr_valid == _FALSE && hal_data->txpwr_by_rate_undefined_band_path[band][path]) ? "(dup)" : ""); for (rs = 0; rs < RATE_SECTION_NUM; rs++) { tx_num = rate_section_to_tx_num(rs); if (tx_num + 1 > hal_data->tx_nss) continue; if (band == BAND_ON_5G && IS_CCK_RATE_SECTION(rs)) continue; if (IS_VHT_RATE_SECTION(rs) && !IS_HARDWARE_TYPE_JAGUAR_ALL(adapter)) continue; target = phy_get_target_txpwr(adapter, band, path, rs); if (target % hal_spec->txgi_pdbm) { _RTW_PRINT_SEL(sel, "%7s: %2d.%d\n", rate_section_str(rs) , target / hal_spec->txgi_pdbm, (target % hal_spec->txgi_pdbm) * 100 / hal_spec->txgi_pdbm); } else { _RTW_PRINT_SEL(sel, "%7s: %5d\n", rate_section_str(rs) , target / hal_spec->txgi_pdbm); } } } } return; } 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; for (band = BAND_ON_2_4G; band <= BAND_ON_5G; band++) { if (!hal_is_band_support(adapter, band)) continue; for (path = 0; path < RF_PATH_MAX; path++) { if (!HAL_SPEC_CHK_RF_PATH(hal_spec, band, path)) break; RTW_PRINT_SEL(sel, "[%s][%c]%s\n", band_str(band), rf_path_char(path) , hal_data->txpwr_by_rate_undefined_band_path[band][path] ? "(dup)" : ""); for (rs = 0; rs < RATE_SECTION_NUM; rs++) { tx_num = rate_section_to_tx_num(rs); if (tx_num + 1 > hal_data->tx_nss) continue; if (band == BAND_ON_5G && IS_CCK_RATE_SECTION(rs)) continue; if (IS_VHT_RATE_SECTION(rs) && !IS_HARDWARE_TYPE_JAGUAR_ALL(adapter)) continue; if (IS_HARDWARE_TYPE_JAGUAR_ALL(adapter)) max_rate_num = 10; else max_rate_num = 8; rate_num = rate_section_rate_num(rs); RTW_PRINT_SEL(sel, "%7s: ", rate_section_str(rs)); /* dump power by rate in db */ for (n = rate_num - 1; n >= 0; n--) { by_rate = PHY_GetTxPowerByRate(adapter, band, path, rs, rates_by_sections[rs].rates[n]); if (by_rate % hal_spec->txgi_pdbm) { _RTW_PRINT_SEL(sel, "%2d.%d ", by_rate / hal_spec->txgi_pdbm , (by_rate % hal_spec->txgi_pdbm) * 100 / hal_spec->txgi_pdbm); } else _RTW_PRINT_SEL(sel, "%5d ", by_rate / hal_spec->txgi_pdbm); } for (n = 0; n < max_rate_num - rate_num; n++) _RTW_PRINT_SEL(sel, "%5s ", ""); _RTW_PRINT_SEL(sel, "|"); /* dump power by rate in offset */ for (n = rate_num - 1; n >= 0; n--) { by_rate = PHY_GetTxPowerByRate(adapter, band, path, rs, rates_by_sections[rs].rates[n]); base = phy_get_target_txpwr(adapter, band, path, rs); _RTW_PRINT_SEL(sel, "%3d ", by_rate - base); } RTW_PRINT_SEL(sel, "\n"); } } } } /* * phy file path is stored in global char array rtw_phy_para_file_path * need to care about racing */ int rtw_get_phy_file_path(_adapter *adapter, const char *file_name) { #ifdef CONFIG_LOAD_PHY_PARA_FROM_FILE struct hal_spec_t *hal_spec = GET_HAL_SPEC(adapter); int len = 0; if (file_name) { len += snprintf(rtw_phy_para_file_path, PATH_LENGTH_MAX, "%s", rtw_phy_file_path); #if defined(CONFIG_MULTIDRV) || defined(REALTEK_CONFIG_PATH_WITH_IC_NAME_FOLDER) len += snprintf(rtw_phy_para_file_path + len, PATH_LENGTH_MAX - len, "%s/", hal_spec->ic_name); #endif len += snprintf(rtw_phy_para_file_path + len, PATH_LENGTH_MAX - len, "%s", file_name); return _TRUE; } #endif return _FALSE; } #ifdef CONFIG_LOAD_PHY_PARA_FROM_FILE int phy_ConfigMACWithParaFile( PADAPTER Adapter, 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_get_phy_file_path(Adapter, pFileName); if (rtw_readable_file_sz_chk(rtw_phy_para_file_path, MAX_PARA_FILE_BUF_LEN) == _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 RTW_INFO("%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 RTW_INFO("%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 RTW_INFO("%s(): No File %s, Load from HWImg Array!\n", __FUNCTION__, pFileName); return rtStatus; } int phy_ConfigBBWithParaFile( PADAPTER Adapter, char *pFileName, 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: RTW_INFO("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_get_phy_file_path(Adapter, pFileName); if (rtw_readable_file_sz_chk(rtw_phy_para_file_path, MAX_PARA_FILE_BUF_LEN) == _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 RTW_INFO("%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 RTW_INFO("%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)) { /* RTW_INFO("[BB-ADDR]%03lX=%08lX\n", u4bRegOffset, u4bRegValue); */ phy_set_bb_reg(Adapter, u4bRegOffset, bMaskDWord, u4bRegValue); if (u4bRegOffset == 0xa24) pHalData->odmpriv.rf_calibrate_info.rega24 = u4bRegValue; /* Add 1us delay between BB/RF register setting. */ rtw_udelay_os(1); } } } } } else RTW_INFO("%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; /* RTW_INFO("=====>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)) { /* RTW_INFO("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; } /* RTW_INFO("Decrypted Line: %s\n", BufOfLines ); */ if (strlen(BufOfLines) != 0) i++; BufOfLines[strlen(BufOfLines)] = '\n'; } } #ifndef DBG_TXPWR_BY_RATE_FILE_PARSE #define DBG_TXPWR_BY_RATE_FILE_PARSE 0 #endif int phy_ParseBBPgParaFile( PADAPTER Adapter, char *buffer ) { int rtStatus = _FAIL; HAL_DATA_TYPE *pHalData = GET_HAL_DATA(Adapter); struct hal_spec_t *hal_spec = GET_HAL_SPEC(Adapter); char *szLine, *ptmp; u32 u4bRegOffset, u4bRegMask; u32 u4bMove; BOOLEAN firstLine = _TRUE; u8 tx_num = 0; u8 band = 0, rf_path = 0; if (Adapter->registrypriv.RegDecryptCustomFile == 1) phy_DecryptBBPgParaFile(Adapter, buffer); ptmp = buffer; for (szLine = GetLineFromBuffer(ptmp); szLine != NULL; szLine = GetLineFromBuffer(ptmp)) { if (isAllSpaceOrTab(szLine, sizeof(*szLine))) continue; if (!IsCommentString(szLine)) { /* Get header info (relative value or exact value) */ if (firstLine) { if (strncmp(szLine, "#[v1]", 5) == 0 || strncmp(szLine, "#[v2]", 5) == 0) pHalData->odmpriv.phy_reg_pg_version = szLine[3] - '0'; else { RTW_ERR("The format in PHY_REG_PG are invalid %s\n", szLine); goto exit; } if (strncmp(szLine + 5, "[Exact]#", 8) == 0) { pHalData->odmpriv.phy_reg_pg_value_type = PHY_REG_PG_EXACT_VALUE; firstLine = _FALSE; continue; } else { RTW_ERR("The values in PHY_REG_PG are invalid %s\n", szLine); goto exit; } } if (pHalData->odmpriv.phy_reg_pg_version > 0) { u32 index = 0; if (strncmp(szLine, "0xffff", 6) == 0) break; if (strncmp(szLine, "#[END]#", 7)) { /* load the table label info */ if (szLine[0] == '#') { index = 0; if (strncmp(szLine, "#[2.4G]", 7) == 0) { band = BAND_ON_2_4G; index += 8; } else if (strncmp(szLine, "#[5G]", 5) == 0) { band = BAND_ON_5G; index += 6; } else { RTW_ERR("Invalid band %s in PHY_REG_PG.txt\n", szLine); goto exit; } rf_path = szLine[index] - 'A'; if (DBG_TXPWR_BY_RATE_FILE_PARSE) RTW_INFO(" 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 { RTW_ERR("Invalid row in PHY_REG_PG.txt '%c'(%d)\n", szLine[1], szLine[1]); goto exit; } while (szLine[index] != ']') ++index; ++index;/* skip ] */ /* Get 2nd hex value as register offset. */ szLine += index; if (GetHexValueFromString(szLine, &u4bRegOffset, &u4bMove)) szLine += u4bMove; else goto exit; /* Get 2nd hex value as register mask. */ if (GetHexValueFromString(szLine, &u4bRegMask, &u4bMove)) szLine += u4bMove; else goto exit; if (pHalData->odmpriv.phy_reg_pg_value_type == PHY_REG_PG_EXACT_VALUE) { u32 combineValue = 0; u8 integer = 0, fraction = 0; if (GetFractionValueFromString(szLine, &integer, &fraction, &u4bMove)) szLine += u4bMove; else goto exit; integer *= hal_spec->txgi_pdbm; integer += ((u16)fraction * (u16)hal_spec->txgi_pdbm) / 100; if (pHalData->odmpriv.phy_reg_pg_version == 1) combineValue |= (((integer / 10) << 4) + (integer % 10)); else combineValue |= integer; if (GetFractionValueFromString(szLine, &integer, &fraction, &u4bMove)) szLine += u4bMove; else goto exit; integer *= hal_spec->txgi_pdbm; integer += ((u16)fraction * (u16)hal_spec->txgi_pdbm) / 100; combineValue <<= 8; if (pHalData->odmpriv.phy_reg_pg_version == 1) combineValue |= (((integer / 10) << 4) + (integer % 10)); else combineValue |= integer; if (GetFractionValueFromString(szLine, &integer, &fraction, &u4bMove)) szLine += u4bMove; else goto exit; integer *= hal_spec->txgi_pdbm; integer += ((u16)fraction * (u16)hal_spec->txgi_pdbm) / 100; combineValue <<= 8; if (pHalData->odmpriv.phy_reg_pg_version == 1) combineValue |= (((integer / 10) << 4) + (integer % 10)); else combineValue |= integer; if (GetFractionValueFromString(szLine, &integer, &fraction, &u4bMove)) szLine += u4bMove; else goto exit; integer *= hal_spec->txgi_pdbm; integer += ((u16)fraction * (u16)hal_spec->txgi_pdbm) / 100; combineValue <<= 8; if (pHalData->odmpriv.phy_reg_pg_version == 1) combineValue |= (((integer / 10) << 4) + (integer % 10)); else combineValue |= integer; phy_store_tx_power_by_rate(Adapter, band, rf_path, tx_num, u4bRegOffset, u4bRegMask, combineValue); if (DBG_TXPWR_BY_RATE_FILE_PARSE) RTW_INFO("addr:0x%3x mask:0x%08x %dTx = 0x%08x\n", u4bRegOffset, u4bRegMask, tx_num + 1, combineValue); } } } } } } rtStatus = _SUCCESS; exit: RTW_INFO("%s return %d\n", __func__, rtStatus); return rtStatus; } int phy_ConfigBBWithPgParaFile( PADAPTER Adapter, const 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 == NULL) { rtw_get_phy_file_path(Adapter, pFileName); if (rtw_readable_file_sz_chk(rtw_phy_para_file_path, MAX_PARA_FILE_BUF_LEN) == _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 RTW_INFO("%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 RTW_INFO("%s(): Critical Error !!!\n", __FUNCTION__); } if (rtStatus == _SUCCESS) { /* RTW_INFO("phy_ConfigBBWithPgParaFile(): read %s ok\n", pFileName); */ rtStatus = phy_ParseBBPgParaFile(Adapter, pHalData->para_file_buf); } else RTW_INFO("%s(): No File %s, Load from HWImg Array!\n", __FUNCTION__, pFileName); return rtStatus; } #if (MP_DRIVER == 1) int phy_ConfigBBWithMpParaFile( PADAPTER Adapter, 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_get_phy_file_path(Adapter, pFileName); if (rtw_readable_file_sz_chk(rtw_phy_para_file_path, MAX_PARA_FILE_BUF_LEN) == _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 RTW_INFO("%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 RTW_INFO("%s(): Critical Error !!!\n", __FUNCTION__); } if (rtStatus == _SUCCESS) { /* RTW_INFO("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)) { /* RTW_INFO("[ADDR]%03lX=%08lX\n", u4bRegOffset, u4bRegValue); */ phy_set_bb_reg(Adapter, u4bRegOffset, bMaskDWord, u4bRegValue); /* Add 1us delay between BB/RF register setting. */ rtw_udelay_os(1); } } } } } else RTW_INFO("%s(): No File %s, Load from HWImg Array!\n", __FUNCTION__, pFileName); return rtStatus; } #endif int PHY_ConfigRFWithParaFile( PADAPTER Adapter, char *pFileName, enum rf_path 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 RF_PATH_A: pBuf = pHalData->rf_radio_a; pBufLen = &pHalData->rf_radio_a_len; break; case RF_PATH_B: pBuf = pHalData->rf_radio_b; pBufLen = &pHalData->rf_radio_b_len; break; default: RTW_INFO("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_get_phy_file_path(Adapter, pFileName); if (rtw_readable_file_sz_chk(rtw_phy_para_file_path, MAX_PARA_FILE_BUF_LEN) == _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 RF_PATH_A: pHalData->rf_radio_a = pBuf; break; case RF_PATH_B: pHalData->rf_radio_b = pBuf; break; default: RTW_INFO("Unknown RF path!! %d\r\n", eRFPath); break; } } else RTW_INFO("%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 RTW_INFO("%s(): Critical Error !!!\n", __FUNCTION__); } if (rtStatus == _SUCCESS) { /* RTW_INFO("%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_set_rf_reg(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 RTW_INFO("%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) \ do { \ for (token = strsep(&Data, delim); token != NULL; token = strsep(&Data, delim)) {\ sscanf(token, "%d", &idx);\ _array[_iteratedIdx++] = (u8)idx;\ } } while (0)\ HAL_DATA_TYPE *pHalData = GET_HAL_DATA(Adapter); struct dm_struct *pDM_Odm = &pHalData->odmpriv; struct dm_rf_calibration_struct *pRFCalibrateInfo = &(pDM_Odm->rf_calibrate_info); u32 j = 0; char *token; char delim[] = ","; u32 idx = 0; /* RTW_INFO("===>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->delta_swing_table_idx_2g_cck_a_p, j); else if (STR_EQUAL_2G("2G", "A", "-", "CCK")) STORE_SWING_TABLE(pRFCalibrateInfo->delta_swing_table_idx_2g_cck_a_n, j); else if (STR_EQUAL_2G("2G", "B", "+", "CCK")) STORE_SWING_TABLE(pRFCalibrateInfo->delta_swing_table_idx_2g_cck_b_p, j); else if (STR_EQUAL_2G("2G", "B", "-", "CCK")) STORE_SWING_TABLE(pRFCalibrateInfo->delta_swing_table_idx_2g_cck_b_n, j); else if (STR_EQUAL_2G("2G", "A", "+", "ALL")) STORE_SWING_TABLE(pRFCalibrateInfo->delta_swing_table_idx_2ga_p, j); else if (STR_EQUAL_2G("2G", "A", "-", "ALL")) STORE_SWING_TABLE(pRFCalibrateInfo->delta_swing_table_idx_2ga_n, j); else if (STR_EQUAL_2G("2G", "B", "+", "ALL")) STORE_SWING_TABLE(pRFCalibrateInfo->delta_swing_table_idx_2gb_p, j); else if (STR_EQUAL_2G("2G", "B", "-", "ALL")) STORE_SWING_TABLE(pRFCalibrateInfo->delta_swing_table_idx_2gb_n, j); else if (STR_EQUAL_5G("5G", "A", "+", "ALL", "0")) STORE_SWING_TABLE(pRFCalibrateInfo->delta_swing_table_idx_5ga_p[0], j); else if (STR_EQUAL_5G("5G", "A", "-", "ALL", "0")) STORE_SWING_TABLE(pRFCalibrateInfo->delta_swing_table_idx_5ga_n[0], j); else if (STR_EQUAL_5G("5G", "B", "+", "ALL", "0")) STORE_SWING_TABLE(pRFCalibrateInfo->delta_swing_table_idx_5gb_p[0], j); else if (STR_EQUAL_5G("5G", "B", "-", "ALL", "0")) STORE_SWING_TABLE(pRFCalibrateInfo->delta_swing_table_idx_5gb_n[0], j); else if (STR_EQUAL_5G("5G", "A", "+", "ALL", "1")) STORE_SWING_TABLE(pRFCalibrateInfo->delta_swing_table_idx_5ga_p[1], j); else if (STR_EQUAL_5G("5G", "A", "-", "ALL", "1")) STORE_SWING_TABLE(pRFCalibrateInfo->delta_swing_table_idx_5ga_n[1], j); else if (STR_EQUAL_5G("5G", "B", "+", "ALL", "1")) STORE_SWING_TABLE(pRFCalibrateInfo->delta_swing_table_idx_5gb_p[1], j); else if (STR_EQUAL_5G("5G", "B", "-", "ALL", "1")) STORE_SWING_TABLE(pRFCalibrateInfo->delta_swing_table_idx_5gb_n[1], j); else if (STR_EQUAL_5G("5G", "A", "+", "ALL", "2")) STORE_SWING_TABLE(pRFCalibrateInfo->delta_swing_table_idx_5ga_p[2], j); else if (STR_EQUAL_5G("5G", "A", "-", "ALL", "2")) STORE_SWING_TABLE(pRFCalibrateInfo->delta_swing_table_idx_5ga_n[2], j); else if (STR_EQUAL_5G("5G", "B", "+", "ALL", "2")) STORE_SWING_TABLE(pRFCalibrateInfo->delta_swing_table_idx_5gb_p[2], j); else if (STR_EQUAL_5G("5G", "B", "-", "ALL", "2")) STORE_SWING_TABLE(pRFCalibrateInfo->delta_swing_table_idx_5gb_n[2], j); else if (STR_EQUAL_5G("5G", "A", "+", "ALL", "3")) STORE_SWING_TABLE(pRFCalibrateInfo->delta_swing_table_idx_5ga_p[3], j); else if (STR_EQUAL_5G("5G", "A", "-", "ALL", "3")) STORE_SWING_TABLE(pRFCalibrateInfo->delta_swing_table_idx_5ga_n[3], j); else if (STR_EQUAL_5G("5G", "B", "+", "ALL", "3")) STORE_SWING_TABLE(pRFCalibrateInfo->delta_swing_table_idx_5gb_p[3], j); else if (STR_EQUAL_5G("5G", "B", "-", "ALL", "3")) STORE_SWING_TABLE(pRFCalibrateInfo->delta_swing_table_idx_5gb_n[3], j); else RTW_INFO("===>initDeltaSwingIndexTables(): The input is invalid!!\n"); } int PHY_ConfigRFWithTxPwrTrackParaFile( PADAPTER Adapter, char *pFileName ) { HAL_DATA_TYPE *pHalData = GET_HAL_DATA(Adapter); struct dm_struct *pDM_Odm = &pHalData->odmpriv; int rlen = 0, rtStatus = _FAIL; char *szLine, *ptmp; u32 i = 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_get_phy_file_path(Adapter, pFileName); if (rtw_readable_file_sz_chk(rtw_phy_para_file_path, MAX_PARA_FILE_BUF_LEN) == _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 RTW_INFO("%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 RTW_INFO("%s(): Critical Error !!!\n", __FUNCTION__); } if (rtStatus == _SUCCESS) { /* RTW_INFO("%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, '[', ']')) { /* RTW_INFO("Fail to parse rate!\n"); */ } if (!ParseQualifiedString(szLine, &i, chnl, '[', ']')) { /* RTW_INFO("Fail to parse channel group!\n"); */ } while (szLine[i] != '{' && i < strlen(szLine)) i++; if (!ParseQualifiedString(szLine, &i, data, '{', '}')) { /* RTW_INFO("Fail to parse data!\n"); */ } initDeltaSwingIndexTables(Adapter, band, path, sign, chnl, rate, data); } } } else RTW_INFO("%s(): No File %s, Load from HWImg Array!\n", __FUNCTION__, pFileName); #if 0 for (i = 0; i < DELTA_SWINGIDX_SIZE; ++i) { RTW_INFO("pRFCalibrateInfo->delta_swing_table_idx_2ga_p[%d] = %d\n", i, pRFCalibrateInfo->delta_swing_table_idx_2ga_p[i]); RTW_INFO("pRFCalibrateInfo->delta_swing_table_idx_2ga_n[%d] = %d\n", i, pRFCalibrateInfo->delta_swing_table_idx_2ga_n[i]); RTW_INFO("pRFCalibrateInfo->delta_swing_table_idx_2gb_p[%d] = %d\n", i, pRFCalibrateInfo->delta_swing_table_idx_2gb_p[i]); RTW_INFO("pRFCalibrateInfo->delta_swing_table_idx_2gb_n[%d] = %d\n", i, pRFCalibrateInfo->delta_swing_table_idx_2gb_n[i]); RTW_INFO("pRFCalibrateInfo->delta_swing_table_idx_2g_cck_a_p[%d] = %d\n", i, pRFCalibrateInfo->delta_swing_table_idx_2g_cck_a_p[i]); RTW_INFO("pRFCalibrateInfo->delta_swing_table_idx_2g_cck_a_n[%d] = %d\n", i, pRFCalibrateInfo->delta_swing_table_idx_2g_cck_a_n[i]); RTW_INFO("pRFCalibrateInfo->delta_swing_table_idx_2g_cck_b_p[%d] = %d\n", i, pRFCalibrateInfo->delta_swing_table_idx_2g_cck_b_p[i]); RTW_INFO("pRFCalibrateInfo->delta_swing_table_idx_2g_cck_b_n[%d] = %d\n", i, pRFCalibrateInfo->delta_swing_table_idx_2g_cck_b_n[i]); for (j = 0; j < 3; ++j) { RTW_INFO("pRFCalibrateInfo->delta_swing_table_idx_5ga_p[%d][%d] = %d\n", j, i, pRFCalibrateInfo->delta_swing_table_idx_5ga_p[j][i]); RTW_INFO("pRFCalibrateInfo->delta_swing_table_idx_5ga_n[%d][%d] = %d\n", j, i, pRFCalibrateInfo->delta_swing_table_idx_5ga_n[j][i]); RTW_INFO("pRFCalibrateInfo->delta_swing_table_idx_5gb_p[%d][%d] = %d\n", j, i, pRFCalibrateInfo->delta_swing_table_idx_5gb_p[j][i]); RTW_INFO("pRFCalibrateInfo->delta_swing_table_idx_5gb_n[%d][%d] = %d\n", j, i, pRFCalibrateInfo->delta_swing_table_idx_5gb_n[j][i]); } } #endif return rtStatus; } #if CONFIG_TXPWR_LIMIT #ifndef DBG_TXPWR_LMT_FILE_PARSE #define DBG_TXPWR_LMT_FILE_PARSE 0 #endif #define PARSE_RET_NO_HDL 0 #define PARSE_RET_SUCCESS 1 #define PARSE_RET_FAIL 2 /* * @@Ver=2.0 * or * @@DomainCode=0x28, Regulation=C6 * or * @@CountryCode=GB, Regulation=C7 */ static u8 parse_reg_exc_config(_adapter *adapter, char *szLine) { #define VER_PREFIX "Ver=" #define DOMAIN_PREFIX "DomainCode=0x" #define COUNTRY_PREFIX "CountryCode=" #define REG_PREFIX "Regulation=" const u8 ver_prefix_len = strlen(VER_PREFIX); const u8 domain_prefix_len = strlen(DOMAIN_PREFIX); const u8 country_prefix_len = strlen(COUNTRY_PREFIX); const u8 reg_prefix_len = strlen(REG_PREFIX); u32 i, i_val_s, i_val_e; u32 j; u8 domain = 0xFF; char *country = NULL; u8 parse_reg = 0; if (szLine[0] != '@' || szLine[1] != '@') return PARSE_RET_NO_HDL; i = 2; if (strncmp(szLine + i, VER_PREFIX, ver_prefix_len) == 0) ; /* nothing to do */ else if (strncmp(szLine + i, DOMAIN_PREFIX, domain_prefix_len) == 0) { /* get string after domain prefix to ',' */ i += domain_prefix_len; i_val_s = i; while (szLine[i] != ',') { if (szLine[i] == '\0') return PARSE_RET_FAIL; i++; } i_val_e = i; /* check if all hex */ for (j = i_val_s; j < i_val_e; j++) if (IsHexDigit(szLine[j]) == _FALSE) return PARSE_RET_FAIL; /* get value from hex string */ if (sscanf(szLine + i_val_s, "%hhx", &domain) != 1) return PARSE_RET_FAIL; parse_reg = 1; } else if (strncmp(szLine + i, COUNTRY_PREFIX, country_prefix_len) == 0) { /* get string after country prefix to ',' */ i += country_prefix_len; i_val_s = i; while (szLine[i] != ',') { if (szLine[i] == '\0') return PARSE_RET_FAIL; i++; } i_val_e = i; if (i_val_e - i_val_s != 2) return PARSE_RET_FAIL; /* check if all alpha */ for (j = i_val_s; j < i_val_e; j++) if (is_alpha(szLine[j]) == _FALSE) return PARSE_RET_FAIL; country = szLine + i_val_s; parse_reg = 1; } else return PARSE_RET_FAIL; if (parse_reg) { /* move to 'R' */ while (szLine[i] != 'R') { if (szLine[i] == '\0') return PARSE_RET_FAIL; i++; } /* check if matching regulation prefix */ if (strncmp(szLine + i, REG_PREFIX, reg_prefix_len) != 0) return PARSE_RET_FAIL; /* get string after regulation prefix ending with space */ i += reg_prefix_len; i_val_s = i; while (szLine[i] != ' ' && szLine[i] != '\t' && szLine[i] != '\0') i++; if (i == i_val_s) return PARSE_RET_FAIL; rtw_regd_exc_add_with_nlen(adapter_to_rfctl(adapter), country, domain, szLine + i_val_s, i - i_val_s); } return PARSE_RET_SUCCESS; } static int phy_ParsePowerLimitTableFile( PADAPTER Adapter, char *buffer ) { #define LD_STAGE_EXC_MAPPING 0 #define LD_STAGE_TAB_DEFINE 1 #define LD_STAGE_TAB_START 2 #define LD_STAGE_COLUMN_DEFINE 3 #define LD_STAGE_CH_ROW 4 int rtStatus = _FAIL; HAL_DATA_TYPE *pHalData = GET_HAL_DATA(Adapter); struct hal_spec_t *hal_spec = GET_HAL_SPEC(Adapter); struct dm_struct *pDM_Odm = &(pHalData->odmpriv); u8 loadingStage = LD_STAGE_EXC_MAPPING; u32 i = 0, forCnt = 0; char *szLine, *ptmp; char band[10], bandwidth[10], rateSection[10], ntx[10], colNumBuf[10]; char **regulation = NULL; u8 colNum = 0; if (Adapter->registrypriv.RegDecryptCustomFile == 1) phy_DecryptBBPgParaFile(Adapter, buffer); ptmp = buffer; for (szLine = GetLineFromBuffer(ptmp); szLine != NULL; szLine = GetLineFromBuffer(ptmp)) { if (isAllSpaceOrTab(szLine, sizeof(*szLine))) continue; if (IsCommentString(szLine)) continue; if (loadingStage == LD_STAGE_EXC_MAPPING) { if (szLine[0] == '#' || szLine[1] == '#') { loadingStage = LD_STAGE_TAB_DEFINE; if (DBG_TXPWR_LMT_FILE_PARSE) dump_regd_exc_list(RTW_DBGDUMP, adapter_to_rfctl(Adapter)); } else { if (parse_reg_exc_config(Adapter, szLine) == PARSE_RET_FAIL) { RTW_ERR("Fail to parse regulation exception ruls!\n"); goto exit; } continue; } } if (loadingStage == LD_STAGE_TAB_DEFINE) { /* read "## 2.4G, 20M, 1T, CCK" */ 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 */ _rtw_memset((void *) band, 0, 10); _rtw_memset((void *) bandwidth, 0, 10); _rtw_memset((void *) ntx, 0, 10); _rtw_memset((void *) rateSection, 0, 10); if (!ParseQualifiedString(szLine, &i, band, ' ', ',')) { RTW_ERR("Fail to parse band!\n"); goto exit; } if (!ParseQualifiedString(szLine, &i, bandwidth, ' ', ',')) { RTW_ERR("Fail to parse bandwidth!\n"); goto exit; } if (!ParseQualifiedString(szLine, &i, ntx, ' ', ',')) { RTW_ERR("Fail to parse ntx!\n"); goto exit; } if (!ParseQualifiedString(szLine, &i, rateSection, ' ', ',')) { RTW_ERR("Fail to parse rate!\n"); goto exit; } loadingStage = LD_STAGE_TAB_START; } else if (loadingStage == LD_STAGE_TAB_START) { /* read "## START" */ if (szLine[0] != '#' || szLine[1] != '#') continue; /* skip the space */ i = 2; while (szLine[i] == ' ' || szLine[i] == '\t') ++i; if (strncmp((u8 *)(szLine + i), "START", 5)) { RTW_ERR("Missing \"## START\" label\n"); goto exit; } loadingStage = LD_STAGE_COLUMN_DEFINE; } else if (loadingStage == LD_STAGE_COLUMN_DEFINE) { /* read "## #5# FCC ETSI MKK IC KCC" */ if (szLine[0] != '#' || szLine[1] != '#') continue; /* skip the space */ i = 2; while (szLine[i] == ' ' || szLine[i] == '\t') ++i; _rtw_memset((void *) colNumBuf, 0, 10); if (!ParseQualifiedString(szLine, &i, colNumBuf, '#', '#')) { RTW_ERR("Fail to parse column number!\n"); goto exit; } if (!GetU1ByteIntegerFromStringInDecimal(colNumBuf, &colNum)) { RTW_ERR("Column number \"%s\" is not unsigned decimal\n", colNumBuf); goto exit; } if (colNum == 0) { RTW_ERR("Column number is 0\n"); goto exit; } if (DBG_TXPWR_LMT_FILE_PARSE) RTW_PRINT("[%s][%s][%s][%s] column num:%d\n", band, bandwidth, rateSection, ntx, colNum); regulation = (char **)rtw_zmalloc(sizeof(char *) * colNum); if (!regulation) { RTW_ERR("Regulation alloc fail\n"); goto exit; } for (forCnt = 0; forCnt < colNum; ++forCnt) { u32 i_ns; /* skip the space */ while (szLine[i] == ' ' || szLine[i] == '\t') i++; i_ns = i; while (szLine[i] != ' ' && szLine[i] != '\t' && szLine[i] != '\0') i++; regulation[forCnt] = (char *)rtw_malloc(i - i_ns + 1); if (!regulation[forCnt]) { RTW_ERR("Regulation alloc fail\n"); goto exit; } _rtw_memcpy(regulation[forCnt], szLine + i_ns, i - i_ns); regulation[forCnt][i - i_ns] = '\0'; } if (DBG_TXPWR_LMT_FILE_PARSE) { RTW_PRINT("column name:"); for (forCnt = 0; forCnt < colNum; ++forCnt) _RTW_PRINT(" %s", regulation[forCnt]); _RTW_PRINT("\n"); } loadingStage = LD_STAGE_CH_ROW; } else if (loadingStage == LD_STAGE_CH_ROW) { 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 (strncmp((u8 *)(szLine + i), "END", 3) == 0) { loadingStage = LD_STAGE_TAB_DEFINE; if (regulation) { for (forCnt = 0; forCnt < colNum; ++forCnt) { if (regulation[forCnt]) { rtw_mfree(regulation[forCnt], strlen(regulation[forCnt]) + 1); regulation[forCnt] = NULL; } } rtw_mfree((u8 *)regulation, sizeof(char *) * colNum); regulation = NULL; } colNum = 0; continue; } else { RTW_ERR("Missing \"## END\" label\n"); goto exit; } } if ((szLine[0] != 'c' && szLine[0] != 'C') || (szLine[1] != 'h' && szLine[1] != 'H') ) { RTW_WARN("Wrong channel prefix: '%c','%c'(%d,%d)\n", szLine[0], szLine[1], szLine[0], szLine[1]); 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; } /* RTW_INFO("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 */ _rtw_memset((void *) powerLimit, 0, 10); if (szLine[i] == 'W' && szLine[i + 1] == 'W') { /* * case "WW" assign special ww value * means to get minimal limit in other regulations at same channel */ s8 ww_value = phy_txpwr_ww_lmt_value(Adapter); sprintf(powerLimit, "%d", ww_value); i += 2; } else if (szLine[i] == 'N' && szLine[i + 1] == 'A') { /* * case "NA" assign max txgi value * means no limitation */ sprintf(powerLimit, "%d", hal_spec->txgi_max); i += 2; } else if ((szLine[i] >= '0' && szLine[i] <= '9') || szLine[i] == '.' || szLine[i] == '+' || szLine[i] == '-' ){ /* case of dBm value */ u8 integer = 0, fraction = 0, negative = 0; u32 u4bMove; s8 lmt = 0; if (szLine[i] == '+' || szLine[i] == '-') { if (szLine[i] == '-') negative = 1; i++; } if (GetFractionValueFromString(&szLine[i], &integer, &fraction, &u4bMove)) i += u4bMove; else { RTW_ERR("Limit \"%s\" is not valid decimal\n", &szLine[i]); goto exit; } /* transform to string of value in unit of txgi */ lmt = integer * hal_spec->txgi_pdbm + ((u16)fraction * (u16)hal_spec->txgi_pdbm) / 100; if (negative) lmt = -lmt; sprintf(powerLimit, "%d", lmt); } else { RTW_ERR("Wrong limit expression \"%c%c\"(%d, %d)\n" , szLine[i], szLine[i + 1], szLine[i], szLine[i + 1]); goto exit; } /* store the power limit value */ phy_set_tx_power_limit(pDM_Odm, (u8 *)regulation[forCnt], (u8 *)band, (u8 *)bandwidth, (u8 *)rateSection, (u8 *)ntx, (u8 *)channel, (u8 *)powerLimit); } } } rtStatus = _SUCCESS; exit: if (regulation) { for (forCnt = 0; forCnt < colNum; ++forCnt) { if (regulation[forCnt]) { rtw_mfree(regulation[forCnt], strlen(regulation[forCnt]) + 1); regulation[forCnt] = NULL; } } rtw_mfree((u8 *)regulation, sizeof(char *) * colNum); regulation = NULL; } RTW_INFO("%s return %d\n", __func__, rtStatus); return rtStatus; } int PHY_ConfigRFWithPowerLimitTableParaFile( PADAPTER Adapter, const 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 == NULL) { rtw_get_phy_file_path(Adapter, pFileName); if (rtw_readable_file_sz_chk(rtw_phy_para_file_path, MAX_PARA_FILE_BUF_LEN) == _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 RTW_INFO("%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 RTW_INFO("%s(): Critical Error !!!\n", __FUNCTION__); } if (rtStatus == _SUCCESS) { /* RTW_INFO("%s(): read %s ok\n", __FUNCTION__, pFileName); */ rtStatus = phy_ParsePowerLimitTableFile(Adapter, pHalData->para_file_buf); } else RTW_INFO("%s(): No File %s, Load from HWImg Array!\n", __FUNCTION__, pFileName); return rtStatus; } #endif /* CONFIG_TXPWR_LIMIT */ void phy_free_filebuf_mask(_adapter *padapter, u8 mask) { HAL_DATA_TYPE *pHalData = GET_HAL_DATA(padapter); if (pHalData->mac_reg && (mask & LOAD_MAC_PARA_FILE)) { rtw_vmfree(pHalData->mac_reg, pHalData->mac_reg_len); pHalData->mac_reg = NULL; } if (mask & LOAD_BB_PARA_FILE) { if (pHalData->bb_phy_reg) { rtw_vmfree(pHalData->bb_phy_reg, pHalData->bb_phy_reg_len); pHalData->bb_phy_reg = NULL; } if (pHalData->bb_agc_tab) { rtw_vmfree(pHalData->bb_agc_tab, pHalData->bb_agc_tab_len); pHalData->bb_agc_tab = NULL; } } if (pHalData->bb_phy_reg_pg && (mask & LOAD_BB_PG_PARA_FILE)) { rtw_vmfree(pHalData->bb_phy_reg_pg, pHalData->bb_phy_reg_pg_len); pHalData->bb_phy_reg_pg = NULL; } if (pHalData->bb_phy_reg_mp && (mask & LOAD_BB_MP_PARA_FILE)) { rtw_vmfree(pHalData->bb_phy_reg_mp, pHalData->bb_phy_reg_mp_len); pHalData->bb_phy_reg_mp = NULL; } if (mask & LOAD_RF_PARA_FILE) { if (pHalData->rf_radio_a) { rtw_vmfree(pHalData->rf_radio_a, pHalData->rf_radio_a_len); pHalData->rf_radio_a = NULL; } if (pHalData->rf_radio_b) { rtw_vmfree(pHalData->rf_radio_b, pHalData->rf_radio_b_len); pHalData->rf_radio_b = NULL; } } if (pHalData->rf_tx_pwr_track && (mask & LOAD_RF_TXPWR_TRACK_PARA_FILE)) { rtw_vmfree(pHalData->rf_tx_pwr_track, pHalData->rf_tx_pwr_track_len); pHalData->rf_tx_pwr_track = NULL; } if (pHalData->rf_tx_pwr_lmt && (mask & LOAD_RF_TXPWR_LMT_PARA_FILE)) { rtw_vmfree(pHalData->rf_tx_pwr_lmt, pHalData->rf_tx_pwr_lmt_len); pHalData->rf_tx_pwr_lmt = NULL; } } inline void phy_free_filebuf(_adapter *padapter) { phy_free_filebuf_mask(padapter, 0xFF); } #endif /* * check if user specified mbm is valid */ bool phy_is_txpwr_user_mbm_valid(_adapter *adapter, s16 mbm) { struct hal_spec_t *hal_spec = GET_HAL_SPEC(adapter); /* 1T upper bound check */ if (hal_spec->txgi_max <= mbm * hal_spec->txgi_pdbm / MBM_PDBM) return 0; return 1; } bool phy_is_txpwr_user_target_specified(_adapter *adapter) { s16 total_mbm = UNSPECIFIED_MBM; #ifdef CONFIG_IOCTL_CFG80211 total_mbm = rtw_cfg80211_dev_get_total_txpwr_target_mbm(adapter_to_dvobj(adapter)); #endif return total_mbm != UNSPECIFIED_MBM; } /* * Return value in unit of TX Gain Index * hal_spec.txgi_max means unspecified */ s8 phy_get_txpwr_user_target(_adapter *adapter, struct hal_spec_t *hal_spec, u8 ntx_idx) { s16 total_mbm = UNSPECIFIED_MBM; s8 target; #ifdef CONFIG_IOCTL_CFG80211 total_mbm = rtw_cfg80211_dev_get_total_txpwr_target_mbm(adapter_to_dvobj(adapter)); #endif if (total_mbm != UNSPECIFIED_MBM) target = (total_mbm - mb_of_ntx(ntx_idx + 1)) * hal_spec->txgi_pdbm / MBM_PDBM; else target = hal_spec->txgi_max; return target; } /* * Return value in unit of TX Gain Index * hal_spec.txgi_max means unspecified */ s8 phy_get_txpwr_user_lmt(_adapter *adapter, struct hal_spec_t *hal_spec, u8 ntx_idx) { s16 total_mbm = UNSPECIFIED_MBM; s8 lmt; #ifdef CONFIG_IOCTL_CFG80211 total_mbm = rtw_cfg80211_dev_get_total_txpwr_lmt_mbm(adapter_to_dvobj(adapter)); #endif if (total_mbm != UNSPECIFIED_MBM) lmt = (total_mbm - mb_of_ntx(ntx_idx + 1)) * hal_spec->txgi_pdbm / MBM_PDBM; else lmt = hal_spec->txgi_max; return lmt; } /* * Return value in unit of TX Gain Index */ s8 phy_get_txpwr_target(_adapter *adapter, u8 rfpath, RATE_SECTION rs, u8 rate, u8 ntx_idx , enum channel_width bw, BAND_TYPE band, u8 cch, u8 opch, struct txpwr_idx_comp *tic) { HAL_DATA_TYPE *hal_data = GET_HAL_DATA(adapter); struct hal_spec_t *hal_spec = GET_HAL_SPEC(adapter); s8 target, by_rate = 0, btc_diff = 0, extra = 0; s8 lmt, utgt, ulmt; lmt = utgt = ulmt = hal_spec->txgi_max; if (band != BAND_ON_2_4G && IS_CCK_RATE(rate)) goto exit; utgt = phy_get_txpwr_user_target(adapter, hal_spec, ntx_idx); if (utgt != hal_spec->txgi_max) goto get_lmt; #ifdef CONFIG_RTL8812A if (IS_HARDWARE_TYPE_8812(adapter) && phy_get_txpwr_target_skip_by_rate_8812a(adapter, rate)) by_rate = phy_get_target_txpwr(adapter, band, rfpath, rs); else #endif by_rate = PHY_GetTxPowerByRate(adapter, band, rfpath, rs, rate); if (by_rate == hal_spec->txgi_max) by_rate = 0; #ifdef CONFIG_BT_COEXIST if (hal_data->EEPROMBluetoothCoexist == _TRUE) btc_diff = -(rtw_btcoex_query_reduced_wl_pwr_lvl(adapter) * hal_spec->txgi_pdbm); #endif extra = rtw_hal_get_txpwr_target_extra_bias(adapter, rfpath, rs, rate, bw, band, cch); get_lmt: lmt = phy_get_txpwr_lmt_sub_chs(adapter, NULL, band, bw, rfpath, rate, ntx_idx, cch, opch); ulmt = phy_get_txpwr_user_lmt(adapter, hal_spec, ntx_idx); /* TODO: limit from outer source, ex: 11d */ exit: if (utgt != hal_spec->txgi_max) target = utgt; else target = by_rate + btc_diff + extra; if (target > lmt) target = lmt; if (target > ulmt) target = ulmt; if (tic) { tic->target = target; if (utgt == hal_spec->txgi_max) { tic->by_rate = by_rate; tic->btc = btc_diff; tic->extra = extra; } tic->utarget = utgt; tic->limit = lmt; tic->ulimit = ulmt; } return target; } /* TODO: common dpd_diff getting API from phydm */ #ifdef CONFIG_RTL8822C #include "./rtl8822c/rtl8822c.h" #endif /* * Return in unit of TX Gain Index */ s8 phy_get_txpwr_amends(_adapter *adapter, u8 rfpath, RATE_SECTION rs, u8 rate, u8 ntx_idx , enum channel_width bw, BAND_TYPE band, u8 cch, struct txpwr_idx_comp *tic) { struct hal_spec_t *hal_spec = GET_HAL_SPEC(adapter); s8 tpt_diff = 0, dpd_diff = 0, val = 0; if (band != BAND_ON_2_4G && IS_CCK_RATE(rate)) goto exit; if (IS_HARDWARE_TYPE_8188E(adapter) || IS_HARDWARE_TYPE_8188F(adapter) || IS_HARDWARE_TYPE_8188GTV(adapter) || IS_HARDWARE_TYPE_8192E(adapter) || IS_HARDWARE_TYPE_8192F(adapter) || IS_HARDWARE_TYPE_8723B(adapter) || IS_HARDWARE_TYPE_8703B(adapter) || IS_HARDWARE_TYPE_8723D(adapter) || IS_HARDWARE_TYPE_8710B(adapter) || IS_HARDWARE_TYPE_8821(adapter) || IS_HARDWARE_TYPE_8812(adapter) ) tpt_diff = PHY_GetTxPowerTrackingOffset(adapter, rfpath, rate); #ifdef CONFIG_RTL8822C if (IS_HARDWARE_TYPE_8822C(adapter)) dpd_diff = -(rtl8822c_get_dis_dpd_by_rate_diff(adapter, rate) * hal_spec->txgi_pdbm); #endif exit: if (tic) { tic->tpt = tpt_diff; tic->dpd = dpd_diff; } return tpt_diff + dpd_diff; } #ifdef CONFIG_TXPWR_PG_WITH_TSSI_OFFSET s8 phy_get_tssi_txpwr_by_rate_ref(_adapter *adapter, enum rf_path path , enum channel_width bw, u8 cch, u8 opch) { HAL_DATA_TYPE *hal_data = GET_HAL_DATA(adapter); u8 ntx_idx = phy_get_current_tx_num(adapter, MGN_MCS7); BAND_TYPE band = cch > 14 ? BAND_ON_5G : BAND_ON_2_4G; s8 pwr_idx; pwr_idx = phy_get_txpwr_target(adapter, path, HT_1SS, MGN_MCS7 , ntx_idx, bw, band, cch, opch, NULL); pwr_idx += phy_get_txpwr_amends(adapter, path, HT_1SS, MGN_MCS7 , ntx_idx, bw, band, cch, NULL); return pwr_idx; } #endif /* * Rteurn tx power index for rate */ u8 hal_com_get_txpwr_idx(_adapter *adapter, enum rf_path rfpath , RATE_SECTION rs, enum MGN_RATE rate, enum channel_width bw, BAND_TYPE band, u8 cch, u8 opch , struct txpwr_idx_comp *tic) { PHAL_DATA_TYPE hal = GET_HAL_DATA(adapter); struct hal_spec_t *hal_spec = GET_HAL_SPEC(adapter); s16 power_idx = 0; s8 base = 0; s8 rate_target, rate_amends; u8 ntx_idx = phy_get_current_tx_num(adapter, rate); /* target */ rate_target = phy_get_txpwr_target(adapter, rfpath, rs, rate, ntx_idx, bw, band, cch, opch, tic); /* amends */ rate_amends = phy_get_txpwr_amends(adapter, rfpath, rs, rate, ntx_idx, bw, band, cch, tic); switch (hal->txpwr_pg_mode) { #ifdef CONFIG_TXPWR_PG_WITH_PWR_IDX case TXPWR_PG_WITH_PWR_IDX: { /* * power index = * 1. pg base (per rate section) + * 2. target diff (per rate) to target of its rate section + * 3. amends diff (per rate) */ u8 rs_target; base = phy_get_pg_txpwr_idx(adapter, rfpath, rs, ntx_idx, bw, band, cch); rs_target = phy_get_target_txpwr(adapter, band, rfpath, rs); power_idx = base + (rate_target - rs_target) + (rate_amends); if (tic) { if (tic->utarget == hal_spec->txgi_max) tic->by_rate -= rs_target; else tic->utarget -= rs_target; if (tic->limit != hal_spec->txgi_max) tic->limit -= rs_target; if (tic->ulimit != hal_spec->txgi_max) tic->ulimit -= rs_target; } } break; #endif #ifdef CONFIG_TXPWR_PG_WITH_TSSI_OFFSET case TXPWR_PG_WITH_TSSI_OFFSET: { /* * power index = * 1. base (fixed) + * 2. target (per rate) + * 3. amends diff (per rate) * base is selected that power index of MCS7 == halrf_get_tssi_codeword_for_txindex() */ s8 mcs7_idx; mcs7_idx = phy_get_tssi_txpwr_by_rate_ref(adapter, rfpath, bw, cch, opch); base = halrf_get_tssi_codeword_for_txindex(adapter_to_phydm(adapter)) - mcs7_idx; power_idx = base + rate_target + rate_amends; } break; #endif } if (tic) { tic->ntx_idx = ntx_idx; tic->base = base; } if (power_idx < 0) power_idx = 0; else if (power_idx > hal_spec->txgi_max) power_idx = hal_spec->txgi_max; #if defined(CONFIG_RTL8821A) || defined(CONFIG_RTL8812A) if ((IS_HARDWARE_TYPE_8821(adapter) || IS_HARDWARE_TYPE_8812(adapter)) && power_idx % 2 == 1 && !IS_NORMAL_CHIP(hal->version_id)) --power_idx; #endif return power_idx; } /* get txpowr in mBm for single path */ s16 phy_get_txpwr_single_mbm(_adapter *adapter, u8 rfpath, RATE_SECTION rs, u8 rate , enum channel_width bw, u8 cch, u8 opch, struct txpwr_idx_comp *tic) { struct hal_spec_t *hal_spec = GET_HAL_SPEC(adapter); BAND_TYPE band = cch <= 14 ? BAND_ON_2_4G : BAND_ON_5G; u8 ntx_idx = phy_get_current_tx_num(adapter, rate); s16 val; val = phy_get_txpwr_target(adapter, rfpath, rs, rate, ntx_idx, bw, band, cch, opch, tic); val = (val * MBM_PDBM) / hal_spec->txgi_pdbm; if (tic) tic->ntx_idx = ntx_idx; return val; } /* get txpowr in mBm with effect of N-TX */ s16 phy_get_txpwr_total_mbm(_adapter *adapter, RATE_SECTION rs, u8 rate , enum channel_width bw, u8 cch, u8 opch, struct txpwr_idx_comp *tic) { s16 val; u8 tx_num = phy_get_current_tx_num(adapter, rate) + 1; /* assume all path have same txpower target */ val = phy_get_txpwr_single_mbm(adapter, RF_PATH_A, rs, rate, bw, cch, opch, tic); val += mb_of_ntx(tx_num); return val; } static s16 _phy_get_txpwr_max_mbm(_adapter *adapter, s8 rfpath , enum channel_width bw, u8 cch, u8 opch, u16 bmp_cck_ofdm, u32 bmp_ht, u64 bmp_vht) { struct hal_spec_t *hal_spec = GET_HAL_SPEC(adapter); HAL_DATA_TYPE *hal_data = GET_HAL_DATA(adapter); BAND_TYPE band = cch <= 14 ? BAND_ON_2_4G : BAND_ON_5G; u8 tx_num; RATE_SECTION rs; u8 hw_rate; int i; s16 max = UNSPECIFIED_MBM, mbm; if (0) RTW_INFO("cck_ofdm:0x%04x, ht:0x%08x, vht:0x%016llx\n", bmp_cck_ofdm, bmp_ht, bmp_vht); for (rs = 0; rs < RATE_SECTION_NUM; rs++) { tx_num = rate_section_to_tx_num(rs); if (tx_num + 1 > hal_data->tx_nss) continue; if (band == BAND_ON_5G && IS_CCK_RATE_SECTION(rs)) continue; if (IS_VHT_RATE_SECTION(rs) && !IS_HARDWARE_TYPE_JAGUAR_ALL(adapter)) continue; for (i = 0; i < rates_by_sections[rs].rate_num; i++) { hw_rate = MRateToHwRate(rates_by_sections[rs].rates[i]); if (IS_LEGACY_HRATE(hw_rate)) { if (!(bmp_cck_ofdm & BIT(hw_rate))) continue; } else if (IS_HT_HRATE(hw_rate)) { if (!(bmp_ht & BIT(hw_rate - DESC_RATEMCS0))) continue; } else if (IS_VHT_HRATE(hw_rate)) { if (!(bmp_vht & BIT(hw_rate - DESC_RATEVHTSS1MCS0))) continue; } if (rfpath < 0) /* total */ mbm = phy_get_txpwr_total_mbm(adapter, rs, rates_by_sections[rs].rates[i], bw, cch, opch, NULL); else mbm = phy_get_txpwr_single_mbm(adapter, rfpath, rs, rates_by_sections[rs].rates[i], bw, cch, opch, NULL); if (max == UNSPECIFIED_MBM || mbm > max) max = mbm; } } return max; } s16 phy_get_txpwr_single_max_mbm(_adapter *adapter, u8 rfpath , enum channel_width bw, u8 cch, u8 opch, u16 bmp_cck_ofdm, u32 bmp_ht, u64 bmp_vht) { return _phy_get_txpwr_max_mbm(adapter, rfpath, bw, cch, opch, bmp_cck_ofdm, bmp_ht, bmp_vht); } s16 phy_get_txpwr_total_max_mbm(_adapter *adapter , enum channel_width bw, u8 cch, u8 opch, u16 bmp_cck_ofdm, u32 bmp_ht, u64 bmp_vht) { return _phy_get_txpwr_max_mbm(adapter, -1, bw, cch, opch, bmp_cck_ofdm, bmp_ht, bmp_vht); } s8 phy_get_tx_power_final_absolute_value(_adapter *adapter, u8 rfpath, u8 rate, enum channel_width bw, u8 cch) { struct hal_spec_t *hal_spec = GET_HAL_SPEC(adapter); RATE_SECTION rs = mgn_rate_to_rs(rate); BAND_TYPE band = cch <= 14 ? BAND_ON_2_4G : BAND_ON_5G; s8 val; val = phy_get_txpwr_target(adapter, rfpath , rs, rate, phy_get_current_tx_num(adapter, rate), bw, band, cch, 0, NULL); val /= hal_spec->txgi_pdbm; return val; }