1 // SPDX-License-Identifier: GPL-2.0
2 /******************************************************************************
4 * Copyright(c) 2007 - 2016 Realtek Corporation.
7 * wlanfae <wlanfae@realtek.com>
8 * Realtek Corporation, No. 2, Innovation Road II, Hsinchu Science Park,
11 * Larry Finger <Larry.Finger@lwfinger.net>
13 *****************************************************************************/
15 #include "../mp_precomp.h"
16 #include "../phydm_precomp.h"
18 static void phydm_dynamic_switch_htstf_mumimo_8822b(struct phy_dm_struct *dm)
20 /*if rssi > 40dBm, enable HT-STF gain controller,
21 *otherwise, if rssi < 40dBm, disable the controller
23 /*add by Chun-Hung Ho 20160711 */
24 if (dm->rssi_min >= 40)
25 odm_set_bb_reg(dm, 0x8d8, BIT(17), 0x1);
26 else if (dm->rssi_min < 35)
27 odm_set_bb_reg(dm, 0x8d8, BIT(17), 0x0);
29 ODM_RT_TRACE(dm, ODM_COMP_COMMON, "%s, rssi_min = %d\n", __func__,
33 static void _set_tx_a_cali_value(struct phy_dm_struct *dm, u8 rf_path,
34 u8 offset, u8 tx_a_bias_offset)
36 u32 modi_tx_a_value = 0;
38 bool is_minus = false;
43 odm_set_rf_reg(dm, rf_path, 0x18, 0xFFFFF, 0X10124);
46 odm_set_rf_reg(dm, rf_path, 0x18, 0xFFFFF, 0X10524);
49 odm_set_rf_reg(dm, rf_path, 0x18, 0xFFFFF, 0X10924);
52 odm_set_rf_reg(dm, rf_path, 0x18, 0xFFFFF, 0X10D24);
55 odm_set_rf_reg(dm, rf_path, 0x18, 0xFFFFF, 0X30164);
58 odm_set_rf_reg(dm, rf_path, 0x18, 0xFFFFF, 0X30564);
61 odm_set_rf_reg(dm, rf_path, 0x18, 0xFFFFF, 0X30964);
64 odm_set_rf_reg(dm, rf_path, 0x18, 0xFFFFF, 0X30D64);
67 odm_set_rf_reg(dm, rf_path, 0x18, 0xFFFFF, 0X50195);
70 odm_set_rf_reg(dm, rf_path, 0x18, 0xFFFFF, 0X50595);
73 odm_set_rf_reg(dm, rf_path, 0x18, 0xFFFFF, 0X50995);
76 odm_set_rf_reg(dm, rf_path, 0x18, 0xFFFFF, 0X50D95);
79 ODM_RT_TRACE(dm, ODM_COMP_COMMON,
80 "Invalid TxA band offset...\n");
85 modi_tx_a_value = odm_get_rf_reg(dm, rf_path, 0x61, 0xFFFFF);
86 tmp1_byte = (u8)modi_tx_a_value & (BIT(3) | BIT(2) | BIT(1) | BIT(0));
88 /* check how much need to calibration */
89 switch (tx_a_bias_offset) {
125 /* do nothing case */
128 ODM_RT_TRACE(dm, ODM_COMP_COMMON,
129 "No need to do TxA bias current calibration\n");
133 /* calc correct value to calibrate */
135 if (tmp1_byte >= comp_value) {
136 tmp1_byte -= comp_value;
137 /*modi_tx_a_value += tmp1_byte;*/
142 tmp1_byte += comp_value;
147 /* Write back to RF reg */
148 odm_set_rf_reg(dm, rf_path, 0x30, 0xFFFF,
149 (offset << 12 | (modi_tx_a_value & 0xFF0) | tmp1_byte));
152 static void _txa_bias_cali_4_each_path(struct phy_dm_struct *dm, u8 rf_path,
155 /* switch on set TxA bias */
156 odm_set_rf_reg(dm, rf_path, 0xEF, 0xFFFFF, 0x200);
158 /* Set 12 sets of TxA value */
159 _set_tx_a_cali_value(dm, rf_path, 0x0, efuse_value);
160 _set_tx_a_cali_value(dm, rf_path, 0x1, efuse_value);
161 _set_tx_a_cali_value(dm, rf_path, 0x2, efuse_value);
162 _set_tx_a_cali_value(dm, rf_path, 0x3, efuse_value);
163 _set_tx_a_cali_value(dm, rf_path, 0x4, efuse_value);
164 _set_tx_a_cali_value(dm, rf_path, 0x5, efuse_value);
165 _set_tx_a_cali_value(dm, rf_path, 0x6, efuse_value);
166 _set_tx_a_cali_value(dm, rf_path, 0x7, efuse_value);
167 _set_tx_a_cali_value(dm, rf_path, 0x8, efuse_value);
168 _set_tx_a_cali_value(dm, rf_path, 0x9, efuse_value);
169 _set_tx_a_cali_value(dm, rf_path, 0xa, efuse_value);
170 _set_tx_a_cali_value(dm, rf_path, 0xb, efuse_value);
172 /* switch off set TxA bias */
173 odm_set_rf_reg(dm, rf_path, 0xEF, 0xFFFFF, 0x0);
177 * for 8822B PCIE D-cut patch only
178 * Normal driver and MP driver need this patch
181 void phydm_txcurrentcalibration(struct phy_dm_struct *dm)
183 u8 efuse0x3D8, efuse0x3D7;
184 u32 orig_rf0x18_path_a = 0, orig_rf0x18_path_b = 0;
186 /* save original 0x18 value */
187 orig_rf0x18_path_a = odm_get_rf_reg(dm, ODM_RF_PATH_A, 0x18, 0xFFFFF);
188 orig_rf0x18_path_b = odm_get_rf_reg(dm, ODM_RF_PATH_B, 0x18, 0xFFFFF);
190 /* define efuse content */
191 efuse0x3D8 = dm->efuse0x3d8;
192 efuse0x3D7 = dm->efuse0x3d7;
194 /* check efuse content to judge whether need to calibration or not */
195 if (efuse0x3D7 == 0xFF) {
198 "efuse content 0x3D7 == 0xFF, No need to do TxA cali\n");
202 /* write RF register for calibration */
203 _txa_bias_cali_4_each_path(dm, ODM_RF_PATH_A, efuse0x3D7);
204 _txa_bias_cali_4_each_path(dm, ODM_RF_PATH_B, efuse0x3D8);
206 /* restore original 0x18 value */
207 odm_set_rf_reg(dm, ODM_RF_PATH_A, 0x18, 0xFFFFF, orig_rf0x18_path_a);
208 odm_set_rf_reg(dm, ODM_RF_PATH_B, 0x18, 0xFFFFF, orig_rf0x18_path_b);
211 void phydm_hwsetting_8822b(struct phy_dm_struct *dm)
213 phydm_dynamic_switch_htstf_mumimo_8822b(dm);