phy_common.c 59 KB

123456789101112131415161718192021222324252627282930313233343536373839404142434445464748495051525354555657585960616263646566676869707172737475767778798081828384858687888990919293949596979899100101102103104105106107108109110111112113114115116117118119120121122123124125126127128129130131132133134135136137138139140141142143144145146147148149150151152153154155156157158159160161162163164165166167168169170171172173174175176177178179180181182183184185186187188189190191192193194195196197198199200201202203204205206207208209210211212213214215216217218219220221222223224225226227228229230231232233234235236237238239240241242243244245246247248249250251252253254255256257258259260261262263264265266267268269270271272273274275276277278279280281282283284285286287288289290291292293294295296297298299300301302303304305306307308309310311312313314315316317318319320321322323324325326327328329330331332333334335336337338339340341342343344345346347348349350351352353354355356357358359360361362363364365366367368369370371372373374375376377378379380381382383384385386387388389390391392393394395396397398399400401402403404405406407408409410411412413414415416417418419420421422423424425426427428429430431432433434435436437438439440441442443444445446447448449450451452453454455456457458459460461462463464465466467468469470471472473474475476477478479480481482483484485486487488489490491492493494495496497498499500501502503504505506507508509510511512513514515516517518519520521522523524525526527528529530531532533534535536537538539540541542543544545546547548549550551552553554555556557558559560561562563564565566567568569570571572573574575576577578579580581582583584585586587588589590591592593594595596597598599600601602603604605606607608609610611612613614615616617618619620621622623624625626627628629630631632633634635636637638639640641642643644645646647648649650651652653654655656657658659660661662663664665666667668669670671672673674675676677678679680681682683684685686687688689690691692693694695696697698699700701702703704705706707708709710711712713714715716717718719720721722723724725726727728729730731732733734735736737738739740741742743744745746747748749750751752753754755756757758759760761762763764765766767768769770771772773774775776777778779780781782783784785786787788789790791792793794795796797798799800801802803804805806807808809810811812813814815816817818819820821822823824825826827828829830831832833834835836837838839840841842843844845846847848849850851852853854855856857858859860861862863864865866867868869870871872873874875876877878879880881882883884885886887888889890891892893894895896897898899900901902903904905906907908909910911912913914915916917918919920921922923924925926927928929930931932933934935936937938939940941942943944945946947948949950951952953954955956957958959960961962963964965966967968969970971972973974975976977978979980981982983984985986987988989990991992993994995996997998999100010011002100310041005100610071008100910101011101210131014101510161017101810191020102110221023102410251026102710281029103010311032103310341035103610371038103910401041104210431044104510461047104810491050105110521053105410551056105710581059106010611062106310641065106610671068106910701071107210731074107510761077107810791080108110821083108410851086108710881089109010911092109310941095109610971098109911001101110211031104110511061107110811091110111111121113111411151116111711181119112011211122112311241125112611271128112911301131113211331134113511361137113811391140114111421143114411451146114711481149115011511152115311541155115611571158115911601161116211631164116511661167116811691170117111721173117411751176117711781179118011811182118311841185118611871188118911901191119211931194119511961197119811991200120112021203120412051206120712081209121012111212121312141215121612171218121912201221122212231224122512261227122812291230123112321233123412351236123712381239124012411242124312441245124612471248124912501251125212531254125512561257125812591260126112621263126412651266126712681269127012711272127312741275127612771278127912801281128212831284128512861287128812891290129112921293129412951296129712981299130013011302130313041305130613071308130913101311131213131314131513161317131813191320132113221323132413251326132713281329133013311332133313341335133613371338133913401341134213431344134513461347134813491350135113521353135413551356135713581359136013611362136313641365136613671368136913701371137213731374137513761377137813791380138113821383138413851386138713881389139013911392139313941395139613971398139914001401140214031404140514061407140814091410141114121413141414151416141714181419142014211422142314241425142614271428142914301431143214331434143514361437143814391440144114421443144414451446144714481449145014511452145314541455145614571458145914601461146214631464146514661467146814691470147114721473147414751476147714781479148014811482148314841485148614871488148914901491149214931494149514961497149814991500150115021503150415051506150715081509151015111512151315141515151615171518151915201521152215231524152515261527152815291530153115321533153415351536153715381539154015411542154315441545154615471548154915501551155215531554155515561557155815591560156115621563156415651566156715681569157015711572157315741575157615771578157915801581158215831584158515861587158815891590159115921593159415951596159715981599160016011602160316041605160616071608160916101611161216131614161516161617161816191620162116221623162416251626162716281629163016311632163316341635163616371638163916401641164216431644164516461647164816491650165116521653165416551656165716581659166016611662166316641665166616671668166916701671167216731674167516761677167816791680168116821683168416851686168716881689169016911692169316941695169616971698169917001701170217031704170517061707170817091710171117121713171417151716171717181719172017211722172317241725172617271728172917301731173217331734173517361737173817391740174117421743174417451746174717481749175017511752175317541755175617571758175917601761176217631764176517661767176817691770177117721773177417751776177717781779178017811782178317841785178617871788178917901791179217931794179517961797179817991800180118021803180418051806180718081809181018111812181318141815181618171818181918201821182218231824182518261827182818291830183118321833183418351836183718381839184018411842184318441845184618471848184918501851185218531854185518561857185818591860186118621863186418651866186718681869187018711872187318741875187618771878187918801881188218831884188518861887188818891890189118921893189418951896189718981899190019011902190319041905190619071908190919101911191219131914191519161917191819191920192119221923192419251926192719281929193019311932193319341935193619371938193919401941194219431944194519461947194819491950195119521953195419551956195719581959196019611962196319641965196619671968196919701971197219731974197519761977197819791980198119821983198419851986198719881989199019911992199319941995199619971998199920002001200220032004200520062007200820092010201120122013201420152016201720182019202020212022202320242025202620272028202920302031203220332034203520362037203820392040204120422043204420452046204720482049
  1. /******************************************************************************
  2. *
  3. * Copyright(c) 2009-2010 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. * You should have received a copy of the GNU General Public License along with
  15. * this program; if not, write to the Free Software Foundation, Inc.,
  16. * 51 Franklin Street, Fifth Floor, Boston, MA 02110, USA
  17. *
  18. * The full GNU General Public License is included in this distribution in the
  19. * file called LICENSE.
  20. *
  21. * Contact Information:
  22. * wlanfae <wlanfae@realtek.com>
  23. * Realtek Corporation, No. 2, Innovation Road II, Hsinchu Science Park,
  24. * Hsinchu 300, Taiwan.
  25. *
  26. * Larry Finger <Larry.Finger@lwfinger.net>
  27. *
  28. *****************************************************************************/
  29. /* Define macro to shorten lines */
  30. #define MCS_TXPWR mcs_txpwrlevel_origoffset
  31. static u32 _rtl92c_phy_fw_rf_serial_read(struct ieee80211_hw *hw,
  32. enum radio_path rfpath, u32 offset);
  33. static void _rtl92c_phy_fw_rf_serial_write(struct ieee80211_hw *hw,
  34. enum radio_path rfpath, u32 offset,
  35. u32 data);
  36. static u32 _rtl92c_phy_rf_serial_read(struct ieee80211_hw *hw,
  37. enum radio_path rfpath, u32 offset);
  38. static void _rtl92c_phy_rf_serial_write(struct ieee80211_hw *hw,
  39. enum radio_path rfpath, u32 offset,
  40. u32 data);
  41. static u32 _rtl92c_phy_calculate_bit_shift(u32 bitmask);
  42. static bool _rtl92c_phy_bb8192c_config_parafile(struct ieee80211_hw *hw);
  43. static bool _rtl92c_phy_config_mac_with_headerfile(struct ieee80211_hw *hw);
  44. static bool _rtl92c_phy_config_bb_with_headerfile(struct ieee80211_hw *hw,
  45. u8 configtype);
  46. static bool _rtl92c_phy_config_bb_with_pgheaderfile(struct ieee80211_hw *hw,
  47. u8 configtype);
  48. static void _rtl92c_phy_init_bb_rf_register_definition(struct ieee80211_hw *hw);
  49. static bool _rtl92c_phy_set_sw_chnl_cmdarray(struct swchnlcmd *cmdtable,
  50. u32 cmdtableidx, u32 cmdtablesz,
  51. enum swchnlcmd_id cmdid, u32 para1,
  52. u32 para2, u32 msdelay);
  53. static bool _rtl92c_phy_sw_chnl_step_by_step(struct ieee80211_hw *hw,
  54. u8 channel, u8 *stage, u8 *step,
  55. u32 *delay);
  56. static u8 _rtl92c_phy_dbm_to_txpwr_Idx(struct ieee80211_hw *hw,
  57. enum wireless_mode wirelessmode,
  58. long power_indbm);
  59. static bool _rtl92c_phy_config_rf_external_pa(struct ieee80211_hw *hw,
  60. enum radio_path rfpath);
  61. static long _rtl92c_phy_txpwr_idx_to_dbm(struct ieee80211_hw *hw,
  62. enum wireless_mode wirelessmode,
  63. u8 txpwridx);
  64. static void _rtl92c_phy_lc_calibrate(struct ieee80211_hw *hw, bool is2t);
  65. u32 rtl92c_phy_query_bb_reg(struct ieee80211_hw *hw, u32 regaddr, u32 bitmask)
  66. {
  67. struct rtl_priv *rtlpriv = rtl_priv(hw);
  68. u32 returnvalue, originalvalue, bitshift;
  69. RT_TRACE(rtlpriv, COMP_RF, DBG_TRACE, ("regaddr(%#x), "
  70. "bitmask(%#x)\n", regaddr,
  71. bitmask));
  72. originalvalue = rtl_read_dword(rtlpriv, regaddr);
  73. bitshift = _rtl92c_phy_calculate_bit_shift(bitmask);
  74. returnvalue = (originalvalue & bitmask) >> bitshift;
  75. RT_TRACE(rtlpriv, COMP_RF, DBG_TRACE, ("BBR MASK=0x%x "
  76. "Addr[0x%x]=0x%x\n", bitmask,
  77. regaddr, originalvalue));
  78. return returnvalue;
  79. }
  80. void rtl92c_phy_set_bb_reg(struct ieee80211_hw *hw,
  81. u32 regaddr, u32 bitmask, u32 data)
  82. {
  83. struct rtl_priv *rtlpriv = rtl_priv(hw);
  84. u32 originalvalue, bitshift;
  85. RT_TRACE(rtlpriv, COMP_RF, DBG_TRACE, ("regaddr(%#x), bitmask(%#x),"
  86. " data(%#x)\n", regaddr, bitmask,
  87. data));
  88. if (bitmask != MASKDWORD) {
  89. originalvalue = rtl_read_dword(rtlpriv, regaddr);
  90. bitshift = _rtl92c_phy_calculate_bit_shift(bitmask);
  91. data = ((originalvalue & (~bitmask)) | (data << bitshift));
  92. }
  93. rtl_write_dword(rtlpriv, regaddr, data);
  94. RT_TRACE(rtlpriv, COMP_RF, DBG_TRACE, ("regaddr(%#x), bitmask(%#x),"
  95. " data(%#x)\n", regaddr, bitmask,
  96. data));
  97. }
  98. static u32 _rtl92c_phy_fw_rf_serial_read(struct ieee80211_hw *hw,
  99. enum radio_path rfpath, u32 offset)
  100. {
  101. RT_ASSERT(false, ("deprecated!\n"));
  102. return 0;
  103. }
  104. static void _rtl92c_phy_fw_rf_serial_write(struct ieee80211_hw *hw,
  105. enum radio_path rfpath, u32 offset,
  106. u32 data)
  107. {
  108. RT_ASSERT(false, ("deprecated!\n"));
  109. }
  110. static u32 _rtl92c_phy_rf_serial_read(struct ieee80211_hw *hw,
  111. enum radio_path rfpath, u32 offset)
  112. {
  113. struct rtl_priv *rtlpriv = rtl_priv(hw);
  114. struct rtl_phy *rtlphy = &(rtlpriv->phy);
  115. struct bb_reg_def *pphyreg = &rtlphy->phyreg_def[rfpath];
  116. u32 newoffset;
  117. u32 tmplong, tmplong2;
  118. u8 rfpi_enable = 0;
  119. u32 retvalue;
  120. offset &= 0x3f;
  121. newoffset = offset;
  122. if (RT_CANNOT_IO(hw)) {
  123. RT_TRACE(rtlpriv, COMP_ERR, DBG_EMERG, ("return all one\n"));
  124. return 0xFFFFFFFF;
  125. }
  126. tmplong = rtl_get_bbreg(hw, RFPGA0_XA_HSSIPARAMETER2, MASKDWORD);
  127. if (rfpath == RF90_PATH_A)
  128. tmplong2 = tmplong;
  129. else
  130. tmplong2 = rtl_get_bbreg(hw, pphyreg->rfhssi_para2, MASKDWORD);
  131. tmplong2 = (tmplong2 & (~BLSSIREADADDRESS)) |
  132. (newoffset << 23) | BLSSIREADEDGE;
  133. rtl_set_bbreg(hw, RFPGA0_XA_HSSIPARAMETER2, MASKDWORD,
  134. tmplong & (~BLSSIREADEDGE));
  135. mdelay(1);
  136. rtl_set_bbreg(hw, pphyreg->rfhssi_para2, MASKDWORD, tmplong2);
  137. mdelay(1);
  138. rtl_set_bbreg(hw, RFPGA0_XA_HSSIPARAMETER2, MASKDWORD,
  139. tmplong | BLSSIREADEDGE);
  140. mdelay(1);
  141. if (rfpath == RF90_PATH_A)
  142. rfpi_enable = (u8) rtl_get_bbreg(hw, RFPGA0_XA_HSSIPARAMETER1,
  143. BIT(8));
  144. else if (rfpath == RF90_PATH_B)
  145. rfpi_enable = (u8) rtl_get_bbreg(hw, RFPGA0_XB_HSSIPARAMETER1,
  146. BIT(8));
  147. if (rfpi_enable)
  148. retvalue = rtl_get_bbreg(hw, pphyreg->rflssi_readbackpi,
  149. BLSSIREADBACKDATA);
  150. else
  151. retvalue = rtl_get_bbreg(hw, pphyreg->rflssi_readback,
  152. BLSSIREADBACKDATA);
  153. RT_TRACE(rtlpriv, COMP_RF, DBG_TRACE, ("RFR-%d Addr[0x%x]=0x%x\n",
  154. rfpath, pphyreg->rflssi_readback,
  155. retvalue));
  156. return retvalue;
  157. }
  158. static void _rtl92c_phy_rf_serial_write(struct ieee80211_hw *hw,
  159. enum radio_path rfpath, u32 offset,
  160. u32 data)
  161. {
  162. u32 data_and_addr;
  163. u32 newoffset;
  164. struct rtl_priv *rtlpriv = rtl_priv(hw);
  165. struct rtl_phy *rtlphy = &(rtlpriv->phy);
  166. struct bb_reg_def *pphyreg = &rtlphy->phyreg_def[rfpath];
  167. if (RT_CANNOT_IO(hw)) {
  168. RT_TRACE(rtlpriv, COMP_ERR, DBG_EMERG, ("stop\n"));
  169. return;
  170. }
  171. offset &= 0x3f;
  172. newoffset = offset;
  173. data_and_addr = ((newoffset << 20) | (data & 0x000fffff)) & 0x0fffffff;
  174. rtl_set_bbreg(hw, pphyreg->rf3wire_offset, MASKDWORD, data_and_addr);
  175. RT_TRACE(rtlpriv, COMP_RF, DBG_TRACE, ("RFW-%d Addr[0x%x]=0x%x\n",
  176. rfpath, pphyreg->rf3wire_offset,
  177. data_and_addr));
  178. }
  179. static u32 _rtl92c_phy_calculate_bit_shift(u32 bitmask)
  180. {
  181. u32 i;
  182. for (i = 0; i <= 31; i++) {
  183. if (((bitmask >> i) & 0x1) == 1)
  184. break;
  185. }
  186. return i;
  187. }
  188. static void _rtl92c_phy_bb_config_1t(struct ieee80211_hw *hw)
  189. {
  190. rtl_set_bbreg(hw, RFPGA0_TXINFO, 0x3, 0x2);
  191. rtl_set_bbreg(hw, RFPGA1_TXINFO, 0x300033, 0x200022);
  192. rtl_set_bbreg(hw, RCCK0_AFESETTING, MASKBYTE3, 0x45);
  193. rtl_set_bbreg(hw, ROFDM0_TRXPATHENABLE, MASKBYTE0, 0x23);
  194. rtl_set_bbreg(hw, ROFDM0_AGCPARAMETER1, 0x30, 0x1);
  195. rtl_set_bbreg(hw, 0xe74, 0x0c000000, 0x2);
  196. rtl_set_bbreg(hw, 0xe78, 0x0c000000, 0x2);
  197. rtl_set_bbreg(hw, 0xe7c, 0x0c000000, 0x2);
  198. rtl_set_bbreg(hw, 0xe80, 0x0c000000, 0x2);
  199. rtl_set_bbreg(hw, 0xe88, 0x0c000000, 0x2);
  200. }
  201. bool rtl92c_phy_rf_config(struct ieee80211_hw *hw)
  202. {
  203. return rtl92c_phy_rf6052_config(hw);
  204. }
  205. static bool _rtl92c_phy_bb8192c_config_parafile(struct ieee80211_hw *hw)
  206. {
  207. struct rtl_priv *rtlpriv = rtl_priv(hw);
  208. struct rtl_phy *rtlphy = &(rtlpriv->phy);
  209. struct rtl_efuse *rtlefuse = rtl_efuse(rtl_priv(hw));
  210. bool rtstatus;
  211. RT_TRACE(rtlpriv, COMP_INIT, DBG_TRACE, ("==>\n"));
  212. rtstatus = _rtl92c_phy_config_bb_with_headerfile(hw,
  213. BASEBAND_CONFIG_PHY_REG);
  214. if (rtstatus != true) {
  215. RT_TRACE(rtlpriv, COMP_ERR, DBG_EMERG, ("Write BB Reg Fail!!"));
  216. return false;
  217. }
  218. if (rtlphy->rf_type == RF_1T2R) {
  219. _rtl92c_phy_bb_config_1t(hw);
  220. RT_TRACE(rtlpriv, COMP_INIT, DBG_TRACE, ("Config to 1T!!\n"));
  221. }
  222. if (rtlefuse->autoload_failflag == false) {
  223. rtlphy->pwrgroup_cnt = 0;
  224. rtstatus = _rtl92c_phy_config_bb_with_pgheaderfile(hw,
  225. BASEBAND_CONFIG_PHY_REG);
  226. }
  227. if (rtstatus != true) {
  228. RT_TRACE(rtlpriv, COMP_ERR, DBG_EMERG, ("BB_PG Reg Fail!!"));
  229. return false;
  230. }
  231. rtstatus = _rtl92c_phy_config_bb_with_headerfile(hw,
  232. BASEBAND_CONFIG_AGC_TAB);
  233. if (rtstatus != true) {
  234. RT_TRACE(rtlpriv, COMP_ERR, DBG_EMERG, ("AGC Table Fail\n"));
  235. return false;
  236. }
  237. rtlphy->cck_high_power = (bool) (rtl_get_bbreg(hw,
  238. RFPGA0_XA_HSSIPARAMETER2,
  239. 0x200));
  240. return true;
  241. }
  242. void rtl92c_phy_config_bb_external_pa(struct ieee80211_hw *hw)
  243. {
  244. }
  245. static void _rtl92c_store_pwrIndex_diffrate_offset(struct ieee80211_hw *hw,
  246. u32 regaddr, u32 bitmask,
  247. u32 data)
  248. {
  249. struct rtl_priv *rtlpriv = rtl_priv(hw);
  250. struct rtl_phy *rtlphy = &(rtlpriv->phy);
  251. if (regaddr == RTXAGC_A_RATE18_06) {
  252. rtlphy->MCS_TXPWR[rtlphy->pwrgroup_cnt][0] = data;
  253. RT_TRACE(rtlpriv, COMP_INIT, DBG_TRACE,
  254. ("MCSTxPowerLevelOriginalOffset[%d][0] = 0x%x\n",
  255. rtlphy->pwrgroup_cnt,
  256. rtlphy->MCS_TXPWR[rtlphy->pwrgroup_cnt][0]));
  257. }
  258. if (regaddr == RTXAGC_A_RATE54_24) {
  259. rtlphy->MCS_TXPWR[rtlphy->pwrgroup_cnt][1] = data;
  260. RT_TRACE(rtlpriv, COMP_INIT, DBG_TRACE,
  261. ("MCSTxPowerLevelOriginalOffset[%d][1] = 0x%x\n",
  262. rtlphy->pwrgroup_cnt,
  263. rtlphy->MCS_TXPWR[rtlphy->pwrgroup_cnt][1]));
  264. }
  265. if (regaddr == RTXAGC_A_CCK1_MCS32) {
  266. rtlphy->MCS_TXPWR[rtlphy->pwrgroup_cnt][6] = data;
  267. RT_TRACE(rtlpriv, COMP_INIT, DBG_TRACE,
  268. ("MCSTxPowerLevelOriginalOffset[%d][6] = 0x%x\n",
  269. rtlphy->pwrgroup_cnt,
  270. rtlphy->MCS_TXPWR[rtlphy->pwrgroup_cnt][6]));
  271. }
  272. if (regaddr == RTXAGC_B_CCK11_A_CCK2_11 && bitmask == 0xffffff00) {
  273. rtlphy->MCS_TXPWR[rtlphy->pwrgroup_cnt][7] = data;
  274. RT_TRACE(rtlpriv, COMP_INIT, DBG_TRACE,
  275. ("MCSTxPowerLevelOriginalOffset[%d][7] = 0x%x\n",
  276. rtlphy->pwrgroup_cnt,
  277. rtlphy->MCS_TXPWR[rtlphy->pwrgroup_cnt][7]));
  278. }
  279. if (regaddr == RTXAGC_A_MCS03_MCS00) {
  280. rtlphy->MCS_TXPWR[rtlphy->pwrgroup_cnt][2] = data;
  281. RT_TRACE(rtlpriv, COMP_INIT, DBG_TRACE,
  282. ("MCSTxPowerLevelOriginalOffset[%d][2] = 0x%x\n",
  283. rtlphy->pwrgroup_cnt,
  284. rtlphy->MCS_TXPWR[rtlphy->pwrgroup_cnt][2]));
  285. }
  286. if (regaddr == RTXAGC_A_MCS07_MCS04) {
  287. rtlphy->MCS_TXPWR[rtlphy->pwrgroup_cnt][3] = data;
  288. RT_TRACE(rtlpriv, COMP_INIT, DBG_TRACE,
  289. ("MCSTxPowerLevelOriginalOffset[%d][3] = 0x%x\n",
  290. rtlphy->pwrgroup_cnt,
  291. rtlphy->MCS_TXPWR[rtlphy->pwrgroup_cnt][3]));
  292. }
  293. if (regaddr == RTXAGC_A_MCS11_MCS08) {
  294. rtlphy->MCS_TXPWR[rtlphy->pwrgroup_cnt][4] = data;
  295. RT_TRACE(rtlpriv, COMP_INIT, DBG_TRACE,
  296. ("MCSTxPowerLevelOriginalOffset[%d][4] = 0x%x\n",
  297. rtlphy->pwrgroup_cnt,
  298. rtlphy->MCS_TXPWR[rtlphy->pwrgroup_cnt][4]));
  299. }
  300. if (regaddr == RTXAGC_A_MCS15_MCS12) {
  301. rtlphy->MCS_TXPWR[rtlphy->pwrgroup_cnt][5] = data;
  302. RT_TRACE(rtlpriv, COMP_INIT, DBG_TRACE,
  303. ("MCSTxPowerLevelOriginalOffset[%d][5] = 0x%x\n",
  304. rtlphy->pwrgroup_cnt,
  305. rtlphy->MCS_TXPWR[rtlphy->pwrgroup_cnt][5]));
  306. }
  307. if (regaddr == RTXAGC_B_RATE18_06) {
  308. rtlphy->MCS_TXPWR[rtlphy->pwrgroup_cnt][8] = data;
  309. RT_TRACE(rtlpriv, COMP_INIT, DBG_TRACE,
  310. ("MCSTxPowerLevelOriginalOffset[%d][8] = 0x%x\n",
  311. rtlphy->pwrgroup_cnt,
  312. rtlphy->MCS_TXPWR[rtlphy->pwrgroup_cnt][8]));
  313. }
  314. if (regaddr == RTXAGC_B_RATE54_24) {
  315. rtlphy->MCS_TXPWR[rtlphy->pwrgroup_cnt][9] = data;
  316. RT_TRACE(rtlpriv, COMP_INIT, DBG_TRACE,
  317. ("MCSTxPowerLevelOriginalOffset[%d][9] = 0x%x\n",
  318. rtlphy->pwrgroup_cnt,
  319. rtlphy->MCS_TXPWR[rtlphy->pwrgroup_cnt][9]));
  320. }
  321. if (regaddr == RTXAGC_B_CCK1_55_MCS32) {
  322. rtlphy->MCS_TXPWR[rtlphy->pwrgroup_cnt][14] = data;
  323. RT_TRACE(rtlpriv, COMP_INIT, DBG_TRACE,
  324. ("MCSTxPowerLevelOriginalOffset[%d][14] = 0x%x\n",
  325. rtlphy->pwrgroup_cnt,
  326. rtlphy->MCS_TXPWR[rtlphy->pwrgroup_cnt][14]));
  327. }
  328. if (regaddr == RTXAGC_B_CCK11_A_CCK2_11 && bitmask == 0x000000ff) {
  329. rtlphy->MCS_TXPWR[rtlphy->pwrgroup_cnt][15] = data;
  330. RT_TRACE(rtlpriv, COMP_INIT, DBG_TRACE,
  331. ("MCSTxPowerLevelOriginalOffset[%d][15] = 0x%x\n",
  332. rtlphy->pwrgroup_cnt,
  333. rtlphy->MCS_TXPWR[rtlphy->pwrgroup_cnt][15]));
  334. }
  335. if (regaddr == RTXAGC_B_MCS03_MCS00) {
  336. rtlphy->MCS_TXPWR[rtlphy->pwrgroup_cnt][10] = data;
  337. RT_TRACE(rtlpriv, COMP_INIT, DBG_TRACE,
  338. ("MCSTxPowerLevelOriginalOffset[%d][10] = 0x%x\n",
  339. rtlphy->pwrgroup_cnt,
  340. rtlphy->MCS_TXPWR[rtlphy->pwrgroup_cnt][10]));
  341. }
  342. if (regaddr == RTXAGC_B_MCS07_MCS04) {
  343. rtlphy->MCS_TXPWR[rtlphy->pwrgroup_cnt][11] = data;
  344. RT_TRACE(rtlpriv, COMP_INIT, DBG_TRACE,
  345. ("MCSTxPowerLevelOriginalOffset[%d][11] = 0x%x\n",
  346. rtlphy->pwrgroup_cnt,
  347. rtlphy->MCS_TXPWR[rtlphy->pwrgroup_cnt][11]));
  348. }
  349. if (regaddr == RTXAGC_B_MCS11_MCS08) {
  350. rtlphy->MCS_TXPWR[rtlphy->pwrgroup_cnt][12] = data;
  351. RT_TRACE(rtlpriv, COMP_INIT, DBG_TRACE,
  352. ("MCSTxPowerLevelOriginalOffset[%d][12] = 0x%x\n",
  353. rtlphy->pwrgroup_cnt,
  354. rtlphy->MCS_TXPWR[rtlphy->pwrgroup_cnt][12]));
  355. }
  356. if (regaddr == RTXAGC_B_MCS15_MCS12) {
  357. rtlphy->MCS_TXPWR[rtlphy->pwrgroup_cnt][13] = data;
  358. RT_TRACE(rtlpriv, COMP_INIT, DBG_TRACE,
  359. ("MCSTxPowerLevelOriginalOffset[%d][13] = 0x%x\n",
  360. rtlphy->pwrgroup_cnt,
  361. rtlphy->MCS_TXPWR[rtlphy->pwrgroup_cnt][13]));
  362. rtlphy->pwrgroup_cnt++;
  363. }
  364. }
  365. static bool _rtl92c_phy_config_rf_external_pa(struct ieee80211_hw *hw,
  366. enum radio_path rfpath)
  367. {
  368. return true;
  369. }
  370. void rtl92c_phy_get_hw_reg_originalvalue(struct ieee80211_hw *hw)
  371. {
  372. struct rtl_priv *rtlpriv = rtl_priv(hw);
  373. struct rtl_phy *rtlphy = &(rtlpriv->phy);
  374. rtlphy->default_initialgain[0] =
  375. (u8) rtl_get_bbreg(hw, ROFDM0_XAAGCCORE1, MASKBYTE0);
  376. rtlphy->default_initialgain[1] =
  377. (u8) rtl_get_bbreg(hw, ROFDM0_XBAGCCORE1, MASKBYTE0);
  378. rtlphy->default_initialgain[2] =
  379. (u8) rtl_get_bbreg(hw, ROFDM0_XCAGCCORE1, MASKBYTE0);
  380. rtlphy->default_initialgain[3] =
  381. (u8) rtl_get_bbreg(hw, ROFDM0_XDAGCCORE1, MASKBYTE0);
  382. RT_TRACE(rtlpriv, COMP_INIT, DBG_TRACE,
  383. ("Default initial gain (c50=0x%x, "
  384. "c58=0x%x, c60=0x%x, c68=0x%x\n",
  385. rtlphy->default_initialgain[0],
  386. rtlphy->default_initialgain[1],
  387. rtlphy->default_initialgain[2],
  388. rtlphy->default_initialgain[3]));
  389. rtlphy->framesync = (u8) rtl_get_bbreg(hw,
  390. ROFDM0_RXDETECTOR3, MASKBYTE0);
  391. rtlphy->framesync_c34 = rtl_get_bbreg(hw,
  392. ROFDM0_RXDETECTOR2, MASKDWORD);
  393. RT_TRACE(rtlpriv, COMP_INIT, DBG_TRACE,
  394. ("Default framesync (0x%x) = 0x%x\n",
  395. ROFDM0_RXDETECTOR3, rtlphy->framesync));
  396. }
  397. static void _rtl92c_phy_init_bb_rf_register_definition(struct ieee80211_hw *hw)
  398. {
  399. struct rtl_priv *rtlpriv = rtl_priv(hw);
  400. struct rtl_phy *rtlphy = &(rtlpriv->phy);
  401. rtlphy->phyreg_def[RF90_PATH_A].rfintfs = RFPGA0_XAB_RFINTERFACESW;
  402. rtlphy->phyreg_def[RF90_PATH_B].rfintfs = RFPGA0_XAB_RFINTERFACESW;
  403. rtlphy->phyreg_def[RF90_PATH_C].rfintfs = RFPGA0_XCD_RFINTERFACESW;
  404. rtlphy->phyreg_def[RF90_PATH_D].rfintfs = RFPGA0_XCD_RFINTERFACESW;
  405. rtlphy->phyreg_def[RF90_PATH_A].rfintfi = RFPGA0_XAB_RFINTERFACERB;
  406. rtlphy->phyreg_def[RF90_PATH_B].rfintfi = RFPGA0_XAB_RFINTERFACERB;
  407. rtlphy->phyreg_def[RF90_PATH_C].rfintfi = RFPGA0_XCD_RFINTERFACERB;
  408. rtlphy->phyreg_def[RF90_PATH_D].rfintfi = RFPGA0_XCD_RFINTERFACERB;
  409. rtlphy->phyreg_def[RF90_PATH_A].rfintfo = RFPGA0_XA_RFINTERFACEOE;
  410. rtlphy->phyreg_def[RF90_PATH_B].rfintfo = RFPGA0_XB_RFINTERFACEOE;
  411. rtlphy->phyreg_def[RF90_PATH_A].rfintfe = RFPGA0_XA_RFINTERFACEOE;
  412. rtlphy->phyreg_def[RF90_PATH_B].rfintfe = RFPGA0_XB_RFINTERFACEOE;
  413. rtlphy->phyreg_def[RF90_PATH_A].rf3wire_offset =
  414. RFPGA0_XA_LSSIPARAMETER;
  415. rtlphy->phyreg_def[RF90_PATH_B].rf3wire_offset =
  416. RFPGA0_XB_LSSIPARAMETER;
  417. rtlphy->phyreg_def[RF90_PATH_A].rflssi_select = rFPGA0_XAB_RFPARAMETER;
  418. rtlphy->phyreg_def[RF90_PATH_B].rflssi_select = rFPGA0_XAB_RFPARAMETER;
  419. rtlphy->phyreg_def[RF90_PATH_C].rflssi_select = rFPGA0_XCD_RFPARAMETER;
  420. rtlphy->phyreg_def[RF90_PATH_D].rflssi_select = rFPGA0_XCD_RFPARAMETER;
  421. rtlphy->phyreg_def[RF90_PATH_A].rftxgain_stage = RFPGA0_TXGAINSTAGE;
  422. rtlphy->phyreg_def[RF90_PATH_B].rftxgain_stage = RFPGA0_TXGAINSTAGE;
  423. rtlphy->phyreg_def[RF90_PATH_C].rftxgain_stage = RFPGA0_TXGAINSTAGE;
  424. rtlphy->phyreg_def[RF90_PATH_D].rftxgain_stage = RFPGA0_TXGAINSTAGE;
  425. rtlphy->phyreg_def[RF90_PATH_A].rfhssi_para1 = RFPGA0_XA_HSSIPARAMETER1;
  426. rtlphy->phyreg_def[RF90_PATH_B].rfhssi_para1 = RFPGA0_XB_HSSIPARAMETER1;
  427. rtlphy->phyreg_def[RF90_PATH_A].rfhssi_para2 = RFPGA0_XA_HSSIPARAMETER2;
  428. rtlphy->phyreg_def[RF90_PATH_B].rfhssi_para2 = RFPGA0_XB_HSSIPARAMETER2;
  429. rtlphy->phyreg_def[RF90_PATH_A].rfswitch_control =
  430. RFPGA0_XAB_SWITCHCONTROL;
  431. rtlphy->phyreg_def[RF90_PATH_B].rfswitch_control =
  432. RFPGA0_XAB_SWITCHCONTROL;
  433. rtlphy->phyreg_def[RF90_PATH_C].rfswitch_control =
  434. RFPGA0_XCD_SWITCHCONTROL;
  435. rtlphy->phyreg_def[RF90_PATH_D].rfswitch_control =
  436. RFPGA0_XCD_SWITCHCONTROL;
  437. rtlphy->phyreg_def[RF90_PATH_A].rfagc_control1 = ROFDM0_XAAGCCORE1;
  438. rtlphy->phyreg_def[RF90_PATH_B].rfagc_control1 = ROFDM0_XBAGCCORE1;
  439. rtlphy->phyreg_def[RF90_PATH_C].rfagc_control1 = ROFDM0_XCAGCCORE1;
  440. rtlphy->phyreg_def[RF90_PATH_D].rfagc_control1 = ROFDM0_XDAGCCORE1;
  441. rtlphy->phyreg_def[RF90_PATH_A].rfagc_control2 = ROFDM0_XAAGCCORE2;
  442. rtlphy->phyreg_def[RF90_PATH_B].rfagc_control2 = ROFDM0_XBAGCCORE2;
  443. rtlphy->phyreg_def[RF90_PATH_C].rfagc_control2 = ROFDM0_XCAGCCORE2;
  444. rtlphy->phyreg_def[RF90_PATH_D].rfagc_control2 = ROFDM0_XDAGCCORE2;
  445. rtlphy->phyreg_def[RF90_PATH_A].rfrxiq_imbalance =
  446. ROFDM0_XARXIQIMBALANCE;
  447. rtlphy->phyreg_def[RF90_PATH_B].rfrxiq_imbalance =
  448. ROFDM0_XBRXIQIMBALANCE;
  449. rtlphy->phyreg_def[RF90_PATH_C].rfrxiq_imbalance =
  450. ROFDM0_XCRXIQIMBANLANCE;
  451. rtlphy->phyreg_def[RF90_PATH_D].rfrxiq_imbalance =
  452. ROFDM0_XDRXIQIMBALANCE;
  453. rtlphy->phyreg_def[RF90_PATH_A].rfrx_afe = ROFDM0_XARXAFE;
  454. rtlphy->phyreg_def[RF90_PATH_B].rfrx_afe = ROFDM0_XBRXAFE;
  455. rtlphy->phyreg_def[RF90_PATH_C].rfrx_afe = ROFDM0_XCRXAFE;
  456. rtlphy->phyreg_def[RF90_PATH_D].rfrx_afe = ROFDM0_XDRXAFE;
  457. rtlphy->phyreg_def[RF90_PATH_A].rftxiq_imbalance =
  458. ROFDM0_XATXIQIMBALANCE;
  459. rtlphy->phyreg_def[RF90_PATH_B].rftxiq_imbalance =
  460. ROFDM0_XBTXIQIMBALANCE;
  461. rtlphy->phyreg_def[RF90_PATH_C].rftxiq_imbalance =
  462. ROFDM0_XCTXIQIMBALANCE;
  463. rtlphy->phyreg_def[RF90_PATH_D].rftxiq_imbalance =
  464. ROFDM0_XDTXIQIMBALANCE;
  465. rtlphy->phyreg_def[RF90_PATH_A].rftx_afe = ROFDM0_XATXAFE;
  466. rtlphy->phyreg_def[RF90_PATH_B].rftx_afe = ROFDM0_XBTXAFE;
  467. rtlphy->phyreg_def[RF90_PATH_C].rftx_afe = ROFDM0_XCTXAFE;
  468. rtlphy->phyreg_def[RF90_PATH_D].rftx_afe = ROFDM0_XDTXAFE;
  469. rtlphy->phyreg_def[RF90_PATH_A].rflssi_readback =
  470. RFPGA0_XA_LSSIREADBACK;
  471. rtlphy->phyreg_def[RF90_PATH_B].rflssi_readback =
  472. RFPGA0_XB_LSSIREADBACK;
  473. rtlphy->phyreg_def[RF90_PATH_C].rflssi_readback =
  474. RFPGA0_XC_LSSIREADBACK;
  475. rtlphy->phyreg_def[RF90_PATH_D].rflssi_readback =
  476. RFPGA0_XD_LSSIREADBACK;
  477. rtlphy->phyreg_def[RF90_PATH_A].rflssi_readbackpi =
  478. TRANSCEIVEA_HSPI_READBACK;
  479. rtlphy->phyreg_def[RF90_PATH_B].rflssi_readbackpi =
  480. TRANSCEIVEB_HSPI_READBACK;
  481. }
  482. void rtl92c_phy_get_txpower_level(struct ieee80211_hw *hw, long *powerlevel)
  483. {
  484. struct rtl_priv *rtlpriv = rtl_priv(hw);
  485. struct rtl_phy *rtlphy = &(rtlpriv->phy);
  486. struct rtl_efuse *rtlefuse = rtl_efuse(rtl_priv(hw));
  487. u8 txpwr_level;
  488. long txpwr_dbm;
  489. txpwr_level = rtlphy->cur_cck_txpwridx;
  490. txpwr_dbm = _rtl92c_phy_txpwr_idx_to_dbm(hw,
  491. WIRELESS_MODE_B, txpwr_level);
  492. txpwr_level = rtlphy->cur_ofdm24g_txpwridx +
  493. rtlefuse->legacy_ht_txpowerdiff;
  494. if (_rtl92c_phy_txpwr_idx_to_dbm(hw,
  495. WIRELESS_MODE_G,
  496. txpwr_level) > txpwr_dbm)
  497. txpwr_dbm =
  498. _rtl92c_phy_txpwr_idx_to_dbm(hw, WIRELESS_MODE_G,
  499. txpwr_level);
  500. txpwr_level = rtlphy->cur_ofdm24g_txpwridx;
  501. if (_rtl92c_phy_txpwr_idx_to_dbm(hw,
  502. WIRELESS_MODE_N_24G,
  503. txpwr_level) > txpwr_dbm)
  504. txpwr_dbm =
  505. _rtl92c_phy_txpwr_idx_to_dbm(hw, WIRELESS_MODE_N_24G,
  506. txpwr_level);
  507. *powerlevel = txpwr_dbm;
  508. }
  509. static void _rtl92c_get_txpower_index(struct ieee80211_hw *hw, u8 channel,
  510. u8 *cckpowerlevel, u8 *ofdmpowerlevel)
  511. {
  512. struct rtl_priv *rtlpriv = rtl_priv(hw);
  513. struct rtl_phy *rtlphy = &(rtlpriv->phy);
  514. struct rtl_efuse *rtlefuse = rtl_efuse(rtl_priv(hw));
  515. u8 index = (channel - 1);
  516. cckpowerlevel[RF90_PATH_A] =
  517. rtlefuse->txpwrlevel_cck[RF90_PATH_A][index];
  518. cckpowerlevel[RF90_PATH_B] =
  519. rtlefuse->txpwrlevel_cck[RF90_PATH_B][index];
  520. if (get_rf_type(rtlphy) == RF_1T2R || get_rf_type(rtlphy) == RF_1T1R) {
  521. ofdmpowerlevel[RF90_PATH_A] =
  522. rtlefuse->txpwrlevel_ht40_1s[RF90_PATH_A][index];
  523. ofdmpowerlevel[RF90_PATH_B] =
  524. rtlefuse->txpwrlevel_ht40_1s[RF90_PATH_B][index];
  525. } else if (get_rf_type(rtlphy) == RF_2T2R) {
  526. ofdmpowerlevel[RF90_PATH_A] =
  527. rtlefuse->txpwrlevel_ht40_2s[RF90_PATH_A][index];
  528. ofdmpowerlevel[RF90_PATH_B] =
  529. rtlefuse->txpwrlevel_ht40_2s[RF90_PATH_B][index];
  530. }
  531. }
  532. static void _rtl92c_ccxpower_index_check(struct ieee80211_hw *hw,
  533. u8 channel, u8 *cckpowerlevel,
  534. u8 *ofdmpowerlevel)
  535. {
  536. struct rtl_priv *rtlpriv = rtl_priv(hw);
  537. struct rtl_phy *rtlphy = &(rtlpriv->phy);
  538. rtlphy->cur_cck_txpwridx = cckpowerlevel[0];
  539. rtlphy->cur_ofdm24g_txpwridx = ofdmpowerlevel[0];
  540. }
  541. void rtl92c_phy_set_txpower_level(struct ieee80211_hw *hw, u8 channel)
  542. {
  543. struct rtl_efuse *rtlefuse = rtl_efuse(rtl_priv(hw));
  544. u8 cckpowerlevel[2], ofdmpowerlevel[2];
  545. if (rtlefuse->txpwr_fromeprom == false)
  546. return;
  547. _rtl92c_get_txpower_index(hw, channel,
  548. &cckpowerlevel[0], &ofdmpowerlevel[0]);
  549. _rtl92c_ccxpower_index_check(hw,
  550. channel, &cckpowerlevel[0],
  551. &ofdmpowerlevel[0]);
  552. rtl92c_phy_rf6052_set_cck_txpower(hw, &cckpowerlevel[0]);
  553. rtl92c_phy_rf6052_set_ofdm_txpower(hw, &ofdmpowerlevel[0], channel);
  554. }
  555. bool rtl92c_phy_update_txpower_dbm(struct ieee80211_hw *hw, long power_indbm)
  556. {
  557. struct rtl_priv *rtlpriv = rtl_priv(hw);
  558. struct rtl_phy *rtlphy = &(rtlpriv->phy);
  559. struct rtl_efuse *rtlefuse = rtl_efuse(rtl_priv(hw));
  560. u8 idx;
  561. u8 rf_path;
  562. u8 ccktxpwridx = _rtl92c_phy_dbm_to_txpwr_Idx(hw,
  563. WIRELESS_MODE_B,
  564. power_indbm);
  565. u8 ofdmtxpwridx = _rtl92c_phy_dbm_to_txpwr_Idx(hw,
  566. WIRELESS_MODE_N_24G,
  567. power_indbm);
  568. if (ofdmtxpwridx - rtlefuse->legacy_ht_txpowerdiff > 0)
  569. ofdmtxpwridx -= rtlefuse->legacy_ht_txpowerdiff;
  570. else
  571. ofdmtxpwridx = 0;
  572. RT_TRACE(rtlpriv, COMP_TXAGC, DBG_TRACE,
  573. ("%lx dBm, ccktxpwridx = %d, ofdmtxpwridx = %d\n",
  574. power_indbm, ccktxpwridx, ofdmtxpwridx));
  575. for (idx = 0; idx < 14; idx++) {
  576. for (rf_path = 0; rf_path < 2; rf_path++) {
  577. rtlefuse->txpwrlevel_cck[rf_path][idx] = ccktxpwridx;
  578. rtlefuse->txpwrlevel_ht40_1s[rf_path][idx] =
  579. ofdmtxpwridx;
  580. rtlefuse->txpwrlevel_ht40_2s[rf_path][idx] =
  581. ofdmtxpwridx;
  582. }
  583. }
  584. rtl92c_phy_set_txpower_level(hw, rtlphy->current_channel);
  585. return true;
  586. }
  587. void rtl92c_phy_set_beacon_hw_reg(struct ieee80211_hw *hw, u16 beaconinterval)
  588. {
  589. }
  590. static u8 _rtl92c_phy_dbm_to_txpwr_Idx(struct ieee80211_hw *hw,
  591. enum wireless_mode wirelessmode,
  592. long power_indbm)
  593. {
  594. u8 txpwridx;
  595. long offset;
  596. switch (wirelessmode) {
  597. case WIRELESS_MODE_B:
  598. offset = -7;
  599. break;
  600. case WIRELESS_MODE_G:
  601. case WIRELESS_MODE_N_24G:
  602. offset = -8;
  603. break;
  604. default:
  605. offset = -8;
  606. break;
  607. }
  608. if ((power_indbm - offset) > 0)
  609. txpwridx = (u8) ((power_indbm - offset) * 2);
  610. else
  611. txpwridx = 0;
  612. if (txpwridx > MAX_TXPWR_IDX_NMODE_92S)
  613. txpwridx = MAX_TXPWR_IDX_NMODE_92S;
  614. return txpwridx;
  615. }
  616. static long _rtl92c_phy_txpwr_idx_to_dbm(struct ieee80211_hw *hw,
  617. enum wireless_mode wirelessmode,
  618. u8 txpwridx)
  619. {
  620. long offset;
  621. long pwrout_dbm;
  622. switch (wirelessmode) {
  623. case WIRELESS_MODE_B:
  624. offset = -7;
  625. break;
  626. case WIRELESS_MODE_G:
  627. case WIRELESS_MODE_N_24G:
  628. offset = -8;
  629. break;
  630. default:
  631. offset = -8;
  632. break;
  633. }
  634. pwrout_dbm = txpwridx / 2 + offset;
  635. return pwrout_dbm;
  636. }
  637. void rtl92c_phy_scan_operation_backup(struct ieee80211_hw *hw, u8 operation)
  638. {
  639. struct rtl_priv *rtlpriv = rtl_priv(hw);
  640. struct rtl_hal *rtlhal = rtl_hal(rtl_priv(hw));
  641. enum io_type iotype;
  642. if (!is_hal_stop(rtlhal)) {
  643. switch (operation) {
  644. case SCAN_OPT_BACKUP:
  645. iotype = IO_CMD_PAUSE_DM_BY_SCAN;
  646. rtlpriv->cfg->ops->set_hw_reg(hw,
  647. HW_VAR_IO_CMD,
  648. (u8 *)&iotype);
  649. break;
  650. case SCAN_OPT_RESTORE:
  651. iotype = IO_CMD_RESUME_DM_BY_SCAN;
  652. rtlpriv->cfg->ops->set_hw_reg(hw,
  653. HW_VAR_IO_CMD,
  654. (u8 *)&iotype);
  655. break;
  656. default:
  657. RT_TRACE(rtlpriv, COMP_ERR, DBG_EMERG,
  658. ("Unknown Scan Backup operation.\n"));
  659. break;
  660. }
  661. }
  662. }
  663. void rtl92c_phy_set_bw_mode(struct ieee80211_hw *hw,
  664. enum nl80211_channel_type ch_type)
  665. {
  666. struct rtl_priv *rtlpriv = rtl_priv(hw);
  667. struct rtl_phy *rtlphy = &(rtlpriv->phy);
  668. struct rtl_hal *rtlhal = rtl_hal(rtl_priv(hw));
  669. u8 tmp_bw = rtlphy->current_chan_bw;
  670. if (rtlphy->set_bwmode_inprogress)
  671. return;
  672. rtlphy->set_bwmode_inprogress = true;
  673. if ((!is_hal_stop(rtlhal)) && !(RT_CANNOT_IO(hw)))
  674. rtl92c_phy_set_bw_mode_callback(hw);
  675. else {
  676. RT_TRACE(rtlpriv, COMP_ERR, DBG_WARNING,
  677. ("FALSE driver sleep or unload\n"));
  678. rtlphy->set_bwmode_inprogress = false;
  679. rtlphy->current_chan_bw = tmp_bw;
  680. }
  681. }
  682. void rtl92c_phy_sw_chnl_callback(struct ieee80211_hw *hw)
  683. {
  684. struct rtl_priv *rtlpriv = rtl_priv(hw);
  685. struct rtl_hal *rtlhal = rtl_hal(rtl_priv(hw));
  686. struct rtl_phy *rtlphy = &(rtlpriv->phy);
  687. u32 delay;
  688. RT_TRACE(rtlpriv, COMP_SCAN, DBG_TRACE,
  689. ("switch to channel%d\n", rtlphy->current_channel));
  690. if (is_hal_stop(rtlhal))
  691. return;
  692. do {
  693. if (!rtlphy->sw_chnl_inprogress)
  694. break;
  695. if (!_rtl92c_phy_sw_chnl_step_by_step
  696. (hw, rtlphy->current_channel, &rtlphy->sw_chnl_stage,
  697. &rtlphy->sw_chnl_step, &delay)) {
  698. if (delay > 0)
  699. mdelay(delay);
  700. else
  701. continue;
  702. } else
  703. rtlphy->sw_chnl_inprogress = false;
  704. break;
  705. } while (true);
  706. RT_TRACE(rtlpriv, COMP_SCAN, DBG_TRACE, ("<==\n"));
  707. }
  708. u8 rtl92c_phy_sw_chnl(struct ieee80211_hw *hw)
  709. {
  710. struct rtl_priv *rtlpriv = rtl_priv(hw);
  711. struct rtl_phy *rtlphy = &(rtlpriv->phy);
  712. struct rtl_hal *rtlhal = rtl_hal(rtl_priv(hw));
  713. if (rtlphy->sw_chnl_inprogress)
  714. return 0;
  715. if (rtlphy->set_bwmode_inprogress)
  716. return 0;
  717. RT_ASSERT((rtlphy->current_channel <= 14),
  718. ("WIRELESS_MODE_G but channel>14"));
  719. rtlphy->sw_chnl_inprogress = true;
  720. rtlphy->sw_chnl_stage = 0;
  721. rtlphy->sw_chnl_step = 0;
  722. if (!(is_hal_stop(rtlhal)) && !(RT_CANNOT_IO(hw))) {
  723. rtl92c_phy_sw_chnl_callback(hw);
  724. RT_TRACE(rtlpriv, COMP_CHAN, DBG_LOUD,
  725. ("sw_chnl_inprogress false schdule workitem\n"));
  726. rtlphy->sw_chnl_inprogress = false;
  727. } else {
  728. RT_TRACE(rtlpriv, COMP_CHAN, DBG_LOUD,
  729. ("sw_chnl_inprogress false driver sleep or"
  730. " unload\n"));
  731. rtlphy->sw_chnl_inprogress = false;
  732. }
  733. return 1;
  734. }
  735. static bool _rtl92c_phy_sw_chnl_step_by_step(struct ieee80211_hw *hw,
  736. u8 channel, u8 *stage, u8 *step,
  737. u32 *delay)
  738. {
  739. struct rtl_priv *rtlpriv = rtl_priv(hw);
  740. struct rtl_phy *rtlphy = &(rtlpriv->phy);
  741. struct swchnlcmd precommoncmd[MAX_PRECMD_CNT];
  742. u32 precommoncmdcnt;
  743. struct swchnlcmd postcommoncmd[MAX_POSTCMD_CNT];
  744. u32 postcommoncmdcnt;
  745. struct swchnlcmd rfdependcmd[MAX_RFDEPENDCMD_CNT];
  746. u32 rfdependcmdcnt;
  747. struct swchnlcmd *currentcmd = NULL;
  748. u8 rfpath;
  749. u8 num_total_rfpath = rtlphy->num_total_rfpath;
  750. precommoncmdcnt = 0;
  751. _rtl92c_phy_set_sw_chnl_cmdarray(precommoncmd, precommoncmdcnt++,
  752. MAX_PRECMD_CNT,
  753. CMDID_SET_TXPOWEROWER_LEVEL, 0, 0, 0);
  754. _rtl92c_phy_set_sw_chnl_cmdarray(precommoncmd, precommoncmdcnt++,
  755. MAX_PRECMD_CNT, CMDID_END, 0, 0, 0);
  756. postcommoncmdcnt = 0;
  757. _rtl92c_phy_set_sw_chnl_cmdarray(postcommoncmd, postcommoncmdcnt++,
  758. MAX_POSTCMD_CNT, CMDID_END, 0, 0, 0);
  759. rfdependcmdcnt = 0;
  760. RT_ASSERT((channel >= 1 && channel <= 14),
  761. ("illegal channel for Zebra: %d\n", channel));
  762. _rtl92c_phy_set_sw_chnl_cmdarray(rfdependcmd, rfdependcmdcnt++,
  763. MAX_RFDEPENDCMD_CNT, CMDID_RF_WRITEREG,
  764. RF_CHNLBW, channel, 10);
  765. _rtl92c_phy_set_sw_chnl_cmdarray(rfdependcmd, rfdependcmdcnt++,
  766. MAX_RFDEPENDCMD_CNT, CMDID_END, 0, 0,
  767. 0);
  768. do {
  769. switch (*stage) {
  770. case 0:
  771. currentcmd = &precommoncmd[*step];
  772. break;
  773. case 1:
  774. currentcmd = &rfdependcmd[*step];
  775. break;
  776. case 2:
  777. currentcmd = &postcommoncmd[*step];
  778. break;
  779. }
  780. if (currentcmd->cmdid == CMDID_END) {
  781. if ((*stage) == 2) {
  782. return true;
  783. } else {
  784. (*stage)++;
  785. (*step) = 0;
  786. continue;
  787. }
  788. }
  789. switch (currentcmd->cmdid) {
  790. case CMDID_SET_TXPOWEROWER_LEVEL:
  791. rtl92c_phy_set_txpower_level(hw, channel);
  792. break;
  793. case CMDID_WRITEPORT_ULONG:
  794. rtl_write_dword(rtlpriv, currentcmd->para1,
  795. currentcmd->para2);
  796. break;
  797. case CMDID_WRITEPORT_USHORT:
  798. rtl_write_word(rtlpriv, currentcmd->para1,
  799. (u16) currentcmd->para2);
  800. break;
  801. case CMDID_WRITEPORT_UCHAR:
  802. rtl_write_byte(rtlpriv, currentcmd->para1,
  803. (u8) currentcmd->para2);
  804. break;
  805. case CMDID_RF_WRITEREG:
  806. for (rfpath = 0; rfpath < num_total_rfpath; rfpath++) {
  807. rtlphy->rfreg_chnlval[rfpath] =
  808. ((rtlphy->rfreg_chnlval[rfpath] &
  809. 0xfffffc00) | currentcmd->para2);
  810. rtl_set_rfreg(hw, (enum radio_path)rfpath,
  811. currentcmd->para1,
  812. RFREG_OFFSET_MASK,
  813. rtlphy->rfreg_chnlval[rfpath]);
  814. }
  815. break;
  816. default:
  817. RT_TRACE(rtlpriv, COMP_ERR, DBG_EMERG,
  818. ("switch case not process\n"));
  819. break;
  820. }
  821. break;
  822. } while (true);
  823. (*delay) = currentcmd->msdelay;
  824. (*step)++;
  825. return false;
  826. }
  827. static bool _rtl92c_phy_set_sw_chnl_cmdarray(struct swchnlcmd *cmdtable,
  828. u32 cmdtableidx, u32 cmdtablesz,
  829. enum swchnlcmd_id cmdid,
  830. u32 para1, u32 para2, u32 msdelay)
  831. {
  832. struct swchnlcmd *pcmd;
  833. if (cmdtable == NULL) {
  834. RT_ASSERT(false, ("cmdtable cannot be NULL.\n"));
  835. return false;
  836. }
  837. if (cmdtableidx >= cmdtablesz)
  838. return false;
  839. pcmd = cmdtable + cmdtableidx;
  840. pcmd->cmdid = cmdid;
  841. pcmd->para1 = para1;
  842. pcmd->para2 = para2;
  843. pcmd->msdelay = msdelay;
  844. return true;
  845. }
  846. bool rtl8192_phy_check_is_legal_rfpath(struct ieee80211_hw *hw, u32 rfpath)
  847. {
  848. return true;
  849. }
  850. static u8 _rtl92c_phy_path_a_iqk(struct ieee80211_hw *hw, bool config_pathb)
  851. {
  852. u32 reg_eac, reg_e94, reg_e9c, reg_ea4;
  853. u8 result = 0x00;
  854. rtl_set_bbreg(hw, 0xe30, MASKDWORD, 0x10008c1f);
  855. rtl_set_bbreg(hw, 0xe34, MASKDWORD, 0x10008c1f);
  856. rtl_set_bbreg(hw, 0xe38, MASKDWORD, 0x82140102);
  857. rtl_set_bbreg(hw, 0xe3c, MASKDWORD,
  858. config_pathb ? 0x28160202 : 0x28160502);
  859. if (config_pathb) {
  860. rtl_set_bbreg(hw, 0xe50, MASKDWORD, 0x10008c22);
  861. rtl_set_bbreg(hw, 0xe54, MASKDWORD, 0x10008c22);
  862. rtl_set_bbreg(hw, 0xe58, MASKDWORD, 0x82140102);
  863. rtl_set_bbreg(hw, 0xe5c, MASKDWORD, 0x28160202);
  864. }
  865. rtl_set_bbreg(hw, 0xe4c, MASKDWORD, 0x001028d1);
  866. rtl_set_bbreg(hw, 0xe48, MASKDWORD, 0xf9000000);
  867. rtl_set_bbreg(hw, 0xe48, MASKDWORD, 0xf8000000);
  868. mdelay(IQK_DELAY_TIME);
  869. reg_eac = rtl_get_bbreg(hw, 0xeac, MASKDWORD);
  870. reg_e94 = rtl_get_bbreg(hw, 0xe94, MASKDWORD);
  871. reg_e9c = rtl_get_bbreg(hw, 0xe9c, MASKDWORD);
  872. reg_ea4 = rtl_get_bbreg(hw, 0xea4, MASKDWORD);
  873. if (!(reg_eac & BIT(28)) &&
  874. (((reg_e94 & 0x03FF0000) >> 16) != 0x142) &&
  875. (((reg_e9c & 0x03FF0000) >> 16) != 0x42))
  876. result |= 0x01;
  877. else
  878. return result;
  879. if (!(reg_eac & BIT(27)) &&
  880. (((reg_ea4 & 0x03FF0000) >> 16) != 0x132) &&
  881. (((reg_eac & 0x03FF0000) >> 16) != 0x36))
  882. result |= 0x02;
  883. return result;
  884. }
  885. static u8 _rtl92c_phy_path_b_iqk(struct ieee80211_hw *hw)
  886. {
  887. u32 reg_eac, reg_eb4, reg_ebc, reg_ec4, reg_ecc;
  888. u8 result = 0x00;
  889. rtl_set_bbreg(hw, 0xe60, MASKDWORD, 0x00000002);
  890. rtl_set_bbreg(hw, 0xe60, MASKDWORD, 0x00000000);
  891. mdelay(IQK_DELAY_TIME);
  892. reg_eac = rtl_get_bbreg(hw, 0xeac, MASKDWORD);
  893. reg_eb4 = rtl_get_bbreg(hw, 0xeb4, MASKDWORD);
  894. reg_ebc = rtl_get_bbreg(hw, 0xebc, MASKDWORD);
  895. reg_ec4 = rtl_get_bbreg(hw, 0xec4, MASKDWORD);
  896. reg_ecc = rtl_get_bbreg(hw, 0xecc, MASKDWORD);
  897. if (!(reg_eac & BIT(31)) &&
  898. (((reg_eb4 & 0x03FF0000) >> 16) != 0x142) &&
  899. (((reg_ebc & 0x03FF0000) >> 16) != 0x42))
  900. result |= 0x01;
  901. else
  902. return result;
  903. if (!(reg_eac & BIT(30)) &&
  904. (((reg_ec4 & 0x03FF0000) >> 16) != 0x132) &&
  905. (((reg_ecc & 0x03FF0000) >> 16) != 0x36))
  906. result |= 0x02;
  907. return result;
  908. }
  909. static void _rtl92c_phy_path_a_fill_iqk_matrix(struct ieee80211_hw *hw,
  910. bool iqk_ok, long result[][8],
  911. u8 final_candidate, bool btxonly)
  912. {
  913. u32 oldval_0, x, tx0_a, reg;
  914. long y, tx0_c;
  915. if (final_candidate == 0xFF)
  916. return;
  917. else if (iqk_ok) {
  918. oldval_0 = (rtl_get_bbreg(hw, ROFDM0_XATXIQIMBALANCE,
  919. MASKDWORD) >> 22) & 0x3FF;
  920. x = result[final_candidate][0];
  921. if ((x & 0x00000200) != 0)
  922. x = x | 0xFFFFFC00;
  923. tx0_a = (x * oldval_0) >> 8;
  924. rtl_set_bbreg(hw, ROFDM0_XATXIQIMBALANCE, 0x3FF, tx0_a);
  925. rtl_set_bbreg(hw, ROFDM0_ECCATHRESHOLD, BIT(31),
  926. ((x * oldval_0 >> 7) & 0x1));
  927. y = result[final_candidate][1];
  928. if ((y & 0x00000200) != 0)
  929. y = y | 0xFFFFFC00;
  930. tx0_c = (y * oldval_0) >> 8;
  931. rtl_set_bbreg(hw, ROFDM0_XCTXAFE, 0xF0000000,
  932. ((tx0_c & 0x3C0) >> 6));
  933. rtl_set_bbreg(hw, ROFDM0_XATXIQIMBALANCE, 0x003F0000,
  934. (tx0_c & 0x3F));
  935. rtl_set_bbreg(hw, ROFDM0_ECCATHRESHOLD, BIT(29),
  936. ((y * oldval_0 >> 7) & 0x1));
  937. if (btxonly)
  938. return;
  939. reg = result[final_candidate][2];
  940. rtl_set_bbreg(hw, ROFDM0_XARXIQIMBALANCE, 0x3FF, reg);
  941. reg = result[final_candidate][3] & 0x3F;
  942. rtl_set_bbreg(hw, ROFDM0_XARXIQIMBALANCE, 0xFC00, reg);
  943. reg = (result[final_candidate][3] >> 6) & 0xF;
  944. rtl_set_bbreg(hw, 0xca0, 0xF0000000, reg);
  945. }
  946. }
  947. static void _rtl92c_phy_path_b_fill_iqk_matrix(struct ieee80211_hw *hw,
  948. bool iqk_ok, long result[][8],
  949. u8 final_candidate, bool btxonly)
  950. {
  951. u32 oldval_1, x, tx1_a, reg;
  952. long y, tx1_c;
  953. if (final_candidate == 0xFF)
  954. return;
  955. else if (iqk_ok) {
  956. oldval_1 = (rtl_get_bbreg(hw, ROFDM0_XBTXIQIMBALANCE,
  957. MASKDWORD) >> 22) & 0x3FF;
  958. x = result[final_candidate][4];
  959. if ((x & 0x00000200) != 0)
  960. x = x | 0xFFFFFC00;
  961. tx1_a = (x * oldval_1) >> 8;
  962. rtl_set_bbreg(hw, ROFDM0_XBTXIQIMBALANCE, 0x3FF, tx1_a);
  963. rtl_set_bbreg(hw, ROFDM0_ECCATHRESHOLD, BIT(27),
  964. ((x * oldval_1 >> 7) & 0x1));
  965. y = result[final_candidate][5];
  966. if ((y & 0x00000200) != 0)
  967. y = y | 0xFFFFFC00;
  968. tx1_c = (y * oldval_1) >> 8;
  969. rtl_set_bbreg(hw, ROFDM0_XDTXAFE, 0xF0000000,
  970. ((tx1_c & 0x3C0) >> 6));
  971. rtl_set_bbreg(hw, ROFDM0_XBTXIQIMBALANCE, 0x003F0000,
  972. (tx1_c & 0x3F));
  973. rtl_set_bbreg(hw, ROFDM0_ECCATHRESHOLD, BIT(25),
  974. ((y * oldval_1 >> 7) & 0x1));
  975. if (btxonly)
  976. return;
  977. reg = result[final_candidate][6];
  978. rtl_set_bbreg(hw, ROFDM0_XBRXIQIMBALANCE, 0x3FF, reg);
  979. reg = result[final_candidate][7] & 0x3F;
  980. rtl_set_bbreg(hw, ROFDM0_XBRXIQIMBALANCE, 0xFC00, reg);
  981. reg = (result[final_candidate][7] >> 6) & 0xF;
  982. rtl_set_bbreg(hw, ROFDM0_AGCRSSITABLE, 0x0000F000, reg);
  983. }
  984. }
  985. static void _rtl92c_phy_save_adda_registers(struct ieee80211_hw *hw,
  986. u32 *addareg, u32 *addabackup,
  987. u32 registernum)
  988. {
  989. u32 i;
  990. for (i = 0; i < registernum; i++)
  991. addabackup[i] = rtl_get_bbreg(hw, addareg[i], MASKDWORD);
  992. }
  993. static void _rtl92c_phy_save_mac_registers(struct ieee80211_hw *hw,
  994. u32 *macreg, u32 *macbackup)
  995. {
  996. struct rtl_priv *rtlpriv = rtl_priv(hw);
  997. u32 i;
  998. for (i = 0; i < (IQK_MAC_REG_NUM - 1); i++)
  999. macbackup[i] = rtl_read_byte(rtlpriv, macreg[i]);
  1000. macbackup[i] = rtl_read_dword(rtlpriv, macreg[i]);
  1001. }
  1002. static void _rtl92c_phy_reload_adda_registers(struct ieee80211_hw *hw,
  1003. u32 *addareg, u32 *addabackup,
  1004. u32 regiesternum)
  1005. {
  1006. u32 i;
  1007. for (i = 0; i < regiesternum; i++)
  1008. rtl_set_bbreg(hw, addareg[i], MASKDWORD, addabackup[i]);
  1009. }
  1010. static void _rtl92c_phy_reload_mac_registers(struct ieee80211_hw *hw,
  1011. u32 *macreg, u32 *macbackup)
  1012. {
  1013. struct rtl_priv *rtlpriv = rtl_priv(hw);
  1014. u32 i;
  1015. for (i = 0; i < (IQK_MAC_REG_NUM - 1); i++)
  1016. rtl_write_byte(rtlpriv, macreg[i], (u8) macbackup[i]);
  1017. rtl_write_dword(rtlpriv, macreg[i], macbackup[i]);
  1018. }
  1019. static void _rtl92c_phy_path_adda_on(struct ieee80211_hw *hw,
  1020. u32 *addareg, bool is_patha_on, bool is2t)
  1021. {
  1022. u32 pathOn;
  1023. u32 i;
  1024. pathOn = is_patha_on ? 0x04db25a4 : 0x0b1b25a4;
  1025. if (false == is2t) {
  1026. pathOn = 0x0bdb25a0;
  1027. rtl_set_bbreg(hw, addareg[0], MASKDWORD, 0x0b1b25a0);
  1028. } else {
  1029. rtl_set_bbreg(hw, addareg[0], MASKDWORD, pathOn);
  1030. }
  1031. for (i = 1; i < IQK_ADDA_REG_NUM; i++)
  1032. rtl_set_bbreg(hw, addareg[i], MASKDWORD, pathOn);
  1033. }
  1034. static void _rtl92c_phy_mac_setting_calibration(struct ieee80211_hw *hw,
  1035. u32 *macreg, u32 *macbackup)
  1036. {
  1037. struct rtl_priv *rtlpriv = rtl_priv(hw);
  1038. u32 i;
  1039. rtl_write_byte(rtlpriv, macreg[0], 0x3F);
  1040. for (i = 1; i < (IQK_MAC_REG_NUM - 1); i++)
  1041. rtl_write_byte(rtlpriv, macreg[i],
  1042. (u8) (macbackup[i] & (~BIT(3))));
  1043. rtl_write_byte(rtlpriv, macreg[i], (u8) (macbackup[i] & (~BIT(5))));
  1044. }
  1045. static void _rtl92c_phy_path_a_standby(struct ieee80211_hw *hw)
  1046. {
  1047. rtl_set_bbreg(hw, 0xe28, MASKDWORD, 0x0);
  1048. rtl_set_bbreg(hw, 0x840, MASKDWORD, 0x00010000);
  1049. rtl_set_bbreg(hw, 0xe28, MASKDWORD, 0x80800000);
  1050. }
  1051. static void _rtl92c_phy_pi_mode_switch(struct ieee80211_hw *hw, bool pi_mode)
  1052. {
  1053. u32 mode;
  1054. mode = pi_mode ? 0x01000100 : 0x01000000;
  1055. rtl_set_bbreg(hw, 0x820, MASKDWORD, mode);
  1056. rtl_set_bbreg(hw, 0x828, MASKDWORD, mode);
  1057. }
  1058. static bool _rtl92c_phy_simularity_compare(struct ieee80211_hw *hw,
  1059. long result[][8], u8 c1, u8 c2)
  1060. {
  1061. u32 i, j, diff, simularity_bitmap, bound;
  1062. struct rtl_hal *rtlhal = rtl_hal(rtl_priv(hw));
  1063. u8 final_candidate[2] = { 0xFF, 0xFF };
  1064. bool bresult = true, is2t = IS_92C_SERIAL(rtlhal->version);
  1065. if (is2t)
  1066. bound = 8;
  1067. else
  1068. bound = 4;
  1069. simularity_bitmap = 0;
  1070. for (i = 0; i < bound; i++) {
  1071. diff = (result[c1][i] > result[c2][i]) ?
  1072. (result[c1][i] - result[c2][i]) :
  1073. (result[c2][i] - result[c1][i]);
  1074. if (diff > MAX_TOLERANCE) {
  1075. if ((i == 2 || i == 6) && !simularity_bitmap) {
  1076. if (result[c1][i] + result[c1][i + 1] == 0)
  1077. final_candidate[(i / 4)] = c2;
  1078. else if (result[c2][i] + result[c2][i + 1] == 0)
  1079. final_candidate[(i / 4)] = c1;
  1080. else
  1081. simularity_bitmap = simularity_bitmap |
  1082. (1 << i);
  1083. } else
  1084. simularity_bitmap =
  1085. simularity_bitmap | (1 << i);
  1086. }
  1087. }
  1088. if (simularity_bitmap == 0) {
  1089. for (i = 0; i < (bound / 4); i++) {
  1090. if (final_candidate[i] != 0xFF) {
  1091. for (j = i * 4; j < (i + 1) * 4 - 2; j++)
  1092. result[3][j] =
  1093. result[final_candidate[i]][j];
  1094. bresult = false;
  1095. }
  1096. }
  1097. return bresult;
  1098. } else if (!(simularity_bitmap & 0x0F)) {
  1099. for (i = 0; i < 4; i++)
  1100. result[3][i] = result[c1][i];
  1101. return false;
  1102. } else if (!(simularity_bitmap & 0xF0) && is2t) {
  1103. for (i = 4; i < 8; i++)
  1104. result[3][i] = result[c1][i];
  1105. return false;
  1106. } else {
  1107. return false;
  1108. }
  1109. }
  1110. static void _rtl92c_phy_iq_calibrate(struct ieee80211_hw *hw,
  1111. long result[][8], u8 t, bool is2t)
  1112. {
  1113. struct rtl_priv *rtlpriv = rtl_priv(hw);
  1114. struct rtl_phy *rtlphy = &(rtlpriv->phy);
  1115. u32 i;
  1116. u8 patha_ok, pathb_ok;
  1117. u32 adda_reg[IQK_ADDA_REG_NUM] = {
  1118. 0x85c, 0xe6c, 0xe70, 0xe74,
  1119. 0xe78, 0xe7c, 0xe80, 0xe84,
  1120. 0xe88, 0xe8c, 0xed0, 0xed4,
  1121. 0xed8, 0xedc, 0xee0, 0xeec
  1122. };
  1123. u32 iqk_mac_reg[IQK_MAC_REG_NUM] = {
  1124. 0x522, 0x550, 0x551, 0x040
  1125. };
  1126. const u32 retrycount = 2;
  1127. u32 bbvalue;
  1128. if (t == 0) {
  1129. bbvalue = rtl_get_bbreg(hw, 0x800, MASKDWORD);
  1130. _rtl92c_phy_save_adda_registers(hw, adda_reg,
  1131. rtlphy->adda_backup, 16);
  1132. _rtl92c_phy_save_mac_registers(hw, iqk_mac_reg,
  1133. rtlphy->iqk_mac_backup);
  1134. }
  1135. _rtl92c_phy_path_adda_on(hw, adda_reg, true, is2t);
  1136. if (t == 0) {
  1137. rtlphy->rfpi_enable = (u8) rtl_get_bbreg(hw,
  1138. RFPGA0_XA_HSSIPARAMETER1,
  1139. BIT(8));
  1140. }
  1141. if (!rtlphy->rfpi_enable)
  1142. _rtl92c_phy_pi_mode_switch(hw, true);
  1143. if (t == 0) {
  1144. rtlphy->reg_c04 = rtl_get_bbreg(hw, 0xc04, MASKDWORD);
  1145. rtlphy->reg_c08 = rtl_get_bbreg(hw, 0xc08, MASKDWORD);
  1146. rtlphy->reg_874 = rtl_get_bbreg(hw, 0x874, MASKDWORD);
  1147. }
  1148. rtl_set_bbreg(hw, 0xc04, MASKDWORD, 0x03a05600);
  1149. rtl_set_bbreg(hw, 0xc08, MASKDWORD, 0x000800e4);
  1150. rtl_set_bbreg(hw, 0x874, MASKDWORD, 0x22204000);
  1151. if (is2t) {
  1152. rtl_set_bbreg(hw, 0x840, MASKDWORD, 0x00010000);
  1153. rtl_set_bbreg(hw, 0x844, MASKDWORD, 0x00010000);
  1154. }
  1155. _rtl92c_phy_mac_setting_calibration(hw, iqk_mac_reg,
  1156. rtlphy->iqk_mac_backup);
  1157. rtl_set_bbreg(hw, 0xb68, MASKDWORD, 0x00080000);
  1158. if (is2t)
  1159. rtl_set_bbreg(hw, 0xb6c, MASKDWORD, 0x00080000);
  1160. rtl_set_bbreg(hw, 0xe28, MASKDWORD, 0x80800000);
  1161. rtl_set_bbreg(hw, 0xe40, MASKDWORD, 0x01007c00);
  1162. rtl_set_bbreg(hw, 0xe44, MASKDWORD, 0x01004800);
  1163. for (i = 0; i < retrycount; i++) {
  1164. patha_ok = _rtl92c_phy_path_a_iqk(hw, is2t);
  1165. if (patha_ok == 0x03) {
  1166. result[t][0] = (rtl_get_bbreg(hw, 0xe94, MASKDWORD) &
  1167. 0x3FF0000) >> 16;
  1168. result[t][1] = (rtl_get_bbreg(hw, 0xe9c, MASKDWORD) &
  1169. 0x3FF0000) >> 16;
  1170. result[t][2] = (rtl_get_bbreg(hw, 0xea4, MASKDWORD) &
  1171. 0x3FF0000) >> 16;
  1172. result[t][3] = (rtl_get_bbreg(hw, 0xeac, MASKDWORD) &
  1173. 0x3FF0000) >> 16;
  1174. break;
  1175. } else if (i == (retrycount - 1) && patha_ok == 0x01)
  1176. result[t][0] = (rtl_get_bbreg(hw, 0xe94,
  1177. MASKDWORD) & 0x3FF0000) >>
  1178. 16;
  1179. result[t][1] =
  1180. (rtl_get_bbreg(hw, 0xe9c, MASKDWORD) & 0x3FF0000) >> 16;
  1181. }
  1182. if (is2t) {
  1183. _rtl92c_phy_path_a_standby(hw);
  1184. _rtl92c_phy_path_adda_on(hw, adda_reg, false, is2t);
  1185. for (i = 0; i < retrycount; i++) {
  1186. pathb_ok = _rtl92c_phy_path_b_iqk(hw);
  1187. if (pathb_ok == 0x03) {
  1188. result[t][4] = (rtl_get_bbreg(hw,
  1189. 0xeb4,
  1190. MASKDWORD) &
  1191. 0x3FF0000) >> 16;
  1192. result[t][5] =
  1193. (rtl_get_bbreg(hw, 0xebc, MASKDWORD) &
  1194. 0x3FF0000) >> 16;
  1195. result[t][6] =
  1196. (rtl_get_bbreg(hw, 0xec4, MASKDWORD) &
  1197. 0x3FF0000) >> 16;
  1198. result[t][7] =
  1199. (rtl_get_bbreg(hw, 0xecc, MASKDWORD) &
  1200. 0x3FF0000) >> 16;
  1201. break;
  1202. } else if (i == (retrycount - 1) && pathb_ok == 0x01) {
  1203. result[t][4] = (rtl_get_bbreg(hw,
  1204. 0xeb4,
  1205. MASKDWORD) &
  1206. 0x3FF0000) >> 16;
  1207. }
  1208. result[t][5] = (rtl_get_bbreg(hw, 0xebc, MASKDWORD) &
  1209. 0x3FF0000) >> 16;
  1210. }
  1211. }
  1212. rtl_set_bbreg(hw, 0xc04, MASKDWORD, rtlphy->reg_c04);
  1213. rtl_set_bbreg(hw, 0x874, MASKDWORD, rtlphy->reg_874);
  1214. rtl_set_bbreg(hw, 0xc08, MASKDWORD, rtlphy->reg_c08);
  1215. rtl_set_bbreg(hw, 0xe28, MASKDWORD, 0);
  1216. rtl_set_bbreg(hw, 0x840, MASKDWORD, 0x00032ed3);
  1217. if (is2t)
  1218. rtl_set_bbreg(hw, 0x844, MASKDWORD, 0x00032ed3);
  1219. if (t != 0) {
  1220. if (!rtlphy->rfpi_enable)
  1221. _rtl92c_phy_pi_mode_switch(hw, false);
  1222. _rtl92c_phy_reload_adda_registers(hw, adda_reg,
  1223. rtlphy->adda_backup, 16);
  1224. _rtl92c_phy_reload_mac_registers(hw, iqk_mac_reg,
  1225. rtlphy->iqk_mac_backup);
  1226. }
  1227. }
  1228. static void _rtl92c_phy_ap_calibrate(struct ieee80211_hw *hw,
  1229. char delta, bool is2t)
  1230. {
  1231. /* This routine is deliberately dummied out for later fixes */
  1232. #if 0
  1233. struct rtl_priv *rtlpriv = rtl_priv(hw);
  1234. struct rtl_phy *rtlphy = &(rtlpriv->phy);
  1235. struct rtl_efuse *rtlefuse = rtl_efuse(rtl_priv(hw));
  1236. u32 reg_d[PATH_NUM];
  1237. u32 tmpreg, index, offset, path, i, pathbound = PATH_NUM, apkbound;
  1238. u32 bb_backup[APK_BB_REG_NUM];
  1239. u32 bb_reg[APK_BB_REG_NUM] = {
  1240. 0x904, 0xc04, 0x800, 0xc08, 0x874
  1241. };
  1242. u32 bb_ap_mode[APK_BB_REG_NUM] = {
  1243. 0x00000020, 0x00a05430, 0x02040000,
  1244. 0x000800e4, 0x00204000
  1245. };
  1246. u32 bb_normal_ap_mode[APK_BB_REG_NUM] = {
  1247. 0x00000020, 0x00a05430, 0x02040000,
  1248. 0x000800e4, 0x22204000
  1249. };
  1250. u32 afe_backup[APK_AFE_REG_NUM];
  1251. u32 afe_reg[APK_AFE_REG_NUM] = {
  1252. 0x85c, 0xe6c, 0xe70, 0xe74, 0xe78,
  1253. 0xe7c, 0xe80, 0xe84, 0xe88, 0xe8c,
  1254. 0xed0, 0xed4, 0xed8, 0xedc, 0xee0,
  1255. 0xeec
  1256. };
  1257. u32 mac_backup[IQK_MAC_REG_NUM];
  1258. u32 mac_reg[IQK_MAC_REG_NUM] = {
  1259. 0x522, 0x550, 0x551, 0x040
  1260. };
  1261. u32 apk_rf_init_value[PATH_NUM][APK_BB_REG_NUM] = {
  1262. {0x0852c, 0x1852c, 0x5852c, 0x1852c, 0x5852c},
  1263. {0x2852e, 0x0852e, 0x3852e, 0x0852e, 0x0852e}
  1264. };
  1265. u32 apk_normal_rf_init_value[PATH_NUM][APK_BB_REG_NUM] = {
  1266. {0x0852c, 0x0a52c, 0x3a52c, 0x5a52c, 0x5a52c},
  1267. {0x0852c, 0x0a52c, 0x5a52c, 0x5a52c, 0x5a52c}
  1268. };
  1269. u32 apk_rf_value_0[PATH_NUM][APK_BB_REG_NUM] = {
  1270. {0x52019, 0x52014, 0x52013, 0x5200f, 0x5208d},
  1271. {0x5201a, 0x52019, 0x52016, 0x52033, 0x52050}
  1272. };
  1273. u32 apk_normal_rf_value_0[PATH_NUM][APK_BB_REG_NUM] = {
  1274. {0x52019, 0x52017, 0x52010, 0x5200d, 0x5206a},
  1275. {0x52019, 0x52017, 0x52010, 0x5200d, 0x5206a}
  1276. };
  1277. u32 afe_on_off[PATH_NUM] = {
  1278. 0x04db25a4, 0x0b1b25a4
  1279. };
  1280. u32 apk_offset[PATH_NUM] = { 0xb68, 0xb6c };
  1281. u32 apk_normal_offset[PATH_NUM] = { 0xb28, 0xb98 };
  1282. u32 apk_value[PATH_NUM] = { 0x92fc0000, 0x12fc0000 };
  1283. u32 apk_normal_value[PATH_NUM] = { 0x92680000, 0x12680000 };
  1284. const char apk_delta_mapping[APK_BB_REG_NUM][13] = {
  1285. {-4, -3, -2, -2, -1, -1, 0, 1, 2, 3, 4, 5, 6},
  1286. {-4, -3, -2, -2, -1, -1, 0, 1, 2, 3, 4, 5, 6},
  1287. {-6, -4, -2, -2, -1, -1, 0, 1, 2, 3, 4, 5, 6},
  1288. {-1, -1, -1, -1, -1, -1, 0, 1, 2, 3, 4, 5, 6},
  1289. {-11, -9, -7, -5, -3, -1, 0, 0, 0, 0, 0, 0, 0}
  1290. };
  1291. const u32 apk_normal_setting_value_1[13] = {
  1292. 0x01017018, 0xf7ed8f84, 0x1b1a1816, 0x2522201e, 0x322e2b28,
  1293. 0x433f3a36, 0x5b544e49, 0x7b726a62, 0xa69a8f84, 0xdfcfc0b3,
  1294. 0x12680000, 0x00880000, 0x00880000
  1295. };
  1296. const u32 apk_normal_setting_value_2[16] = {
  1297. 0x01c7021d, 0x01670183, 0x01000123, 0x00bf00e2, 0x008d00a3,
  1298. 0x0068007b, 0x004d0059, 0x003a0042, 0x002b0031, 0x001f0025,
  1299. 0x0017001b, 0x00110014, 0x000c000f, 0x0009000b, 0x00070008,
  1300. 0x00050006
  1301. };
  1302. const u32 apk_result[PATH_NUM][APK_BB_REG_NUM];
  1303. long bb_offset, delta_v, delta_offset;
  1304. if (!is2t)
  1305. pathbound = 1;
  1306. for (index = 0; index < PATH_NUM; index++) {
  1307. apk_offset[index] = apk_normal_offset[index];
  1308. apk_value[index] = apk_normal_value[index];
  1309. afe_on_off[index] = 0x6fdb25a4;
  1310. }
  1311. for (index = 0; index < APK_BB_REG_NUM; index++) {
  1312. for (path = 0; path < pathbound; path++) {
  1313. apk_rf_init_value[path][index] =
  1314. apk_normal_rf_init_value[path][index];
  1315. apk_rf_value_0[path][index] =
  1316. apk_normal_rf_value_0[path][index];
  1317. }
  1318. bb_ap_mode[index] = bb_normal_ap_mode[index];
  1319. apkbound = 6;
  1320. }
  1321. for (index = 0; index < APK_BB_REG_NUM; index++) {
  1322. if (index == 0)
  1323. continue;
  1324. bb_backup[index] = rtl_get_bbreg(hw, bb_reg[index], MASKDWORD);
  1325. }
  1326. _rtl92c_phy_save_mac_registers(hw, mac_reg, mac_backup);
  1327. _rtl92c_phy_save_adda_registers(hw, afe_reg, afe_backup, 16);
  1328. for (path = 0; path < pathbound; path++) {
  1329. if (path == RF90_PATH_A) {
  1330. offset = 0xb00;
  1331. for (index = 0; index < 11; index++) {
  1332. rtl_set_bbreg(hw, offset, MASKDWORD,
  1333. apk_normal_setting_value_1
  1334. [index]);
  1335. offset += 0x04;
  1336. }
  1337. rtl_set_bbreg(hw, 0xb98, MASKDWORD, 0x12680000);
  1338. offset = 0xb68;
  1339. for (; index < 13; index++) {
  1340. rtl_set_bbreg(hw, offset, MASKDWORD,
  1341. apk_normal_setting_value_1
  1342. [index]);
  1343. offset += 0x04;
  1344. }
  1345. rtl_set_bbreg(hw, 0xe28, MASKDWORD, 0x40000000);
  1346. offset = 0xb00;
  1347. for (index = 0; index < 16; index++) {
  1348. rtl_set_bbreg(hw, offset, MASKDWORD,
  1349. apk_normal_setting_value_2
  1350. [index]);
  1351. offset += 0x04;
  1352. }
  1353. rtl_set_bbreg(hw, 0xe28, MASKDWORD, 0x00000000);
  1354. } else if (path == RF90_PATH_B) {
  1355. offset = 0xb70;
  1356. for (index = 0; index < 10; index++) {
  1357. rtl_set_bbreg(hw, offset, MASKDWORD,
  1358. apk_normal_setting_value_1
  1359. [index]);
  1360. offset += 0x04;
  1361. }
  1362. rtl_set_bbreg(hw, 0xb28, MASKDWORD, 0x12680000);
  1363. rtl_set_bbreg(hw, 0xb98, MASKDWORD, 0x12680000);
  1364. offset = 0xb68;
  1365. index = 11;
  1366. for (; index < 13; index++) {
  1367. rtl_set_bbreg(hw, offset, MASKDWORD,
  1368. apk_normal_setting_value_1
  1369. [index]);
  1370. offset += 0x04;
  1371. }
  1372. rtl_set_bbreg(hw, 0xe28, MASKDWORD, 0x40000000);
  1373. offset = 0xb60;
  1374. for (index = 0; index < 16; index++) {
  1375. rtl_set_bbreg(hw, offset, MASKDWORD,
  1376. apk_normal_setting_value_2
  1377. [index]);
  1378. offset += 0x04;
  1379. }
  1380. rtl_set_bbreg(hw, 0xe28, MASKDWORD, 0x00000000);
  1381. }
  1382. reg_d[path] = rtl_get_rfreg(hw, (enum radio_path)path,
  1383. 0xd, MASKDWORD);
  1384. for (index = 0; index < APK_AFE_REG_NUM; index++)
  1385. rtl_set_bbreg(hw, afe_reg[index], MASKDWORD,
  1386. afe_on_off[path]);
  1387. if (path == RF90_PATH_A) {
  1388. for (index = 0; index < APK_BB_REG_NUM; index++) {
  1389. if (index == 0)
  1390. continue;
  1391. rtl_set_bbreg(hw, bb_reg[index], MASKDWORD,
  1392. bb_ap_mode[index]);
  1393. }
  1394. }
  1395. _rtl92c_phy_mac_setting_calibration(hw, mac_reg, mac_backup);
  1396. if (path == 0) {
  1397. rtl_set_rfreg(hw, RF90_PATH_B, 0x0, MASKDWORD, 0x10000);
  1398. } else {
  1399. rtl_set_rfreg(hw, RF90_PATH_A, 0x00, MASKDWORD,
  1400. 0x10000);
  1401. rtl_set_rfreg(hw, RF90_PATH_A, 0x10, MASKDWORD,
  1402. 0x1000f);
  1403. rtl_set_rfreg(hw, RF90_PATH_A, 0x11, MASKDWORD,
  1404. 0x20103);
  1405. }
  1406. delta_offset = ((delta + 14) / 2);
  1407. if (delta_offset < 0)
  1408. delta_offset = 0;
  1409. else if (delta_offset > 12)
  1410. delta_offset = 12;
  1411. for (index = 0; index < APK_BB_REG_NUM; index++) {
  1412. if (index != 1)
  1413. continue;
  1414. tmpreg = apk_rf_init_value[path][index];
  1415. if (!rtlefuse->apk_thermalmeterignore) {
  1416. bb_offset = (tmpreg & 0xF0000) >> 16;
  1417. if (!(tmpreg & BIT(15)))
  1418. bb_offset = -bb_offset;
  1419. delta_v =
  1420. apk_delta_mapping[index][delta_offset];
  1421. bb_offset += delta_v;
  1422. if (bb_offset < 0) {
  1423. tmpreg = tmpreg & (~BIT(15));
  1424. bb_offset = -bb_offset;
  1425. } else {
  1426. tmpreg = tmpreg | BIT(15);
  1427. }
  1428. tmpreg =
  1429. (tmpreg & 0xFFF0FFFF) | (bb_offset << 16);
  1430. }
  1431. rtl_set_rfreg(hw, (enum radio_path)path, 0xc,
  1432. MASKDWORD, 0x8992e);
  1433. rtl_set_rfreg(hw, (enum radio_path)path, 0x0,
  1434. MASKDWORD, apk_rf_value_0[path][index]);
  1435. rtl_set_rfreg(hw, (enum radio_path)path, 0xd,
  1436. MASKDWORD, tmpreg);
  1437. i = 0;
  1438. do {
  1439. rtl_set_bbreg(hw, 0xe28, MASKDWORD, 0x80000000);
  1440. rtl_set_bbreg(hw, apk_offset[path],
  1441. MASKDWORD, apk_value[0]);
  1442. RTPRINT(rtlpriv, FINIT, INIT_IQK,
  1443. ("PHY_APCalibrate() offset 0x%x "
  1444. "value 0x%x\n",
  1445. apk_offset[path],
  1446. rtl_get_bbreg(hw, apk_offset[path],
  1447. MASKDWORD)));
  1448. mdelay(3);
  1449. rtl_set_bbreg(hw, apk_offset[path],
  1450. MASKDWORD, apk_value[1]);
  1451. RTPRINT(rtlpriv, FINIT, INIT_IQK,
  1452. ("PHY_APCalibrate() offset 0x%x "
  1453. "value 0x%x\n",
  1454. apk_offset[path],
  1455. rtl_get_bbreg(hw, apk_offset[path],
  1456. MASKDWORD)));
  1457. mdelay(20);
  1458. rtl_set_bbreg(hw, 0xe28, MASKDWORD, 0x00000000);
  1459. if (path == RF90_PATH_A)
  1460. tmpreg = rtl_get_bbreg(hw, 0xbd8,
  1461. 0x03E00000);
  1462. else
  1463. tmpreg = rtl_get_bbreg(hw, 0xbd8,
  1464. 0xF8000000);
  1465. RTPRINT(rtlpriv, FINIT, INIT_IQK,
  1466. ("PHY_APCalibrate() offset "
  1467. "0xbd8[25:21] %x\n", tmpreg));
  1468. i++;
  1469. } while (tmpreg > apkbound && i < 4);
  1470. apk_result[path][index] = tmpreg;
  1471. }
  1472. }
  1473. _rtl92c_phy_reload_mac_registers(hw, mac_reg, mac_backup);
  1474. for (index = 0; index < APK_BB_REG_NUM; index++) {
  1475. if (index == 0)
  1476. continue;
  1477. rtl_set_bbreg(hw, bb_reg[index], MASKDWORD, bb_backup[index]);
  1478. }
  1479. _rtl92c_phy_reload_adda_registers(hw, afe_reg, afe_backup, 16);
  1480. for (path = 0; path < pathbound; path++) {
  1481. rtl_set_rfreg(hw, (enum radio_path)path, 0xd,
  1482. MASKDWORD, reg_d[path]);
  1483. if (path == RF90_PATH_B) {
  1484. rtl_set_rfreg(hw, RF90_PATH_A, 0x10, MASKDWORD,
  1485. 0x1000f);
  1486. rtl_set_rfreg(hw, RF90_PATH_A, 0x11, MASKDWORD,
  1487. 0x20101);
  1488. }
  1489. if (apk_result[path][1] > 6)
  1490. apk_result[path][1] = 6;
  1491. }
  1492. for (path = 0; path < pathbound; path++) {
  1493. rtl_set_rfreg(hw, (enum radio_path)path, 0x3, MASKDWORD,
  1494. ((apk_result[path][1] << 15) |
  1495. (apk_result[path][1] << 10) |
  1496. (apk_result[path][1] << 5) |
  1497. apk_result[path][1]));
  1498. if (path == RF90_PATH_A)
  1499. rtl_set_rfreg(hw, (enum radio_path)path, 0x4, MASKDWORD,
  1500. ((apk_result[path][1] << 15) |
  1501. (apk_result[path][1] << 10) |
  1502. (0x00 << 5) | 0x05));
  1503. else
  1504. rtl_set_rfreg(hw, (enum radio_path)path, 0x4, MASKDWORD,
  1505. ((apk_result[path][1] << 15) |
  1506. (apk_result[path][1] << 10) |
  1507. (0x02 << 5) | 0x05));
  1508. rtl_set_rfreg(hw, (enum radio_path)path, 0xe, MASKDWORD,
  1509. ((0x08 << 15) | (0x08 << 10) | (0x08 << 5) |
  1510. 0x08));
  1511. }
  1512. rtlphy->apk_done = true;
  1513. #endif
  1514. }
  1515. static void _rtl92c_phy_set_rfpath_switch(struct ieee80211_hw *hw,
  1516. bool bmain, bool is2t)
  1517. {
  1518. struct rtl_hal *rtlhal = rtl_hal(rtl_priv(hw));
  1519. if (is_hal_stop(rtlhal)) {
  1520. rtl_set_bbreg(hw, REG_LEDCFG0, BIT(23), 0x01);
  1521. rtl_set_bbreg(hw, rFPGA0_XAB_RFPARAMETER, BIT(13), 0x01);
  1522. }
  1523. if (is2t) {
  1524. if (bmain)
  1525. rtl_set_bbreg(hw, RFPGA0_XB_RFINTERFACEOE,
  1526. BIT(5) | BIT(6), 0x1);
  1527. else
  1528. rtl_set_bbreg(hw, RFPGA0_XB_RFINTERFACEOE,
  1529. BIT(5) | BIT(6), 0x2);
  1530. } else {
  1531. if (bmain)
  1532. rtl_set_bbreg(hw, RFPGA0_XA_RFINTERFACEOE, 0x300, 0x2);
  1533. else
  1534. rtl_set_bbreg(hw, RFPGA0_XA_RFINTERFACEOE, 0x300, 0x1);
  1535. }
  1536. }
  1537. #undef IQK_ADDA_REG_NUM
  1538. #undef IQK_DELAY_TIME
  1539. void rtl92c_phy_iq_calibrate(struct ieee80211_hw *hw, bool recovery)
  1540. {
  1541. struct rtl_priv *rtlpriv = rtl_priv(hw);
  1542. struct rtl_phy *rtlphy = &(rtlpriv->phy);
  1543. struct rtl_hal *rtlhal = rtl_hal(rtl_priv(hw));
  1544. long result[4][8];
  1545. u8 i, final_candidate;
  1546. bool patha_ok, pathb_ok;
  1547. long reg_e94, reg_e9c, reg_ea4, reg_eac, reg_eb4, reg_ebc, reg_ec4,
  1548. reg_ecc, reg_tmp = 0;
  1549. bool is12simular, is13simular, is23simular;
  1550. bool start_conttx = false, singletone = false;
  1551. u32 iqk_bb_reg[10] = {
  1552. ROFDM0_XARXIQIMBALANCE,
  1553. ROFDM0_XBRXIQIMBALANCE,
  1554. ROFDM0_ECCATHRESHOLD,
  1555. ROFDM0_AGCRSSITABLE,
  1556. ROFDM0_XATXIQIMBALANCE,
  1557. ROFDM0_XBTXIQIMBALANCE,
  1558. ROFDM0_XCTXIQIMBALANCE,
  1559. ROFDM0_XCTXAFE,
  1560. ROFDM0_XDTXAFE,
  1561. ROFDM0_RXIQEXTANTA
  1562. };
  1563. if (recovery) {
  1564. _rtl92c_phy_reload_adda_registers(hw,
  1565. iqk_bb_reg,
  1566. rtlphy->iqk_bb_backup, 10);
  1567. return;
  1568. }
  1569. if (start_conttx || singletone)
  1570. return;
  1571. for (i = 0; i < 8; i++) {
  1572. result[0][i] = 0;
  1573. result[1][i] = 0;
  1574. result[2][i] = 0;
  1575. result[3][i] = 0;
  1576. }
  1577. final_candidate = 0xff;
  1578. patha_ok = false;
  1579. pathb_ok = false;
  1580. is12simular = false;
  1581. is23simular = false;
  1582. is13simular = false;
  1583. for (i = 0; i < 3; i++) {
  1584. if (IS_92C_SERIAL(rtlhal->version))
  1585. _rtl92c_phy_iq_calibrate(hw, result, i, true);
  1586. else
  1587. _rtl92c_phy_iq_calibrate(hw, result, i, false);
  1588. if (i == 1) {
  1589. is12simular = _rtl92c_phy_simularity_compare(hw,
  1590. result, 0,
  1591. 1);
  1592. if (is12simular) {
  1593. final_candidate = 0;
  1594. break;
  1595. }
  1596. }
  1597. if (i == 2) {
  1598. is13simular = _rtl92c_phy_simularity_compare(hw,
  1599. result, 0,
  1600. 2);
  1601. if (is13simular) {
  1602. final_candidate = 0;
  1603. break;
  1604. }
  1605. is23simular = _rtl92c_phy_simularity_compare(hw,
  1606. result, 1,
  1607. 2);
  1608. if (is23simular)
  1609. final_candidate = 1;
  1610. else {
  1611. for (i = 0; i < 8; i++)
  1612. reg_tmp += result[3][i];
  1613. if (reg_tmp != 0)
  1614. final_candidate = 3;
  1615. else
  1616. final_candidate = 0xFF;
  1617. }
  1618. }
  1619. }
  1620. for (i = 0; i < 4; i++) {
  1621. reg_e94 = result[i][0];
  1622. reg_e9c = result[i][1];
  1623. reg_ea4 = result[i][2];
  1624. reg_eac = result[i][3];
  1625. reg_eb4 = result[i][4];
  1626. reg_ebc = result[i][5];
  1627. reg_ec4 = result[i][6];
  1628. reg_ecc = result[i][7];
  1629. }
  1630. if (final_candidate != 0xff) {
  1631. rtlphy->reg_e94 = reg_e94 = result[final_candidate][0];
  1632. rtlphy->reg_e9c = reg_e9c = result[final_candidate][1];
  1633. reg_ea4 = result[final_candidate][2];
  1634. reg_eac = result[final_candidate][3];
  1635. rtlphy->reg_eb4 = reg_eb4 = result[final_candidate][4];
  1636. rtlphy->reg_ebc = reg_ebc = result[final_candidate][5];
  1637. reg_ec4 = result[final_candidate][6];
  1638. reg_ecc = result[final_candidate][7];
  1639. patha_ok = pathb_ok = true;
  1640. } else {
  1641. rtlphy->reg_e94 = rtlphy->reg_eb4 = 0x100;
  1642. rtlphy->reg_e9c = rtlphy->reg_ebc = 0x0;
  1643. }
  1644. if (reg_e94 != 0) /*&&(reg_ea4 != 0) */
  1645. _rtl92c_phy_path_a_fill_iqk_matrix(hw, patha_ok, result,
  1646. final_candidate,
  1647. (reg_ea4 == 0));
  1648. if (IS_92C_SERIAL(rtlhal->version)) {
  1649. if (reg_eb4 != 0) /*&&(reg_ec4 != 0) */
  1650. _rtl92c_phy_path_b_fill_iqk_matrix(hw, pathb_ok,
  1651. result,
  1652. final_candidate,
  1653. (reg_ec4 == 0));
  1654. }
  1655. _rtl92c_phy_save_adda_registers(hw, iqk_bb_reg,
  1656. rtlphy->iqk_bb_backup, 10);
  1657. }
  1658. void rtl92c_phy_lc_calibrate(struct ieee80211_hw *hw)
  1659. {
  1660. struct rtl_hal *rtlhal = rtl_hal(rtl_priv(hw));
  1661. bool start_conttx = false, singletone = false;
  1662. if (start_conttx || singletone)
  1663. return;
  1664. if (IS_92C_SERIAL(rtlhal->version))
  1665. _rtl92c_phy_lc_calibrate(hw, true);
  1666. else
  1667. _rtl92c_phy_lc_calibrate(hw, false);
  1668. }
  1669. void rtl92c_phy_ap_calibrate(struct ieee80211_hw *hw, char delta)
  1670. {
  1671. struct rtl_priv *rtlpriv = rtl_priv(hw);
  1672. struct rtl_phy *rtlphy = &(rtlpriv->phy);
  1673. struct rtl_hal *rtlhal = rtl_hal(rtl_priv(hw));
  1674. if (rtlphy->apk_done)
  1675. return;
  1676. if (IS_92C_SERIAL(rtlhal->version))
  1677. _rtl92c_phy_ap_calibrate(hw, delta, true);
  1678. else
  1679. _rtl92c_phy_ap_calibrate(hw, delta, false);
  1680. }
  1681. void rtl92c_phy_set_rfpath_switch(struct ieee80211_hw *hw, bool bmain)
  1682. {
  1683. struct rtl_hal *rtlhal = rtl_hal(rtl_priv(hw));
  1684. if (IS_92C_SERIAL(rtlhal->version))
  1685. _rtl92c_phy_set_rfpath_switch(hw, bmain, true);
  1686. else
  1687. _rtl92c_phy_set_rfpath_switch(hw, bmain, false);
  1688. }
  1689. bool rtl92c_phy_set_io_cmd(struct ieee80211_hw *hw, enum io_type iotype)
  1690. {
  1691. struct rtl_priv *rtlpriv = rtl_priv(hw);
  1692. struct rtl_phy *rtlphy = &(rtlpriv->phy);
  1693. bool postprocessing = false;
  1694. RT_TRACE(rtlpriv, COMP_CMD, DBG_TRACE,
  1695. ("-->IO Cmd(%#x), set_io_inprogress(%d)\n",
  1696. iotype, rtlphy->set_io_inprogress));
  1697. do {
  1698. switch (iotype) {
  1699. case IO_CMD_RESUME_DM_BY_SCAN:
  1700. RT_TRACE(rtlpriv, COMP_CMD, DBG_TRACE,
  1701. ("[IO CMD] Resume DM after scan.\n"));
  1702. postprocessing = true;
  1703. break;
  1704. case IO_CMD_PAUSE_DM_BY_SCAN:
  1705. RT_TRACE(rtlpriv, COMP_CMD, DBG_TRACE,
  1706. ("[IO CMD] Pause DM before scan.\n"));
  1707. postprocessing = true;
  1708. break;
  1709. default:
  1710. RT_TRACE(rtlpriv, COMP_ERR, DBG_EMERG,
  1711. ("switch case not process\n"));
  1712. break;
  1713. }
  1714. } while (false);
  1715. if (postprocessing && !rtlphy->set_io_inprogress) {
  1716. rtlphy->set_io_inprogress = true;
  1717. rtlphy->current_io_type = iotype;
  1718. } else {
  1719. return false;
  1720. }
  1721. rtl92c_phy_set_io(hw);
  1722. RT_TRACE(rtlpriv, COMP_CMD, DBG_TRACE, ("<--IO Type(%#x)\n", iotype));
  1723. return true;
  1724. }
  1725. void rtl92c_phy_set_io(struct ieee80211_hw *hw)
  1726. {
  1727. struct rtl_priv *rtlpriv = rtl_priv(hw);
  1728. struct rtl_phy *rtlphy = &(rtlpriv->phy);
  1729. RT_TRACE(rtlpriv, COMP_CMD, DBG_TRACE,
  1730. ("--->Cmd(%#x), set_io_inprogress(%d)\n",
  1731. rtlphy->current_io_type, rtlphy->set_io_inprogress));
  1732. switch (rtlphy->current_io_type) {
  1733. case IO_CMD_RESUME_DM_BY_SCAN:
  1734. dm_digtable.cur_igvalue = rtlphy->initgain_backup.xaagccore1;
  1735. rtl92c_dm_write_dig(hw);
  1736. rtl92c_phy_set_txpower_level(hw, rtlphy->current_channel);
  1737. break;
  1738. case IO_CMD_PAUSE_DM_BY_SCAN:
  1739. rtlphy->initgain_backup.xaagccore1 = dm_digtable.cur_igvalue;
  1740. dm_digtable.cur_igvalue = 0x17;
  1741. rtl92c_dm_write_dig(hw);
  1742. break;
  1743. default:
  1744. RT_TRACE(rtlpriv, COMP_ERR, DBG_EMERG,
  1745. ("switch case not process\n"));
  1746. break;
  1747. }
  1748. rtlphy->set_io_inprogress = false;
  1749. RT_TRACE(rtlpriv, COMP_CMD, DBG_TRACE,
  1750. ("<---(%#x)\n", rtlphy->current_io_type));
  1751. }
  1752. void rtl92ce_phy_set_rf_on(struct ieee80211_hw *hw)
  1753. {
  1754. struct rtl_priv *rtlpriv = rtl_priv(hw);
  1755. rtl_write_byte(rtlpriv, REG_SPS0_CTRL, 0x2b);
  1756. rtl_write_byte(rtlpriv, REG_SYS_FUNC_EN, 0xE3);
  1757. rtl_write_byte(rtlpriv, REG_APSD_CTRL, 0x00);
  1758. rtl_write_byte(rtlpriv, REG_SYS_FUNC_EN, 0xE2);
  1759. rtl_write_byte(rtlpriv, REG_SYS_FUNC_EN, 0xE3);
  1760. rtl_write_byte(rtlpriv, REG_TXPAUSE, 0x00);
  1761. }
  1762. static void _rtl92ce_phy_set_rf_sleep(struct ieee80211_hw *hw)
  1763. {
  1764. u32 u4b_tmp;
  1765. u8 delay = 5;
  1766. struct rtl_priv *rtlpriv = rtl_priv(hw);
  1767. rtl_write_byte(rtlpriv, REG_TXPAUSE, 0xFF);
  1768. rtl_set_rfreg(hw, RF90_PATH_A, 0x00, RFREG_OFFSET_MASK, 0x00);
  1769. rtl_write_byte(rtlpriv, REG_APSD_CTRL, 0x40);
  1770. u4b_tmp = rtl_get_rfreg(hw, RF90_PATH_A, 0, RFREG_OFFSET_MASK);
  1771. while (u4b_tmp != 0 && delay > 0) {
  1772. rtl_write_byte(rtlpriv, REG_APSD_CTRL, 0x0);
  1773. rtl_set_rfreg(hw, RF90_PATH_A, 0x00, RFREG_OFFSET_MASK, 0x00);
  1774. rtl_write_byte(rtlpriv, REG_APSD_CTRL, 0x40);
  1775. u4b_tmp = rtl_get_rfreg(hw, RF90_PATH_A, 0, RFREG_OFFSET_MASK);
  1776. delay--;
  1777. }
  1778. if (delay == 0) {
  1779. rtl_write_byte(rtlpriv, REG_APSD_CTRL, 0x00);
  1780. rtl_write_byte(rtlpriv, REG_SYS_FUNC_EN, 0xE2);
  1781. rtl_write_byte(rtlpriv, REG_SYS_FUNC_EN, 0xE3);
  1782. rtl_write_byte(rtlpriv, REG_TXPAUSE, 0x00);
  1783. RT_TRACE(rtlpriv, COMP_POWER, DBG_TRACE,
  1784. ("Switch RF timeout !!!.\n"));
  1785. return;
  1786. }
  1787. rtl_write_byte(rtlpriv, REG_SYS_FUNC_EN, 0xE2);
  1788. rtl_write_byte(rtlpriv, REG_SPS0_CTRL, 0x22);
  1789. }