halphyrf_ap.c 57 KB

12345678910111213141516171819202122232425262728293031323334353637383940414243444546474849505152535455565758596061626364656667686970717273747576777879808182838485868788899091929394959697989910010110210310410510610710810911011111211311411511611711811912012112212312412512612712812913013113213313413513613713813914014114214314414514614714814915015115215315415515615715815916016116216316416516616716816917017117217317417517617717817918018118218318418518618718818919019119219319419519619719819920020120220320420520620720820921021121221321421521621721821922022122222322422522622722822923023123223323423523623723823924024124224324424524624724824925025125225325425525625725825926026126226326426526626726826927027127227327427527627727827928028128228328428528628728828929029129229329429529629729829930030130230330430530630730830931031131231331431531631731831932032132232332432532632732832933033133233333433533633733833934034134234334434534634734834935035135235335435535635735835936036136236336436536636736836937037137237337437537637737837938038138238338438538638738838939039139239339439539639739839940040140240340440540640740840941041141241341441541641741841942042142242342442542642742842943043143243343443543643743843944044144244344444544644744844945045145245345445545645745845946046146246346446546646746846947047147247347447547647747847948048148248348448548648748848949049149249349449549649749849950050150250350450550650750850951051151251351451551651751851952052152252352452552652752852953053153253353453553653753853954054154254354454554654754854955055155255355455555655755855956056156256356456556656756856957057157257357457557657757857958058158258358458558658758858959059159259359459559659759859960060160260360460560660760860961061161261361461561661761861962062162262362462562662762862963063163263363463563663763863964064164264364464564664764864965065165265365465565665765865966066166266366466566666766866967067167267367467567667767867968068168268368468568668768868969069169269369469569669769869970070170270370470570670770870971071171271371471571671771871972072172272372472572672772872973073173273373473573673773873974074174274374474574674774874975075175275375475575675775875976076176276376476576676776876977077177277377477577677777877978078178278378478578678778878979079179279379479579679779879980080180280380480580680780880981081181281381481581681781881982082182282382482582682782882983083183283383483583683783883984084184284384484584684784884985085185285385485585685785885986086186286386486586686786886987087187287387487587687787887988088188288388488588688788888989089189289389489589689789889990090190290390490590690790890991091191291391491591691791891992092192292392492592692792892993093193293393493593693793893994094194294394494594694794894995095195295395495595695795895996096196296396496596696796896997097197297397497597697797897998098198298398498598698798898999099199299399499599699799899910001001100210031004100510061007100810091010101110121013101410151016101710181019102010211022102310241025102610271028102910301031103210331034103510361037103810391040104110421043104410451046104710481049105010511052105310541055105610571058105910601061106210631064106510661067106810691070107110721073107410751076107710781079108010811082108310841085108610871088108910901091109210931094109510961097109810991100110111021103110411051106110711081109111011111112111311141115111611171118111911201121112211231124112511261127112811291130113111321133113411351136113711381139114011411142114311441145114611471148114911501151115211531154115511561157115811591160116111621163116411651166116711681169117011711172117311741175117611771178117911801181118211831184118511861187118811891190119111921193119411951196119711981199120012011202120312041205120612071208120912101211121212131214121512161217121812191220122112221223122412251226122712281229123012311232123312341235123612371238123912401241124212431244124512461247124812491250125112521253125412551256125712581259126012611262126312641265126612671268126912701271127212731274127512761277127812791280128112821283128412851286128712881289129012911292129312941295129612971298129913001301130213031304130513061307130813091310131113121313131413151316131713181319132013211322132313241325132613271328132913301331133213331334133513361337133813391340
  1. /******************************************************************************
  2. *
  3. * Copyright(c) 2007 - 2017 Realtek Corporation.
  4. *
  5. * This program is free software; you can redistribute it and/or modify it
  6. * under the terms of version 2 of the GNU General Public License as
  7. * published by the Free Software Foundation.
  8. *
  9. * This program is distributed in the hope that it will be useful, but WITHOUT
  10. * ANY WARRANTY; without even the implied warranty of MERCHANTABILITY or
  11. * FITNESS FOR A PARTICULAR PURPOSE. See the GNU General Public License for
  12. * more details.
  13. *
  14. *****************************************************************************/
  15. #include "mp_precomp.h"
  16. #include "phydm_precomp.h"
  17. #ifndef index_mapping_NUM_88E
  18. #define index_mapping_NUM_88E 15
  19. #endif
  20. /* #if(DM_ODM_SUPPORT_TYPE & ODM_WIN) */
  21. #define CALCULATE_SWINGTALBE_OFFSET(_offset, _direction, _size, _delta_thermal) \
  22. do {\
  23. for (_offset = 0; _offset < _size; _offset++) { \
  24. \
  25. if (_delta_thermal < thermal_threshold[_direction][_offset]) { \
  26. \
  27. if (_offset != 0)\
  28. _offset--;\
  29. break;\
  30. } \
  31. } \
  32. if (_offset >= _size)\
  33. _offset = _size-1;\
  34. } while (0)
  35. void configure_txpower_track(
  36. void *dm_void,
  37. struct txpwrtrack_cfg *config
  38. )
  39. {
  40. struct dm_struct *dm = (struct dm_struct *)dm_void;
  41. #if RTL8812A_SUPPORT
  42. #if (DM_ODM_SUPPORT_TYPE == ODM_WIN)
  43. /* if (IS_HARDWARE_TYPE_8812(dm->adapter)) */
  44. if (dm->support_ic_type == ODM_RTL8812)
  45. configure_txpower_track_8812a(config);
  46. /* else */
  47. #endif
  48. #endif
  49. #if RTL8814A_SUPPORT
  50. if (dm->support_ic_type == ODM_RTL8814A)
  51. configure_txpower_track_8814a(config);
  52. #endif
  53. #if RTL8188E_SUPPORT
  54. if (dm->support_ic_type == ODM_RTL8188E)
  55. configure_txpower_track_8188e(config);
  56. #endif
  57. #if RTL8197F_SUPPORT
  58. if (dm->support_ic_type == ODM_RTL8197F)
  59. configure_txpower_track_8197f(config);
  60. #endif
  61. #if RTL8822B_SUPPORT
  62. if (dm->support_ic_type == ODM_RTL8822B)
  63. configure_txpower_track_8822b(config);
  64. #endif
  65. #if RTL8192F_SUPPORT
  66. if (dm->support_ic_type == ODM_RTL8192F)
  67. configure_txpower_track_8192f(config);
  68. #endif
  69. #if RTL8198F_SUPPORT
  70. if (dm->support_ic_type == ODM_RTL8198F)
  71. configure_txpower_track_8198f(config);
  72. #endif
  73. }
  74. #if (RTL8192E_SUPPORT == 1)
  75. void
  76. odm_txpowertracking_callback_thermal_meter_92e(
  77. void *dm_void
  78. )
  79. {
  80. struct dm_struct *dm = (struct dm_struct *)dm_void;
  81. struct dm_iqk_info *iqk_info = &dm->IQK_info;
  82. u8 thermal_value = 0, delta, delta_IQK, delta_LCK, channel, is_decrease, rf_mimo_mode;
  83. u8 thermal_value_avg_count = 0;
  84. u8 OFDM_min_index = 10; /* OFDM BB Swing should be less than +2.5dB, which is required by Arthur */
  85. s8 OFDM_index[2], index ;
  86. u32 thermal_value_avg = 0, reg0x18;
  87. u32 i = 0, j = 0, rf;
  88. s32 value32, CCK_index = 0, ele_A, ele_D, ele_C, X, Y;
  89. struct rtl8192cd_priv *priv = dm->priv;
  90. rf_mimo_mode = dm->rf_type;
  91. /* RF_DBG(dm,DBG_RF_TX_PWR_TRACK,"%s:%d rf_mimo_mode:%d\n", __FUNCTION__, __LINE__, rf_mimo_mode); */
  92. #ifdef MP_TEST
  93. if ((OPMODE & WIFI_MP_STATE) || *(dm->mp_mode)) {
  94. channel = priv->pshare->working_channel;
  95. if (priv->pshare->mp_txpwr_tracking == false)
  96. return;
  97. } else
  98. #endif
  99. {
  100. channel = (priv->pmib->dot11RFEntry.dot11channel);
  101. }
  102. thermal_value = (unsigned char)odm_get_rf_reg(dm, RF_PATH_A, ODM_RF_T_METER_92E, 0xfc00); /* 0x42: RF Reg[15:10] 88E */
  103. RF_DBG(dm, DBG_RF_TX_PWR_TRACK, "\nReadback Thermal Meter = 0x%x pre thermal meter 0x%x EEPROMthermalmeter 0x%x\n", thermal_value, priv->pshare->thermal_value, priv->pmib->dot11RFEntry.ther);
  104. switch (rf_mimo_mode) {
  105. case RF_1T1R:
  106. rf = 1;
  107. break;
  108. case RF_2T2R:
  109. rf = 2;
  110. break;
  111. default:
  112. rf = 2;
  113. break;
  114. }
  115. /* Query OFDM path A default setting Bit[31:21] */
  116. ele_D = phy_query_bb_reg(priv, REG_OFDM_0_XA_TX_IQ_IMBALANCE, MASKOFDM_D);
  117. for (i = 0; i < OFDM_TABLE_SIZE_92E; i++) {
  118. if (ele_D == (ofdm_swing_table_92e[i] >> 22)) {
  119. OFDM_index[0] = (unsigned char)i;
  120. RF_DBG(dm, DBG_RF_TX_PWR_TRACK, "PathA 0xC80[31:22] = 0x%x, OFDM_index=%d\n", ele_D, OFDM_index[0]);
  121. break;
  122. }
  123. }
  124. /* Query OFDM path B default setting */
  125. if (rf_mimo_mode == RF_2T2R) {
  126. ele_D = phy_query_bb_reg(priv, REG_OFDM_0_XB_TX_IQ_IMBALANCE, MASKOFDM_D);
  127. for (i = 0; i < OFDM_TABLE_SIZE_92E; i++) {
  128. if (ele_D == (ofdm_swing_table_92e[i] >> 22)) {
  129. OFDM_index[1] = (unsigned char)i;
  130. RF_DBG(dm, DBG_RF_TX_PWR_TRACK, "PathB 0xC88[31:22] = 0x%x, OFDM_index=%d\n", ele_D, OFDM_index[1]);
  131. break;
  132. }
  133. }
  134. }
  135. /* calculate average thermal meter */
  136. {
  137. priv->pshare->thermal_value_avg_88xx[priv->pshare->thermal_value_avg_index_88xx] = thermal_value;
  138. priv->pshare->thermal_value_avg_index_88xx++;
  139. if (priv->pshare->thermal_value_avg_index_88xx == AVG_THERMAL_NUM_88XX)
  140. priv->pshare->thermal_value_avg_index_88xx = 0;
  141. for (i = 0; i < AVG_THERMAL_NUM_88XX; i++) {
  142. if (priv->pshare->thermal_value_avg_88xx[i]) {
  143. thermal_value_avg += priv->pshare->thermal_value_avg_88xx[i];
  144. thermal_value_avg_count++;
  145. }
  146. }
  147. if (thermal_value_avg_count) {
  148. thermal_value = (unsigned char)(thermal_value_avg / thermal_value_avg_count);
  149. RF_DBG(dm, DBG_RF_TX_PWR_TRACK, "AVG Thermal Meter = 0x%x\n", thermal_value);
  150. }
  151. }
  152. /* Initialize */
  153. if (!priv->pshare->thermal_value) {
  154. priv->pshare->thermal_value = priv->pmib->dot11RFEntry.ther;
  155. priv->pshare->thermal_value_iqk = thermal_value;
  156. priv->pshare->thermal_value_lck = thermal_value;
  157. }
  158. if (thermal_value != priv->pshare->thermal_value) {
  159. RF_DBG(dm, DBG_RF_TX_PWR_TRACK, "\n******** START POWER TRACKING ********\n");
  160. RF_DBG(dm, DBG_RF_TX_PWR_TRACK, "\nReadback Thermal Meter = 0x%x pre thermal meter 0x%x EEPROMthermalmeter 0x%x\n", thermal_value, priv->pshare->thermal_value, priv->pmib->dot11RFEntry.ther);
  161. delta = RTL_ABS(thermal_value, priv->pmib->dot11RFEntry.ther);
  162. delta_IQK = RTL_ABS(thermal_value, priv->pshare->thermal_value_iqk);
  163. delta_LCK = RTL_ABS(thermal_value, priv->pshare->thermal_value_lck);
  164. is_decrease = ((thermal_value < priv->pmib->dot11RFEntry.ther) ? 1 : 0);
  165. #ifdef _TRACKING_TABLE_FILE
  166. if (priv->pshare->rf_ft_var.pwr_track_file) {
  167. RF_DBG(dm, DBG_RF_TX_PWR_TRACK, "diff: (%s)%d ==> get index from table : %d)\n", (is_decrease ? "-" : "+"), delta, get_tx_tracking_index(priv, channel, i, delta, is_decrease, 0));
  168. if (is_decrease) {
  169. for (i = 0; i < rf; i++) {
  170. OFDM_index[i] = priv->pshare->OFDM_index0[i] + get_tx_tracking_index(priv, channel, i, delta, is_decrease, 0);
  171. OFDM_index[i] = ((OFDM_index[i] > (OFDM_TABLE_SIZE_92E- 1)) ? (OFDM_TABLE_SIZE_92E - 1) : OFDM_index[i]);
  172. RF_DBG(dm, DBG_RF_TX_PWR_TRACK, ">>> decrese power ---> new OFDM_INDEX:%d (%d + %d)\n", OFDM_index[i], priv->pshare->OFDM_index0[i], get_tx_tracking_index(priv, channel, i, delta, is_decrease, 0));
  173. CCK_index = priv->pshare->CCK_index0 + get_tx_tracking_index(priv, channel, i, delta, is_decrease, 1);
  174. CCK_index = ((CCK_index > (CCK_TABLE_SIZE_92E - 1)) ? (CCK_TABLE_SIZE_92E - 1) : CCK_index);
  175. RF_DBG(dm, DBG_RF_TX_PWR_TRACK, ">>> Decrese power ---> new CCK_INDEX:%d (%d + %d)\n", CCK_index, priv->pshare->CCK_index0, get_tx_tracking_index(priv, channel, i, delta, is_decrease, 1));
  176. }
  177. } else {
  178. for (i = 0; i < rf; i++) {
  179. OFDM_index[i] = priv->pshare->OFDM_index0[i] - get_tx_tracking_index(priv, channel, i, delta, is_decrease, 0);
  180. OFDM_index[i] = ((OFDM_index[i] < OFDM_min_index) ? OFDM_min_index : OFDM_index[i]);
  181. RF_DBG(dm, DBG_RF_TX_PWR_TRACK, ">>> Increse power ---> new OFDM_INDEX:%d (%d - %d)\n", OFDM_index[i], priv->pshare->OFDM_index0[i], get_tx_tracking_index(priv, channel, i, delta, is_decrease, 0));
  182. CCK_index = priv->pshare->CCK_index0 - get_tx_tracking_index(priv, channel, i, delta, is_decrease, 1);
  183. CCK_index = ((CCK_index < 0) ? 0 : CCK_index);
  184. RF_DBG(dm, DBG_RF_TX_PWR_TRACK, ">>> Increse power ---> new CCK_INDEX:%d (%d - %d)\n", CCK_index, priv->pshare->CCK_index0, get_tx_tracking_index(priv, channel, i, delta, is_decrease, 1));
  185. }
  186. }
  187. }
  188. #endif /* CFG_TRACKING_TABLE_FILE */
  189. RF_DBG(dm, DBG_RF_TX_PWR_TRACK, "ofdm_swing_table_92e[(unsigned int)OFDM_index[0]] = %x\n", ofdm_swing_table_92e[(unsigned int)OFDM_index[0]]);
  190. RF_DBG(dm, DBG_RF_TX_PWR_TRACK, "ofdm_swing_table_92e[(unsigned int)OFDM_index[1]] = %x\n", ofdm_swing_table_92e[(unsigned int)OFDM_index[1]]);
  191. /* Adujst OFDM Ant_A according to IQK result */
  192. ele_D = (ofdm_swing_table_92e[(unsigned int)OFDM_index[0]] & 0xFFC00000) >> 22;
  193. X = priv->pshare->rege94;
  194. Y = priv->pshare->rege9c;
  195. if (X != 0) {
  196. if ((X & 0x00000200) != 0)
  197. X = X | 0xFFFFFC00;
  198. ele_A = ((X * ele_D) >> 8) & 0x000003FF;
  199. /* new element C = element D x Y */
  200. if ((Y & 0x00000200) != 0)
  201. Y = Y | 0xFFFFFC00;
  202. ele_C = ((Y * ele_D) >> 8) & 0x000003FF;
  203. /* wirte new elements A, C, D to regC80 and regC94, element B is always 0 */
  204. value32 = (ele_D << 22) | ((ele_C & 0x3F) << 16) | ele_A;
  205. phy_set_bb_reg(priv, REG_OFDM_0_XA_TX_IQ_IMBALANCE, MASKDWORD, value32);
  206. value32 = (ele_C & 0x000003C0) >> 6;
  207. phy_set_bb_reg(priv, REG_OFDM_0_XC_TX_AFE, MASKH4BITS, value32);
  208. value32 = ((X * ele_D) >> 7) & 0x01;
  209. phy_set_bb_reg(priv, REG_OFDM_0_ECCA_THRESHOLD, BIT(24), value32);
  210. } else {
  211. phy_set_bb_reg(priv, REG_OFDM_0_XA_TX_IQ_IMBALANCE, MASKDWORD, ofdm_swing_table_92e[(unsigned int)OFDM_index[0]]);
  212. phy_set_bb_reg(priv, REG_OFDM_0_XC_TX_AFE, MASKH4BITS, 0x00);
  213. phy_set_bb_reg(priv, REG_OFDM_0_ECCA_THRESHOLD, BIT(24), 0x00);
  214. }
  215. set_CCK_swing_index(priv, CCK_index);
  216. if (rf == 2) {
  217. ele_D = (ofdm_swing_table_92e[(unsigned int)OFDM_index[1]] & 0xFFC00000) >> 22;
  218. X = priv->pshare->regeb4;
  219. Y = priv->pshare->regebc;
  220. if (X != 0) {
  221. if ((X & 0x00000200) != 0) /* consider minus */
  222. X = X | 0xFFFFFC00;
  223. ele_A = ((X * ele_D) >> 8) & 0x000003FF;
  224. /* new element C = element D x Y */
  225. if ((Y & 0x00000200) != 0)
  226. Y = Y | 0xFFFFFC00;
  227. ele_C = ((Y * ele_D) >> 8) & 0x00003FF;
  228. /* wirte new elements A, C, D to regC88 and regC9C, element B is always 0 */
  229. value32 = (ele_D << 22) | ((ele_C & 0x3F) << 16) | ele_A;
  230. phy_set_bb_reg(priv, REG_OFDM_0_XB_TX_IQ_IMBALANCE, MASKDWORD, value32);
  231. value32 = (ele_C & 0x000003C0) >> 6;
  232. phy_set_bb_reg(priv, REG_OFDM_0_XD_TX_AFE, MASKH4BITS, value32);
  233. value32 = ((X * ele_D) >> 7) & 0x01;
  234. phy_set_bb_reg(priv, REG_OFDM_0_ECCA_THRESHOLD, BIT(28), value32);
  235. } else {
  236. phy_set_bb_reg(priv, REG_OFDM_0_XB_TX_IQ_IMBALANCE, MASKDWORD, ofdm_swing_table_92e[(unsigned int)OFDM_index[1]]);
  237. phy_set_bb_reg(priv, REG_OFDM_0_XD_TX_AFE, MASKH4BITS, 0x00);
  238. phy_set_bb_reg(priv, REG_OFDM_0_ECCA_THRESHOLD, BIT(28), 0x00);
  239. }
  240. }
  241. RF_DBG(dm, DBG_RF_TX_PWR_TRACK, "0xc80 = 0x%x\n", phy_query_bb_reg(priv, REG_OFDM_0_XA_TX_IQ_IMBALANCE, MASKDWORD));
  242. RF_DBG(dm, DBG_RF_TX_PWR_TRACK, "0xc88 = 0x%x\n", phy_query_bb_reg(priv, REG_OFDM_0_XB_TX_IQ_IMBALANCE, MASKDWORD));
  243. if ((delta_IQK > 3) && (!iqk_info->rfk_forbidden)) {
  244. priv->pshare->thermal_value_iqk = thermal_value;
  245. #ifdef MP_TEST
  246. #endif if (!(*(dm->mp_mode) && (OPMODE & (WIFI_MP_CTX_BACKGROUND | WIFI_MP_CTX_PACKET))))
  247. halrf_iqk_trigger(dm, false);
  248. }
  249. if ((delta_LCK > 8) && (!iqk_info->rfk_forbidden)) {
  250. RTL_W8(0x522, 0xff);
  251. reg0x18 = phy_query_rf_reg(priv, RF_PATH_A, 0x18, MASK20BITS, 1);
  252. phy_set_rf_reg(priv, RF_PATH_A, 0xB4, BIT(14), 1);
  253. phy_set_rf_reg(priv, RF_PATH_A, 0x18, BIT(15), 1);
  254. delay_ms(1);
  255. phy_set_rf_reg(priv, RF_PATH_A, 0xB4, BIT(14), 0);
  256. phy_set_rf_reg(priv, RF_PATH_A, 0x18, MASK20BITS, reg0x18);
  257. RTL_W8(0x522, 0x0);
  258. priv->pshare->thermal_value_lck = thermal_value;
  259. }
  260. }
  261. /* update thermal meter value */
  262. priv->pshare->thermal_value = thermal_value;
  263. for (i = 0 ; i < rf ; i++)
  264. priv->pshare->OFDM_index[i] = OFDM_index[i];
  265. priv->pshare->CCK_index = CCK_index;
  266. RF_DBG(dm, DBG_RF_TX_PWR_TRACK, "\n******** END:%s() ********\n", __FUNCTION__);
  267. }
  268. #endif
  269. #if (RTL8197F_SUPPORT == 1 || RTL8192F_SUPPORT == 1 || RTL8822B_SUPPORT == 1 ||\
  270. RTL8821C_SUPPORT == 1 || RTL8198F_SUPPORT == 1)
  271. void
  272. odm_txpowertracking_callback_thermal_meter_jaguar_series3(
  273. void *dm_void
  274. )
  275. {
  276. #if 1
  277. struct dm_struct *dm = (struct dm_struct *)dm_void;
  278. u8 thermal_value = 0, delta, delta_LCK, delta_IQK, channel, is_increase;
  279. u8 thermal_value_avg_count = 0, p = 0, i = 0;
  280. u32 thermal_value_avg = 0;
  281. struct rtl8192cd_priv *priv = dm->priv;
  282. struct txpwrtrack_cfg c;
  283. struct dm_rf_calibration_struct *cali_info = &(dm->rf_calibrate_info);
  284. struct dm_iqk_info *iqk_info = &dm->IQK_info;
  285. struct _hal_rf_ *rf = &dm->rf_table;
  286. /*The following tables decide the final index of OFDM/CCK swing table.*/
  287. u8 *pwrtrk_tab_up_a = NULL, *pwrtrk_tab_down_a = NULL;
  288. u8 *pwrtrk_tab_up_b = NULL, *pwrtrk_tab_down_b = NULL;
  289. u8 *pwrtrk_tab_up_cck_a = NULL, *pwrtrk_tab_down_cck_a = NULL;
  290. u8 *pwrtrk_tab_up_cck_b = NULL, *pwrtrk_tab_down_cck_b = NULL;
  291. /*for 8814 add by Yu Chen*/
  292. u8 *pwrtrk_tab_up_c = NULL, *pwrtrk_tab_down_c = NULL;
  293. u8 *pwrtrk_tab_up_d = NULL, *pwrtrk_tab_down_d = NULL;
  294. u8 *pwrtrk_tab_up_cck_c = NULL, *pwrtrk_tab_down_cck_c = NULL;
  295. u8 *pwrtrk_tab_up_cck_d = NULL, *pwrtrk_tab_down_cck_d = NULL;
  296. #ifdef MP_TEST
  297. if ((OPMODE & WIFI_MP_STATE) || *(dm->mp_mode)) {
  298. channel = priv->pshare->working_channel;
  299. if (priv->pshare->mp_txpwr_tracking == false)
  300. return;
  301. } else
  302. #endif
  303. {
  304. channel = (priv->pmib->dot11RFEntry.dot11channel);
  305. }
  306. configure_txpower_track(dm, &c);
  307. (*c.get_delta_all_swing_table)(dm,
  308. (u8 **)&pwrtrk_tab_up_a, (u8 **)&pwrtrk_tab_down_a,
  309. (u8 **)&pwrtrk_tab_up_b, (u8 **)&pwrtrk_tab_down_b,
  310. (u8 **)&pwrtrk_tab_up_cck_a, (u8 **)&pwrtrk_tab_down_cck_a,
  311. (u8 **)&pwrtrk_tab_up_cck_b, (u8 **)&pwrtrk_tab_down_cck_b);
  312. if (GET_CHIP_VER(priv) == VERSION_8198F) {
  313. (*c.get_delta_all_swing_table_ex)(dm,
  314. (u8 **)&pwrtrk_tab_up_c, (u8 **)&pwrtrk_tab_down_c,
  315. (u8 **)&pwrtrk_tab_up_d, (u8 **)&pwrtrk_tab_down_d,
  316. (u8 **)&pwrtrk_tab_up_cck_c, (u8 **)&pwrtrk_tab_down_cck_c,
  317. (u8 **)&pwrtrk_tab_up_cck_d, (u8 **)&pwrtrk_tab_down_cck_d);
  318. }
  319. /*0x42: RF Reg[15:10] 88E*/
  320. thermal_value = (u8)odm_get_rf_reg(dm, RF_PATH_A, c.thermal_reg_addr, 0xfc00);
  321. #ifdef THER_TRIM
  322. if (GET_CHIP_VER(priv) == VERSION_8197F) {
  323. RF_DBG(dm, DBG_RF_TX_PWR_TRACK,"orig thermal_value=%d, ther_trim_val=%d\n", thermal_value, priv->pshare->rf_ft_var.ther_trim_val);
  324. thermal_value += priv->pshare->rf_ft_var.ther_trim_val;
  325. RF_DBG(dm, DBG_RF_TX_PWR_TRACK,"after thermal trim, thermal_value=%d\n", thermal_value);
  326. }
  327. #endif
  328. RF_DBG(dm, DBG_RF_TX_PWR_TRACK,"\n\n\nCurrent Thermal = 0x%x(%d) EEPROMthermalmeter 0x%x(%d)\n"
  329. , thermal_value, thermal_value, priv->pmib->dot11RFEntry.ther, priv->pmib->dot11RFEntry.ther);
  330. /* Initialize */
  331. if (!dm->rf_calibrate_info.thermal_value)
  332. dm->rf_calibrate_info.thermal_value = priv->pmib->dot11RFEntry.ther;
  333. if (!dm->rf_calibrate_info.thermal_value_lck)
  334. dm->rf_calibrate_info.thermal_value_lck = priv->pmib->dot11RFEntry.ther;
  335. if (!dm->rf_calibrate_info.thermal_value_iqk)
  336. dm->rf_calibrate_info.thermal_value_iqk = priv->pmib->dot11RFEntry.ther;
  337. /* calculate average thermal meter */
  338. dm->rf_calibrate_info.thermal_value_avg[dm->rf_calibrate_info.thermal_value_avg_index] = thermal_value;
  339. dm->rf_calibrate_info.thermal_value_avg_index++;
  340. if (dm->rf_calibrate_info.thermal_value_avg_index == c.average_thermal_num) /*Average times = c.average_thermal_num*/
  341. dm->rf_calibrate_info.thermal_value_avg_index = 0;
  342. for (i = 0; i < c.average_thermal_num; i++) {
  343. if (dm->rf_calibrate_info.thermal_value_avg[i]) {
  344. thermal_value_avg += dm->rf_calibrate_info.thermal_value_avg[i];
  345. thermal_value_avg_count++;
  346. }
  347. }
  348. if (thermal_value_avg_count) {/*Calculate Average thermal_value after average enough times*/
  349. RF_DBG(dm, DBG_RF_TX_PWR_TRACK,"thermal_value_avg=0x%x(%d) thermal_value_avg_count = %d\n"
  350. , thermal_value_avg, thermal_value_avg, thermal_value_avg_count);
  351. thermal_value = (u8)(thermal_value_avg / thermal_value_avg_count);
  352. RF_DBG(dm, DBG_RF_TX_PWR_TRACK,"AVG Thermal Meter = 0x%X(%d), EEPROMthermalmeter = 0x%X(%d)\n", thermal_value, thermal_value, priv->pmib->dot11RFEntry.ther, priv->pmib->dot11RFEntry.ther);
  353. }
  354. /*4 Calculate delta, delta_LCK, delta_IQK.*/
  355. delta = RTL_ABS(thermal_value, priv->pmib->dot11RFEntry.ther);
  356. delta_LCK = RTL_ABS(thermal_value, dm->rf_calibrate_info.thermal_value_lck);
  357. delta_IQK = RTL_ABS(thermal_value, dm->rf_calibrate_info.thermal_value_iqk);
  358. is_increase = ((thermal_value < priv->pmib->dot11RFEntry.ther) ? 0 : 1);
  359. if (delta > 29) { /* power track table index(thermal diff.) upper bound*/
  360. RF_DBG(dm, DBG_RF_TX_PWR_TRACK, "delta(%d) > 29, set delta to 29\n", delta);
  361. delta = 29;
  362. }
  363. RF_DBG(dm, DBG_RF_TX_PWR_TRACK, "(delta, delta_LCK, delta_IQK) = (%d, %d, %d)\n", delta, delta_LCK, delta_IQK);
  364. /*4 if necessary, do LCK.*/
  365. if ((delta_LCK >= c.threshold_iqk) && (!iqk_info->rfk_forbidden)) {
  366. RF_DBG(dm, DBG_RF_TX_PWR_TRACK, "delta_LCK(%d) >= threshold_iqk(%d)\n", delta_LCK, c.threshold_iqk);
  367. dm->rf_calibrate_info.thermal_value_lck = thermal_value;
  368. #if (RTL8822B_SUPPORT != 1)
  369. if (!(dm->support_ic_type & ODM_RTL8822B)) {
  370. if (c.phy_lc_calibrate)
  371. (*c.phy_lc_calibrate)(dm);
  372. }
  373. #endif
  374. }
  375. if (!priv->pmib->dot11RFEntry.ther) /*Don't do power tracking since no calibrated thermal value*/
  376. return;
  377. /*4 Do Power Tracking*/
  378. if (thermal_value != dm->rf_calibrate_info.thermal_value) {
  379. RF_DBG(dm, DBG_RF_TX_PWR_TRACK,"******** START POWER TRACKING ********\n");
  380. RF_DBG(dm, DBG_RF_TX_PWR_TRACK,"Readback Thermal Meter = 0x%x pre thermal meter 0x%x EEPROMthermalmeter 0x%x\n",
  381. thermal_value, dm->rf_calibrate_info.thermal_value, priv->pmib->dot11RFEntry.ther);
  382. #ifdef _TRACKING_TABLE_FILE
  383. if (priv->pshare->rf_ft_var.pwr_track_file) {
  384. if (is_increase) { /*thermal is higher than base*/
  385. for (p = RF_PATH_A; p < c.rf_path_count; p++) {
  386. switch (p) {
  387. case RF_PATH_B:
  388. RF_DBG(dm, DBG_RF_TX_PWR_TRACK,"pwrtrk_tab_up_b[%d] = %d pwrtrk_tab_up_cck_b[%d] = %d\n", delta, pwrtrk_tab_up_b[delta], delta, pwrtrk_tab_up_cck_b[delta]);
  389. cali_info->absolute_ofdm_swing_idx[p] = pwrtrk_tab_up_b[delta];
  390. cali_info->absolute_cck_swing_idx[p] = pwrtrk_tab_up_cck_b[delta];
  391. RF_DBG(dm, DBG_RF_TX_PWR_TRACK,"******Temp is higher and pRF->absolute_ofdm_swing_idx[RF_PATH_B] = %d pRF->absolute_cck_swing_idx[RF_PATH_B] = %d\n", cali_info->absolute_ofdm_swing_idx[p], cali_info->absolute_cck_swing_idx[p]);
  392. break;
  393. case RF_PATH_C:
  394. RF_DBG(dm, DBG_RF_TX_PWR_TRACK,"pwrtrk_tab_up_c[%d] = %d pwrtrk_tab_up_cck_c[%d] = %d\n", delta, pwrtrk_tab_up_c[delta], delta, pwrtrk_tab_up_cck_c[delta]);
  395. cali_info->absolute_ofdm_swing_idx[p] = pwrtrk_tab_up_c[delta];
  396. cali_info->absolute_cck_swing_idx[p] = pwrtrk_tab_up_cck_c[delta];
  397. RF_DBG(dm, DBG_RF_TX_PWR_TRACK,"******Temp is higher and pRF->absolute_ofdm_swing_idx[RF_PATH_C] = %d pRF->absolute_cck_swing_idx[RF_PATH_C] = %d\n", cali_info->absolute_ofdm_swing_idx[p], cali_info->absolute_cck_swing_idx[p]);
  398. break;
  399. case RF_PATH_D:
  400. RF_DBG(dm, DBG_RF_TX_PWR_TRACK,"pwrtrk_tab_up_d[%d] = %d pwrtrk_tab_up_cck_d[%d] = %d\n", delta, pwrtrk_tab_up_d[delta], delta, pwrtrk_tab_up_cck_d[delta]);
  401. cali_info->absolute_ofdm_swing_idx[p] = pwrtrk_tab_up_d[delta];
  402. cali_info->absolute_cck_swing_idx[p] = pwrtrk_tab_up_cck_d[delta];
  403. RF_DBG(dm, DBG_RF_TX_PWR_TRACK,"******Temp is higher and pRF->absolute_ofdm_swing_idx[RF_PATH_D] = %d pRF->absolute_cck_swing_idx[RF_PATH_D] = %d\n", cali_info->absolute_ofdm_swing_idx[p], cali_info->absolute_cck_swing_idx[p]);
  404. break;
  405. default:
  406. RF_DBG(dm, DBG_RF_TX_PWR_TRACK,"pwrtrk_tab_up_a[%d] = %d pwrtrk_tab_up_cck_a[%d] = %d\n", delta, pwrtrk_tab_up_a[delta], delta, pwrtrk_tab_up_cck_a[delta]);
  407. cali_info->absolute_ofdm_swing_idx[p] = pwrtrk_tab_up_a[delta];
  408. cali_info->absolute_cck_swing_idx[p] = pwrtrk_tab_up_cck_a[delta];
  409. RF_DBG(dm, DBG_RF_TX_PWR_TRACK,"******Temp is higher and pRF->absolute_ofdm_swing_idx[RF_PATH_A] = %d pRF->absolute_cck_swing_idx[RF_PATH_A] = %d\n", cali_info->absolute_ofdm_swing_idx[p], cali_info->absolute_cck_swing_idx[p]);
  410. break;
  411. }
  412. }
  413. } else { /* thermal is lower than base*/
  414. for (p = RF_PATH_A; p < c.rf_path_count; p++) {
  415. switch (p) {
  416. case RF_PATH_B:
  417. RF_DBG(dm, DBG_RF_TX_PWR_TRACK,"pwrtrk_tab_down_b[%d] = %d pwrtrk_tab_down_cck_b[%d] = %d\n", delta, pwrtrk_tab_down_b[delta], delta, pwrtrk_tab_down_cck_b[delta]);
  418. cali_info->absolute_ofdm_swing_idx[p] = -1 * pwrtrk_tab_down_b[delta];
  419. cali_info->absolute_cck_swing_idx[p] = -1 * pwrtrk_tab_down_cck_b[delta];
  420. RF_DBG(dm, DBG_RF_TX_PWR_TRACK,"******Temp is lower and pRF->absolute_ofdm_swing_idx[RF_PATH_B] = %d pRF->absolute_cck_swing_idx[RF_PATH_B] = %d\n", cali_info->absolute_ofdm_swing_idx[p], cali_info->absolute_cck_swing_idx[p]);
  421. break;
  422. case RF_PATH_C:
  423. RF_DBG(dm, DBG_RF_TX_PWR_TRACK,"pwrtrk_tab_down_c[%d] = %d pwrtrk_tab_down_cck_c[%d] = %d\n", delta, pwrtrk_tab_down_c[delta], delta, pwrtrk_tab_down_cck_c[delta]);
  424. cali_info->absolute_ofdm_swing_idx[p] = -1 * pwrtrk_tab_down_c[delta];
  425. cali_info->absolute_cck_swing_idx[p] = -1 * pwrtrk_tab_down_cck_c[delta];
  426. RF_DBG(dm, DBG_RF_TX_PWR_TRACK,"******Temp is lower and pRF->absolute_ofdm_swing_idx[RF_PATH_C] = %d pRF->absolute_cck_swing_idx[RF_PATH_C] = %d\n", cali_info->absolute_ofdm_swing_idx[p], cali_info->absolute_cck_swing_idx[p]);
  427. break;
  428. case RF_PATH_D:
  429. RF_DBG(dm, DBG_RF_TX_PWR_TRACK,"pwrtrk_tab_down_d[%d] = %d pwrtrk_tab_down_cck_d[%d] = %d\n", delta, pwrtrk_tab_down_d[delta], delta, pwrtrk_tab_down_cck_d[delta]);
  430. cali_info->absolute_ofdm_swing_idx[p] = -1 * pwrtrk_tab_down_d[delta];
  431. cali_info->absolute_cck_swing_idx[p] = -1 * pwrtrk_tab_down_cck_d[delta];
  432. RF_DBG(dm, DBG_RF_TX_PWR_TRACK,"******Temp is lower and pRF->absolute_ofdm_swing_idx[RF_PATH_D] = %d pRF->absolute_cck_swing_idx[RF_PATH_D] = %d\n", cali_info->absolute_ofdm_swing_idx[p], cali_info->absolute_cck_swing_idx[p]);
  433. break;
  434. default:
  435. RF_DBG(dm, DBG_RF_TX_PWR_TRACK,"pwrtrk_tab_down_a[%d] = %d pwrtrk_tab_down_cck_a[%d] = %d\n", delta, pwrtrk_tab_down_a[delta], delta, pwrtrk_tab_down_cck_a[delta]);
  436. cali_info->absolute_ofdm_swing_idx[p] = -1 * pwrtrk_tab_down_a[delta];
  437. cali_info->absolute_cck_swing_idx[p] = -1 * pwrtrk_tab_down_cck_a[delta];
  438. RF_DBG(dm, DBG_RF_TX_PWR_TRACK,"******Temp is lower and pRF->absolute_ofdm_swing_idx[RF_PATH_A] = %d pRF->absolute_cck_swing_idx[RF_PATH_A] = %d\n", cali_info->absolute_ofdm_swing_idx[p], cali_info->absolute_cck_swing_idx[p]);
  439. break;
  440. }
  441. }
  442. }
  443. if (is_increase) {
  444. RF_DBG(dm, DBG_RF_TX_PWR_TRACK, ">>> increse power --->\n");
  445. if (GET_CHIP_VER(priv) == VERSION_8197F) {
  446. for (p = RF_PATH_A; p < c.rf_path_count; p++)
  447. (*c.odm_tx_pwr_track_set_pwr)(dm, BBSWING, p, 0);
  448. //} else if (GET_CHIP_VER(priv) == VERSION_8192F) {
  449. // for (p = RF_PATH_A; p < c.rf_path_count; p++)
  450. // (*c.odm_tx_pwr_track_set_pwr)(dm, MIX_MODE, p, 0);
  451. } else if (GET_CHIP_VER(priv) == VERSION_8822B) {
  452. for (p = RF_PATH_A; p < c.rf_path_count; p++)
  453. (*c.odm_tx_pwr_track_set_pwr)(dm, MIX_MODE, p, 0);
  454. } else if (GET_CHIP_VER(priv) == VERSION_8821C) {
  455. for (p = RF_PATH_A; p < c.rf_path_count; p++)
  456. (*c.odm_tx_pwr_track_set_pwr)(dm, MIX_MODE, p, 0);
  457. } else if (GET_CHIP_VER(priv) == VERSION_8198F) {
  458. for (p = RF_PATH_A; p < c.rf_path_count; p++)
  459. (*c.odm_tx_pwr_track_set_pwr)(dm, MIX_MODE, p, 0);
  460. }
  461. } else {
  462. RF_DBG(dm, DBG_RF_TX_PWR_TRACK, ">>> decrese power --->\n");
  463. if (GET_CHIP_VER(priv) == VERSION_8197F) {
  464. for (p = RF_PATH_A; p < c.rf_path_count; p++)
  465. (*c.odm_tx_pwr_track_set_pwr)(dm, BBSWING, p, 0);
  466. //} else if (GET_CHIP_VER(priv) == VERSION_8192F) {
  467. // for (p = RF_PATH_A; p < c.rf_path_count; p++)
  468. // (*c.odm_tx_pwr_track_set_pwr)(dm, MIX_MODE, p, 0);
  469. } else if (GET_CHIP_VER(priv) == VERSION_8822B) {
  470. for (p = RF_PATH_A; p < c.rf_path_count; p++)
  471. (*c.odm_tx_pwr_track_set_pwr)(dm, MIX_MODE, p, 0);
  472. } else if (GET_CHIP_VER(priv) == VERSION_8821C) {
  473. for (p = RF_PATH_A; p < c.rf_path_count; p++)
  474. (*c.odm_tx_pwr_track_set_pwr)(dm, MIX_MODE, p, 0);
  475. } else if (GET_CHIP_VER(priv) == VERSION_8198F) {
  476. for (p = RF_PATH_A; p < c.rf_path_count; p++)
  477. (*c.odm_tx_pwr_track_set_pwr)(dm, MIX_MODE, p, 0);
  478. }
  479. }
  480. }
  481. #endif
  482. if (GET_CHIP_VER(priv) != VERSION_8198F) {
  483. if ((delta_IQK >= c.threshold_iqk) && (!iqk_info->rfk_forbidden)) {
  484. RF_DBG(dm, DBG_RF_TX_PWR_TRACK, "delta_IQK(%d) >= threshold_iqk(%d)\n", delta_IQK, c.threshold_iqk);
  485. dm->rf_calibrate_info.thermal_value_iqk = thermal_value;
  486. if (c.do_iqk)
  487. (*c.do_iqk)(dm, false, thermal_value, 0);
  488. }
  489. }
  490. RF_DBG(dm, DBG_RF_TX_PWR_TRACK, "\n******** END:%s() ********\n\n", __func__);
  491. /*update thermal meter value*/
  492. dm->rf_calibrate_info.thermal_value = thermal_value;
  493. }
  494. #endif
  495. }
  496. #endif
  497. /*#if (RTL8814A_SUPPORT == 1)*/
  498. #if (RTL8814A_SUPPORT == 1)
  499. void
  500. odm_txpowertracking_callback_thermal_meter_jaguar_series2(
  501. void *dm_void
  502. )
  503. {
  504. struct dm_struct *dm = (struct dm_struct *)dm_void;
  505. u8 thermal_value = 0, delta, delta_LCK, delta_IQK, channel, is_increase;
  506. u8 thermal_value_avg_count = 0, p = 0, i = 0;
  507. u32 thermal_value_avg = 0, reg0x18;
  508. u32 bb_swing_reg[4] = {REG_A_TX_SCALE_JAGUAR, REG_B_TX_SCALE_JAGUAR, REG_C_TX_SCALE_JAGUAR2, REG_D_TX_SCALE_JAGUAR2};
  509. s32 ele_D;
  510. u32 bb_swing_idx;
  511. struct rtl8192cd_priv *priv = dm->priv;
  512. struct txpwrtrack_cfg c;
  513. boolean is_tssi_enable = false;
  514. struct dm_rf_calibration_struct *cali_info = &(dm->rf_calibrate_info);
  515. struct dm_iqk_info *iqk_info = &dm->IQK_info;
  516. /* 4 1. The following TWO tables decide the final index of OFDM/CCK swing table. */
  517. u8 *delta_swing_table_idx_tup_a = NULL, *delta_swing_table_idx_tdown_a = NULL;
  518. u8 *delta_swing_table_idx_tup_b = NULL, *delta_swing_table_idx_tdown_b = NULL;
  519. /* for 8814 add by Yu Chen */
  520. u8 *delta_swing_table_idx_tup_c = NULL, *delta_swing_table_idx_tdown_c = NULL;
  521. u8 *delta_swing_table_idx_tup_d = NULL, *delta_swing_table_idx_tdown_d = NULL;
  522. #ifdef MP_TEST
  523. if ((OPMODE & WIFI_MP_STATE) || *(dm->mp_mode)) {
  524. channel = priv->pshare->working_channel;
  525. if (priv->pshare->mp_txpwr_tracking == false)
  526. return;
  527. } else
  528. #endif
  529. {
  530. channel = (priv->pmib->dot11RFEntry.dot11channel);
  531. }
  532. configure_txpower_track(dm, &c);
  533. cali_info->default_ofdm_index = priv->pshare->OFDM_index0[RF_PATH_A];
  534. (*c.get_delta_swing_table)(dm, (u8 **)&delta_swing_table_idx_tup_a, (u8 **)&delta_swing_table_idx_tdown_a,
  535. (u8 **)&delta_swing_table_idx_tup_b, (u8 **)&delta_swing_table_idx_tdown_b);
  536. if (dm->support_ic_type & ODM_RTL8814A) /* for 8814 path C & D */
  537. (*c.get_delta_swing_table8814only)(dm, (u8 **)&delta_swing_table_idx_tup_c, (u8 **)&delta_swing_table_idx_tdown_c,
  538. (u8 **)&delta_swing_table_idx_tup_d, (u8 **)&delta_swing_table_idx_tdown_d);
  539. thermal_value = (u8)odm_get_rf_reg(dm, RF_PATH_A, c.thermal_reg_addr, 0xfc00); /* 0x42: RF Reg[15:10] 88E */
  540. RF_DBG(dm, DBG_RF_TX_PWR_TRACK,"\nReadback Thermal Meter = 0x%x, pre thermal meter 0x%x, EEPROMthermalmeter 0x%x\n", thermal_value, dm->rf_calibrate_info.thermal_value, priv->pmib->dot11RFEntry.ther);
  541. /* Initialize */
  542. if (!dm->rf_calibrate_info.thermal_value)
  543. dm->rf_calibrate_info.thermal_value = priv->pmib->dot11RFEntry.ther;
  544. if (!dm->rf_calibrate_info.thermal_value_lck)
  545. dm->rf_calibrate_info.thermal_value_lck = priv->pmib->dot11RFEntry.ther;
  546. if (!dm->rf_calibrate_info.thermal_value_iqk)
  547. dm->rf_calibrate_info.thermal_value_iqk = priv->pmib->dot11RFEntry.ther;
  548. is_tssi_enable = (boolean)odm_get_rf_reg(dm, RF_PATH_A, REG_RF_TX_GAIN_OFFSET, BIT(7)); /* check TSSI enable */
  549. /* 4 Query OFDM BB swing default setting Bit[31:21] */
  550. for (p = RF_PATH_A ; p < c.rf_path_count ; p++) {
  551. ele_D = odm_get_bb_reg(dm, bb_swing_reg[p], 0xffe00000);
  552. RF_DBG(dm, DBG_RF_TX_PWR_TRACK,"0x%x:0x%x ([31:21] = 0x%x)\n", bb_swing_reg[p], odm_get_bb_reg(dm, bb_swing_reg[p], MASKDWORD), ele_D);
  553. for (bb_swing_idx = 0; bb_swing_idx < TXSCALE_TABLE_SIZE; bb_swing_idx++) {/* 4 */
  554. if (ele_D == tx_scaling_table_jaguar[bb_swing_idx]) {
  555. dm->rf_calibrate_info.OFDM_index[p] = (u8)bb_swing_idx;
  556. RF_DBG(dm, DBG_RF_TX_PWR_TRACK,"OFDM_index[%d]=%d\n", p, dm->rf_calibrate_info.OFDM_index[p]);
  557. break;
  558. }
  559. }
  560. RF_DBG(dm, DBG_RF_TX_PWR_TRACK, "kfree_offset[%d]=%d\n", p, cali_info->kfree_offset[p]);
  561. }
  562. /* calculate average thermal meter */
  563. dm->rf_calibrate_info.thermal_value_avg[dm->rf_calibrate_info.thermal_value_avg_index] = thermal_value;
  564. dm->rf_calibrate_info.thermal_value_avg_index++;
  565. if (dm->rf_calibrate_info.thermal_value_avg_index == c.average_thermal_num) /* Average times = c.average_thermal_num */
  566. dm->rf_calibrate_info.thermal_value_avg_index = 0;
  567. for (i = 0; i < c.average_thermal_num; i++) {
  568. if (dm->rf_calibrate_info.thermal_value_avg[i]) {
  569. thermal_value_avg += dm->rf_calibrate_info.thermal_value_avg[i];
  570. thermal_value_avg_count++;
  571. }
  572. }
  573. if (thermal_value_avg_count) { /* Calculate Average thermal_value after average enough times */
  574. thermal_value = (u8)(thermal_value_avg / thermal_value_avg_count);
  575. RF_DBG(dm, DBG_RF_TX_PWR_TRACK,"AVG Thermal Meter = 0x%X, EEPROMthermalmeter = 0x%X\n", thermal_value, priv->pmib->dot11RFEntry.ther);
  576. }
  577. /* 4 Calculate delta, delta_LCK, delta_IQK. */
  578. delta = RTL_ABS(thermal_value, priv->pmib->dot11RFEntry.ther);
  579. delta_LCK = RTL_ABS(thermal_value, dm->rf_calibrate_info.thermal_value_lck);
  580. delta_IQK = RTL_ABS(thermal_value, dm->rf_calibrate_info.thermal_value_iqk);
  581. is_increase = ((thermal_value < priv->pmib->dot11RFEntry.ther) ? 0 : 1);
  582. /* 4 if necessary, do LCK. */
  583. if (!(dm->support_ic_type & ODM_RTL8821)) {
  584. if ((delta_LCK > c.threshold_iqk) && (!iqk_info->rfk_forbidden)) {
  585. RF_DBG(dm, DBG_RF_TX_PWR_TRACK, "delta_LCK(%d) >= threshold_iqk(%d)\n", delta_LCK, c.threshold_iqk);
  586. dm->rf_calibrate_info.thermal_value_lck = thermal_value;
  587. /*Use RTLCK, so close power tracking driver LCK*/
  588. #if (RTL8814A_SUPPORT != 1)
  589. if (!(dm->support_ic_type & ODM_RTL8814A)) {
  590. if (c.phy_lc_calibrate)
  591. (*c.phy_lc_calibrate)(dm);
  592. }
  593. #endif
  594. }
  595. }
  596. if ((delta_IQK > c.threshold_iqk) && (!iqk_info->rfk_forbidden)) {
  597. panic_printk("%s(%d)\n", __FUNCTION__, __LINE__);
  598. RF_DBG(dm, DBG_RF_TX_PWR_TRACK, "delta_IQK(%d) >= threshold_iqk(%d)\n", delta_IQK, c.threshold_iqk);
  599. dm->rf_calibrate_info.thermal_value_iqk = thermal_value;
  600. if (c.do_iqk)
  601. (*c.do_iqk)(dm, true, 0, 0);
  602. }
  603. if (!priv->pmib->dot11RFEntry.ther) /*Don't do power tracking since no calibrated thermal value*/
  604. return;
  605. /* 4 Do Power Tracking */
  606. if (is_tssi_enable == true) {
  607. RF_DBG(dm, DBG_RF_TX_PWR_TRACK, "**********Enter PURE TSSI MODE**********\n");
  608. for (p = RF_PATH_A; p < c.rf_path_count; p++)
  609. (*c.odm_tx_pwr_track_set_pwr)(dm, TSSI_MODE, p, 0);
  610. } else if (thermal_value != dm->rf_calibrate_info.thermal_value) {
  611. RF_DBG(dm, DBG_RF_TX_PWR_TRACK,"\n******** START POWER TRACKING ********\n");
  612. RF_DBG(dm, DBG_RF_TX_PWR_TRACK,"\nReadback Thermal Meter = 0x%x pre thermal meter 0x%x EEPROMthermalmeter 0x%x\n", thermal_value, dm->rf_calibrate_info.thermal_value, priv->pmib->dot11RFEntry.ther);
  613. #ifdef _TRACKING_TABLE_FILE
  614. if (priv->pshare->rf_ft_var.pwr_track_file) {
  615. if (is_increase) { /* thermal is higher than base */
  616. for (p = RF_PATH_A; p < c.rf_path_count; p++) {
  617. switch (p) {
  618. case RF_PATH_B:
  619. RF_DBG(dm, DBG_RF_TX_PWR_TRACK,"delta_swing_table_idx_tup_b[%d] = %d\n", delta, delta_swing_table_idx_tup_b[delta]);
  620. cali_info->absolute_ofdm_swing_idx[p] = delta_swing_table_idx_tup_b[delta]; /* Record delta swing for mix mode power tracking */
  621. RF_DBG(dm, DBG_RF_TX_PWR_TRACK,"******Temp is higher and dm->absolute_ofdm_swing_idx[RF_PATH_B] = %d\n", cali_info->absolute_ofdm_swing_idx[p]);
  622. break;
  623. case RF_PATH_C:
  624. RF_DBG(dm, DBG_RF_TX_PWR_TRACK,"delta_swing_table_idx_tup_c[%d] = %d\n", delta, delta_swing_table_idx_tup_c[delta]);
  625. cali_info->absolute_ofdm_swing_idx[p] = delta_swing_table_idx_tup_c[delta]; /* Record delta swing for mix mode power tracking */
  626. RF_DBG(dm, DBG_RF_TX_PWR_TRACK,"******Temp is higher and dm->absolute_ofdm_swing_idx[RF_PATH_C] = %d\n", cali_info->absolute_ofdm_swing_idx[p]);
  627. break;
  628. case RF_PATH_D:
  629. RF_DBG(dm, DBG_RF_TX_PWR_TRACK,"delta_swing_table_idx_tup_d[%d] = %d\n", delta, delta_swing_table_idx_tup_d[delta]);
  630. cali_info->absolute_ofdm_swing_idx[p] = delta_swing_table_idx_tup_d[delta]; /* Record delta swing for mix mode power tracking */
  631. RF_DBG(dm, DBG_RF_TX_PWR_TRACK,"******Temp is higher and dm->absolute_ofdm_swing_idx[RF_PATH_D] = %d\n", cali_info->absolute_ofdm_swing_idx[p]);
  632. break;
  633. default:
  634. RF_DBG(dm, DBG_RF_TX_PWR_TRACK,"delta_swing_table_idx_tup_a[%d] = %d\n", delta, delta_swing_table_idx_tup_a[delta]);
  635. cali_info->absolute_ofdm_swing_idx[p] = delta_swing_table_idx_tup_a[delta]; /* Record delta swing for mix mode power tracking */
  636. RF_DBG(dm, DBG_RF_TX_PWR_TRACK,"******Temp is higher and dm->absolute_ofdm_swing_idx[RF_PATH_A] = %d\n", cali_info->absolute_ofdm_swing_idx[p]);
  637. break;
  638. }
  639. }
  640. } else { /* thermal is lower than base */
  641. for (p = RF_PATH_A; p < c.rf_path_count; p++) {
  642. switch (p) {
  643. case RF_PATH_B:
  644. RF_DBG(dm, DBG_RF_TX_PWR_TRACK,"delta_swing_table_idx_tdown_b[%d] = %d\n", delta, delta_swing_table_idx_tdown_b[delta]);
  645. cali_info->absolute_ofdm_swing_idx[p] = -1 * delta_swing_table_idx_tdown_b[delta]; /* Record delta swing for mix mode power tracking */
  646. RF_DBG(dm, DBG_RF_TX_PWR_TRACK,"******Temp is lower and dm->absolute_ofdm_swing_idx[RF_PATH_B] = %d\n", cali_info->absolute_ofdm_swing_idx[p]);
  647. break;
  648. case RF_PATH_C:
  649. RF_DBG(dm, DBG_RF_TX_PWR_TRACK,"delta_swing_table_idx_tdown_c[%d] = %d\n", delta, delta_swing_table_idx_tdown_c[delta]);
  650. cali_info->absolute_ofdm_swing_idx[p] = -1 * delta_swing_table_idx_tdown_c[delta]; /* Record delta swing for mix mode power tracking */
  651. RF_DBG(dm, DBG_RF_TX_PWR_TRACK,"******Temp is lower and dm->absolute_ofdm_swing_idx[RF_PATH_C] = %d\n", cali_info->absolute_ofdm_swing_idx[p]);
  652. break;
  653. case RF_PATH_D:
  654. RF_DBG(dm, DBG_RF_TX_PWR_TRACK,"delta_swing_table_idx_tdown_d[%d] = %d\n", delta, delta_swing_table_idx_tdown_d[delta]);
  655. cali_info->absolute_ofdm_swing_idx[p] = -1 * delta_swing_table_idx_tdown_d[delta]; /* Record delta swing for mix mode power tracking */
  656. RF_DBG(dm, DBG_RF_TX_PWR_TRACK,"******Temp is lower and dm->absolute_ofdm_swing_idx[RF_PATH_D] = %d\n", cali_info->absolute_ofdm_swing_idx[p]);
  657. break;
  658. default:
  659. RF_DBG(dm, DBG_RF_TX_PWR_TRACK,"delta_swing_table_idx_tdown_a[%d] = %d\n", delta, delta_swing_table_idx_tdown_a[delta]);
  660. cali_info->absolute_ofdm_swing_idx[p] = -1 * delta_swing_table_idx_tdown_a[delta]; /* Record delta swing for mix mode power tracking */
  661. RF_DBG(dm, DBG_RF_TX_PWR_TRACK,"******Temp is lower and dm->absolute_ofdm_swing_idx[RF_PATH_A] = %d\n", cali_info->absolute_ofdm_swing_idx[p]);
  662. break;
  663. }
  664. }
  665. }
  666. if (is_increase) {
  667. RF_DBG(dm, DBG_RF_TX_PWR_TRACK, ">>> increse power --->\n");
  668. for (p = RF_PATH_A; p < c.rf_path_count; p++)
  669. (*c.odm_tx_pwr_track_set_pwr)(dm, MIX_MODE, p, 0);
  670. } else {
  671. RF_DBG(dm, DBG_RF_TX_PWR_TRACK, ">>> decrese power --->\n");
  672. for (p = RF_PATH_A; p < c.rf_path_count; p++)
  673. (*c.odm_tx_pwr_track_set_pwr)(dm, MIX_MODE, p, 0);
  674. }
  675. }
  676. #endif
  677. RF_DBG(dm, DBG_RF_TX_PWR_TRACK, "\n******** END:%s() ********\n", __FUNCTION__);
  678. /* update thermal meter value */
  679. dm->rf_calibrate_info.thermal_value = thermal_value;
  680. }
  681. }
  682. #endif
  683. #if (RTL8812A_SUPPORT == 1 || RTL8881A_SUPPORT == 1)
  684. void
  685. odm_txpowertracking_callback_thermal_meter_jaguar_series(
  686. void *dm_void
  687. )
  688. {
  689. struct dm_struct *dm = (struct dm_struct *)dm_void;
  690. unsigned char thermal_value = 0, delta, delta_LCK, channel, is_decrease;
  691. unsigned char thermal_value_avg_count = 0;
  692. unsigned int thermal_value_avg = 0, reg0x18;
  693. unsigned int bb_swing_reg[4] = {0xc1c, 0xe1c, 0x181c, 0x1a1c};
  694. int ele_D, value32;
  695. char OFDM_index[2], index;
  696. unsigned int i = 0, j = 0, rf_path, max_rf_path = 2, rf;
  697. struct rtl8192cd_priv *priv = dm->priv;
  698. unsigned char OFDM_min_index = 7; /* OFDM BB Swing should be less than +2.5dB, which is required by Arthur and Mimic */
  699. struct dm_iqk_info *iqk_info = &dm->IQK_info;
  700. #ifdef MP_TEST
  701. if ((OPMODE & WIFI_MP_STATE) || *(dm->mp_mode)) {
  702. channel = priv->pshare->working_channel;
  703. if (priv->pshare->mp_txpwr_tracking == false)
  704. return;
  705. } else
  706. #endif
  707. {
  708. channel = (priv->pmib->dot11RFEntry.dot11channel);
  709. }
  710. #if RTL8881A_SUPPORT
  711. if (dm->support_ic_type == ODM_RTL8881A) {
  712. max_rf_path = 1;
  713. if ((get_bonding_type_8881A() == BOND_8881AM || get_bonding_type_8881A() == BOND_8881AN)
  714. && priv->pshare->rf_ft_var.use_intpa8881A && (*dm->band_type == ODM_BAND_2_4G))
  715. OFDM_min_index = 6; /* intPA - upper bond set to +3 dB (base: -2 dB)ot11RFEntry.phy_band_select == PHY_BAND_2G)) */
  716. else
  717. OFDM_min_index = 10; /* OFDM BB Swing should be less than +1dB, which is required by Arthur and Mimic */
  718. }
  719. #endif
  720. thermal_value = (unsigned char)phy_query_rf_reg(priv, RF_PATH_A, 0x42, 0xfc00, 1); /* 0x42: RF Reg[15:10] 88E */
  721. RF_DBG(dm, DBG_RF_TX_PWR_TRACK, "\nReadback Thermal Meter = 0x%x pre thermal meter 0x%x EEPROMthermalmeter 0x%x\n", thermal_value, priv->pshare->thermal_value, priv->pmib->dot11RFEntry.ther);
  722. /* 4 Query OFDM BB swing default setting Bit[31:21] */
  723. for (rf_path = 0 ; rf_path < max_rf_path ; rf_path++) {
  724. ele_D = phy_query_bb_reg(priv, bb_swing_reg[rf_path], 0xffe00000);
  725. RF_DBG(dm, DBG_RF_TX_PWR_TRACK, "0x%x:0x%x ([31:21] = 0x%x)\n", bb_swing_reg[rf_path], phy_query_bb_reg(priv, bb_swing_reg[rf_path], MASKDWORD), ele_D);
  726. for (i = 0; i < OFDM_TABLE_SIZE_8812; i++) {/* 4 */
  727. if (ele_D == ofdm_swing_table_8812[i]) {
  728. OFDM_index[rf_path] = (unsigned char)i;
  729. RF_DBG(dm, DBG_RF_TX_PWR_TRACK, "OFDM_index[%d]=%d\n", rf_path, OFDM_index[rf_path]);
  730. break;
  731. }
  732. }
  733. }
  734. #if 0
  735. /* Query OFDM path A default setting Bit[31:21] */
  736. ele_D = phy_query_bb_reg(priv, 0xc1c, 0xffe00000);
  737. RF_DBG(dm, DBG_RF_TX_PWR_TRACK, "0xc1c:0x%x ([31:21] = 0x%x)\n", phy_query_bb_reg(priv, 0xc1c, MASKDWORD), ele_D);
  738. for (i = 0; i < OFDM_TABLE_SIZE_8812; i++) {/* 4 */
  739. if (ele_D == ofdm_swing_table_8812[i]) {
  740. OFDM_index[0] = (unsigned char)i;
  741. RF_DBG(dm, DBG_RF_TX_PWR_TRACK, "OFDM_index[0]=%d\n", OFDM_index[0]);
  742. break;
  743. }
  744. }
  745. /* Query OFDM path B default setting */
  746. if (rf == 2) {
  747. ele_D = phy_query_bb_reg(priv, 0xe1c, 0xffe00000);
  748. RF_DBG(dm, DBG_RF_TX_PWR_TRACK, "0xe1c:0x%x ([32:21] = 0x%x)\n", phy_query_bb_reg(priv, 0xe1c, MASKDWORD), ele_D);
  749. for (i = 0; i < OFDM_TABLE_SIZE_8812; i++) {
  750. if (ele_D == ofdm_swing_table_8812[i]) {
  751. OFDM_index[1] = (unsigned char)i;
  752. RF_DBG(dm, DBG_RF_TX_PWR_TRACK, "OFDM_index[1]=%d\n", OFDM_index[1]);
  753. break;
  754. }
  755. }
  756. }
  757. #endif
  758. /* Initialize */
  759. if (!priv->pshare->thermal_value) {
  760. priv->pshare->thermal_value = priv->pmib->dot11RFEntry.ther;
  761. priv->pshare->thermal_value_lck = thermal_value;
  762. }
  763. /* calculate average thermal meter */
  764. {
  765. priv->pshare->thermal_value_avg_8812[priv->pshare->thermal_value_avg_index_8812] = thermal_value;
  766. priv->pshare->thermal_value_avg_index_8812++;
  767. if (priv->pshare->thermal_value_avg_index_8812 == AVG_THERMAL_NUM_8812)
  768. priv->pshare->thermal_value_avg_index_8812 = 0;
  769. for (i = 0; i < AVG_THERMAL_NUM_8812; i++) {
  770. if (priv->pshare->thermal_value_avg_8812[i]) {
  771. thermal_value_avg += priv->pshare->thermal_value_avg_8812[i];
  772. thermal_value_avg_count++;
  773. }
  774. }
  775. if (thermal_value_avg_count) {
  776. thermal_value = (unsigned char)(thermal_value_avg / thermal_value_avg_count);
  777. /* printk("AVG Thermal Meter = 0x%x\n", thermal_value); */
  778. }
  779. }
  780. /* 4 If necessary, do power tracking */
  781. if (!priv->pmib->dot11RFEntry.ther) /*Don't do power tracking since no calibrated thermal value*/
  782. return;
  783. if (thermal_value != priv->pshare->thermal_value) {
  784. RF_DBG(dm, DBG_RF_TX_PWR_TRACK, "\n******** START POWER TRACKING ********\n");
  785. RF_DBG(dm, DBG_RF_TX_PWR_TRACK, "\nReadback Thermal Meter = 0x%x pre thermal meter 0x%x EEPROMthermalmeter 0x%x\n", thermal_value, priv->pshare->thermal_value, priv->pmib->dot11RFEntry.ther);
  786. delta = RTL_ABS(thermal_value, priv->pmib->dot11RFEntry.ther);
  787. delta_LCK = RTL_ABS(thermal_value, priv->pshare->thermal_value_lck);
  788. is_decrease = ((thermal_value < priv->pmib->dot11RFEntry.ther) ? 1 : 0);
  789. /* if (*dm->band_type == ODM_BAND_5G) */
  790. {
  791. #ifdef _TRACKING_TABLE_FILE
  792. if (priv->pshare->rf_ft_var.pwr_track_file) {
  793. for (rf_path = 0; rf_path < max_rf_path; rf_path++) {
  794. RF_DBG(dm, DBG_RF_TX_PWR_TRACK, "diff: (%s)%d ==> get index from table : %d)\n", (is_decrease ? "-" : "+"), delta, get_tx_tracking_index(priv, channel, rf_path, delta, is_decrease, 0));
  795. if (is_decrease) {
  796. OFDM_index[rf_path] = priv->pshare->OFDM_index0[rf_path] + get_tx_tracking_index(priv, channel, rf_path, delta, is_decrease, 0);
  797. OFDM_index[rf_path] = ((OFDM_index[rf_path] > (OFDM_TABLE_SIZE_8812 - 1)) ? (OFDM_TABLE_SIZE_8812 - 1) : OFDM_index[rf_path]);
  798. RF_DBG(dm, DBG_RF_TX_PWR_TRACK, ">>> decrese power ---> new OFDM_INDEX:%d (%d + %d)\n", OFDM_index[rf_path], priv->pshare->OFDM_index0[rf_path], get_tx_tracking_index(priv, channel, rf_path, delta, is_decrease, 0));
  799. #if 0/* RTL8881A_SUPPORT */
  800. if (dm->support_ic_type == ODM_RTL8881A) {
  801. if (priv->pshare->rf_ft_var.pwrtrk_tx_agc_enable) {
  802. if (priv->pshare->add_tx_agc) { /* tx_agc has been added */
  803. add_tx_power88xx_ac(priv, 0);
  804. priv->pshare->add_tx_agc = 0;
  805. priv->pshare->add_tx_agc_index = 0;
  806. }
  807. }
  808. }
  809. #endif
  810. } else {
  811. OFDM_index[rf_path] = priv->pshare->OFDM_index0[rf_path] - get_tx_tracking_index(priv, channel, rf_path, delta, is_decrease, 0);
  812. #if 0/* RTL8881A_SUPPORT */
  813. if (dm->support_ic_type == ODM_RTL8881A) {
  814. if (priv->pshare->rf_ft_var.pwrtrk_tx_agc_enable) {
  815. if (OFDM_index[i] < OFDM_min_index) {
  816. priv->pshare->add_tx_agc_index = (OFDM_min_index - OFDM_index[i]) / 2; /* Calculate Remnant tx_agc value, 2 index for 1 tx_agc */
  817. add_tx_power88xx_ac(priv, priv->pshare->add_tx_agc_index);
  818. priv->pshare->add_tx_agc = 1; /* add_tx_agc Flag = 1 */
  819. OFDM_index[i] = OFDM_min_index;
  820. } else {
  821. if (priv->pshare->add_tx_agc) { /* tx_agc been added */
  822. priv->pshare->add_tx_agc = 0;
  823. priv->pshare->add_tx_agc_index = 0;
  824. add_tx_power88xx_ac(priv, 0); /* minus the added TPI */
  825. }
  826. }
  827. }
  828. }
  829. #else
  830. OFDM_index[rf_path] = ((OFDM_index[rf_path] < OFDM_min_index) ? OFDM_min_index : OFDM_index[rf_path]);
  831. #endif
  832. RF_DBG(dm, DBG_RF_TX_PWR_TRACK, ">>> increse power ---> new OFDM_INDEX:%d (%d - %d)\n", OFDM_index[rf_path], priv->pshare->OFDM_index0[rf_path], get_tx_tracking_index(priv, channel, rf_path, delta, is_decrease, 0));
  833. }
  834. }
  835. }
  836. #endif
  837. /* 4 Set new BB swing index */
  838. for (rf_path = 0; rf_path < max_rf_path; rf_path++) {
  839. phy_set_bb_reg(priv, bb_swing_reg[rf_path], 0xffe00000, ofdm_swing_table_8812[(unsigned int)OFDM_index[rf_path]]);
  840. RF_DBG(dm, DBG_RF_TX_PWR_TRACK, "Readback 0x%x[31:21] = 0x%x, OFDM_index:%d\n", bb_swing_reg[rf_path], phy_query_bb_reg(priv, bb_swing_reg[rf_path], 0xffe00000), OFDM_index[rf_path]);
  841. }
  842. }
  843. if ((delta_LCK > 8) && (!iqk_info->rfk_forbidden)) {
  844. RTL_W8(0x522, 0xff);
  845. reg0x18 = phy_query_rf_reg(priv, RF_PATH_A, 0x18, MASK20BITS, 1);
  846. phy_set_rf_reg(priv, RF_PATH_A, 0xB4, BIT(14), 1);
  847. phy_set_rf_reg(priv, RF_PATH_A, 0x18, BIT(15), 1);
  848. delay_ms(200); /* frequency deviation */
  849. phy_set_rf_reg(priv, RF_PATH_A, 0xB4, BIT(14), 0);
  850. phy_set_rf_reg(priv, RF_PATH_A, 0x18, MASK20BITS, reg0x18);
  851. #ifdef CONFIG_RTL_8812_SUPPORT
  852. if (GET_CHIP_VER(priv) == VERSION_8812E)
  853. update_bbrf_val8812(priv, priv->pmib->dot11RFEntry.dot11channel);
  854. #endif
  855. RTL_W8(0x522, 0x0);
  856. priv->pshare->thermal_value_lck = thermal_value;
  857. }
  858. RF_DBG(dm, DBG_RF_TX_PWR_TRACK, "\n******** END:%s() ********\n", __FUNCTION__);
  859. /* update thermal meter value */
  860. priv->pshare->thermal_value = thermal_value;
  861. for (rf_path = 0; rf_path < max_rf_path; rf_path++)
  862. priv->pshare->OFDM_index[rf_path] = OFDM_index[rf_path];
  863. }
  864. }
  865. #endif
  866. void
  867. odm_txpowertracking_callback_thermal_meter(
  868. void *dm_void
  869. )
  870. {
  871. struct dm_struct *dm = (struct dm_struct *)dm_void;
  872. struct dm_rf_calibration_struct *cali_info = &(dm->rf_calibrate_info);
  873. struct dm_iqk_info *iqk_info = &dm->IQK_info;
  874. #if (RTL8197F_SUPPORT == 1 ||RTL8192F_SUPPORT == 1 || RTL8822B_SUPPORT == 1 || RTL8821C_SUPPORT == 1 || RTL8198F_SUPPORT == 1)
  875. if (dm->support_ic_type == ODM_RTL8197F || dm->support_ic_type == ODM_RTL8192F || dm->support_ic_type == ODM_RTL8822B
  876. || dm->support_ic_type == ODM_RTL8821C || dm->support_ic_type == ODM_RTL8198F) {
  877. odm_txpowertracking_callback_thermal_meter_jaguar_series3(dm);
  878. return;
  879. }
  880. #endif
  881. #if (RTL8814A_SUPPORT == 1) /*use this function to do power tracking after 8814 by YuChen*/
  882. if (dm->support_ic_type & ODM_RTL8814A) {
  883. odm_txpowertracking_callback_thermal_meter_jaguar_series2(dm);
  884. return;
  885. }
  886. #endif
  887. #if (RTL8881A_SUPPORT || RTL8812A_SUPPORT == 1)
  888. if (dm->support_ic_type & ODM_RTL8812 || dm->support_ic_type & ODM_RTL8881A) {
  889. odm_txpowertracking_callback_thermal_meter_jaguar_series(dm);
  890. return;
  891. }
  892. #endif
  893. #if (RTL8192E_SUPPORT == 1)
  894. if (dm->support_ic_type == ODM_RTL8192E) {
  895. odm_txpowertracking_callback_thermal_meter_92e(dm);
  896. return;
  897. }
  898. #endif
  899. #if !(DM_ODM_SUPPORT_TYPE & ODM_AP)
  900. HAL_DATA_TYPE *hal_data = GET_HAL_DATA(((PADAPTER)adapter));
  901. /* PMGNT_INFO mgnt_info = &adapter->mgnt_info; */
  902. #endif
  903. u8 thermal_value = 0, delta, delta_LCK, delta_IQK, offset;
  904. u8 thermal_value_avg_count = 0;
  905. u32 thermal_value_avg = 0;
  906. /* s32 ele_A=0, ele_D, TempCCk, X, value32;
  907. * s32 Y, ele_C=0;
  908. * s8 OFDM_index[2], CCK_index=0, OFDM_index_old[2]={0,0}, CCK_index_old=0, index;
  909. * s8 deltaPowerIndex = 0; */
  910. u32 i = 0;/* , j = 0; */
  911. boolean is2T = false;
  912. /* bool bInteralPA = false; */
  913. u8 OFDM_max_index = 34, rf = (is2T) ? 2 : 1; /* OFDM BB Swing should be less than +3.0dB, which is required by Arthur */
  914. u8 indexforchannel = 0;/*get_right_chnl_place_for_iqk(hal_data->current_channel)*/
  915. enum _POWER_DEC_INC { POWER_DEC, POWER_INC };
  916. struct txpwrtrack_cfg c;
  917. /* 4 1. The following TWO tables decide the final index of OFDM/CCK swing table. */
  918. s8 delta_swing_table_idx[2][index_mapping_NUM_88E] = {
  919. /* {{Power decreasing(lower temperature)}, {Power increasing(higher temperature)}} */
  920. {0, 0, 2, 3, 4, 4, 5, 6, 7, 7, 8, 9, 10, 10, 11}, {0, 0, 1, 2, 3, 4, 4, 4, 4, 5, 7, 8, 9, 9, 10}
  921. };
  922. u8 thermal_threshold[2][index_mapping_NUM_88E] = {
  923. /* {{Power decreasing(lower temperature)}, {Power increasing(higher temperature)}} */
  924. {0, 2, 4, 6, 8, 10, 12, 14, 16, 18, 20, 22, 24, 26, 27}, {0, 2, 4, 6, 8, 10, 12, 14, 16, 18, 20, 22, 25, 25, 25}
  925. };
  926. #if (DM_ODM_SUPPORT_TYPE & ODM_AP)
  927. struct rtl8192cd_priv *priv = dm->priv;
  928. #endif
  929. /* 4 2. Initilization ( 7 steps in total ) */
  930. configure_txpower_track(dm, &c);
  931. dm->rf_calibrate_info.txpowertracking_callback_cnt++; /* cosa add for debug */
  932. dm->rf_calibrate_info.is_txpowertracking_init = true;
  933. #if (MP_DRIVER == 1)
  934. dm->rf_calibrate_info.txpowertrack_control = hal_data->txpowertrack_control; /* <Kordan> We should keep updating the control variable according to HalData.
  935. * <Kordan> rf_calibrate_info.rega24 will be initialized when ODM HW configuring, but MP configures with para files. */
  936. dm->rf_calibrate_info.rega24 = 0x090e1317;
  937. #endif
  938. #if (DM_ODM_SUPPORT_TYPE == ODM_AP) && defined(MP_TEST)
  939. if ((OPMODE & WIFI_MP_STATE) || *(dm->mp_mode)) {
  940. if (dm->priv->pshare->mp_txpwr_tracking == false)
  941. return;
  942. }
  943. #endif
  944. RF_DBG(dm, DBG_RF_TX_PWR_TRACK, "===>odm_txpowertracking_callback_thermal_meter_8188e, dm->bb_swing_idx_cck_base: %d, dm->bb_swing_idx_ofdm_base: %d\n", cali_info->bb_swing_idx_cck_base, cali_info->bb_swing_idx_ofdm_base);
  945. /*
  946. if (!dm->rf_calibrate_info.tm_trigger) {
  947. odm_set_rf_reg(dm, RF_PATH_A, c.thermal_reg_addr, BIT(17) | BIT(16), 0x3);
  948. dm->rf_calibrate_info.tm_trigger = 1;
  949. return;
  950. }
  951. */
  952. thermal_value = (u8)odm_get_rf_reg(dm, RF_PATH_A, c.thermal_reg_addr, 0xfc00); /* 0x42: RF Reg[15:10] 88E */
  953. #if !(DM_ODM_SUPPORT_TYPE & ODM_AP)
  954. if (!thermal_value || !dm->rf_calibrate_info.txpowertrack_control)
  955. #else
  956. if (!dm->rf_calibrate_info.txpowertrack_control)
  957. #endif
  958. return;
  959. /* 4 3. Initialize ThermalValues of rf_calibrate_info */
  960. if (!dm->rf_calibrate_info.thermal_value) {
  961. dm->rf_calibrate_info.thermal_value_lck = thermal_value;
  962. dm->rf_calibrate_info.thermal_value_iqk = thermal_value;
  963. }
  964. if (dm->rf_calibrate_info.is_reloadtxpowerindex)
  965. RF_DBG(dm, DBG_RF_TX_PWR_TRACK, "reload ofdm index for band switch\n");
  966. /* 4 4. Calculate average thermal meter */
  967. dm->rf_calibrate_info.thermal_value_avg[dm->rf_calibrate_info.thermal_value_avg_index] = thermal_value;
  968. dm->rf_calibrate_info.thermal_value_avg_index++;
  969. if (dm->rf_calibrate_info.thermal_value_avg_index == c.average_thermal_num)
  970. dm->rf_calibrate_info.thermal_value_avg_index = 0;
  971. for (i = 0; i < c.average_thermal_num; i++) {
  972. if (dm->rf_calibrate_info.thermal_value_avg[i]) {
  973. thermal_value_avg += dm->rf_calibrate_info.thermal_value_avg[i];
  974. thermal_value_avg_count++;
  975. }
  976. }
  977. if (thermal_value_avg_count) {
  978. /* Give the new thermo value a weighting */
  979. thermal_value_avg += (thermal_value * 4);
  980. thermal_value = (u8)(thermal_value_avg / (thermal_value_avg_count + 4));
  981. cali_info->thermal_value_delta = thermal_value - priv->pmib->dot11RFEntry.ther;
  982. RF_DBG(dm, DBG_RF_TX_PWR_TRACK, "AVG Thermal Meter = 0x%x\n", thermal_value);
  983. }
  984. /* 4 5. Calculate delta, delta_LCK, delta_IQK. */
  985. delta = (thermal_value > dm->rf_calibrate_info.thermal_value) ? (thermal_value - dm->rf_calibrate_info.thermal_value) : (dm->rf_calibrate_info.thermal_value - thermal_value);
  986. delta_LCK = (thermal_value > dm->rf_calibrate_info.thermal_value_lck) ? (thermal_value - dm->rf_calibrate_info.thermal_value_lck) : (dm->rf_calibrate_info.thermal_value_lck - thermal_value);
  987. delta_IQK = (thermal_value > dm->rf_calibrate_info.thermal_value_iqk) ? (thermal_value - dm->rf_calibrate_info.thermal_value_iqk) : (dm->rf_calibrate_info.thermal_value_iqk - thermal_value);
  988. /* 4 6. If necessary, do LCK. */
  989. if (!(dm->support_ic_type & ODM_RTL8821)) {
  990. /*if((delta_LCK > hal_data->delta_lck) && (hal_data->delta_lck != 0))*/
  991. if ((delta_LCK >= c.threshold_iqk) && (!iqk_info->rfk_forbidden)) {
  992. /*Delta temperature is equal to or larger than 20 centigrade.*/
  993. dm->rf_calibrate_info.thermal_value_lck = thermal_value;
  994. (*c.phy_lc_calibrate)(dm);
  995. }
  996. }
  997. /* 3 7. If necessary, move the index of swing table to adjust Tx power. */
  998. if (delta > 0 && dm->rf_calibrate_info.txpowertrack_control) {
  999. delta = (thermal_value > dm->priv->pmib->dot11RFEntry.ther) ? (thermal_value - dm->priv->pmib->dot11RFEntry.ther) : (dm->priv->pmib->dot11RFEntry.ther - thermal_value);
  1000. /* 4 7.1 The Final Power index = BaseIndex + power_index_offset */
  1001. if (thermal_value > dm->priv->pmib->dot11RFEntry.ther) {
  1002. CALCULATE_SWINGTALBE_OFFSET(offset, POWER_INC, index_mapping_NUM_88E, delta);
  1003. dm->rf_calibrate_info.delta_power_index_last = dm->rf_calibrate_info.delta_power_index;
  1004. dm->rf_calibrate_info.delta_power_index = delta_swing_table_idx[POWER_INC][offset];
  1005. } else {
  1006. CALCULATE_SWINGTALBE_OFFSET(offset, POWER_DEC, index_mapping_NUM_88E, delta);
  1007. dm->rf_calibrate_info.delta_power_index_last = dm->rf_calibrate_info.delta_power_index;
  1008. dm->rf_calibrate_info.delta_power_index = (-1) * delta_swing_table_idx[POWER_DEC][offset];
  1009. }
  1010. if (dm->rf_calibrate_info.delta_power_index == dm->rf_calibrate_info.delta_power_index_last)
  1011. dm->rf_calibrate_info.power_index_offset = 0;
  1012. else
  1013. dm->rf_calibrate_info.power_index_offset = dm->rf_calibrate_info.delta_power_index - dm->rf_calibrate_info.delta_power_index_last;
  1014. for (i = 0; i < rf; i++)
  1015. dm->rf_calibrate_info.OFDM_index[i] = cali_info->bb_swing_idx_ofdm_base + dm->rf_calibrate_info.power_index_offset;
  1016. dm->rf_calibrate_info.CCK_index = cali_info->bb_swing_idx_cck_base + dm->rf_calibrate_info.power_index_offset;
  1017. cali_info->bb_swing_idx_cck = dm->rf_calibrate_info.CCK_index;
  1018. cali_info->bb_swing_idx_ofdm[RF_PATH_A] = dm->rf_calibrate_info.OFDM_index[RF_PATH_A];
  1019. RF_DBG(dm, DBG_RF_TX_PWR_TRACK, "The 'CCK' final index(%d) = BaseIndex(%d) + power_index_offset(%d)\n", cali_info->bb_swing_idx_cck, cali_info->bb_swing_idx_cck_base, dm->rf_calibrate_info.power_index_offset);
  1020. RF_DBG(dm, DBG_RF_TX_PWR_TRACK, "The 'OFDM' final index(%d) = BaseIndex(%d) + power_index_offset(%d)\n", cali_info->bb_swing_idx_ofdm[RF_PATH_A], cali_info->bb_swing_idx_ofdm_base, dm->rf_calibrate_info.power_index_offset);
  1021. /* 4 7.1 Handle boundary conditions of index. */
  1022. for (i = 0; i < rf; i++) {
  1023. if (dm->rf_calibrate_info.OFDM_index[i] > OFDM_max_index)
  1024. dm->rf_calibrate_info.OFDM_index[i] = OFDM_max_index;
  1025. else if (dm->rf_calibrate_info.OFDM_index[i] < 0)
  1026. dm->rf_calibrate_info.OFDM_index[i] = 0;
  1027. }
  1028. if (dm->rf_calibrate_info.CCK_index > c.swing_table_size_cck - 1)
  1029. dm->rf_calibrate_info.CCK_index = c.swing_table_size_cck - 1;
  1030. else if (dm->rf_calibrate_info.CCK_index < 0)
  1031. dm->rf_calibrate_info.CCK_index = 0;
  1032. } else {
  1033. RF_DBG(dm, DBG_RF_TX_PWR_TRACK,"The thermal meter is unchanged or TxPowerTracking OFF: thermal_value: %d, dm->rf_calibrate_info.thermal_value: %d)\n", thermal_value, dm->rf_calibrate_info.thermal_value);
  1034. dm->rf_calibrate_info.power_index_offset = 0;
  1035. }
  1036. RF_DBG(dm, DBG_RF_TX_PWR_TRACK,"TxPowerTracking: [CCK] Swing Current index: %d, Swing base index: %d\n", dm->rf_calibrate_info.CCK_index, cali_info->bb_swing_idx_cck_base);
  1037. RF_DBG(dm, DBG_RF_TX_PWR_TRACK,"TxPowerTracking: [OFDM] Swing Current index: %d, Swing base index: %d\n", dm->rf_calibrate_info.OFDM_index[RF_PATH_A], cali_info->bb_swing_idx_ofdm_base);
  1038. if (dm->rf_calibrate_info.power_index_offset != 0 && dm->rf_calibrate_info.txpowertrack_control) {
  1039. /* 4 7.2 Configure the Swing Table to adjust Tx Power. */
  1040. dm->rf_calibrate_info.is_tx_power_changed = true; /* Always true after Tx Power is adjusted by power tracking. */
  1041. /* */
  1042. /* 2012/04/23 MH According to Luke's suggestion, we can not write BB digital */
  1043. /* to increase TX power. Otherwise, EVM will be bad. */
  1044. /* */
  1045. /* 2012/04/25 MH Add for tx power tracking to set tx power in tx agc for 88E. */
  1046. if (thermal_value > dm->rf_calibrate_info.thermal_value) {
  1047. /* RF_DBG(dm,DBG_RF_TX_PWR_TRACK, */
  1048. /* "Temperature Increasing: delta_pi: %d, delta_t: %d, Now_t: %d, EFUSE_t: %d, Last_t: %d\n", */
  1049. /* dm->rf_calibrate_info.power_index_offset, delta, thermal_value, hal_data->eeprom_thermal_meter, dm->rf_calibrate_info.thermal_value); */
  1050. } else if (thermal_value < dm->rf_calibrate_info.thermal_value) { /* Low temperature */
  1051. /* RF_DBG(dm,DBG_RF_TX_PWR_TRACK, */
  1052. /* "Temperature Decreasing: delta_pi: %d, delta_t: %d, Now_t: %d, EFUSE_t: %d, Last_t: %d\n", */
  1053. /* dm->rf_calibrate_info.power_index_offset, delta, thermal_value, hal_data->eeprom_thermal_meter, dm->rf_calibrate_info.thermal_value); */
  1054. }
  1055. if (thermal_value > dm->priv->pmib->dot11RFEntry.ther)
  1056. {
  1057. /* RF_DBG(dm,DBG_RF_TX_PWR_TRACK,"Temperature(%d) hugher than PG value(%d), increases the power by tx_agc\n", thermal_value, hal_data->eeprom_thermal_meter); */
  1058. (*c.odm_tx_pwr_track_set_pwr)(dm, TXAGC, 0, 0);
  1059. } else {
  1060. /* RF_DBG(dm,DBG_RF_TX_PWR_TRACK,"Temperature(%d) lower than PG value(%d), increases the power by tx_agc\n", thermal_value, hal_data->eeprom_thermal_meter); */
  1061. (*c.odm_tx_pwr_track_set_pwr)(dm, BBSWING, RF_PATH_A, indexforchannel);
  1062. if (is2T)
  1063. (*c.odm_tx_pwr_track_set_pwr)(dm, BBSWING, RF_PATH_B, indexforchannel);
  1064. }
  1065. cali_info->bb_swing_idx_cck_base = cali_info->bb_swing_idx_cck;
  1066. cali_info->bb_swing_idx_ofdm_base = cali_info->bb_swing_idx_ofdm[RF_PATH_A];
  1067. dm->rf_calibrate_info.thermal_value = thermal_value;
  1068. }
  1069. RF_DBG(dm, DBG_RF_TX_PWR_TRACK, "<===dm_TXPowerTrackingCallback_ThermalMeter_8188E\n");
  1070. dm->rf_calibrate_info.tx_powercount = 0;
  1071. }
  1072. /* 3============================================================
  1073. * 3 IQ Calibration
  1074. * 3============================================================ */
  1075. void
  1076. odm_reset_iqk_result(
  1077. void *dm_void
  1078. )
  1079. {
  1080. return;
  1081. }
  1082. #if 1/* !(DM_ODM_SUPPORT_TYPE & ODM_AP) */
  1083. u8 odm_get_right_chnl_place_for_iqk(u8 chnl)
  1084. {
  1085. u8 channel_all[ODM_TARGET_CHNL_NUM_2G_5G] = {
  1086. 1, 2, 3, 4, 5, 6, 7, 8, 9, 10, 11, 12, 13, 14, 36, 38, 40, 42, 44, 46, 48, 50, 52, 54, 56, 58, 60, 62, 64, 100, 102, 104, 106, 108, 110, 112, 114, 116, 118, 120, 122, 124, 126, 128, 130, 132, 134, 136, 138, 140, 149, 151, 153, 155, 157, 159, 161, 163, 165
  1087. };
  1088. u8 place = chnl;
  1089. if (chnl > 14) {
  1090. for (place = 14; place < sizeof(channel_all); place++) {
  1091. if (channel_all[place] == chnl)
  1092. return place - 13;
  1093. }
  1094. }
  1095. return 0;
  1096. }
  1097. #endif
  1098. void
  1099. odm_iq_calibrate(
  1100. struct dm_struct *dm
  1101. )
  1102. {
  1103. struct dm_iqk_info *iqk_info = &dm->IQK_info;
  1104. if ((dm->is_linked) && (!iqk_info->rfk_forbidden)) {
  1105. if ((*dm->channel != dm->pre_channel) && (!*dm->is_scan_in_process)) {
  1106. dm->pre_channel = *dm->channel;
  1107. dm->linked_interval = 0;
  1108. }
  1109. if (dm->linked_interval < 3)
  1110. dm->linked_interval++;
  1111. if (dm->linked_interval == 2)
  1112. halrf_iqk_trigger(dm, false);
  1113. } else
  1114. dm->linked_interval = 0;
  1115. }
  1116. void phydm_rf_init(void *dm_void)
  1117. {
  1118. struct dm_struct *dm = (struct dm_struct *)dm_void;
  1119. odm_txpowertracking_init(dm);
  1120. #if (DM_ODM_SUPPORT_TYPE & (ODM_AP))
  1121. #if (RTL8814A_SUPPORT == 1)
  1122. if (dm->support_ic_type & ODM_RTL8814A)
  1123. phy_iq_calibrate_8814a_init(dm);
  1124. #endif
  1125. #endif
  1126. }
  1127. void phydm_rf_watchdog(void *dm_void)
  1128. {
  1129. struct dm_struct *dm = (struct dm_struct *)dm_void;
  1130. #if (DM_ODM_SUPPORT_TYPE & (ODM_WIN | ODM_CE))
  1131. odm_txpowertracking_check(dm);
  1132. if (dm->support_ic_type & ODM_IC_11AC_SERIES)
  1133. odm_iq_calibrate(dm);
  1134. #endif
  1135. }