Path: blob/master/ALFA-W1F1/RTL8814AU/hal/hal_com_phycfg.c
1307 views
/******************************************************************************1*2* Copyright(c) 2007 - 2017 Realtek Corporation.3*4* This program is free software; you can redistribute it and/or modify it5* under the terms of version 2 of the GNU General Public License as6* published by the Free Software Foundation.7*8* This program is distributed in the hope that it will be useful, but WITHOUT9* ANY WARRANTY; without even the implied warranty of MERCHANTABILITY or10* FITNESS FOR A PARTICULAR PURPOSE. See the GNU General Public License for11* more details.12*13*****************************************************************************/14#define _HAL_COM_PHYCFG_C_1516#include <drv_types.h>17#include <hal_data.h>1819#define PG_TXPWR_1PATH_BYTE_NUM_2G 1820#define PG_TXPWR_BASE_BYTE_NUM_2G 112122#define PG_TXPWR_1PATH_BYTE_NUM_5G 2423#define PG_TXPWR_BASE_BYTE_NUM_5G 142425#define PG_TXPWR_MSB_DIFF_S4BIT(_pg_v) (((_pg_v) & 0xf0) >> 4)26#define PG_TXPWR_LSB_DIFF_S4BIT(_pg_v) ((_pg_v) & 0x0f)27#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))28#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))29#define IS_PG_TXPWR_BASE_INVALID(hal_spec, _base) ((_base) > hal_spec->txgi_max)30#define IS_PG_TXPWR_DIFF_INVALID(_diff) ((_diff) > 7 || (_diff) < -8)31#define PG_TXPWR_INVALID_BASE 25532#define PG_TXPWR_INVALID_DIFF 83334#if !IS_PG_TXPWR_DIFF_INVALID(PG_TXPWR_INVALID_DIFF)35#error "PG_TXPWR_DIFF definition has problem"36#endif3738#define PG_TXPWR_SRC_PG_DATA 039#define PG_TXPWR_SRC_IC_DEF 140#define PG_TXPWR_SRC_DEF 241#define PG_TXPWR_SRC_NUM 34243const char *const _pg_txpwr_src_str[] = {44"PG_DATA",45"IC_DEF",46"DEF",47"UNKNOWN"48};4950#define pg_txpwr_src_str(src) (((src) >= PG_TXPWR_SRC_NUM) ? _pg_txpwr_src_str[PG_TXPWR_SRC_NUM] : _pg_txpwr_src_str[(src)])5152#ifndef CONFIG_USE_TSSI53typedef struct _TxPowerInfo24G {54u8 IndexCCK_Base[MAX_RF_PATH][MAX_CHNL_GROUP_24G];55u8 IndexBW40_Base[MAX_RF_PATH][MAX_CHNL_GROUP_24G];56/* If only one tx, only BW20 and OFDM are used. */57s8 CCK_Diff[MAX_RF_PATH][MAX_TX_COUNT];58s8 OFDM_Diff[MAX_RF_PATH][MAX_TX_COUNT];59s8 BW20_Diff[MAX_RF_PATH][MAX_TX_COUNT];60s8 BW40_Diff[MAX_RF_PATH][MAX_TX_COUNT];61} TxPowerInfo24G;6263typedef struct _TxPowerInfo5G {64u8 IndexBW40_Base[MAX_RF_PATH][MAX_CHNL_GROUP_5G];65/* If only one tx, only BW20, OFDM, BW80 and BW160 are used. */66s8 OFDM_Diff[MAX_RF_PATH][MAX_TX_COUNT];67s8 BW20_Diff[MAX_RF_PATH][MAX_TX_COUNT];68s8 BW40_Diff[MAX_RF_PATH][MAX_TX_COUNT];69s8 BW80_Diff[MAX_RF_PATH][MAX_TX_COUNT];70s8 BW160_Diff[MAX_RF_PATH][MAX_TX_COUNT];71} TxPowerInfo5G;7273#ifndef DBG_PG_TXPWR_READ74#define DBG_PG_TXPWR_READ 075#endif7677#if DBG_PG_TXPWR_READ78static void dump_pg_txpwr_info_2g(void *sel, TxPowerInfo24G *txpwr_info, u8 rfpath_num, u8 max_tx_cnt)79{80int path, group, tx_idx;8182RTW_PRINT_SEL(sel, "2.4G\n");83RTW_PRINT_SEL(sel, "CCK-1T base:\n");84RTW_PRINT_SEL(sel, "%4s ", "");85for (group = 0; group < MAX_CHNL_GROUP_24G; group++)86_RTW_PRINT_SEL(sel, "G%02d ", group);87_RTW_PRINT_SEL(sel, "\n");88for (path = 0; path < MAX_RF_PATH && path < rfpath_num; path++) {89RTW_PRINT_SEL(sel, "[%c]: ", rf_path_char(path));90for (group = 0; group < MAX_CHNL_GROUP_24G; group++)91_RTW_PRINT_SEL(sel, "%3u ", txpwr_info->IndexCCK_Base[path][group]);92_RTW_PRINT_SEL(sel, "\n");93}94RTW_PRINT_SEL(sel, "\n");9596RTW_PRINT_SEL(sel, "CCK diff:\n");97RTW_PRINT_SEL(sel, "%4s ", "");98for (path = 0; path < MAX_RF_PATH && path < rfpath_num; path++)99_RTW_PRINT_SEL(sel, "%dT ", path + 1);100_RTW_PRINT_SEL(sel, "\n");101for (path = 0; path < MAX_RF_PATH && path < rfpath_num; path++) {102RTW_PRINT_SEL(sel, "[%c]: ", rf_path_char(path));103for (tx_idx = RF_1TX; tx_idx < MAX_TX_COUNT && tx_idx < max_tx_cnt; tx_idx++)104_RTW_PRINT_SEL(sel, "%2d ", txpwr_info->CCK_Diff[path][tx_idx]);105_RTW_PRINT_SEL(sel, "\n");106}107RTW_PRINT_SEL(sel, "\n");108109RTW_PRINT_SEL(sel, "BW40-1S base:\n");110RTW_PRINT_SEL(sel, "%4s ", "");111for (group = 0; group < MAX_CHNL_GROUP_24G - 1; group++)112_RTW_PRINT_SEL(sel, "G%02d ", group);113_RTW_PRINT_SEL(sel, "\n");114for (path = 0; path < MAX_RF_PATH && path < rfpath_num; path++) {115RTW_PRINT_SEL(sel, "[%c]: ", rf_path_char(path));116for (group = 0; group < MAX_CHNL_GROUP_24G - 1; group++)117_RTW_PRINT_SEL(sel, "%3u ", txpwr_info->IndexBW40_Base[path][group]);118_RTW_PRINT_SEL(sel, "\n");119}120RTW_PRINT_SEL(sel, "\n");121122RTW_PRINT_SEL(sel, "OFDM diff:\n");123RTW_PRINT_SEL(sel, "%4s ", "");124for (path = 0; path < MAX_RF_PATH && path < rfpath_num; path++)125_RTW_PRINT_SEL(sel, "%dT ", path + 1);126_RTW_PRINT_SEL(sel, "\n");127for (path = 0; path < MAX_RF_PATH && path < rfpath_num; path++) {128RTW_PRINT_SEL(sel, "[%c]: ", rf_path_char(path));129for (tx_idx = RF_1TX; tx_idx < MAX_TX_COUNT && tx_idx < max_tx_cnt; tx_idx++)130_RTW_PRINT_SEL(sel, "%2d ", txpwr_info->OFDM_Diff[path][tx_idx]);131_RTW_PRINT_SEL(sel, "\n");132}133RTW_PRINT_SEL(sel, "\n");134135RTW_PRINT_SEL(sel, "BW20 diff:\n");136RTW_PRINT_SEL(sel, "%4s ", "");137for (path = 0; path < MAX_RF_PATH && path < rfpath_num; path++)138_RTW_PRINT_SEL(sel, "%dS ", path + 1);139_RTW_PRINT_SEL(sel, "\n");140for (path = 0; path < MAX_RF_PATH && path < rfpath_num; path++) {141RTW_PRINT_SEL(sel, "[%c]: ", rf_path_char(path));142for (tx_idx = RF_1TX; tx_idx < MAX_TX_COUNT && tx_idx < max_tx_cnt; tx_idx++)143_RTW_PRINT_SEL(sel, "%2d ", txpwr_info->BW20_Diff[path][tx_idx]);144_RTW_PRINT_SEL(sel, "\n");145}146RTW_PRINT_SEL(sel, "\n");147148RTW_PRINT_SEL(sel, "BW40 diff:\n");149RTW_PRINT_SEL(sel, "%4s ", "");150for (path = 0; path < MAX_RF_PATH && path < rfpath_num; path++)151_RTW_PRINT_SEL(sel, "%dS ", path + 1);152_RTW_PRINT_SEL(sel, "\n");153for (path = 0; path < MAX_RF_PATH && path < rfpath_num; path++) {154RTW_PRINT_SEL(sel, "[%c]: ", rf_path_char(path));155for (tx_idx = RF_1TX; tx_idx < MAX_TX_COUNT && tx_idx < max_tx_cnt; tx_idx++)156_RTW_PRINT_SEL(sel, "%2d ", txpwr_info->BW40_Diff[path][tx_idx]);157_RTW_PRINT_SEL(sel, "\n");158}159RTW_PRINT_SEL(sel, "\n");160}161162static void dump_pg_txpwr_info_5g(void *sel, TxPowerInfo5G *txpwr_info, u8 rfpath_num, u8 max_tx_cnt)163{164int path, group, tx_idx;165166RTW_PRINT_SEL(sel, "5G\n");167RTW_PRINT_SEL(sel, "BW40-1S base:\n");168RTW_PRINT_SEL(sel, "%4s ", "");169for (group = 0; group < MAX_CHNL_GROUP_5G; group++)170_RTW_PRINT_SEL(sel, "G%02d ", group);171_RTW_PRINT_SEL(sel, "\n");172for (path = 0; path < MAX_RF_PATH && path < rfpath_num; path++) {173RTW_PRINT_SEL(sel, "[%c]: ", rf_path_char(path));174for (group = 0; group < MAX_CHNL_GROUP_5G; group++)175_RTW_PRINT_SEL(sel, "%3u ", txpwr_info->IndexBW40_Base[path][group]);176_RTW_PRINT_SEL(sel, "\n");177}178RTW_PRINT_SEL(sel, "\n");179180RTW_PRINT_SEL(sel, "OFDM diff:\n");181RTW_PRINT_SEL(sel, "%4s ", "");182for (path = 0; path < MAX_RF_PATH && path < rfpath_num; path++)183_RTW_PRINT_SEL(sel, "%dT ", path + 1);184_RTW_PRINT_SEL(sel, "\n");185for (path = 0; path < MAX_RF_PATH && path < rfpath_num; path++) {186RTW_PRINT_SEL(sel, "[%c]: ", rf_path_char(path));187for (tx_idx = RF_1TX; tx_idx < MAX_TX_COUNT && tx_idx < max_tx_cnt; tx_idx++)188_RTW_PRINT_SEL(sel, "%2d ", txpwr_info->OFDM_Diff[path][tx_idx]);189_RTW_PRINT_SEL(sel, "\n");190}191RTW_PRINT_SEL(sel, "\n");192193RTW_PRINT_SEL(sel, "BW20 diff:\n");194RTW_PRINT_SEL(sel, "%4s ", "");195for (path = 0; path < MAX_RF_PATH && path < rfpath_num; path++)196_RTW_PRINT_SEL(sel, "%dS ", path + 1);197_RTW_PRINT_SEL(sel, "\n");198for (path = 0; path < MAX_RF_PATH && path < rfpath_num; path++) {199RTW_PRINT_SEL(sel, "[%c]: ", rf_path_char(path));200for (tx_idx = RF_1TX; tx_idx < MAX_TX_COUNT && tx_idx < max_tx_cnt; tx_idx++)201_RTW_PRINT_SEL(sel, "%2d ", txpwr_info->BW20_Diff[path][tx_idx]);202_RTW_PRINT_SEL(sel, "\n");203}204RTW_PRINT_SEL(sel, "\n");205206RTW_PRINT_SEL(sel, "BW40 diff:\n");207RTW_PRINT_SEL(sel, "%4s ", "");208for (path = 0; path < MAX_RF_PATH && path < rfpath_num; path++)209_RTW_PRINT_SEL(sel, "%dS ", path + 1);210_RTW_PRINT_SEL(sel, "\n");211for (path = 0; path < MAX_RF_PATH && path < rfpath_num; path++) {212RTW_PRINT_SEL(sel, "[%c]: ", rf_path_char(path));213for (tx_idx = RF_1TX; tx_idx < MAX_TX_COUNT && tx_idx < max_tx_cnt; tx_idx++)214_RTW_PRINT_SEL(sel, "%2d ", txpwr_info->BW40_Diff[path][tx_idx]);215_RTW_PRINT_SEL(sel, "\n");216}217RTW_PRINT_SEL(sel, "\n");218219RTW_PRINT_SEL(sel, "BW80 diff:\n");220RTW_PRINT_SEL(sel, "%4s ", "");221for (path = 0; path < MAX_RF_PATH && path < rfpath_num; path++)222_RTW_PRINT_SEL(sel, "%dS ", path + 1);223_RTW_PRINT_SEL(sel, "\n");224for (path = 0; path < MAX_RF_PATH && path < rfpath_num; path++) {225RTW_PRINT_SEL(sel, "[%c]: ", rf_path_char(path));226for (tx_idx = RF_1TX; tx_idx < MAX_TX_COUNT && tx_idx < max_tx_cnt; tx_idx++)227_RTW_PRINT_SEL(sel, "%2d ", txpwr_info->BW80_Diff[path][tx_idx]);228_RTW_PRINT_SEL(sel, "\n");229}230RTW_PRINT_SEL(sel, "\n");231232RTW_PRINT_SEL(sel, "BW160 diff:\n");233RTW_PRINT_SEL(sel, "%4s ", "");234for (path = 0; path < MAX_RF_PATH && path < rfpath_num; path++)235_RTW_PRINT_SEL(sel, "%dS ", path + 1);236_RTW_PRINT_SEL(sel, "\n");237for (path = 0; path < MAX_RF_PATH && path < rfpath_num; path++) {238RTW_PRINT_SEL(sel, "[%c]: ", rf_path_char(path));239for (tx_idx = RF_1TX; tx_idx < MAX_TX_COUNT && tx_idx < max_tx_cnt; tx_idx++)240_RTW_PRINT_SEL(sel, "%2d ", txpwr_info->BW160_Diff[path][tx_idx]);241_RTW_PRINT_SEL(sel, "\n");242}243RTW_PRINT_SEL(sel, "\n");244}245#endif /* DBG_PG_TXPWR_READ */246247const struct map_t pg_txpwr_def_info =248MAP_ENT(0xB8, 1, 0xFF249, MAPSEG_ARRAY_ENT(0x10, 168,2500x2D, 0x2D, 0x2D, 0x2D, 0x2D, 0x2D, 0x2D, 0x2D, 0x2D, 0x2D, 0x2D, 0x24, 0xEE, 0xEE, 0xEE, 0xEE,2510xEE, 0xEE, 0x2A, 0x2A, 0x2A, 0x2A, 0x2A, 0x2A, 0x2A, 0x2A, 0x2A, 0x2A, 0x2A, 0x2A, 0x2A, 0x2A,2520x04, 0xEE, 0xEE, 0xEE, 0xEE, 0xEE, 0xEE, 0xEE, 0xEE, 0xEE, 0x2D, 0x2D, 0x2D, 0x2D, 0x2D, 0x2D,2530x2D, 0x2D, 0x2D, 0x2D, 0x2D, 0x24, 0xEE, 0xEE, 0xEE, 0xEE, 0xEE, 0xEE, 0x2A, 0x2A, 0x2A, 0x2A,2540x2A, 0x2A, 0x2A, 0x2A, 0x2A, 0x2A, 0x2A, 0x2A, 0x2A, 0x2A, 0x04, 0xEE, 0xEE, 0xEE, 0xEE, 0xEE,2550xEE, 0xEE, 0xEE, 0xEE, 0x2D, 0x2D, 0x2D, 0x2D, 0x2D, 0x2D, 0x2D, 0x2D, 0x2D, 0x2D, 0x2D, 0x24,2560xEE, 0xEE, 0xEE, 0xEE, 0xEE, 0xEE, 0x2A, 0x2A, 0x2A, 0x2A, 0x2A, 0x2A, 0x2A, 0x2A, 0x2A, 0x2A,2570x2A, 0x2A, 0x2A, 0x2A, 0x04, 0xEE, 0xEE, 0xEE, 0xEE, 0xEE, 0xEE, 0xEE, 0xEE, 0xEE, 0x2D, 0x2D,2580x2D, 0x2D, 0x2D, 0x2D, 0x2D, 0x2D, 0x2D, 0x2D, 0x2D, 0x24, 0xEE, 0xEE, 0xEE, 0xEE, 0xEE, 0xEE,2590x2A, 0x2A, 0x2A, 0x2A, 0x2A, 0x2A, 0x2A, 0x2A, 0x2A, 0x2A, 0x2A, 0x2A, 0x2A, 0x2A, 0x04, 0xEE,2600xEE, 0xEE, 0xEE, 0xEE, 0xEE, 0xEE, 0xEE, 0xEE)261);262263#ifdef CONFIG_RTL8188E264static const struct map_t rtl8188e_pg_txpwr_def_info =265MAP_ENT(0xB8, 1, 0xFF266, MAPSEG_ARRAY_ENT(0x10, 12,2670x2D, 0x2D, 0x2D, 0x2D, 0x2D, 0x2D, 0x2D, 0x2D, 0x2D, 0x2D, 0x2D, 0x24)268);269#endif270271#ifdef CONFIG_RTL8188F272static const struct map_t rtl8188f_pg_txpwr_def_info =273MAP_ENT(0xB8, 1, 0xFF274, MAPSEG_ARRAY_ENT(0x10, 12,2750x22, 0x22, 0x22, 0x22, 0x22, 0x22, 0x27, 0x27, 0x27, 0x27, 0x27, 0x24)276);277#endif278279#ifdef CONFIG_RTL8188GTV280static const struct map_t rtl8188gtv_pg_txpwr_def_info =281MAP_ENT(0xB8, 1, 0xFF282, MAPSEG_ARRAY_ENT(0x10, 12,2830x22, 0x22, 0x22, 0x22, 0x22, 0x22, 0x27, 0x27, 0x27, 0x27, 0x27, 0x24)284);285#endif286287#ifdef CONFIG_RTL8723B288static const struct map_t rtl8723b_pg_txpwr_def_info =289MAP_ENT(0xB8, 2, 0xFF290, MAPSEG_ARRAY_ENT(0x10, 12,2910x2D, 0x2D, 0x2D, 0x2D, 0x2D, 0x2D, 0x2D, 0x2D, 0x2D, 0x2D, 0x2D, 0xE0)292, MAPSEG_ARRAY_ENT(0x3A, 12,2930x2D, 0x2D, 0x2D, 0x2D, 0x2D, 0x2D, 0x2D, 0x2D, 0x2D, 0x2D, 0x2D, 0xE0)294);295#endif296297#ifdef CONFIG_RTL8703B298static const struct map_t rtl8703b_pg_txpwr_def_info =299MAP_ENT(0xB8, 1, 0xFF300, MAPSEG_ARRAY_ENT(0x10, 12,3010x2D, 0x2D, 0x2D, 0x2D, 0x2D, 0x2D, 0x2D, 0x2D, 0x2D, 0x2D, 0x2D, 0x02)302);303#endif304305#ifdef CONFIG_RTL8723D306static const struct map_t rtl8723d_pg_txpwr_def_info =307MAP_ENT(0xB8, 2, 0xFF308, MAPSEG_ARRAY_ENT(0x10, 12,3090x2D, 0x2D, 0x2D, 0x2D, 0x2D, 0x2D, 0x2D, 0x2D, 0x2D, 0x2D, 0x2D, 0x02)310, MAPSEG_ARRAY_ENT(0x3A, 12,3110x22, 0x22, 0x22, 0x22, 0x22, 0x22, 0x21, 0x21, 0x21, 0x21, 0x21, 0x02)312);313#endif314315#ifdef CONFIG_RTL8192E316static const struct map_t rtl8192e_pg_txpwr_def_info =317MAP_ENT(0xB8, 2, 0xFF318, MAPSEG_ARRAY_ENT(0x10, 14,3190x2D, 0x2D, 0x2D, 0x2D, 0x2D, 0x2D, 0x2D, 0x2D, 0x2D, 0x2D, 0x2D, 0x24, 0xEE, 0xEE)320, MAPSEG_ARRAY_ENT(0x3A, 14,3210x2D, 0x2D, 0x2D, 0x2D, 0x2D, 0x2D, 0x2D, 0x2D, 0x2D, 0x2D, 0x2D, 0x24, 0xEE, 0xEE)322);323#endif324325#ifdef CONFIG_RTL8821A326static const struct map_t rtl8821a_pg_txpwr_def_info =327MAP_ENT(0xB8, 1, 0xFF328, MAPSEG_ARRAY_ENT(0x10, 39,3290x2D, 0x2D, 0x2D, 0x2D, 0x2D, 0x2D, 0x2D, 0x2D, 0x2D, 0x2D, 0x2D, 0x24, 0xFF, 0xFF, 0xFF, 0xFF,3300xFF, 0xFF, 0x2A, 0x2A, 0x2A, 0x2A, 0x2A, 0x2A, 0x2A, 0x2A, 0x2A, 0x2A, 0x2A, 0x2A, 0x2A, 0x2A,3310x04, 0xFF, 0xFF, 0xFF, 0xFF, 0xFF, 0x00)332);333#endif334335#ifdef CONFIG_RTL8821C336static const struct map_t rtl8821c_pg_txpwr_def_info =337MAP_ENT(0xB8, 1, 0xFF338, MAPSEG_ARRAY_ENT(0x10, 54,3390x2D, 0x2D, 0x2D, 0x2D, 0x2D, 0x2D, 0x2D, 0x2D, 0x2D, 0x2D, 0x2D, 0x02, 0xFF, 0xFF, 0xFF, 0xFF,3400xFF, 0xFF, 0x28, 0x28, 0x28, 0x28, 0x28, 0x28, 0x28, 0x28, 0x28, 0x28, 0x28, 0x28, 0x28, 0x28,3410x02, 0xFF, 0xFF, 0xFF, 0xFF, 0xFF, 0xEC, 0xFF, 0xFF, 0xFF, 0x2D, 0x2D, 0x2D, 0x2D, 0x2D, 0x2D,3420x2D, 0x2D, 0x2D, 0x2D, 0x2D, 0x02)343);344#endif345346#ifdef CONFIG_RTL8710B347static const struct map_t rtl8710b_pg_txpwr_def_info =348MAP_ENT(0xC8, 1, 0xFF349, MAPSEG_ARRAY_ENT(0x20, 12,3500x2D, 0x2D, 0x2D, 0x2D, 0x2D, 0x2D, 0x2D, 0x2D, 0x2D, 0x2D, 0x2D, 0x20)351);352#endif353354#ifdef CONFIG_RTL8812A355static const struct map_t rtl8812a_pg_txpwr_def_info =356MAP_ENT(0xB8, 1, 0xFF357, MAPSEG_ARRAY_ENT(0x10, 82,3580x2D, 0x2D, 0x2D, 0x2D, 0x2D, 0x2D, 0x2D, 0x2D, 0x2D, 0x2D, 0x2D, 0x02, 0xEE, 0xEE, 0xFF, 0xFF,3590xFF, 0xFF, 0x2A, 0x2A, 0x2A, 0x2A, 0x2A, 0x2A, 0x2A, 0x2A, 0x2A, 0x2A, 0x2A, 0x2A, 0x2A, 0x2A,3600x02, 0xEE, 0xFF, 0xFF, 0xEE, 0xFF, 0x00, 0xEE, 0xFF, 0xFF, 0x2D, 0x2D, 0x2D, 0x2D, 0x2D, 0x2D,3610x2D, 0x2D, 0x2D, 0x2D, 0x2D, 0x02, 0xEE, 0xEE, 0xFF, 0xFF, 0xFF, 0xFF, 0x2A, 0x2A, 0x2A, 0x2A,3620x2A, 0x2A, 0x2A, 0x2A, 0x2A, 0x2A, 0x2A, 0x2A, 0x2A, 0x2A, 0x02, 0xEE, 0xFF, 0xFF, 0xEE, 0xFF,3630x00, 0xEE)364);365#endif366367#ifdef CONFIG_RTL8822B368static const struct map_t rtl8822b_pg_txpwr_def_info =369MAP_ENT(0xB8, 1, 0xFF370, MAPSEG_ARRAY_ENT(0x10, 82,3710x2D, 0x2D, 0x2D, 0x2D, 0x2D, 0x2D, 0x2D, 0x2D, 0x2D, 0x2D, 0x2D, 0x02, 0xEE, 0xEE, 0xFF, 0xFF,3720xFF, 0xFF, 0x2A, 0x2A, 0x2A, 0x2A, 0x2A, 0x2A, 0x2A, 0x2A, 0x2A, 0x2A, 0x2A, 0x2A, 0x2A, 0x2A,3730x02, 0xEE, 0xFF, 0xFF, 0xEE, 0xFF, 0xEC, 0xEC, 0xFF, 0xFF, 0x2D, 0x2D, 0x2D, 0x2D, 0x2D, 0x2D,3740x2D, 0x2D, 0x2D, 0x2D, 0x2D, 0x02, 0xEE, 0xEE, 0xFF, 0xFF, 0xFF, 0xFF, 0x2A, 0x2A, 0x2A, 0x2A,3750x2A, 0x2A, 0x2A, 0x2A, 0x2A, 0x2A, 0x2A, 0x2A, 0x2A, 0x2A, 0x02, 0xEE, 0xFF, 0xFF, 0xEE, 0xFF,3760xEC, 0xEC)377);378#endif379380#ifdef CONFIG_RTL8822C381static const struct map_t rtl8822c_pg_txpwr_def_info =382MAP_ENT(0xB8, 1, 0xFF383, MAPSEG_ARRAY_ENT(0x10, 82,3840x33, 0x33, 0x33, 0x33, 0x33, 0x33, 0x33, 0x33, 0x33, 0x33, 0x33, 0x02, 0x00, 0x00, 0xFF, 0xFF,3850xFF, 0xFF, 0x33, 0x33, 0x33, 0x33, 0x33, 0x33, 0x33, 0x33, 0x33, 0x33, 0x33, 0x33, 0x33, 0x33,3860x02, 0x00, 0xFF, 0xFF, 0x00, 0xFF, 0x00, 0x00, 0xFF, 0xFF, 0x33, 0x33, 0x33, 0x33, 0x33, 0x33,3870x33, 0x33, 0x33, 0x33, 0x33, 0x02, 0x00, 0x00, 0xFF, 0xFF, 0xFF, 0xFF, 0x33, 0x33, 0x33, 0x33,3880x33, 0x33, 0x33, 0x33, 0x33, 0x33, 0x33, 0x33, 0x33, 0x33, 0x02, 0x00, 0xFF, 0xFF, 0x00, 0xFF,3890x00, 0x00)390);391#endif392393#ifdef CONFIG_RTL8814A394static const struct map_t rtl8814a_pg_txpwr_def_info =395MAP_ENT(0xB8, 1, 0xFF396, MAPSEG_ARRAY_ENT(0x10, 168,3970x2D, 0x2D, 0x2D, 0x2D, 0x2D, 0x2D, 0x2D, 0x2D, 0x2D, 0x2D, 0x2D, 0x02, 0xEE, 0xEE, 0xEE, 0xEE,3980xEE, 0xEE, 0x2A, 0x2A, 0x2A, 0x2A, 0x2A, 0x2A, 0x2A, 0x2A, 0x2A, 0x2A, 0x2A, 0x2A, 0x2A, 0x2A,3990x02, 0xEE, 0xEE, 0xEE, 0xEE, 0xEE, 0x00, 0xEE, 0xEE, 0xEE, 0x2D, 0x2D, 0x2D, 0x2D, 0x2D, 0x2D,4000x2D, 0x2D, 0x2D, 0x2D, 0x2D, 0x02, 0xEE, 0xEE, 0xEE, 0xEE, 0xEE, 0xEE, 0x2A, 0x2A, 0x2A, 0x2A,4010x2A, 0x2A, 0x2A, 0x2A, 0x2A, 0x2A, 0x2A, 0x2A, 0x2A, 0x2A, 0x02, 0xEE, 0xEE, 0xEE, 0xEE, 0xEE,4020x00, 0xEE, 0xEE, 0xEE, 0x2D, 0x2D, 0x2D, 0x2D, 0x2D, 0x2D, 0x2D, 0x2D, 0x2D, 0x2D, 0x2D, 0x02,4030xEE, 0xEE, 0xEE, 0xEE, 0xEE, 0xEE, 0x2A, 0x2A, 0x2A, 0x2A, 0x2A, 0x2A, 0x2A, 0x2A, 0x2A, 0x2A,4040x2A, 0x2A, 0x2A, 0x2A, 0x02, 0xEE, 0xEE, 0xEE, 0xEE, 0xEE, 0x00, 0xEE, 0xEE, 0xEE, 0x2D, 0x2D,4050x2D, 0x2D, 0x2D, 0x2D, 0x2D, 0x2D, 0x2D, 0x2D, 0x2D, 0x02, 0xEE, 0xEE, 0xEE, 0xEE, 0xEE, 0xEE,4060x2A, 0x2A, 0x2A, 0x2A, 0x2A, 0x2A, 0x2A, 0x2A, 0x2A, 0x2A, 0x2A, 0x2A, 0x2A, 0x2A, 0x02, 0xEE,4070xEE, 0xEE, 0xEE, 0xEE, 0x00, 0xEE, 0xEE, 0xEE)408);409#endif410411#ifdef CONFIG_RTL8192F/*use 8192F default,no document*/412static const struct map_t rtl8192f_pg_txpwr_def_info =413MAP_ENT(0xB8, 2, 0xFF414, MAPSEG_ARRAY_ENT(0x10, 14,4150x2D, 0x2D, 0x2D, 0x2D, 0x2D, 0x2D, 0x2D, 0x2D, 0x2D, 0x2D, 0x2D, 0x24, 0xEE, 0xEE)416, MAPSEG_ARRAY_ENT(0x3A, 14,4170x2D, 0x2D, 0x2D, 0x2D, 0x2D, 0x2D, 0x2D, 0x2D, 0x2D, 0x2D, 0x2D, 0x24, 0xEE, 0xEE)418);419#endif420421#ifdef CONFIG_RTL8814B422static const struct map_t rtl8814b_pg_txpwr_def_info =423MAP_ENT(0xB8, 1, 0xFF424, MAPSEG_ARRAY_ENT(0x10, 168,4250x28, 0x28, 0x28, 0x28, 0x28, 0x28, 0x28, 0x28, 0x28, 0x28, 0x28, 0x02, 0xFF, 0xFF, 0xFF, 0xFF,4260xFF, 0xFF, 0x28, 0x28, 0x28, 0x28, 0x28, 0x28, 0x28, 0x28, 0x28, 0x28, 0x28, 0x28, 0x28, 0x28,4270x02, 0xFF, 0xFF, 0xFF, 0xFF, 0xFF, 0xEC, 0xFF, 0xFF, 0xFF, 0x28, 0x28, 0x28, 0x28, 0x28, 0x28,4280x28, 0x28, 0x28, 0x28, 0x28, 0x02, 0xFF, 0xFF, 0xFF, 0xFF, 0xFF, 0xFF, 0xFF, 0xFF, 0xFF, 0xFF,4290xFF, 0xFF, 0xFF, 0xFF, 0xFF, 0xFF, 0xFF, 0xFF, 0xFF, 0xFF, 0xFF, 0xFF, 0xFF, 0xFF, 0xFF, 0xFF,4300xFF, 0xFF, 0xFF, 0xFF, 0xFF, 0xFF, 0xFF, 0xFF, 0xFF, 0xFF, 0xFF, 0xFF, 0xFF, 0xFF, 0xFF, 0xFF,4310xFF, 0xFF, 0xFF, 0xFF, 0xFF, 0xFF, 0xFF, 0xFF, 0xFF, 0xFF, 0xFF, 0xFF, 0xFF, 0xFF, 0xFF, 0xFF,4320xFF, 0xFF, 0xFF, 0xFF, 0xFF, 0xFF, 0xFF, 0xFF, 0xFF, 0xFF, 0xFF, 0xFF, 0xFF, 0xFF, 0xFF, 0xFF,4330xFF, 0xFF, 0xFF, 0xFF, 0xFF, 0xFF, 0xFF, 0xFF, 0xFF, 0xFF, 0xFF, 0xFF, 0xFF, 0xFF, 0xFF, 0xFF,4340xFF, 0xFF, 0xFF, 0xFF, 0xFF, 0xFF, 0xFF, 0xFF, 0xFF, 0xFF, 0xFF, 0xFF, 0xFF, 0xFF, 0xFF, 0xFF,4350xFF, 0xFF, 0xFF, 0xFF, 0xFF, 0xFF, 0xFF, 0xFF)436);437#endif438439const struct map_t *hal_pg_txpwr_def_info(_adapter *adapter)440{441u8 interface_type = 0;442const struct map_t *map = NULL;443444interface_type = rtw_get_intf_type(adapter);445446switch (rtw_get_chip_type(adapter)) {447#ifdef CONFIG_RTL8723B448case RTL8723B:449map = &rtl8723b_pg_txpwr_def_info;450break;451#endif452#ifdef CONFIG_RTL8703B453case RTL8703B:454map = &rtl8703b_pg_txpwr_def_info;455break;456#endif457#ifdef CONFIG_RTL8723D458case RTL8723D:459map = &rtl8723d_pg_txpwr_def_info;460break;461#endif462#ifdef CONFIG_RTL8188E463case RTL8188E:464map = &rtl8188e_pg_txpwr_def_info;465break;466#endif467#ifdef CONFIG_RTL8188F468case RTL8188F:469map = &rtl8188f_pg_txpwr_def_info;470break;471#endif472#ifdef CONFIG_RTL8188GTV473case RTL8188GTV:474map = &rtl8188gtv_pg_txpwr_def_info;475break;476#endif477#ifdef CONFIG_RTL8812A478case RTL8812:479map = &rtl8812a_pg_txpwr_def_info;480break;481#endif482#ifdef CONFIG_RTL8821A483case RTL8821:484map = &rtl8821a_pg_txpwr_def_info;485break;486#endif487#ifdef CONFIG_RTL8192E488case RTL8192E:489map = &rtl8192e_pg_txpwr_def_info;490break;491#endif492#ifdef CONFIG_RTL8814A493case RTL8814A:494map = &rtl8814a_pg_txpwr_def_info;495break;496#endif497#ifdef CONFIG_RTL8822B498case RTL8822B:499map = &rtl8822b_pg_txpwr_def_info;500break;501#endif502#ifdef CONFIG_RTL8821C503case RTL8821C:504map = &rtl8821c_pg_txpwr_def_info;505break;506#endif507#ifdef CONFIG_RTL8710B508case RTL8710B:509map = &rtl8710b_pg_txpwr_def_info;510break;511#endif512#ifdef CONFIG_RTL8192F513case RTL8192F:514map = &rtl8192f_pg_txpwr_def_info;515break;516#endif517#ifdef CONFIG_RTL8822C518case RTL8822C:519map = &rtl8822c_pg_txpwr_def_info;520break;521#endif522#ifdef CONFIG_RTL8814B523case RTL8814B:524map = &rtl8814b_pg_txpwr_def_info;525break;526#endif527}528529if (map == NULL) {530RTW_ERR("%s: unknown chip_type:%u\n"531, __func__, rtw_get_chip_type(adapter));532rtw_warn_on(1);533}534535return map;536}537538static u8 hal_chk_pg_txpwr_info_2g(_adapter *adapter, TxPowerInfo24G *pwr_info)539{540HAL_DATA_TYPE *hal_data = GET_HAL_DATA(adapter);541struct hal_spec_t *hal_spec = GET_HAL_SPEC(adapter);542u8 path, group, tx_idx;543544if (pwr_info == NULL || !hal_chk_band_cap(adapter, BAND_CAP_2G))545return _SUCCESS;546547for (path = 0; path < MAX_RF_PATH; path++) {548if (!HAL_SPEC_CHK_RF_PATH_2G(hal_spec, path))549continue;550for (group = 0; group < MAX_CHNL_GROUP_24G; group++) {551if (IS_PG_TXPWR_BASE_INVALID(hal_spec, pwr_info->IndexCCK_Base[path][group])552|| IS_PG_TXPWR_BASE_INVALID(hal_spec, pwr_info->IndexBW40_Base[path][group]))553return _FAIL;554}555for (tx_idx = 0; tx_idx < MAX_TX_COUNT; tx_idx++) {556if (tx_idx + 1 > hal_data->max_tx_cnt)557continue;558if (IS_PG_TXPWR_DIFF_INVALID(pwr_info->CCK_Diff[path][tx_idx])559|| IS_PG_TXPWR_DIFF_INVALID(pwr_info->OFDM_Diff[path][tx_idx])560|| IS_PG_TXPWR_DIFF_INVALID(pwr_info->BW20_Diff[path][tx_idx])561|| IS_PG_TXPWR_DIFF_INVALID(pwr_info->BW40_Diff[path][tx_idx]))562return _FAIL;563}564}565566return _SUCCESS;567}568569static u8 hal_chk_pg_txpwr_info_5g(_adapter *adapter, TxPowerInfo5G *pwr_info)570{571#ifdef CONFIG_IEEE80211_BAND_5GHZ572HAL_DATA_TYPE *hal_data = GET_HAL_DATA(adapter);573struct hal_spec_t *hal_spec = GET_HAL_SPEC(adapter);574u8 path, group, tx_idx;575576if (pwr_info == NULL || !hal_chk_band_cap(adapter, BAND_CAP_5G))577return _SUCCESS;578579for (path = 0; path < MAX_RF_PATH; path++) {580if (!HAL_SPEC_CHK_RF_PATH_5G(hal_spec, path))581continue;582for (group = 0; group < MAX_CHNL_GROUP_5G; group++)583if (IS_PG_TXPWR_BASE_INVALID(hal_spec, pwr_info->IndexBW40_Base[path][group]))584return _FAIL;585for (tx_idx = 0; tx_idx < MAX_TX_COUNT; tx_idx++) {586if (tx_idx + 1 > hal_data->max_tx_cnt)587continue;588if (IS_PG_TXPWR_DIFF_INVALID(pwr_info->OFDM_Diff[path][tx_idx])589|| IS_PG_TXPWR_DIFF_INVALID(pwr_info->BW20_Diff[path][tx_idx])590|| IS_PG_TXPWR_DIFF_INVALID(pwr_info->BW40_Diff[path][tx_idx])591|| IS_PG_TXPWR_DIFF_INVALID(pwr_info->BW80_Diff[path][tx_idx])592|| IS_PG_TXPWR_DIFF_INVALID(pwr_info->BW160_Diff[path][tx_idx]))593return _FAIL;594}595}596#endif /* CONFIG_IEEE80211_BAND_5GHZ */597return _SUCCESS;598}599600static inline void hal_init_pg_txpwr_info_2g(_adapter *adapter, TxPowerInfo24G *pwr_info)601{602struct hal_spec_t *hal_spec = GET_HAL_SPEC(adapter);603u8 path, group, tx_idx;604605if (pwr_info == NULL)606return;607608_rtw_memset(pwr_info, 0, sizeof(TxPowerInfo24G));609610/* init with invalid value */611for (path = 0; path < MAX_RF_PATH; path++) {612for (group = 0; group < MAX_CHNL_GROUP_24G; group++) {613pwr_info->IndexCCK_Base[path][group] = PG_TXPWR_INVALID_BASE;614pwr_info->IndexBW40_Base[path][group] = PG_TXPWR_INVALID_BASE;615}616for (tx_idx = 0; tx_idx < MAX_TX_COUNT; tx_idx++) {617pwr_info->CCK_Diff[path][tx_idx] = PG_TXPWR_INVALID_DIFF;618pwr_info->OFDM_Diff[path][tx_idx] = PG_TXPWR_INVALID_DIFF;619pwr_info->BW20_Diff[path][tx_idx] = PG_TXPWR_INVALID_DIFF;620pwr_info->BW40_Diff[path][tx_idx] = PG_TXPWR_INVALID_DIFF;621}622}623624/* init for dummy base and diff */625for (path = 0; path < MAX_RF_PATH; path++) {626if (!HAL_SPEC_CHK_RF_PATH_2G(hal_spec, path))627break;628/* 2.4G BW40 base has 1 less group than CCK base*/629pwr_info->IndexBW40_Base[path][MAX_CHNL_GROUP_24G - 1] = 0;630631/* dummy diff */632pwr_info->CCK_Diff[path][0] = 0; /* 2.4G CCK-1TX */633pwr_info->BW40_Diff[path][0] = 0; /* 2.4G BW40-1S */634}635}636637static inline void hal_init_pg_txpwr_info_5g(_adapter *adapter, TxPowerInfo5G *pwr_info)638{639#ifdef CONFIG_IEEE80211_BAND_5GHZ640struct hal_spec_t *hal_spec = GET_HAL_SPEC(adapter);641u8 path, group, tx_idx;642643if (pwr_info == NULL)644return;645646_rtw_memset(pwr_info, 0, sizeof(TxPowerInfo5G));647648/* init with invalid value */649for (path = 0; path < MAX_RF_PATH; path++) {650for (group = 0; group < MAX_CHNL_GROUP_5G; group++)651pwr_info->IndexBW40_Base[path][group] = PG_TXPWR_INVALID_BASE;652for (tx_idx = 0; tx_idx < MAX_TX_COUNT; tx_idx++) {653pwr_info->OFDM_Diff[path][tx_idx] = PG_TXPWR_INVALID_DIFF;654pwr_info->BW20_Diff[path][tx_idx] = PG_TXPWR_INVALID_DIFF;655pwr_info->BW40_Diff[path][tx_idx] = PG_TXPWR_INVALID_DIFF;656pwr_info->BW80_Diff[path][tx_idx] = PG_TXPWR_INVALID_DIFF;657pwr_info->BW160_Diff[path][tx_idx] = PG_TXPWR_INVALID_DIFF;658}659}660661for (path = 0; path < MAX_RF_PATH; path++) {662if (!HAL_SPEC_CHK_RF_PATH_5G(hal_spec, path))663break;664/* dummy diff */665pwr_info->BW40_Diff[path][0] = 0; /* 5G BW40-1S */666}667#endif /* CONFIG_IEEE80211_BAND_5GHZ */668}669670#if DBG_PG_TXPWR_READ671#define LOAD_PG_TXPWR_WARN_COND(_txpwr_src) 1672#else673#define LOAD_PG_TXPWR_WARN_COND(_txpwr_src) (_txpwr_src > PG_TXPWR_SRC_PG_DATA)674#endif675676u16 hal_load_pg_txpwr_info_path_2g(677_adapter *adapter,678TxPowerInfo24G *pwr_info,679u32 path,680u8 txpwr_src,681const struct map_t *txpwr_map,682u16 pg_offset)683{684HAL_DATA_TYPE *hal_data = GET_HAL_DATA(adapter);685struct hal_spec_t *hal_spec = GET_HAL_SPEC(adapter);686u16 offset = pg_offset;687u8 group, tx_idx;688u8 val;689u8 tmp_base;690s8 tmp_diff;691692if (pwr_info == NULL || !hal_chk_band_cap(adapter, BAND_CAP_2G)) {693offset += PG_TXPWR_1PATH_BYTE_NUM_2G;694goto exit;695}696697if (DBG_PG_TXPWR_READ)698RTW_INFO("%s [%c] offset:0x%03x\n", __func__, rf_path_char(path), offset);699700for (group = 0; group < MAX_CHNL_GROUP_24G; group++) {701if (HAL_SPEC_CHK_RF_PATH_2G(hal_spec, path)) {702tmp_base = map_read8(txpwr_map, offset);703if (!IS_PG_TXPWR_BASE_INVALID(hal_spec, tmp_base)704&& IS_PG_TXPWR_BASE_INVALID(hal_spec, pwr_info->IndexCCK_Base[path][group])705) {706pwr_info->IndexCCK_Base[path][group] = tmp_base;707if (LOAD_PG_TXPWR_WARN_COND(txpwr_src))708RTW_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));709}710}711offset++;712}713714for (group = 0; group < MAX_CHNL_GROUP_24G - 1; group++) {715if (HAL_SPEC_CHK_RF_PATH_2G(hal_spec, path)) {716tmp_base = map_read8(txpwr_map, offset);717if (!IS_PG_TXPWR_BASE_INVALID(hal_spec, tmp_base)718&& IS_PG_TXPWR_BASE_INVALID(hal_spec, pwr_info->IndexBW40_Base[path][group])719) {720pwr_info->IndexBW40_Base[path][group] = tmp_base;721if (LOAD_PG_TXPWR_WARN_COND(txpwr_src))722RTW_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));723}724}725offset++;726}727728for (tx_idx = 0; tx_idx < MAX_TX_COUNT; tx_idx++) {729if (tx_idx == 0) {730if (HAL_SPEC_CHK_RF_PATH_2G(hal_spec, path)) {731val = map_read8(txpwr_map, offset);732tmp_diff = PG_TXPWR_MSB_DIFF_TO_S8BIT(val);733if (!IS_PG_TXPWR_DIFF_INVALID(tmp_diff)734&& IS_PG_TXPWR_DIFF_INVALID(pwr_info->BW20_Diff[path][tx_idx])735) {736pwr_info->BW20_Diff[path][tx_idx] = tmp_diff;737if (LOAD_PG_TXPWR_WARN_COND(txpwr_src))738RTW_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));739}740tmp_diff = PG_TXPWR_LSB_DIFF_TO_S8BIT(val);741if (!IS_PG_TXPWR_DIFF_INVALID(tmp_diff)742&& IS_PG_TXPWR_DIFF_INVALID(pwr_info->OFDM_Diff[path][tx_idx])743) {744pwr_info->OFDM_Diff[path][tx_idx] = tmp_diff;745if (LOAD_PG_TXPWR_WARN_COND(txpwr_src))746RTW_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));747}748}749offset++;750} else {751if (HAL_SPEC_CHK_RF_PATH_2G(hal_spec, path) && tx_idx + 1 <= hal_data->max_tx_cnt) {752val = map_read8(txpwr_map, offset);753tmp_diff = PG_TXPWR_MSB_DIFF_TO_S8BIT(val);754if (!IS_PG_TXPWR_DIFF_INVALID(tmp_diff)755&& IS_PG_TXPWR_DIFF_INVALID(pwr_info->BW40_Diff[path][tx_idx])756) {757pwr_info->BW40_Diff[path][tx_idx] = tmp_diff;758if (LOAD_PG_TXPWR_WARN_COND(txpwr_src))759RTW_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));760761}762tmp_diff = PG_TXPWR_LSB_DIFF_TO_S8BIT(val);763if (!IS_PG_TXPWR_DIFF_INVALID(tmp_diff)764&& IS_PG_TXPWR_DIFF_INVALID(pwr_info->BW20_Diff[path][tx_idx])765) {766pwr_info->BW20_Diff[path][tx_idx] = tmp_diff;767if (LOAD_PG_TXPWR_WARN_COND(txpwr_src))768RTW_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));769}770}771offset++;772773if (HAL_SPEC_CHK_RF_PATH_2G(hal_spec, path) && tx_idx + 1 <= hal_data->max_tx_cnt) {774val = map_read8(txpwr_map, offset);775tmp_diff = PG_TXPWR_MSB_DIFF_TO_S8BIT(val);776if (!IS_PG_TXPWR_DIFF_INVALID(tmp_diff)777&& IS_PG_TXPWR_DIFF_INVALID(pwr_info->OFDM_Diff[path][tx_idx])778) {779pwr_info->OFDM_Diff[path][tx_idx] = tmp_diff;780if (LOAD_PG_TXPWR_WARN_COND(txpwr_src))781RTW_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));782}783tmp_diff = PG_TXPWR_LSB_DIFF_TO_S8BIT(val);784if (!IS_PG_TXPWR_DIFF_INVALID(tmp_diff)785&& IS_PG_TXPWR_DIFF_INVALID(pwr_info->CCK_Diff[path][tx_idx])786) {787pwr_info->CCK_Diff[path][tx_idx] = tmp_diff;788if (LOAD_PG_TXPWR_WARN_COND(txpwr_src))789RTW_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));790}791}792offset++;793}794}795796if (offset != pg_offset + PG_TXPWR_1PATH_BYTE_NUM_2G) {797RTW_ERR("%s parse %d bytes != %d\n", __func__, offset - pg_offset, PG_TXPWR_1PATH_BYTE_NUM_2G);798rtw_warn_on(1);799}800801exit:802return offset;803}804805u16 hal_load_pg_txpwr_info_path_5g(806_adapter *adapter,807TxPowerInfo5G *pwr_info,808u32 path,809u8 txpwr_src,810const struct map_t *txpwr_map,811u16 pg_offset)812{813HAL_DATA_TYPE *hal_data = GET_HAL_DATA(adapter);814struct hal_spec_t *hal_spec = GET_HAL_SPEC(adapter);815u16 offset = pg_offset;816u8 group, tx_idx;817u8 val;818u8 tmp_base;819s8 tmp_diff;820821#ifdef CONFIG_IEEE80211_BAND_5GHZ822if (pwr_info == NULL || !hal_chk_band_cap(adapter, BAND_CAP_5G))823#endif824{825offset += PG_TXPWR_1PATH_BYTE_NUM_5G;826goto exit;827}828829#ifdef CONFIG_IEEE80211_BAND_5GHZ830if (DBG_PG_TXPWR_READ)831RTW_INFO("%s[%c] eaddr:0x%03x\n", __func__, rf_path_char(path), offset);832833for (group = 0; group < MAX_CHNL_GROUP_5G; group++) {834if (HAL_SPEC_CHK_RF_PATH_5G(hal_spec, path)) {835tmp_base = map_read8(txpwr_map, offset);836if (!IS_PG_TXPWR_BASE_INVALID(hal_spec, tmp_base)837&& IS_PG_TXPWR_BASE_INVALID(hal_spec, pwr_info->IndexBW40_Base[path][group])838) {839pwr_info->IndexBW40_Base[path][group] = tmp_base;840if (LOAD_PG_TXPWR_WARN_COND(txpwr_src))841RTW_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));842}843}844offset++;845}846847for (tx_idx = 0; tx_idx < MAX_TX_COUNT; tx_idx++) {848if (tx_idx == 0) {849if (HAL_SPEC_CHK_RF_PATH_5G(hal_spec, path)) {850val = map_read8(txpwr_map, offset);851tmp_diff = PG_TXPWR_MSB_DIFF_TO_S8BIT(val);852if (!IS_PG_TXPWR_DIFF_INVALID(tmp_diff)853&& IS_PG_TXPWR_DIFF_INVALID(pwr_info->BW20_Diff[path][tx_idx])854) {855pwr_info->BW20_Diff[path][tx_idx] = tmp_diff;856if (LOAD_PG_TXPWR_WARN_COND(txpwr_src))857RTW_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));858}859tmp_diff = PG_TXPWR_LSB_DIFF_TO_S8BIT(val);860if (!IS_PG_TXPWR_DIFF_INVALID(tmp_diff)861&& IS_PG_TXPWR_DIFF_INVALID(pwr_info->OFDM_Diff[path][tx_idx])862) {863pwr_info->OFDM_Diff[path][tx_idx] = tmp_diff;864if (LOAD_PG_TXPWR_WARN_COND(txpwr_src))865RTW_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));866}867}868offset++;869} else {870if (HAL_SPEC_CHK_RF_PATH_5G(hal_spec, path) && tx_idx + 1 <= hal_data->max_tx_cnt) {871val = map_read8(txpwr_map, offset);872tmp_diff = PG_TXPWR_MSB_DIFF_TO_S8BIT(val);873if (!IS_PG_TXPWR_DIFF_INVALID(tmp_diff)874&& IS_PG_TXPWR_DIFF_INVALID(pwr_info->BW40_Diff[path][tx_idx])875) {876pwr_info->BW40_Diff[path][tx_idx] = tmp_diff;877if (LOAD_PG_TXPWR_WARN_COND(txpwr_src))878RTW_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));879}880tmp_diff = PG_TXPWR_LSB_DIFF_TO_S8BIT(val);881if (!IS_PG_TXPWR_DIFF_INVALID(tmp_diff)882&& IS_PG_TXPWR_DIFF_INVALID(pwr_info->BW20_Diff[path][tx_idx])883) {884pwr_info->BW20_Diff[path][tx_idx] = tmp_diff;885if (LOAD_PG_TXPWR_WARN_COND(txpwr_src))886RTW_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));887}888}889offset++;890}891}892893/* OFDM diff 2T ~ 3T */894if (HAL_SPEC_CHK_RF_PATH_5G(hal_spec, path) && hal_data->max_tx_cnt > 1) {895val = map_read8(txpwr_map, offset);896tmp_diff = PG_TXPWR_MSB_DIFF_TO_S8BIT(val);897if (!IS_PG_TXPWR_DIFF_INVALID(tmp_diff)898&& IS_PG_TXPWR_DIFF_INVALID(pwr_info->OFDM_Diff[path][1])899) {900pwr_info->OFDM_Diff[path][1] = tmp_diff;901if (LOAD_PG_TXPWR_WARN_COND(txpwr_src))902RTW_INFO("[%c] 5G OFDM-%dT diff:%d from %s\n", rf_path_char(path), 2, tmp_diff, pg_txpwr_src_str(txpwr_src));903}904if (hal_data->max_tx_cnt > 2) {905tmp_diff = PG_TXPWR_LSB_DIFF_TO_S8BIT(val);906if (!IS_PG_TXPWR_DIFF_INVALID(tmp_diff)907&& IS_PG_TXPWR_DIFF_INVALID(pwr_info->OFDM_Diff[path][2])908) {909pwr_info->OFDM_Diff[path][2] = tmp_diff;910if (LOAD_PG_TXPWR_WARN_COND(txpwr_src))911RTW_INFO("[%c] 5G OFDM-%dT diff:%d from %s\n", rf_path_char(path), 3, tmp_diff, pg_txpwr_src_str(txpwr_src));912}913}914}915offset++;916917/* OFDM diff 4T */918if (HAL_SPEC_CHK_RF_PATH_5G(hal_spec, path) && hal_data->max_tx_cnt > 3) {919val = map_read8(txpwr_map, offset);920tmp_diff = PG_TXPWR_LSB_DIFF_TO_S8BIT(val);921if (!IS_PG_TXPWR_DIFF_INVALID(tmp_diff)922&& IS_PG_TXPWR_DIFF_INVALID(pwr_info->OFDM_Diff[path][3])923) {924pwr_info->OFDM_Diff[path][3] = tmp_diff;925if (LOAD_PG_TXPWR_WARN_COND(txpwr_src))926RTW_INFO("[%c] 5G OFDM-%dT diff:%d from %s\n", rf_path_char(path), 4, tmp_diff, pg_txpwr_src_str(txpwr_src));927}928}929offset++;930931for (tx_idx = 0; tx_idx < MAX_TX_COUNT; tx_idx++) {932if (HAL_SPEC_CHK_RF_PATH_5G(hal_spec, path) && tx_idx + 1 <= hal_data->max_tx_cnt) {933val = map_read8(txpwr_map, offset);934tmp_diff = PG_TXPWR_MSB_DIFF_TO_S8BIT(val);935if (!IS_PG_TXPWR_DIFF_INVALID(tmp_diff)936&& IS_PG_TXPWR_DIFF_INVALID(pwr_info->BW80_Diff[path][tx_idx])937) {938pwr_info->BW80_Diff[path][tx_idx] = tmp_diff;939if (LOAD_PG_TXPWR_WARN_COND(txpwr_src))940RTW_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));941}942tmp_diff = PG_TXPWR_LSB_DIFF_TO_S8BIT(val);943if (!IS_PG_TXPWR_DIFF_INVALID(tmp_diff)944&& IS_PG_TXPWR_DIFF_INVALID(pwr_info->BW160_Diff[path][tx_idx])945) {946pwr_info->BW160_Diff[path][tx_idx] = tmp_diff;947if (LOAD_PG_TXPWR_WARN_COND(txpwr_src))948RTW_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));949}950}951offset++;952}953954if (offset != pg_offset + PG_TXPWR_1PATH_BYTE_NUM_5G) {955RTW_ERR("%s parse %d bytes != %d\n", __func__, offset - pg_offset, PG_TXPWR_1PATH_BYTE_NUM_5G);956rtw_warn_on(1);957}958959#endif /* #ifdef CONFIG_IEEE80211_BAND_5GHZ */960961exit:962return offset;963}964965void hal_load_pg_txpwr_info(966_adapter *adapter,967TxPowerInfo24G *pwr_info_2g,968TxPowerInfo5G *pwr_info_5g,969u8 *pg_data,970BOOLEAN AutoLoadFail971)972{973struct hal_spec_t *hal_spec = GET_HAL_SPEC(adapter);974u8 path;975u16 pg_offset;976u8 txpwr_src = PG_TXPWR_SRC_PG_DATA;977struct map_t pg_data_map = MAP_ENT(184, 1, 0xFF, MAPSEG_PTR_ENT(0x00, 184, pg_data));978const struct map_t *txpwr_map = NULL;979980/* init with invalid value and some dummy base and diff */981hal_init_pg_txpwr_info_2g(adapter, pwr_info_2g);982hal_init_pg_txpwr_info_5g(adapter, pwr_info_5g);983984select_src:985pg_offset = hal_spec->pg_txpwr_saddr;986987switch (txpwr_src) {988case PG_TXPWR_SRC_PG_DATA:989txpwr_map = &pg_data_map;990break;991case PG_TXPWR_SRC_IC_DEF:992txpwr_map = hal_pg_txpwr_def_info(adapter);993break;994case PG_TXPWR_SRC_DEF:995default:996txpwr_map = &pg_txpwr_def_info;997break;998};9991000if (txpwr_map == NULL)1001goto end_parse;10021003for (path = 0; path < MAX_RF_PATH ; path++) {1004if (!HAL_SPEC_CHK_RF_PATH_2G(hal_spec, path) && !HAL_SPEC_CHK_RF_PATH_5G(hal_spec, path))1005break;1006pg_offset = hal_load_pg_txpwr_info_path_2g(adapter, pwr_info_2g, path, txpwr_src, txpwr_map, pg_offset);1007pg_offset = hal_load_pg_txpwr_info_path_5g(adapter, pwr_info_5g, path, txpwr_src, txpwr_map, pg_offset);1008}10091010if (hal_chk_pg_txpwr_info_2g(adapter, pwr_info_2g) == _SUCCESS1011&& hal_chk_pg_txpwr_info_5g(adapter, pwr_info_5g) == _SUCCESS)1012goto exit;10131014end_parse:1015txpwr_src++;1016if (txpwr_src < PG_TXPWR_SRC_NUM)1017goto select_src;10181019if (hal_chk_pg_txpwr_info_2g(adapter, pwr_info_2g) != _SUCCESS1020|| hal_chk_pg_txpwr_info_5g(adapter, pwr_info_5g) != _SUCCESS)1021rtw_warn_on(1);10221023exit:1024#if DBG_PG_TXPWR_READ1025if (pwr_info_2g)1026dump_pg_txpwr_info_2g(RTW_DBGDUMP, pwr_info_2g, 4, 4);1027if (pwr_info_5g)1028dump_pg_txpwr_info_5g(RTW_DBGDUMP, pwr_info_5g, 4, 4);1029#endif10301031return;1032}1033#endif /* CONFIG_USE_TSSI */10341035#ifdef CONFIG_EFUSE_CONFIG_FILE10361037#define EFUSE_POWER_INDEX_INVALID 0xFF10381039static u8 _check_phy_efuse_tx_power_info_valid(u8 *pg_data, int base_len, u16 pg_offset)1040{1041int ff_cnt = 0;1042int i;10431044for (i = 0; i < base_len; i++) {1045if (*(pg_data + pg_offset + i) == 0xFF)1046ff_cnt++;1047}10481049if (ff_cnt == 0)1050return _TRUE;1051else if (ff_cnt == base_len)1052return _FALSE;1053else1054return EFUSE_POWER_INDEX_INVALID;1055}10561057int check_phy_efuse_tx_power_info_valid(_adapter *adapter)1058{1059struct hal_spec_t *hal_spec = GET_HAL_SPEC(adapter);1060HAL_DATA_TYPE *hal_data = GET_HAL_DATA(adapter);1061u8 *pg_data = hal_data->efuse_eeprom_data;1062u16 pg_offset = hal_spec->pg_txpwr_saddr;1063u8 path;1064u8 valid_2g_path_bmp = 0;1065#ifdef CONFIG_IEEE80211_BAND_5GHZ1066u8 valid_5g_path_bmp = 0;1067#endif10681069for (path = 0; path < MAX_RF_PATH; path++) {1070u8 ret = _FALSE;10711072if (!HAL_SPEC_CHK_RF_PATH_2G(hal_spec, path) && !HAL_SPEC_CHK_RF_PATH_5G(hal_spec, path))1073break;10741075if (HAL_SPEC_CHK_RF_PATH_2G(hal_spec, path)) {1076ret = _check_phy_efuse_tx_power_info_valid(pg_data, PG_TXPWR_BASE_BYTE_NUM_2G, pg_offset);1077if (ret == _TRUE)1078valid_2g_path_bmp |= BIT(path);1079else if (ret == EFUSE_POWER_INDEX_INVALID)1080return _FALSE;1081}1082pg_offset += PG_TXPWR_1PATH_BYTE_NUM_2G;10831084#ifdef CONFIG_IEEE80211_BAND_5GHZ1085if (HAL_SPEC_CHK_RF_PATH_5G(hal_spec, path)) {1086ret = _check_phy_efuse_tx_power_info_valid(pg_data, PG_TXPWR_BASE_BYTE_NUM_5G, pg_offset);1087if (ret == _TRUE)1088valid_5g_path_bmp |= BIT(path);1089else if (ret == EFUSE_POWER_INDEX_INVALID)1090return _FALSE;1091}1092#endif1093pg_offset += PG_TXPWR_1PATH_BYTE_NUM_5G;1094}10951096if ((hal_chk_band_cap(adapter, BAND_CAP_2G) && valid_2g_path_bmp)1097#ifdef CONFIG_IEEE80211_BAND_5GHZ1098|| (hal_chk_band_cap(adapter, BAND_CAP_5G) && valid_5g_path_bmp)1099#endif1100)1101return _TRUE;11021103return _FALSE;1104}1105#endif /* CONFIG_EFUSE_CONFIG_FILE */11061107#ifndef CONFIG_USE_TSSI1108void hal_load_txpwr_info(_adapter *adapter)1109{1110HAL_DATA_TYPE *hal_data = GET_HAL_DATA(adapter);1111struct hal_spec_t *hal_spec = GET_HAL_SPEC(adapter);1112u8 max_tx_cnt = hal_data->max_tx_cnt;1113u8 *pg_data = hal_data->efuse_eeprom_data;1114TxPowerInfo24G *pwr_info_2g = NULL;1115TxPowerInfo5G *pwr_info_5g = NULL;1116u8 rfpath, ch_idx, group, tx_idx;11171118if (hal_chk_band_cap(adapter, BAND_CAP_2G))1119pwr_info_2g = rtw_vmalloc(sizeof(TxPowerInfo24G));1120#ifdef CONFIG_IEEE80211_BAND_5GHZ1121if (hal_chk_band_cap(adapter, BAND_CAP_5G))1122pwr_info_5g = rtw_vmalloc(sizeof(TxPowerInfo5G));1123#endif11241125/* load from pg data (or default value) */1126hal_load_pg_txpwr_info(adapter, pwr_info_2g, pwr_info_5g, pg_data, _FALSE);11271128/* transform to hal_data */1129for (rfpath = 0; rfpath < MAX_RF_PATH; rfpath++) {11301131if (!pwr_info_2g || !HAL_SPEC_CHK_RF_PATH_2G(hal_spec, rfpath))1132goto bypass_2g;11331134/* 2.4G base */1135for (ch_idx = 0; ch_idx < CENTER_CH_2G_NUM; ch_idx++) {1136u8 cck_group;11371138if (rtw_get_ch_group(ch_idx + 1, &group, &cck_group) != BAND_ON_2_4G)1139continue;11401141hal_data->Index24G_CCK_Base[rfpath][ch_idx] = pwr_info_2g->IndexCCK_Base[rfpath][cck_group];1142hal_data->Index24G_BW40_Base[rfpath][ch_idx] = pwr_info_2g->IndexBW40_Base[rfpath][group];1143}11441145/* 2.4G diff */1146for (tx_idx = 0; tx_idx < MAX_TX_COUNT; tx_idx++) {1147if (tx_idx + 1 > max_tx_cnt)1148break;11491150hal_data->CCK_24G_Diff[rfpath][tx_idx] = pwr_info_2g->CCK_Diff[rfpath][tx_idx] * hal_spec->pg_txgi_diff_factor;1151hal_data->OFDM_24G_Diff[rfpath][tx_idx] = pwr_info_2g->OFDM_Diff[rfpath][tx_idx] * hal_spec->pg_txgi_diff_factor;1152hal_data->BW20_24G_Diff[rfpath][tx_idx] = pwr_info_2g->BW20_Diff[rfpath][tx_idx] * hal_spec->pg_txgi_diff_factor;1153hal_data->BW40_24G_Diff[rfpath][tx_idx] = pwr_info_2g->BW40_Diff[rfpath][tx_idx] * hal_spec->pg_txgi_diff_factor;1154}1155bypass_2g:1156;11571158#ifdef CONFIG_IEEE80211_BAND_5GHZ1159if (!pwr_info_5g || !HAL_SPEC_CHK_RF_PATH_5G(hal_spec, rfpath))1160goto bypass_5g;11611162/* 5G base */1163for (ch_idx = 0; ch_idx < CENTER_CH_5G_ALL_NUM; ch_idx++) {1164if (rtw_get_ch_group(center_ch_5g_all[ch_idx], &group, NULL) != BAND_ON_5G)1165continue;1166hal_data->Index5G_BW40_Base[rfpath][ch_idx] = pwr_info_5g->IndexBW40_Base[rfpath][group];1167}11681169for (ch_idx = 0 ; ch_idx < CENTER_CH_5G_80M_NUM; ch_idx++) {1170u8 upper, lower;11711172if (rtw_get_ch_group(center_ch_5g_80m[ch_idx], &group, NULL) != BAND_ON_5G)1173continue;11741175upper = pwr_info_5g->IndexBW40_Base[rfpath][group];1176lower = pwr_info_5g->IndexBW40_Base[rfpath][group + 1];1177hal_data->Index5G_BW80_Base[rfpath][ch_idx] = (upper + lower) / 2;1178}11791180/* 5G diff */1181for (tx_idx = 0; tx_idx < MAX_TX_COUNT; tx_idx++) {1182if (tx_idx + 1 > max_tx_cnt)1183break;11841185hal_data->OFDM_5G_Diff[rfpath][tx_idx] = pwr_info_5g->OFDM_Diff[rfpath][tx_idx] * hal_spec->pg_txgi_diff_factor;1186hal_data->BW20_5G_Diff[rfpath][tx_idx] = pwr_info_5g->BW20_Diff[rfpath][tx_idx] * hal_spec->pg_txgi_diff_factor;1187hal_data->BW40_5G_Diff[rfpath][tx_idx] = pwr_info_5g->BW40_Diff[rfpath][tx_idx] * hal_spec->pg_txgi_diff_factor;1188hal_data->BW80_5G_Diff[rfpath][tx_idx] = pwr_info_5g->BW80_Diff[rfpath][tx_idx] * hal_spec->pg_txgi_diff_factor;1189}1190bypass_5g:1191;1192#endif /* CONFIG_IEEE80211_BAND_5GHZ */1193}11941195if (pwr_info_2g)1196rtw_vmfree(pwr_info_2g, sizeof(TxPowerInfo24G));1197if (pwr_info_5g)1198rtw_vmfree(pwr_info_5g, sizeof(TxPowerInfo5G));1199}12001201void dump_hal_txpwr_info_2g(void *sel, _adapter *adapter, u8 rfpath_num, u8 max_tx_cnt)1202{1203HAL_DATA_TYPE *hal_data = GET_HAL_DATA(adapter);1204int path, ch_idx, tx_idx;12051206RTW_PRINT_SEL(sel, "2.4G\n");1207RTW_PRINT_SEL(sel, "CCK-1T base:\n");1208RTW_PRINT_SEL(sel, "%4s ", "");1209for (ch_idx = 0; ch_idx < CENTER_CH_2G_NUM; ch_idx++)1210_RTW_PRINT_SEL(sel, "%3d ", center_ch_2g[ch_idx]);1211_RTW_PRINT_SEL(sel, "\n");1212for (path = 0; path < MAX_RF_PATH && path < rfpath_num; path++) {1213RTW_PRINT_SEL(sel, "[%c]: ", rf_path_char(path));1214for (ch_idx = 0; ch_idx < CENTER_CH_2G_NUM; ch_idx++)1215_RTW_PRINT_SEL(sel, "%3u ", hal_data->Index24G_CCK_Base[path][ch_idx]);1216_RTW_PRINT_SEL(sel, "\n");1217}1218RTW_PRINT_SEL(sel, "\n");12191220RTW_PRINT_SEL(sel, "CCK diff:\n");1221RTW_PRINT_SEL(sel, "%4s ", "");1222for (tx_idx = RF_1TX; tx_idx < MAX_TX_COUNT && tx_idx < max_tx_cnt; tx_idx++)1223_RTW_PRINT_SEL(sel, "%dT ", tx_idx + 1);1224_RTW_PRINT_SEL(sel, "\n");1225for (path = 0; path < MAX_RF_PATH && path < rfpath_num; path++) {1226RTW_PRINT_SEL(sel, "[%c]: ", rf_path_char(path));1227for (tx_idx = RF_1TX; tx_idx < MAX_TX_COUNT && tx_idx < max_tx_cnt; tx_idx++)1228_RTW_PRINT_SEL(sel, "%2d ", hal_data->CCK_24G_Diff[path][tx_idx]);1229_RTW_PRINT_SEL(sel, "\n");1230}1231RTW_PRINT_SEL(sel, "\n");12321233RTW_PRINT_SEL(sel, "BW40-1S base:\n");1234RTW_PRINT_SEL(sel, "%4s ", "");1235for (ch_idx = 0; ch_idx < CENTER_CH_2G_NUM; ch_idx++)1236_RTW_PRINT_SEL(sel, "%3d ", center_ch_2g[ch_idx]);1237_RTW_PRINT_SEL(sel, "\n");1238for (path = 0; path < MAX_RF_PATH && path < rfpath_num; path++) {1239RTW_PRINT_SEL(sel, "[%c]: ", rf_path_char(path));1240for (ch_idx = 0; ch_idx < CENTER_CH_2G_NUM; ch_idx++)1241_RTW_PRINT_SEL(sel, "%3u ", hal_data->Index24G_BW40_Base[path][ch_idx]);1242_RTW_PRINT_SEL(sel, "\n");1243}1244RTW_PRINT_SEL(sel, "\n");12451246RTW_PRINT_SEL(sel, "OFDM diff:\n");1247RTW_PRINT_SEL(sel, "%4s ", "");1248for (tx_idx = RF_1TX; tx_idx < MAX_TX_COUNT && tx_idx < max_tx_cnt; tx_idx++)1249_RTW_PRINT_SEL(sel, "%dT ", tx_idx + 1);1250_RTW_PRINT_SEL(sel, "\n");1251for (path = 0; path < MAX_RF_PATH && path < rfpath_num; path++) {1252RTW_PRINT_SEL(sel, "[%c]: ", rf_path_char(path));1253for (tx_idx = RF_1TX; tx_idx < MAX_TX_COUNT && tx_idx < max_tx_cnt; tx_idx++)1254_RTW_PRINT_SEL(sel, "%2d ", hal_data->OFDM_24G_Diff[path][tx_idx]);1255_RTW_PRINT_SEL(sel, "\n");1256}1257RTW_PRINT_SEL(sel, "\n");12581259RTW_PRINT_SEL(sel, "BW20 diff:\n");1260RTW_PRINT_SEL(sel, "%4s ", "");1261for (tx_idx = RF_1TX; tx_idx < MAX_TX_COUNT && tx_idx < max_tx_cnt; tx_idx++)1262_RTW_PRINT_SEL(sel, "%dS ", tx_idx + 1);1263_RTW_PRINT_SEL(sel, "\n");1264for (path = 0; path < MAX_RF_PATH && path < rfpath_num; path++) {1265RTW_PRINT_SEL(sel, "[%c]: ", rf_path_char(path));1266for (tx_idx = RF_1TX; tx_idx < MAX_TX_COUNT && tx_idx < max_tx_cnt; tx_idx++)1267_RTW_PRINT_SEL(sel, "%2d ", hal_data->BW20_24G_Diff[path][tx_idx]);1268_RTW_PRINT_SEL(sel, "\n");1269}1270RTW_PRINT_SEL(sel, "\n");12711272RTW_PRINT_SEL(sel, "BW40 diff:\n");1273RTW_PRINT_SEL(sel, "%4s ", "");1274for (tx_idx = RF_1TX; tx_idx < MAX_TX_COUNT && tx_idx < max_tx_cnt; tx_idx++)1275_RTW_PRINT_SEL(sel, "%dS ", tx_idx + 1);1276_RTW_PRINT_SEL(sel, "\n");1277for (path = 0; path < MAX_RF_PATH && path < rfpath_num; path++) {1278RTW_PRINT_SEL(sel, "[%c]: ", rf_path_char(path));1279for (tx_idx = RF_1TX; tx_idx < MAX_TX_COUNT && tx_idx < max_tx_cnt; tx_idx++)1280_RTW_PRINT_SEL(sel, "%2d ", hal_data->BW40_24G_Diff[path][tx_idx]);1281_RTW_PRINT_SEL(sel, "\n");1282}1283RTW_PRINT_SEL(sel, "\n");1284}12851286void dump_hal_txpwr_info_5g(void *sel, _adapter *adapter, u8 rfpath_num, u8 max_tx_cnt)1287{1288#ifdef CONFIG_IEEE80211_BAND_5GHZ1289HAL_DATA_TYPE *hal_data = GET_HAL_DATA(adapter);1290int path, ch_idx, tx_idx;1291u8 dump_section = 0;1292u8 ch_idx_s = 0;12931294RTW_PRINT_SEL(sel, "5G\n");1295RTW_PRINT_SEL(sel, "BW40-1S base:\n");1296do {1297#define DUMP_5G_BW40_BASE_SECTION_NUM 31298u8 end[DUMP_5G_BW40_BASE_SECTION_NUM] = {64, 144, 177};12991300RTW_PRINT_SEL(sel, "%4s ", "");1301for (ch_idx = ch_idx_s; ch_idx < CENTER_CH_5G_ALL_NUM; ch_idx++) {1302_RTW_PRINT_SEL(sel, "%3d ", center_ch_5g_all[ch_idx]);1303if (end[dump_section] == center_ch_5g_all[ch_idx])1304break;1305}1306_RTW_PRINT_SEL(sel, "\n");1307for (path = 0; path < MAX_RF_PATH && path < rfpath_num; path++) {1308RTW_PRINT_SEL(sel, "[%c]: ", rf_path_char(path));1309for (ch_idx = ch_idx_s; ch_idx < CENTER_CH_5G_ALL_NUM; ch_idx++) {1310_RTW_PRINT_SEL(sel, "%3u ", hal_data->Index5G_BW40_Base[path][ch_idx]);1311if (end[dump_section] == center_ch_5g_all[ch_idx])1312break;1313}1314_RTW_PRINT_SEL(sel, "\n");1315}1316RTW_PRINT_SEL(sel, "\n");13171318ch_idx_s = ch_idx + 1;1319dump_section++;1320if (dump_section >= DUMP_5G_BW40_BASE_SECTION_NUM)1321break;1322} while (1);13231324RTW_PRINT_SEL(sel, "BW80-1S base:\n");1325RTW_PRINT_SEL(sel, "%4s ", "");1326for (ch_idx = 0; ch_idx < CENTER_CH_5G_80M_NUM; ch_idx++)1327_RTW_PRINT_SEL(sel, "%3d ", center_ch_5g_80m[ch_idx]);1328_RTW_PRINT_SEL(sel, "\n");1329for (path = 0; path < MAX_RF_PATH && path < rfpath_num; path++) {1330RTW_PRINT_SEL(sel, "[%c]: ", rf_path_char(path));1331for (ch_idx = 0; ch_idx < CENTER_CH_5G_80M_NUM; ch_idx++)1332_RTW_PRINT_SEL(sel, "%3u ", hal_data->Index5G_BW80_Base[path][ch_idx]);1333_RTW_PRINT_SEL(sel, "\n");1334}1335RTW_PRINT_SEL(sel, "\n");13361337RTW_PRINT_SEL(sel, "OFDM diff:\n");1338RTW_PRINT_SEL(sel, "%4s ", "");1339for (tx_idx = RF_1TX; tx_idx < MAX_TX_COUNT && tx_idx < max_tx_cnt; tx_idx++)1340_RTW_PRINT_SEL(sel, "%dT ", tx_idx + 1);1341_RTW_PRINT_SEL(sel, "\n");1342for (path = 0; path < MAX_RF_PATH && path < rfpath_num; path++) {1343RTW_PRINT_SEL(sel, "[%c]: ", rf_path_char(path));1344for (tx_idx = RF_1TX; tx_idx < MAX_TX_COUNT && tx_idx < max_tx_cnt; tx_idx++)1345_RTW_PRINT_SEL(sel, "%2d ", hal_data->OFDM_5G_Diff[path][tx_idx]);1346_RTW_PRINT_SEL(sel, "\n");1347}1348RTW_PRINT_SEL(sel, "\n");13491350RTW_PRINT_SEL(sel, "BW20 diff:\n");1351RTW_PRINT_SEL(sel, "%4s ", "");1352for (tx_idx = RF_1TX; tx_idx < MAX_TX_COUNT && tx_idx < max_tx_cnt; tx_idx++)1353_RTW_PRINT_SEL(sel, "%dS ", tx_idx + 1);1354_RTW_PRINT_SEL(sel, "\n");1355for (path = 0; path < MAX_RF_PATH && path < rfpath_num; path++) {1356RTW_PRINT_SEL(sel, "[%c]: ", rf_path_char(path));1357for (tx_idx = RF_1TX; tx_idx < MAX_TX_COUNT && tx_idx < max_tx_cnt; tx_idx++)1358_RTW_PRINT_SEL(sel, "%2d ", hal_data->BW20_5G_Diff[path][tx_idx]);1359_RTW_PRINT_SEL(sel, "\n");1360}1361RTW_PRINT_SEL(sel, "\n");13621363RTW_PRINT_SEL(sel, "BW40 diff:\n");1364RTW_PRINT_SEL(sel, "%4s ", "");1365for (tx_idx = RF_1TX; tx_idx < MAX_TX_COUNT && tx_idx < max_tx_cnt; tx_idx++)1366_RTW_PRINT_SEL(sel, "%dS ", tx_idx + 1);1367_RTW_PRINT_SEL(sel, "\n");1368for (path = 0; path < MAX_RF_PATH && path < rfpath_num; path++) {1369RTW_PRINT_SEL(sel, "[%c]: ", rf_path_char(path));1370for (tx_idx = RF_1TX; tx_idx < MAX_TX_COUNT && tx_idx < max_tx_cnt; tx_idx++)1371_RTW_PRINT_SEL(sel, "%2d ", hal_data->BW40_5G_Diff[path][tx_idx]);1372_RTW_PRINT_SEL(sel, "\n");1373}1374RTW_PRINT_SEL(sel, "\n");13751376RTW_PRINT_SEL(sel, "BW80 diff:\n");1377RTW_PRINT_SEL(sel, "%4s ", "");1378for (tx_idx = RF_1TX; tx_idx < MAX_TX_COUNT && tx_idx < max_tx_cnt; tx_idx++)1379_RTW_PRINT_SEL(sel, "%dS ", tx_idx + 1);1380_RTW_PRINT_SEL(sel, "\n");1381for (path = 0; path < MAX_RF_PATH && path < rfpath_num; path++) {1382RTW_PRINT_SEL(sel, "[%c]: ", rf_path_char(path));1383for (tx_idx = RF_1TX; tx_idx < MAX_TX_COUNT && tx_idx < max_tx_cnt; tx_idx++)1384_RTW_PRINT_SEL(sel, "%2d ", hal_data->BW80_5G_Diff[path][tx_idx]);1385_RTW_PRINT_SEL(sel, "\n");1386}1387RTW_PRINT_SEL(sel, "\n");1388#endif /* CONFIG_IEEE80211_BAND_5GHZ */1389}1390#endif /* CONFIG_USE_TSSI */13911392/*1393* rtw_regsty_get_target_tx_power -1394*1395* Return dBm or -1 for undefined1396*/1397s8 rtw_regsty_get_target_tx_power(1398PADAPTER Adapter,1399u8 Band,1400u8 RfPath,1401RATE_SECTION RateSection1402)1403{1404struct registry_priv *regsty = adapter_to_regsty(Adapter);1405s8 value = 0;14061407if (RfPath > RF_PATH_D) {1408RTW_PRINT("%s invalid RfPath:%d\n", __func__, RfPath);1409return -1;1410}14111412if (Band != BAND_ON_2_4G1413#ifdef CONFIG_IEEE80211_BAND_5GHZ1414&& Band != BAND_ON_5G1415#endif1416) {1417RTW_PRINT("%s invalid Band:%d\n", __func__, Band);1418return -1;1419}14201421if (RateSection >= RATE_SECTION_NUM1422#ifdef CONFIG_IEEE80211_BAND_5GHZ1423|| (Band == BAND_ON_5G && RateSection == CCK)1424#endif1425) {1426RTW_PRINT("%s invalid RateSection:%d in Band:%d, RfPath:%d\n", __func__1427, RateSection, Band, RfPath);1428return -1;1429}14301431if (Band == BAND_ON_2_4G)1432value = regsty->target_tx_pwr_2g[RfPath][RateSection];1433#ifdef CONFIG_IEEE80211_BAND_5GHZ1434else /* BAND_ON_5G */1435value = regsty->target_tx_pwr_5g[RfPath][RateSection - 1];1436#endif14371438return value;1439}14401441bool rtw_regsty_chk_target_tx_power_valid(_adapter *adapter)1442{1443struct hal_spec_t *hal_spec = GET_HAL_SPEC(adapter);1444int path, tx_num, band, rs;1445s8 target;14461447for (band = BAND_ON_2_4G; band <= BAND_ON_5G; band++) {1448if (!hal_is_band_support(adapter, band))1449continue;14501451for (path = 0; path < RF_PATH_MAX; path++) {1452if (!HAL_SPEC_CHK_RF_PATH(hal_spec, band, path))1453break;14541455for (rs = 0; rs < RATE_SECTION_NUM; rs++) {1456tx_num = rate_section_to_tx_num(rs);1457if (tx_num + 1 > GET_HAL_TX_NSS(adapter))1458continue;14591460if (band == BAND_ON_5G && IS_CCK_RATE_SECTION(rs))1461continue;14621463if (IS_VHT_RATE_SECTION(rs) && !IS_HARDWARE_TYPE_JAGUAR_ALL(adapter))1464continue;14651466target = rtw_regsty_get_target_tx_power(adapter, band, path, rs);1467if (target == -1) {1468RTW_PRINT("%s return _FALSE for band:%d, path:%d, rs:%d, t:%d\n", __func__, band, path, rs, target);1469return _FALSE;1470}1471}1472}1473}14741475return _TRUE;1476}14771478#ifndef CONFIG_USE_TSSI1479/*1480* PHY_GetTxPowerByRateBase -1481*1482* Return value in unit of TX Gain Index1483*/1484u81485PHY_GetTxPowerByRateBase(1486PADAPTER Adapter,1487u8 Band,1488u8 RfPath,1489RATE_SECTION RateSection1490)1491{1492HAL_DATA_TYPE *pHalData = GET_HAL_DATA(Adapter);1493u8 value = 0;14941495if (RfPath > RF_PATH_D) {1496RTW_PRINT("%s invalid RfPath:%d\n", __func__, RfPath);1497return 0;1498}14991500if (Band != BAND_ON_2_4G && Band != BAND_ON_5G) {1501RTW_PRINT("%s invalid Band:%d\n", __func__, Band);1502return 0;1503}15041505if (RateSection >= RATE_SECTION_NUM1506|| (Band == BAND_ON_5G && RateSection == CCK)1507) {1508RTW_PRINT("%s invalid RateSection:%d in Band:%d, RfPath:%d\n", __func__1509, RateSection, Band, RfPath);1510return 0;1511}15121513if (Band == BAND_ON_2_4G)1514value = pHalData->TxPwrByRateBase2_4G[RfPath][RateSection];1515else /* BAND_ON_5G */1516value = pHalData->TxPwrByRateBase5G[RfPath][RateSection - 1];15171518return value;1519}15201521void1522phy_SetTxPowerByRateBase(1523PADAPTER Adapter,1524u8 Band,1525u8 RfPath,1526RATE_SECTION RateSection,1527u8 Value1528)1529{1530HAL_DATA_TYPE *pHalData = GET_HAL_DATA(Adapter);15311532if (RfPath > RF_PATH_D) {1533RTW_PRINT("%s invalid RfPath:%d\n", __func__, RfPath);1534return;1535}15361537if (Band != BAND_ON_2_4G && Band != BAND_ON_5G) {1538RTW_PRINT("%s invalid Band:%d\n", __func__, Band);1539return;1540}15411542if (RateSection >= RATE_SECTION_NUM1543|| (Band == BAND_ON_5G && RateSection == CCK)1544) {1545RTW_PRINT("%s invalid RateSection:%d in %sG, RfPath:%d\n", __func__1546, RateSection, (Band == BAND_ON_2_4G) ? "2.4" : "5", RfPath);1547return;1548}15491550if (Band == BAND_ON_2_4G)1551pHalData->TxPwrByRateBase2_4G[RfPath][RateSection] = Value;1552else /* BAND_ON_5G */1553pHalData->TxPwrByRateBase5G[RfPath][RateSection - 1] = Value;1554}1555#endif /* !CONFIG_USE_TSSI */15561557static inline BOOLEAN phy_is_txpwr_by_rate_undefined_of_band_path(_adapter *adapter, u8 band, u8 path)1558{1559HAL_DATA_TYPE *hal_data = GET_HAL_DATA(adapter);1560u8 rate_idx = 0;15611562for (rate_idx = 0; rate_idx < TX_PWR_BY_RATE_NUM_RATE; rate_idx++) {1563if (hal_data->TxPwrByRateOffset[band][path][rate_idx] != 0)1564goto exit;1565}15661567exit:1568return rate_idx >= TX_PWR_BY_RATE_NUM_RATE ? _TRUE : _FALSE;1569}15701571static inline void phy_txpwr_by_rate_duplicate_band_path(_adapter *adapter, u8 band, u8 s_path, u8 t_path)1572{1573HAL_DATA_TYPE *hal_data = GET_HAL_DATA(adapter);1574u8 rate_idx = 0;15751576for (rate_idx = 0; rate_idx < TX_PWR_BY_RATE_NUM_RATE; rate_idx++)1577hal_data->TxPwrByRateOffset[band][t_path][rate_idx] = hal_data->TxPwrByRateOffset[band][s_path][rate_idx];1578}15791580static void phy_txpwr_by_rate_chk_for_path_dup(_adapter *adapter)1581{1582struct hal_spec_t *hal_spec = GET_HAL_SPEC(adapter);1583HAL_DATA_TYPE *hal_data = GET_HAL_DATA(adapter);1584u8 band, path;1585s8 src_path;15861587for (band = BAND_ON_2_4G; band <= BAND_ON_5G; band++)1588for (path = RF_PATH_A; path < RF_PATH_MAX; path++)1589hal_data->txpwr_by_rate_undefined_band_path[band][path] = 0;15901591for (band = BAND_ON_2_4G; band <= BAND_ON_5G; band++) {1592if (!hal_is_band_support(adapter, band))1593continue;15941595for (path = RF_PATH_A; path < RF_PATH_MAX; path++) {1596if (!HAL_SPEC_CHK_RF_PATH(hal_spec, band, path))1597continue;15981599if (phy_is_txpwr_by_rate_undefined_of_band_path(adapter, band, path))1600hal_data->txpwr_by_rate_undefined_band_path[band][path] = 1;1601}1602}16031604for (band = BAND_ON_2_4G; band <= BAND_ON_5G; band++) {1605if (!hal_is_band_support(adapter, band))1606continue;16071608src_path = -1;1609for (path = RF_PATH_A; path < RF_PATH_MAX; path++) {1610if (!HAL_SPEC_CHK_RF_PATH(hal_spec, band, path))1611continue;16121613/* find src */1614if (src_path == -1 && hal_data->txpwr_by_rate_undefined_band_path[band][path] == 0)1615src_path = path;1616}16171618if (src_path == -1) {1619RTW_ERR("%s all power by rate undefined\n", __func__);1620continue;1621}16221623for (path = RF_PATH_A; path < RF_PATH_MAX; path++) {1624if (!HAL_SPEC_CHK_RF_PATH(hal_spec, band, path))1625continue;16261627/* duplicate src to undefined one */1628if (hal_data->txpwr_by_rate_undefined_band_path[band][path] == 1) {1629RTW_INFO("%s duplicate %s [%c] to [%c]\n", __func__1630, band_str(band), rf_path_char(src_path), rf_path_char(path));1631phy_txpwr_by_rate_duplicate_band_path(adapter, band, src_path, path);1632}1633}1634}1635}16361637#ifdef CONFIG_USE_TSSI1638static void phy_save_original_txpwr_by_rate(_adapter *adapter)1639{1640HAL_DATA_TYPE *hal_data = GET_HAL_DATA(adapter);16411642_rtw_memcpy(hal_data->TxPwrByRate, hal_data->TxPwrByRateOffset, sizeof(hal_data->TxPwrByRate));1643}1644#endif16451646#ifndef CONFIG_USE_TSSI1647void1648phy_StoreTxPowerByRateBase(1649PADAPTER pAdapter1650)1651{1652struct hal_spec_t *hal_spec = GET_HAL_SPEC(pAdapter);1653struct registry_priv *regsty = adapter_to_regsty(pAdapter);16541655u8 rate_sec_base[RATE_SECTION_NUM] = {1656MGN_11M,1657MGN_54M,1658MGN_MCS7,1659MGN_MCS15,1660MGN_MCS23,1661MGN_MCS31,1662MGN_VHT1SS_MCS7,1663MGN_VHT2SS_MCS7,1664MGN_VHT3SS_MCS7,1665MGN_VHT4SS_MCS7,1666};16671668u8 band, path, rs, tx_num, base;16691670for (band = BAND_ON_2_4G; band <= BAND_ON_5G; band++) {1671if (!hal_is_band_support(pAdapter, band))1672continue;16731674for (path = RF_PATH_A; path < RF_PATH_MAX; path++) {1675if (!HAL_SPEC_CHK_RF_PATH(hal_spec, band, path))1676break;16771678for (rs = 0; rs < RATE_SECTION_NUM; rs++) {1679tx_num = rate_section_to_tx_num(rs);1680if (tx_num + 1 > GET_HAL_TX_NSS(pAdapter))1681continue;16821683if (band == BAND_ON_5G && IS_CCK_RATE_SECTION(rs))1684continue;16851686if (IS_VHT_RATE_SECTION(rs) && !IS_HARDWARE_TYPE_JAGUAR_ALL(pAdapter))1687continue;16881689if (regsty->target_tx_pwr_valid == _TRUE)1690base = hal_spec->txgi_pdbm * rtw_regsty_get_target_tx_power(pAdapter, band, path, rs);1691else1692base = _PHY_GetTxPowerByRate(pAdapter, band, path, rate_sec_base[rs]);1693phy_SetTxPowerByRateBase(pAdapter, band, path, rs, base);1694}1695}1696}1697}1698#endif16991700static u8 get_val_from_dhex(u32 dhex, u8 i)1701{1702return (((dhex >> (i * 8 + 4)) & 0xF)) * 10 + ((dhex >> (i * 8)) & 0xF);1703}17041705static u8 get_val_from_hex(u32 hex, u8 i)1706{1707return (hex >> (i * 8)) & 0xFF;1708}17091710void1711PHY_GetRateValuesOfTxPowerByRate(1712PADAPTER pAdapter,1713u32 RegAddr,1714u32 BitMask,1715u32 Value,1716u8 *Rate,1717s8 *PwrByRateVal,1718u8 *RateNum1719)1720{1721HAL_DATA_TYPE *pHalData = GET_HAL_DATA(pAdapter);1722struct dm_struct *pDM_Odm = &pHalData->odmpriv;1723u8 i = 0;1724u8 (*get_val)(u32, u8);17251726if (pDM_Odm->phy_reg_pg_version == 1)1727get_val = get_val_from_dhex;1728else1729get_val = get_val_from_hex;17301731switch (RegAddr) {1732case rTxAGC_A_Rate18_06:1733case rTxAGC_B_Rate18_06:1734Rate[0] = MGN_6M;1735Rate[1] = MGN_9M;1736Rate[2] = MGN_12M;1737Rate[3] = MGN_18M;1738for (i = 0; i < 4; ++i)1739PwrByRateVal[i] = (s8)get_val(Value, i);1740*RateNum = 4;1741break;17421743case rTxAGC_A_Rate54_24:1744case rTxAGC_B_Rate54_24:1745Rate[0] = MGN_24M;1746Rate[1] = MGN_36M;1747Rate[2] = MGN_48M;1748Rate[3] = MGN_54M;1749for (i = 0; i < 4; ++i)1750PwrByRateVal[i] = (s8)get_val(Value, i);1751*RateNum = 4;1752break;17531754case rTxAGC_A_CCK1_Mcs32:1755Rate[0] = MGN_1M;1756PwrByRateVal[0] = (s8)get_val(Value, 1);1757*RateNum = 1;1758break;17591760case rTxAGC_B_CCK11_A_CCK2_11:1761if (BitMask == 0xffffff00) {1762Rate[0] = MGN_2M;1763Rate[1] = MGN_5_5M;1764Rate[2] = MGN_11M;1765for (i = 1; i < 4; ++i)1766PwrByRateVal[i - 1] = (s8)get_val(Value, i);1767*RateNum = 3;1768} else if (BitMask == 0x000000ff) {1769Rate[0] = MGN_11M;1770PwrByRateVal[0] = (s8)get_val(Value, 0);1771*RateNum = 1;1772}1773break;17741775case rTxAGC_A_Mcs03_Mcs00:1776case rTxAGC_B_Mcs03_Mcs00:1777Rate[0] = MGN_MCS0;1778Rate[1] = MGN_MCS1;1779Rate[2] = MGN_MCS2;1780Rate[3] = MGN_MCS3;1781for (i = 0; i < 4; ++i)1782PwrByRateVal[i] = (s8)get_val(Value, i);1783*RateNum = 4;1784break;17851786case rTxAGC_A_Mcs07_Mcs04:1787case rTxAGC_B_Mcs07_Mcs04:1788Rate[0] = MGN_MCS4;1789Rate[1] = MGN_MCS5;1790Rate[2] = MGN_MCS6;1791Rate[3] = MGN_MCS7;1792for (i = 0; i < 4; ++i)1793PwrByRateVal[i] = (s8)get_val(Value, i);1794*RateNum = 4;1795break;17961797case rTxAGC_A_Mcs11_Mcs08:1798case rTxAGC_B_Mcs11_Mcs08:1799Rate[0] = MGN_MCS8;1800Rate[1] = MGN_MCS9;1801Rate[2] = MGN_MCS10;1802Rate[3] = MGN_MCS11;1803for (i = 0; i < 4; ++i)1804PwrByRateVal[i] = (s8)get_val(Value, i);1805*RateNum = 4;1806break;18071808case rTxAGC_A_Mcs15_Mcs12:1809case rTxAGC_B_Mcs15_Mcs12:1810Rate[0] = MGN_MCS12;1811Rate[1] = MGN_MCS13;1812Rate[2] = MGN_MCS14;1813Rate[3] = MGN_MCS15;1814for (i = 0; i < 4; ++i)1815PwrByRateVal[i] = (s8)get_val(Value, i);1816*RateNum = 4;1817break;18181819case rTxAGC_B_CCK1_55_Mcs32:1820Rate[0] = MGN_1M;1821Rate[1] = MGN_2M;1822Rate[2] = MGN_5_5M;1823for (i = 1; i < 4; ++i)1824PwrByRateVal[i - 1] = (s8)get_val(Value, i);1825*RateNum = 3;1826break;18271828case 0xC20:1829case 0xE20:1830case 0x1820:1831case 0x1a20:1832Rate[0] = MGN_1M;1833Rate[1] = MGN_2M;1834Rate[2] = MGN_5_5M;1835Rate[3] = MGN_11M;1836for (i = 0; i < 4; ++i)1837PwrByRateVal[i] = (s8)get_val(Value, i);1838*RateNum = 4;1839break;18401841case 0xC24:1842case 0xE24:1843case 0x1824:1844case 0x1a24:1845Rate[0] = MGN_6M;1846Rate[1] = MGN_9M;1847Rate[2] = MGN_12M;1848Rate[3] = MGN_18M;1849for (i = 0; i < 4; ++i)1850PwrByRateVal[i] = (s8)get_val(Value, i);1851*RateNum = 4;1852break;18531854case 0xC28:1855case 0xE28:1856case 0x1828:1857case 0x1a28:1858Rate[0] = MGN_24M;1859Rate[1] = MGN_36M;1860Rate[2] = MGN_48M;1861Rate[3] = MGN_54M;1862for (i = 0; i < 4; ++i)1863PwrByRateVal[i] = (s8)get_val(Value, i);1864*RateNum = 4;1865break;18661867case 0xC2C:1868case 0xE2C:1869case 0x182C:1870case 0x1a2C:1871Rate[0] = MGN_MCS0;1872Rate[1] = MGN_MCS1;1873Rate[2] = MGN_MCS2;1874Rate[3] = MGN_MCS3;1875for (i = 0; i < 4; ++i)1876PwrByRateVal[i] = (s8)get_val(Value, i);1877*RateNum = 4;1878break;18791880case 0xC30:1881case 0xE30:1882case 0x1830:1883case 0x1a30:1884Rate[0] = MGN_MCS4;1885Rate[1] = MGN_MCS5;1886Rate[2] = MGN_MCS6;1887Rate[3] = MGN_MCS7;1888for (i = 0; i < 4; ++i)1889PwrByRateVal[i] = (s8)get_val(Value, i);1890*RateNum = 4;1891break;18921893case 0xC34:1894case 0xE34:1895case 0x1834:1896case 0x1a34:1897Rate[0] = MGN_MCS8;1898Rate[1] = MGN_MCS9;1899Rate[2] = MGN_MCS10;1900Rate[3] = MGN_MCS11;1901for (i = 0; i < 4; ++i)1902PwrByRateVal[i] = (s8)get_val(Value, i);1903*RateNum = 4;1904break;19051906case 0xC38:1907case 0xE38:1908case 0x1838:1909case 0x1a38:1910Rate[0] = MGN_MCS12;1911Rate[1] = MGN_MCS13;1912Rate[2] = MGN_MCS14;1913Rate[3] = MGN_MCS15;1914for (i = 0; i < 4; ++i)1915PwrByRateVal[i] = (s8)get_val(Value, i);1916*RateNum = 4;1917break;19181919case 0xC3C:1920case 0xE3C:1921case 0x183C:1922case 0x1a3C:1923Rate[0] = MGN_VHT1SS_MCS0;1924Rate[1] = MGN_VHT1SS_MCS1;1925Rate[2] = MGN_VHT1SS_MCS2;1926Rate[3] = MGN_VHT1SS_MCS3;1927for (i = 0; i < 4; ++i)1928PwrByRateVal[i] = (s8)get_val(Value, i);1929*RateNum = 4;1930break;19311932case 0xC40:1933case 0xE40:1934case 0x1840:1935case 0x1a40:1936Rate[0] = MGN_VHT1SS_MCS4;1937Rate[1] = MGN_VHT1SS_MCS5;1938Rate[2] = MGN_VHT1SS_MCS6;1939Rate[3] = MGN_VHT1SS_MCS7;1940for (i = 0; i < 4; ++i)1941PwrByRateVal[i] = (s8)get_val(Value, i);1942*RateNum = 4;1943break;19441945case 0xC44:1946case 0xE44:1947case 0x1844:1948case 0x1a44:1949Rate[0] = MGN_VHT1SS_MCS8;1950Rate[1] = MGN_VHT1SS_MCS9;1951Rate[2] = MGN_VHT2SS_MCS0;1952Rate[3] = MGN_VHT2SS_MCS1;1953for (i = 0; i < 4; ++i)1954PwrByRateVal[i] = (s8)get_val(Value, i);1955*RateNum = 4;1956break;19571958case 0xC48:1959case 0xE48:1960case 0x1848:1961case 0x1a48:1962Rate[0] = MGN_VHT2SS_MCS2;1963Rate[1] = MGN_VHT2SS_MCS3;1964Rate[2] = MGN_VHT2SS_MCS4;1965Rate[3] = MGN_VHT2SS_MCS5;1966for (i = 0; i < 4; ++i)1967PwrByRateVal[i] = (s8)get_val(Value, i);1968*RateNum = 4;1969break;19701971case 0xC4C:1972case 0xE4C:1973case 0x184C:1974case 0x1a4C:1975Rate[0] = MGN_VHT2SS_MCS6;1976Rate[1] = MGN_VHT2SS_MCS7;1977Rate[2] = MGN_VHT2SS_MCS8;1978Rate[3] = MGN_VHT2SS_MCS9;1979for (i = 0; i < 4; ++i)1980PwrByRateVal[i] = (s8)get_val(Value, i);1981*RateNum = 4;1982break;19831984case 0xCD8:1985case 0xED8:1986case 0x18D8:1987case 0x1aD8:1988Rate[0] = MGN_MCS16;1989Rate[1] = MGN_MCS17;1990Rate[2] = MGN_MCS18;1991Rate[3] = MGN_MCS19;1992for (i = 0; i < 4; ++i)1993PwrByRateVal[i] = (s8)get_val(Value, i);1994*RateNum = 4;1995break;19961997case 0xCDC:1998case 0xEDC:1999case 0x18DC:2000case 0x1aDC:2001Rate[0] = MGN_MCS20;2002Rate[1] = MGN_MCS21;2003Rate[2] = MGN_MCS22;2004Rate[3] = MGN_MCS23;2005for (i = 0; i < 4; ++i)2006PwrByRateVal[i] = (s8)get_val(Value, i);2007*RateNum = 4;2008break;20092010case 0x3a24: /* HT MCS24-27 */2011Rate[0] = MGN_MCS24;2012Rate[1] = MGN_MCS25;2013Rate[2] = MGN_MCS26;2014Rate[3] = MGN_MCS27;2015for (i = 0; i < 4; ++i)2016PwrByRateVal[i] = (s8)get_val(Value, i);2017*RateNum = 4;2018break;20192020case 0x3a28: /* HT MCS28-31 */2021Rate[0] = MGN_MCS28;2022Rate[1] = MGN_MCS29;2023Rate[2] = MGN_MCS30;2024Rate[3] = MGN_MCS31;2025for (i = 0; i < 4; ++i)2026PwrByRateVal[i] = (s8)get_val(Value, i);2027*RateNum = 4;2028break;20292030case 0xCE0:2031case 0xEE0:2032case 0x18E0:2033case 0x1aE0:2034Rate[0] = MGN_VHT3SS_MCS0;2035Rate[1] = MGN_VHT3SS_MCS1;2036Rate[2] = MGN_VHT3SS_MCS2;2037Rate[3] = MGN_VHT3SS_MCS3;2038for (i = 0; i < 4; ++i)2039PwrByRateVal[i] = (s8)get_val(Value, i);2040*RateNum = 4;2041break;20422043case 0xCE4:2044case 0xEE4:2045case 0x18E4:2046case 0x1aE4:2047Rate[0] = MGN_VHT3SS_MCS4;2048Rate[1] = MGN_VHT3SS_MCS5;2049Rate[2] = MGN_VHT3SS_MCS6;2050Rate[3] = MGN_VHT3SS_MCS7;2051for (i = 0; i < 4; ++i)2052PwrByRateVal[i] = (s8)get_val(Value, i);2053*RateNum = 4;2054break;20552056case 0xCE8:2057case 0xEE8:2058case 0x18E8:2059case 0x1aE8:2060case 0x3a48:2061Rate[0] = MGN_VHT3SS_MCS8;2062Rate[1] = MGN_VHT3SS_MCS9;2063Rate[2] = MGN_VHT4SS_MCS0;2064Rate[3] = MGN_VHT4SS_MCS1;2065for (i = 0; i < 4; ++i)2066PwrByRateVal[i] = (s8)get_val(Value, i);2067*RateNum = 4;2068break;20692070case 0x3a4c:2071Rate[0] = MGN_VHT4SS_MCS2;2072Rate[1] = MGN_VHT4SS_MCS3;2073Rate[2] = MGN_VHT4SS_MCS4;2074Rate[3] = MGN_VHT4SS_MCS5;2075for (i = 0; i < 4; ++i)2076PwrByRateVal[i] = (s8)get_val(Value, i);2077*RateNum = 4;2078break;20792080case 0x3a50:2081Rate[0] = MGN_VHT4SS_MCS6;2082Rate[1] = MGN_VHT4SS_MCS7;2083Rate[2] = MGN_VHT4SS_MCS8;2084Rate[3] = MGN_VHT4SS_MCS9;2085for (i = 0; i < 4; ++i)2086PwrByRateVal[i] = (s8)get_val(Value, i);2087*RateNum = 4;2088break;20892090default:2091RTW_PRINT("Invalid RegAddr 0x%x in %s()\n", RegAddr, __func__);2092break;2093};2094}20952096void2097PHY_StoreTxPowerByRateNew(2098PADAPTER pAdapter,2099u32 Band,2100u32 RfPath,2101u32 RegAddr,2102u32 BitMask,2103u32 Data2104)2105{2106HAL_DATA_TYPE *pHalData = GET_HAL_DATA(pAdapter);2107u8 i = 0, rates[4] = {0}, rateNum = 0;2108s8 PwrByRateVal[4] = {0};21092110PHY_GetRateValuesOfTxPowerByRate(pAdapter, RegAddr, BitMask, Data, rates, PwrByRateVal, &rateNum);21112112if (Band != BAND_ON_2_4G && Band != BAND_ON_5G) {2113RTW_PRINT("Invalid Band %d\n", Band);2114return;2115}21162117if (RfPath > RF_PATH_D) {2118RTW_PRINT("Invalid RfPath %d\n", RfPath);2119return;2120}21212122for (i = 0; i < rateNum; ++i) {2123u8 rate_idx = PHY_GetRateIndexOfTxPowerByRate(rates[i]);21242125pHalData->TxPwrByRateOffset[Band][RfPath][rate_idx] = PwrByRateVal[i];2126}2127}21282129void2130PHY_InitTxPowerByRate(2131PADAPTER pAdapter2132)2133{2134HAL_DATA_TYPE *pHalData = GET_HAL_DATA(pAdapter);2135u8 band = 0, rfPath = 0, rate = 0;21362137for (band = BAND_ON_2_4G; band <= BAND_ON_5G; ++band)2138for (rfPath = 0; rfPath < TX_PWR_BY_RATE_NUM_RF; ++rfPath)2139for (rate = 0; rate < TX_PWR_BY_RATE_NUM_RATE; ++rate)2140pHalData->TxPwrByRateOffset[band][rfPath][rate] = 0;2141}21422143void2144phy_store_tx_power_by_rate(2145PADAPTER pAdapter,2146u32 Band,2147u32 RfPath,2148u32 TxNum,2149u32 RegAddr,2150u32 BitMask,2151u32 Data2152)2153{2154HAL_DATA_TYPE *pHalData = GET_HAL_DATA(pAdapter);2155struct dm_struct *pDM_Odm = &pHalData->odmpriv;21562157if (pDM_Odm->phy_reg_pg_version > 0)2158PHY_StoreTxPowerByRateNew(pAdapter, Band, RfPath, RegAddr, BitMask, Data);2159else2160RTW_INFO("Invalid PHY_REG_PG.txt version %d\n", pDM_Odm->phy_reg_pg_version);21612162}21632164#ifdef CONFIG_USE_TSSI2165void2166phy_ConvertTxPowerByRateInDbmToRelativeValues_TSSI(2167PADAPTER pAdapter2168)2169{2170u8 base = 0, i = 0, value = 0,2171band = 0, path = 0;2172u8 cckRates[4] = {MGN_1M, MGN_2M, MGN_5_5M, MGN_11M},2173ofdmRates[8] = {MGN_6M, MGN_9M, MGN_12M, MGN_18M, MGN_24M, MGN_36M, MGN_48M, MGN_54M},2174mcs0_7Rates[8] = {MGN_MCS0, MGN_MCS1, MGN_MCS2, MGN_MCS3, MGN_MCS4, MGN_MCS5, MGN_MCS6, MGN_MCS7},2175mcs8_15Rates[8] = {MGN_MCS8, MGN_MCS9, MGN_MCS10, MGN_MCS11, MGN_MCS12, MGN_MCS13, MGN_MCS14, MGN_MCS15},2176mcs16_23Rates[8] = {MGN_MCS16, MGN_MCS17, MGN_MCS18, MGN_MCS19, MGN_MCS20, MGN_MCS21, MGN_MCS22, MGN_MCS23},2177mcs24_31Rates[8] = {MGN_MCS24, MGN_MCS25, MGN_MCS26, MGN_MCS27, MGN_MCS28, MGN_MCS29, MGN_MCS30, MGN_MCS31},2178vht1ssRates[10] = {MGN_VHT1SS_MCS0, MGN_VHT1SS_MCS1, MGN_VHT1SS_MCS2, MGN_VHT1SS_MCS3, MGN_VHT1SS_MCS4,2179MGN_VHT1SS_MCS5, MGN_VHT1SS_MCS6, MGN_VHT1SS_MCS7, MGN_VHT1SS_MCS8, MGN_VHT1SS_MCS9},2180vht2ssRates[10] = {MGN_VHT2SS_MCS0, MGN_VHT2SS_MCS1, MGN_VHT2SS_MCS2, MGN_VHT2SS_MCS3, MGN_VHT2SS_MCS4,2181MGN_VHT2SS_MCS5, MGN_VHT2SS_MCS6, MGN_VHT2SS_MCS7, MGN_VHT2SS_MCS8, MGN_VHT2SS_MCS9},2182vht3ssRates[10] = {MGN_VHT3SS_MCS0, MGN_VHT3SS_MCS1, MGN_VHT3SS_MCS2, MGN_VHT3SS_MCS3, MGN_VHT3SS_MCS4,2183MGN_VHT3SS_MCS5, MGN_VHT3SS_MCS6, MGN_VHT3SS_MCS7, MGN_VHT3SS_MCS8, MGN_VHT3SS_MCS9},2184vht4ssRates[10] = {MGN_VHT4SS_MCS0, MGN_VHT4SS_MCS1, MGN_VHT4SS_MCS2, MGN_VHT4SS_MCS3, MGN_VHT4SS_MCS4,2185MGN_VHT4SS_MCS5, MGN_VHT4SS_MCS6, MGN_VHT4SS_MCS7, MGN_VHT4SS_MCS8, MGN_VHT4SS_MCS9};21862187/* RTW_INFO("===>%s()\n", __func__); */21882189for (band = BAND_ON_2_4G; band <= BAND_ON_5G; ++band) {2190for (path = RF_PATH_A; path <= RF_PATH_D; ++path) {2191base = PHY_GetTxPowerByRate(pAdapter, band, path, MGN_MCS7);21922193/* CCK */2194for (i = 0; i < sizeof(cckRates); ++i) {2195value = PHY_GetTxPowerByRate(pAdapter, band, path, cckRates[i]);2196PHY_SetTxPowerByRate(pAdapter, band, path, cckRates[i], value - base);2197}21982199/* OFDM */2200for (i = 0; i < sizeof(ofdmRates); ++i) {2201value = PHY_GetTxPowerByRate(pAdapter, band, path, ofdmRates[i]);2202PHY_SetTxPowerByRate(pAdapter, band, path, ofdmRates[i], value - base);2203}22042205/* HT MCS0~7 */2206for (i = 0; i < sizeof(mcs0_7Rates); ++i) {2207value = PHY_GetTxPowerByRate(pAdapter, band, path, mcs0_7Rates[i]);2208PHY_SetTxPowerByRate(pAdapter, band, path, mcs0_7Rates[i], value - base);2209}22102211/* HT MCS8~15 */2212for (i = 0; i < sizeof(mcs8_15Rates); ++i) {2213value = PHY_GetTxPowerByRate(pAdapter, band, path, mcs8_15Rates[i]);2214PHY_SetTxPowerByRate(pAdapter, band, path, mcs8_15Rates[i], value - base);2215}22162217/* HT MCS16~23 */2218for (i = 0; i < sizeof(mcs16_23Rates); ++i) {2219value = PHY_GetTxPowerByRate(pAdapter, band, path, mcs16_23Rates[i]);2220PHY_SetTxPowerByRate(pAdapter, band, path, mcs16_23Rates[i], value - base);2221}22222223/* HT MCS24~31 */2224for (i = 0; i < sizeof(mcs24_31Rates); ++i) {2225value = PHY_GetTxPowerByRate(pAdapter, band, path, mcs24_31Rates[i]);2226PHY_SetTxPowerByRate(pAdapter, band, path, mcs24_31Rates[i], value - base);2227}22282229/* VHT 1SS */2230for (i = 0; i < sizeof(vht1ssRates); ++i) {2231value = PHY_GetTxPowerByRate(pAdapter, band, path, vht1ssRates[i]);2232PHY_SetTxPowerByRate(pAdapter, band, path, vht1ssRates[i], value - base);2233}22342235/* VHT 2SS */2236for (i = 0; i < sizeof(vht2ssRates); ++i) {2237value = PHY_GetTxPowerByRate(pAdapter, band, path, vht2ssRates[i]);2238PHY_SetTxPowerByRate(pAdapter, band, path, vht2ssRates[i], value - base);2239}22402241/* VHT 3SS */2242for (i = 0; i < sizeof(vht3ssRates); ++i) {2243value = PHY_GetTxPowerByRate(pAdapter, band, path, vht3ssRates[i]);2244PHY_SetTxPowerByRate(pAdapter, band, path, vht3ssRates[i], value - base);2245}22462247/* VHT 4SS */2248for (i = 0; i < sizeof(vht4ssRates); ++i) {2249value = PHY_GetTxPowerByRate(pAdapter, band, path, vht4ssRates[i]);2250PHY_SetTxPowerByRate(pAdapter, band, path, vht4ssRates[i], value - base);2251}2252}2253}22542255/* RTW_INFO("<===%s()\n", __func__); */2256}2257#else2258void2259phy_ConvertTxPowerByRateInDbmToRelativeValues(2260PADAPTER pAdapter2261)2262{2263u8 base = 0, i = 0, value = 0,2264band = 0, path = 0;2265u8 cckRates[4] = {MGN_1M, MGN_2M, MGN_5_5M, MGN_11M},2266ofdmRates[8] = {MGN_6M, MGN_9M, MGN_12M, MGN_18M, MGN_24M, MGN_36M, MGN_48M, MGN_54M},2267mcs0_7Rates[8] = {MGN_MCS0, MGN_MCS1, MGN_MCS2, MGN_MCS3, MGN_MCS4, MGN_MCS5, MGN_MCS6, MGN_MCS7},2268mcs8_15Rates[8] = {MGN_MCS8, MGN_MCS9, MGN_MCS10, MGN_MCS11, MGN_MCS12, MGN_MCS13, MGN_MCS14, MGN_MCS15},2269mcs16_23Rates[8] = {MGN_MCS16, MGN_MCS17, MGN_MCS18, MGN_MCS19, MGN_MCS20, MGN_MCS21, MGN_MCS22, MGN_MCS23},2270mcs24_31Rates[8] = {MGN_MCS24, MGN_MCS25, MGN_MCS26, MGN_MCS27, MGN_MCS28, MGN_MCS29, MGN_MCS30, MGN_MCS31},2271vht1ssRates[10] = {MGN_VHT1SS_MCS0, MGN_VHT1SS_MCS1, MGN_VHT1SS_MCS2, MGN_VHT1SS_MCS3, MGN_VHT1SS_MCS4,2272MGN_VHT1SS_MCS5, MGN_VHT1SS_MCS6, MGN_VHT1SS_MCS7, MGN_VHT1SS_MCS8, MGN_VHT1SS_MCS9},2273vht2ssRates[10] = {MGN_VHT2SS_MCS0, MGN_VHT2SS_MCS1, MGN_VHT2SS_MCS2, MGN_VHT2SS_MCS3, MGN_VHT2SS_MCS4,2274MGN_VHT2SS_MCS5, MGN_VHT2SS_MCS6, MGN_VHT2SS_MCS7, MGN_VHT2SS_MCS8, MGN_VHT2SS_MCS9},2275vht3ssRates[10] = {MGN_VHT3SS_MCS0, MGN_VHT3SS_MCS1, MGN_VHT3SS_MCS2, MGN_VHT3SS_MCS3, MGN_VHT3SS_MCS4,2276MGN_VHT3SS_MCS5, MGN_VHT3SS_MCS6, MGN_VHT3SS_MCS7, MGN_VHT3SS_MCS8, MGN_VHT3SS_MCS9},2277vht4ssRates[10] = {MGN_VHT4SS_MCS0, MGN_VHT4SS_MCS1, MGN_VHT4SS_MCS2, MGN_VHT4SS_MCS3, MGN_VHT4SS_MCS4,2278MGN_VHT4SS_MCS5, MGN_VHT4SS_MCS6, MGN_VHT4SS_MCS7, MGN_VHT4SS_MCS8, MGN_VHT4SS_MCS9};22792280/* RTW_INFO("===>PHY_ConvertTxPowerByRateInDbmToRelativeValues()\n" ); */22812282for (band = BAND_ON_2_4G; band <= BAND_ON_5G; ++band) {2283for (path = RF_PATH_A; path <= RF_PATH_D; ++path) {2284/* CCK */2285if (band == BAND_ON_2_4G) {2286base = PHY_GetTxPowerByRateBase(pAdapter, band, path, CCK);2287for (i = 0; i < sizeof(cckRates); ++i) {2288value = PHY_GetTxPowerByRate(pAdapter, band, path, cckRates[i]);2289PHY_SetTxPowerByRate(pAdapter, band, path, cckRates[i], value - base);2290}2291}22922293/* OFDM */2294base = PHY_GetTxPowerByRateBase(pAdapter, band, path, OFDM);2295for (i = 0; i < sizeof(ofdmRates); ++i) {2296value = PHY_GetTxPowerByRate(pAdapter, band, path, ofdmRates[i]);2297PHY_SetTxPowerByRate(pAdapter, band, path, ofdmRates[i], value - base);2298}22992300/* HT MCS0~7 */2301base = PHY_GetTxPowerByRateBase(pAdapter, band, path, HT_1SS);2302for (i = 0; i < sizeof(mcs0_7Rates); ++i) {2303value = PHY_GetTxPowerByRate(pAdapter, band, path, mcs0_7Rates[i]);2304PHY_SetTxPowerByRate(pAdapter, band, path, mcs0_7Rates[i], value - base);2305}23062307/* HT MCS8~15 */2308base = PHY_GetTxPowerByRateBase(pAdapter, band, path, HT_2SS);2309for (i = 0; i < sizeof(mcs8_15Rates); ++i) {2310value = PHY_GetTxPowerByRate(pAdapter, band, path, mcs8_15Rates[i]);2311PHY_SetTxPowerByRate(pAdapter, band, path, mcs8_15Rates[i], value - base);2312}23132314/* HT MCS16~23 */2315base = PHY_GetTxPowerByRateBase(pAdapter, band, path, HT_3SS);2316for (i = 0; i < sizeof(mcs16_23Rates); ++i) {2317value = PHY_GetTxPowerByRate(pAdapter, band, path, mcs16_23Rates[i]);2318PHY_SetTxPowerByRate(pAdapter, band, path, mcs16_23Rates[i], value - base);2319}23202321/* HT MCS24~31 */2322base = PHY_GetTxPowerByRateBase(pAdapter, band, path, HT_4SS);2323for (i = 0; i < sizeof(mcs24_31Rates); ++i) {2324value = PHY_GetTxPowerByRate(pAdapter, band, path, mcs24_31Rates[i]);2325PHY_SetTxPowerByRate(pAdapter, band, path, mcs24_31Rates[i], value - base);2326}23272328/* VHT 1SS */2329base = PHY_GetTxPowerByRateBase(pAdapter, band, path, VHT_1SS);2330for (i = 0; i < sizeof(vht1ssRates); ++i) {2331value = PHY_GetTxPowerByRate(pAdapter, band, path, vht1ssRates[i]);2332PHY_SetTxPowerByRate(pAdapter, band, path, vht1ssRates[i], value - base);2333}23342335/* VHT 2SS */2336base = PHY_GetTxPowerByRateBase(pAdapter, band, path, VHT_2SS);2337for (i = 0; i < sizeof(vht2ssRates); ++i) {2338value = PHY_GetTxPowerByRate(pAdapter, band, path, vht2ssRates[i]);2339PHY_SetTxPowerByRate(pAdapter, band, path, vht2ssRates[i], value - base);2340}23412342/* VHT 3SS */2343base = PHY_GetTxPowerByRateBase(pAdapter, band, path, VHT_3SS);2344for (i = 0; i < sizeof(vht3ssRates); ++i) {2345value = PHY_GetTxPowerByRate(pAdapter, band, path, vht3ssRates[i]);2346PHY_SetTxPowerByRate(pAdapter, band, path, vht3ssRates[i], value - base);2347}23482349/* VHT 4SS */2350base = PHY_GetTxPowerByRateBase(pAdapter, band, path, VHT_4SS);2351for (i = 0; i < sizeof(vht4ssRates); ++i) {2352value = PHY_GetTxPowerByRate(pAdapter, band, path, vht4ssRates[i]);2353PHY_SetTxPowerByRate(pAdapter, band, path, vht4ssRates[i], value - base);2354}2355}2356}23572358/* RTW_INFO("<===PHY_ConvertTxPowerByRateInDbmToRelativeValues()\n" ); */2359}2360#endif /* CONFIG_USE_TSSI */23612362/*2363* This function must be called if the value in the PHY_REG_PG.txt(or header)2364* is exact dBm values2365*/2366void2367PHY_TxPowerByRateConfiguration(2368PADAPTER pAdapter2369)2370{2371phy_txpwr_by_rate_chk_for_path_dup(pAdapter);2372#ifdef CONFIG_USE_TSSI2373phy_save_original_txpwr_by_rate(pAdapter);2374phy_ConvertTxPowerByRateInDbmToRelativeValues_TSSI(pAdapter);2375#else2376phy_StoreTxPowerByRateBase(pAdapter);2377phy_ConvertTxPowerByRateInDbmToRelativeValues(pAdapter);2378#endif2379}23802381void2382phy_set_tx_power_index_by_rate_section(2383PADAPTER pAdapter,2384enum rf_path RFPath,2385u8 Channel,2386u8 RateSection2387)2388{2389PHAL_DATA_TYPE pHalData = GET_HAL_DATA(pAdapter);23902391if (RateSection >= RATE_SECTION_NUM) {2392RTW_INFO("Invalid RateSection %d in %s", RateSection, __func__);2393rtw_warn_on(1);2394goto exit;2395}23962397if (RateSection == CCK && pHalData->current_band_type != BAND_ON_2_4G)2398goto exit;23992400PHY_SetTxPowerIndexByRateArray(pAdapter, RFPath, pHalData->current_channel_bw, Channel,2401rates_by_sections[RateSection].rates, rates_by_sections[RateSection].rate_num);24022403exit:2404return;2405}24062407BOOLEAN2408phy_GetChnlIndex(2409u8 Channel,2410u8 *ChannelIdx2411)2412{2413u8 i = 0;2414BOOLEAN bIn24G = _TRUE;24152416if (Channel <= 14) {2417bIn24G = _TRUE;2418*ChannelIdx = Channel - 1;2419} else {2420bIn24G = _FALSE;24212422for (i = 0; i < CENTER_CH_5G_ALL_NUM; ++i) {2423if (center_ch_5g_all[i] == Channel) {2424*ChannelIdx = i;2425return bIn24G;2426}2427}2428}24292430return bIn24G;2431}24322433#ifndef CONFIG_USE_TSSI2434u8 phy_get_pg_txpwr_idx(2435PADAPTER pAdapter,2436enum rf_path RFPath,2437u8 Rate,2438u8 ntx_idx,2439enum channel_width BandWidth,2440u8 Channel,2441PBOOLEAN bIn24G2442)2443{2444PHAL_DATA_TYPE pHalData = GET_HAL_DATA(pAdapter);2445u8 i = 0; /* default set to 1S */2446u8 txPower = 0;2447u8 chnlIdx = (Channel - 1);24482449if (HAL_IsLegalChannel(pAdapter, Channel) == _FALSE) {2450chnlIdx = 0;2451RTW_INFO("Illegal channel!!\n");2452}24532454*bIn24G = phy_GetChnlIndex(Channel, &chnlIdx);24552456if (0)2457RTW_INFO("[%s] Channel Index: %d\n", (*bIn24G ? "2.4G" : "5G"), chnlIdx);24582459if (*bIn24G) {2460if (IS_CCK_RATE(Rate)) {2461/* CCK-nTX */2462txPower = pHalData->Index24G_CCK_Base[RFPath][chnlIdx];2463txPower += pHalData->CCK_24G_Diff[RFPath][RF_1TX];2464if (ntx_idx >= RF_2TX)2465txPower += pHalData->CCK_24G_Diff[RFPath][RF_2TX];2466if (ntx_idx >= RF_3TX)2467txPower += pHalData->CCK_24G_Diff[RFPath][RF_3TX];2468if (ntx_idx >= RF_4TX)2469txPower += pHalData->CCK_24G_Diff[RFPath][RF_4TX];2470goto exit;2471}24722473txPower = pHalData->Index24G_BW40_Base[RFPath][chnlIdx];24742475/* OFDM-nTX */2476if ((MGN_6M <= Rate && Rate <= MGN_54M) && !IS_CCK_RATE(Rate)) {2477txPower += pHalData->OFDM_24G_Diff[RFPath][RF_1TX];2478if (ntx_idx >= RF_2TX)2479txPower += pHalData->OFDM_24G_Diff[RFPath][RF_2TX];2480if (ntx_idx >= RF_3TX)2481txPower += pHalData->OFDM_24G_Diff[RFPath][RF_3TX];2482if (ntx_idx >= RF_4TX)2483txPower += pHalData->OFDM_24G_Diff[RFPath][RF_4TX];2484goto exit;2485}24862487/* BW20-nS */2488if (BandWidth == CHANNEL_WIDTH_20) {2489if ((MGN_MCS0 <= Rate && Rate <= MGN_MCS31) || (MGN_VHT1SS_MCS0 <= Rate && Rate <= MGN_VHT4SS_MCS9))2490txPower += pHalData->BW20_24G_Diff[RFPath][RF_1TX];2491if ((MGN_MCS8 <= Rate && Rate <= MGN_MCS31) || (MGN_VHT2SS_MCS0 <= Rate && Rate <= MGN_VHT4SS_MCS9))2492txPower += pHalData->BW20_24G_Diff[RFPath][RF_2TX];2493if ((MGN_MCS16 <= Rate && Rate <= MGN_MCS31) || (MGN_VHT3SS_MCS0 <= Rate && Rate <= MGN_VHT4SS_MCS9))2494txPower += pHalData->BW20_24G_Diff[RFPath][RF_3TX];2495if ((MGN_MCS24 <= Rate && Rate <= MGN_MCS31) || (MGN_VHT4SS_MCS0 <= Rate && Rate <= MGN_VHT4SS_MCS9))2496txPower += pHalData->BW20_24G_Diff[RFPath][RF_4TX];2497goto exit;2498}24992500/* BW40-nS */2501if (BandWidth == CHANNEL_WIDTH_40) {2502if ((MGN_MCS0 <= Rate && Rate <= MGN_MCS31) || (MGN_VHT1SS_MCS0 <= Rate && Rate <= MGN_VHT4SS_MCS9))2503txPower += pHalData->BW40_24G_Diff[RFPath][RF_1TX];2504if ((MGN_MCS8 <= Rate && Rate <= MGN_MCS31) || (MGN_VHT2SS_MCS0 <= Rate && Rate <= MGN_VHT4SS_MCS9))2505txPower += pHalData->BW40_24G_Diff[RFPath][RF_2TX];2506if ((MGN_MCS16 <= Rate && Rate <= MGN_MCS31) || (MGN_VHT3SS_MCS0 <= Rate && Rate <= MGN_VHT4SS_MCS9))2507txPower += pHalData->BW40_24G_Diff[RFPath][RF_3TX];2508if ((MGN_MCS24 <= Rate && Rate <= MGN_MCS31) || (MGN_VHT4SS_MCS0 <= Rate && Rate <= MGN_VHT4SS_MCS9))2509txPower += pHalData->BW40_24G_Diff[RFPath][RF_4TX];2510goto exit;2511}25122513/* Willis suggest adopt BW 40M power index while in BW 80 mode */2514if (BandWidth == CHANNEL_WIDTH_80) {2515if ((MGN_MCS0 <= Rate && Rate <= MGN_MCS31) || (MGN_VHT1SS_MCS0 <= Rate && Rate <= MGN_VHT4SS_MCS9))2516txPower += pHalData->BW40_24G_Diff[RFPath][RF_1TX];2517if ((MGN_MCS8 <= Rate && Rate <= MGN_MCS31) || (MGN_VHT2SS_MCS0 <= Rate && Rate <= MGN_VHT4SS_MCS9))2518txPower += pHalData->BW40_24G_Diff[RFPath][RF_2TX];2519if ((MGN_MCS16 <= Rate && Rate <= MGN_MCS31) || (MGN_VHT3SS_MCS0 <= Rate && Rate <= MGN_VHT4SS_MCS9))2520txPower += pHalData->BW40_24G_Diff[RFPath][RF_3TX];2521if ((MGN_MCS24 <= Rate && Rate <= MGN_MCS31) || (MGN_VHT4SS_MCS0 <= Rate && Rate <= MGN_VHT4SS_MCS9))2522txPower += pHalData->BW40_24G_Diff[RFPath][RF_4TX];2523goto exit;2524}2525}2526#ifdef CONFIG_IEEE80211_BAND_5GHZ2527else {2528if (Rate >= MGN_6M)2529txPower = pHalData->Index5G_BW40_Base[RFPath][chnlIdx];2530else {2531RTW_INFO("===>%s: INVALID Rate(0x%02x).\n", __func__, Rate);2532goto exit;2533}25342535/* OFDM-nTX */2536if ((MGN_6M <= Rate && Rate <= MGN_54M) && !IS_CCK_RATE(Rate)) {2537txPower += pHalData->OFDM_5G_Diff[RFPath][RF_1TX];2538if (ntx_idx >= RF_2TX)2539txPower += pHalData->OFDM_5G_Diff[RFPath][RF_2TX];2540if (ntx_idx >= RF_3TX)2541txPower += pHalData->OFDM_5G_Diff[RFPath][RF_3TX];2542if (ntx_idx >= RF_4TX)2543txPower += pHalData->OFDM_5G_Diff[RFPath][RF_4TX];2544goto exit;2545}25462547/* BW20-nS */2548if (BandWidth == CHANNEL_WIDTH_20) {2549if ((MGN_MCS0 <= Rate && Rate <= MGN_MCS31) || (MGN_VHT1SS_MCS0 <= Rate && Rate <= MGN_VHT4SS_MCS9))2550txPower += pHalData->BW20_5G_Diff[RFPath][RF_1TX];2551if ((MGN_MCS8 <= Rate && Rate <= MGN_MCS31) || (MGN_VHT2SS_MCS0 <= Rate && Rate <= MGN_VHT4SS_MCS9))2552txPower += pHalData->BW20_5G_Diff[RFPath][RF_2TX];2553if ((MGN_MCS16 <= Rate && Rate <= MGN_MCS31) || (MGN_VHT3SS_MCS0 <= Rate && Rate <= MGN_VHT4SS_MCS9))2554txPower += pHalData->BW20_5G_Diff[RFPath][RF_3TX];2555if ((MGN_MCS24 <= Rate && Rate <= MGN_MCS31) || (MGN_VHT4SS_MCS0 <= Rate && Rate <= MGN_VHT4SS_MCS9))2556txPower += pHalData->BW20_5G_Diff[RFPath][RF_4TX];2557goto exit;2558}25592560/* BW40-nS */2561if (BandWidth == CHANNEL_WIDTH_40) {2562if ((MGN_MCS0 <= Rate && Rate <= MGN_MCS31) || (MGN_VHT1SS_MCS0 <= Rate && Rate <= MGN_VHT4SS_MCS9))2563txPower += pHalData->BW40_5G_Diff[RFPath][RF_1TX];2564if ((MGN_MCS8 <= Rate && Rate <= MGN_MCS31) || (MGN_VHT2SS_MCS0 <= Rate && Rate <= MGN_VHT4SS_MCS9))2565txPower += pHalData->BW40_5G_Diff[RFPath][RF_2TX];2566if ((MGN_MCS16 <= Rate && Rate <= MGN_MCS31) || (MGN_VHT3SS_MCS0 <= Rate && Rate <= MGN_VHT4SS_MCS9))2567txPower += pHalData->BW40_5G_Diff[RFPath][RF_3TX];2568if ((MGN_MCS24 <= Rate && Rate <= MGN_MCS31) || (MGN_VHT4SS_MCS0 <= Rate && Rate <= MGN_VHT4SS_MCS9))2569txPower += pHalData->BW40_5G_Diff[RFPath][RF_4TX];2570goto exit;2571}25722573/* BW80-nS */2574if (BandWidth == CHANNEL_WIDTH_80) {2575/* get 80MHz cch index */2576for (i = 0; i < CENTER_CH_5G_80M_NUM; ++i) {2577if (center_ch_5g_80m[i] == Channel) {2578chnlIdx = i;2579break;2580}2581}2582if (i >= CENTER_CH_5G_80M_NUM) {2583#ifdef CONFIG_MP_INCLUDED2584if (rtw_mp_mode_check(pAdapter) == _FALSE)2585#endif2586rtw_warn_on(1);2587txPower = 0;2588goto exit;2589}25902591txPower = pHalData->Index5G_BW80_Base[RFPath][chnlIdx];25922593if ((MGN_MCS0 <= Rate && Rate <= MGN_MCS31) || (MGN_VHT1SS_MCS0 <= Rate && Rate <= MGN_VHT4SS_MCS9))2594txPower += + pHalData->BW80_5G_Diff[RFPath][RF_1TX];2595if ((MGN_MCS8 <= Rate && Rate <= MGN_MCS31) || (MGN_VHT2SS_MCS0 <= Rate && Rate <= MGN_VHT4SS_MCS9))2596txPower += pHalData->BW80_5G_Diff[RFPath][RF_2TX];2597if ((MGN_MCS16 <= Rate && Rate <= MGN_MCS31) || (MGN_VHT3SS_MCS0 <= Rate && Rate <= MGN_VHT4SS_MCS9))2598txPower += pHalData->BW80_5G_Diff[RFPath][RF_3TX];2599if ((MGN_MCS23 <= Rate && Rate <= MGN_MCS31) || (MGN_VHT4SS_MCS0 <= Rate && Rate <= MGN_VHT4SS_MCS9))2600txPower += pHalData->BW80_5G_Diff[RFPath][RF_4TX];2601goto exit;2602}26032604/* TODO: BW160-nS */2605rtw_warn_on(1);2606}2607#endif /* CONFIG_IEEE80211_BAND_5GHZ */26082609exit:2610return txPower;2611}2612#endif /* CONFIG_USE_TSSI */26132614s82615PHY_GetTxPowerTrackingOffset(2616PADAPTER pAdapter,2617enum rf_path RFPath,2618u8 Rate2619)2620{2621PHAL_DATA_TYPE pHalData = GET_HAL_DATA(pAdapter);2622struct dm_struct *pDM_Odm = &pHalData->odmpriv;2623s8 offset = 0;26242625if (pDM_Odm->rf_calibrate_info.txpowertrack_control == _FALSE)2626return offset;26272628if ((Rate == MGN_1M) || (Rate == MGN_2M) || (Rate == MGN_5_5M) || (Rate == MGN_11M)) {2629offset = pDM_Odm->rf_calibrate_info.remnant_cck_swing_idx;2630/*RTW_INFO("+Remnant_CCKSwingIdx = 0x%x\n", RFPath, Rate, pRFCalibrateInfo->Remnant_CCKSwingIdx);*/2631} else {2632offset = pDM_Odm->rf_calibrate_info.remnant_ofdm_swing_idx[RFPath];2633/*RTW_INFO("+Remanant_OFDMSwingIdx[RFPath %u][Rate 0x%x] = 0x%x\n", RFPath, Rate, pRFCalibrateInfo->Remnant_OFDMSwingIdx[RFPath]); */26342635}26362637return offset;2638}26392640/*The same as MRateToHwRate in hal_com.c*/2641u82642PHY_GetRateIndexOfTxPowerByRate(2643u8 Rate2644)2645{2646u8 index = 0;2647switch (Rate) {2648case MGN_1M:2649index = 0;2650break;2651case MGN_2M:2652index = 1;2653break;2654case MGN_5_5M:2655index = 2;2656break;2657case MGN_11M:2658index = 3;2659break;2660case MGN_6M:2661index = 4;2662break;2663case MGN_9M:2664index = 5;2665break;2666case MGN_12M:2667index = 6;2668break;2669case MGN_18M:2670index = 7;2671break;2672case MGN_24M:2673index = 8;2674break;2675case MGN_36M:2676index = 9;2677break;2678case MGN_48M:2679index = 10;2680break;2681case MGN_54M:2682index = 11;2683break;2684case MGN_MCS0:2685index = 12;2686break;2687case MGN_MCS1:2688index = 13;2689break;2690case MGN_MCS2:2691index = 14;2692break;2693case MGN_MCS3:2694index = 15;2695break;2696case MGN_MCS4:2697index = 16;2698break;2699case MGN_MCS5:2700index = 17;2701break;2702case MGN_MCS6:2703index = 18;2704break;2705case MGN_MCS7:2706index = 19;2707break;2708case MGN_MCS8:2709index = 20;2710break;2711case MGN_MCS9:2712index = 21;2713break;2714case MGN_MCS10:2715index = 22;2716break;2717case MGN_MCS11:2718index = 23;2719break;2720case MGN_MCS12:2721index = 24;2722break;2723case MGN_MCS13:2724index = 25;2725break;2726case MGN_MCS14:2727index = 26;2728break;2729case MGN_MCS15:2730index = 27;2731break;2732case MGN_MCS16:2733index = 28;2734break;2735case MGN_MCS17:2736index = 29;2737break;2738case MGN_MCS18:2739index = 30;2740break;2741case MGN_MCS19:2742index = 31;2743break;2744case MGN_MCS20:2745index = 32;2746break;2747case MGN_MCS21:2748index = 33;2749break;2750case MGN_MCS22:2751index = 34;2752break;2753case MGN_MCS23:2754index = 35;2755break;2756case MGN_MCS24:2757index = 36;2758break;2759case MGN_MCS25:2760index = 37;2761break;2762case MGN_MCS26:2763index = 38;2764break;2765case MGN_MCS27:2766index = 39;2767break;2768case MGN_MCS28:2769index = 40;2770break;2771case MGN_MCS29:2772index = 41;2773break;2774case MGN_MCS30:2775index = 42;2776break;2777case MGN_MCS31:2778index = 43;2779break;2780case MGN_VHT1SS_MCS0:2781index = 44;2782break;2783case MGN_VHT1SS_MCS1:2784index = 45;2785break;2786case MGN_VHT1SS_MCS2:2787index = 46;2788break;2789case MGN_VHT1SS_MCS3:2790index = 47;2791break;2792case MGN_VHT1SS_MCS4:2793index = 48;2794break;2795case MGN_VHT1SS_MCS5:2796index = 49;2797break;2798case MGN_VHT1SS_MCS6:2799index = 50;2800break;2801case MGN_VHT1SS_MCS7:2802index = 51;2803break;2804case MGN_VHT1SS_MCS8:2805index = 52;2806break;2807case MGN_VHT1SS_MCS9:2808index = 53;2809break;2810case MGN_VHT2SS_MCS0:2811index = 54;2812break;2813case MGN_VHT2SS_MCS1:2814index = 55;2815break;2816case MGN_VHT2SS_MCS2:2817index = 56;2818break;2819case MGN_VHT2SS_MCS3:2820index = 57;2821break;2822case MGN_VHT2SS_MCS4:2823index = 58;2824break;2825case MGN_VHT2SS_MCS5:2826index = 59;2827break;2828case MGN_VHT2SS_MCS6:2829index = 60;2830break;2831case MGN_VHT2SS_MCS7:2832index = 61;2833break;2834case MGN_VHT2SS_MCS8:2835index = 62;2836break;2837case MGN_VHT2SS_MCS9:2838index = 63;2839break;2840case MGN_VHT3SS_MCS0:2841index = 64;2842break;2843case MGN_VHT3SS_MCS1:2844index = 65;2845break;2846case MGN_VHT3SS_MCS2:2847index = 66;2848break;2849case MGN_VHT3SS_MCS3:2850index = 67;2851break;2852case MGN_VHT3SS_MCS4:2853index = 68;2854break;2855case MGN_VHT3SS_MCS5:2856index = 69;2857break;2858case MGN_VHT3SS_MCS6:2859index = 70;2860break;2861case MGN_VHT3SS_MCS7:2862index = 71;2863break;2864case MGN_VHT3SS_MCS8:2865index = 72;2866break;2867case MGN_VHT3SS_MCS9:2868index = 73;2869break;2870case MGN_VHT4SS_MCS0:2871index = 74;2872break;2873case MGN_VHT4SS_MCS1:2874index = 75;2875break;2876case MGN_VHT4SS_MCS2:2877index = 76;2878break;2879case MGN_VHT4SS_MCS3:2880index = 77;2881break;2882case MGN_VHT4SS_MCS4:2883index = 78;2884break;2885case MGN_VHT4SS_MCS5:2886index = 79;2887break;2888case MGN_VHT4SS_MCS6:2889index = 80;2890break;2891case MGN_VHT4SS_MCS7:2892index = 81;2893break;2894case MGN_VHT4SS_MCS8:2895index = 82;2896break;2897case MGN_VHT4SS_MCS9:2898index = 83;2899break;2900default:2901RTW_INFO("Invalid rate 0x%x in %s\n", Rate, __FUNCTION__);2902break;2903};29042905return index;2906}29072908#ifdef CONFIG_USE_TSSI2909s8 PHY_GetTxPowerByRateOriginal(2910PADAPTER pAdapter,2911u8 Band,2912enum rf_path RFPath,2913u8 Rate2914)2915{2916HAL_DATA_TYPE *pHalData = GET_HAL_DATA(pAdapter);2917s8 value = 0;2918u8 rateIndex = PHY_GetRateIndexOfTxPowerByRate(Rate);29192920if (Band != BAND_ON_2_4G && Band != BAND_ON_5G) {2921RTW_INFO("Invalid band %d in %s\n", Band, __func__);2922goto exit;2923}2924if (RFPath > RF_PATH_D) {2925RTW_INFO("Invalid RfPath %d in %s\n", RFPath, __func__);2926goto exit;2927}2928if (rateIndex >= TX_PWR_BY_RATE_NUM_RATE) {2929RTW_INFO("Invalid RateIndex %d in %s\n", rateIndex, __func__);2930goto exit;2931}29322933value = pHalData->TxPwrByRate[Band][RFPath][rateIndex];29342935exit:2936return value;2937}2938#endif /* CONFIG_USE_TSSI */29392940s82941_PHY_GetTxPowerByRate(2942PADAPTER pAdapter,2943u8 Band,2944enum rf_path RFPath,2945u8 Rate2946)2947{2948HAL_DATA_TYPE *pHalData = GET_HAL_DATA(pAdapter);2949s8 value = 0;2950u8 rateIndex = PHY_GetRateIndexOfTxPowerByRate(Rate);29512952if (Band != BAND_ON_2_4G && Band != BAND_ON_5G) {2953RTW_INFO("Invalid band %d in %s\n", Band, __func__);2954goto exit;2955}2956if (RFPath > RF_PATH_D) {2957RTW_INFO("Invalid RfPath %d in %s\n", RFPath, __func__);2958goto exit;2959}2960if (rateIndex >= TX_PWR_BY_RATE_NUM_RATE) {2961RTW_INFO("Invalid RateIndex %d in %s\n", rateIndex, __func__);2962goto exit;2963}29642965value = pHalData->TxPwrByRateOffset[Band][RFPath][rateIndex];29662967exit:2968return value;2969}297029712972s82973PHY_GetTxPowerByRate(2974PADAPTER pAdapter,2975u8 Band,2976enum rf_path RFPath,2977u8 Rate2978)2979{2980if (!phy_is_tx_power_by_rate_needed(pAdapter))2981return 0;29822983return _PHY_GetTxPowerByRate(pAdapter, Band, RFPath, Rate);2984}29852986void2987PHY_SetTxPowerByRate(2988PADAPTER pAdapter,2989u8 Band,2990enum rf_path RFPath,2991u8 Rate,2992s8 Value2993)2994{2995HAL_DATA_TYPE *pHalData = GET_HAL_DATA(pAdapter);2996u8 rateIndex = PHY_GetRateIndexOfTxPowerByRate(Rate);29972998if (Band != BAND_ON_2_4G && Band != BAND_ON_5G) {2999RTW_INFO("Invalid band %d in %s\n", Band, __FUNCTION__);3000return;3001}3002if (RFPath > RF_PATH_D) {3003RTW_INFO("Invalid RfPath %d in %s\n", RFPath, __FUNCTION__);3004return;3005}3006if (rateIndex >= TX_PWR_BY_RATE_NUM_RATE) {3007RTW_INFO("Invalid RateIndex %d in %s\n", rateIndex, __FUNCTION__);3008return;3009}30103011pHalData->TxPwrByRateOffset[Band][RFPath][rateIndex] = Value;3012}30133014u8 phy_check_under_survey_ch(_adapter *adapter)3015{3016struct dvobj_priv *dvobj = adapter_to_dvobj(adapter);3017_adapter *iface;3018struct mlme_ext_priv *mlmeext;3019u8 ret = _FALSE;3020int i;30213022for (i = 0; i < dvobj->iface_nums; i++) {3023iface = dvobj->padapters[i];3024if (!iface)3025continue;3026mlmeext = &iface->mlmeextpriv;30273028/* check scan state */3029if (mlmeext_scan_state(mlmeext) != SCAN_DISABLE3030&& mlmeext_scan_state(mlmeext) != SCAN_COMPLETE3031&& mlmeext_scan_state(mlmeext) != SCAN_BACKING_OP) {3032ret = _TRUE;3033} else if (mlmeext_scan_state(mlmeext) == SCAN_BACKING_OP3034&& !mlmeext_chk_scan_backop_flags(mlmeext, SS_BACKOP_TX_RESUME)) {3035ret = _TRUE;3036}3037}30383039return ret;3040}30413042void3043phy_set_tx_power_level_by_path(3044PADAPTER Adapter,3045u8 channel,3046u8 path3047)3048{3049PHAL_DATA_TYPE pHalData = GET_HAL_DATA(Adapter);3050BOOLEAN bIsIn24G = (pHalData->current_band_type == BAND_ON_2_4G);3051u8 under_survey_ch = phy_check_under_survey_ch(Adapter);305230533054/* if ( pMgntInfo->RegNByteAccess == 0 ) */3055{3056if (bIsIn24G)3057phy_set_tx_power_index_by_rate_section(Adapter, path, channel, CCK);30583059phy_set_tx_power_index_by_rate_section(Adapter, path, channel, OFDM);30603061if (!under_survey_ch) {3062phy_set_tx_power_index_by_rate_section(Adapter, path, channel, HT_MCS0_MCS7);30633064if (IS_HARDWARE_TYPE_JAGUAR(Adapter) || IS_HARDWARE_TYPE_8814A(Adapter))3065phy_set_tx_power_index_by_rate_section(Adapter, path, channel, VHT_1SSMCS0_1SSMCS9);30663067if (pHalData->NumTotalRFPath >= 2) {3068phy_set_tx_power_index_by_rate_section(Adapter, path, channel, HT_MCS8_MCS15);30693070if (IS_HARDWARE_TYPE_JAGUAR(Adapter) || IS_HARDWARE_TYPE_8814A(Adapter))3071phy_set_tx_power_index_by_rate_section(Adapter, path, channel, VHT_2SSMCS0_2SSMCS9);30723073if (IS_HARDWARE_TYPE_8814A(Adapter)) {3074phy_set_tx_power_index_by_rate_section(Adapter, path, channel, HT_MCS16_MCS23);3075phy_set_tx_power_index_by_rate_section(Adapter, path, channel, VHT_3SSMCS0_3SSMCS9);3076}3077}3078}3079}3080}30813082#ifndef DBG_TX_POWER_IDX3083#define DBG_TX_POWER_IDX 03084#endif30853086void3087PHY_SetTxPowerIndexByRateArray(3088PADAPTER pAdapter,3089enum rf_path RFPath,3090enum channel_width BandWidth,3091u8 Channel,3092u8 *Rates,3093u8 RateArraySize3094)3095{3096u32 powerIndex = 0;3097int i = 0;30983099for (i = 0; i < RateArraySize; ++i) {3100#if DBG_TX_POWER_IDX3101struct txpwr_idx_comp tic;31023103powerIndex = rtw_hal_get_tx_power_index(pAdapter, RFPath, Rates[i], BandWidth, Channel, &tic);3104RTW_INFO("TXPWR: [%c][%s]ch:%u, %s %uT, pwr_idx:%u(0x%02x) = %u + (%d=%d:%d) + (%d) + (%d) + (%d) + (%d)\n"3105, rf_path_char(RFPath), ch_width_str(BandWidth), Channel, MGN_RATE_STR(Rates[i]), tic.ntx_idx + 13106, powerIndex, powerIndex, tic.pg, (tic.by_rate > tic.limit ? tic.limit : tic.by_rate), tic.by_rate, tic.limit, tic.tpt3107, tic.ebias, tic.btc, tic.dpd);3108#else3109powerIndex = phy_get_tx_power_index(pAdapter, RFPath, Rates[i], BandWidth, Channel);3110#endif3111PHY_SetTxPowerIndex(pAdapter, powerIndex, RFPath, Rates[i]);3112}3113}31143115#if CONFIG_TXPWR_LIMIT3116const char *const _txpwr_lmt_rs_str[] = {3117"CCK",3118"OFDM",3119"HT",3120"VHT",3121"UNKNOWN",3122};31233124static s83125phy_GetChannelIndexOfTxPowerLimit(3126u8 Band,3127u8 Channel3128)3129{3130s8 channelIndex = -1;3131u8 i = 0;31323133if (Band == BAND_ON_2_4G)3134channelIndex = Channel - 1;3135else if (Band == BAND_ON_5G) {3136for (i = 0; i < CENTER_CH_5G_ALL_NUM; ++i) {3137if (center_ch_5g_all[i] == Channel)3138channelIndex = i;3139}3140} else3141RTW_PRINT("Invalid Band %d in %s\n", Band, __func__);31423143if (channelIndex == -1)3144RTW_PRINT("Invalid Channel %d of Band %d in %s\n", Channel, Band, __func__);31453146return channelIndex;3147}31483149static s8 phy_txpwr_ww_lmt_value(_adapter *adapter)3150{3151struct hal_spec_t *hal_spec = GET_HAL_SPEC(adapter);31523153if (hal_spec->txgi_max == 63)3154return -63;3155else if (hal_spec->txgi_max == 127)3156return -128;31573158rtw_warn_on(1);3159return -128;3160}31613162/*3163* return txpwr limit absolute value3164* hsl_spec->txgi_max is returned when NO limit3165*/3166s8 phy_get_txpwr_lmt_abs(3167PADAPTER Adapter,3168const char *regd_name,3169BAND_TYPE Band,3170enum channel_width bw,3171u8 tlrs,3172u8 ntx_idx,3173u8 cch,3174u8 lock3175)3176{3177struct dvobj_priv *dvobj = adapter_to_dvobj(Adapter);3178struct rf_ctl_t *rfctl = adapter_to_rfctl(Adapter);3179HAL_DATA_TYPE *hal_data = GET_HAL_DATA(Adapter);3180struct hal_spec_t *hal_spec = GET_HAL_SPEC(Adapter);3181struct txpwr_lmt_ent *ent = NULL;3182_irqL irqL;3183_list *cur, *head;3184s8 ch_idx;3185u8 is_ww_regd = 0;3186s8 ww_lmt_val = phy_txpwr_ww_lmt_value(Adapter);3187s8 lmt = hal_spec->txgi_max;31883189if ((Adapter->registrypriv.RegEnableTxPowerLimit == 2 && hal_data->EEPROMRegulatory != 1) ||3190Adapter->registrypriv.RegEnableTxPowerLimit == 0)3191goto exit;31923193if (Band != BAND_ON_2_4G && Band != BAND_ON_5G) {3194RTW_ERR("%s invalid band:%u\n", __func__, Band);3195rtw_warn_on(1);3196goto exit;3197}31983199if (Band == BAND_ON_5G && tlrs == TXPWR_LMT_RS_CCK) {3200RTW_ERR("5G has no CCK\n");3201goto exit;3202}32033204if (lock)3205_enter_critical_mutex(&rfctl->txpwr_lmt_mutex, &irqL);32063207if (!regd_name) /* no regd_name specified, use currnet */3208regd_name = rfctl->regd_name;32093210if (rfctl->txpwr_regd_num == 03211|| strcmp(regd_name, regd_str(TXPWR_LMT_NONE)) == 0)3212goto release_lock;32133214if (strcmp(regd_name, regd_str(TXPWR_LMT_WW)) == 0)3215is_ww_regd = 1;32163217if (!is_ww_regd) {3218ent = _rtw_txpwr_lmt_get_by_name(rfctl, regd_name);3219if (!ent)3220goto release_lock;3221}32223223ch_idx = phy_GetChannelIndexOfTxPowerLimit(Band, cch);3224if (ch_idx == -1)3225goto release_lock;32263227if (Band == BAND_ON_2_4G) {3228if (!is_ww_regd) {3229lmt = ent->lmt_2g[bw][tlrs][ch_idx][ntx_idx];3230if (lmt != ww_lmt_val)3231goto release_lock;3232}32333234/* search for min value for WW regd or WW limit */3235lmt = hal_spec->txgi_max;3236head = &rfctl->txpwr_lmt_list;3237cur = get_next(head);3238while ((rtw_end_of_queue_search(head, cur)) == _FALSE) {3239ent = LIST_CONTAINOR(cur, struct txpwr_lmt_ent, list);3240cur = get_next(cur);3241if (ent->lmt_2g[bw][tlrs][ch_idx][ntx_idx] != ww_lmt_val)3242lmt = rtw_min(lmt, ent->lmt_2g[bw][tlrs][ch_idx][ntx_idx]);3243}3244}3245#ifdef CONFIG_IEEE80211_BAND_5GHZ3246else if (Band == BAND_ON_5G) {3247if (!is_ww_regd) {3248lmt = ent->lmt_5g[bw][tlrs - 1][ch_idx][ntx_idx];3249if (lmt != ww_lmt_val)3250goto release_lock;3251}32523253/* search for min value for WW regd or WW limit */3254lmt = hal_spec->txgi_max;3255head = &rfctl->txpwr_lmt_list;3256cur = get_next(head);3257while ((rtw_end_of_queue_search(head, cur)) == _FALSE) {3258ent = LIST_CONTAINOR(cur, struct txpwr_lmt_ent, list);3259cur = get_next(cur);3260if (ent->lmt_5g[bw][tlrs - 1][ch_idx][ntx_idx] != ww_lmt_val)3261lmt = rtw_min(lmt, ent->lmt_5g[bw][tlrs - 1][ch_idx][ntx_idx]);3262}3263}3264#endif32653266release_lock:3267if (lock)3268_exit_critical_mutex(&rfctl->txpwr_lmt_mutex, &irqL);32693270exit:3271return lmt;3272}32733274/*3275* return txpwr limit diff value3276* hal_spec->txgi_max is returned when NO limit3277*/3278inline s8 phy_get_txpwr_lmt(_adapter *adapter3279, const char *regd_name3280, BAND_TYPE band, enum channel_width bw3281, u8 rfpath, u8 rs, u8 ntx_idx, u8 cch, u8 lock3282)3283{3284struct hal_spec_t *hal_spec = GET_HAL_SPEC(adapter);3285u8 tlrs;3286s8 lmt = hal_spec->txgi_max;32873288if (IS_CCK_RATE_SECTION(rs))3289tlrs = TXPWR_LMT_RS_CCK;3290else if (IS_OFDM_RATE_SECTION(rs))3291tlrs = TXPWR_LMT_RS_OFDM;3292else if (IS_HT_RATE_SECTION(rs))3293tlrs = TXPWR_LMT_RS_HT;3294else if (IS_VHT_RATE_SECTION(rs))3295tlrs = TXPWR_LMT_RS_VHT;3296else {3297RTW_ERR("%s invalid rs %u\n", __func__, rs);3298rtw_warn_on(1);3299goto exit;3300}33013302lmt = phy_get_txpwr_lmt_abs(adapter, regd_name, band, bw, tlrs, ntx_idx, cch, lock);33033304if (lmt != hal_spec->txgi_max) {3305/* return diff value */3306#ifdef CONFIG_USE_TSSI3307lmt = lmt - PHY_GetTxPowerByRateOriginal(adapter, band, rfpath, MGN_MCS7);3308#else3309lmt = lmt - PHY_GetTxPowerByRateBase(adapter, band, rfpath, rs);3310#endif3311}33123313exit:3314return lmt;3315}33163317#ifdef CONFIG_USE_TSSI3318static3319s8 PHY_GetTxPowerLimitOriginal(_adapter *adapter3320, const char *regd_name3321, BAND_TYPE band, enum channel_width bw3322, u8 rfpath, u8 rate, u8 ntx_idx, u8 cch3323)3324{3325/* input may be ch=155 bw=2 for OFDM */3326s8 lmt;33273328lmt = _PHY_GetTxPowerLimit(adapter, regd_name, band, bw, rfpath, rate, ntx_idx, cch, true);33293330return lmt;3331}3332#endif33333334/*3335* May search for secondary channels for min limit3336* return txpwr limit diff value3337*/3338s83339_PHY_GetTxPowerLimit(_adapter *adapter3340, const char *regd_name3341, BAND_TYPE band, enum channel_width bw3342, u8 rfpath, u8 rate, u8 ntx_idx, u8 cch, bool orig)3343{3344struct dvobj_priv *dvobj = adapter_to_dvobj(adapter);3345struct rf_ctl_t *rfctl = adapter_to_rfctl(adapter);3346HAL_DATA_TYPE *hal_data = GET_HAL_DATA(adapter);3347struct hal_spec_t *hal_spec = GET_HAL_SPEC(adapter);3348BOOLEAN no_sc = _FALSE;3349s8 tlrs = -1, rs = -1;3350s8 lmt = hal_spec->txgi_max;3351u8 tmp_cch = 0;3352u8 tmp_bw;3353u8 bw_bmp = 0;3354s8 min_lmt = hal_spec->txgi_max;3355u8 final_bw = bw, final_cch = cch;3356_irqL irqL;33573358#ifdef CONFIG_MP_INCLUDED3359/* MP mode channel don't use secondary channel */3360if (rtw_mp_mode_check(adapter) == _TRUE)3361no_sc = _TRUE;3362#endif3363if (IS_CCK_RATE(rate)) {3364tlrs = TXPWR_LMT_RS_CCK;3365rs = CCK;3366} else if (IS_OFDM_RATE(rate)) {3367tlrs = TXPWR_LMT_RS_OFDM;3368rs = OFDM;3369} else if (IS_HT_RATE(rate)) {3370tlrs = TXPWR_LMT_RS_HT;3371rs = HT_1SS + (IS_HT1SS_RATE(rate) ? 0 : IS_HT2SS_RATE(rate) ? 1 : IS_HT3SS_RATE(rate) ? 2 : IS_HT4SS_RATE(rate) ? 3 : 0);3372} else if (IS_VHT_RATE(rate)) {3373tlrs = TXPWR_LMT_RS_VHT;3374rs = VHT_1SS + (IS_VHT1SS_RATE(rate) ? 0 : IS_VHT2SS_RATE(rate) ? 1 : IS_VHT3SS_RATE(rate) ? 2 : IS_VHT4SS_RATE(rate) ? 3 : 0);3375} else {3376RTW_ERR("%s invalid rate 0x%x\n", __func__, rate);3377rtw_warn_on(1);3378goto exit;3379}33803381if (no_sc == _TRUE) {3382/* use the input center channel and bandwidth directly */3383tmp_cch = cch;3384bw_bmp = ch_width_to_bw_cap(bw);3385} else {3386/*3387* find the possible tx bandwidth bmp for this rate, and then will get center channel for each bandwidth3388* if no possible tx bandwidth bmp, select valid bandwidth up to current RF bandwidth into bmp3389*/3390if (tlrs == TXPWR_LMT_RS_CCK || tlrs == TXPWR_LMT_RS_OFDM)3391bw_bmp = BW_CAP_20M; /* CCK, OFDM only BW 20M */3392else if (tlrs == TXPWR_LMT_RS_HT) {3393bw_bmp = rtw_get_tx_bw_bmp_of_ht_rate(dvobj, rate, bw);3394if (bw_bmp == 0)3395bw_bmp = ch_width_to_bw_cap(bw > CHANNEL_WIDTH_40 ? CHANNEL_WIDTH_40 : bw);3396} else if (tlrs == TXPWR_LMT_RS_VHT) {3397bw_bmp = rtw_get_tx_bw_bmp_of_vht_rate(dvobj, rate, bw);3398if (bw_bmp == 0)3399bw_bmp = ch_width_to_bw_cap(bw > CHANNEL_WIDTH_160 ? CHANNEL_WIDTH_160 : bw);3400} else3401rtw_warn_on(1);3402}34033404if (bw_bmp == 0)3405goto exit;34063407_enter_critical_mutex(&rfctl->txpwr_lmt_mutex, &irqL);34083409/* loop for each possible tx bandwidth to find minimum limit */3410for (tmp_bw = CHANNEL_WIDTH_20; tmp_bw <= bw; tmp_bw++) {3411if (!(ch_width_to_bw_cap(tmp_bw) & bw_bmp))3412continue;34133414if (no_sc == _FALSE) {3415if (tmp_bw == CHANNEL_WIDTH_20)3416tmp_cch = hal_data->cch_20;3417else if (tmp_bw == CHANNEL_WIDTH_40)3418tmp_cch = hal_data->cch_40;3419else if (tmp_bw == CHANNEL_WIDTH_80)3420tmp_cch = hal_data->cch_80;3421else {3422tmp_cch = 0;3423rtw_warn_on(1);3424}3425}34263427lmt = phy_get_txpwr_lmt_abs(adapter, regd_name, band, tmp_bw, tlrs, ntx_idx, tmp_cch, 0);34283429if (min_lmt >= lmt) {3430min_lmt = lmt;3431final_cch = tmp_cch;3432final_bw = tmp_bw;3433}34343435}34363437_exit_critical_mutex(&rfctl->txpwr_lmt_mutex, &irqL);34383439if (!orig && min_lmt != hal_spec->txgi_max) {3440/* return diff value */3441#ifdef CONFIG_USE_TSSI3442min_lmt = min_lmt - PHY_GetTxPowerByRateOriginal(adapter, band, rfpath, MGN_MCS7);3443#else3444min_lmt = min_lmt - PHY_GetTxPowerByRateBase(adapter, band, rfpath, rs);3445#endif3446}34473448exit:34493450if (0) {3451if (final_bw != bw && (IS_HT_RATE(rate) || IS_VHT_RATE(rate)))3452RTW_INFO("%s min_lmt: %s ch%u -> %s ch%u\n"3453, MGN_RATE_STR(rate)3454, ch_width_str(bw), cch3455, ch_width_str(final_bw), final_cch);3456}34573458return min_lmt;3459}34603461static void phy_txpwr_lmt_cck_ofdm_mt_chk(_adapter *adapter)3462{3463struct rf_ctl_t *rfctl = adapter_to_rfctl(adapter);3464struct hal_spec_t *hal_spec = GET_HAL_SPEC(adapter);3465struct txpwr_lmt_ent *ent;3466_list *cur, *head;3467u8 channel, tlrs, ntx_idx;34683469rfctl->txpwr_lmt_2g_cck_ofdm_state = 0;3470#ifdef CONFIG_IEEE80211_BAND_5GHZ3471rfctl->txpwr_lmt_5g_cck_ofdm_state = 0;3472#endif34733474head = &rfctl->txpwr_lmt_list;3475cur = get_next(head);34763477while ((rtw_end_of_queue_search(head, cur)) == _FALSE) {3478ent = LIST_CONTAINOR(cur, struct txpwr_lmt_ent, list);3479cur = get_next(cur);34803481/* check 2G CCK, OFDM state*/3482for (tlrs = TXPWR_LMT_RS_CCK; tlrs <= TXPWR_LMT_RS_OFDM; tlrs++) {3483for (ntx_idx = RF_1TX; ntx_idx < MAX_TX_COUNT; ntx_idx++) {3484for (channel = 0; channel < CENTER_CH_2G_NUM; ++channel) {3485if (ent->lmt_2g[CHANNEL_WIDTH_20][tlrs][channel][ntx_idx] != hal_spec->txgi_max) {3486if (tlrs == TXPWR_LMT_RS_CCK)3487rfctl->txpwr_lmt_2g_cck_ofdm_state |= TXPWR_LMT_HAS_CCK_1T << ntx_idx;3488else3489rfctl->txpwr_lmt_2g_cck_ofdm_state |= TXPWR_LMT_HAS_OFDM_1T << ntx_idx;3490break;3491}3492}3493}3494}34953496/* if 2G OFDM multi-TX is not defined, reference HT20 */3497for (channel = 0; channel < CENTER_CH_2G_NUM; ++channel) {3498for (ntx_idx = RF_2TX; ntx_idx < MAX_TX_COUNT; ntx_idx++) {3499if (rfctl->txpwr_lmt_2g_cck_ofdm_state & (TXPWR_LMT_HAS_OFDM_1T << ntx_idx))3500continue;3501ent->lmt_2g[CHANNEL_WIDTH_20][TXPWR_LMT_RS_OFDM][channel][ntx_idx] =3502ent->lmt_2g[CHANNEL_WIDTH_20][TXPWR_LMT_RS_HT][channel][ntx_idx];3503}3504}35053506#ifdef CONFIG_IEEE80211_BAND_5GHZ3507/* check 5G OFDM state*/3508for (ntx_idx = RF_1TX; ntx_idx < MAX_TX_COUNT; ntx_idx++) {3509for (channel = 0; channel < CENTER_CH_5G_ALL_NUM; ++channel) {3510if (ent->lmt_5g[CHANNEL_WIDTH_20][TXPWR_LMT_RS_OFDM - 1][channel][ntx_idx] != hal_spec->txgi_max) {3511rfctl->txpwr_lmt_5g_cck_ofdm_state |= TXPWR_LMT_HAS_OFDM_1T << ntx_idx;3512break;3513}3514}3515}35163517for (channel = 0; channel < CENTER_CH_5G_ALL_NUM; ++channel) {3518for (ntx_idx = RF_2TX; ntx_idx < MAX_TX_COUNT; ntx_idx++) {3519if (rfctl->txpwr_lmt_5g_cck_ofdm_state & (TXPWR_LMT_HAS_OFDM_1T << ntx_idx))3520continue;3521/* if 5G OFDM multi-TX is not defined, reference HT20 */3522ent->lmt_5g[CHANNEL_WIDTH_20][TXPWR_LMT_RS_OFDM - 1][channel][ntx_idx] =3523ent->lmt_5g[CHANNEL_WIDTH_20][TXPWR_LMT_RS_HT - 1][channel][ntx_idx];3524}3525}3526#endif /* CONFIG_IEEE80211_BAND_5GHZ */3527}3528}35293530#ifdef CONFIG_IEEE80211_BAND_5GHZ3531static void phy_txpwr_lmt_cross_ref_ht_vht(_adapter *adapter)3532{3533struct rf_ctl_t *rfctl = adapter_to_rfctl(adapter);3534struct hal_spec_t *hal_spec = GET_HAL_SPEC(adapter);3535struct txpwr_lmt_ent *ent;3536_list *cur, *head;3537u8 bw, channel, tlrs, ref_tlrs, ntx_idx;3538int ht_ref_vht_5g_20_40 = 0;3539int vht_ref_ht_5g_20_40 = 0;3540int ht_has_ref_5g_20_40 = 0;3541int vht_has_ref_5g_20_40 = 0;35423543rfctl->txpwr_lmt_5g_20_40_ref = 0;35443545head = &rfctl->txpwr_lmt_list;3546cur = get_next(head);35473548while ((rtw_end_of_queue_search(head, cur)) == _FALSE) {3549ent = LIST_CONTAINOR(cur, struct txpwr_lmt_ent, list);3550cur = get_next(cur);35513552for (bw = 0; bw < MAX_5G_BANDWIDTH_NUM; ++bw) {35533554for (channel = 0; channel < CENTER_CH_5G_ALL_NUM; ++channel) {35553556for (tlrs = TXPWR_LMT_RS_HT; tlrs < TXPWR_LMT_RS_NUM; ++tlrs) {35573558/* 5G 20M 40M VHT and HT can cross reference */3559if (bw == CHANNEL_WIDTH_20 || bw == CHANNEL_WIDTH_40) {3560if (tlrs == TXPWR_LMT_RS_HT)3561ref_tlrs = TXPWR_LMT_RS_VHT;3562else if (tlrs == TXPWR_LMT_RS_VHT)3563ref_tlrs = TXPWR_LMT_RS_HT;3564else3565continue;35663567for (ntx_idx = RF_1TX; ntx_idx < MAX_TX_COUNT; ntx_idx++) {35683569if (ent->lmt_5g[bw][ref_tlrs - 1][channel][ntx_idx] == hal_spec->txgi_max)3570continue;35713572if (tlrs == TXPWR_LMT_RS_HT)3573ht_has_ref_5g_20_40++;3574else if (tlrs == TXPWR_LMT_RS_VHT)3575vht_has_ref_5g_20_40++;3576else3577continue;35783579if (ent->lmt_5g[bw][tlrs - 1][channel][ntx_idx] != hal_spec->txgi_max)3580continue;35813582if (tlrs == TXPWR_LMT_RS_HT && ref_tlrs == TXPWR_LMT_RS_VHT)3583ht_ref_vht_5g_20_40++;3584else if (tlrs == TXPWR_LMT_RS_VHT && ref_tlrs == TXPWR_LMT_RS_HT)3585vht_ref_ht_5g_20_40++;35863587if (0)3588RTW_INFO("reg:%s, bw:%u, ch:%u, %s-%uT ref %s-%uT\n"3589, ent->regd_name, bw, channel3590, txpwr_lmt_rs_str(tlrs), ntx_idx + 13591, txpwr_lmt_rs_str(ref_tlrs), ntx_idx + 1);35923593ent->lmt_5g[bw][tlrs - 1][channel][ntx_idx] =3594ent->lmt_5g[bw][ref_tlrs - 1][channel][ntx_idx];3595}3596}35973598}3599}3600}3601}36023603if (0) {3604RTW_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);3605RTW_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);3606}36073608/* 5G 20M&40M HT all come from VHT*/3609if (ht_ref_vht_5g_20_40 && ht_has_ref_5g_20_40 == ht_ref_vht_5g_20_40)3610rfctl->txpwr_lmt_5g_20_40_ref |= TXPWR_LMT_REF_HT_FROM_VHT;36113612/* 5G 20M&40M VHT all come from HT*/3613if (vht_ref_ht_5g_20_40 && vht_has_ref_5g_20_40 == vht_ref_ht_5g_20_40)3614rfctl->txpwr_lmt_5g_20_40_ref |= TXPWR_LMT_REF_VHT_FROM_HT;3615}3616#endif /* CONFIG_IEEE80211_BAND_5GHZ */36173618#ifndef DBG_TXPWR_LMT_BAND_CHK3619#define DBG_TXPWR_LMT_BAND_CHK 03620#endif36213622#if DBG_TXPWR_LMT_BAND_CHK3623/* check if larger bandwidth limit is less than smaller bandwidth for HT & VHT rate */3624void phy_txpwr_limit_bandwidth_chk(_adapter *adapter)3625{3626struct rf_ctl_t *rfctl = adapter_to_rfctl(adapter);3627HAL_DATA_TYPE *hal_data = GET_HAL_DATA(adapter);3628struct hal_spec_t *hal_spec = GET_HAL_SPEC(adapter);3629u8 band, bw, path, tlrs, ntx_idx, cch, offset, scch;3630u8 ch_num, n, i;36313632for (band = BAND_ON_2_4G; band <= BAND_ON_5G; band++) {3633if (!hal_is_band_support(adapter, band))3634continue;36353636for (bw = CHANNEL_WIDTH_40; bw <= CHANNEL_WIDTH_80; bw++) {3637if (bw >= CHANNEL_WIDTH_160)3638continue;3639if (band == BAND_ON_2_4G && bw >= CHANNEL_WIDTH_80)3640continue;36413642if (band == BAND_ON_2_4G)3643ch_num = center_chs_2g_num(bw);3644else3645ch_num = center_chs_5g_num(bw);36463647if (ch_num == 0) {3648rtw_warn_on(1);3649break;3650}36513652for (tlrs = TXPWR_LMT_RS_HT; tlrs < TXPWR_LMT_RS_NUM; tlrs++) {36533654if (band == BAND_ON_2_4G && tlrs == TXPWR_LMT_RS_VHT)3655continue;3656if (band == BAND_ON_5G && tlrs == TXPWR_LMT_RS_CCK)3657continue;3658if (bw > CHANNEL_WIDTH_20 && (tlrs == TXPWR_LMT_RS_CCK || tlrs == TXPWR_LMT_RS_OFDM))3659continue;3660if (bw > CHANNEL_WIDTH_40 && tlrs == TXPWR_LMT_RS_HT)3661continue;3662if (tlrs == TXPWR_LMT_RS_VHT && !IS_HARDWARE_TYPE_JAGUAR_ALL(adapter))3663continue;36643665for (ntx_idx = RF_1TX; ntx_idx < MAX_TX_COUNT; ntx_idx++) {3666struct txpwr_lmt_ent *ent;3667_list *cur, *head;36683669if (ntx_idx + 1 > hal_data->max_tx_cnt)3670continue;36713672/* bypass CCK multi-TX is not defined */3673if (tlrs == TXPWR_LMT_RS_CCK && ntx_idx > RF_1TX) {3674if (band == BAND_ON_2_4G3675&& !(rfctl->txpwr_lmt_2g_cck_ofdm_state & (TXPWR_LMT_HAS_CCK_1T << ntx_idx)))3676continue;3677}36783679/* bypass OFDM multi-TX is not defined */3680if (tlrs == TXPWR_LMT_RS_OFDM && ntx_idx > RF_1TX) {3681if (band == BAND_ON_2_4G3682&& !(rfctl->txpwr_lmt_2g_cck_ofdm_state & (TXPWR_LMT_HAS_OFDM_1T << ntx_idx)))3683continue;3684#ifdef CONFIG_IEEE80211_BAND_5GHZ3685if (band == BAND_ON_5G3686&& !(rfctl->txpwr_lmt_5g_cck_ofdm_state & (TXPWR_LMT_HAS_OFDM_1T << ntx_idx)))3687continue;3688#endif3689}36903691/* bypass 5G 20M, 40M pure reference */3692#ifdef CONFIG_IEEE80211_BAND_5GHZ3693if (band == BAND_ON_5G && (bw == CHANNEL_WIDTH_20 || bw == CHANNEL_WIDTH_40)) {3694if (rfctl->txpwr_lmt_5g_20_40_ref == TXPWR_LMT_REF_HT_FROM_VHT) {3695if (tlrs == TXPWR_LMT_RS_HT)3696continue;3697} else if (rfctl->txpwr_lmt_5g_20_40_ref == TXPWR_LMT_REF_VHT_FROM_HT) {3698if (tlrs == TXPWR_LMT_RS_VHT && bw <= CHANNEL_WIDTH_40)3699continue;3700}3701}3702#endif37033704for (n = 0; n < ch_num; n++) {3705u8 cch_by_bw[3];3706u8 offset_by_bw; /* bitmap, 0 for lower, 1 for upper */3707u8 bw_pos;3708s8 lmt[3];37093710if (band == BAND_ON_2_4G)3711cch = center_chs_2g(bw, n);3712else3713cch = center_chs_5g(bw, n);37143715if (cch == 0) {3716rtw_warn_on(1);3717break;3718}37193720_rtw_memset(cch_by_bw, 0, 3);3721cch_by_bw[bw] = cch;3722offset_by_bw = 0x01;37233724do {3725for (bw_pos = bw; bw_pos >= CHANNEL_WIDTH_40; bw_pos--)3726cch_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);37273728head = &rfctl->txpwr_lmt_list;3729cur = get_next(head);3730while ((rtw_end_of_queue_search(head, cur)) == _FALSE) {3731ent = LIST_CONTAINOR(cur, struct txpwr_lmt_ent, list);3732cur = get_next(cur);37333734for (bw_pos = bw; bw_pos < CHANNEL_WIDTH_160; bw_pos--)3735lmt[bw_pos] = phy_get_txpwr_lmt_abs(adapter, ent->regd_name, band, bw_pos, tlrs, ntx_idx, cch_by_bw[bw_pos], 0);37363737for (bw_pos = bw; bw_pos > CHANNEL_WIDTH_20; bw_pos--)3738if (lmt[bw_pos] > lmt[bw_pos - 1])3739break;3740if (bw_pos == CHANNEL_WIDTH_20)3741continue;37423743RTW_PRINT_SEL(RTW_DBGDUMP, "[%s][%s][%s][%uT][%-4s] cch:"3744, band_str(band)3745, ch_width_str(bw)3746, txpwr_lmt_rs_str(tlrs)3747, ntx_idx + 13748, ent->regd_name3749);3750for (bw_pos = bw; bw_pos < CHANNEL_WIDTH_160; bw_pos--)3751_RTW_PRINT_SEL(RTW_DBGDUMP, "%03u ", cch_by_bw[bw_pos]);3752_RTW_PRINT_SEL(RTW_DBGDUMP, "limit:");3753for (bw_pos = bw; bw_pos < CHANNEL_WIDTH_160; bw_pos--) {3754if (lmt[bw_pos] == hal_spec->txgi_max)3755_RTW_PRINT_SEL(RTW_DBGDUMP, "N/A ");3756else if (lmt[bw_pos] > -hal_spec->txgi_pdbm && lmt[bw_pos] < 0) /* -1 < value < 0 */3757_RTW_PRINT_SEL(RTW_DBGDUMP, "-0.%d", (rtw_abs(lmt[bw_pos]) % hal_spec->txgi_pdbm) * 100 / hal_spec->txgi_pdbm);3758else if (lmt[bw_pos] % hal_spec->txgi_pdbm)3759_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);3760else3761_RTW_PRINT_SEL(RTW_DBGDUMP, "%2d ", lmt[bw_pos] / hal_spec->txgi_pdbm);3762}3763_RTW_PRINT_SEL(RTW_DBGDUMP, "\n");3764}3765for (bw_pos = bw; bw_pos < CHANNEL_WIDTH_160; bw_pos--)3766lmt[bw_pos] = phy_get_txpwr_lmt_abs(adapter, regd_str(TXPWR_LMT_WW), band, bw_pos, tlrs, ntx_idx, cch_by_bw[bw_pos], 0);37673768for (bw_pos = bw; bw_pos > CHANNEL_WIDTH_20; bw_pos--)3769if (lmt[bw_pos] > lmt[bw_pos - 1])3770break;3771if (bw_pos != CHANNEL_WIDTH_20) {3772RTW_PRINT_SEL(RTW_DBGDUMP, "[%s][%s][%s][%uT][%-4s] cch:"3773, band_str(band)3774, ch_width_str(bw)3775, txpwr_lmt_rs_str(tlrs)3776, ntx_idx + 13777, regd_str(TXPWR_LMT_WW)3778);3779for (bw_pos = bw; bw_pos < CHANNEL_WIDTH_160; bw_pos--)3780_RTW_PRINT_SEL(RTW_DBGDUMP, "%03u ", cch_by_bw[bw_pos]);3781_RTW_PRINT_SEL(RTW_DBGDUMP, "limit:");3782for (bw_pos = bw; bw_pos < CHANNEL_WIDTH_160; bw_pos--) {3783if (lmt[bw_pos] == hal_spec->txgi_max)3784_RTW_PRINT_SEL(RTW_DBGDUMP, "N/A ");3785else if (lmt[bw_pos] > -hal_spec->txgi_pdbm && lmt[bw_pos] < 0) /* -1 < value < 0 */3786_RTW_PRINT_SEL(RTW_DBGDUMP, "-0.%d", (rtw_abs(lmt[bw_pos]) % hal_spec->txgi_pdbm) * 100 / hal_spec->txgi_pdbm);3787else if (lmt[bw_pos] % hal_spec->txgi_pdbm)3788_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);3789else3790_RTW_PRINT_SEL(RTW_DBGDUMP, "%2d ", lmt[bw_pos] / hal_spec->txgi_pdbm);3791}3792_RTW_PRINT_SEL(RTW_DBGDUMP, "\n");3793}37943795offset_by_bw += 2;3796if (offset_by_bw & BIT(bw + 1))3797break;3798} while (1); /* loop for all ch combinations */3799} /* loop for center channels */3800} /* loop fo each ntx_idx */3801} /* loop for tlrs */3802} /* loop for bandwidth */3803} /* loop for band */3804}3805#endif /* DBG_TXPWR_LMT_BAND_CHK */38063807static void phy_txpwr_lmt_post_hdl(_adapter *adapter)3808{3809struct rf_ctl_t *rfctl = adapter_to_rfctl(adapter);3810_irqL irqL;38113812_enter_critical_mutex(&rfctl->txpwr_lmt_mutex, &irqL);38133814#ifdef CONFIG_IEEE80211_BAND_5GHZ3815if (IS_HARDWARE_TYPE_JAGUAR_ALL(adapter))3816phy_txpwr_lmt_cross_ref_ht_vht(adapter);3817#endif3818phy_txpwr_lmt_cck_ofdm_mt_chk(adapter);38193820#if DBG_TXPWR_LMT_BAND_CHK3821phy_txpwr_limit_bandwidth_chk(adapter);3822#endif38233824_exit_critical_mutex(&rfctl->txpwr_lmt_mutex, &irqL);3825}38263827BOOLEAN3828GetS1ByteIntegerFromStringInDecimal(3829char *str,3830s8 *val3831)3832{3833u8 negative = 0;3834u16 i = 0;38353836*val = 0;38373838while (str[i] != '\0') {3839if (i == 0 && (str[i] == '+' || str[i] == '-')) {3840if (str[i] == '-')3841negative = 1;3842} else if (str[i] >= '0' && str[i] <= '9') {3843*val *= 10;3844*val += (str[i] - '0');3845} else3846return _FALSE;3847++i;3848}38493850if (negative)3851*val = -*val;38523853return _TRUE;3854}3855#endif /* CONFIG_TXPWR_LIMIT */38563857/*3858* phy_set_tx_power_limit - Parsing TX power limit from phydm array, called by odm_ConfigBB_TXPWR_LMT_XXX in phydm3859*/3860void3861phy_set_tx_power_limit(3862struct dm_struct *pDM_Odm,3863u8 *Regulation,3864u8 *Band,3865u8 *Bandwidth,3866u8 *RateSection,3867u8 *ntx,3868u8 *Channel,3869u8 *PowerLimit3870)3871{3872#if CONFIG_TXPWR_LIMIT3873PADAPTER Adapter = pDM_Odm->adapter;3874HAL_DATA_TYPE *pHalData = GET_HAL_DATA(Adapter);3875struct hal_spec_t *hal_spec = GET_HAL_SPEC(Adapter);3876u8 band = 0, bandwidth = 0, tlrs = 0, channel;3877u8 ntx_idx;3878s8 powerLimit = 0, prevPowerLimit, channelIndex;3879s8 ww_lmt_val = phy_txpwr_ww_lmt_value(Adapter);38803881if (0)3882RTW_INFO("Index of power limit table [regulation %s][band %s][bw %s][rate section %s][ntx %s][chnl %s][val %s]\n"3883, Regulation, Band, Bandwidth, RateSection, ntx, Channel, PowerLimit);38843885if (GetU1ByteIntegerFromStringInDecimal((char *)Channel, &channel) == _FALSE3886|| GetS1ByteIntegerFromStringInDecimal((char *)PowerLimit, &powerLimit) == _FALSE3887) {3888RTW_PRINT("Illegal index of power limit table [ch %s][val %s]\n", Channel, PowerLimit);3889return;3890}38913892if (powerLimit != ww_lmt_val) {3893if (powerLimit < -hal_spec->txgi_max || powerLimit > hal_spec->txgi_max)3894RTW_PRINT("Illegal power limit value [ch %s][val %s]\n", Channel, PowerLimit);38953896if (powerLimit > hal_spec->txgi_max)3897powerLimit = hal_spec->txgi_max;3898else if (powerLimit < -hal_spec->txgi_max)3899powerLimit = ww_lmt_val + 1;3900}39013902if (eqNByte(RateSection, (u8 *)("CCK"), 3))3903tlrs = TXPWR_LMT_RS_CCK;3904else if (eqNByte(RateSection, (u8 *)("OFDM"), 4))3905tlrs = TXPWR_LMT_RS_OFDM;3906else if (eqNByte(RateSection, (u8 *)("HT"), 2))3907tlrs = TXPWR_LMT_RS_HT;3908else if (eqNByte(RateSection, (u8 *)("VHT"), 3))3909tlrs = TXPWR_LMT_RS_VHT;3910else {3911RTW_PRINT("Wrong rate section:%s\n", RateSection);3912return;3913}39143915if (eqNByte(ntx, (u8 *)("1T"), 2))3916ntx_idx = RF_1TX;3917else if (eqNByte(ntx, (u8 *)("2T"), 2))3918ntx_idx = RF_2TX;3919else if (eqNByte(ntx, (u8 *)("3T"), 2))3920ntx_idx = RF_3TX;3921else if (eqNByte(ntx, (u8 *)("4T"), 2))3922ntx_idx = RF_4TX;3923else {3924RTW_PRINT("Wrong tx num:%s\n", ntx);3925return;3926}39273928if (eqNByte(Bandwidth, (u8 *)("20M"), 3))3929bandwidth = CHANNEL_WIDTH_20;3930else if (eqNByte(Bandwidth, (u8 *)("40M"), 3))3931bandwidth = CHANNEL_WIDTH_40;3932else if (eqNByte(Bandwidth, (u8 *)("80M"), 3))3933bandwidth = CHANNEL_WIDTH_80;3934else if (eqNByte(Bandwidth, (u8 *)("160M"), 4))3935bandwidth = CHANNEL_WIDTH_160;3936else {3937RTW_PRINT("unknown bandwidth: %s\n", Bandwidth);3938return;3939}39403941if (eqNByte(Band, (u8 *)("2.4G"), 4)) {3942band = BAND_ON_2_4G;3943channelIndex = phy_GetChannelIndexOfTxPowerLimit(BAND_ON_2_4G, channel);39443945if (channelIndex == -1) {3946RTW_PRINT("unsupported channel: %d at 2.4G\n", channel);3947return;3948}39493950if (bandwidth >= MAX_2_4G_BANDWIDTH_NUM) {3951RTW_PRINT("unsupported bandwidth: %s at 2.4G\n", Bandwidth);3952return;3953}39543955rtw_txpwr_lmt_add(adapter_to_rfctl(Adapter), Regulation, band, bandwidth, tlrs, ntx_idx, channelIndex, powerLimit);3956}3957#ifdef CONFIG_IEEE80211_BAND_5GHZ3958else if (eqNByte(Band, (u8 *)("5G"), 2)) {3959band = BAND_ON_5G;3960channelIndex = phy_GetChannelIndexOfTxPowerLimit(BAND_ON_5G, channel);39613962if (channelIndex == -1) {3963RTW_PRINT("unsupported channel: %d at 5G\n", channel);3964return;3965}39663967rtw_txpwr_lmt_add(adapter_to_rfctl(Adapter), Regulation, band, bandwidth, tlrs, ntx_idx, channelIndex, powerLimit);3968}3969#endif3970else {3971RTW_PRINT("unknown/unsupported band:%s\n", Band);3972return;3973}3974#endif3975}39763977u83978phy_get_tx_power_index(3979PADAPTER pAdapter,3980enum rf_path RFPath,3981u8 Rate,3982enum channel_width BandWidth,3983u8 Channel3984)3985{3986return rtw_hal_get_tx_power_index(pAdapter, RFPath, Rate, BandWidth, Channel, NULL);3987}39883989void3990PHY_SetTxPowerIndex(3991PADAPTER pAdapter,3992u32 PowerIndex,3993enum rf_path RFPath,3994u8 Rate3995)3996{3997rtw_hal_set_tx_power_index(pAdapter, PowerIndex, RFPath, Rate);3998}39994000void dump_tx_power_idx_title(void *sel, _adapter *adapter)4001{4002HAL_DATA_TYPE *hal_data = GET_HAL_DATA(adapter);4003u8 bw = hal_data->current_channel_bw;40044005RTW_PRINT_SEL(sel, "%s", ch_width_str(bw));4006if (bw >= CHANNEL_WIDTH_80)4007_RTW_PRINT_SEL(sel, ", cch80:%u", hal_data->cch_80);4008if (bw >= CHANNEL_WIDTH_40)4009_RTW_PRINT_SEL(sel, ", cch40:%u", hal_data->cch_40);4010_RTW_PRINT_SEL(sel, ", cch20:%u\n", hal_data->cch_20);40114012RTW_PRINT_SEL(sel, "%-4s %-9s %2s %-3s%6s %-3s %-3s %-4s %-4s %-3s %-5s %-3s %-3s\n"4013, "path", "rate", "", "pwr", "", "pg", "", "(byr", "lmt)", "tpt", "ebias", "btc", "dpd");4014}40154016void dump_tx_power_idx_by_path_rs(void *sel, _adapter *adapter, u8 rfpath, u8 rs)4017{4018HAL_DATA_TYPE *hal_data = GET_HAL_DATA(adapter);4019struct hal_spec_t *hal_spec = GET_HAL_SPEC(adapter);4020u8 power_idx;4021struct txpwr_idx_comp tic;4022u8 tx_num, i;4023u8 band = hal_data->current_band_type;4024u8 cch = hal_data->current_channel;4025u8 bw = hal_data->current_channel_bw;40264027if (!HAL_SPEC_CHK_RF_PATH(hal_spec, band, rfpath))4028return;40294030if (rs >= RATE_SECTION_NUM)4031return;40324033tx_num = rate_section_to_tx_num(rs);4034if (tx_num + 1 > hal_data->tx_nss)4035return;40364037if (band == BAND_ON_5G && IS_CCK_RATE_SECTION(rs))4038return;40394040if (IS_VHT_RATE_SECTION(rs) && !IS_HARDWARE_TYPE_JAGUAR_ALL(adapter))4041return;40424043for (i = 0; i < rates_by_sections[rs].rate_num; i++) {4044power_idx = rtw_hal_get_tx_power_index(adapter, rfpath, rates_by_sections[rs].rates[i], bw, cch, &tic);40454046RTW_PRINT_SEL(sel, "%4c %9s %uT %3u(0x%02x) %3u %3d (%3d %3d) %3d %5d %3d %3d\n"4047, rf_path_char(rfpath), MGN_RATE_STR(rates_by_sections[rs].rates[i]), tic.ntx_idx + 14048, power_idx, power_idx, tic.pg, (tic.by_rate > tic.limit ? tic.limit : tic.by_rate)4049, tic.by_rate, tic.limit, tic.tpt, tic.ebias, tic.btc, tic.dpd);4050}4051}40524053void dump_tx_power_idx(void *sel, _adapter *adapter)4054{4055u8 rfpath, rs;40564057dump_tx_power_idx_title(sel, adapter);4058for (rfpath = RF_PATH_A; rfpath < RF_PATH_MAX; rfpath++)4059for (rs = CCK; rs < RATE_SECTION_NUM; rs++)4060dump_tx_power_idx_by_path_rs(sel, adapter, rfpath, rs);4061}40624063bool phy_is_tx_power_limit_needed(_adapter *adapter)4064{4065#if CONFIG_TXPWR_LIMIT4066HAL_DATA_TYPE *hal_data = GET_HAL_DATA(adapter);4067struct registry_priv *regsty = dvobj_to_regsty(adapter_to_dvobj(adapter));40684069if (regsty->RegEnableTxPowerLimit == 14070|| (regsty->RegEnableTxPowerLimit == 2 && hal_data->EEPROMRegulatory == 1))4071return _TRUE;4072#endif40734074return _FALSE;4075}40764077bool phy_is_tx_power_by_rate_needed(_adapter *adapter)4078{4079HAL_DATA_TYPE *hal_data = GET_HAL_DATA(adapter);4080struct registry_priv *regsty = dvobj_to_regsty(adapter_to_dvobj(adapter));40814082if (regsty->RegEnableTxPowerByRate == 14083|| (regsty->RegEnableTxPowerByRate == 2 && hal_data->EEPROMRegulatory != 2))4084return _TRUE;40854086#ifdef CONFIG_USE_TSSI4087RTW_WARN("%s: power by rate is always needed by TSSI\n", __func__);4088return _TRUE;4089#endif40904091return _FALSE;4092}40934094int phy_load_tx_power_by_rate(_adapter *adapter, u8 chk_file)4095{4096HAL_DATA_TYPE *hal_data = GET_HAL_DATA(adapter);4097int ret = _FAIL;40984099hal_data->txpwr_by_rate_loaded = 0;4100PHY_InitTxPowerByRate(adapter);41014102/* tx power limit is based on tx power by rate */4103hal_data->txpwr_limit_loaded = 0;41044105#ifdef CONFIG_LOAD_PHY_PARA_FROM_FILE4106if (chk_file4107&& phy_ConfigBBWithPgParaFile(adapter, PHY_FILE_PHY_REG_PG) == _SUCCESS4108) {4109hal_data->txpwr_by_rate_from_file = 1;4110goto post_hdl;4111}4112#endif41134114#ifdef CONFIG_EMBEDDED_FWIMG4115if (HAL_STATUS_SUCCESS == odm_config_bb_with_header_file(&hal_data->odmpriv, CONFIG_BB_PHY_REG_PG)) {4116RTW_INFO("default power by rate loaded\n");4117hal_data->txpwr_by_rate_from_file = 0;4118goto post_hdl;4119}4120#endif41214122RTW_ERR("%s():Read Tx power by rate fail\n", __func__);4123goto exit;41244125post_hdl:4126if (hal_data->odmpriv.phy_reg_pg_value_type != PHY_REG_PG_EXACT_VALUE) {4127rtw_warn_on(1);4128goto exit;4129}41304131PHY_TxPowerByRateConfiguration(adapter);4132hal_data->txpwr_by_rate_loaded = 1;41334134ret = _SUCCESS;41354136exit:4137return ret;4138}41394140#if CONFIG_TXPWR_LIMIT4141int phy_load_tx_power_limit(_adapter *adapter, u8 chk_file)4142{4143HAL_DATA_TYPE *hal_data = GET_HAL_DATA(adapter);4144struct registry_priv *regsty = dvobj_to_regsty(adapter_to_dvobj(adapter));4145struct rf_ctl_t *rfctl = adapter_to_rfctl(adapter);4146int ret = _FAIL;41474148hal_data->txpwr_limit_loaded = 0;4149rtw_regd_exc_list_free(rfctl);4150rtw_txpwr_lmt_list_free(rfctl);41514152if (!hal_data->txpwr_by_rate_loaded && regsty->target_tx_pwr_valid != _TRUE) {4153RTW_ERR("%s():Read Tx power limit before target tx power is specify\n", __func__);4154goto exit;4155}41564157#ifdef CONFIG_LOAD_PHY_PARA_FROM_FILE4158if (chk_file4159&& PHY_ConfigRFWithPowerLimitTableParaFile(adapter, PHY_FILE_TXPWR_LMT) == _SUCCESS4160) {4161hal_data->txpwr_limit_from_file = 1;4162goto post_hdl;4163}4164#endif41654166#ifdef CONFIG_EMBEDDED_FWIMG4167if (odm_config_rf_with_header_file(&hal_data->odmpriv, CONFIG_RF_TXPWR_LMT, RF_PATH_A) == HAL_STATUS_SUCCESS) {4168RTW_INFO("default power limit loaded\n");4169hal_data->txpwr_limit_from_file = 0;4170goto post_hdl;4171}4172#endif41734174RTW_ERR("%s():Read Tx power limit fail\n", __func__);4175goto exit;41764177post_hdl:4178phy_txpwr_lmt_post_hdl(adapter);4179rtw_txpwr_init_regd(rfctl);4180hal_data->txpwr_limit_loaded = 1;4181ret = _SUCCESS;41824183exit:4184return ret;4185}4186#endif /* CONFIG_TXPWR_LIMIT */41874188void phy_load_tx_power_ext_info(_adapter *adapter, u8 chk_file)4189{4190struct registry_priv *regsty = adapter_to_regsty(adapter);41914192/* check registy target tx power */4193regsty->target_tx_pwr_valid = rtw_regsty_chk_target_tx_power_valid(adapter);41944195/* power by rate and limit */4196if (phy_is_tx_power_by_rate_needed(adapter)4197|| (phy_is_tx_power_limit_needed(adapter) && regsty->target_tx_pwr_valid != _TRUE)4198)4199phy_load_tx_power_by_rate(adapter, chk_file);42004201#if CONFIG_TXPWR_LIMIT4202if (phy_is_tx_power_limit_needed(adapter))4203phy_load_tx_power_limit(adapter, chk_file);4204#endif4205}42064207inline void phy_reload_tx_power_ext_info(_adapter *adapter)4208{4209phy_load_tx_power_ext_info(adapter, 1);4210}42114212inline void phy_reload_default_tx_power_ext_info(_adapter *adapter)4213{4214phy_load_tx_power_ext_info(adapter, 0);4215}42164217void dump_tx_power_ext_info(void *sel, _adapter *adapter)4218{4219struct registry_priv *regsty = adapter_to_regsty(adapter);4220HAL_DATA_TYPE *hal_data = GET_HAL_DATA(adapter);42214222if (regsty->target_tx_pwr_valid == _TRUE)4223RTW_PRINT_SEL(sel, "target_tx_power: from registry\n");4224else if (phy_is_tx_power_by_rate_needed(adapter))4225RTW_PRINT_SEL(sel, "target_tx_power: from power by rate\n");4226else4227RTW_PRINT_SEL(sel, "target_tx_power: unavailable\n");42284229RTW_PRINT_SEL(sel, "tx_power_by_rate: %s, %s, %s\n"4230, phy_is_tx_power_by_rate_needed(adapter) ? "enabled" : "disabled"4231, hal_data->txpwr_by_rate_loaded ? "loaded" : "unloaded"4232, hal_data->txpwr_by_rate_from_file ? "file" : "default"4233);42344235RTW_PRINT_SEL(sel, "tx_power_limit: %s, %s, %s\n"4236, phy_is_tx_power_limit_needed(adapter) ? "enabled" : "disabled"4237, hal_data->txpwr_limit_loaded ? "loaded" : "unloaded"4238, hal_data->txpwr_limit_from_file ? "file" : "default"4239);4240}42414242void dump_target_tx_power(void *sel, _adapter *adapter)4243{4244struct hal_spec_t *hal_spec = GET_HAL_SPEC(adapter);4245HAL_DATA_TYPE *hal_data = GET_HAL_DATA(adapter);4246struct registry_priv *regsty = adapter_to_regsty(adapter);4247int path, tx_num, band, rs;4248u8 target;42494250for (band = BAND_ON_2_4G; band <= BAND_ON_5G; band++) {4251if (!hal_is_band_support(adapter, band))4252continue;42534254for (path = 0; path < RF_PATH_MAX; path++) {4255if (!HAL_SPEC_CHK_RF_PATH(hal_spec, band, path))4256break;42574258RTW_PRINT_SEL(sel, "[%s][%c]%s\n", band_str(band), rf_path_char(path)4259, (regsty->target_tx_pwr_valid == _FALSE && hal_data->txpwr_by_rate_undefined_band_path[band][path]) ? "(dup)" : "");42604261for (rs = 0; rs < RATE_SECTION_NUM; rs++) {4262tx_num = rate_section_to_tx_num(rs);4263if (tx_num + 1 > hal_data->tx_nss)4264continue;42654266if (band == BAND_ON_5G && IS_CCK_RATE_SECTION(rs))4267continue;42684269if (IS_VHT_RATE_SECTION(rs) && !IS_HARDWARE_TYPE_JAGUAR_ALL(adapter))4270continue;42714272#ifdef CONFIG_USE_TSSI4273target = PHY_GetTxPowerByRateOriginal(adapter, band, path, MGN_MCS7);4274#else4275target = PHY_GetTxPowerByRateBase(adapter, band, path, rs);4276#endif42774278if (target % hal_spec->txgi_pdbm) {4279_RTW_PRINT_SEL(sel, "%7s: %2d.%d\n", rate_section_str(rs)4280, target / hal_spec->txgi_pdbm, (target % hal_spec->txgi_pdbm) * 100 / hal_spec->txgi_pdbm);4281} else {4282_RTW_PRINT_SEL(sel, "%7s: %5d\n", rate_section_str(rs)4283, target / hal_spec->txgi_pdbm);4284}4285}4286}4287}42884289return;4290}42914292void dump_tx_power_by_rate(void *sel, _adapter *adapter)4293{4294struct hal_spec_t *hal_spec = GET_HAL_SPEC(adapter);4295HAL_DATA_TYPE *hal_data = GET_HAL_DATA(adapter);4296int path, tx_num, band, n, rs;4297u8 rate_num, max_rate_num, base;4298s8 by_rate_offset;42994300for (band = BAND_ON_2_4G; band <= BAND_ON_5G; band++) {4301if (!hal_is_band_support(adapter, band))4302continue;43034304for (path = 0; path < RF_PATH_MAX; path++) {4305if (!HAL_SPEC_CHK_RF_PATH(hal_spec, band, path))4306break;43074308RTW_PRINT_SEL(sel, "[%s][%c]%s\n", band_str(band), rf_path_char(path)4309, hal_data->txpwr_by_rate_undefined_band_path[band][path] ? "(dup)" : "");43104311for (rs = 0; rs < RATE_SECTION_NUM; rs++) {4312tx_num = rate_section_to_tx_num(rs);4313if (tx_num + 1 > hal_data->tx_nss)4314continue;43154316if (band == BAND_ON_5G && IS_CCK_RATE_SECTION(rs))4317continue;43184319if (IS_VHT_RATE_SECTION(rs) && !IS_HARDWARE_TYPE_JAGUAR_ALL(adapter))4320continue;43214322if (IS_HARDWARE_TYPE_JAGUAR_ALL(adapter))4323max_rate_num = 10;4324else4325max_rate_num = 8;4326rate_num = rate_section_rate_num(rs);4327#ifdef CONFIG_USE_TSSI4328base = 0;4329#else4330base = PHY_GetTxPowerByRateBase(adapter, band, path, rs);4331#endif43324333RTW_PRINT_SEL(sel, "%7s: ", rate_section_str(rs));43344335/* dump power by rate in db */4336for (n = rate_num - 1; n >= 0; n--) {4337#ifdef CONFIG_USE_TSSI4338by_rate_offset = PHY_GetTxPowerByRateOriginal(adapter, band, path, rates_by_sections[rs].rates[n]);4339#else4340by_rate_offset = PHY_GetTxPowerByRate(adapter, band, path, rates_by_sections[rs].rates[n]);4341#endif43424343if ((base + by_rate_offset) % hal_spec->txgi_pdbm) {4344_RTW_PRINT_SEL(sel, "%2d.%d ", (base + by_rate_offset) / hal_spec->txgi_pdbm4345, ((base + by_rate_offset) % hal_spec->txgi_pdbm) * 100 / hal_spec->txgi_pdbm);4346} else4347_RTW_PRINT_SEL(sel, "%5d ", (base + by_rate_offset) / hal_spec->txgi_pdbm);4348}4349for (n = 0; n < max_rate_num - rate_num; n++)4350_RTW_PRINT_SEL(sel, "%5s ", "");43514352_RTW_PRINT_SEL(sel, "|");43534354/* dump power by rate in offset */4355for (n = rate_num - 1; n >= 0; n--) {4356by_rate_offset = PHY_GetTxPowerByRate(adapter, band, path, rates_by_sections[rs].rates[n]);4357_RTW_PRINT_SEL(sel, "%3d ", by_rate_offset);4358}4359RTW_PRINT_SEL(sel, "\n");43604361}4362}4363}4364}43654366/*4367* phy file path is stored in global char array rtw_phy_para_file_path4368* need to care about racing4369*/4370int rtw_get_phy_file_path(_adapter *adapter, const char *file_name)4371{4372#ifdef CONFIG_LOAD_PHY_PARA_FROM_FILE4373struct hal_spec_t *hal_spec = GET_HAL_SPEC(adapter);4374int len = 0;43754376if (file_name) {4377len += snprintf(rtw_phy_para_file_path, PATH_LENGTH_MAX, "%s", rtw_phy_file_path);4378#if defined(CONFIG_MULTIDRV) || defined(REALTEK_CONFIG_PATH_WITH_IC_NAME_FOLDER)4379len += snprintf(rtw_phy_para_file_path + len, PATH_LENGTH_MAX - len, "%s/", hal_spec->ic_name);4380#endif4381len += snprintf(rtw_phy_para_file_path + len, PATH_LENGTH_MAX - len, "%s", file_name);43824383return _TRUE;4384}4385#endif4386return _FALSE;4387}43884389#ifdef CONFIG_LOAD_PHY_PARA_FROM_FILE4390int4391phy_ConfigMACWithParaFile(4392PADAPTER Adapter,4393char *pFileName4394)4395{4396PHAL_DATA_TYPE pHalData = GET_HAL_DATA(Adapter);4397int rlen = 0, rtStatus = _FAIL;4398char *szLine, *ptmp;4399u32 u4bRegOffset, u4bRegValue, u4bMove;44004401if (!(Adapter->registrypriv.load_phy_file & LOAD_MAC_PARA_FILE))4402return rtStatus;44034404_rtw_memset(pHalData->para_file_buf, 0, MAX_PARA_FILE_BUF_LEN);44054406if ((pHalData->mac_reg_len == 0) && (pHalData->mac_reg == NULL)) {4407rtw_get_phy_file_path(Adapter, pFileName);4408if (rtw_readable_file_sz_chk(rtw_phy_para_file_path,4409MAX_PARA_FILE_BUF_LEN) == _TRUE) {4410rlen = rtw_retrieve_from_file(rtw_phy_para_file_path, pHalData->para_file_buf, MAX_PARA_FILE_BUF_LEN);4411if (rlen > 0) {4412rtStatus = _SUCCESS;4413pHalData->mac_reg = rtw_zvmalloc(rlen);4414if (pHalData->mac_reg) {4415_rtw_memcpy(pHalData->mac_reg, pHalData->para_file_buf, rlen);4416pHalData->mac_reg_len = rlen;4417} else4418RTW_INFO("%s mac_reg alloc fail !\n", __FUNCTION__);4419}4420}4421} else {4422if ((pHalData->mac_reg_len != 0) && (pHalData->mac_reg != NULL)) {4423_rtw_memcpy(pHalData->para_file_buf, pHalData->mac_reg, pHalData->mac_reg_len);4424rtStatus = _SUCCESS;4425} else4426RTW_INFO("%s(): Critical Error !!!\n", __FUNCTION__);4427}44284429if (rtStatus == _SUCCESS) {4430ptmp = pHalData->para_file_buf;4431for (szLine = GetLineFromBuffer(ptmp); szLine != NULL; szLine = GetLineFromBuffer(ptmp)) {4432if (!IsCommentString(szLine)) {4433/* Get 1st hex value as register offset */4434if (GetHexValueFromString(szLine, &u4bRegOffset, &u4bMove)) {4435if (u4bRegOffset == 0xffff) {4436/* Ending. */4437break;4438}44394440/* Get 2nd hex value as register value. */4441szLine += u4bMove;4442if (GetHexValueFromString(szLine, &u4bRegValue, &u4bMove))4443rtw_write8(Adapter, u4bRegOffset, (u8)u4bRegValue);4444}4445}4446}4447} else4448RTW_INFO("%s(): No File %s, Load from HWImg Array!\n", __FUNCTION__, pFileName);44494450return rtStatus;4451}44524453int4454phy_ConfigBBWithParaFile(4455PADAPTER Adapter,4456char *pFileName,4457u32 ConfigType4458)4459{4460HAL_DATA_TYPE *pHalData = GET_HAL_DATA(Adapter);4461int rlen = 0, rtStatus = _FAIL;4462char *szLine, *ptmp;4463u32 u4bRegOffset, u4bRegValue, u4bMove;4464char *pBuf = NULL;4465u32 *pBufLen = NULL;44664467if (!(Adapter->registrypriv.load_phy_file & LOAD_BB_PARA_FILE))4468return rtStatus;44694470switch (ConfigType) {4471case CONFIG_BB_PHY_REG:4472pBuf = pHalData->bb_phy_reg;4473pBufLen = &pHalData->bb_phy_reg_len;4474break;4475case CONFIG_BB_AGC_TAB:4476pBuf = pHalData->bb_agc_tab;4477pBufLen = &pHalData->bb_agc_tab_len;4478break;4479default:4480RTW_INFO("Unknown ConfigType!! %d\r\n", ConfigType);4481break;4482}44834484_rtw_memset(pHalData->para_file_buf, 0, MAX_PARA_FILE_BUF_LEN);44854486if ((pBufLen != NULL) && (*pBufLen == 0) && (pBuf == NULL)) {4487rtw_get_phy_file_path(Adapter, pFileName);4488if (rtw_readable_file_sz_chk(rtw_phy_para_file_path,4489MAX_PARA_FILE_BUF_LEN) == _TRUE) {4490rlen = rtw_retrieve_from_file(rtw_phy_para_file_path, pHalData->para_file_buf, MAX_PARA_FILE_BUF_LEN);4491if (rlen > 0) {4492rtStatus = _SUCCESS;4493pBuf = rtw_zvmalloc(rlen);4494if (pBuf) {4495_rtw_memcpy(pBuf, pHalData->para_file_buf, rlen);4496*pBufLen = rlen;44974498switch (ConfigType) {4499case CONFIG_BB_PHY_REG:4500pHalData->bb_phy_reg = pBuf;4501break;4502case CONFIG_BB_AGC_TAB:4503pHalData->bb_agc_tab = pBuf;4504break;4505}4506} else4507RTW_INFO("%s(): ConfigType %d alloc fail !\n", __FUNCTION__, ConfigType);4508}4509}4510} else {4511if ((pBufLen != NULL) && (*pBufLen != 0) && (pBuf != NULL)) {4512_rtw_memcpy(pHalData->para_file_buf, pBuf, *pBufLen);4513rtStatus = _SUCCESS;4514} else4515RTW_INFO("%s(): Critical Error !!!\n", __FUNCTION__);4516}45174518if (rtStatus == _SUCCESS) {4519ptmp = pHalData->para_file_buf;4520for (szLine = GetLineFromBuffer(ptmp); szLine != NULL; szLine = GetLineFromBuffer(ptmp)) {4521if (!IsCommentString(szLine)) {4522/* Get 1st hex value as register offset. */4523if (GetHexValueFromString(szLine, &u4bRegOffset, &u4bMove)) {4524if (u4bRegOffset == 0xffff) {4525/* Ending. */4526break;4527} else if (u4bRegOffset == 0xfe || u4bRegOffset == 0xffe) {4528#ifdef CONFIG_LONG_DELAY_ISSUE4529rtw_msleep_os(50);4530#else4531rtw_mdelay_os(50);4532#endif4533} else if (u4bRegOffset == 0xfd)4534rtw_mdelay_os(5);4535else if (u4bRegOffset == 0xfc)4536rtw_mdelay_os(1);4537else if (u4bRegOffset == 0xfb)4538rtw_udelay_os(50);4539else if (u4bRegOffset == 0xfa)4540rtw_udelay_os(5);4541else if (u4bRegOffset == 0xf9)4542rtw_udelay_os(1);45434544/* Get 2nd hex value as register value. */4545szLine += u4bMove;4546if (GetHexValueFromString(szLine, &u4bRegValue, &u4bMove)) {4547/* RTW_INFO("[BB-ADDR]%03lX=%08lX\n", u4bRegOffset, u4bRegValue); */4548phy_set_bb_reg(Adapter, u4bRegOffset, bMaskDWord, u4bRegValue);45494550if (u4bRegOffset == 0xa24)4551pHalData->odmpriv.rf_calibrate_info.rega24 = u4bRegValue;45524553/* Add 1us delay between BB/RF register setting. */4554rtw_udelay_os(1);4555}4556}4557}4558}4559} else4560RTW_INFO("%s(): No File %s, Load from HWImg Array!\n", __FUNCTION__, pFileName);45614562return rtStatus;4563}45644565void4566phy_DecryptBBPgParaFile(4567PADAPTER Adapter,4568char *buffer4569)4570{4571u32 i = 0, j = 0;4572u8 map[95] = {0};4573u8 currentChar;4574char *BufOfLines, *ptmp;45754576/* RTW_INFO("=====>phy_DecryptBBPgParaFile()\n"); */4577/* 32 the ascii code of the first visable char, 126 the last one */4578for (i = 0; i < 95; ++i)4579map[i] = (u8)(94 - i);45804581ptmp = buffer;4582i = 0;4583for (BufOfLines = GetLineFromBuffer(ptmp); BufOfLines != NULL; BufOfLines = GetLineFromBuffer(ptmp)) {4584/* RTW_INFO("Encrypted Line: %s\n", BufOfLines); */45854586for (j = 0; j < strlen(BufOfLines); ++j) {4587currentChar = BufOfLines[j];45884589if (currentChar == '\0')4590break;45914592currentChar -= (u8)((((i + j) * 3) % 128));45934594BufOfLines[j] = map[currentChar - 32] + 32;4595}4596/* RTW_INFO("Decrypted Line: %s\n", BufOfLines ); */4597if (strlen(BufOfLines) != 0)4598i++;4599BufOfLines[strlen(BufOfLines)] = '\n';4600}4601}46024603#ifndef DBG_TXPWR_BY_RATE_FILE_PARSE4604#define DBG_TXPWR_BY_RATE_FILE_PARSE 04605#endif46064607int4608phy_ParseBBPgParaFile(4609PADAPTER Adapter,4610char *buffer4611)4612{4613int rtStatus = _FAIL;4614HAL_DATA_TYPE *pHalData = GET_HAL_DATA(Adapter);4615struct hal_spec_t *hal_spec = GET_HAL_SPEC(Adapter);4616char *szLine, *ptmp;4617u32 u4bRegOffset, u4bRegMask;4618u32 u4bMove;4619BOOLEAN firstLine = _TRUE;4620u8 tx_num = 0;4621u8 band = 0, rf_path = 0;46224623if (Adapter->registrypriv.RegDecryptCustomFile == 1)4624phy_DecryptBBPgParaFile(Adapter, buffer);46254626ptmp = buffer;4627for (szLine = GetLineFromBuffer(ptmp); szLine != NULL; szLine = GetLineFromBuffer(ptmp)) {4628if (isAllSpaceOrTab(szLine, sizeof(*szLine)))4629continue;46304631if (!IsCommentString(szLine)) {4632/* Get header info (relative value or exact value) */4633if (firstLine) {4634if (eqNByte(szLine, (u8 *)("#[v1]"), 5)4635|| eqNByte(szLine, (u8 *)("#[v2]"), 5))4636pHalData->odmpriv.phy_reg_pg_version = szLine[3] - '0';4637else {4638RTW_ERR("The format in PHY_REG_PG are invalid %s\n", szLine);4639goto exit;4640}46414642if (eqNByte(szLine + 5, (u8 *)("[Exact]#"), 8)) {4643pHalData->odmpriv.phy_reg_pg_value_type = PHY_REG_PG_EXACT_VALUE;4644firstLine = _FALSE;4645continue;4646} else {4647RTW_ERR("The values in PHY_REG_PG are invalid %s\n", szLine);4648goto exit;4649}4650}46514652if (pHalData->odmpriv.phy_reg_pg_version > 0) {4653u32 index = 0;46544655if (eqNByte(szLine, "0xffff", 6))4656break;46574658if (!eqNByte("#[END]#", szLine, 7)) {4659/* load the table label info */4660if (szLine[0] == '#') {4661index = 0;4662if (eqNByte(szLine, "#[2.4G]" , 7)) {4663band = BAND_ON_2_4G;4664index += 8;4665} else if (eqNByte(szLine, "#[5G]", 5)) {4666band = BAND_ON_5G;4667index += 6;4668} else {4669RTW_ERR("Invalid band %s in PHY_REG_PG.txt\n", szLine);4670goto exit;4671}46724673rf_path = szLine[index] - 'A';4674if (DBG_TXPWR_BY_RATE_FILE_PARSE)4675RTW_INFO(" Table label Band %d, RfPath %d\n", band, rf_path );4676} else { /* load rows of tables */4677if (szLine[1] == '1')4678tx_num = RF_1TX;4679else if (szLine[1] == '2')4680tx_num = RF_2TX;4681else if (szLine[1] == '3')4682tx_num = RF_3TX;4683else if (szLine[1] == '4')4684tx_num = RF_4TX;4685else {4686RTW_ERR("Invalid row in PHY_REG_PG.txt '%c'(%d)\n", szLine[1], szLine[1]);4687goto exit;4688}46894690while (szLine[index] != ']')4691++index;4692++index;/* skip ] */46934694/* Get 2nd hex value as register offset. */4695szLine += index;4696if (GetHexValueFromString(szLine, &u4bRegOffset, &u4bMove))4697szLine += u4bMove;4698else4699goto exit;47004701/* Get 2nd hex value as register mask. */4702if (GetHexValueFromString(szLine, &u4bRegMask, &u4bMove))4703szLine += u4bMove;4704else4705goto exit;47064707if (pHalData->odmpriv.phy_reg_pg_value_type == PHY_REG_PG_EXACT_VALUE) {4708u32 combineValue = 0;4709u8 integer = 0, fraction = 0;47104711if (GetFractionValueFromString(szLine, &integer, &fraction, &u4bMove))4712szLine += u4bMove;4713else4714goto exit;47154716integer *= hal_spec->txgi_pdbm;4717integer += ((u16)fraction * (u16)hal_spec->txgi_pdbm) / 100;4718if (pHalData->odmpriv.phy_reg_pg_version == 1)4719combineValue |= (((integer / 10) << 4) + (integer % 10));4720else4721combineValue |= integer;47224723if (GetFractionValueFromString(szLine, &integer, &fraction, &u4bMove))4724szLine += u4bMove;4725else4726goto exit;47274728integer *= hal_spec->txgi_pdbm;4729integer += ((u16)fraction * (u16)hal_spec->txgi_pdbm) / 100;4730combineValue <<= 8;4731if (pHalData->odmpriv.phy_reg_pg_version == 1)4732combineValue |= (((integer / 10) << 4) + (integer % 10));4733else4734combineValue |= integer;47354736if (GetFractionValueFromString(szLine, &integer, &fraction, &u4bMove))4737szLine += u4bMove;4738else4739goto exit;47404741integer *= hal_spec->txgi_pdbm;4742integer += ((u16)fraction * (u16)hal_spec->txgi_pdbm) / 100;4743combineValue <<= 8;4744if (pHalData->odmpriv.phy_reg_pg_version == 1)4745combineValue |= (((integer / 10) << 4) + (integer % 10));4746else4747combineValue |= integer;47484749if (GetFractionValueFromString(szLine, &integer, &fraction, &u4bMove))4750szLine += u4bMove;4751else4752goto exit;47534754integer *= hal_spec->txgi_pdbm;4755integer += ((u16)fraction * (u16)hal_spec->txgi_pdbm) / 100;4756combineValue <<= 8;4757if (pHalData->odmpriv.phy_reg_pg_version == 1)4758combineValue |= (((integer / 10) << 4) + (integer % 10));4759else4760combineValue |= integer;47614762phy_store_tx_power_by_rate(Adapter, band, rf_path, tx_num, u4bRegOffset, u4bRegMask, combineValue);47634764if (DBG_TXPWR_BY_RATE_FILE_PARSE)4765RTW_INFO("addr:0x%3x mask:0x%08x %dTx = 0x%08x\n", u4bRegOffset, u4bRegMask, tx_num + 1, combineValue);4766}4767}4768}4769}4770}4771}47724773rtStatus = _SUCCESS;47744775exit:4776RTW_INFO("%s return %d\n", __func__, rtStatus);4777return rtStatus;4778}47794780int4781phy_ConfigBBWithPgParaFile(4782PADAPTER Adapter,4783const char *pFileName)4784{4785HAL_DATA_TYPE *pHalData = GET_HAL_DATA(Adapter);4786int rlen = 0, rtStatus = _FAIL;47874788if (!(Adapter->registrypriv.load_phy_file & LOAD_BB_PG_PARA_FILE))4789return rtStatus;47904791_rtw_memset(pHalData->para_file_buf, 0, MAX_PARA_FILE_BUF_LEN);47924793if (pHalData->bb_phy_reg_pg == NULL) {4794rtw_get_phy_file_path(Adapter, pFileName);4795if (rtw_readable_file_sz_chk(rtw_phy_para_file_path,4796MAX_PARA_FILE_BUF_LEN) == _TRUE) {4797rlen = rtw_retrieve_from_file(rtw_phy_para_file_path, pHalData->para_file_buf, MAX_PARA_FILE_BUF_LEN);4798if (rlen > 0) {4799rtStatus = _SUCCESS;4800pHalData->bb_phy_reg_pg = rtw_zvmalloc(rlen);4801if (pHalData->bb_phy_reg_pg) {4802_rtw_memcpy(pHalData->bb_phy_reg_pg, pHalData->para_file_buf, rlen);4803pHalData->bb_phy_reg_pg_len = rlen;4804} else4805RTW_INFO("%s bb_phy_reg_pg alloc fail !\n", __FUNCTION__);4806}4807}4808} else {4809if ((pHalData->bb_phy_reg_pg_len != 0) && (pHalData->bb_phy_reg_pg != NULL)) {4810_rtw_memcpy(pHalData->para_file_buf, pHalData->bb_phy_reg_pg, pHalData->bb_phy_reg_pg_len);4811rtStatus = _SUCCESS;4812} else4813RTW_INFO("%s(): Critical Error !!!\n", __FUNCTION__);4814}48154816if (rtStatus == _SUCCESS) {4817/* RTW_INFO("phy_ConfigBBWithPgParaFile(): read %s ok\n", pFileName); */4818rtStatus = phy_ParseBBPgParaFile(Adapter, pHalData->para_file_buf);4819} else4820RTW_INFO("%s(): No File %s, Load from HWImg Array!\n", __FUNCTION__, pFileName);48214822return rtStatus;4823}48244825#if (MP_DRIVER == 1)48264827int4828phy_ConfigBBWithMpParaFile(4829PADAPTER Adapter,4830char *pFileName4831)4832{4833HAL_DATA_TYPE *pHalData = GET_HAL_DATA(Adapter);4834int rlen = 0, rtStatus = _FAIL;4835char *szLine, *ptmp;4836u32 u4bRegOffset, u4bRegValue, u4bMove;48374838if (!(Adapter->registrypriv.load_phy_file & LOAD_BB_MP_PARA_FILE))4839return rtStatus;48404841_rtw_memset(pHalData->para_file_buf, 0, MAX_PARA_FILE_BUF_LEN);48424843if ((pHalData->bb_phy_reg_mp_len == 0) && (pHalData->bb_phy_reg_mp == NULL)) {4844rtw_get_phy_file_path(Adapter, pFileName);4845if (rtw_readable_file_sz_chk(rtw_phy_para_file_path,4846MAX_PARA_FILE_BUF_LEN) == _TRUE) {4847rlen = rtw_retrieve_from_file(rtw_phy_para_file_path, pHalData->para_file_buf, MAX_PARA_FILE_BUF_LEN);4848if (rlen > 0) {4849rtStatus = _SUCCESS;4850pHalData->bb_phy_reg_mp = rtw_zvmalloc(rlen);4851if (pHalData->bb_phy_reg_mp) {4852_rtw_memcpy(pHalData->bb_phy_reg_mp, pHalData->para_file_buf, rlen);4853pHalData->bb_phy_reg_mp_len = rlen;4854} else4855RTW_INFO("%s bb_phy_reg_mp alloc fail !\n", __FUNCTION__);4856}4857}4858} else {4859if ((pHalData->bb_phy_reg_mp_len != 0) && (pHalData->bb_phy_reg_mp != NULL)) {4860_rtw_memcpy(pHalData->para_file_buf, pHalData->bb_phy_reg_mp, pHalData->bb_phy_reg_mp_len);4861rtStatus = _SUCCESS;4862} else4863RTW_INFO("%s(): Critical Error !!!\n", __FUNCTION__);4864}48654866if (rtStatus == _SUCCESS) {4867/* RTW_INFO("phy_ConfigBBWithMpParaFile(): read %s ok\n", pFileName); */48684869ptmp = pHalData->para_file_buf;4870for (szLine = GetLineFromBuffer(ptmp); szLine != NULL; szLine = GetLineFromBuffer(ptmp)) {4871if (!IsCommentString(szLine)) {4872/* Get 1st hex value as register offset. */4873if (GetHexValueFromString(szLine, &u4bRegOffset, &u4bMove)) {4874if (u4bRegOffset == 0xffff) {4875/* Ending. */4876break;4877} else if (u4bRegOffset == 0xfe || u4bRegOffset == 0xffe) {4878#ifdef CONFIG_LONG_DELAY_ISSUE4879rtw_msleep_os(50);4880#else4881rtw_mdelay_os(50);4882#endif4883} else if (u4bRegOffset == 0xfd)4884rtw_mdelay_os(5);4885else if (u4bRegOffset == 0xfc)4886rtw_mdelay_os(1);4887else if (u4bRegOffset == 0xfb)4888rtw_udelay_os(50);4889else if (u4bRegOffset == 0xfa)4890rtw_udelay_os(5);4891else if (u4bRegOffset == 0xf9)4892rtw_udelay_os(1);48934894/* Get 2nd hex value as register value. */4895szLine += u4bMove;4896if (GetHexValueFromString(szLine, &u4bRegValue, &u4bMove)) {4897/* RTW_INFO("[ADDR]%03lX=%08lX\n", u4bRegOffset, u4bRegValue); */4898phy_set_bb_reg(Adapter, u4bRegOffset, bMaskDWord, u4bRegValue);48994900/* Add 1us delay between BB/RF register setting. */4901rtw_udelay_os(1);4902}4903}4904}4905}4906} else4907RTW_INFO("%s(): No File %s, Load from HWImg Array!\n", __FUNCTION__, pFileName);49084909return rtStatus;4910}49114912#endif49134914int4915PHY_ConfigRFWithParaFile(4916PADAPTER Adapter,4917char *pFileName,4918enum rf_path eRFPath4919)4920{4921HAL_DATA_TYPE *pHalData = GET_HAL_DATA(Adapter);4922int rlen = 0, rtStatus = _FAIL;4923char *szLine, *ptmp;4924u32 u4bRegOffset, u4bRegValue, u4bMove;4925u16 i;4926char *pBuf = NULL;4927u32 *pBufLen = NULL;49284929if (!(Adapter->registrypriv.load_phy_file & LOAD_RF_PARA_FILE))4930return rtStatus;49314932switch (eRFPath) {4933case RF_PATH_A:4934pBuf = pHalData->rf_radio_a;4935pBufLen = &pHalData->rf_radio_a_len;4936break;4937case RF_PATH_B:4938pBuf = pHalData->rf_radio_b;4939pBufLen = &pHalData->rf_radio_b_len;4940break;4941default:4942RTW_INFO("Unknown RF path!! %d\r\n", eRFPath);4943break;4944}49454946_rtw_memset(pHalData->para_file_buf, 0, MAX_PARA_FILE_BUF_LEN);49474948if ((pBufLen != NULL) && (*pBufLen == 0) && (pBuf == NULL)) {4949rtw_get_phy_file_path(Adapter, pFileName);4950if (rtw_readable_file_sz_chk(rtw_phy_para_file_path,4951MAX_PARA_FILE_BUF_LEN) == _TRUE) {4952rlen = rtw_retrieve_from_file(rtw_phy_para_file_path, pHalData->para_file_buf, MAX_PARA_FILE_BUF_LEN);4953if (rlen > 0) {4954rtStatus = _SUCCESS;4955pBuf = rtw_zvmalloc(rlen);4956if (pBuf) {4957_rtw_memcpy(pBuf, pHalData->para_file_buf, rlen);4958*pBufLen = rlen;49594960switch (eRFPath) {4961case RF_PATH_A:4962pHalData->rf_radio_a = pBuf;4963break;4964case RF_PATH_B:4965pHalData->rf_radio_b = pBuf;4966break;4967default:4968RTW_INFO("Unknown RF path!! %d\r\n", eRFPath);4969break;4970}4971} else4972RTW_INFO("%s(): eRFPath=%d alloc fail !\n", __FUNCTION__, eRFPath);4973}4974}4975} else {4976if ((pBufLen != NULL) && (*pBufLen != 0) && (pBuf != NULL)) {4977_rtw_memcpy(pHalData->para_file_buf, pBuf, *pBufLen);4978rtStatus = _SUCCESS;4979} else4980RTW_INFO("%s(): Critical Error !!!\n", __FUNCTION__);4981}49824983if (rtStatus == _SUCCESS) {4984/* RTW_INFO("%s(): read %s successfully\n", __FUNCTION__, pFileName); */49854986ptmp = pHalData->para_file_buf;4987for (szLine = GetLineFromBuffer(ptmp); szLine != NULL; szLine = GetLineFromBuffer(ptmp)) {4988if (!IsCommentString(szLine)) {4989/* Get 1st hex value as register offset. */4990if (GetHexValueFromString(szLine, &u4bRegOffset, &u4bMove)) {4991if (u4bRegOffset == 0xfe || u4bRegOffset == 0xffe) {4992/* Deay specific ms. Only RF configuration require delay. */4993#ifdef CONFIG_LONG_DELAY_ISSUE4994rtw_msleep_os(50);4995#else4996rtw_mdelay_os(50);4997#endif4998} else if (u4bRegOffset == 0xfd) {4999/* delay_ms(5); */5000for (i = 0; i < 100; i++)5001rtw_udelay_os(MAX_STALL_TIME);5002} else if (u4bRegOffset == 0xfc) {5003/* delay_ms(1); */5004for (i = 0; i < 20; i++)5005rtw_udelay_os(MAX_STALL_TIME);5006} else if (u4bRegOffset == 0xfb)5007rtw_udelay_os(50);5008else if (u4bRegOffset == 0xfa)5009rtw_udelay_os(5);5010else if (u4bRegOffset == 0xf9)5011rtw_udelay_os(1);5012else if (u4bRegOffset == 0xffff)5013break;50145015/* Get 2nd hex value as register value. */5016szLine += u4bMove;5017if (GetHexValueFromString(szLine, &u4bRegValue, &u4bMove)) {5018phy_set_rf_reg(Adapter, eRFPath, u4bRegOffset, bRFRegOffsetMask, u4bRegValue);50195020/* Temp add, for frequency lock, if no delay, that may cause */5021/* frequency shift, ex: 2412MHz => 2417MHz */5022/* If frequency shift, the following action may works. */5023/* Fractional-N table in radio_a.txt */5024/* 0x2a 0x00001 */ /* channel 1 */5025/* 0x2b 0x00808 frequency divider. */5026/* 0x2b 0x53333 */5027/* 0x2c 0x0000c */5028rtw_udelay_os(1);5029}5030}5031}5032}5033} else5034RTW_INFO("%s(): No File %s, Load from HWImg Array!\n", __FUNCTION__, pFileName);50355036return rtStatus;5037}50385039void5040initDeltaSwingIndexTables(5041PADAPTER Adapter,5042char *Band,5043char *Path,5044char *Sign,5045char *Channel,5046char *Rate,5047char *Data5048)5049{5050#define STR_EQUAL_5G(_band, _path, _sign, _rate, _chnl) \5051((strcmp(Band, _band) == 0) && (strcmp(Path, _path) == 0) && (strcmp(Sign, _sign) == 0) &&\5052(strcmp(Rate, _rate) == 0) && (strcmp(Channel, _chnl) == 0)\5053)5054#define STR_EQUAL_2G(_band, _path, _sign, _rate) \5055((strcmp(Band, _band) == 0) && (strcmp(Path, _path) == 0) && (strcmp(Sign, _sign) == 0) &&\5056(strcmp(Rate, _rate) == 0)\5057)50585059#define STORE_SWING_TABLE(_array, _iteratedIdx) \5060do { \5061for (token = strsep(&Data, delim); token != NULL; token = strsep(&Data, delim)) {\5062sscanf(token, "%d", &idx);\5063_array[_iteratedIdx++] = (u8)idx;\5064} } while (0)\50655066HAL_DATA_TYPE *pHalData = GET_HAL_DATA(Adapter);5067struct dm_struct *pDM_Odm = &pHalData->odmpriv;5068struct dm_rf_calibration_struct *pRFCalibrateInfo = &(pDM_Odm->rf_calibrate_info);5069u32 j = 0;5070char *token;5071char delim[] = ",";5072u32 idx = 0;50735074/* RTW_INFO("===>initDeltaSwingIndexTables(): Band: %s;\nPath: %s;\nSign: %s;\nChannel: %s;\nRate: %s;\n, Data: %s;\n", */5075/* Band, Path, Sign, Channel, Rate, Data); */50765077if (STR_EQUAL_2G("2G", "A", "+", "CCK"))5078STORE_SWING_TABLE(pRFCalibrateInfo->delta_swing_table_idx_2g_cck_a_p, j);5079else if (STR_EQUAL_2G("2G", "A", "-", "CCK"))5080STORE_SWING_TABLE(pRFCalibrateInfo->delta_swing_table_idx_2g_cck_a_n, j);5081else if (STR_EQUAL_2G("2G", "B", "+", "CCK"))5082STORE_SWING_TABLE(pRFCalibrateInfo->delta_swing_table_idx_2g_cck_b_p, j);5083else if (STR_EQUAL_2G("2G", "B", "-", "CCK"))5084STORE_SWING_TABLE(pRFCalibrateInfo->delta_swing_table_idx_2g_cck_b_n, j);5085else if (STR_EQUAL_2G("2G", "A", "+", "ALL"))5086STORE_SWING_TABLE(pRFCalibrateInfo->delta_swing_table_idx_2ga_p, j);5087else if (STR_EQUAL_2G("2G", "A", "-", "ALL"))5088STORE_SWING_TABLE(pRFCalibrateInfo->delta_swing_table_idx_2ga_n, j);5089else if (STR_EQUAL_2G("2G", "B", "+", "ALL"))5090STORE_SWING_TABLE(pRFCalibrateInfo->delta_swing_table_idx_2gb_p, j);5091else if (STR_EQUAL_2G("2G", "B", "-", "ALL"))5092STORE_SWING_TABLE(pRFCalibrateInfo->delta_swing_table_idx_2gb_n, j);5093else if (STR_EQUAL_5G("5G", "A", "+", "ALL", "0"))5094STORE_SWING_TABLE(pRFCalibrateInfo->delta_swing_table_idx_5ga_p[0], j);5095else if (STR_EQUAL_5G("5G", "A", "-", "ALL", "0"))5096STORE_SWING_TABLE(pRFCalibrateInfo->delta_swing_table_idx_5ga_n[0], j);5097else if (STR_EQUAL_5G("5G", "B", "+", "ALL", "0"))5098STORE_SWING_TABLE(pRFCalibrateInfo->delta_swing_table_idx_5gb_p[0], j);5099else if (STR_EQUAL_5G("5G", "B", "-", "ALL", "0"))5100STORE_SWING_TABLE(pRFCalibrateInfo->delta_swing_table_idx_5gb_n[0], j);5101else if (STR_EQUAL_5G("5G", "A", "+", "ALL", "1"))5102STORE_SWING_TABLE(pRFCalibrateInfo->delta_swing_table_idx_5ga_p[1], j);5103else if (STR_EQUAL_5G("5G", "A", "-", "ALL", "1"))5104STORE_SWING_TABLE(pRFCalibrateInfo->delta_swing_table_idx_5ga_n[1], j);5105else if (STR_EQUAL_5G("5G", "B", "+", "ALL", "1"))5106STORE_SWING_TABLE(pRFCalibrateInfo->delta_swing_table_idx_5gb_p[1], j);5107else if (STR_EQUAL_5G("5G", "B", "-", "ALL", "1"))5108STORE_SWING_TABLE(pRFCalibrateInfo->delta_swing_table_idx_5gb_n[1], j);5109else if (STR_EQUAL_5G("5G", "A", "+", "ALL", "2"))5110STORE_SWING_TABLE(pRFCalibrateInfo->delta_swing_table_idx_5ga_p[2], j);5111else if (STR_EQUAL_5G("5G", "A", "-", "ALL", "2"))5112STORE_SWING_TABLE(pRFCalibrateInfo->delta_swing_table_idx_5ga_n[2], j);5113else if (STR_EQUAL_5G("5G", "B", "+", "ALL", "2"))5114STORE_SWING_TABLE(pRFCalibrateInfo->delta_swing_table_idx_5gb_p[2], j);5115else if (STR_EQUAL_5G("5G", "B", "-", "ALL", "2"))5116STORE_SWING_TABLE(pRFCalibrateInfo->delta_swing_table_idx_5gb_n[2], j);5117else if (STR_EQUAL_5G("5G", "A", "+", "ALL", "3"))5118STORE_SWING_TABLE(pRFCalibrateInfo->delta_swing_table_idx_5ga_p[3], j);5119else if (STR_EQUAL_5G("5G", "A", "-", "ALL", "3"))5120STORE_SWING_TABLE(pRFCalibrateInfo->delta_swing_table_idx_5ga_n[3], j);5121else if (STR_EQUAL_5G("5G", "B", "+", "ALL", "3"))5122STORE_SWING_TABLE(pRFCalibrateInfo->delta_swing_table_idx_5gb_p[3], j);5123else if (STR_EQUAL_5G("5G", "B", "-", "ALL", "3"))5124STORE_SWING_TABLE(pRFCalibrateInfo->delta_swing_table_idx_5gb_n[3], j);5125else5126RTW_INFO("===>initDeltaSwingIndexTables(): The input is invalid!!\n");5127}51285129int5130PHY_ConfigRFWithTxPwrTrackParaFile(5131PADAPTER Adapter,5132char *pFileName5133)5134{5135HAL_DATA_TYPE *pHalData = GET_HAL_DATA(Adapter);5136struct dm_struct *pDM_Odm = &pHalData->odmpriv;5137int rlen = 0, rtStatus = _FAIL;5138char *szLine, *ptmp;5139u32 i = 0;51405141if (!(Adapter->registrypriv.load_phy_file & LOAD_RF_TXPWR_TRACK_PARA_FILE))5142return rtStatus;51435144_rtw_memset(pHalData->para_file_buf, 0, MAX_PARA_FILE_BUF_LEN);51455146if ((pHalData->rf_tx_pwr_track_len == 0) && (pHalData->rf_tx_pwr_track == NULL)) {5147rtw_get_phy_file_path(Adapter, pFileName);5148if (rtw_readable_file_sz_chk(rtw_phy_para_file_path,5149MAX_PARA_FILE_BUF_LEN) == _TRUE) {5150rlen = rtw_retrieve_from_file(rtw_phy_para_file_path, pHalData->para_file_buf, MAX_PARA_FILE_BUF_LEN);5151if (rlen > 0) {5152rtStatus = _SUCCESS;5153pHalData->rf_tx_pwr_track = rtw_zvmalloc(rlen);5154if (pHalData->rf_tx_pwr_track) {5155_rtw_memcpy(pHalData->rf_tx_pwr_track, pHalData->para_file_buf, rlen);5156pHalData->rf_tx_pwr_track_len = rlen;5157} else5158RTW_INFO("%s rf_tx_pwr_track alloc fail !\n", __FUNCTION__);5159}5160}5161} else {5162if ((pHalData->rf_tx_pwr_track_len != 0) && (pHalData->rf_tx_pwr_track != NULL)) {5163_rtw_memcpy(pHalData->para_file_buf, pHalData->rf_tx_pwr_track, pHalData->rf_tx_pwr_track_len);5164rtStatus = _SUCCESS;5165} else5166RTW_INFO("%s(): Critical Error !!!\n", __FUNCTION__);5167}51685169if (rtStatus == _SUCCESS) {5170/* RTW_INFO("%s(): read %s successfully\n", __FUNCTION__, pFileName); */51715172ptmp = pHalData->para_file_buf;5173for (szLine = GetLineFromBuffer(ptmp); szLine != NULL; szLine = GetLineFromBuffer(ptmp)) {5174if (!IsCommentString(szLine)) {5175char band[5] = "", path[5] = "", sign[5] = "";5176char chnl[5] = "", rate[10] = "";5177char data[300] = ""; /* 100 is too small */51785179if (strlen(szLine) < 10 || szLine[0] != '[')5180continue;51815182strncpy(band, szLine + 1, 2);5183strncpy(path, szLine + 5, 1);5184strncpy(sign, szLine + 8, 1);51855186i = 10; /* szLine+10 */5187if (!ParseQualifiedString(szLine, &i, rate, '[', ']')) {5188/* RTW_INFO("Fail to parse rate!\n"); */5189}5190if (!ParseQualifiedString(szLine, &i, chnl, '[', ']')) {5191/* RTW_INFO("Fail to parse channel group!\n"); */5192}5193while (szLine[i] != '{' && i < strlen(szLine))5194i++;5195if (!ParseQualifiedString(szLine, &i, data, '{', '}')) {5196/* RTW_INFO("Fail to parse data!\n"); */5197}51985199initDeltaSwingIndexTables(Adapter, band, path, sign, chnl, rate, data);5200}5201}5202} else5203RTW_INFO("%s(): No File %s, Load from HWImg Array!\n", __FUNCTION__, pFileName);5204#if 05205for (i = 0; i < DELTA_SWINGIDX_SIZE; ++i) {5206RTW_INFO("pRFCalibrateInfo->delta_swing_table_idx_2ga_p[%d] = %d\n", i, pRFCalibrateInfo->delta_swing_table_idx_2ga_p[i]);5207RTW_INFO("pRFCalibrateInfo->delta_swing_table_idx_2ga_n[%d] = %d\n", i, pRFCalibrateInfo->delta_swing_table_idx_2ga_n[i]);5208RTW_INFO("pRFCalibrateInfo->delta_swing_table_idx_2gb_p[%d] = %d\n", i, pRFCalibrateInfo->delta_swing_table_idx_2gb_p[i]);5209RTW_INFO("pRFCalibrateInfo->delta_swing_table_idx_2gb_n[%d] = %d\n", i, pRFCalibrateInfo->delta_swing_table_idx_2gb_n[i]);5210RTW_INFO("pRFCalibrateInfo->delta_swing_table_idx_2g_cck_a_p[%d] = %d\n", i, pRFCalibrateInfo->delta_swing_table_idx_2g_cck_a_p[i]);5211RTW_INFO("pRFCalibrateInfo->delta_swing_table_idx_2g_cck_a_n[%d] = %d\n", i, pRFCalibrateInfo->delta_swing_table_idx_2g_cck_a_n[i]);5212RTW_INFO("pRFCalibrateInfo->delta_swing_table_idx_2g_cck_b_p[%d] = %d\n", i, pRFCalibrateInfo->delta_swing_table_idx_2g_cck_b_p[i]);5213RTW_INFO("pRFCalibrateInfo->delta_swing_table_idx_2g_cck_b_n[%d] = %d\n", i, pRFCalibrateInfo->delta_swing_table_idx_2g_cck_b_n[i]);52145215for (j = 0; j < 3; ++j) {5216RTW_INFO("pRFCalibrateInfo->delta_swing_table_idx_5ga_p[%d][%d] = %d\n", j, i, pRFCalibrateInfo->delta_swing_table_idx_5ga_p[j][i]);5217RTW_INFO("pRFCalibrateInfo->delta_swing_table_idx_5ga_n[%d][%d] = %d\n", j, i, pRFCalibrateInfo->delta_swing_table_idx_5ga_n[j][i]);5218RTW_INFO("pRFCalibrateInfo->delta_swing_table_idx_5gb_p[%d][%d] = %d\n", j, i, pRFCalibrateInfo->delta_swing_table_idx_5gb_p[j][i]);5219RTW_INFO("pRFCalibrateInfo->delta_swing_table_idx_5gb_n[%d][%d] = %d\n", j, i, pRFCalibrateInfo->delta_swing_table_idx_5gb_n[j][i]);5220}5221}5222#endif5223return rtStatus;5224}52255226#if CONFIG_TXPWR_LIMIT52275228#ifndef DBG_TXPWR_LMT_FILE_PARSE5229#define DBG_TXPWR_LMT_FILE_PARSE 05230#endif52315232#define PARSE_RET_NO_HDL 05233#define PARSE_RET_SUCCESS 15234#define PARSE_RET_FAIL 252355236/*5237* @@Ver=2.05238* or5239* @@DomainCode=0x28, Regulation=C65240* or5241* @@CountryCode=GB, Regulation=C75242*/5243static u8 parse_reg_exc_config(_adapter *adapter, char *szLine)5244{5245#define VER_PREFIX "Ver="5246#define DOMAIN_PREFIX "DomainCode=0x"5247#define COUNTRY_PREFIX "CountryCode="5248#define REG_PREFIX "Regulation="52495250const u8 ver_prefix_len = strlen(VER_PREFIX);5251const u8 domain_prefix_len = strlen(DOMAIN_PREFIX);5252const u8 country_prefix_len = strlen(COUNTRY_PREFIX);5253const u8 reg_prefix_len = strlen(REG_PREFIX);5254u32 i, i_val_s, i_val_e;5255u32 j;5256u8 domain = 0xFF;5257char *country = NULL;5258u8 parse_reg = 0;52595260if (szLine[0] != '@' || szLine[1] != '@')5261return PARSE_RET_NO_HDL;52625263i = 2;5264if (strncmp(szLine + i, VER_PREFIX, ver_prefix_len) == 0)5265; /* nothing to do */5266else if (strncmp(szLine + i, DOMAIN_PREFIX, domain_prefix_len) == 0) {5267/* get string after domain prefix to ',' */5268i += domain_prefix_len;5269i_val_s = i;5270while (szLine[i] != ',') {5271if (szLine[i] == '\0')5272return PARSE_RET_FAIL;5273i++;5274}5275i_val_e = i;52765277/* check if all hex */5278for (j = i_val_s; j < i_val_e; j++)5279if (IsHexDigit(szLine[j]) == _FALSE)5280return PARSE_RET_FAIL;52815282/* get value from hex string */5283if (sscanf(szLine + i_val_s, "%hhx", &domain) != 1)5284return PARSE_RET_FAIL;52855286parse_reg = 1;5287} else if (strncmp(szLine + i, COUNTRY_PREFIX, country_prefix_len) == 0) {5288/* get string after country prefix to ',' */5289i += country_prefix_len;5290i_val_s = i;5291while (szLine[i] != ',') {5292if (szLine[i] == '\0')5293return PARSE_RET_FAIL;5294i++;5295}5296i_val_e = i;52975298if (i_val_e - i_val_s != 2)5299return PARSE_RET_FAIL;53005301/* check if all alpha */5302for (j = i_val_s; j < i_val_e; j++)5303if (is_alpha(szLine[j]) == _FALSE)5304return PARSE_RET_FAIL;53055306country = szLine + i_val_s;53075308parse_reg = 1;53095310} else5311return PARSE_RET_FAIL;53125313if (parse_reg) {5314/* move to 'R' */5315while (szLine[i] != 'R') {5316if (szLine[i] == '\0')5317return PARSE_RET_FAIL;5318i++;5319}53205321/* check if matching regulation prefix */5322if (strncmp(szLine + i, REG_PREFIX, reg_prefix_len) != 0)5323return PARSE_RET_FAIL;53245325/* get string after regulation prefix ending with space */5326i += reg_prefix_len;5327i_val_s = i;5328while (szLine[i] != ' ' && szLine[i] != '\t' && szLine[i] != '\0')5329i++;53305331if (i == i_val_s)5332return PARSE_RET_FAIL;53335334rtw_regd_exc_add_with_nlen(adapter_to_rfctl(adapter), country, domain, szLine + i_val_s, i - i_val_s);5335}53365337return PARSE_RET_SUCCESS;5338}53395340static int5341phy_ParsePowerLimitTableFile(5342PADAPTER Adapter,5343char *buffer5344)5345{5346#define LD_STAGE_EXC_MAPPING 05347#define LD_STAGE_TAB_DEFINE 15348#define LD_STAGE_TAB_START 25349#define LD_STAGE_COLUMN_DEFINE 35350#define LD_STAGE_CH_ROW 453515352int rtStatus = _FAIL;5353HAL_DATA_TYPE *pHalData = GET_HAL_DATA(Adapter);5354struct hal_spec_t *hal_spec = GET_HAL_SPEC(Adapter);5355struct dm_struct *pDM_Odm = &(pHalData->odmpriv);5356u8 loadingStage = LD_STAGE_EXC_MAPPING;5357u32 i = 0, forCnt = 0;5358char *szLine, *ptmp;5359char band[10], bandwidth[10], rateSection[10], ntx[10], colNumBuf[10];5360char **regulation = NULL;5361u8 colNum = 0;53625363if (Adapter->registrypriv.RegDecryptCustomFile == 1)5364phy_DecryptBBPgParaFile(Adapter, buffer);53655366ptmp = buffer;5367for (szLine = GetLineFromBuffer(ptmp); szLine != NULL; szLine = GetLineFromBuffer(ptmp)) {5368if (isAllSpaceOrTab(szLine, sizeof(*szLine)))5369continue;5370if (IsCommentString(szLine))5371continue;53725373if (loadingStage == LD_STAGE_EXC_MAPPING) {5374if (szLine[0] == '#' || szLine[1] == '#') {5375loadingStage = LD_STAGE_TAB_DEFINE;5376if (DBG_TXPWR_LMT_FILE_PARSE)5377dump_regd_exc_list(RTW_DBGDUMP, adapter_to_rfctl(Adapter));5378} else {5379if (parse_reg_exc_config(Adapter, szLine) == PARSE_RET_FAIL) {5380RTW_ERR("Fail to parse regulation exception ruls!\n");5381goto exit;5382}5383continue;5384}5385}53865387if (loadingStage == LD_STAGE_TAB_DEFINE) {5388/* read "## 2.4G, 20M, 1T, CCK" */5389if (szLine[0] != '#' || szLine[1] != '#')5390continue;53915392/* skip the space */5393i = 2;5394while (szLine[i] == ' ' || szLine[i] == '\t')5395++i;53965397szLine[--i] = ' '; /* return the space in front of the regulation info */53985399/* Parse the label of the table */5400_rtw_memset((void *) band, 0, 10);5401_rtw_memset((void *) bandwidth, 0, 10);5402_rtw_memset((void *) ntx, 0, 10);5403_rtw_memset((void *) rateSection, 0, 10);5404if (!ParseQualifiedString(szLine, &i, band, ' ', ',')) {5405RTW_ERR("Fail to parse band!\n");5406goto exit;5407}5408if (!ParseQualifiedString(szLine, &i, bandwidth, ' ', ',')) {5409RTW_ERR("Fail to parse bandwidth!\n");5410goto exit;5411}5412if (!ParseQualifiedString(szLine, &i, ntx, ' ', ',')) {5413RTW_ERR("Fail to parse ntx!\n");5414goto exit;5415}5416if (!ParseQualifiedString(szLine, &i, rateSection, ' ', ',')) {5417RTW_ERR("Fail to parse rate!\n");5418goto exit;5419}54205421loadingStage = LD_STAGE_TAB_START;5422} else if (loadingStage == LD_STAGE_TAB_START) {5423/* read "## START" */5424if (szLine[0] != '#' || szLine[1] != '#')5425continue;54265427/* skip the space */5428i = 2;5429while (szLine[i] == ' ' || szLine[i] == '\t')5430++i;54315432if (!eqNByte((u8 *)(szLine + i), (u8 *)("START"), 5)) {5433RTW_ERR("Missing \"## START\" label\n");5434goto exit;5435}54365437loadingStage = LD_STAGE_COLUMN_DEFINE;5438} else if (loadingStage == LD_STAGE_COLUMN_DEFINE) {5439/* read "## #5# FCC ETSI MKK IC KCC" */5440if (szLine[0] != '#' || szLine[1] != '#')5441continue;54425443/* skip the space */5444i = 2;5445while (szLine[i] == ' ' || szLine[i] == '\t')5446++i;54475448_rtw_memset((void *) colNumBuf, 0, 10);5449if (!ParseQualifiedString(szLine, &i, colNumBuf, '#', '#')) {5450RTW_ERR("Fail to parse column number!\n");5451goto exit;5452}5453if (!GetU1ByteIntegerFromStringInDecimal(colNumBuf, &colNum)) {5454RTW_ERR("Column number \"%s\" is not unsigned decimal\n", colNumBuf);5455goto exit;5456}5457if (colNum == 0) {5458RTW_ERR("Column number is 0\n");5459goto exit;5460}54615462if (DBG_TXPWR_LMT_FILE_PARSE)5463RTW_PRINT("[%s][%s][%s][%s] column num:%d\n", band, bandwidth, rateSection, ntx, colNum);54645465regulation = (char **)rtw_zmalloc(sizeof(char *) * colNum);5466if (!regulation) {5467RTW_ERR("Regulation alloc fail\n");5468goto exit;5469}54705471for (forCnt = 0; forCnt < colNum; ++forCnt) {5472u32 i_ns;54735474/* skip the space */5475while (szLine[i] == ' ' || szLine[i] == '\t')5476i++;5477i_ns = i;54785479while (szLine[i] != ' ' && szLine[i] != '\t' && szLine[i] != '\0')5480i++;54815482regulation[forCnt] = (char *)rtw_malloc(i - i_ns + 1);5483if (!regulation[forCnt]) {5484RTW_ERR("Regulation alloc fail\n");5485goto exit;5486}54875488_rtw_memcpy(regulation[forCnt], szLine + i_ns, i - i_ns);5489regulation[forCnt][i - i_ns] = '\0';5490}54915492if (DBG_TXPWR_LMT_FILE_PARSE) {5493RTW_PRINT("column name:");5494for (forCnt = 0; forCnt < colNum; ++forCnt)5495_RTW_PRINT(" %s", regulation[forCnt]);5496_RTW_PRINT("\n");5497}54985499loadingStage = LD_STAGE_CH_ROW;5500} else if (loadingStage == LD_STAGE_CH_ROW) {5501char channel[10] = {0}, powerLimit[10] = {0};5502u8 cnt = 0;55035504/* the table ends */5505if (szLine[0] == '#' && szLine[1] == '#') {5506i = 2;5507while (szLine[i] == ' ' || szLine[i] == '\t')5508++i;55095510if (eqNByte((u8 *)(szLine + i), (u8 *)("END"), 3)) {5511loadingStage = LD_STAGE_TAB_DEFINE;5512if (regulation) {5513for (forCnt = 0; forCnt < colNum; ++forCnt) {5514if (regulation[forCnt]) {5515rtw_mfree(regulation[forCnt], strlen(regulation[forCnt]) + 1);5516regulation[forCnt] = NULL;5517}5518}5519rtw_mfree((u8 *)regulation, sizeof(char *) * colNum);5520regulation = NULL;5521}5522colNum = 0;5523continue;5524} else {5525RTW_ERR("Missing \"## END\" label\n");5526goto exit;5527}5528}55295530if ((szLine[0] != 'c' && szLine[0] != 'C') ||5531(szLine[1] != 'h' && szLine[1] != 'H')5532) {5533RTW_WARN("Wrong channel prefix: '%c','%c'(%d,%d)\n", szLine[0], szLine[1], szLine[0], szLine[1]);5534continue;5535}5536i = 2;/* move to the location behind 'h' */55375538/* load the channel number */5539cnt = 0;5540while (szLine[i] >= '0' && szLine[i] <= '9') {5541channel[cnt] = szLine[i];5542++cnt;5543++i;5544}5545/* RTW_INFO("chnl %s!\n", channel); */55465547for (forCnt = 0; forCnt < colNum; ++forCnt) {5548/* skip the space between channel number and the power limit value */5549while (szLine[i] == ' ' || szLine[i] == '\t')5550++i;55515552/* load the power limit value */5553_rtw_memset((void *) powerLimit, 0, 10);55545555if (szLine[i] == 'W' && szLine[i + 1] == 'W') {5556/*5557* case "WW" assign special ww value5558* means to get minimal limit in other regulations at same channel5559*/5560s8 ww_value = phy_txpwr_ww_lmt_value(Adapter);55615562sprintf(powerLimit, "%d", ww_value);5563i += 2;55645565} else if (szLine[i] == 'N' && szLine[i + 1] == 'A') {5566/*5567* case "NA" assign max txgi value5568* means no limitation5569*/5570sprintf(powerLimit, "%d", hal_spec->txgi_max);5571i += 2;55725573} else if ((szLine[i] >= '0' && szLine[i] <= '9') || szLine[i] == '.'5574|| szLine[i] == '+' || szLine[i] == '-'5575){5576/* case of dBm value */5577u8 integer = 0, fraction = 0, negative = 0;5578u32 u4bMove;5579s8 lmt = 0;55805581if (szLine[i] == '+' || szLine[i] == '-') {5582if (szLine[i] == '-')5583negative = 1;5584i++;5585}55865587if (GetFractionValueFromString(&szLine[i], &integer, &fraction, &u4bMove))5588i += u4bMove;5589else {5590RTW_ERR("Limit \"%s\" is not valid decimal\n", &szLine[i]);5591goto exit;5592}55935594/* transform to string of value in unit of txgi */5595lmt = integer * hal_spec->txgi_pdbm + ((u16)fraction * (u16)hal_spec->txgi_pdbm) / 100;5596if (negative)5597lmt = -lmt;5598sprintf(powerLimit, "%d", lmt);55995600} else {5601RTW_ERR("Wrong limit expression \"%c%c\"(%d, %d)\n"5602, szLine[i], szLine[i + 1], szLine[i], szLine[i + 1]);5603goto exit;5604}56055606/* store the power limit value */5607phy_set_tx_power_limit(pDM_Odm, (u8 *)regulation[forCnt], (u8 *)band,5608(u8 *)bandwidth, (u8 *)rateSection, (u8 *)ntx, (u8 *)channel, (u8 *)powerLimit);56095610}5611}5612}56135614rtStatus = _SUCCESS;56155616exit:5617if (regulation) {5618for (forCnt = 0; forCnt < colNum; ++forCnt) {5619if (regulation[forCnt]) {5620rtw_mfree(regulation[forCnt], strlen(regulation[forCnt]) + 1);5621regulation[forCnt] = NULL;5622}5623}5624rtw_mfree((u8 *)regulation, sizeof(char *) * colNum);5625regulation = NULL;5626}56275628RTW_INFO("%s return %d\n", __func__, rtStatus);5629return rtStatus;5630}56315632int5633PHY_ConfigRFWithPowerLimitTableParaFile(5634PADAPTER Adapter,5635const char *pFileName5636)5637{5638HAL_DATA_TYPE *pHalData = GET_HAL_DATA(Adapter);5639int rlen = 0, rtStatus = _FAIL;56405641if (!(Adapter->registrypriv.load_phy_file & LOAD_RF_TXPWR_LMT_PARA_FILE))5642return rtStatus;56435644_rtw_memset(pHalData->para_file_buf, 0, MAX_PARA_FILE_BUF_LEN);56455646if (pHalData->rf_tx_pwr_lmt == NULL) {5647rtw_get_phy_file_path(Adapter, pFileName);5648if (rtw_readable_file_sz_chk(rtw_phy_para_file_path,5649MAX_PARA_FILE_BUF_LEN) == _TRUE) {5650rlen = rtw_retrieve_from_file(rtw_phy_para_file_path, pHalData->para_file_buf, MAX_PARA_FILE_BUF_LEN);5651if (rlen > 0) {5652rtStatus = _SUCCESS;5653pHalData->rf_tx_pwr_lmt = rtw_zvmalloc(rlen);5654if (pHalData->rf_tx_pwr_lmt) {5655_rtw_memcpy(pHalData->rf_tx_pwr_lmt, pHalData->para_file_buf, rlen);5656pHalData->rf_tx_pwr_lmt_len = rlen;5657} else5658RTW_INFO("%s rf_tx_pwr_lmt alloc fail !\n", __FUNCTION__);5659}5660}5661} else {5662if ((pHalData->rf_tx_pwr_lmt_len != 0) && (pHalData->rf_tx_pwr_lmt != NULL)) {5663_rtw_memcpy(pHalData->para_file_buf, pHalData->rf_tx_pwr_lmt, pHalData->rf_tx_pwr_lmt_len);5664rtStatus = _SUCCESS;5665} else5666RTW_INFO("%s(): Critical Error !!!\n", __FUNCTION__);5667}56685669if (rtStatus == _SUCCESS) {5670/* RTW_INFO("%s(): read %s ok\n", __FUNCTION__, pFileName); */5671rtStatus = phy_ParsePowerLimitTableFile(Adapter, pHalData->para_file_buf);5672} else5673RTW_INFO("%s(): No File %s, Load from HWImg Array!\n", __FUNCTION__, pFileName);56745675return rtStatus;5676}5677#endif /* CONFIG_TXPWR_LIMIT */56785679void phy_free_filebuf_mask(_adapter *padapter, u8 mask)5680{5681HAL_DATA_TYPE *pHalData = GET_HAL_DATA(padapter);56825683if (pHalData->mac_reg && (mask & LOAD_MAC_PARA_FILE)) {5684rtw_vmfree(pHalData->mac_reg, pHalData->mac_reg_len);5685pHalData->mac_reg = NULL;5686}5687if (mask & LOAD_BB_PARA_FILE) {5688if (pHalData->bb_phy_reg) {5689rtw_vmfree(pHalData->bb_phy_reg, pHalData->bb_phy_reg_len);5690pHalData->bb_phy_reg = NULL;5691}5692if (pHalData->bb_agc_tab) {5693rtw_vmfree(pHalData->bb_agc_tab, pHalData->bb_agc_tab_len);5694pHalData->bb_agc_tab = NULL;5695}5696}5697if (pHalData->bb_phy_reg_pg && (mask & LOAD_BB_PG_PARA_FILE)) {5698rtw_vmfree(pHalData->bb_phy_reg_pg, pHalData->bb_phy_reg_pg_len);5699pHalData->bb_phy_reg_pg = NULL;5700}5701if (pHalData->bb_phy_reg_mp && (mask & LOAD_BB_MP_PARA_FILE)) {5702rtw_vmfree(pHalData->bb_phy_reg_mp, pHalData->bb_phy_reg_mp_len);5703pHalData->bb_phy_reg_mp = NULL;5704}5705if (mask & LOAD_RF_PARA_FILE) {5706if (pHalData->rf_radio_a) {5707rtw_vmfree(pHalData->rf_radio_a, pHalData->rf_radio_a_len);5708pHalData->rf_radio_a = NULL;5709}5710if (pHalData->rf_radio_b) {5711rtw_vmfree(pHalData->rf_radio_b, pHalData->rf_radio_b_len);5712pHalData->rf_radio_b = NULL;5713}5714}5715if (pHalData->rf_tx_pwr_track && (mask & LOAD_RF_TXPWR_TRACK_PARA_FILE)) {5716rtw_vmfree(pHalData->rf_tx_pwr_track, pHalData->rf_tx_pwr_track_len);5717pHalData->rf_tx_pwr_track = NULL;5718}5719if (pHalData->rf_tx_pwr_lmt && (mask & LOAD_RF_TXPWR_LMT_PARA_FILE)) {5720rtw_vmfree(pHalData->rf_tx_pwr_lmt, pHalData->rf_tx_pwr_lmt_len);5721pHalData->rf_tx_pwr_lmt = NULL;5722}5723}57245725inline void phy_free_filebuf(_adapter *padapter)5726{5727phy_free_filebuf_mask(padapter, 0xFF);5728}57295730#endif57315732s85733phy_get_tx_power_final_absolute_value(_adapter *adapter, u8 rfpath, u8 rate,5734enum channel_width bw, u8 channel)5735{5736#ifdef CONFIG_USE_TSSI5737struct hal_spec_t *hal_spec = GET_HAL_SPEC(adapter);5738u8 powerByRate = 0, powerLimit = 0;5739bool bIn24G = channel <= 14;5740s8 value = 0;5741u8 ntx_idx = phy_get_current_tx_num(adapter, rate);57425743if (!bIn24G && IS_CCK_RATE(rate))5744return 0;57455746powerByRate = PHY_GetTxPowerByRateOriginal(adapter, (u8)(!bIn24G), rfpath, rate);5747powerByRate /= hal_spec->txgi_pdbm;57485749#if CONFIG_TXPWR_LIMIT5750powerLimit = PHY_GetTxPowerLimitOriginal(adapter, NULL, (BAND_TYPE)(!bIn24G), bw, rfpath, rate, ntx_idx, channel);5751#else5752powerLimit = hal_spec->txgi_max;5753#endif5754powerLimit /= hal_spec->txgi_pdbm;57555756value = (powerByRate > powerLimit ? powerLimit : powerByRate);57575758return value;5759#else5760return 0;5761#endif5762}576357645765