phydm.c 95 KB

1234567891011121314151617181920212223242526272829303132333435363738394041424344454647484950515253545556575859606162636465666768697071727374757677787980818283848586878889909192939495969798991001011021031041051061071081091101111121131141151161171181191201211221231241251261271281291301311321331341351361371381391401411421431441451461471481491501511521531541551561571581591601611621631641651661671681691701711721731741751761771781791801811821831841851861871881891901911921931941951961971981992002012022032042052062072082092102112122132142152162172182192202212222232242252262272282292302312322332342352362372382392402412422432442452462472482492502512522532542552562572582592602612622632642652662672682692702712722732742752762772782792802812822832842852862872882892902912922932942952962972982993003013023033043053063073083093103113123133143153163173183193203213223233243253263273283293303313323333343353363373383393403413423433443453463473483493503513523533543553563573583593603613623633643653663673683693703713723733743753763773783793803813823833843853863873883893903913923933943953963973983994004014024034044054064074084094104114124134144154164174184194204214224234244254264274284294304314324334344354364374384394404414424434444454464474484494504514524534544554564574584594604614624634644654664674684694704714724734744754764774784794804814824834844854864874884894904914924934944954964974984995005015025035045055065075085095105115125135145155165175185195205215225235245255265275285295305315325335345355365375385395405415425435445455465475485495505515525535545555565575585595605615625635645655665675685695705715725735745755765775785795805815825835845855865875885895905915925935945955965975985996006016026036046056066076086096106116126136146156166176186196206216226236246256266276286296306316326336346356366376386396406416426436446456466476486496506516526536546556566576586596606616626636646656666676686696706716726736746756766776786796806816826836846856866876886896906916926936946956966976986997007017027037047057067077087097107117127137147157167177187197207217227237247257267277287297307317327337347357367377387397407417427437447457467477487497507517527537547557567577587597607617627637647657667677687697707717727737747757767777787797807817827837847857867877887897907917927937947957967977987998008018028038048058068078088098108118128138148158168178188198208218228238248258268278288298308318328338348358368378388398408418428438448458468478488498508518528538548558568578588598608618628638648658668678688698708718728738748758768778788798808818828838848858868878888898908918928938948958968978988999009019029039049059069079089099109119129139149159169179189199209219229239249259269279289299309319329339349359369379389399409419429439449459469479489499509519529539549559569579589599609619629639649659669679689699709719729739749759769779789799809819829839849859869879889899909919929939949959969979989991000100110021003100410051006100710081009101010111012101310141015101610171018101910201021102210231024102510261027102810291030103110321033103410351036103710381039104010411042104310441045104610471048104910501051105210531054105510561057105810591060106110621063106410651066106710681069107010711072107310741075107610771078107910801081108210831084108510861087108810891090109110921093109410951096109710981099110011011102110311041105110611071108110911101111111211131114111511161117111811191120112111221123112411251126112711281129113011311132113311341135113611371138113911401141114211431144114511461147114811491150115111521153115411551156115711581159116011611162116311641165116611671168116911701171117211731174117511761177117811791180118111821183118411851186118711881189119011911192119311941195119611971198119912001201120212031204120512061207120812091210121112121213121412151216121712181219122012211222122312241225122612271228122912301231123212331234123512361237123812391240124112421243124412451246124712481249125012511252125312541255125612571258125912601261126212631264126512661267126812691270127112721273127412751276127712781279128012811282128312841285128612871288128912901291129212931294129512961297129812991300130113021303130413051306130713081309131013111312131313141315131613171318131913201321132213231324132513261327132813291330133113321333133413351336133713381339134013411342134313441345134613471348134913501351135213531354135513561357135813591360136113621363136413651366136713681369137013711372137313741375137613771378137913801381138213831384138513861387138813891390139113921393139413951396139713981399140014011402140314041405140614071408140914101411141214131414141514161417141814191420142114221423142414251426142714281429143014311432143314341435143614371438143914401441144214431444144514461447144814491450145114521453145414551456145714581459146014611462146314641465146614671468146914701471147214731474147514761477147814791480148114821483148414851486148714881489149014911492149314941495149614971498149915001501150215031504150515061507150815091510151115121513151415151516151715181519152015211522152315241525152615271528152915301531153215331534153515361537153815391540154115421543154415451546154715481549155015511552155315541555155615571558155915601561156215631564156515661567156815691570157115721573157415751576157715781579158015811582158315841585158615871588158915901591159215931594159515961597159815991600160116021603160416051606160716081609161016111612161316141615161616171618161916201621162216231624162516261627162816291630163116321633163416351636163716381639164016411642164316441645164616471648164916501651165216531654165516561657165816591660166116621663166416651666166716681669167016711672167316741675167616771678167916801681168216831684168516861687168816891690169116921693169416951696169716981699170017011702170317041705170617071708170917101711171217131714171517161717171817191720172117221723172417251726172717281729173017311732173317341735173617371738173917401741174217431744174517461747174817491750175117521753175417551756175717581759176017611762176317641765176617671768176917701771177217731774177517761777177817791780178117821783178417851786178717881789179017911792179317941795179617971798179918001801180218031804180518061807180818091810181118121813181418151816181718181819182018211822182318241825182618271828182918301831183218331834183518361837183818391840184118421843184418451846184718481849185018511852185318541855185618571858185918601861186218631864186518661867186818691870187118721873187418751876187718781879188018811882188318841885188618871888188918901891189218931894189518961897189818991900190119021903190419051906190719081909191019111912191319141915191619171918191919201921192219231924192519261927192819291930193119321933193419351936193719381939194019411942194319441945194619471948194919501951195219531954195519561957195819591960196119621963196419651966196719681969197019711972197319741975197619771978197919801981198219831984198519861987198819891990199119921993199419951996199719981999200020012002200320042005200620072008200920102011201220132014201520162017201820192020202120222023202420252026202720282029203020312032203320342035203620372038203920402041204220432044204520462047204820492050205120522053205420552056205720582059206020612062206320642065206620672068206920702071207220732074207520762077207820792080208120822083208420852086208720882089209020912092209320942095209620972098209921002101210221032104210521062107210821092110211121122113211421152116211721182119212021212122212321242125212621272128212921302131213221332134213521362137213821392140214121422143214421452146214721482149215021512152215321542155215621572158215921602161216221632164216521662167216821692170217121722173217421752176217721782179218021812182218321842185218621872188218921902191219221932194219521962197219821992200220122022203220422052206220722082209221022112212221322142215221622172218221922202221222222232224222522262227222822292230223122322233223422352236223722382239224022412242224322442245224622472248224922502251225222532254225522562257225822592260226122622263226422652266226722682269227022712272227322742275227622772278227922802281228222832284228522862287228822892290229122922293229422952296229722982299230023012302230323042305230623072308230923102311231223132314231523162317231823192320232123222323232423252326232723282329233023312332233323342335233623372338233923402341234223432344234523462347234823492350235123522353235423552356235723582359236023612362236323642365236623672368236923702371237223732374237523762377237823792380238123822383238423852386238723882389239023912392239323942395239623972398239924002401240224032404240524062407240824092410241124122413241424152416241724182419242024212422242324242425242624272428242924302431243224332434243524362437243824392440244124422443244424452446244724482449245024512452245324542455245624572458245924602461246224632464246524662467246824692470247124722473247424752476247724782479248024812482248324842485248624872488248924902491249224932494249524962497249824992500250125022503250425052506250725082509251025112512251325142515251625172518251925202521252225232524252525262527252825292530253125322533253425352536253725382539254025412542254325442545254625472548254925502551255225532554255525562557255825592560256125622563256425652566256725682569257025712572257325742575257625772578257925802581258225832584258525862587258825892590259125922593259425952596259725982599260026012602260326042605260626072608260926102611261226132614261526162617261826192620262126222623262426252626262726282629263026312632263326342635263626372638263926402641264226432644264526462647264826492650265126522653265426552656265726582659266026612662266326642665266626672668266926702671267226732674267526762677267826792680268126822683268426852686268726882689269026912692269326942695269626972698269927002701270227032704270527062707270827092710271127122713271427152716271727182719272027212722272327242725272627272728272927302731273227332734273527362737273827392740274127422743274427452746274727482749275027512752275327542755275627572758275927602761276227632764276527662767276827692770277127722773277427752776277727782779278027812782278327842785278627872788278927902791279227932794279527962797279827992800280128022803280428052806280728082809281028112812281328142815281628172818281928202821282228232824282528262827282828292830283128322833283428352836283728382839284028412842284328442845284628472848284928502851285228532854285528562857285828592860286128622863286428652866286728682869287028712872287328742875287628772878287928802881288228832884288528862887288828892890289128922893289428952896289728982899290029012902290329042905290629072908290929102911291229132914291529162917291829192920292129222923292429252926292729282929293029312932293329342935293629372938293929402941294229432944294529462947294829492950295129522953295429552956295729582959296029612962296329642965296629672968296929702971297229732974297529762977297829792980298129822983298429852986298729882989299029912992299329942995299629972998299930003001300230033004300530063007300830093010301130123013301430153016301730183019302030213022302330243025302630273028302930303031303230333034303530363037303830393040304130423043304430453046304730483049305030513052305330543055305630573058305930603061306230633064306530663067306830693070307130723073307430753076307730783079308030813082308330843085308630873088308930903091309230933094309530963097309830993100310131023103310431053106310731083109311031113112311331143115311631173118311931203121312231233124312531263127312831293130313131323133313431353136313731383139314031413142314331443145314631473148314931503151315231533154315531563157315831593160316131623163316431653166316731683169317031713172317331743175317631773178317931803181318231833184318531863187318831893190319131923193319431953196319731983199320032013202320332043205320632073208320932103211321232133214321532163217321832193220322132223223322432253226322732283229323032313232323332343235323632373238323932403241324232433244324532463247324832493250325132523253325432553256325732583259326032613262326332643265326632673268326932703271327232733274327532763277327832793280328132823283328432853286328732883289329032913292329332943295329632973298329933003301330233033304330533063307330833093310331133123313331433153316331733183319332033213322332333243325332633273328332933303331333233333334333533363337333833393340334133423343334433453346334733483349335033513352335333543355335633573358335933603361336233633364336533663367336833693370337133723373337433753376337733783379338033813382338333843385338633873388338933903391339233933394339533963397339833993400340134023403340434053406340734083409341034113412341334143415341634173418341934203421342234233424342534263427342834293430343134323433343434353436343734383439344034413442344334443445344634473448344934503451345234533454345534563457345834593460346134623463346434653466346734683469347034713472347334743475347634773478347934803481348234833484348534863487348834893490349134923493349434953496349734983499350035013502350335043505350635073508350935103511351235133514
  1. /******************************************************************************
  2. *
  3. * Copyright(c) 2007 - 2011 Realtek Corporation. All rights reserved.
  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. *
  19. ******************************************************************************/
  20. /* ************************************************************
  21. * include files
  22. * ************************************************************ */
  23. #include "mp_precomp.h"
  24. #include "phydm_precomp.h"
  25. const u16 db_invert_table[12][8] = {
  26. { 1, 1, 1, 2, 2, 2, 2, 3},
  27. { 3, 3, 4, 4, 4, 5, 6, 6},
  28. { 7, 8, 9, 10, 11, 13, 14, 16},
  29. { 18, 20, 22, 25, 28, 32, 35, 40},
  30. { 45, 50, 56, 63, 71, 79, 89, 100},
  31. { 112, 126, 141, 158, 178, 200, 224, 251},
  32. { 282, 316, 355, 398, 447, 501, 562, 631},
  33. { 708, 794, 891, 1000, 1122, 1259, 1413, 1585},
  34. { 1778, 1995, 2239, 2512, 2818, 3162, 3548, 3981},
  35. { 4467, 5012, 5623, 6310, 7079, 7943, 8913, 10000},
  36. { 11220, 12589, 14125, 15849, 17783, 19953, 22387, 25119},
  37. { 28184, 31623, 35481, 39811, 44668, 50119, 56234, 65535}
  38. };
  39. /* ************************************************************
  40. * Local Function predefine.
  41. * ************************************************************ */
  42. /* START------------COMMON INFO RELATED--------------- */
  43. void
  44. odm_global_adapter_check(
  45. void
  46. );
  47. /* move to odm_PowerTacking.h by YuChen */
  48. void
  49. odm_update_power_training_state(
  50. struct PHY_DM_STRUCT *p_dm_odm
  51. );
  52. /* ************************************************************
  53. * 3 Export Interface
  54. * ************************************************************ */
  55. /*Y = 10*log(X)*/
  56. s32
  57. odm_pwdb_conversion(
  58. s32 X,
  59. u32 total_bit,
  60. u32 decimal_bit
  61. )
  62. {
  63. s32 Y, integer = 0, decimal = 0;
  64. u32 i;
  65. if (X == 0)
  66. X = 1; /* log2(x), x can't be 0 */
  67. for (i = (total_bit - 1); i > 0; i--) {
  68. if (X & BIT(i)) {
  69. integer = i;
  70. if (i > 0)
  71. decimal = (X & BIT(i - 1)) ? 2 : 0; /* decimal is 0.5dB*3=1.5dB~=2dB */
  72. break;
  73. }
  74. }
  75. Y = 3 * (integer - decimal_bit) + decimal; /* 10*log(x)=3*log2(x), */
  76. return Y;
  77. }
  78. s32
  79. odm_sign_conversion(
  80. s32 value,
  81. u32 total_bit
  82. )
  83. {
  84. if (value & BIT(total_bit - 1))
  85. value -= BIT(total_bit);
  86. return value;
  87. }
  88. void
  89. phydm_seq_sorting(
  90. void *p_dm_void,
  91. u32 *p_value,
  92. u32 *rank_idx,
  93. u32 *p_idx_out,
  94. u8 seq_length
  95. )
  96. {
  97. struct PHY_DM_STRUCT *p_dm_odm = (struct PHY_DM_STRUCT *)p_dm_void;
  98. u8 i = 0, j = 0;
  99. u32 tmp_a, tmp_b;
  100. u32 tmp_idx_a, tmp_idx_b;
  101. for (i = 0; i < seq_length; i++) {
  102. rank_idx[i] = i;
  103. /**/
  104. }
  105. for (i = 0; i < (seq_length - 1); i++) {
  106. for (j = 0; j < (seq_length - 1 - i); j++) {
  107. tmp_a = p_value[j];
  108. tmp_b = p_value[j + 1];
  109. tmp_idx_a = rank_idx[j];
  110. tmp_idx_b = rank_idx[j + 1];
  111. if (tmp_a < tmp_b) {
  112. p_value[j] = tmp_b;
  113. p_value[j + 1] = tmp_a;
  114. rank_idx[j] = tmp_idx_b;
  115. rank_idx[j + 1] = tmp_idx_a;
  116. }
  117. }
  118. }
  119. for (i = 0; i < seq_length; i++) {
  120. p_idx_out[rank_idx[i]] = i + 1;
  121. /**/
  122. }
  123. }
  124. void
  125. odm_init_mp_driver_status(
  126. struct PHY_DM_STRUCT *p_dm_odm
  127. )
  128. {
  129. #if (DM_ODM_SUPPORT_TYPE & ODM_WIN)
  130. /* Decide when compile time */
  131. #if (MP_DRIVER == 1)
  132. p_dm_odm->mp_mode = true;
  133. #else
  134. p_dm_odm->mp_mode = false;
  135. #endif
  136. #elif (DM_ODM_SUPPORT_TYPE & ODM_CE)
  137. struct _ADAPTER *adapter = p_dm_odm->adapter;
  138. /* Update information every period */
  139. p_dm_odm->mp_mode = (boolean)adapter->registrypriv.mp_mode;
  140. #else
  141. struct rtl8192cd_priv *priv = p_dm_odm->priv;
  142. p_dm_odm->mp_mode = (boolean)priv->pshare->rf_ft_var.mp_specific;
  143. #endif
  144. }
  145. void
  146. odm_update_mp_driver_status(
  147. struct PHY_DM_STRUCT *p_dm_odm
  148. )
  149. {
  150. #if (DM_ODM_SUPPORT_TYPE & ODM_WIN)
  151. /* Do nothing. */
  152. #elif (DM_ODM_SUPPORT_TYPE & ODM_CE)
  153. struct _ADAPTER *adapter = p_dm_odm->adapter;
  154. /* Update information erery period */
  155. p_dm_odm->mp_mode = (boolean)adapter->registrypriv.mp_mode;
  156. #else
  157. /* Do nothing. */
  158. #endif
  159. }
  160. void
  161. phydm_init_trx_antenna_setting(
  162. struct PHY_DM_STRUCT *p_dm_odm
  163. )
  164. {
  165. /*#if (RTL8814A_SUPPORT == 1)*/
  166. if (p_dm_odm->support_ic_type & (ODM_RTL8814A)) {
  167. u8 rx_ant = 0, tx_ant = 0;
  168. rx_ant = (u8)odm_get_bb_reg(p_dm_odm, ODM_REG(BB_RX_PATH, p_dm_odm), ODM_BIT(BB_RX_PATH, p_dm_odm));
  169. tx_ant = (u8)odm_get_bb_reg(p_dm_odm, ODM_REG(BB_TX_PATH, p_dm_odm), ODM_BIT(BB_TX_PATH, p_dm_odm));
  170. p_dm_odm->tx_ant_status = (tx_ant & 0xf);
  171. p_dm_odm->rx_ant_status = (rx_ant & 0xf);
  172. } else if (p_dm_odm->support_ic_type & (ODM_RTL8723D | ODM_RTL8821C | ODM_RTL8710B)) {/* JJ ADD 20161014 */
  173. p_dm_odm->tx_ant_status = 0x1;
  174. p_dm_odm->rx_ant_status = 0x1;
  175. }
  176. /*#endif*/
  177. }
  178. void
  179. phydm_traffic_load_decision(
  180. void *p_dm_void
  181. )
  182. {
  183. struct PHY_DM_STRUCT *p_dm_odm = (struct PHY_DM_STRUCT *)p_dm_void;
  184. struct _sw_antenna_switch_ *p_dm_swat_table = &p_dm_odm->dm_swat_table;
  185. /*---TP & Trafic-load calculation---*/
  186. if (p_dm_odm->last_tx_ok_cnt > (*(p_dm_odm->p_num_tx_bytes_unicast)))
  187. p_dm_odm->last_tx_ok_cnt = (*(p_dm_odm->p_num_tx_bytes_unicast));
  188. if (p_dm_odm->last_rx_ok_cnt > (*(p_dm_odm->p_num_rx_bytes_unicast)))
  189. p_dm_odm->last_rx_ok_cnt = (*(p_dm_odm->p_num_rx_bytes_unicast));
  190. p_dm_odm->cur_tx_ok_cnt = *(p_dm_odm->p_num_tx_bytes_unicast) - p_dm_odm->last_tx_ok_cnt;
  191. p_dm_odm->cur_rx_ok_cnt = *(p_dm_odm->p_num_rx_bytes_unicast) - p_dm_odm->last_rx_ok_cnt;
  192. p_dm_odm->last_tx_ok_cnt = *(p_dm_odm->p_num_tx_bytes_unicast);
  193. p_dm_odm->last_rx_ok_cnt = *(p_dm_odm->p_num_rx_bytes_unicast);
  194. #if (DM_ODM_SUPPORT_TYPE & ODM_AP)
  195. p_dm_odm->tx_tp = ((p_dm_odm->tx_tp) >> 1) + (u32)(((p_dm_odm->cur_tx_ok_cnt) >> 17) >> 1); /* <<3(8bit), >>20(10^6,M)*/
  196. p_dm_odm->rx_tp = ((p_dm_odm->rx_tp) >> 1) + (u32)(((p_dm_odm->cur_rx_ok_cnt) >> 17) >> 1); /* <<3(8bit), >>20(10^6,M)*/
  197. #else
  198. p_dm_odm->tx_tp = ((p_dm_odm->tx_tp) >> 1) + (u32)(((p_dm_odm->cur_tx_ok_cnt) >> 18) >> 1); /* <<3(8bit), >>20(10^6,M), >>1(2sec)*/
  199. p_dm_odm->rx_tp = ((p_dm_odm->rx_tp) >> 1) + (u32)(((p_dm_odm->cur_rx_ok_cnt) >> 18) >> 1); /* <<3(8bit), >>20(10^6,M), >>1(2sec)*/
  200. #endif
  201. p_dm_odm->total_tp = p_dm_odm->tx_tp + p_dm_odm->rx_tp;
  202. if (p_dm_odm->total_tp == 0)
  203. p_dm_odm->consecutive_idlel_time += PHYDM_WATCH_DOG_PERIOD;
  204. else
  205. p_dm_odm->consecutive_idlel_time = 0;
  206. /*
  207. ODM_RT_TRACE(p_dm_odm, ODM_COMP_COMMON, ODM_DBG_LOUD, ("cur_tx_ok_cnt = %d, cur_rx_ok_cnt = %d, last_tx_ok_cnt = %d, last_rx_ok_cnt = %d\n",
  208. p_dm_odm->cur_tx_ok_cnt, p_dm_odm->cur_rx_ok_cnt, p_dm_odm->last_tx_ok_cnt, p_dm_odm->last_rx_ok_cnt));
  209. ODM_RT_TRACE(p_dm_odm, ODM_COMP_COMMON, ODM_DBG_LOUD, ("tx_tp = %d, rx_tp = %d\n",
  210. p_dm_odm->tx_tp, p_dm_odm->rx_tp));
  211. */
  212. p_dm_odm->pre_traffic_load = p_dm_odm->traffic_load;
  213. if (p_dm_odm->cur_tx_ok_cnt > 1875000 || p_dm_odm->cur_rx_ok_cnt > 1875000) { /* ( 1.875M * 8bit ) / 2sec= 7.5M bits /sec )*/
  214. p_dm_odm->traffic_load = TRAFFIC_HIGH;
  215. /**/
  216. } else if (p_dm_odm->cur_tx_ok_cnt > 500000 || p_dm_odm->cur_rx_ok_cnt > 500000) { /*( 0.5M * 8bit ) / 2sec = 2M bits /sec )*/
  217. p_dm_odm->traffic_load = TRAFFIC_MID;
  218. /**/
  219. } else if (p_dm_odm->cur_tx_ok_cnt > 100000 || p_dm_odm->cur_rx_ok_cnt > 100000) { /*( 0.1M * 8bit ) / 2sec = 0.4M bits /sec )*/
  220. p_dm_odm->traffic_load = TRAFFIC_LOW;
  221. /**/
  222. } else {
  223. p_dm_odm->traffic_load = TRAFFIC_ULTRA_LOW;
  224. /**/
  225. }
  226. }
  227. void
  228. phydm_config_ofdm_tx_path(
  229. struct PHY_DM_STRUCT *p_dm_odm,
  230. u32 path
  231. )
  232. {
  233. u8 ofdm_tx_path = 0x33;
  234. #if (RTL8192E_SUPPORT == 1)
  235. if (p_dm_odm->support_ic_type & (ODM_RTL8192E)) {
  236. if (path == PHYDM_A) {
  237. odm_set_bb_reg(p_dm_odm, 0x90c, MASKDWORD, 0x81121111);
  238. /**/
  239. } else if (path == PHYDM_B) {
  240. odm_set_bb_reg(p_dm_odm, 0x90c, MASKDWORD, 0x82221222);
  241. /**/
  242. } else if (path == PHYDM_AB) {
  243. odm_set_bb_reg(p_dm_odm, 0x90c, MASKDWORD, 0x83321333);
  244. /**/
  245. }
  246. }
  247. #endif
  248. #if (RTL8812A_SUPPORT == 1)
  249. if (p_dm_odm->support_ic_type & (ODM_RTL8812)) {
  250. if (path == PHYDM_A) {
  251. ofdm_tx_path = 0x11;
  252. /**/
  253. } else if (path == PHYDM_B) {
  254. ofdm_tx_path = 0x22;
  255. /**/
  256. } else if (path == PHYDM_AB) {
  257. ofdm_tx_path = 0x33;
  258. /**/
  259. }
  260. odm_set_bb_reg(p_dm_odm, 0x80c, 0xff00, ofdm_tx_path);
  261. }
  262. #endif
  263. }
  264. void
  265. phydm_config_ofdm_rx_path(
  266. struct PHY_DM_STRUCT *p_dm_odm,
  267. u32 path
  268. )
  269. {
  270. u8 ofdm_rx_path = 0;
  271. if (p_dm_odm->support_ic_type & (ODM_RTL8192E)) {
  272. #if (RTL8192E_SUPPORT == 1)
  273. if (path == PHYDM_A) {
  274. ofdm_rx_path = 1;
  275. /**/
  276. } else if (path == PHYDM_B) {
  277. ofdm_rx_path = 2;
  278. /**/
  279. } else if (path == PHYDM_AB) {
  280. ofdm_rx_path = 3;
  281. /**/
  282. }
  283. odm_set_bb_reg(p_dm_odm, 0xC04, 0xff, (((ofdm_rx_path) << 4) | ofdm_rx_path));
  284. odm_set_bb_reg(p_dm_odm, 0xD04, 0xf, ofdm_rx_path);
  285. #endif
  286. }
  287. #if (RTL8812A_SUPPORT || RTL8822B_SUPPORT)
  288. else if (p_dm_odm->support_ic_type & (ODM_RTL8812 | ODM_RTL8822B)) {
  289. if (path == PHYDM_A) {
  290. ofdm_rx_path = 1;
  291. /**/
  292. } else if (path == PHYDM_B) {
  293. ofdm_rx_path = 2;
  294. /**/
  295. } else if (path == PHYDM_AB) {
  296. ofdm_rx_path = 3;
  297. /**/
  298. }
  299. odm_set_bb_reg(p_dm_odm, 0x808, MASKBYTE0, ((ofdm_rx_path << 4) | ofdm_rx_path));
  300. }
  301. #endif
  302. }
  303. void
  304. phydm_config_cck_rx_antenna_init(
  305. struct PHY_DM_STRUCT *p_dm_odm
  306. )
  307. {
  308. #if ((RTL8192E_SUPPORT == 1) || (RTL8812A_SUPPORT == 1))
  309. if (p_dm_odm->support_ic_type & (ODM_RTL8192E | ODM_RTL8812)) {
  310. /*CCK 2R CCA parameters*/
  311. odm_set_bb_reg(p_dm_odm, 0xa2c, BIT(18), 1); /*enable 2R Rx path*/
  312. odm_set_bb_reg(p_dm_odm, 0xa2c, BIT(22), 1); /*enable 2R MRC*/
  313. odm_set_bb_reg(p_dm_odm, 0xa84, BIT(28), 1); /*1. pdx1[5:0] > 2*PD_lim 2. RXIQ_3 = 0 ( signed )*/
  314. odm_set_bb_reg(p_dm_odm, 0xa70, BIT(7), 0); /*Concurrent CCA at LSB & USB*/
  315. odm_set_bb_reg(p_dm_odm, 0xa74, BIT(8), 0); /*RX path diversity enable*/
  316. odm_set_bb_reg(p_dm_odm, 0xa08, BIT(28), 1); /* r_cck_2nd_sel_eco*/
  317. odm_set_bb_reg(p_dm_odm, 0xa14, BIT(7), 0); /* r_en_mrc_antsel*/
  318. }
  319. #endif
  320. }
  321. void
  322. phydm_config_cck_rx_path(
  323. struct PHY_DM_STRUCT *p_dm_odm,
  324. u8 path,
  325. u8 path_div_en
  326. )
  327. {
  328. u8 path_div_select = 0;
  329. u8 cck_1_path = 0, cck_2_path = 0;
  330. #if ((RTL8192E_SUPPORT == 1) || (RTL8812A_SUPPORT == 1))
  331. if (p_dm_odm->support_ic_type & (ODM_RTL8192E | ODM_RTL8812)) {
  332. if (path == PHYDM_A) {
  333. path_div_select = 0;
  334. cck_1_path = 0;
  335. cck_2_path = 0;
  336. } else if (path == PHYDM_B) {
  337. path_div_select = 0;
  338. cck_1_path = 1;
  339. cck_2_path = 1;
  340. } else if (path == PHYDM_AB) {
  341. if (path_div_en == CCA_PATHDIV_ENABLE)
  342. path_div_select = 1;
  343. cck_1_path = 0;
  344. cck_2_path = 1;
  345. }
  346. odm_set_bb_reg(p_dm_odm, 0xa04, (BIT(27) | BIT(26)), cck_1_path);
  347. odm_set_bb_reg(p_dm_odm, 0xa04, (BIT(25) | BIT(24)), cck_2_path);
  348. odm_set_bb_reg(p_dm_odm, 0xa74, BIT(8), path_div_select);
  349. }
  350. #endif
  351. }
  352. void
  353. phydm_config_trx_path(
  354. void *p_dm_void,
  355. u32 *const dm_value,
  356. u32 *_used,
  357. char *output,
  358. u32 *_out_len
  359. )
  360. {
  361. struct PHY_DM_STRUCT *p_dm_odm = (struct PHY_DM_STRUCT *)p_dm_void;
  362. u32 pre_support_ability;
  363. u32 used = *_used;
  364. u32 out_len = *_out_len;
  365. /* CCK */
  366. if (dm_value[0] == 0) {
  367. if (dm_value[1] == 1) { /*TX*/
  368. if (dm_value[2] == 1)
  369. odm_set_bb_reg(p_dm_odm, 0xa04, 0xf0000000, 0x8);
  370. else if (dm_value[2] == 2)
  371. odm_set_bb_reg(p_dm_odm, 0xa04, 0xf0000000, 0x4);
  372. else if (dm_value[2] == 3)
  373. odm_set_bb_reg(p_dm_odm, 0xa04, 0xf0000000, 0xc);
  374. } else if (dm_value[1] == 2) { /*RX*/
  375. phydm_config_cck_rx_antenna_init(p_dm_odm);
  376. if (dm_value[2] == 1)
  377. phydm_config_cck_rx_path(p_dm_odm, PHYDM_A, CCA_PATHDIV_DISABLE);
  378. else if (dm_value[2] == 2)
  379. phydm_config_cck_rx_path(p_dm_odm, PHYDM_B, CCA_PATHDIV_DISABLE);
  380. else if (dm_value[2] == 3) {
  381. if (dm_value[3] == 1) /*enable path diversity*/
  382. phydm_config_cck_rx_path(p_dm_odm, PHYDM_AB, CCA_PATHDIV_ENABLE);
  383. else
  384. phydm_config_cck_rx_path(p_dm_odm, PHYDM_B, CCA_PATHDIV_DISABLE);
  385. }
  386. }
  387. }
  388. /* OFDM */
  389. else if (dm_value[0] == 1) {
  390. if (dm_value[1] == 1) { /*TX*/
  391. phydm_config_ofdm_tx_path(p_dm_odm, dm_value[2]);
  392. /**/
  393. } else if (dm_value[1] == 2) { /*RX*/
  394. phydm_config_ofdm_rx_path(p_dm_odm, dm_value[2]);
  395. /**/
  396. }
  397. }
  398. PHYDM_SNPRINTF((output + used, out_len - used, "PHYDM Set path [%s] [%s] = [%s%s%s%s]\n",
  399. (dm_value[0] == 1) ? "OFDM" : "CCK",
  400. (dm_value[1] == 1) ? "TX" : "RX",
  401. (dm_value[2] & 0x1) ? "A" : "",
  402. (dm_value[2] & 0x2) ? "B" : "",
  403. (dm_value[2] & 0x4) ? "C" : "",
  404. (dm_value[2] & 0x8) ? "D" : ""
  405. ));
  406. }
  407. void
  408. phydm_init_cck_setting(
  409. struct PHY_DM_STRUCT *p_dm_odm
  410. )
  411. {
  412. u32 value_824, value_82c;
  413. p_dm_odm->is_cck_high_power = (boolean) odm_get_bb_reg(p_dm_odm, ODM_REG(CCK_RPT_FORMAT, p_dm_odm), ODM_BIT(CCK_RPT_FORMAT, p_dm_odm));
  414. #if (RTL8192E_SUPPORT == 1)
  415. if (p_dm_odm->support_ic_type & (ODM_RTL8192E)) {
  416. #if (DM_ODM_SUPPORT_TYPE == ODM_WIN)
  417. phydm_config_cck_rx_antenna_init(p_dm_odm);
  418. phydm_config_cck_rx_path(p_dm_odm, PHYDM_A, CCA_PATHDIV_DISABLE);
  419. #endif
  420. /* 0x824[9] = 0x82C[9] = 0xA80[7] those registers setting should be equal or CCK RSSI report may be incorrect */
  421. value_824 = odm_get_bb_reg(p_dm_odm, 0x824, BIT(9));
  422. value_82c = odm_get_bb_reg(p_dm_odm, 0x82c, BIT(9));
  423. if (value_824 != value_82c)
  424. odm_set_bb_reg(p_dm_odm, 0x82c, BIT(9), value_824);
  425. odm_set_bb_reg(p_dm_odm, 0xa80, BIT(7), value_824);
  426. p_dm_odm->cck_agc_report_type = (boolean)value_824;
  427. ODM_RT_TRACE(p_dm_odm, ODM_COMP_INIT, ODM_DBG_LOUD, ("cck_agc_report_type = (( %d )), ext_lna_gain = (( %d ))\n", p_dm_odm->cck_agc_report_type, p_dm_odm->ext_lna_gain));
  428. }
  429. #endif
  430. /* JJ ADD 20161014 */
  431. #if ((RTL8703B_SUPPORT == 1) || (RTL8723D_SUPPORT == 1) || (RTL8710B_SUPPORT == 1))
  432. if (p_dm_odm->support_ic_type & (ODM_RTL8703B | ODM_RTL8723D | ODM_RTL8710B)) {
  433. p_dm_odm->cck_agc_report_type = odm_get_bb_reg(p_dm_odm, 0x950, BIT(11)) ? 1 : 0; /*1: 4bit LNA, 0: 3bit LNA */
  434. if (p_dm_odm->cck_agc_report_type != 1) {
  435. dbg_print("[Warning] 8703B/8723D/8710B CCK should be 4bit LNA, ie. 0x950[11] = 1\n");
  436. /**/
  437. }
  438. }
  439. #endif
  440. /* JJ ADD 20161014 */
  441. #if ((RTL8723D_SUPPORT == 1) || (RTL8822B_SUPPORT == 1) || (RTL8197F_SUPPORT == 1) || (RTL8821C_SUPPORT == 1) || (RTL8710B_SUPPORT == 1))
  442. if (p_dm_odm->support_ic_type & (ODM_RTL8723D | ODM_RTL8822B | ODM_RTL8197F | ODM_RTL8821C | ODM_RTL8710B))
  443. p_dm_odm->cck_new_agc = odm_get_bb_reg(p_dm_odm, 0xa9c, BIT(17)) ? true : false; /*1: new agc 0: old agc*/
  444. else
  445. #endif
  446. p_dm_odm->cck_new_agc = false;
  447. }
  448. void
  449. phydm_dynamicsoftmletting(
  450. struct PHY_DM_STRUCT *p_dm_odm
  451. )
  452. {
  453. u32 ret_val;
  454. #if (RTL8822B_SUPPORT == 1)
  455. if (p_dm_odm->mp_mode == FALSE) {
  456. if (p_dm_odm->support_ic_type & ODM_RTL8822B) {
  457. if ((!p_dm_odm->is_linked)|(p_dm_odm->bLinkedcmw500))
  458. return;
  459. if (TRUE == p_dm_odm->bsomlenabled) {
  460. ODM_RT_TRACE(p_dm_odm,ODM_COMP_API,ODM_DBG_TRACE,("PHYDM_DynamicSoftMLSetting(): SoML has been enable, skip dynamic SoML switch\n"));
  461. return;
  462. }
  463. ret_val = odm_get_bb_reg(p_dm_odm, 0xf8c, bMaskByte0);
  464. ODM_RT_TRACE(p_dm_odm,ODM_COMP_API,ODM_DBG_TRACE,("PHYDM_DynamicSoftMLSetting(): Read 0xF8C = 0x%08X\n",ret_val));
  465. if (ret_val < 0x16) {
  466. ODM_RT_TRACE(p_dm_odm,ODM_COMP_API,ODM_DBG_LOUD,("PHYDM_DynamicSoftMLSetting(): 0xF8C(== 0x%08X) < 0x16, enable SoML\n",ret_val));
  467. odm_set_bb_reg(p_dm_odm, 0x19a8, bMaskDWord, 0xc10a0000);
  468. p_dm_odm->bsomlenabled = TRUE;
  469. }
  470. }
  471. }
  472. #endif
  473. }
  474. void
  475. phydm_init_soft_ml_setting(
  476. struct PHY_DM_STRUCT *p_dm_odm
  477. )
  478. {
  479. #if (RTL8822B_SUPPORT == 1)
  480. if (p_dm_odm->mp_mode == false) {
  481. if (p_dm_odm->support_ic_type & ODM_RTL8822B)
  482. odm_set_bb_reg(p_dm_odm, 0x19a8, MASKDWORD, 0xc10a0000);
  483. }
  484. #endif
  485. #if (RTL8821C_SUPPORT == 1)
  486. if (p_dm_odm->mp_mode == false) {
  487. if (p_dm_odm->support_ic_type & ODM_RTL8821C)
  488. odm_set_bb_reg(p_dm_odm, 0x19a8, BIT(31)|BIT(30)|BIT(29)|BIT(28), 0xd);
  489. }
  490. #endif
  491. }
  492. void
  493. phydm_init_hw_info_by_rfe(
  494. struct PHY_DM_STRUCT *p_dm_odm
  495. )
  496. {
  497. #if (RTL8822B_SUPPORT == 1)
  498. if (p_dm_odm->support_ic_type & ODM_RTL8822B)
  499. phydm_init_hw_info_by_rfe_type_8822b(p_dm_odm);
  500. #endif
  501. #if (RTL8821C_SUPPORT == 1)
  502. if (p_dm_odm->support_ic_type & ODM_RTL8821C)
  503. phydm_init_hw_info_by_rfe_type_8821c(p_dm_odm);
  504. #endif
  505. #if (RTL8197F_SUPPORT == 1)
  506. if (p_dm_odm->support_ic_type & ODM_RTL8197F)
  507. phydm_init_hw_info_by_rfe_type_8197f(p_dm_odm);
  508. #endif
  509. }
  510. void
  511. odm_common_info_self_init(
  512. struct PHY_DM_STRUCT *p_dm_odm
  513. )
  514. {
  515. phydm_init_cck_setting(p_dm_odm);
  516. p_dm_odm->rf_path_rx_enable = (u8) odm_get_bb_reg(p_dm_odm, ODM_REG(BB_RX_PATH, p_dm_odm), ODM_BIT(BB_RX_PATH, p_dm_odm));
  517. #if (DM_ODM_SUPPORT_TYPE != ODM_CE)
  518. p_dm_odm->p_is_net_closed = &p_dm_odm->BOOLEAN_temp;
  519. phydm_init_debug_setting(p_dm_odm);
  520. #endif
  521. odm_init_mp_driver_status(p_dm_odm);
  522. phydm_init_trx_antenna_setting(p_dm_odm);
  523. phydm_init_soft_ml_setting(p_dm_odm);
  524. p_dm_odm->phydm_period = PHYDM_WATCH_DOG_PERIOD;
  525. p_dm_odm->phydm_sys_up_time = 0;
  526. if (p_dm_odm->support_ic_type & ODM_IC_1SS)
  527. p_dm_odm->num_rf_path = 1;
  528. else if (p_dm_odm->support_ic_type & ODM_IC_2SS)
  529. p_dm_odm->num_rf_path = 2;
  530. else if (p_dm_odm->support_ic_type & ODM_IC_3SS)
  531. p_dm_odm->num_rf_path = 3;
  532. else if (p_dm_odm->support_ic_type & ODM_IC_4SS)
  533. p_dm_odm->num_rf_path = 4;
  534. p_dm_odm->tx_rate = 0xFF;
  535. p_dm_odm->number_linked_client = 0;
  536. p_dm_odm->pre_number_linked_client = 0;
  537. p_dm_odm->number_active_client = 0;
  538. p_dm_odm->pre_number_active_client = 0;
  539. p_dm_odm->last_tx_ok_cnt = 0;
  540. p_dm_odm->last_rx_ok_cnt = 0;
  541. p_dm_odm->tx_tp = 0;
  542. p_dm_odm->rx_tp = 0;
  543. p_dm_odm->total_tp = 0;
  544. p_dm_odm->traffic_load = TRAFFIC_LOW;
  545. p_dm_odm->nbi_set_result = 0;
  546. p_dm_odm->is_init_hw_info_by_rfe = false;
  547. p_dm_odm->pre_dbg_priority = BB_DBGPORT_RELEASE;
  548. }
  549. void
  550. odm_common_info_self_update(
  551. struct PHY_DM_STRUCT *p_dm_odm
  552. )
  553. {
  554. u8 entry_cnt = 0, num_active_client = 0;
  555. u32 i, one_entry_macid = 0, ma_rx_tp = 0;
  556. struct sta_info *p_entry;
  557. #if (DM_ODM_SUPPORT_TYPE == ODM_WIN)
  558. struct _ADAPTER *adapter = p_dm_odm->adapter;
  559. PMGNT_INFO p_mgnt_info = &adapter->MgntInfo;
  560. p_entry = p_dm_odm->p_odm_sta_info[0];
  561. if (p_mgnt_info->mAssoc) {
  562. p_entry->bUsed = true;
  563. for (i = 0; i < 6; i++)
  564. p_entry->MacAddr[i] = p_mgnt_info->Bssid[i];
  565. } else if (GetFirstClientPort(adapter)) {
  566. struct _ADAPTER *p_client_adapter = GetFirstClientPort(adapter);
  567. p_entry->bUsed = true;
  568. for (i = 0; i < 6; i++)
  569. p_entry->MacAddr[i] = p_client_adapter->MgntInfo.Bssid[i];
  570. } else {
  571. p_entry->bUsed = false;
  572. for (i = 0; i < 6; i++)
  573. p_entry->MacAddr[i] = 0;
  574. }
  575. /* STA mode is linked to AP */
  576. if (IS_STA_VALID(p_dm_odm->p_odm_sta_info[0]) && !ACTING_AS_AP(adapter))
  577. p_dm_odm->bsta_state = true;
  578. else
  579. p_dm_odm->bsta_state = false;
  580. #endif
  581. /* THis variable cannot be used because it is wrong*/
  582. #if (DM_ODM_SUPPORT_TYPE == ODM_AP)
  583. if (*(p_dm_odm->p_band_width) == ODM_BW40M) {
  584. if (*(p_dm_odm->p_sec_ch_offset) == 1)
  585. p_dm_odm->control_channel = *(p_dm_odm->p_channel) + 2;
  586. else if (*(p_dm_odm->p_sec_ch_offset) == 2)
  587. p_dm_odm->control_channel = *(p_dm_odm->p_channel) - 2;
  588. } else if (*(p_dm_odm->p_band_width) == ODM_BW80M) {
  589. if (*(p_dm_odm->p_sec_ch_offset) == 1)
  590. p_dm_odm->control_channel = *(p_dm_odm->p_channel) + 6;
  591. else if (*(p_dm_odm->p_sec_ch_offset) == 2)
  592. p_dm_odm->control_channel = *(p_dm_odm->p_channel) - 6;
  593. } else
  594. p_dm_odm->control_channel = *(p_dm_odm->p_channel);
  595. #else
  596. if (*(p_dm_odm->p_band_width) == ODM_BW40M) {
  597. if (*(p_dm_odm->p_sec_ch_offset) == 1)
  598. p_dm_odm->control_channel = *(p_dm_odm->p_channel) - 2;
  599. else if (*(p_dm_odm->p_sec_ch_offset) == 2)
  600. p_dm_odm->control_channel = *(p_dm_odm->p_channel) + 2;
  601. } else
  602. p_dm_odm->control_channel = *(p_dm_odm->p_channel);
  603. #endif
  604. for (i = 0; i < ODM_ASSOCIATE_ENTRY_NUM; i++) {
  605. p_entry = p_dm_odm->p_odm_sta_info[i];
  606. if (IS_STA_VALID(p_entry)) {
  607. entry_cnt++;
  608. if (entry_cnt == 1)
  609. one_entry_macid = i;
  610. #if (DM_ODM_SUPPORT_TYPE == ODM_AP)
  611. ma_rx_tp = (p_entry->rx_byte_cnt_low_maw) << 3; /* low moving average RX TP ( bit /sec)*/
  612. ODM_RT_TRACE(p_dm_odm, PHYDM_COMP_RA_DBG, ODM_DBG_LOUD, ("ClientTP[%d]: ((%d )) bit/sec\n", i, ma_rx_tp));
  613. if (ma_rx_tp > ACTIVE_TP_THRESHOLD)
  614. num_active_client++;
  615. #endif
  616. }
  617. }
  618. if (entry_cnt == 1) {
  619. p_dm_odm->is_one_entry_only = true;
  620. p_dm_odm->one_entry_macid = one_entry_macid;
  621. } else
  622. p_dm_odm->is_one_entry_only = false;
  623. p_dm_odm->pre_number_linked_client = p_dm_odm->number_linked_client;
  624. p_dm_odm->pre_number_active_client = p_dm_odm->number_active_client;
  625. p_dm_odm->number_linked_client = entry_cnt;
  626. p_dm_odm->number_active_client = num_active_client;
  627. /* Update MP driver status*/
  628. odm_update_mp_driver_status(p_dm_odm);
  629. /*Traffic load information update*/
  630. phydm_traffic_load_decision(p_dm_odm);
  631. p_dm_odm->phydm_sys_up_time += p_dm_odm->phydm_period;
  632. }
  633. void
  634. odm_common_info_self_reset(
  635. struct PHY_DM_STRUCT *p_dm_odm
  636. )
  637. {
  638. #if (DM_ODM_SUPPORT_TYPE & (ODM_WIN | ODM_CE))
  639. p_dm_odm->phy_dbg_info.num_qry_beacon_pkt = 0;
  640. #endif
  641. }
  642. void *
  643. phydm_get_structure(
  644. struct PHY_DM_STRUCT *p_dm_odm,
  645. u8 structure_type
  646. )
  647. {
  648. void *p_struct = NULL;
  649. #if RTL8195A_SUPPORT
  650. switch (structure_type) {
  651. case PHYDM_FALSEALMCNT:
  652. p_struct = &false_alm_cnt;
  653. break;
  654. case PHYDM_CFOTRACK:
  655. p_struct = &dm_cfo_track;
  656. break;
  657. case PHYDM_ADAPTIVITY:
  658. p_struct = &(p_dm_odm->adaptivity);
  659. break;
  660. default:
  661. break;
  662. }
  663. #else
  664. switch (structure_type) {
  665. case PHYDM_FALSEALMCNT:
  666. p_struct = &(p_dm_odm->false_alm_cnt);
  667. break;
  668. case PHYDM_CFOTRACK:
  669. p_struct = &(p_dm_odm->dm_cfo_track);
  670. break;
  671. case PHYDM_ADAPTIVITY:
  672. p_struct = &(p_dm_odm->adaptivity);
  673. break;
  674. case PHYDM_DFS:
  675. p_struct = &(p_dm_odm->dfs);
  676. break;
  677. default:
  678. break;
  679. }
  680. #endif
  681. return p_struct;
  682. }
  683. void
  684. odm_hw_setting(
  685. struct PHY_DM_STRUCT *p_dm_odm
  686. )
  687. {
  688. #if (RTL8821A_SUPPORT == 1)
  689. if (p_dm_odm->support_ic_type & ODM_RTL8821)
  690. odm_hw_setting_8821a(p_dm_odm);
  691. #endif
  692. #if (RTL8814A_SUPPORT == 1)
  693. if (p_dm_odm->support_ic_type & ODM_RTL8814A)
  694. phydm_hwsetting_8814a(p_dm_odm);
  695. #endif
  696. #if (RTL8822B_SUPPORT == 1)
  697. if (p_dm_odm->support_ic_type & ODM_RTL8822B)
  698. phydm_hwsetting_8822b(p_dm_odm);
  699. #endif
  700. #if (RTL8197F_SUPPORT == 1)
  701. if (p_dm_odm->support_ic_type & ODM_RTL8197F)
  702. phydm_hwsetting_8197f(p_dm_odm);
  703. #endif
  704. }
  705. #if SUPPORTABLITY_PHYDMLIZE
  706. void
  707. phydm_supportability_init(
  708. void *p_dm_void
  709. )
  710. {
  711. struct PHY_DM_STRUCT *p_dm_odm = (struct PHY_DM_STRUCT *)p_dm_void;
  712. u32 support_ability = 0;
  713. #if (DM_ODM_SUPPORT_TYPE & (ODM_WIN))
  714. struct _ADAPTER *adapter = p_dm_odm->adapter;
  715. PMGNT_INFO p_mgnt_info = &adapter->MgntInfo;
  716. #endif
  717. #if (DM_ODM_SUPPORT_TYPE & (ODM_CE | ODM_AP))
  718. if (p_dm_odm->support_ic_type != ODM_RTL8821C)
  719. return;
  720. #endif
  721. switch (p_dm_odm->support_ic_type) {
  722. /*---------------N Series--------------------*/
  723. case ODM_RTL8188E:
  724. support_ability |=
  725. ODM_BB_DIG |
  726. ODM_BB_RA_MASK |
  727. ODM_BB_DYNAMIC_TXPWR |
  728. ODM_BB_FA_CNT |
  729. ODM_BB_RSSI_MONITOR |
  730. ODM_BB_CCK_PD |
  731. ODM_RF_TX_PWR_TRACK |
  732. ODM_RF_RX_GAIN_TRACK |
  733. ODM_RF_CALIBRATION |
  734. ODM_BB_CFO_TRACKING |
  735. ODM_BB_NHM_CNT |
  736. ODM_BB_PRIMARY_CCA;
  737. break;
  738. case ODM_RTL8192E:
  739. support_ability |=
  740. ODM_BB_DIG |
  741. ODM_RF_TX_PWR_TRACK |
  742. ODM_BB_RA_MASK |
  743. ODM_BB_FA_CNT |
  744. ODM_BB_RSSI_MONITOR |
  745. ODM_BB_CFO_TRACKING |
  746. /* ODM_BB_PWR_TRAIN |*/
  747. ODM_BB_NHM_CNT |
  748. ODM_BB_PRIMARY_CCA;
  749. break;
  750. case ODM_RTL8723B:
  751. support_ability |=
  752. ODM_BB_DIG |
  753. ODM_BB_RA_MASK |
  754. ODM_BB_FA_CNT |
  755. ODM_BB_RSSI_MONITOR |
  756. ODM_BB_CCK_PD |
  757. ODM_RF_TX_PWR_TRACK |
  758. ODM_RF_RX_GAIN_TRACK |
  759. ODM_RF_CALIBRATION |
  760. ODM_BB_CFO_TRACKING |
  761. /* ODM_BB_PWR_TRAIN |*/
  762. ODM_BB_NHM_CNT;
  763. break;
  764. case ODM_RTL8703B:
  765. support_ability |=
  766. ODM_BB_DIG |
  767. ODM_BB_RA_MASK |
  768. ODM_BB_FA_CNT |
  769. ODM_BB_RSSI_MONITOR |
  770. ODM_BB_CCK_PD |
  771. ODM_BB_CFO_TRACKING |
  772. /* ODM_BB_PWR_TRAIN | */
  773. ODM_BB_NHM_CNT |
  774. ODM_RF_TX_PWR_TRACK |
  775. /* ODM_RF_RX_GAIN_TRACK | */
  776. ODM_RF_CALIBRATION;
  777. break;
  778. case ODM_RTL8723D:
  779. support_ability |=
  780. ODM_BB_DIG |
  781. ODM_BB_RA_MASK |
  782. ODM_BB_FA_CNT |
  783. ODM_BB_RSSI_MONITOR |
  784. ODM_BB_CCK_PD |
  785. ODM_BB_CFO_TRACKING |
  786. /* ODM_BB_PWR_TRAIN | */
  787. ODM_BB_NHM_CNT |
  788. ODM_RF_TX_PWR_TRACK;
  789. /* ODM_RF_RX_GAIN_TRACK | */
  790. /* ODM_RF_CALIBRATION | */
  791. break;
  792. /* JJ ADD 20161014 */
  793. case ODM_RTL8710B:
  794. support_ability |=
  795. ODM_BB_DIG |
  796. ODM_BB_RA_MASK |
  797. ODM_BB_FA_CNT |
  798. ODM_BB_RSSI_MONITOR |
  799. ODM_BB_CCK_PD |
  800. ODM_BB_CFO_TRACKING |
  801. /* ODM_BB_PWR_TRAIN | */
  802. ODM_BB_NHM_CNT |
  803. ODM_RF_TX_PWR_TRACK;
  804. /* ODM_RF_RX_GAIN_TRACK | */
  805. /* ODM_RF_CALIBRATION | */
  806. break;
  807. case ODM_RTL8188F:
  808. support_ability |=
  809. ODM_BB_DIG |
  810. ODM_BB_RA_MASK |
  811. ODM_BB_FA_CNT |
  812. ODM_BB_RSSI_MONITOR |
  813. ODM_BB_CCK_PD |
  814. ODM_BB_CFO_TRACKING |
  815. ODM_BB_NHM_CNT |
  816. ODM_RF_TX_PWR_TRACK |
  817. ODM_RF_CALIBRATION;
  818. break;
  819. #if (DM_ODM_SUPPORT_TYPE & (ODM_AP))
  820. case ODM_RTL8198F:
  821. case ODM_RTL8197F:
  822. support_ability |=
  823. ODM_BB_DIG |
  824. ODM_BB_RA_MASK |
  825. ODM_BB_FA_CNT |
  826. ODM_BB_RSSI_MONITOR |
  827. ODM_BB_CCK_PD |
  828. ODM_BB_CFO_TRACKING |
  829. ODM_BB_NHM_CNT |
  830. ODM_RF_TX_PWR_TRACK |
  831. ODM_RF_CALIBRATION;
  832. break;
  833. #endif
  834. #if (DM_ODM_SUPPORT_TYPE & (ODM_IOT))
  835. case ODM_RTL8195A:
  836. support_ability |=
  837. ODM_BB_DIG |
  838. ODM_BB_RA_MASK |
  839. ODM_BB_FA_CNT |
  840. ODM_BB_RSSI_MONITOR |
  841. ODM_BB_CCK_PD |
  842. ODM_BB_CFO_TRACKING |
  843. ODM_BB_NHM_CNT |
  844. ODM_RF_TX_PWR_TRACK |
  845. ODM_RF_CALIBRATION;
  846. break;
  847. #endif
  848. /*---------------AC Series-------------------*/
  849. case ODM_RTL8812:
  850. case ODM_RTL8821:
  851. case ODM_RTL8881A:
  852. support_ability |=
  853. ODM_BB_DIG |
  854. ODM_BB_FA_CNT |
  855. ODM_BB_RSSI_MONITOR |
  856. ODM_BB_RA_MASK |
  857. ODM_RF_TX_PWR_TRACK |
  858. ODM_BB_CFO_TRACKING |
  859. /* ODM_BB_PWR_TRAIN |*/
  860. ODM_BB_DYNAMIC_TXPWR |
  861. ODM_BB_NHM_CNT;
  862. break;
  863. case ODM_RTL8814B:
  864. case ODM_RTL8814A:
  865. support_ability |=
  866. ODM_BB_DIG |
  867. ODM_BB_FA_CNT |
  868. ODM_BB_RSSI_MONITOR |
  869. ODM_BB_RA_MASK |
  870. ODM_RF_TX_PWR_TRACK |
  871. ODM_BB_CCK_PD |
  872. ODM_BB_CFO_TRACKING |
  873. ODM_BB_DYNAMIC_TXPWR |
  874. ODM_BB_NHM_CNT;
  875. break;
  876. case ODM_RTL8822B:
  877. support_ability |=
  878. ODM_BB_DIG |
  879. ODM_BB_FA_CNT |
  880. ODM_BB_CCK_PD |
  881. ODM_BB_CFO_TRACKING |
  882. ODM_BB_RATE_ADAPTIVE |
  883. ODM_BB_RSSI_MONITOR |
  884. ODM_BB_RA_MASK |
  885. ODM_RF_TX_PWR_TRACK;
  886. break;
  887. case ODM_RTL8821C:
  888. support_ability |=
  889. ODM_BB_DIG |
  890. ODM_BB_RA_MASK |
  891. ODM_BB_CCK_PD |
  892. ODM_BB_FA_CNT |
  893. ODM_BB_RSSI_MONITOR |
  894. ODM_BB_RATE_ADAPTIVE |
  895. ODM_RF_TX_PWR_TRACK |
  896. ODM_BB_CFO_TRACKING; /* |
  897. * ODM_BB_DYNAMIC_TXPWR |
  898. * ODM_BB_NHM_CNT;*/
  899. break;
  900. default:
  901. support_ability |=
  902. ODM_BB_DIG |
  903. ODM_BB_FA_CNT |
  904. ODM_BB_CCK_PD |
  905. ODM_BB_CFO_TRACKING |
  906. ODM_BB_RATE_ADAPTIVE |
  907. ODM_BB_RSSI_MONITOR |
  908. ODM_BB_RA_MASK |
  909. ODM_RF_TX_PWR_TRACK;
  910. dbg_print("[Warning] Supportability Init Warning !!!\n");
  911. break;
  912. }
  913. if (*(p_dm_odm->p_enable_antdiv))
  914. support_ability |= ODM_BB_ANT_DIV;
  915. if (*(p_dm_odm->p_enable_adaptivity)) {
  916. ODM_RT_TRACE(p_dm_odm, ODM_COMP_INIT, ODM_DBG_LOUD, ("ODM adaptivity is set to Enabled!!!\n"));
  917. support_ability |= ODM_BB_ADAPTIVITY;
  918. #if (DM_ODM_SUPPORT_TYPE & (ODM_WIN))
  919. phydm_adaptivity_info_init(p_dm_odm, PHYDM_ADAPINFO_CARRIER_SENSE_ENABLE, p_mgnt_info->RegEnableCarrierSense);
  920. phydm_adaptivity_info_init(p_dm_odm, PHYDM_ADAPINFO_DCBACKOFF, p_mgnt_info->RegDCbackoff);
  921. phydm_adaptivity_info_init(p_dm_odm, PHYDM_ADAPINFO_DYNAMICLINKADAPTIVITY, p_mgnt_info->RegDmLinkAdaptivity);
  922. phydm_adaptivity_info_init(p_dm_odm, PHYDM_ADAPINFO_AP_NUM_TH, p_mgnt_info->RegAPNumTH);
  923. phydm_adaptivity_info_init(p_dm_odm, PHYDM_ADAPINFO_TH_L2H_INI, p_mgnt_info->RegL2HForAdaptivity);
  924. phydm_adaptivity_info_init(p_dm_odm, PHYDM_ADAPINFO_TH_EDCCA_HL_DIFF, p_mgnt_info->RegHLDiffForAdaptivity);
  925. #endif
  926. } else {
  927. ODM_RT_TRACE(p_dm_odm, ODM_COMP_INIT, ODM_DBG_LOUD, ("ODM adaptivity is set to disnabled!!!\n"));
  928. /**/
  929. }
  930. ODM_RT_TRACE(p_dm_odm, ODM_COMP_INIT, ODM_DBG_LOUD, ("PHYDM support_ability = ((0x%x))\n", support_ability));
  931. odm_cmn_info_init(p_dm_odm, ODM_CMNINFO_ABILITY, support_ability);
  932. }
  933. #endif
  934. /*
  935. * 2011/09/21 MH Add to describe different team necessary resource allocate??
  936. * */
  937. void
  938. odm_dm_init(
  939. struct PHY_DM_STRUCT *p_dm_odm
  940. )
  941. {
  942. #if (DM_ODM_SUPPORT_TYPE == ODM_WIN)
  943. struct _ADAPTER *adapter = p_dm_odm->adapter;
  944. HAL_DATA_TYPE *p_hal_data = GET_HAL_DATA(adapter);
  945. #endif
  946. #if SUPPORTABLITY_PHYDMLIZE
  947. phydm_supportability_init(p_dm_odm);
  948. #endif
  949. odm_common_info_self_init(p_dm_odm);
  950. odm_dig_init(p_dm_odm);
  951. phydm_nhm_counter_statistics_init(p_dm_odm);
  952. phydm_adaptivity_init(p_dm_odm);
  953. phydm_ra_info_init(p_dm_odm);
  954. odm_rate_adaptive_mask_init(p_dm_odm);
  955. odm_cfo_tracking_init(p_dm_odm);
  956. #if PHYDM_SUPPORT_EDCA
  957. odm_edca_turbo_init(p_dm_odm);
  958. #endif
  959. odm_rssi_monitor_init(p_dm_odm);
  960. phydm_rf_init(p_dm_odm);
  961. odm_txpowertracking_init(p_dm_odm);
  962. #if (RTL8822B_SUPPORT == 1)
  963. if (p_dm_odm->support_ic_type & ODM_RTL8822B)
  964. phydm_txcurrentcalibration(p_dm_odm);
  965. #endif
  966. odm_antenna_diversity_init(p_dm_odm);
  967. #if (CONFIG_DYNAMIC_RX_PATH == 1)
  968. phydm_dynamic_rx_path_init(p_dm_odm);
  969. #endif
  970. odm_auto_channel_select_init(p_dm_odm);
  971. odm_path_diversity_init(p_dm_odm);
  972. odm_dynamic_tx_power_init(p_dm_odm);
  973. phydm_init_ra_info(p_dm_odm);
  974. #if (PHYDM_LA_MODE_SUPPORT == 1)
  975. adc_smp_init(p_dm_odm);
  976. #endif
  977. #if (DM_ODM_SUPPORT_TYPE & (ODM_WIN | ODM_CE))
  978. #ifdef BEAMFORMING_VERSION_1
  979. if (p_hal_data->beamforming_version == BEAMFORMING_VERSION_1)
  980. #endif
  981. {
  982. phydm_beamforming_init(p_dm_odm);
  983. }
  984. #endif
  985. if (p_dm_odm->support_ic_type & ODM_IC_11N_SERIES) {
  986. #if (defined(CONFIG_BB_POWER_SAVING))
  987. odm_dynamic_bb_power_saving_init(p_dm_odm);
  988. #endif
  989. #if (RTL8188E_SUPPORT == 1)
  990. if (p_dm_odm->support_ic_type == ODM_RTL8188E) {
  991. odm_primary_cca_init(p_dm_odm);
  992. odm_ra_info_init_all(p_dm_odm);
  993. }
  994. #endif
  995. #if (DM_ODM_SUPPORT_TYPE & (ODM_WIN | ODM_CE))
  996. #if (RTL8723B_SUPPORT == 1)
  997. if (p_dm_odm->support_ic_type == ODM_RTL8723B)
  998. odm_sw_ant_detect_init(p_dm_odm);
  999. #endif
  1000. #if (RTL8192E_SUPPORT == 1)
  1001. if (p_dm_odm->support_ic_type == ODM_RTL8192E)
  1002. odm_primary_cca_check_init(p_dm_odm);
  1003. #endif
  1004. #endif
  1005. }
  1006. #if (CONFIG_PSD_TOOL == 1)
  1007. phydm_psd_init(p_dm_odm);
  1008. #endif
  1009. }
  1010. void
  1011. odm_dm_reset(
  1012. struct PHY_DM_STRUCT *p_dm_odm
  1013. )
  1014. {
  1015. struct _dynamic_initial_gain_threshold_ *p_dm_dig_table = &p_dm_odm->dm_dig_table;
  1016. odm_ant_div_reset(p_dm_odm);
  1017. phydm_set_edcca_threshold_api(p_dm_odm, p_dm_dig_table->cur_ig_value);
  1018. }
  1019. void
  1020. phydm_support_ability_debug(
  1021. void *p_dm_void,
  1022. u32 *const dm_value,
  1023. u32 *_used,
  1024. char *output,
  1025. u32 *_out_len
  1026. )
  1027. {
  1028. struct PHY_DM_STRUCT *p_dm_odm = (struct PHY_DM_STRUCT *)p_dm_void;
  1029. u32 pre_support_ability;
  1030. u32 used = *_used;
  1031. u32 out_len = *_out_len;
  1032. pre_support_ability = p_dm_odm->support_ability ;
  1033. PHYDM_SNPRINTF((output + used, out_len - used, "\n%s\n", "================================"));
  1034. if (dm_value[0] == 100) {
  1035. PHYDM_SNPRINTF((output + used, out_len - used, "[Supportability] PhyDM Selection\n"));
  1036. PHYDM_SNPRINTF((output + used, out_len - used, "%s\n", "================================"));
  1037. PHYDM_SNPRINTF((output + used, out_len - used, "00. (( %s ))DIG\n", ((p_dm_odm->support_ability & ODM_BB_DIG) ? ("V") : ("."))));
  1038. PHYDM_SNPRINTF((output + used, out_len - used, "01. (( %s ))RA_MASK\n", ((p_dm_odm->support_ability & ODM_BB_RA_MASK) ? ("V") : ("."))));
  1039. PHYDM_SNPRINTF((output + used, out_len - used, "02. (( %s ))DYNAMIC_TXPWR\n", ((p_dm_odm->support_ability & ODM_BB_DYNAMIC_TXPWR) ? ("V") : ("."))));
  1040. PHYDM_SNPRINTF((output + used, out_len - used, "03. (( %s ))FA_CNT\n", ((p_dm_odm->support_ability & ODM_BB_FA_CNT) ? ("V") : ("."))));
  1041. PHYDM_SNPRINTF((output + used, out_len - used, "04. (( %s ))RSSI_MONITOR\n", ((p_dm_odm->support_ability & ODM_BB_RSSI_MONITOR) ? ("V") : ("."))));
  1042. PHYDM_SNPRINTF((output + used, out_len - used, "05. (( %s ))CCK_PD\n", ((p_dm_odm->support_ability & ODM_BB_CCK_PD) ? ("V") : ("."))));
  1043. PHYDM_SNPRINTF((output + used, out_len - used, "06. (( %s ))ANT_DIV\n", ((p_dm_odm->support_ability & ODM_BB_ANT_DIV) ? ("V") : ("."))));
  1044. PHYDM_SNPRINTF((output + used, out_len - used, "08. (( %s ))PWR_TRAIN\n", ((p_dm_odm->support_ability & ODM_BB_PWR_TRAIN) ? ("V") : ("."))));
  1045. PHYDM_SNPRINTF((output + used, out_len - used, "09. (( %s ))RATE_ADAPTIVE\n", ((p_dm_odm->support_ability & ODM_BB_RATE_ADAPTIVE) ? ("V") : ("."))));
  1046. PHYDM_SNPRINTF((output + used, out_len - used, "10. (( %s ))PATH_DIV\n", ((p_dm_odm->support_ability & ODM_BB_PATH_DIV) ? ("V") : ("."))));
  1047. PHYDM_SNPRINTF((output + used, out_len - used, "13. (( %s ))ADAPTIVITY\n", ((p_dm_odm->support_ability & ODM_BB_ADAPTIVITY) ? ("V") : ("."))));
  1048. PHYDM_SNPRINTF((output + used, out_len - used, "14. (( %s ))struct _CFO_TRACKING_\n", ((p_dm_odm->support_ability & ODM_BB_CFO_TRACKING) ? ("V") : ("."))));
  1049. PHYDM_SNPRINTF((output + used, out_len - used, "15. (( %s ))NHM_CNT\n", ((p_dm_odm->support_ability & ODM_BB_NHM_CNT) ? ("V") : ("."))));
  1050. PHYDM_SNPRINTF((output + used, out_len - used, "16. (( %s ))PRIMARY_CCA\n", ((p_dm_odm->support_ability & ODM_BB_PRIMARY_CCA) ? ("V") : ("."))));
  1051. PHYDM_SNPRINTF((output + used, out_len - used, "17. (( %s ))TXBF\n", ((p_dm_odm->support_ability & ODM_BB_TXBF) ? ("V") : ("."))));
  1052. PHYDM_SNPRINTF((output + used, out_len - used, "18. (( %s ))DYNAMIC_ARFR\n", ((p_dm_odm->support_ability & ODM_BB_DYNAMIC_ARFR) ? ("V") : ("."))));
  1053. PHYDM_SNPRINTF((output + used, out_len - used, "20. (( %s ))EDCA_TURBO\n", ((p_dm_odm->support_ability & ODM_MAC_EDCA_TURBO) ? ("V") : ("."))));
  1054. PHYDM_SNPRINTF((output + used, out_len - used, "21. (( %s ))DYNAMIC_RX_PATH\n", ((p_dm_odm->support_ability & ODM_BB_DYNAMIC_RX_PATH) ? ("V") : ("."))));
  1055. PHYDM_SNPRINTF((output + used, out_len - used, "24. (( %s ))TX_PWR_TRACK\n", ((p_dm_odm->support_ability & ODM_RF_TX_PWR_TRACK) ? ("V") : ("."))));
  1056. PHYDM_SNPRINTF((output + used, out_len - used, "25. (( %s ))RX_GAIN_TRACK\n", ((p_dm_odm->support_ability & ODM_RF_RX_GAIN_TRACK) ? ("V") : ("."))));
  1057. PHYDM_SNPRINTF((output + used, out_len - used, "26. (( %s ))RF_CALIBRATION\n", ((p_dm_odm->support_ability & ODM_RF_CALIBRATION) ? ("V") : ("."))));
  1058. PHYDM_SNPRINTF((output + used, out_len - used, "%s\n", "================================"));
  1059. }
  1060. /*
  1061. else if(dm_value[0] == 101)
  1062. {
  1063. p_dm_odm->support_ability = 0 ;
  1064. dbg_print("Disable all support_ability components\n");
  1065. PHYDM_SNPRINTF((output+used, out_len-used,"%s\n", "Disable all support_ability components"));
  1066. }
  1067. */
  1068. else {
  1069. if (dm_value[1] == 1) { /* enable */
  1070. p_dm_odm->support_ability |= BIT(dm_value[0]) ;
  1071. if (BIT(dm_value[0]) & ODM_BB_PATH_DIV)
  1072. odm_path_diversity_init(p_dm_odm);
  1073. } else if (dm_value[1] == 2) /* disable */
  1074. p_dm_odm->support_ability &= ~(BIT(dm_value[0])) ;
  1075. else {
  1076. /* dbg_print("\n[Warning!!!] 1:enable, 2:disable \n\n"); */
  1077. PHYDM_SNPRINTF((output + used, out_len - used, "%s\n", "[Warning!!!] 1:enable, 2:disable"));
  1078. }
  1079. }
  1080. PHYDM_SNPRINTF((output + used, out_len - used, "pre-support_ability = 0x%x\n", pre_support_ability));
  1081. PHYDM_SNPRINTF((output + used, out_len - used, "Curr-support_ability = 0x%x\n", p_dm_odm->support_ability));
  1082. PHYDM_SNPRINTF((output + used, out_len - used, "%s\n", "================================"));
  1083. }
  1084. #if (DM_ODM_SUPPORT_TYPE & ODM_WIN)
  1085. /*
  1086. * tmp modify for LC Only
  1087. * */
  1088. void
  1089. odm_dm_watchdog_lps(
  1090. struct PHY_DM_STRUCT *p_dm_odm
  1091. )
  1092. {
  1093. odm_common_info_self_update(p_dm_odm);
  1094. odm_false_alarm_counter_statistics(p_dm_odm);
  1095. odm_rssi_monitor_check(p_dm_odm);
  1096. odm_dig_by_rssi_lps(p_dm_odm);
  1097. odm_cck_packet_detection_thresh(p_dm_odm);
  1098. odm_common_info_self_reset(p_dm_odm);
  1099. if (*(p_dm_odm->p_is_power_saving) == true)
  1100. return;
  1101. }
  1102. #endif
  1103. void
  1104. phydm_watchdog_mp(
  1105. struct PHY_DM_STRUCT *p_dm_odm
  1106. )
  1107. {
  1108. #if (CONFIG_DYNAMIC_RX_PATH == 1)
  1109. phydm_dynamic_rx_path_caller(p_dm_odm);
  1110. #endif
  1111. }
  1112. /*
  1113. * 2011/09/20 MH This is the entry pointer for all team to execute HW out source DM.
  1114. * You can not add any dummy function here, be care, you can only use DM structure
  1115. * to perform any new ODM_DM.
  1116. * */
  1117. void
  1118. odm_dm_watchdog(
  1119. struct PHY_DM_STRUCT *p_dm_odm
  1120. )
  1121. {
  1122. odm_common_info_self_update(p_dm_odm);
  1123. phydm_basic_dbg_message(p_dm_odm);
  1124. phydm_receiver_blocking(p_dm_odm);
  1125. odm_hw_setting(p_dm_odm);
  1126. #if (DM_ODM_SUPPORT_TYPE == ODM_AP)
  1127. {
  1128. struct rtl8192cd_priv *priv = p_dm_odm->priv;
  1129. if ((priv->auto_channel != 0) && (priv->auto_channel != 2)) /* if struct _ACS_ running, do not do FA/CCA counter read */
  1130. return;
  1131. }
  1132. #endif
  1133. odm_false_alarm_counter_statistics(p_dm_odm);
  1134. phydm_noisy_detection(p_dm_odm);
  1135. odm_rssi_monitor_check(p_dm_odm);
  1136. if (*(p_dm_odm->p_is_power_saving) == true) {
  1137. odm_dig_by_rssi_lps(p_dm_odm);
  1138. phydm_adaptivity(p_dm_odm);
  1139. #if (DM_ODM_SUPPORT_TYPE & (ODM_CE))
  1140. odm_antenna_diversity(p_dm_odm); /*enable AntDiv in PS mode, request from SD4 Jeff*/
  1141. #endif
  1142. ODM_RT_TRACE(p_dm_odm, ODM_COMP_COMMON, ODM_DBG_LOUD, ("DMWatchdog in power saving mode\n"));
  1143. return;
  1144. }
  1145. phydm_check_adaptivity(p_dm_odm);
  1146. odm_update_power_training_state(p_dm_odm);
  1147. odm_DIG(p_dm_odm);
  1148. phydm_adaptivity(p_dm_odm);
  1149. odm_cck_packet_detection_thresh(p_dm_odm);
  1150. phydm_ra_info_watchdog(p_dm_odm);
  1151. #if PHYDM_SUPPORT_EDCA
  1152. odm_edca_turbo_check(p_dm_odm);
  1153. #endif
  1154. odm_path_diversity(p_dm_odm);
  1155. odm_cfo_tracking(p_dm_odm);
  1156. odm_dynamic_tx_power(p_dm_odm);
  1157. odm_antenna_diversity(p_dm_odm);
  1158. #if (CONFIG_DYNAMIC_RX_PATH == 1)
  1159. phydm_dynamic_rx_path(p_dm_odm);
  1160. #endif
  1161. #if (DM_ODM_SUPPORT_TYPE & (ODM_WIN | ODM_CE))
  1162. phydm_beamforming_watchdog(p_dm_odm);
  1163. #endif
  1164. phydm_rf_watchdog(p_dm_odm);
  1165. if (p_dm_odm->support_ic_type & ODM_IC_11N_SERIES) {
  1166. #if (RTL8188E_SUPPORT == 1)
  1167. if (p_dm_odm->support_ic_type == ODM_RTL8188E)
  1168. odm_dynamic_primary_cca(p_dm_odm);
  1169. #endif
  1170. #if (DM_ODM_SUPPORT_TYPE & (ODM_WIN | ODM_CE))
  1171. #if (RTL8192E_SUPPORT == 1)
  1172. if (p_dm_odm->support_ic_type == ODM_RTL8192E)
  1173. odm_dynamic_primary_cca_check(p_dm_odm);
  1174. #endif
  1175. #endif
  1176. }
  1177. #if (DM_ODM_SUPPORT_TYPE == ODM_CE)
  1178. odm_dtc(p_dm_odm);
  1179. #endif
  1180. odm_common_info_self_reset(p_dm_odm);
  1181. }
  1182. /*
  1183. * Init /.. Fixed HW value. Only init time.
  1184. * */
  1185. void
  1186. odm_cmn_info_init(
  1187. struct PHY_DM_STRUCT *p_dm_odm,
  1188. enum odm_cmninfo_e cmn_info,
  1189. u32 value
  1190. )
  1191. {
  1192. /* */
  1193. /* This section is used for init value */
  1194. /* */
  1195. switch (cmn_info) {
  1196. /* */
  1197. /* Fixed ODM value. */
  1198. /* */
  1199. case ODM_CMNINFO_ABILITY:
  1200. p_dm_odm->support_ability = (u32)value;
  1201. break;
  1202. case ODM_CMNINFO_RF_TYPE:
  1203. p_dm_odm->rf_type = (u8)value;
  1204. break;
  1205. case ODM_CMNINFO_PLATFORM:
  1206. p_dm_odm->support_platform = (u8)value;
  1207. break;
  1208. case ODM_CMNINFO_INTERFACE:
  1209. p_dm_odm->support_interface = (u8)value;
  1210. break;
  1211. case ODM_CMNINFO_MP_TEST_CHIP:
  1212. p_dm_odm->is_mp_chip = (u8)value;
  1213. break;
  1214. case ODM_CMNINFO_IC_TYPE:
  1215. p_dm_odm->support_ic_type = value;
  1216. break;
  1217. case ODM_CMNINFO_CUT_VER:
  1218. p_dm_odm->cut_version = (u8)value;
  1219. break;
  1220. case ODM_CMNINFO_FAB_VER:
  1221. p_dm_odm->fab_version = (u8)value;
  1222. break;
  1223. case ODM_CMNINFO_RFE_TYPE:
  1224. p_dm_odm->rfe_type = (u8)value;
  1225. phydm_init_hw_info_by_rfe(p_dm_odm);
  1226. break;
  1227. case ODM_CMNINFO_DPK_EN:
  1228. p_dm_odm->dpk_en = (u1Byte)value;
  1229. break;
  1230. case ODM_CMNINFO_RF_ANTENNA_TYPE:
  1231. p_dm_odm->ant_div_type = (u8)value;
  1232. break;
  1233. case ODM_CMNINFO_WITH_EXT_ANTENNA_SWITCH:
  1234. p_dm_odm->with_extenal_ant_switch = (u8)value;
  1235. break;
  1236. case ODM_CMNINFO_BE_FIX_TX_ANT:
  1237. p_dm_odm->dm_fat_table.b_fix_tx_ant = (u8)value;
  1238. break;
  1239. case ODM_CMNINFO_BOARD_TYPE:
  1240. if (!p_dm_odm->is_init_hw_info_by_rfe)
  1241. p_dm_odm->board_type = (u8)value;
  1242. break;
  1243. case ODM_CMNINFO_PACKAGE_TYPE:
  1244. if (!p_dm_odm->is_init_hw_info_by_rfe)
  1245. p_dm_odm->package_type = (u8)value;
  1246. break;
  1247. case ODM_CMNINFO_EXT_LNA:
  1248. if (!p_dm_odm->is_init_hw_info_by_rfe)
  1249. p_dm_odm->ext_lna = (u8)value;
  1250. break;
  1251. case ODM_CMNINFO_5G_EXT_LNA:
  1252. if (!p_dm_odm->is_init_hw_info_by_rfe)
  1253. p_dm_odm->ext_lna_5g = (u8)value;
  1254. break;
  1255. case ODM_CMNINFO_EXT_PA:
  1256. if (!p_dm_odm->is_init_hw_info_by_rfe)
  1257. p_dm_odm->ext_pa = (u8)value;
  1258. break;
  1259. case ODM_CMNINFO_5G_EXT_PA:
  1260. if (!p_dm_odm->is_init_hw_info_by_rfe)
  1261. p_dm_odm->ext_pa_5g = (u8)value;
  1262. break;
  1263. case ODM_CMNINFO_GPA:
  1264. if (!p_dm_odm->is_init_hw_info_by_rfe)
  1265. p_dm_odm->type_gpa = (u16)value;
  1266. break;
  1267. case ODM_CMNINFO_APA:
  1268. if (!p_dm_odm->is_init_hw_info_by_rfe)
  1269. p_dm_odm->type_apa = (u16)value;
  1270. break;
  1271. case ODM_CMNINFO_GLNA:
  1272. if (!p_dm_odm->is_init_hw_info_by_rfe)
  1273. p_dm_odm->type_glna = (u16)value;
  1274. break;
  1275. case ODM_CMNINFO_ALNA:
  1276. if (!p_dm_odm->is_init_hw_info_by_rfe)
  1277. p_dm_odm->type_alna = (u16)value;
  1278. break;
  1279. case ODM_CMNINFO_EXT_TRSW:
  1280. if (!p_dm_odm->is_init_hw_info_by_rfe)
  1281. p_dm_odm->ext_trsw = (u8)value;
  1282. break;
  1283. case ODM_CMNINFO_EXT_LNA_GAIN:
  1284. p_dm_odm->ext_lna_gain = (u8)value;
  1285. break;
  1286. case ODM_CMNINFO_PATCH_ID:
  1287. p_dm_odm->patch_id = (u8)value;
  1288. break;
  1289. case ODM_CMNINFO_BINHCT_TEST:
  1290. p_dm_odm->is_in_hct_test = (boolean)value;
  1291. break;
  1292. case ODM_CMNINFO_BWIFI_TEST:
  1293. p_dm_odm->wifi_test = (u8)value;
  1294. break;
  1295. case ODM_CMNINFO_SMART_CONCURRENT:
  1296. p_dm_odm->is_dual_mac_smart_concurrent = (boolean)value;
  1297. break;
  1298. case ODM_CMNINFO_DOMAIN_CODE_2G:
  1299. p_dm_odm->odm_regulation_2_4g = (u8)value;
  1300. break;
  1301. case ODM_CMNINFO_DOMAIN_CODE_5G:
  1302. p_dm_odm->odm_regulation_5g = (u8)value;
  1303. break;
  1304. case ODM_CMNINFO_CONFIG_BB_RF:
  1305. p_dm_odm->config_bbrf = (boolean)value;
  1306. break;
  1307. case ODM_CMNINFO_IQKFWOFFLOAD:
  1308. p_dm_odm->iqk_fw_offload = (u8)value;
  1309. break;
  1310. case ODM_CMNINFO_IQKPAOFF:
  1311. p_dm_odm->rf_calibrate_info.is_iqk_pa_off = (boolean)value;
  1312. break;
  1313. case ODM_CMNINFO_REGRFKFREEENABLE:
  1314. p_dm_odm->rf_calibrate_info.reg_rf_kfree_enable = (u8)value;
  1315. break;
  1316. case ODM_CMNINFO_RFKFREEENABLE:
  1317. p_dm_odm->rf_calibrate_info.rf_kfree_enable = (u8)value;
  1318. break;
  1319. case ODM_CMNINFO_NORMAL_RX_PATH_CHANGE:
  1320. p_dm_odm->normal_rx_path = (u8)value;
  1321. break;
  1322. case ODM_CMNINFO_EFUSE0X3D8:
  1323. p_dm_odm->efuse0x3d8 = (u8)value;
  1324. break;
  1325. case ODM_CMNINFO_EFUSE0X3D7:
  1326. p_dm_odm->efuse0x3d7 = (u8)value;
  1327. break;
  1328. #ifdef CONFIG_PHYDM_DFS_MASTER
  1329. case ODM_CMNINFO_DFS_REGION_DOMAIN:
  1330. p_dm_odm->dfs_region_domain = (u8)value;
  1331. break;
  1332. #endif
  1333. case ODM_CMNINFO_SOFT_AP_SPECIAL_SETTING:
  1334. p_dm_odm->soft_ap_special_setting = (u32)value;
  1335. break;
  1336. case ODM_CMNINFO_HALMAC_ABILITY:
  1337. p_dm_odm->halmac_ability = (u32)value;
  1338. break;
  1339. /* To remove the compiler warning, must add an empty default statement to handle the other values. */
  1340. default:
  1341. /* do nothing */
  1342. break;
  1343. }
  1344. }
  1345. void
  1346. odm_cmn_info_hook(
  1347. struct PHY_DM_STRUCT *p_dm_odm,
  1348. enum odm_cmninfo_e cmn_info,
  1349. void *p_value
  1350. )
  1351. {
  1352. /* */
  1353. /* Hook call by reference pointer. */
  1354. /* */
  1355. switch (cmn_info) {
  1356. /* */
  1357. /* Dynamic call by reference pointer. */
  1358. /* */
  1359. case ODM_CMNINFO_MAC_PHY_MODE:
  1360. p_dm_odm->p_mac_phy_mode = (u8 *)p_value;
  1361. break;
  1362. case ODM_CMNINFO_TX_UNI:
  1363. p_dm_odm->p_num_tx_bytes_unicast = (u64 *)p_value;
  1364. break;
  1365. case ODM_CMNINFO_RX_UNI:
  1366. p_dm_odm->p_num_rx_bytes_unicast = (u64 *)p_value;
  1367. break;
  1368. case ODM_CMNINFO_WM_MODE:
  1369. p_dm_odm->p_wireless_mode = (u8 *)p_value;
  1370. break;
  1371. case ODM_CMNINFO_BAND:
  1372. p_dm_odm->p_band_type = (u8 *)p_value;
  1373. break;
  1374. case ODM_CMNINFO_SEC_CHNL_OFFSET:
  1375. p_dm_odm->p_sec_ch_offset = (u8 *)p_value;
  1376. break;
  1377. case ODM_CMNINFO_SEC_MODE:
  1378. p_dm_odm->p_security = (u8 *)p_value;
  1379. break;
  1380. case ODM_CMNINFO_BW:
  1381. p_dm_odm->p_band_width = (u8 *)p_value;
  1382. break;
  1383. case ODM_CMNINFO_CHNL:
  1384. p_dm_odm->p_channel = (u8 *)p_value;
  1385. break;
  1386. case ODM_CMNINFO_DMSP_GET_VALUE:
  1387. p_dm_odm->p_is_get_value_from_other_mac = (boolean *)p_value;
  1388. break;
  1389. case ODM_CMNINFO_BUDDY_ADAPTOR:
  1390. p_dm_odm->p_buddy_adapter = (struct _ADAPTER **)p_value;
  1391. break;
  1392. case ODM_CMNINFO_DMSP_IS_MASTER:
  1393. p_dm_odm->p_is_master_of_dmsp = (boolean *)p_value;
  1394. break;
  1395. case ODM_CMNINFO_SCAN:
  1396. p_dm_odm->p_is_scan_in_process = (boolean *)p_value;
  1397. break;
  1398. case ODM_CMNINFO_POWER_SAVING:
  1399. p_dm_odm->p_is_power_saving = (boolean *)p_value;
  1400. break;
  1401. case ODM_CMNINFO_ONE_PATH_CCA:
  1402. p_dm_odm->p_one_path_cca = (u8 *)p_value;
  1403. break;
  1404. case ODM_CMNINFO_DRV_STOP:
  1405. p_dm_odm->p_is_driver_stopped = (boolean *)p_value;
  1406. break;
  1407. case ODM_CMNINFO_PNP_IN:
  1408. p_dm_odm->p_is_driver_is_going_to_pnp_set_power_sleep = (boolean *)p_value;
  1409. break;
  1410. case ODM_CMNINFO_INIT_ON:
  1411. p_dm_odm->pinit_adpt_in_progress = (boolean *)p_value;
  1412. break;
  1413. case ODM_CMNINFO_ANT_TEST:
  1414. p_dm_odm->p_antenna_test = (u8 *)p_value;
  1415. break;
  1416. case ODM_CMNINFO_NET_CLOSED:
  1417. p_dm_odm->p_is_net_closed = (boolean *)p_value;
  1418. break;
  1419. case ODM_CMNINFO_FORCED_RATE:
  1420. p_dm_odm->p_forced_data_rate = (u16 *)p_value;
  1421. break;
  1422. case ODM_CMNINFO_ANT_DIV:
  1423. p_dm_odm->p_enable_antdiv = (u8 *)p_value;
  1424. break;
  1425. case ODM_CMNINFO_ADAPTIVITY:
  1426. p_dm_odm->p_enable_adaptivity = (u8 *)p_value;
  1427. break;
  1428. case ODM_CMNINFO_FORCED_IGI_LB:
  1429. p_dm_odm->pu1_forced_igi_lb = (u8 *)p_value;
  1430. break;
  1431. case ODM_CMNINFO_P2P_LINK:
  1432. p_dm_odm->dm_dig_table.is_p2p_in_process = (u8 *)p_value;
  1433. break;
  1434. case ODM_CMNINFO_IS1ANTENNA:
  1435. p_dm_odm->p_is_1_antenna = (boolean *)p_value;
  1436. break;
  1437. case ODM_CMNINFO_RFDEFAULTPATH:
  1438. p_dm_odm->p_rf_default_path = (u8 *)p_value;
  1439. break;
  1440. case ODM_CMNINFO_FCS_MODE:
  1441. p_dm_odm->p_is_fcs_mode_enable = (boolean *)p_value;
  1442. break;
  1443. /*add by YuChen for beamforming PhyDM*/
  1444. case ODM_CMNINFO_HUBUSBMODE:
  1445. p_dm_odm->hub_usb_mode = (u8 *)p_value;
  1446. break;
  1447. case ODM_CMNINFO_FWDWRSVDPAGEINPROGRESS:
  1448. p_dm_odm->p_is_fw_dw_rsvd_page_in_progress = (boolean *)p_value;
  1449. break;
  1450. case ODM_CMNINFO_TX_TP:
  1451. p_dm_odm->p_current_tx_tp = (u32 *)p_value;
  1452. break;
  1453. case ODM_CMNINFO_RX_TP:
  1454. p_dm_odm->p_current_rx_tp = (u32 *)p_value;
  1455. break;
  1456. case ODM_CMNINFO_SOUNDING_SEQ:
  1457. p_dm_odm->p_sounding_seq = (u8 *)p_value;
  1458. break;
  1459. #ifdef CONFIG_PHYDM_DFS_MASTER
  1460. case ODM_CMNINFO_DFS_MASTER_ENABLE:
  1461. p_dm_odm->dfs_master_enabled = (u8 *)p_value;
  1462. break;
  1463. #endif
  1464. case ODM_CMNINFO_FORCE_TX_ANT_BY_TXDESC:
  1465. p_dm_odm->dm_fat_table.p_force_tx_ant_by_desc = (u8 *)p_value;
  1466. break;
  1467. case ODM_CMNINFO_SET_S0S1_DEFAULT_ANTENNA:
  1468. p_dm_odm->dm_fat_table.p_default_s0_s1 = (u8 *)p_value;
  1469. break;
  1470. case ODM_CMNINFO_SOFT_AP_MODE:
  1471. p_dm_odm->p_soft_ap_mode = (u32 *)p_value;
  1472. break;
  1473. default:
  1474. /*do nothing*/
  1475. break;
  1476. }
  1477. }
  1478. void
  1479. odm_cmn_info_ptr_array_hook(
  1480. struct PHY_DM_STRUCT *p_dm_odm,
  1481. enum odm_cmninfo_e cmn_info,
  1482. u16 index,
  1483. void *p_value
  1484. )
  1485. {
  1486. /*Hook call by reference pointer.*/
  1487. switch (cmn_info) {
  1488. /*Dynamic call by reference pointer. */
  1489. case ODM_CMNINFO_STA_STATUS:
  1490. p_dm_odm->p_odm_sta_info[index] = (struct sta_info *)p_value;
  1491. if (IS_STA_VALID(p_dm_odm->p_odm_sta_info[index]))
  1492. #if (DM_ODM_SUPPORT_TYPE == ODM_WIN)
  1493. p_dm_odm->platform2phydm_macid_table[((struct sta_info *)p_value)->AssociatedMacId] = index; /*associated_mac_id are unique bttween different adapter*/
  1494. #elif (DM_ODM_SUPPORT_TYPE == ODM_AP)
  1495. p_dm_odm->platform2phydm_macid_table[((struct sta_info *)p_value)->aid] = index;
  1496. #elif (DM_ODM_SUPPORT_TYPE == ODM_CE)
  1497. p_dm_odm->platform2phydm_macid_table[((struct sta_info *)p_value)->mac_id] = index;
  1498. #endif
  1499. break;
  1500. /* To remove the compiler warning, must add an empty default statement to handle the other values. */
  1501. default:
  1502. /* do nothing */
  1503. break;
  1504. }
  1505. }
  1506. /*
  1507. * Update band/CHannel/.. The values are dynamic but non-per-packet.
  1508. * */
  1509. void
  1510. odm_cmn_info_update(
  1511. struct PHY_DM_STRUCT *p_dm_odm,
  1512. u32 cmn_info,
  1513. u64 value
  1514. )
  1515. {
  1516. /* */
  1517. /* This init variable may be changed in run time. */
  1518. /* */
  1519. switch (cmn_info) {
  1520. case ODM_CMNINFO_LINK_IN_PROGRESS:
  1521. p_dm_odm->is_link_in_process = (boolean)value;
  1522. break;
  1523. case ODM_CMNINFO_ABILITY:
  1524. p_dm_odm->support_ability = (u32)value;
  1525. break;
  1526. case ODM_CMNINFO_RF_TYPE:
  1527. p_dm_odm->rf_type = (u8)value;
  1528. break;
  1529. case ODM_CMNINFO_WIFI_DIRECT:
  1530. p_dm_odm->is_wifi_direct = (boolean)value;
  1531. break;
  1532. case ODM_CMNINFO_WIFI_DISPLAY:
  1533. p_dm_odm->is_wifi_display = (boolean)value;
  1534. break;
  1535. case ODM_CMNINFO_LINK:
  1536. p_dm_odm->is_linked = (boolean)value;
  1537. break;
  1538. case ODM_CMNINFO_CMW500LINK:
  1539. p_dm_odm->bLinkedcmw500 = (boolean)value;
  1540. break;
  1541. case ODM_CMNINFO_LPSPG:
  1542. p_dm_odm->is_in_lps_pg = (boolean)value;
  1543. break;
  1544. case ODM_CMNINFO_STATION_STATE:
  1545. p_dm_odm->bsta_state = (boolean)value;
  1546. break;
  1547. case ODM_CMNINFO_RSSI_MIN:
  1548. p_dm_odm->rssi_min = (u8)value;
  1549. break;
  1550. case ODM_CMNINFO_DBG_COMP:
  1551. p_dm_odm->debug_components = (u32)value;
  1552. break;
  1553. case ODM_CMNINFO_DBG_LEVEL:
  1554. p_dm_odm->debug_level = (u32)value;
  1555. break;
  1556. case ODM_CMNINFO_RA_THRESHOLD_HIGH:
  1557. p_dm_odm->rate_adaptive.high_rssi_thresh = (u8)value;
  1558. break;
  1559. case ODM_CMNINFO_RA_THRESHOLD_LOW:
  1560. p_dm_odm->rate_adaptive.low_rssi_thresh = (u8)value;
  1561. break;
  1562. #if defined(BT_SUPPORT) && (BT_SUPPORT == 1)
  1563. /* The following is for BT HS mode and BT coexist mechanism. */
  1564. case ODM_CMNINFO_BT_ENABLED:
  1565. p_dm_odm->is_bt_enabled = (boolean)value;
  1566. break;
  1567. case ODM_CMNINFO_BT_HS_CONNECT_PROCESS:
  1568. p_dm_odm->is_bt_connect_process = (boolean)value;
  1569. break;
  1570. case ODM_CMNINFO_BT_HS_RSSI:
  1571. p_dm_odm->bt_hs_rssi = (u8)value;
  1572. break;
  1573. case ODM_CMNINFO_BT_OPERATION:
  1574. p_dm_odm->is_bt_hs_operation = (boolean)value;
  1575. break;
  1576. case ODM_CMNINFO_BT_LIMITED_DIG:
  1577. p_dm_odm->is_bt_limited_dig = (boolean)value;
  1578. break;
  1579. case ODM_CMNINFO_BT_DIG:
  1580. p_dm_odm->bt_hs_dig_val = (u8)value;
  1581. break;
  1582. case ODM_CMNINFO_BT_BUSY:
  1583. p_dm_odm->is_bt_busy = (boolean)value;
  1584. break;
  1585. case ODM_CMNINFO_BT_DISABLE_EDCA:
  1586. p_dm_odm->is_bt_disable_edca_turbo = (boolean)value;
  1587. break;
  1588. #endif
  1589. #if (DM_ODM_SUPPORT_TYPE & ODM_AP) /* for repeater mode add by YuChen 2014.06.23 */
  1590. #ifdef UNIVERSAL_REPEATER
  1591. case ODM_CMNINFO_VXD_LINK:
  1592. p_dm_odm->vxd_linked = (boolean)value;
  1593. break;
  1594. #endif
  1595. #endif
  1596. case ODM_CMNINFO_AP_TOTAL_NUM:
  1597. p_dm_odm->ap_total_num = (u8)value;
  1598. break;
  1599. case ODM_CMNINFO_POWER_TRAINING:
  1600. p_dm_odm->is_disable_power_training = (boolean)value;
  1601. break;
  1602. #ifdef CONFIG_PHYDM_DFS_MASTER
  1603. case ODM_CMNINFO_DFS_REGION_DOMAIN:
  1604. p_dm_odm->dfs_region_domain = (u8)value;
  1605. break;
  1606. #endif
  1607. #if 0
  1608. case ODM_CMNINFO_OP_MODE:
  1609. p_dm_odm->op_mode = (u8)value;
  1610. break;
  1611. case ODM_CMNINFO_WM_MODE:
  1612. p_dm_odm->wireless_mode = (u8)value;
  1613. break;
  1614. case ODM_CMNINFO_BAND:
  1615. p_dm_odm->band_type = (u8)value;
  1616. break;
  1617. case ODM_CMNINFO_SEC_CHNL_OFFSET:
  1618. p_dm_odm->sec_ch_offset = (u8)value;
  1619. break;
  1620. case ODM_CMNINFO_SEC_MODE:
  1621. p_dm_odm->security = (u8)value;
  1622. break;
  1623. case ODM_CMNINFO_BW:
  1624. p_dm_odm->band_width = (u8)value;
  1625. break;
  1626. case ODM_CMNINFO_CHNL:
  1627. p_dm_odm->channel = (u8)value;
  1628. break;
  1629. #endif
  1630. default:
  1631. /* do nothing */
  1632. break;
  1633. }
  1634. }
  1635. u32
  1636. phydm_cmn_info_query(
  1637. struct PHY_DM_STRUCT *p_dm_odm,
  1638. enum phydm_info_query_e info_type
  1639. )
  1640. {
  1641. struct _FALSE_ALARM_STATISTICS *false_alm_cnt = (struct _FALSE_ALARM_STATISTICS *)phydm_get_structure(p_dm_odm, PHYDM_FALSEALMCNT);
  1642. switch (info_type) {
  1643. case PHYDM_INFO_FA_OFDM:
  1644. return false_alm_cnt->cnt_ofdm_fail;
  1645. case PHYDM_INFO_FA_CCK:
  1646. return false_alm_cnt->cnt_cck_fail;
  1647. case PHYDM_INFO_FA_TOTAL:
  1648. return false_alm_cnt->cnt_all;
  1649. case PHYDM_INFO_CCA_OFDM:
  1650. return false_alm_cnt->cnt_ofdm_cca;
  1651. case PHYDM_INFO_CCA_CCK:
  1652. return false_alm_cnt->cnt_cck_cca;
  1653. case PHYDM_INFO_CCA_ALL:
  1654. return false_alm_cnt->cnt_cca_all;
  1655. case PHYDM_INFO_CRC32_OK_VHT:
  1656. return false_alm_cnt->cnt_vht_crc32_ok;
  1657. case PHYDM_INFO_CRC32_OK_HT:
  1658. return false_alm_cnt->cnt_ht_crc32_ok;
  1659. case PHYDM_INFO_CRC32_OK_LEGACY:
  1660. return false_alm_cnt->cnt_ofdm_crc32_ok;
  1661. case PHYDM_INFO_CRC32_OK_CCK:
  1662. return false_alm_cnt->cnt_cck_crc32_ok;
  1663. case PHYDM_INFO_CRC32_ERROR_VHT:
  1664. return false_alm_cnt->cnt_vht_crc32_error;
  1665. case PHYDM_INFO_CRC32_ERROR_HT:
  1666. return false_alm_cnt->cnt_ht_crc32_error;
  1667. case PHYDM_INFO_CRC32_ERROR_LEGACY:
  1668. return false_alm_cnt->cnt_ofdm_crc32_error;
  1669. case PHYDM_INFO_CRC32_ERROR_CCK:
  1670. return false_alm_cnt->cnt_cck_crc32_error;
  1671. case PHYDM_INFO_EDCCA_FLAG:
  1672. return false_alm_cnt->edcca_flag;
  1673. case PHYDM_INFO_OFDM_ENABLE:
  1674. return false_alm_cnt->ofdm_block_enable;
  1675. case PHYDM_INFO_CCK_ENABLE:
  1676. return false_alm_cnt->cck_block_enable;
  1677. case PHYDM_INFO_DBG_PORT_0:
  1678. return false_alm_cnt->dbg_port0;
  1679. default:
  1680. return 0xffffffff;
  1681. }
  1682. }
  1683. #if (DM_ODM_SUPPORT_TYPE == ODM_WIN)
  1684. void
  1685. odm_init_all_work_items(struct PHY_DM_STRUCT *p_dm_odm)
  1686. {
  1687. struct _ADAPTER *p_adapter = p_dm_odm->adapter;
  1688. #if USE_WORKITEM
  1689. #if CONFIG_DYNAMIC_RX_PATH
  1690. odm_initialize_work_item(p_dm_odm,
  1691. &p_dm_odm->dm_drp_table.phydm_dynamic_rx_path_workitem,
  1692. (RT_WORKITEM_CALL_BACK)phydm_dynamic_rx_path_workitem_callback,
  1693. (void *)p_adapter,
  1694. "DynamicRxPathWorkitem");
  1695. #endif
  1696. #ifdef CONFIG_S0S1_SW_ANTENNA_DIVERSITY
  1697. odm_initialize_work_item(p_dm_odm,
  1698. &p_dm_odm->dm_swat_table.phydm_sw_antenna_switch_workitem,
  1699. (RT_WORKITEM_CALL_BACK)odm_sw_antdiv_workitem_callback,
  1700. (void *)p_adapter,
  1701. "AntennaSwitchWorkitem");
  1702. #endif
  1703. #if (defined(CONFIG_HL_SMART_ANTENNA_TYPE1)) || (defined(CONFIG_HL_SMART_ANTENNA_TYPE2))
  1704. odm_initialize_work_item(p_dm_odm,
  1705. &p_dm_odm->dm_sat_table.hl_smart_antenna_workitem,
  1706. (RT_WORKITEM_CALL_BACK)phydm_beam_switch_workitem_callback,
  1707. (void *)p_adapter,
  1708. "hl_smart_ant_workitem");
  1709. odm_initialize_work_item(p_dm_odm,
  1710. &p_dm_odm->dm_sat_table.hl_smart_antenna_decision_workitem,
  1711. (RT_WORKITEM_CALL_BACK)phydm_beam_decision_workitem_callback,
  1712. (void *)p_adapter,
  1713. "hl_smart_ant_decision_workitem");
  1714. #endif
  1715. odm_initialize_work_item(
  1716. p_dm_odm,
  1717. &(p_dm_odm->path_div_switch_workitem),
  1718. (RT_WORKITEM_CALL_BACK)odm_path_div_chk_ant_switch_workitem_callback,
  1719. (void *)p_adapter,
  1720. "SWAS_WorkItem");
  1721. odm_initialize_work_item(
  1722. p_dm_odm,
  1723. &(p_dm_odm->cck_path_diversity_workitem),
  1724. (RT_WORKITEM_CALL_BACK)odm_cck_tx_path_diversity_work_item_callback,
  1725. (void *)p_adapter,
  1726. "CCKTXPathDiversityWorkItem");
  1727. odm_initialize_work_item(
  1728. p_dm_odm,
  1729. &(p_dm_odm->mpt_dig_workitem),
  1730. (RT_WORKITEM_CALL_BACK)odm_mpt_dig_work_item_callback,
  1731. (void *)p_adapter,
  1732. "mpt_dig_workitem");
  1733. odm_initialize_work_item(
  1734. p_dm_odm,
  1735. &(p_dm_odm->ra_rpt_workitem),
  1736. (RT_WORKITEM_CALL_BACK)odm_update_init_rate_work_item_callback,
  1737. (void *)p_adapter,
  1738. "ra_rpt_workitem");
  1739. #if (defined(CONFIG_5G_CG_SMART_ANT_DIVERSITY)) || (defined(CONFIG_2G_CG_SMART_ANT_DIVERSITY))
  1740. odm_initialize_work_item(
  1741. p_dm_odm,
  1742. &(p_dm_odm->fast_ant_training_workitem),
  1743. (RT_WORKITEM_CALL_BACK)odm_fast_ant_training_work_item_callback,
  1744. (void *)p_adapter,
  1745. "fast_ant_training_workitem");
  1746. #endif
  1747. #endif /*#if USE_WORKITEM*/
  1748. #if (BEAMFORMING_SUPPORT == 1)
  1749. odm_initialize_work_item(
  1750. p_dm_odm,
  1751. &(p_dm_odm->beamforming_info.txbf_info.txbf_enter_work_item),
  1752. (RT_WORKITEM_CALL_BACK)hal_com_txbf_enter_work_item_callback,
  1753. (void *)p_adapter,
  1754. "txbf_enter_work_item");
  1755. odm_initialize_work_item(
  1756. p_dm_odm,
  1757. &(p_dm_odm->beamforming_info.txbf_info.txbf_leave_work_item),
  1758. (RT_WORKITEM_CALL_BACK)hal_com_txbf_leave_work_item_callback,
  1759. (void *)p_adapter,
  1760. "txbf_leave_work_item");
  1761. odm_initialize_work_item(
  1762. p_dm_odm,
  1763. &(p_dm_odm->beamforming_info.txbf_info.txbf_fw_ndpa_work_item),
  1764. (RT_WORKITEM_CALL_BACK)hal_com_txbf_fw_ndpa_work_item_callback,
  1765. (void *)p_adapter,
  1766. "txbf_fw_ndpa_work_item");
  1767. odm_initialize_work_item(
  1768. p_dm_odm,
  1769. &(p_dm_odm->beamforming_info.txbf_info.txbf_clk_work_item),
  1770. (RT_WORKITEM_CALL_BACK)hal_com_txbf_clk_work_item_callback,
  1771. (void *)p_adapter,
  1772. "txbf_clk_work_item");
  1773. odm_initialize_work_item(
  1774. p_dm_odm,
  1775. &(p_dm_odm->beamforming_info.txbf_info.txbf_rate_work_item),
  1776. (RT_WORKITEM_CALL_BACK)hal_com_txbf_rate_work_item_callback,
  1777. (void *)p_adapter,
  1778. "txbf_rate_work_item");
  1779. odm_initialize_work_item(
  1780. p_dm_odm,
  1781. &(p_dm_odm->beamforming_info.txbf_info.txbf_status_work_item),
  1782. (RT_WORKITEM_CALL_BACK)hal_com_txbf_status_work_item_callback,
  1783. (void *)p_adapter,
  1784. "txbf_status_work_item");
  1785. odm_initialize_work_item(
  1786. p_dm_odm,
  1787. &(p_dm_odm->beamforming_info.txbf_info.txbf_reset_tx_path_work_item),
  1788. (RT_WORKITEM_CALL_BACK)hal_com_txbf_reset_tx_path_work_item_callback,
  1789. (void *)p_adapter,
  1790. "txbf_reset_tx_path_work_item");
  1791. odm_initialize_work_item(
  1792. p_dm_odm,
  1793. &(p_dm_odm->beamforming_info.txbf_info.txbf_get_tx_rate_work_item),
  1794. (RT_WORKITEM_CALL_BACK)hal_com_txbf_get_tx_rate_work_item_callback,
  1795. (void *)p_adapter,
  1796. "txbf_get_tx_rate_work_item");
  1797. #endif
  1798. odm_initialize_work_item(
  1799. p_dm_odm,
  1800. &(p_dm_odm->adaptivity.phydm_pause_edcca_work_item),
  1801. (RT_WORKITEM_CALL_BACK)phydm_pause_edcca_work_item_callback,
  1802. (void *)p_adapter,
  1803. "phydm_pause_edcca_work_item");
  1804. odm_initialize_work_item(
  1805. p_dm_odm,
  1806. &(p_dm_odm->adaptivity.phydm_resume_edcca_work_item),
  1807. (RT_WORKITEM_CALL_BACK)phydm_resume_edcca_work_item_callback,
  1808. (void *)p_adapter,
  1809. "phydm_resume_edcca_work_item");
  1810. #if (PHYDM_LA_MODE_SUPPORT == 1)
  1811. odm_initialize_work_item(
  1812. p_dm_odm,
  1813. &(p_dm_odm->adcsmp.adc_smp_work_item),
  1814. (RT_WORKITEM_CALL_BACK)adc_smp_work_item_callback,
  1815. (void *)p_adapter,
  1816. "adc_smp_work_item");
  1817. odm_initialize_work_item(
  1818. p_dm_odm,
  1819. &(p_dm_odm->adcsmp.adc_smp_work_item_1),
  1820. (RT_WORKITEM_CALL_BACK)adc_smp_work_item_callback,
  1821. (void *)p_adapter,
  1822. "adc_smp_work_item_1");
  1823. #endif
  1824. }
  1825. void
  1826. odm_free_all_work_items(struct PHY_DM_STRUCT *p_dm_odm)
  1827. {
  1828. #if USE_WORKITEM
  1829. #ifdef CONFIG_S0S1_SW_ANTENNA_DIVERSITY
  1830. odm_free_work_item(&(p_dm_odm->dm_swat_table.phydm_sw_antenna_switch_workitem));
  1831. #endif
  1832. #if CONFIG_DYNAMIC_RX_PATH
  1833. odm_free_work_item(&(p_dm_odm->dm_drp_table.phydm_dynamic_rx_path_workitem));
  1834. #endif
  1835. #if (defined(CONFIG_HL_SMART_ANTENNA_TYPE1)) || (defined(CONFIG_HL_SMART_ANTENNA_TYPE2))
  1836. odm_free_work_item(&(p_dm_odm->dm_sat_table.hl_smart_antenna_workitem));
  1837. odm_free_work_item(&(p_dm_odm->dm_sat_table.hl_smart_antenna_decision_workitem));
  1838. #endif
  1839. odm_free_work_item(&(p_dm_odm->path_div_switch_workitem));
  1840. odm_free_work_item(&(p_dm_odm->cck_path_diversity_workitem));
  1841. #if (defined(CONFIG_5G_CG_SMART_ANT_DIVERSITY)) || (defined(CONFIG_2G_CG_SMART_ANT_DIVERSITY))
  1842. odm_free_work_item(&(p_dm_odm->fast_ant_training_workitem));
  1843. #endif
  1844. odm_free_work_item(&(p_dm_odm->mpt_dig_workitem));
  1845. odm_free_work_item(&(p_dm_odm->ra_rpt_workitem));
  1846. /*odm_free_work_item((&p_dm_odm->sbdcnt_workitem));*/
  1847. #endif
  1848. #if (BEAMFORMING_SUPPORT == 1)
  1849. odm_free_work_item((&p_dm_odm->beamforming_info.txbf_info.txbf_enter_work_item));
  1850. odm_free_work_item((&p_dm_odm->beamforming_info.txbf_info.txbf_leave_work_item));
  1851. odm_free_work_item((&p_dm_odm->beamforming_info.txbf_info.txbf_fw_ndpa_work_item));
  1852. odm_free_work_item((&p_dm_odm->beamforming_info.txbf_info.txbf_clk_work_item));
  1853. odm_free_work_item((&p_dm_odm->beamforming_info.txbf_info.txbf_rate_work_item));
  1854. odm_free_work_item((&p_dm_odm->beamforming_info.txbf_info.txbf_status_work_item));
  1855. odm_free_work_item((&p_dm_odm->beamforming_info.txbf_info.txbf_reset_tx_path_work_item));
  1856. odm_free_work_item((&p_dm_odm->beamforming_info.txbf_info.txbf_get_tx_rate_work_item));
  1857. #endif
  1858. odm_free_work_item((&p_dm_odm->adaptivity.phydm_pause_edcca_work_item));
  1859. odm_free_work_item((&p_dm_odm->adaptivity.phydm_resume_edcca_work_item));
  1860. #if (PHYDM_LA_MODE_SUPPORT == 1)
  1861. odm_free_work_item((&p_dm_odm->adcsmp.adc_smp_work_item));
  1862. odm_free_work_item((&p_dm_odm->adcsmp.adc_smp_work_item_1));
  1863. #endif
  1864. }
  1865. #endif /*#if (DM_ODM_SUPPORT_TYPE == ODM_WIN)*/
  1866. #if 0
  1867. void
  1868. odm_FindMinimumRSSI(
  1869. struct PHY_DM_STRUCT *p_dm_odm
  1870. )
  1871. {
  1872. u32 i;
  1873. u8 rssi_min = 0xFF;
  1874. for (i = 0; i < ODM_ASSOCIATE_ENTRY_NUM; i++) {
  1875. /* if(p_dm_odm->p_odm_sta_info[i] != NULL) */
  1876. if (IS_STA_VALID(p_dm_odm->p_odm_sta_info[i])) {
  1877. if (p_dm_odm->p_odm_sta_info[i]->rssi_ave < rssi_min)
  1878. rssi_min = p_dm_odm->p_odm_sta_info[i]->rssi_ave;
  1879. }
  1880. }
  1881. p_dm_odm->rssi_min = rssi_min;
  1882. }
  1883. void
  1884. odm_IsLinked(
  1885. struct PHY_DM_STRUCT *p_dm_odm
  1886. )
  1887. {
  1888. u32 i;
  1889. boolean Linked = false;
  1890. for (i = 0; i < ODM_ASSOCIATE_ENTRY_NUM; i++) {
  1891. if (IS_STA_VALID(p_dm_odm->p_odm_sta_info[i])) {
  1892. Linked = true;
  1893. break;
  1894. }
  1895. }
  1896. p_dm_odm->is_linked = Linked;
  1897. }
  1898. #endif
  1899. void
  1900. odm_init_all_timers(
  1901. struct PHY_DM_STRUCT *p_dm_odm
  1902. )
  1903. {
  1904. #if (defined(CONFIG_PHYDM_ANTENNA_DIVERSITY))
  1905. odm_ant_div_timers(p_dm_odm, INIT_ANTDIV_TIMMER);
  1906. #endif
  1907. #if (CONFIG_DYNAMIC_RX_PATH == 1)
  1908. phydm_dynamic_rx_path_timers(p_dm_odm, INIT_DRP_TIMMER);
  1909. #endif
  1910. #if (DM_ODM_SUPPORT_TYPE == ODM_AP)
  1911. #ifdef MP_TEST
  1912. if (p_dm_odm->priv->pshare->rf_ft_var.mp_specific)
  1913. odm_initialize_timer(p_dm_odm, &p_dm_odm->mpt_dig_timer,
  1914. (void *)odm_mpt_dig_callback, NULL, "mpt_dig_timer");
  1915. #endif
  1916. #elif (DM_ODM_SUPPORT_TYPE == ODM_WIN)
  1917. odm_initialize_timer(p_dm_odm, &p_dm_odm->mpt_dig_timer,
  1918. (void *)odm_mpt_dig_callback, NULL, "mpt_dig_timer");
  1919. #endif
  1920. #if (DM_ODM_SUPPORT_TYPE == ODM_WIN)
  1921. odm_initialize_timer(p_dm_odm, &p_dm_odm->path_div_switch_timer,
  1922. (void *)odm_path_div_chk_ant_switch_callback, NULL, "PathDivTimer");
  1923. odm_initialize_timer(p_dm_odm, &p_dm_odm->cck_path_diversity_timer,
  1924. (void *)odm_cck_tx_path_diversity_callback, NULL, "cck_path_diversity_timer");
  1925. odm_initialize_timer(p_dm_odm, &p_dm_odm->sbdcnt_timer,
  1926. (void *)phydm_sbd_callback, NULL, "SbdTimer");
  1927. #if (BEAMFORMING_SUPPORT == 1)
  1928. odm_initialize_timer(p_dm_odm, &p_dm_odm->beamforming_info.txbf_info.txbf_fw_ndpa_timer,
  1929. (void *)hal_com_txbf_fw_ndpa_timer_callback, NULL, "txbf_fw_ndpa_timer");
  1930. #endif
  1931. #endif
  1932. #if (DM_ODM_SUPPORT_TYPE & (ODM_WIN | ODM_CE))
  1933. #if (BEAMFORMING_SUPPORT == 1)
  1934. odm_initialize_timer(p_dm_odm, &p_dm_odm->beamforming_info.beamforming_timer,
  1935. (void *)beamforming_sw_timer_callback, NULL, "beamforming_timer");
  1936. #endif
  1937. #endif
  1938. }
  1939. void
  1940. odm_cancel_all_timers(
  1941. struct PHY_DM_STRUCT *p_dm_odm
  1942. )
  1943. {
  1944. #if (DM_ODM_SUPPORT_TYPE == ODM_WIN)
  1945. /* */
  1946. /* 2012/01/12 MH Temp BSOD fix. We need to find NIC allocate mem fail reason in */
  1947. /* win7 platform. */
  1948. /* */
  1949. HAL_ADAPTER_STS_CHK(p_dm_odm);
  1950. #endif
  1951. #if (defined(CONFIG_PHYDM_ANTENNA_DIVERSITY))
  1952. odm_ant_div_timers(p_dm_odm, CANCEL_ANTDIV_TIMMER);
  1953. #endif
  1954. #if (CONFIG_DYNAMIC_RX_PATH == 1)
  1955. phydm_dynamic_rx_path_timers(p_dm_odm, CANCEL_DRP_TIMMER);
  1956. #endif
  1957. #if (DM_ODM_SUPPORT_TYPE == ODM_AP)
  1958. #ifdef MP_TEST
  1959. if (p_dm_odm->priv->pshare->rf_ft_var.mp_specific)
  1960. odm_cancel_timer(p_dm_odm, &p_dm_odm->mpt_dig_timer);
  1961. #endif
  1962. #elif (DM_ODM_SUPPORT_TYPE == ODM_WIN)
  1963. odm_cancel_timer(p_dm_odm, &p_dm_odm->mpt_dig_timer);
  1964. #endif
  1965. #if (DM_ODM_SUPPORT_TYPE == ODM_WIN)
  1966. odm_cancel_timer(p_dm_odm, &p_dm_odm->path_div_switch_timer);
  1967. odm_cancel_timer(p_dm_odm, &p_dm_odm->cck_path_diversity_timer);
  1968. odm_cancel_timer(p_dm_odm, &p_dm_odm->mpt_dig_timer);
  1969. odm_cancel_timer(p_dm_odm, &p_dm_odm->sbdcnt_timer);
  1970. #if (BEAMFORMING_SUPPORT == 1)
  1971. odm_cancel_timer(p_dm_odm, &p_dm_odm->beamforming_info.txbf_info.txbf_fw_ndpa_timer);
  1972. #endif
  1973. #endif
  1974. #if (DM_ODM_SUPPORT_TYPE & (ODM_WIN | ODM_CE))
  1975. #if (BEAMFORMING_SUPPORT == 1)
  1976. odm_cancel_timer(p_dm_odm, &p_dm_odm->beamforming_info.beamforming_timer);
  1977. #endif
  1978. #endif
  1979. }
  1980. void
  1981. odm_release_all_timers(
  1982. struct PHY_DM_STRUCT *p_dm_odm
  1983. )
  1984. {
  1985. #if (defined(CONFIG_PHYDM_ANTENNA_DIVERSITY))
  1986. odm_ant_div_timers(p_dm_odm, RELEASE_ANTDIV_TIMMER);
  1987. #endif
  1988. #if (CONFIG_DYNAMIC_RX_PATH == 1)
  1989. phydm_dynamic_rx_path_timers(p_dm_odm, RELEASE_DRP_TIMMER);
  1990. #endif
  1991. #if (DM_ODM_SUPPORT_TYPE == ODM_AP)
  1992. #ifdef MP_TEST
  1993. if (p_dm_odm->priv->pshare->rf_ft_var.mp_specific)
  1994. odm_release_timer(p_dm_odm, &p_dm_odm->mpt_dig_timer);
  1995. #endif
  1996. #elif (DM_ODM_SUPPORT_TYPE == ODM_WIN)
  1997. odm_release_timer(p_dm_odm, &p_dm_odm->mpt_dig_timer);
  1998. #endif
  1999. #if (DM_ODM_SUPPORT_TYPE == ODM_WIN)
  2000. odm_release_timer(p_dm_odm, &p_dm_odm->path_div_switch_timer);
  2001. odm_release_timer(p_dm_odm, &p_dm_odm->cck_path_diversity_timer);
  2002. odm_release_timer(p_dm_odm, &p_dm_odm->mpt_dig_timer);
  2003. odm_release_timer(p_dm_odm, &p_dm_odm->sbdcnt_timer);
  2004. #if (BEAMFORMING_SUPPORT == 1)
  2005. odm_release_timer(p_dm_odm, &p_dm_odm->beamforming_info.txbf_info.txbf_fw_ndpa_timer);
  2006. #endif
  2007. #endif
  2008. #if (DM_ODM_SUPPORT_TYPE & (ODM_WIN | ODM_CE))
  2009. #if (BEAMFORMING_SUPPORT == 1)
  2010. odm_release_timer(p_dm_odm, &p_dm_odm->beamforming_info.beamforming_timer);
  2011. #endif
  2012. #endif
  2013. }
  2014. /* 3============================================================
  2015. * 3 Tx Power Tracking
  2016. * 3============================================================ */
  2017. #if (DM_ODM_SUPPORT_TYPE == ODM_AP)
  2018. void
  2019. odm_init_all_threads(
  2020. struct PHY_DM_STRUCT *p_dm_odm
  2021. )
  2022. {
  2023. #ifdef TPT_THREAD
  2024. k_tpt_task_init(p_dm_odm->priv);
  2025. #endif
  2026. }
  2027. void
  2028. odm_stop_all_threads(
  2029. struct PHY_DM_STRUCT *p_dm_odm
  2030. )
  2031. {
  2032. #ifdef TPT_THREAD
  2033. k_tpt_task_stop(p_dm_odm->priv);
  2034. #endif
  2035. }
  2036. #endif
  2037. #if (DM_ODM_SUPPORT_TYPE == ODM_WIN)
  2038. /*
  2039. * 2011/07/26 MH Add an API for testing IQK fail case.
  2040. * */
  2041. boolean
  2042. odm_check_power_status(
  2043. struct _ADAPTER *adapter)
  2044. {
  2045. HAL_DATA_TYPE *p_hal_data = GET_HAL_DATA(adapter);
  2046. struct PHY_DM_STRUCT *p_dm_odm = &p_hal_data->DM_OutSrc;
  2047. RT_RF_POWER_STATE rt_state;
  2048. PMGNT_INFO p_mgnt_info = &(adapter->MgntInfo);
  2049. /* 2011/07/27 MH We are not testing ready~~!! We may fail to get correct value when init sequence. */
  2050. if (p_mgnt_info->init_adpt_in_progress == true) {
  2051. ODM_RT_TRACE(p_dm_odm, ODM_COMP_INIT, ODM_DBG_LOUD, ("odm_check_power_status Return true, due to initadapter\n"));
  2052. return true;
  2053. }
  2054. /* */
  2055. /* 2011/07/19 MH We can not execute tx pwoer tracking/ LLC calibrate or IQK. */
  2056. /* */
  2057. adapter->HalFunc.GetHwRegHandler(adapter, HW_VAR_RF_STATE, (u8 *)(&rt_state));
  2058. if (adapter->bDriverStopped || adapter->bDriverIsGoingToPnpSetPowerSleep || rt_state == eRfOff) {
  2059. ODM_RT_TRACE(p_dm_odm, ODM_COMP_INIT, ODM_DBG_LOUD, ("odm_check_power_status Return false, due to %d/%d/%d\n",
  2060. adapter->bDriverStopped, adapter->bDriverIsGoingToPnpSetPowerSleep, rt_state));
  2061. return false;
  2062. }
  2063. return true;
  2064. }
  2065. #elif (DM_ODM_SUPPORT_TYPE == ODM_AP)
  2066. boolean
  2067. odm_check_power_status(
  2068. struct _ADAPTER *adapter)
  2069. {
  2070. #if 0
  2071. /* HAL_DATA_TYPE *p_hal_data = GET_HAL_DATA(adapter); */
  2072. struct PHY_DM_STRUCT *p_dm_odm = &p_hal_data->DM_OutSrc;
  2073. RT_RF_POWER_STATE rt_state;
  2074. PMGNT_INFO p_mgnt_info = &(adapter->MgntInfo);
  2075. /* 2011/07/27 MH We are not testing ready~~!! We may fail to get correct value when init sequence. */
  2076. if (p_mgnt_info->init_adpt_in_progress == true) {
  2077. ODM_RT_TRACE(p_dm_odm, COMP_INIT, DBG_LOUD, ("odm_check_power_status Return true, due to initadapter"));
  2078. return true;
  2079. }
  2080. /* */
  2081. /* 2011/07/19 MH We can not execute tx pwoer tracking/ LLC calibrate or IQK. */
  2082. /* */
  2083. phydm_get_hw_reg_interface(p_dm_odm, HW_VAR_RF_STATE, (u8 *)(&rt_state));
  2084. if (adapter->is_driver_stopped || adapter->is_driver_is_going_to_pnp_set_power_sleep || rt_state == eRfOff) {
  2085. ODM_RT_TRACE(p_dm_odm, COMP_INIT, DBG_LOUD, ("odm_check_power_status Return false, due to %d/%d/%d\n",
  2086. adapter->is_driver_stopped, adapter->is_driver_is_going_to_pnp_set_power_sleep, rt_state));
  2087. return false;
  2088. }
  2089. #endif
  2090. return true;
  2091. }
  2092. #endif
  2093. /* need to ODM CE Platform
  2094. * move to here for ANT detection mechanism using */
  2095. u32
  2096. odm_convert_to_db(
  2097. u32 value)
  2098. {
  2099. u8 i;
  2100. u8 j;
  2101. u32 dB;
  2102. value = value & 0xFFFF;
  2103. for (i = 0; i < 12; i++) {
  2104. if (value <= db_invert_table[i][7])
  2105. break;
  2106. }
  2107. if (i >= 12) {
  2108. return 96; /* maximum 96 dB */
  2109. }
  2110. for (j = 0; j < 8; j++) {
  2111. if (value <= db_invert_table[i][j])
  2112. break;
  2113. }
  2114. dB = (i << 3) + j + 1;
  2115. return dB;
  2116. }
  2117. u32
  2118. odm_convert_to_linear(
  2119. u32 value)
  2120. {
  2121. u8 i;
  2122. u8 j;
  2123. u32 linear;
  2124. /* 1dB~96dB */
  2125. value = value & 0xFF;
  2126. i = (u8)((value - 1) >> 3);
  2127. j = (u8)(value - 1) - (i << 3);
  2128. linear = db_invert_table[i][j];
  2129. return linear;
  2130. }
  2131. /*
  2132. * ODM multi-port consideration, added by Roger, 2013.10.01.
  2133. * */
  2134. void
  2135. odm_asoc_entry_init(
  2136. struct PHY_DM_STRUCT *p_dm_odm
  2137. )
  2138. {
  2139. #if (DM_ODM_SUPPORT_TYPE == ODM_WIN)
  2140. struct _ADAPTER *p_loop_adapter = GetDefaultAdapter(p_dm_odm->adapter);
  2141. HAL_DATA_TYPE *p_hal_data = GET_HAL_DATA(p_loop_adapter);
  2142. struct PHY_DM_STRUCT *p_dm_out_src = &p_hal_data->DM_OutSrc;
  2143. u8 total_assoc_entry_num = 0;
  2144. u8 index = 0;
  2145. u8 adaptercount = 0;
  2146. odm_cmn_info_ptr_array_hook(p_dm_out_src, ODM_CMNINFO_STA_STATUS, 0, &p_loop_adapter->MgntInfo.DefaultPort[0]);
  2147. p_loop_adapter->MgntInfo.DefaultPort[0].MultiPortStationIdx = total_assoc_entry_num;
  2148. adaptercount += 1;
  2149. RT_TRACE(COMP_INIT, DBG_LOUD, ("adaptercount=%d\n", adaptercount));
  2150. p_loop_adapter = GetNextExtAdapter(p_loop_adapter);
  2151. total_assoc_entry_num += 1;
  2152. while (p_loop_adapter) {
  2153. for (index = 0; index < ASSOCIATE_ENTRY_NUM; index++) {
  2154. odm_cmn_info_ptr_array_hook(p_dm_out_src, ODM_CMNINFO_STA_STATUS, total_assoc_entry_num + index, &p_loop_adapter->MgntInfo.AsocEntry[index]);
  2155. p_loop_adapter->MgntInfo.AsocEntry[index].MultiPortStationIdx = total_assoc_entry_num + index;
  2156. }
  2157. total_assoc_entry_num += index;
  2158. if (IS_HARDWARE_TYPE_8188E((p_dm_odm->adapter)))
  2159. p_loop_adapter->RASupport = true;
  2160. adaptercount += 1;
  2161. RT_TRACE(COMP_INIT, DBG_LOUD, ("adaptercount=%d\n", adaptercount));
  2162. p_loop_adapter = GetNextExtAdapter(p_loop_adapter);
  2163. }
  2164. RT_TRACE(COMP_INIT, DBG_LOUD, ("total_assoc_entry_num = %d\n", total_assoc_entry_num));
  2165. if (total_assoc_entry_num < (ODM_ASSOCIATE_ENTRY_NUM - 1)) {
  2166. RT_TRACE(COMP_INIT, DBG_LOUD, ("In hook null\n"));
  2167. for (index = total_assoc_entry_num; index < ODM_ASSOCIATE_ENTRY_NUM; index++)
  2168. odm_cmn_info_ptr_array_hook(p_dm_out_src, ODM_CMNINFO_STA_STATUS, index, NULL);
  2169. }
  2170. #endif
  2171. }
  2172. #if (DM_ODM_SUPPORT_TYPE == ODM_CE)
  2173. /* Justin: According to the current RRSI to adjust Response Frame TX power, 2012/11/05 */
  2174. void odm_dtc(struct PHY_DM_STRUCT *p_dm_odm)
  2175. {
  2176. #ifdef CONFIG_DM_RESP_TXAGC
  2177. #define DTC_BASE 35 /* RSSI higher than this value, start to decade TX power */
  2178. #define DTC_DWN_BASE (DTC_BASE-5) /* RSSI lower than this value, start to increase TX power */
  2179. /* RSSI vs TX power step mapping: decade TX power */
  2180. static const u8 dtc_table_down[] = {
  2181. DTC_BASE,
  2182. (DTC_BASE + 5),
  2183. (DTC_BASE + 10),
  2184. (DTC_BASE + 15),
  2185. (DTC_BASE + 20),
  2186. (DTC_BASE + 25)
  2187. };
  2188. /* RSSI vs TX power step mapping: increase TX power */
  2189. static const u8 dtc_table_up[] = {
  2190. DTC_DWN_BASE,
  2191. (DTC_DWN_BASE - 5),
  2192. (DTC_DWN_BASE - 10),
  2193. (DTC_DWN_BASE - 15),
  2194. (DTC_DWN_BASE - 15),
  2195. (DTC_DWN_BASE - 20),
  2196. (DTC_DWN_BASE - 20),
  2197. (DTC_DWN_BASE - 25),
  2198. (DTC_DWN_BASE - 25),
  2199. (DTC_DWN_BASE - 30),
  2200. (DTC_DWN_BASE - 35)
  2201. };
  2202. u8 i;
  2203. u8 dtc_steps = 0;
  2204. u8 sign;
  2205. u8 resp_txagc = 0;
  2206. #if 0
  2207. /* As DIG is disabled, DTC is also disable */
  2208. if (!(p_dm_odm->support_ability & ODM_XXXXXX))
  2209. return;
  2210. #endif
  2211. if (DTC_BASE < p_dm_odm->rssi_min) {
  2212. /* need to decade the CTS TX power */
  2213. sign = 1;
  2214. for (i = 0; i < ARRAY_SIZE(dtc_table_down); i++) {
  2215. if ((dtc_table_down[i] >= p_dm_odm->rssi_min) || (dtc_steps >= 6))
  2216. break;
  2217. else
  2218. dtc_steps++;
  2219. }
  2220. }
  2221. #if 0
  2222. else if (DTC_DWN_BASE > p_dm_odm->rssi_min) {
  2223. /* needs to increase the CTS TX power */
  2224. sign = 0;
  2225. dtc_steps = 1;
  2226. for (i = 0; i < ARRAY_SIZE(dtc_table_up); i++) {
  2227. if ((dtc_table_up[i] <= p_dm_odm->rssi_min) || (dtc_steps >= 10))
  2228. break;
  2229. else
  2230. dtc_steps++;
  2231. }
  2232. }
  2233. #endif
  2234. else {
  2235. sign = 0;
  2236. dtc_steps = 0;
  2237. }
  2238. resp_txagc = dtc_steps | (sign << 4);
  2239. resp_txagc = resp_txagc | (resp_txagc << 5);
  2240. odm_write_1byte(p_dm_odm, 0x06d9, resp_txagc);
  2241. ODM_RT_TRACE(p_dm_odm, ODM_COMP_PWR_TRAIN, ODM_DBG_LOUD, ("%s rssi_min:%u, set RESP_TXAGC to %s %u\n",
  2242. __func__, p_dm_odm->rssi_min, sign ? "minus" : "plus", dtc_steps));
  2243. #endif /* CONFIG_RESP_TXAGC_ADJUST */
  2244. }
  2245. #endif /* #if (DM_ODM_SUPPORT_TYPE == ODM_CE) */
  2246. void
  2247. odm_update_power_training_state(
  2248. struct PHY_DM_STRUCT *p_dm_odm
  2249. )
  2250. {
  2251. #if (DM_ODM_SUPPORT_TYPE & (ODM_WIN | ODM_CE))
  2252. struct _FALSE_ALARM_STATISTICS *false_alm_cnt = (struct _FALSE_ALARM_STATISTICS *)phydm_get_structure(p_dm_odm, PHYDM_FALSEALMCNT);
  2253. struct _dynamic_initial_gain_threshold_ *p_dm_dig_table = &p_dm_odm->dm_dig_table;
  2254. u32 score = 0;
  2255. if (!(p_dm_odm->support_ability & ODM_BB_PWR_TRAIN))
  2256. return;
  2257. ODM_RT_TRACE(p_dm_odm, ODM_COMP_RA_MASK, ODM_DBG_LOUD, ("odm_update_power_training_state()============>\n"));
  2258. p_dm_odm->is_change_state = false;
  2259. /* Debug command */
  2260. if (p_dm_odm->force_power_training_state) {
  2261. if (p_dm_odm->force_power_training_state == 1 && !p_dm_odm->is_disable_power_training) {
  2262. p_dm_odm->is_change_state = true;
  2263. p_dm_odm->is_disable_power_training = true;
  2264. } else if (p_dm_odm->force_power_training_state == 2 && p_dm_odm->is_disable_power_training) {
  2265. p_dm_odm->is_change_state = true;
  2266. p_dm_odm->is_disable_power_training = false;
  2267. }
  2268. p_dm_odm->PT_score = 0;
  2269. p_dm_odm->phy_dbg_info.num_qry_phy_status_ofdm = 0;
  2270. p_dm_odm->phy_dbg_info.num_qry_phy_status_cck = 0;
  2271. ODM_RT_TRACE(p_dm_odm, ODM_COMP_RA_MASK, ODM_DBG_LOUD, ("odm_update_power_training_state(): force_power_training_state = %d\n",
  2272. p_dm_odm->force_power_training_state));
  2273. return;
  2274. }
  2275. if (!p_dm_odm->is_linked)
  2276. return;
  2277. /* First connect */
  2278. if ((p_dm_odm->is_linked) && (p_dm_dig_table->is_media_connect_0 == false)) {
  2279. p_dm_odm->PT_score = 0;
  2280. p_dm_odm->is_change_state = true;
  2281. p_dm_odm->phy_dbg_info.num_qry_phy_status_ofdm = 0;
  2282. p_dm_odm->phy_dbg_info.num_qry_phy_status_cck = 0;
  2283. ODM_RT_TRACE(p_dm_odm, ODM_COMP_RA_MASK, ODM_DBG_LOUD, ("odm_update_power_training_state(): First Connect\n"));
  2284. return;
  2285. }
  2286. /* Compute score */
  2287. if (p_dm_odm->nhm_cnt_0 >= 215)
  2288. score = 2;
  2289. else if (p_dm_odm->nhm_cnt_0 >= 190)
  2290. score = 1; /* unknow state */
  2291. else {
  2292. u32 rx_pkt_cnt;
  2293. rx_pkt_cnt = (u32)(p_dm_odm->phy_dbg_info.num_qry_phy_status_ofdm) + (u32)(p_dm_odm->phy_dbg_info.num_qry_phy_status_cck);
  2294. if ((false_alm_cnt->cnt_cca_all > 31 && rx_pkt_cnt > 31) && (false_alm_cnt->cnt_cca_all >= rx_pkt_cnt)) {
  2295. if ((rx_pkt_cnt + (rx_pkt_cnt >> 1)) <= false_alm_cnt->cnt_cca_all)
  2296. score = 0;
  2297. else if ((rx_pkt_cnt + (rx_pkt_cnt >> 2)) <= false_alm_cnt->cnt_cca_all)
  2298. score = 1;
  2299. else
  2300. score = 2;
  2301. }
  2302. ODM_RT_TRACE(p_dm_odm, ODM_COMP_RA_MASK, ODM_DBG_LOUD, ("odm_update_power_training_state(): rx_pkt_cnt = %d, cnt_cca_all = %d\n",
  2303. rx_pkt_cnt, false_alm_cnt->cnt_cca_all));
  2304. }
  2305. ODM_RT_TRACE(p_dm_odm, ODM_COMP_RA_MASK, ODM_DBG_LOUD, ("odm_update_power_training_state(): num_qry_phy_status_ofdm = %d, num_qry_phy_status_cck = %d\n",
  2306. (u32)(p_dm_odm->phy_dbg_info.num_qry_phy_status_ofdm), (u32)(p_dm_odm->phy_dbg_info.num_qry_phy_status_cck)));
  2307. ODM_RT_TRACE(p_dm_odm, ODM_COMP_RA_MASK, ODM_DBG_LOUD, ("odm_update_power_training_state(): nhm_cnt_0 = %d, score = %d\n",
  2308. p_dm_odm->nhm_cnt_0, score));
  2309. /* smoothing */
  2310. p_dm_odm->PT_score = (score << 4) + (p_dm_odm->PT_score >> 1) + (p_dm_odm->PT_score >> 2);
  2311. score = (p_dm_odm->PT_score + 32) >> 6;
  2312. ODM_RT_TRACE(p_dm_odm, ODM_COMP_RA_MASK, ODM_DBG_LOUD, ("odm_update_power_training_state(): PT_score = %d, score after smoothing = %d\n",
  2313. p_dm_odm->PT_score, score));
  2314. /* mode decision */
  2315. if (score == 2) {
  2316. if (p_dm_odm->is_disable_power_training) {
  2317. p_dm_odm->is_change_state = true;
  2318. p_dm_odm->is_disable_power_training = false;
  2319. ODM_RT_TRACE(p_dm_odm, ODM_COMP_RA_MASK, ODM_DBG_LOUD, ("odm_update_power_training_state(): Change state\n"));
  2320. }
  2321. ODM_RT_TRACE(p_dm_odm, ODM_COMP_RA_MASK, ODM_DBG_LOUD, ("odm_update_power_training_state(): Enable Power Training\n"));
  2322. } else if (score == 0) {
  2323. if (!p_dm_odm->is_disable_power_training) {
  2324. p_dm_odm->is_change_state = true;
  2325. p_dm_odm->is_disable_power_training = true;
  2326. ODM_RT_TRACE(p_dm_odm, ODM_COMP_RA_MASK, ODM_DBG_LOUD, ("odm_update_power_training_state(): Change state\n"));
  2327. }
  2328. ODM_RT_TRACE(p_dm_odm, ODM_COMP_RA_MASK, ODM_DBG_LOUD, ("odm_update_power_training_state(): Disable Power Training\n"));
  2329. }
  2330. p_dm_odm->phy_dbg_info.num_qry_phy_status_ofdm = 0;
  2331. p_dm_odm->phy_dbg_info.num_qry_phy_status_cck = 0;
  2332. #endif
  2333. }
  2334. /*===========================================================*/
  2335. /* The following is for compile only*/
  2336. /*===========================================================*/
  2337. /*#define TARGET_CHNL_NUM_2G_5G 59*/
  2338. #if (DM_ODM_SUPPORT_TYPE == ODM_WIN)
  2339. u8 get_right_chnl_place_for_iqk(u8 chnl)
  2340. {
  2341. u8 channel_all[TARGET_CHNL_NUM_2G_5G] = {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,
  2342. 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
  2343. };
  2344. u8 place = chnl;
  2345. if (chnl > 14) {
  2346. for (place = 14; place < sizeof(channel_all); place++) {
  2347. if (channel_all[place] == chnl)
  2348. return place - 13;
  2349. }
  2350. }
  2351. return 0;
  2352. }
  2353. #endif
  2354. /*===========================================================*/
  2355. void
  2356. phydm_noisy_detection(
  2357. struct PHY_DM_STRUCT *p_dm_odm
  2358. )
  2359. {
  2360. u32 total_fa_cnt, total_cca_cnt;
  2361. u32 score = 0, i, score_smooth;
  2362. total_cca_cnt = p_dm_odm->false_alm_cnt.cnt_cca_all;
  2363. total_fa_cnt = p_dm_odm->false_alm_cnt.cnt_all;
  2364. #if 0
  2365. if (total_fa_cnt * 16 >= total_cca_cnt * 14) /* 87.5 */
  2366. ;
  2367. else if (total_fa_cnt * 16 >= total_cca_cnt * 12) /* 75 */
  2368. ;
  2369. else if (total_fa_cnt * 16 >= total_cca_cnt * 10) /* 56.25 */
  2370. ;
  2371. else if (total_fa_cnt * 16 >= total_cca_cnt * 8) /* 50 */
  2372. ;
  2373. else if (total_fa_cnt * 16 >= total_cca_cnt * 7) /* 43.75 */
  2374. ;
  2375. else if (total_fa_cnt * 16 >= total_cca_cnt * 6) /* 37.5 */
  2376. ;
  2377. else if (total_fa_cnt * 16 >= total_cca_cnt * 5) /* 31.25% */
  2378. ;
  2379. else if (total_fa_cnt * 16 >= total_cca_cnt * 4) /* 25% */
  2380. ;
  2381. else if (total_fa_cnt * 16 >= total_cca_cnt * 3) /* 18.75% */
  2382. ;
  2383. else if (total_fa_cnt * 16 >= total_cca_cnt * 2) /* 12.5% */
  2384. ;
  2385. else if (total_fa_cnt * 16 >= total_cca_cnt * 1) /* 6.25% */
  2386. ;
  2387. #endif
  2388. for (i = 0; i <= 16; i++) {
  2389. if (total_fa_cnt * 16 >= total_cca_cnt * (16 - i)) {
  2390. score = 16 - i;
  2391. break;
  2392. }
  2393. }
  2394. /* noisy_decision_smooth = noisy_decision_smooth>>1 + (score<<3)>>1; */
  2395. p_dm_odm->noisy_decision_smooth = (p_dm_odm->noisy_decision_smooth >> 1) + (score << 2);
  2396. /* Round the noisy_decision_smooth: +"3" comes from (2^3)/2-1 */
  2397. score_smooth = (total_cca_cnt >= 300) ? ((p_dm_odm->noisy_decision_smooth + 3) >> 3) : 0;
  2398. p_dm_odm->noisy_decision = (score_smooth >= 3) ? 1 : 0;
  2399. #if 0
  2400. switch (score_smooth) {
  2401. case 0:
  2402. ODM_RT_TRACE(p_dm_odm, ODM_COMP_COMMON, ODM_DBG_LOUD,
  2403. ("[NoisyDetection] total_fa_cnt/total_cca_cnt=0%%\n"));
  2404. break;
  2405. case 1:
  2406. ODM_RT_TRACE(p_dm_odm, ODM_COMP_COMMON, ODM_DBG_LOUD,
  2407. ("[NoisyDetection] total_fa_cnt/total_cca_cnt=6.25%%\n"));
  2408. break;
  2409. case 2:
  2410. ODM_RT_TRACE(p_dm_odm, ODM_COMP_COMMON, ODM_DBG_LOUD,
  2411. ("[NoisyDetection] total_fa_cnt/total_cca_cnt=12.5%%\n"));
  2412. break;
  2413. case 3:
  2414. ODM_RT_TRACE(p_dm_odm, ODM_COMP_COMMON, ODM_DBG_LOUD,
  2415. ("[NoisyDetection] total_fa_cnt/total_cca_cnt=18.75%%\n"));
  2416. break;
  2417. case 4:
  2418. ODM_RT_TRACE(p_dm_odm, ODM_COMP_COMMON, ODM_DBG_LOUD,
  2419. ("[NoisyDetection] total_fa_cnt/total_cca_cnt=25%%\n"));
  2420. break;
  2421. case 5:
  2422. ODM_RT_TRACE(p_dm_odm, ODM_COMP_COMMON, ODM_DBG_LOUD,
  2423. ("[NoisyDetection] total_fa_cnt/total_cca_cnt=31.25%%\n"));
  2424. break;
  2425. case 6:
  2426. ODM_RT_TRACE(p_dm_odm, ODM_COMP_COMMON, ODM_DBG_LOUD,
  2427. ("[NoisyDetection] total_fa_cnt/total_cca_cnt=37.5%%\n"));
  2428. break;
  2429. case 7:
  2430. ODM_RT_TRACE(p_dm_odm, ODM_COMP_COMMON, ODM_DBG_LOUD,
  2431. ("[NoisyDetection] total_fa_cnt/total_cca_cnt=43.75%%\n"));
  2432. break;
  2433. case 8:
  2434. ODM_RT_TRACE(p_dm_odm, ODM_COMP_COMMON, ODM_DBG_LOUD,
  2435. ("[NoisyDetection] total_fa_cnt/total_cca_cnt=50%%\n"));
  2436. break;
  2437. case 9:
  2438. ODM_RT_TRACE(p_dm_odm, ODM_COMP_COMMON, ODM_DBG_LOUD,
  2439. ("[NoisyDetection] total_fa_cnt/total_cca_cnt=56.25%%\n"));
  2440. break;
  2441. case 10:
  2442. ODM_RT_TRACE(p_dm_odm, ODM_COMP_COMMON, ODM_DBG_LOUD,
  2443. ("[NoisyDetection] total_fa_cnt/total_cca_cnt=62.5%%\n"));
  2444. break;
  2445. case 11:
  2446. ODM_RT_TRACE(p_dm_odm, ODM_COMP_COMMON, ODM_DBG_LOUD,
  2447. ("[NoisyDetection] total_fa_cnt/total_cca_cnt=68.75%%\n"));
  2448. break;
  2449. case 12:
  2450. ODM_RT_TRACE(p_dm_odm, ODM_COMP_COMMON, ODM_DBG_LOUD,
  2451. ("[NoisyDetection] total_fa_cnt/total_cca_cnt=75%%\n"));
  2452. break;
  2453. case 13:
  2454. ODM_RT_TRACE(p_dm_odm, ODM_COMP_COMMON, ODM_DBG_LOUD,
  2455. ("[NoisyDetection] total_fa_cnt/total_cca_cnt=81.25%%\n"));
  2456. break;
  2457. case 14:
  2458. ODM_RT_TRACE(p_dm_odm, ODM_COMP_COMMON, ODM_DBG_LOUD,
  2459. ("[NoisyDetection] total_fa_cnt/total_cca_cnt=87.5%%\n"));
  2460. break;
  2461. case 15:
  2462. ODM_RT_TRACE(p_dm_odm, ODM_COMP_COMMON, ODM_DBG_LOUD,
  2463. ("[NoisyDetection] total_fa_cnt/total_cca_cnt=93.75%%\n"));
  2464. break;
  2465. case 16:
  2466. ODM_RT_TRACE(p_dm_odm, ODM_COMP_COMMON, ODM_DBG_LOUD,
  2467. ("[NoisyDetection] total_fa_cnt/total_cca_cnt=100%%\n"));
  2468. break;
  2469. default:
  2470. ODM_RT_TRACE(p_dm_odm, ODM_COMP_COMMON, ODM_DBG_LOUD,
  2471. ("[NoisyDetection] Unknown value!! Need Check!!\n"));
  2472. }
  2473. #endif
  2474. ODM_RT_TRACE(p_dm_odm, ODM_COMP_NOISY_DETECT, ODM_DBG_LOUD,
  2475. ("[NoisyDetection] total_cca_cnt=%d, total_fa_cnt=%d, noisy_decision_smooth=%d, score=%d, score_smooth=%d, p_dm_odm->noisy_decision=%d\n",
  2476. total_cca_cnt, total_fa_cnt, p_dm_odm->noisy_decision_smooth, score, score_smooth, p_dm_odm->noisy_decision));
  2477. }
  2478. void
  2479. phydm_set_ext_switch(
  2480. void *p_dm_void,
  2481. u32 *const dm_value,
  2482. u32 *_used,
  2483. char *output,
  2484. u32 *_out_len
  2485. )
  2486. {
  2487. struct PHY_DM_STRUCT *p_dm_odm = (struct PHY_DM_STRUCT *)p_dm_void;
  2488. u32 used = *_used;
  2489. u32 out_len = *_out_len;
  2490. u32 ext_ant_switch = dm_value[0];
  2491. if (p_dm_odm->support_ic_type & (ODM_RTL8821 | ODM_RTL8881A)) {
  2492. /*Output Pin Settings*/
  2493. odm_set_mac_reg(p_dm_odm, 0x4C, BIT(23), 0); /*select DPDT_P and DPDT_N as output pin*/
  2494. odm_set_mac_reg(p_dm_odm, 0x4C, BIT(24), 1); /*by WLAN control*/
  2495. odm_set_bb_reg(p_dm_odm, 0xCB4, 0xF, 7); /*DPDT_P = 1b'0*/
  2496. odm_set_bb_reg(p_dm_odm, 0xCB4, 0xF0, 7); /*DPDT_N = 1b'0*/
  2497. if (ext_ant_switch == MAIN_ANT) {
  2498. odm_set_bb_reg(p_dm_odm, 0xCB4, (BIT(29) | BIT(28)), 1);
  2499. ODM_RT_TRACE(p_dm_odm, ODM_COMP_API, ODM_DBG_LOUD, ("***8821A set ant switch = 2b'01 (Main)\n"));
  2500. } else if (ext_ant_switch == AUX_ANT) {
  2501. odm_set_bb_reg(p_dm_odm, 0xCB4, BIT(29) | BIT(28), 2);
  2502. ODM_RT_TRACE(p_dm_odm, ODM_COMP_API, ODM_DBG_LOUD, ("***8821A set ant switch = 2b'10 (Aux)\n"));
  2503. }
  2504. }
  2505. }
  2506. void
  2507. phydm_csi_mask_enable(
  2508. void *p_dm_void,
  2509. u32 enable
  2510. )
  2511. {
  2512. struct PHY_DM_STRUCT *p_dm_odm = (struct PHY_DM_STRUCT *)p_dm_void;
  2513. u32 reg_value = 0;
  2514. reg_value = (enable == CSI_MASK_ENABLE) ? 1 : 0;
  2515. if (p_dm_odm->support_ic_type & ODM_IC_11N_SERIES) {
  2516. odm_set_bb_reg(p_dm_odm, 0xD2C, BIT(28), reg_value);
  2517. ODM_RT_TRACE(p_dm_odm, ODM_COMP_API, ODM_DBG_LOUD, ("Enable CSI Mask: Reg 0xD2C[28] = ((0x%x))\n", reg_value));
  2518. } else if (p_dm_odm->support_ic_type & ODM_IC_11AC_SERIES) {
  2519. odm_set_bb_reg(p_dm_odm, 0x874, BIT(0), reg_value);
  2520. ODM_RT_TRACE(p_dm_odm, ODM_COMP_API, ODM_DBG_LOUD, ("Enable CSI Mask: Reg 0x874[0] = ((0x%x))\n", reg_value));
  2521. }
  2522. }
  2523. void
  2524. phydm_clean_all_csi_mask(
  2525. void *p_dm_void
  2526. )
  2527. {
  2528. struct PHY_DM_STRUCT *p_dm_odm = (struct PHY_DM_STRUCT *)p_dm_void;
  2529. if (p_dm_odm->support_ic_type & ODM_IC_11N_SERIES) {
  2530. odm_set_bb_reg(p_dm_odm, 0xD40, MASKDWORD, 0);
  2531. odm_set_bb_reg(p_dm_odm, 0xD44, MASKDWORD, 0);
  2532. odm_set_bb_reg(p_dm_odm, 0xD48, MASKDWORD, 0);
  2533. odm_set_bb_reg(p_dm_odm, 0xD4c, MASKDWORD, 0);
  2534. } else if (p_dm_odm->support_ic_type & ODM_IC_11AC_SERIES) {
  2535. odm_set_bb_reg(p_dm_odm, 0x880, MASKDWORD, 0);
  2536. odm_set_bb_reg(p_dm_odm, 0x884, MASKDWORD, 0);
  2537. odm_set_bb_reg(p_dm_odm, 0x888, MASKDWORD, 0);
  2538. odm_set_bb_reg(p_dm_odm, 0x88c, MASKDWORD, 0);
  2539. odm_set_bb_reg(p_dm_odm, 0x890, MASKDWORD, 0);
  2540. odm_set_bb_reg(p_dm_odm, 0x894, MASKDWORD, 0);
  2541. odm_set_bb_reg(p_dm_odm, 0x898, MASKDWORD, 0);
  2542. odm_set_bb_reg(p_dm_odm, 0x89c, MASKDWORD, 0);
  2543. }
  2544. }
  2545. void
  2546. phydm_set_csi_mask_reg(
  2547. void *p_dm_void,
  2548. u32 tone_idx_tmp,
  2549. u8 tone_direction
  2550. )
  2551. {
  2552. struct PHY_DM_STRUCT *p_dm_odm = (struct PHY_DM_STRUCT *)p_dm_void;
  2553. u8 byte_offset, bit_offset;
  2554. u32 target_reg;
  2555. u8 reg_tmp_value;
  2556. u32 tone_num = 64;
  2557. u32 tone_num_shift = 0;
  2558. u32 csi_mask_reg_p = 0, csi_mask_reg_n = 0;
  2559. /* calculate real tone idx*/
  2560. if ((tone_idx_tmp % 10) >= 5)
  2561. tone_idx_tmp += 10;
  2562. tone_idx_tmp = (tone_idx_tmp / 10);
  2563. if (p_dm_odm->support_ic_type & ODM_IC_11N_SERIES) {
  2564. tone_num = 64;
  2565. csi_mask_reg_p = 0xD40;
  2566. csi_mask_reg_n = 0xD48;
  2567. } else if (p_dm_odm->support_ic_type & ODM_IC_11AC_SERIES) {
  2568. tone_num = 128;
  2569. csi_mask_reg_p = 0x880;
  2570. csi_mask_reg_n = 0x890;
  2571. }
  2572. if (tone_direction == FREQ_POSITIVE) {
  2573. if (tone_idx_tmp >= (tone_num - 1))
  2574. tone_idx_tmp = (tone_num - 1);
  2575. byte_offset = (u8)(tone_idx_tmp >> 3);
  2576. bit_offset = (u8)(tone_idx_tmp & 0x7);
  2577. target_reg = csi_mask_reg_p + byte_offset;
  2578. } else {
  2579. tone_num_shift = tone_num;
  2580. if (tone_idx_tmp >= tone_num)
  2581. tone_idx_tmp = tone_num;
  2582. tone_idx_tmp = tone_num - tone_idx_tmp;
  2583. byte_offset = (u8)(tone_idx_tmp >> 3);
  2584. bit_offset = (u8)(tone_idx_tmp & 0x7);
  2585. target_reg = csi_mask_reg_n + byte_offset;
  2586. }
  2587. reg_tmp_value = odm_read_1byte(p_dm_odm, target_reg);
  2588. ODM_RT_TRACE(p_dm_odm, ODM_COMP_API, ODM_DBG_LOUD, ("Pre Mask tone idx[%d]: Reg0x%x = ((0x%x))\n", (tone_idx_tmp + tone_num_shift), target_reg, reg_tmp_value));
  2589. reg_tmp_value |= BIT(bit_offset);
  2590. odm_write_1byte(p_dm_odm, target_reg, reg_tmp_value);
  2591. ODM_RT_TRACE(p_dm_odm, ODM_COMP_API, ODM_DBG_LOUD, ("New Mask tone idx[%d]: Reg0x%x = ((0x%x))\n", (tone_idx_tmp + tone_num_shift), target_reg, reg_tmp_value));
  2592. }
  2593. void
  2594. phydm_set_nbi_reg(
  2595. void *p_dm_void,
  2596. u32 tone_idx_tmp,
  2597. u32 bw
  2598. )
  2599. {
  2600. struct PHY_DM_STRUCT *p_dm_odm = (struct PHY_DM_STRUCT *)p_dm_void;
  2601. u32 nbi_table_128[NBI_TABLE_SIZE_128] = {25, 55, 85, 115, 135, 155, 185, 205, 225, 245, /*1~10*/ /*tone_idx X 10*/
  2602. 265, 285, 305, 335, 355, 375, 395, 415, 435, 455, /*11~20*/
  2603. 485, 505, 525, 555, 585, 615, 635
  2604. }; /*21~27*/
  2605. u32 nbi_table_256[NBI_TABLE_SIZE_256] = { 25, 55, 85, 115, 135, 155, 175, 195, 225, 245, /*1~10*/
  2606. 265, 285, 305, 325, 345, 365, 385, 405, 425, 445, /*11~20*/
  2607. 465, 485, 505, 525, 545, 565, 585, 605, 625, 645, /*21~30*/
  2608. 665, 695, 715, 735, 755, 775, 795, 815, 835, 855, /*31~40*/
  2609. 875, 895, 915, 935, 955, 975, 995, 1015, 1035, 1055, /*41~50*/
  2610. 1085, 1105, 1125, 1145, 1175, 1195, 1225, 1255, 1275
  2611. }; /*51~59*/
  2612. u32 reg_idx = 0;
  2613. u32 i;
  2614. u8 nbi_table_idx = FFT_128_TYPE;
  2615. if (p_dm_odm->support_ic_type & ODM_IC_11N_SERIES)
  2616. nbi_table_idx = FFT_128_TYPE;
  2617. else if (p_dm_odm->support_ic_type & ODM_IC_11AC_1_SERIES)
  2618. nbi_table_idx = FFT_256_TYPE;
  2619. else if (p_dm_odm->support_ic_type & ODM_IC_11AC_2_SERIES) {
  2620. if (bw == 80)
  2621. nbi_table_idx = FFT_256_TYPE;
  2622. else /*20M, 40M*/
  2623. nbi_table_idx = FFT_128_TYPE;
  2624. }
  2625. if (nbi_table_idx == FFT_128_TYPE) {
  2626. for (i = 0; i < NBI_TABLE_SIZE_128; i++) {
  2627. if (tone_idx_tmp < nbi_table_128[i]) {
  2628. reg_idx = i + 1;
  2629. break;
  2630. }
  2631. }
  2632. } else if (nbi_table_idx == FFT_256_TYPE) {
  2633. for (i = 0; i < NBI_TABLE_SIZE_256; i++) {
  2634. if (tone_idx_tmp < nbi_table_256[i]) {
  2635. reg_idx = i + 1;
  2636. break;
  2637. }
  2638. }
  2639. }
  2640. if (p_dm_odm->support_ic_type & ODM_IC_11N_SERIES) {
  2641. odm_set_bb_reg(p_dm_odm, 0xc40, 0x1f000000, reg_idx);
  2642. ODM_RT_TRACE(p_dm_odm, ODM_COMP_API, ODM_DBG_LOUD, ("Set tone idx: Reg0xC40[28:24] = ((0x%x))\n", reg_idx));
  2643. /**/
  2644. } else {
  2645. odm_set_bb_reg(p_dm_odm, 0x87c, 0xfc000, reg_idx);
  2646. ODM_RT_TRACE(p_dm_odm, ODM_COMP_API, ODM_DBG_LOUD, ("Set tone idx: Reg0x87C[19:14] = ((0x%x))\n", reg_idx));
  2647. /**/
  2648. }
  2649. }
  2650. void
  2651. phydm_nbi_enable(
  2652. void *p_dm_void,
  2653. u32 enable
  2654. )
  2655. {
  2656. struct PHY_DM_STRUCT *p_dm_odm = (struct PHY_DM_STRUCT *)p_dm_void;
  2657. u32 reg_value = 0;
  2658. reg_value = (enable == NBI_ENABLE) ? 1 : 0;
  2659. if (p_dm_odm->support_ic_type & ODM_IC_11N_SERIES) {
  2660. odm_set_bb_reg(p_dm_odm, 0xc40, BIT(9), reg_value);
  2661. ODM_RT_TRACE(p_dm_odm, ODM_COMP_API, ODM_DBG_LOUD, ("Enable NBI Reg0xC40[9] = ((0x%x))\n", reg_value));
  2662. } else if (p_dm_odm->support_ic_type & ODM_IC_11AC_SERIES) {
  2663. odm_set_bb_reg(p_dm_odm, 0x87c, BIT(13), reg_value);
  2664. ODM_RT_TRACE(p_dm_odm, ODM_COMP_API, ODM_DBG_LOUD, ("Enable NBI Reg0x87C[13] = ((0x%x))\n", reg_value));
  2665. }
  2666. }
  2667. u8
  2668. phydm_calculate_fc(
  2669. void *p_dm_void,
  2670. u32 channel,
  2671. u32 bw,
  2672. u32 second_ch,
  2673. u32 *fc_in
  2674. )
  2675. {
  2676. struct PHY_DM_STRUCT *p_dm_odm = (struct PHY_DM_STRUCT *)p_dm_void;
  2677. u32 fc = *fc_in;
  2678. u32 start_ch_per_40m[NUM_START_CH_40M] = {36, 44, 52, 60, 100, 108, 116, 124, 132, 140, 149, 157, 165, 173};
  2679. u32 start_ch_per_80m[NUM_START_CH_80M] = {36, 52, 100, 116, 132, 149, 165};
  2680. u32 *p_start_ch = &(start_ch_per_40m[0]);
  2681. u32 num_start_channel = NUM_START_CH_40M;
  2682. u32 channel_offset = 0;
  2683. u32 i;
  2684. /*2.4G*/
  2685. if (channel <= 14 && channel > 0) {
  2686. if (bw == 80)
  2687. return SET_ERROR;
  2688. fc = 2412 + (channel - 1) * 5;
  2689. if (bw == 40 && (second_ch == PHYDM_ABOVE)) {
  2690. if (channel >= 10) {
  2691. ODM_RT_TRACE(p_dm_odm, ODM_COMP_API, ODM_DBG_LOUD, ("CH = ((%d)), Scnd_CH = ((%d)) Error setting\n", channel, second_ch));
  2692. return SET_ERROR;
  2693. }
  2694. fc += 10;
  2695. } else if (bw == 40 && (second_ch == PHYDM_BELOW)) {
  2696. if (channel <= 2) {
  2697. ODM_RT_TRACE(p_dm_odm, ODM_COMP_API, ODM_DBG_LOUD, ("CH = ((%d)), Scnd_CH = ((%d)) Error setting\n", channel, second_ch));
  2698. return SET_ERROR;
  2699. }
  2700. fc -= 10;
  2701. }
  2702. }
  2703. /*5G*/
  2704. else if (channel >= 36 && channel <= 177) {
  2705. if (bw != 20) {
  2706. if (bw == 40) {
  2707. num_start_channel = NUM_START_CH_40M;
  2708. p_start_ch = &(start_ch_per_40m[0]);
  2709. channel_offset = CH_OFFSET_40M;
  2710. } else if (bw == 80) {
  2711. num_start_channel = NUM_START_CH_80M;
  2712. p_start_ch = &(start_ch_per_80m[0]);
  2713. channel_offset = CH_OFFSET_80M;
  2714. }
  2715. for (i = 0; i < num_start_channel; i++) {
  2716. if (channel < p_start_ch[i + 1]) {
  2717. channel = p_start_ch[i] + channel_offset;
  2718. break;
  2719. }
  2720. }
  2721. ODM_RT_TRACE(p_dm_odm, ODM_COMP_API, ODM_DBG_LOUD, ("Mod_CH = ((%d))\n", channel));
  2722. }
  2723. fc = 5180 + (channel - 36) * 5;
  2724. } else {
  2725. ODM_RT_TRACE(p_dm_odm, ODM_COMP_API, ODM_DBG_LOUD, ("CH = ((%d)) Error setting\n", channel));
  2726. return SET_ERROR;
  2727. }
  2728. *fc_in = fc;
  2729. return SET_SUCCESS;
  2730. }
  2731. u8
  2732. phydm_calculate_intf_distance(
  2733. void *p_dm_void,
  2734. u32 bw,
  2735. u32 fc,
  2736. u32 f_interference,
  2737. u32 *p_tone_idx_tmp_in
  2738. )
  2739. {
  2740. struct PHY_DM_STRUCT *p_dm_odm = (struct PHY_DM_STRUCT *)p_dm_void;
  2741. u32 bw_up, bw_low;
  2742. u32 int_distance;
  2743. u32 tone_idx_tmp;
  2744. u8 set_result = SET_NO_NEED;
  2745. bw_up = fc + bw / 2;
  2746. bw_low = fc - bw / 2;
  2747. ODM_RT_TRACE(p_dm_odm, ODM_COMP_API, ODM_DBG_LOUD, ("[f_l, fc, fh] = [ %d, %d, %d ], f_int = ((%d))\n", bw_low, fc, bw_up, f_interference));
  2748. if ((f_interference >= bw_low) && (f_interference <= bw_up)) {
  2749. int_distance = (fc >= f_interference) ? (fc - f_interference) : (f_interference - fc);
  2750. tone_idx_tmp = (int_distance << 5); /* =10*(int_distance /0.3125) */
  2751. ODM_RT_TRACE(p_dm_odm, ODM_COMP_API, ODM_DBG_LOUD, ("int_distance = ((%d MHz)) Mhz, tone_idx_tmp = ((%d.%d))\n", int_distance, (tone_idx_tmp / 10), (tone_idx_tmp % 10)));
  2752. *p_tone_idx_tmp_in = tone_idx_tmp;
  2753. set_result = SET_SUCCESS;
  2754. }
  2755. return set_result;
  2756. }
  2757. u8
  2758. phydm_csi_mask_setting(
  2759. void *p_dm_void,
  2760. u32 enable,
  2761. u32 channel,
  2762. u32 bw,
  2763. u32 f_interference,
  2764. u32 second_ch
  2765. )
  2766. {
  2767. struct PHY_DM_STRUCT *p_dm_odm = (struct PHY_DM_STRUCT *)p_dm_void;
  2768. u32 fc;
  2769. u32 int_distance;
  2770. u8 tone_direction;
  2771. u32 tone_idx_tmp;
  2772. u8 set_result = SET_SUCCESS;
  2773. if (enable == CSI_MASK_DISABLE) {
  2774. set_result = SET_SUCCESS;
  2775. phydm_clean_all_csi_mask(p_dm_odm);
  2776. } else {
  2777. ODM_RT_TRACE(p_dm_odm, ODM_COMP_API, ODM_DBG_LOUD, ("[Set CSI MASK_] CH = ((%d)), BW = ((%d)), f_intf = ((%d)), Scnd_CH = ((%s))\n",
  2778. channel, bw, f_interference, (((bw == 20) || (channel > 14)) ? "Don't care" : (second_ch == PHYDM_ABOVE) ? "H" : "L")));
  2779. /*calculate fc*/
  2780. if (phydm_calculate_fc(p_dm_odm, channel, bw, second_ch, &fc) == SET_ERROR)
  2781. set_result = SET_ERROR;
  2782. else {
  2783. /*calculate interference distance*/
  2784. if (phydm_calculate_intf_distance(p_dm_odm, bw, fc, f_interference, &tone_idx_tmp) == SET_SUCCESS) {
  2785. tone_direction = (f_interference >= fc) ? FREQ_POSITIVE : FREQ_NEGATIVE;
  2786. phydm_set_csi_mask_reg(p_dm_odm, tone_idx_tmp, tone_direction);
  2787. set_result = SET_SUCCESS;
  2788. } else
  2789. set_result = SET_NO_NEED;
  2790. }
  2791. }
  2792. if (set_result == SET_SUCCESS)
  2793. phydm_csi_mask_enable(p_dm_odm, enable);
  2794. else
  2795. phydm_csi_mask_enable(p_dm_odm, CSI_MASK_DISABLE);
  2796. return set_result;
  2797. }
  2798. u8
  2799. phydm_nbi_setting(
  2800. void *p_dm_void,
  2801. u32 enable,
  2802. u32 channel,
  2803. u32 bw,
  2804. u32 f_interference,
  2805. u32 second_ch
  2806. )
  2807. {
  2808. struct PHY_DM_STRUCT *p_dm_odm = (struct PHY_DM_STRUCT *)p_dm_void;
  2809. u32 fc;
  2810. u32 int_distance;
  2811. u32 tone_idx_tmp;
  2812. u8 set_result = SET_SUCCESS;
  2813. u32 bw_max = 40;
  2814. if (enable == NBI_DISABLE)
  2815. set_result = SET_SUCCESS;
  2816. else {
  2817. ODM_RT_TRACE(p_dm_odm, ODM_COMP_API, ODM_DBG_LOUD, ("[Set NBI] CH = ((%d)), BW = ((%d)), f_intf = ((%d)), Scnd_CH = ((%s))\n",
  2818. channel, bw, f_interference, (((second_ch == PHYDM_DONT_CARE) || (bw == 20) || (channel > 14)) ? "Don't care" : (second_ch == PHYDM_ABOVE) ? "H" : "L")));
  2819. /*calculate fc*/
  2820. if (phydm_calculate_fc(p_dm_odm, channel, bw, second_ch, &fc) == SET_ERROR)
  2821. set_result = SET_ERROR;
  2822. else {
  2823. /*calculate interference distance*/
  2824. if (phydm_calculate_intf_distance(p_dm_odm, bw, fc, f_interference, &tone_idx_tmp) == SET_SUCCESS) {
  2825. phydm_set_nbi_reg(p_dm_odm, tone_idx_tmp, bw);
  2826. set_result = SET_SUCCESS;
  2827. } else
  2828. set_result = SET_NO_NEED;
  2829. }
  2830. }
  2831. if (set_result == SET_SUCCESS)
  2832. phydm_nbi_enable(p_dm_odm, enable);
  2833. else
  2834. phydm_nbi_enable(p_dm_odm, NBI_DISABLE);
  2835. return set_result;
  2836. }
  2837. void
  2838. phydm_api_debug(
  2839. void *p_dm_void,
  2840. u32 function_map,
  2841. u32 *const dm_value,
  2842. u32 *_used,
  2843. char *output,
  2844. u32 *_out_len
  2845. )
  2846. {
  2847. struct PHY_DM_STRUCT *p_dm_odm = (struct PHY_DM_STRUCT *)p_dm_void;
  2848. u32 used = *_used;
  2849. u32 out_len = *_out_len;
  2850. u32 channel = dm_value[1];
  2851. u32 bw = dm_value[2];
  2852. u32 f_interference = dm_value[3];
  2853. u32 second_ch = dm_value[4];
  2854. u8 set_result = 0;
  2855. /*PHYDM_API_NBI*/
  2856. /*-------------------------------------------------------------------------------------------------------------------------------*/
  2857. if (function_map == PHYDM_API_NBI) {
  2858. if (dm_value[0] == 100) {
  2859. PHYDM_SNPRINTF((output + used, out_len - used, "[HELP-NBI] EN(on=1, off=2) CH BW(20/40/80) f_intf(Mhz) Scnd_CH(L=1, H=2)\n"));
  2860. return;
  2861. } else if (dm_value[0] == NBI_ENABLE) {
  2862. PHYDM_SNPRINTF((output + used, out_len - used, "[Enable NBI] CH = ((%d)), BW = ((%d)), f_intf = ((%d)), Scnd_CH = ((%s))\n",
  2863. channel, bw, f_interference, ((second_ch == PHYDM_DONT_CARE) || (bw == 20) || (channel > 14)) ? "Don't care" : ((second_ch == PHYDM_ABOVE) ? "H" : "L")));
  2864. set_result = phydm_nbi_setting(p_dm_odm, NBI_ENABLE, channel, bw, f_interference, second_ch);
  2865. } else if (dm_value[0] == NBI_DISABLE) {
  2866. PHYDM_SNPRINTF((output + used, out_len - used, "[Disable NBI]\n"));
  2867. set_result = phydm_nbi_setting(p_dm_odm, NBI_DISABLE, channel, bw, f_interference, second_ch);
  2868. } else
  2869. set_result = SET_ERROR;
  2870. PHYDM_SNPRINTF((output + used, out_len - used, "[NBI set result: %s]\n", (set_result == SET_SUCCESS) ? "Success" : ((set_result == SET_NO_NEED) ? "No need" : "Error")));
  2871. }
  2872. /*PHYDM_CSI_MASK*/
  2873. /*-------------------------------------------------------------------------------------------------------------------------------*/
  2874. else if (function_map == PHYDM_API_CSI_MASK) {
  2875. if (dm_value[0] == 100) {
  2876. PHYDM_SNPRINTF((output + used, out_len - used, "[HELP-CSI MASK] EN(on=1, off=2) CH BW(20/40/80) f_intf(Mhz) Scnd_CH(L=1, H=2)\n"));
  2877. return;
  2878. } else if (dm_value[0] == CSI_MASK_ENABLE) {
  2879. PHYDM_SNPRINTF((output + used, out_len - used, "[Enable CSI MASK] CH = ((%d)), BW = ((%d)), f_intf = ((%d)), Scnd_CH = ((%s))\n",
  2880. channel, bw, f_interference, (channel > 14) ? "Don't care" : (((second_ch == PHYDM_DONT_CARE) || (bw == 20) || (channel > 14)) ? "H" : "L")));
  2881. set_result = phydm_csi_mask_setting(p_dm_odm, CSI_MASK_ENABLE, channel, bw, f_interference, second_ch);
  2882. } else if (dm_value[0] == CSI_MASK_DISABLE) {
  2883. PHYDM_SNPRINTF((output + used, out_len - used, "[Disable CSI MASK]\n"));
  2884. set_result = phydm_csi_mask_setting(p_dm_odm, CSI_MASK_DISABLE, channel, bw, f_interference, second_ch);
  2885. } else
  2886. set_result = SET_ERROR;
  2887. PHYDM_SNPRINTF((output + used, out_len - used, "[CSI MASK set result: %s]\n", (set_result == SET_SUCCESS) ? "Success" : ((set_result == SET_NO_NEED) ? "No need" : "Error")));
  2888. }
  2889. }
  2890. void
  2891. phydm_receiver_blocking(
  2892. void *p_dm_void
  2893. )
  2894. {
  2895. #ifdef CONFIG_RECEIVER_BLOCKING
  2896. struct PHY_DM_STRUCT *p_dm_odm = (struct PHY_DM_STRUCT *)p_dm_void;
  2897. u32 channel = *p_dm_odm->p_channel;
  2898. u8 bw = *p_dm_odm->p_band_width;
  2899. u8 set_result = 0;
  2900. if (!(p_dm_odm->support_ic_type & ODM_RECEIVER_BLOCKING_SUPPORT))
  2901. return;
  2902. if (p_dm_odm->consecutive_idlel_time > 10 && p_dm_odm->mp_mode == false && p_dm_odm->adaptivity_enable == true) {
  2903. if ((bw == ODM_BW20M) && (channel == 1)) {
  2904. set_result = phydm_nbi_setting(p_dm_odm, NBI_ENABLE, channel, 20, 2410, PHYDM_DONT_CARE);
  2905. p_dm_odm->is_receiver_blocking_en = true;
  2906. } else if ((bw == ODM_BW20M) && (channel == 13)) {
  2907. set_result = phydm_nbi_setting(p_dm_odm, NBI_ENABLE, channel, 20, 2473, PHYDM_DONT_CARE);
  2908. p_dm_odm->is_receiver_blocking_en = true;
  2909. } else if ((bw == ODM_BW20M) && (channel == 100)) {
  2910. set_result = phydm_nbi_setting(p_dm_odm, NBI_ENABLE, channel, 20, 5495, PHYDM_DONT_CARE);
  2911. p_dm_odm->is_receiver_blocking_en = true;
  2912. } else if (*(p_dm_odm->p_is_scan_in_process) == false) {
  2913. if (p_dm_odm->is_receiver_blocking_en && channel != 1 && channel != 13 && channel != 100) {
  2914. phydm_nbi_enable(p_dm_odm, NBI_DISABLE);
  2915. odm_set_bb_reg(p_dm_odm, 0xc40, 0x1f000000, 0x1f);
  2916. p_dm_odm->is_receiver_blocking_en = false;
  2917. }
  2918. }
  2919. } else {
  2920. if (p_dm_odm->is_receiver_blocking_en) {
  2921. phydm_nbi_enable(p_dm_odm, NBI_DISABLE);
  2922. odm_set_bb_reg(p_dm_odm, 0xc40, 0x1f000000, 0x1f);
  2923. p_dm_odm->is_receiver_blocking_en = false;
  2924. }
  2925. }
  2926. ODM_RT_TRACE(p_dm_odm, PHYDM_COMP_ADAPTIVITY, ODM_DBG_LOUD,
  2927. ("[NBI set result: %s]\n", (set_result == SET_SUCCESS ? "Success" : (set_result == SET_NO_NEED ? "No need" : "Error"))));
  2928. #endif
  2929. }