rtw_mp_ioctl.c 65 KB

123456789101112131415161718192021222324252627282930313233343536373839404142434445464748495051525354555657585960616263646566676869707172737475767778798081828384858687888990919293949596979899100101102103104105106107108109110111112113114115116117118119120121122123124125126127128129130131132133134135136137138139140141142143144145146147148149150151152153154155156157158159160161162163164165166167168169170171172173174175176177178179180181182183184185186187188189190191192193194195196197198199200201202203204205206207208209210211212213214215216217218219220221222223224225226227228229230231232233234235236237238239240241242243244245246247248249250251252253254255256257258259260261262263264265266267268269270271272273274275276277278279280281282283284285286287288289290291292293294295296297298299300301302303304305306307308309310311312313314315316317318319320321322323324325326327328329330331332333334335336337338339340341342343344345346347348349350351352353354355356357358359360361362363364365366367368369370371372373374375376377378379380381382383384385386387388389390391392393394395396397398399400401402403404405406407408409410411412413414415416417418419420421422423424425426427428429430431432433434435436437438439440441442443444445446447448449450451452453454455456457458459460461462463464465466467468469470471472473474475476477478479480481482483484485486487488489490491492493494495496497498499500501502503504505506507508509510511512513514515516517518519520521522523524525526527528529530531532533534535536537538539540541542543544545546547548549550551552553554555556557558559560561562563564565566567568569570571572573574575576577578579580581582583584585586587588589590591592593594595596597598599600601602603604605606607608609610611612613614615616617618619620621622623624625626627628629630631632633634635636637638639640641642643644645646647648649650651652653654655656657658659660661662663664665666667668669670671672673674675676677678679680681682683684685686687688689690691692693694695696697698699700701702703704705706707708709710711712713714715716717718719720721722723724725726727728729730731732733734735736737738739740741742743744745746747748749750751752753754755756757758759760761762763764765766767768769770771772773774775776777778779780781782783784785786787788789790791792793794795796797798799800801802803804805806807808809810811812813814815816817818819820821822823824825826827828829830831832833834835836837838839840841842843844845846847848849850851852853854855856857858859860861862863864865866867868869870871872873874875876877878879880881882883884885886887888889890891892893894895896897898899900901902903904905906907908909910911912913914915916917918919920921922923924925926927928929930931932933934935936937938939940941942943944945946947948949950951952953954955956957958959960961962963964965966967968969970971972973974975976977978979980981982983984985986987988989990991992993994995996997998999100010011002100310041005100610071008100910101011101210131014101510161017101810191020102110221023102410251026102710281029103010311032103310341035103610371038103910401041104210431044104510461047104810491050105110521053105410551056105710581059106010611062106310641065106610671068106910701071107210731074107510761077107810791080108110821083108410851086108710881089109010911092109310941095109610971098109911001101110211031104110511061107110811091110111111121113111411151116111711181119112011211122112311241125112611271128112911301131113211331134113511361137113811391140114111421143114411451146114711481149115011511152115311541155115611571158115911601161116211631164116511661167116811691170117111721173117411751176117711781179118011811182118311841185118611871188118911901191119211931194119511961197119811991200120112021203120412051206120712081209121012111212121312141215121612171218121912201221122212231224122512261227122812291230123112321233123412351236123712381239124012411242124312441245124612471248124912501251125212531254125512561257125812591260126112621263126412651266126712681269127012711272127312741275127612771278127912801281128212831284128512861287128812891290129112921293129412951296129712981299130013011302130313041305130613071308130913101311131213131314131513161317131813191320132113221323132413251326132713281329133013311332133313341335133613371338133913401341134213431344134513461347134813491350135113521353135413551356135713581359136013611362136313641365136613671368136913701371137213731374137513761377137813791380138113821383138413851386138713881389139013911392139313941395139613971398139914001401140214031404140514061407140814091410141114121413141414151416141714181419142014211422142314241425142614271428142914301431143214331434143514361437143814391440144114421443144414451446144714481449145014511452145314541455145614571458145914601461146214631464146514661467146814691470147114721473147414751476147714781479148014811482148314841485148614871488148914901491149214931494149514961497149814991500150115021503150415051506150715081509151015111512151315141515151615171518151915201521152215231524152515261527152815291530153115321533153415351536153715381539154015411542154315441545154615471548154915501551155215531554155515561557155815591560156115621563156415651566156715681569157015711572157315741575157615771578157915801581158215831584158515861587158815891590159115921593159415951596159715981599160016011602160316041605160616071608160916101611161216131614161516161617161816191620162116221623162416251626162716281629163016311632163316341635163616371638163916401641164216431644164516461647164816491650165116521653165416551656165716581659166016611662166316641665166616671668166916701671167216731674167516761677167816791680168116821683168416851686168716881689169016911692169316941695169616971698169917001701170217031704170517061707170817091710171117121713171417151716171717181719172017211722172317241725172617271728172917301731173217331734173517361737173817391740174117421743174417451746174717481749175017511752175317541755175617571758175917601761176217631764176517661767176817691770177117721773177417751776177717781779178017811782178317841785178617871788178917901791179217931794179517961797179817991800180118021803180418051806180718081809181018111812181318141815181618171818181918201821182218231824182518261827182818291830183118321833183418351836183718381839184018411842184318441845184618471848184918501851185218531854185518561857185818591860186118621863186418651866186718681869187018711872187318741875187618771878187918801881188218831884188518861887188818891890189118921893189418951896189718981899190019011902190319041905190619071908190919101911191219131914191519161917191819191920192119221923192419251926192719281929193019311932193319341935193619371938193919401941194219431944194519461947194819491950195119521953195419551956195719581959196019611962196319641965196619671968196919701971197219731974197519761977197819791980198119821983198419851986198719881989199019911992199319941995199619971998199920002001200220032004200520062007200820092010201120122013201420152016201720182019202020212022202320242025202620272028202920302031203220332034203520362037203820392040204120422043204420452046204720482049205020512052205320542055205620572058205920602061206220632064206520662067206820692070207120722073207420752076207720782079208020812082208320842085208620872088208920902091209220932094209520962097209820992100210121022103210421052106210721082109211021112112211321142115211621172118211921202121212221232124212521262127212821292130213121322133213421352136213721382139214021412142214321442145214621472148214921502151215221532154215521562157215821592160216121622163216421652166216721682169217021712172217321742175217621772178217921802181218221832184218521862187218821892190219121922193219421952196219721982199220022012202220322042205220622072208220922102211221222132214221522162217221822192220222122222223222422252226222722282229223022312232223322342235223622372238223922402241224222432244224522462247224822492250225122522253225422552256225722582259226022612262226322642265226622672268226922702271227222732274227522762277227822792280228122822283228422852286228722882289229022912292229322942295229622972298229923002301230223032304230523062307230823092310231123122313231423152316231723182319232023212322232323242325232623272328232923302331233223332334233523362337233823392340234123422343234423452346234723482349235023512352235323542355235623572358235923602361236223632364236523662367236823692370237123722373237423752376237723782379238023812382238323842385238623872388238923902391239223932394239523962397239823992400240124022403240424052406240724082409241024112412241324142415241624172418241924202421242224232424242524262427242824292430243124322433243424352436243724382439244024412442244324442445244624472448244924502451245224532454245524562457245824592460246124622463246424652466246724682469247024712472247324742475247624772478247924802481248224832484248524862487248824892490249124922493249424952496249724982499250025012502250325042505250625072508250925102511251225132514251525162517251825192520252125222523252425252526252725282529
  1. /******************************************************************************
  2. *
  3. * Copyright(c) 2007 - 2017 Realtek Corporation.
  4. *
  5. * This program is free software; you can redistribute it and/or modify it
  6. * under the terms of version 2 of the GNU General Public License as
  7. * published by the Free Software Foundation.
  8. *
  9. * This program is distributed in the hope that it will be useful, but WITHOUT
  10. * ANY WARRANTY; without even the implied warranty of MERCHANTABILITY or
  11. * FITNESS FOR A PARTICULAR PURPOSE. See the GNU General Public License for
  12. * more details.
  13. *
  14. *****************************************************************************/
  15. #define _RTW_MP_IOCTL_C_
  16. #include <drv_types.h>
  17. #include <rtw_mp_ioctl.h>
  18. #include "../hal/phydm/phydm_precomp.h"
  19. /* **************** oid_rtl_seg_81_85 section start **************** */
  20. NDIS_STATUS oid_rt_wireless_mode_hdl(struct oid_par_priv *poid_par_priv)
  21. {
  22. NDIS_STATUS status = NDIS_STATUS_SUCCESS;
  23. PADAPTER Adapter = (PADAPTER)(poid_par_priv->adapter_context);
  24. if (poid_par_priv->information_buf_len < sizeof(u8))
  25. return NDIS_STATUS_INVALID_LENGTH;
  26. if (poid_par_priv->type_of_oid == SET_OID)
  27. Adapter->registrypriv.wireless_mode = *(u8 *)poid_par_priv->information_buf;
  28. else if (poid_par_priv->type_of_oid == QUERY_OID) {
  29. *(u8 *)poid_par_priv->information_buf = Adapter->registrypriv.wireless_mode;
  30. *poid_par_priv->bytes_rw = poid_par_priv->information_buf_len;
  31. } else
  32. status = NDIS_STATUS_NOT_ACCEPTED;
  33. return status;
  34. }
  35. /* **************** oid_rtl_seg_81_87_80 section start **************** */
  36. NDIS_STATUS oid_rt_pro_write_bb_reg_hdl(struct oid_par_priv *poid_par_priv)
  37. {
  38. #ifdef PLATFORM_OS_XP
  39. _irqL oldirql;
  40. #endif
  41. struct bb_reg_param *pbbreg;
  42. u16 offset;
  43. u32 value;
  44. NDIS_STATUS status = NDIS_STATUS_SUCCESS;
  45. PADAPTER Adapter = (PADAPTER)(poid_par_priv->adapter_context);
  46. if (poid_par_priv->type_of_oid != SET_OID)
  47. return NDIS_STATUS_NOT_ACCEPTED;
  48. if (poid_par_priv->information_buf_len < sizeof(struct bb_reg_param))
  49. return NDIS_STATUS_INVALID_LENGTH;
  50. pbbreg = (struct bb_reg_param *)(poid_par_priv->information_buf);
  51. offset = (u16)(pbbreg->offset) & 0xFFF; /* 0ffset :0x800~0xfff */
  52. if (offset < BB_REG_BASE_ADDR)
  53. offset |= BB_REG_BASE_ADDR;
  54. value = pbbreg->value;
  55. _irqlevel_changed_(&oldirql, LOWER);
  56. write_bbreg(Adapter, offset, 0xFFFFFFFF, value);
  57. _irqlevel_changed_(&oldirql, RAISE);
  58. return status;
  59. }
  60. /* ------------------------------------------------------------------------------ */
  61. NDIS_STATUS oid_rt_pro_read_bb_reg_hdl(struct oid_par_priv *poid_par_priv)
  62. {
  63. #ifdef PLATFORM_OS_XP
  64. _irqL oldirql;
  65. #endif
  66. struct bb_reg_param *pbbreg;
  67. u16 offset;
  68. u32 value;
  69. NDIS_STATUS status = NDIS_STATUS_SUCCESS;
  70. PADAPTER Adapter = (PADAPTER)(poid_par_priv->adapter_context);
  71. if (poid_par_priv->type_of_oid != QUERY_OID)
  72. return NDIS_STATUS_NOT_ACCEPTED;
  73. if (poid_par_priv->information_buf_len < sizeof(struct bb_reg_param))
  74. return NDIS_STATUS_INVALID_LENGTH;
  75. pbbreg = (struct bb_reg_param *)(poid_par_priv->information_buf);
  76. offset = (u16)(pbbreg->offset) & 0xFFF; /* 0ffset :0x800~0xfff */
  77. if (offset < BB_REG_BASE_ADDR)
  78. offset |= BB_REG_BASE_ADDR;
  79. _irqlevel_changed_(&oldirql, LOWER);
  80. value = read_bbreg(Adapter, offset, 0xFFFFFFFF);
  81. _irqlevel_changed_(&oldirql, RAISE);
  82. pbbreg->value = value;
  83. *poid_par_priv->bytes_rw = poid_par_priv->information_buf_len;
  84. return status;
  85. }
  86. /* ------------------------------------------------------------------------------ */
  87. NDIS_STATUS oid_rt_pro_write_rf_reg_hdl(struct oid_par_priv *poid_par_priv)
  88. {
  89. #ifdef PLATFORM_OS_XP
  90. _irqL oldirql;
  91. #endif
  92. struct rf_reg_param *pbbreg;
  93. u8 path;
  94. u8 offset;
  95. u32 value;
  96. NDIS_STATUS status = NDIS_STATUS_SUCCESS;
  97. PADAPTER Adapter = (PADAPTER)(poid_par_priv->adapter_context);
  98. if (poid_par_priv->type_of_oid != SET_OID)
  99. return NDIS_STATUS_NOT_ACCEPTED;
  100. if (poid_par_priv->information_buf_len < sizeof(struct rf_reg_param))
  101. return NDIS_STATUS_INVALID_LENGTH;
  102. pbbreg = (struct rf_reg_param *)(poid_par_priv->information_buf);
  103. if (pbbreg->path >= MAX_RF_PATH_NUMS)
  104. return NDIS_STATUS_NOT_ACCEPTED;
  105. if (pbbreg->offset > 0xFF)
  106. return NDIS_STATUS_NOT_ACCEPTED;
  107. if (pbbreg->value > 0xFFFFF)
  108. return NDIS_STATUS_NOT_ACCEPTED;
  109. path = (u8)pbbreg->path;
  110. offset = (u8)pbbreg->offset;
  111. value = pbbreg->value;
  112. _irqlevel_changed_(&oldirql, LOWER);
  113. write_rfreg(Adapter, path, offset, value);
  114. _irqlevel_changed_(&oldirql, RAISE);
  115. return status;
  116. }
  117. /* ------------------------------------------------------------------------------ */
  118. NDIS_STATUS oid_rt_pro_read_rf_reg_hdl(struct oid_par_priv *poid_par_priv)
  119. {
  120. #ifdef PLATFORM_OS_XP
  121. _irqL oldirql;
  122. #endif
  123. struct rf_reg_param *pbbreg;
  124. u8 path;
  125. u8 offset;
  126. u32 value;
  127. PADAPTER Adapter = (PADAPTER)(poid_par_priv->adapter_context);
  128. NDIS_STATUS status = NDIS_STATUS_SUCCESS;
  129. if (poid_par_priv->type_of_oid != QUERY_OID)
  130. return NDIS_STATUS_NOT_ACCEPTED;
  131. if (poid_par_priv->information_buf_len < sizeof(struct rf_reg_param))
  132. return NDIS_STATUS_INVALID_LENGTH;
  133. pbbreg = (struct rf_reg_param *)(poid_par_priv->information_buf);
  134. if (pbbreg->path >= MAX_RF_PATH_NUMS)
  135. return NDIS_STATUS_NOT_ACCEPTED;
  136. if (pbbreg->offset > 0xFF)
  137. return NDIS_STATUS_NOT_ACCEPTED;
  138. path = (u8)pbbreg->path;
  139. offset = (u8)pbbreg->offset;
  140. _irqlevel_changed_(&oldirql, LOWER);
  141. value = read_rfreg(Adapter, path, offset);
  142. _irqlevel_changed_(&oldirql, RAISE);
  143. pbbreg->value = value;
  144. *poid_par_priv->bytes_rw = poid_par_priv->information_buf_len;
  145. return status;
  146. }
  147. /* **************** oid_rtl_seg_81_87_00 section end****************
  148. * ------------------------------------------------------------------------------ */
  149. /* **************** oid_rtl_seg_81_80_00 section start ****************
  150. * ------------------------------------------------------------------------------ */
  151. NDIS_STATUS oid_rt_pro_set_data_rate_hdl(struct oid_par_priv *poid_par_priv)
  152. {
  153. #ifdef PLATFORM_OS_XP
  154. _irqL oldirql;
  155. #endif
  156. u32 ratevalue;/* 4 */
  157. NDIS_STATUS status = NDIS_STATUS_SUCCESS;
  158. PADAPTER Adapter = (PADAPTER)(poid_par_priv->adapter_context);
  159. if (poid_par_priv->type_of_oid != SET_OID)
  160. return NDIS_STATUS_NOT_ACCEPTED;
  161. if (poid_par_priv->information_buf_len != sizeof(u32))
  162. return NDIS_STATUS_INVALID_LENGTH;
  163. ratevalue = *((u32 *)poid_par_priv->information_buf); /* 4 */
  164. if (ratevalue >= MPT_RATE_LAST)
  165. return NDIS_STATUS_INVALID_DATA;
  166. Adapter->mppriv.rateidx = ratevalue;
  167. _irqlevel_changed_(&oldirql, LOWER);
  168. SetDataRate(Adapter);
  169. _irqlevel_changed_(&oldirql, RAISE);
  170. return status;
  171. }
  172. /* ------------------------------------------------------------------------------ */
  173. NDIS_STATUS oid_rt_pro_start_test_hdl(struct oid_par_priv *poid_par_priv)
  174. {
  175. #ifdef PLATFORM_OS_XP
  176. _irqL oldirql;
  177. #endif
  178. u32 mode;
  179. NDIS_STATUS status = NDIS_STATUS_SUCCESS;
  180. PADAPTER Adapter = (PADAPTER)(poid_par_priv->adapter_context);
  181. if (Adapter->registrypriv.mp_mode == 0)
  182. return NDIS_STATUS_NOT_ACCEPTED;
  183. if (poid_par_priv->type_of_oid != SET_OID)
  184. return NDIS_STATUS_NOT_ACCEPTED;
  185. _irqlevel_changed_(&oldirql, LOWER);
  186. /* IQCalibrateBcut(Adapter); */
  187. mode = *((u32 *)poid_par_priv->information_buf);
  188. Adapter->mppriv.mode = mode;/* 1 for loopback */
  189. if (mp_start_test(Adapter) == _FAIL) {
  190. status = NDIS_STATUS_NOT_ACCEPTED;
  191. goto exit;
  192. }
  193. exit:
  194. _irqlevel_changed_(&oldirql, RAISE);
  195. return status;
  196. }
  197. /* ------------------------------------------------------------------------------ */
  198. NDIS_STATUS oid_rt_pro_stop_test_hdl(struct oid_par_priv *poid_par_priv)
  199. {
  200. #ifdef PLATFORM_OS_XP
  201. _irqL oldirql;
  202. #endif
  203. NDIS_STATUS status = NDIS_STATUS_SUCCESS;
  204. PADAPTER Adapter = (PADAPTER)(poid_par_priv->adapter_context);
  205. if (poid_par_priv->type_of_oid != SET_OID)
  206. return NDIS_STATUS_NOT_ACCEPTED;
  207. _irqlevel_changed_(&oldirql, LOWER);
  208. mp_stop_test(Adapter);
  209. _irqlevel_changed_(&oldirql, RAISE);
  210. return status;
  211. }
  212. /* ------------------------------------------------------------------------------ */
  213. NDIS_STATUS oid_rt_pro_set_channel_direct_call_hdl(struct oid_par_priv *poid_par_priv)
  214. {
  215. #ifdef PLATFORM_OS_XP
  216. _irqL oldirql;
  217. #endif
  218. u32 Channel;
  219. NDIS_STATUS status = NDIS_STATUS_SUCCESS;
  220. PADAPTER Adapter = (PADAPTER)(poid_par_priv->adapter_context);
  221. if (poid_par_priv->information_buf_len != sizeof(u32))
  222. return NDIS_STATUS_INVALID_LENGTH;
  223. if (poid_par_priv->type_of_oid == QUERY_OID) {
  224. *((u32 *)poid_par_priv->information_buf) = Adapter->mppriv.channel;
  225. return NDIS_STATUS_SUCCESS;
  226. }
  227. if (poid_par_priv->type_of_oid != SET_OID)
  228. return NDIS_STATUS_NOT_ACCEPTED;
  229. Channel = *((u32 *)poid_par_priv->information_buf);
  230. if (Channel > 14)
  231. return NDIS_STATUS_NOT_ACCEPTED;
  232. Adapter->mppriv.channel = Channel;
  233. _irqlevel_changed_(&oldirql, LOWER);
  234. SetChannel(Adapter);
  235. _irqlevel_changed_(&oldirql, RAISE);
  236. return status;
  237. }
  238. /* ------------------------------------------------------------------------------ */
  239. NDIS_STATUS oid_rt_set_bandwidth_hdl(struct oid_par_priv *poid_par_priv)
  240. {
  241. #ifdef PLATFORM_OS_XP
  242. _irqL oldirql;
  243. #endif
  244. u16 bandwidth;
  245. u16 channel_offset;
  246. NDIS_STATUS status = NDIS_STATUS_SUCCESS;
  247. PADAPTER padapter = (PADAPTER)(poid_par_priv->adapter_context);
  248. if (poid_par_priv->type_of_oid != SET_OID)
  249. return NDIS_STATUS_NOT_ACCEPTED;
  250. if (poid_par_priv->information_buf_len < sizeof(u32))
  251. return NDIS_STATUS_INVALID_LENGTH;
  252. bandwidth = *((u32 *)poid_par_priv->information_buf); /* 4 */
  253. channel_offset = HAL_PRIME_CHNL_OFFSET_DONT_CARE;
  254. if (bandwidth != CHANNEL_WIDTH_40)
  255. bandwidth = CHANNEL_WIDTH_20;
  256. padapter->mppriv.bandwidth = (u8)bandwidth;
  257. padapter->mppriv.prime_channel_offset = (u8)channel_offset;
  258. _irqlevel_changed_(&oldirql, LOWER);
  259. SetBandwidth(padapter);
  260. _irqlevel_changed_(&oldirql, RAISE);
  261. return status;
  262. }
  263. /* ------------------------------------------------------------------------------ */
  264. NDIS_STATUS oid_rt_pro_set_antenna_bb_hdl(struct oid_par_priv *poid_par_priv)
  265. {
  266. #ifdef PLATFORM_OS_XP
  267. _irqL oldirql;
  268. #endif
  269. u32 antenna;
  270. NDIS_STATUS status = NDIS_STATUS_SUCCESS;
  271. PADAPTER Adapter = (PADAPTER)(poid_par_priv->adapter_context);
  272. if (poid_par_priv->information_buf_len != sizeof(u32))
  273. return NDIS_STATUS_INVALID_LENGTH;
  274. if (poid_par_priv->type_of_oid == SET_OID) {
  275. antenna = *(u32 *)poid_par_priv->information_buf;
  276. Adapter->mppriv.antenna_tx = (u16)((antenna & 0xFFFF0000) >> 16);
  277. Adapter->mppriv.antenna_rx = (u16)(antenna & 0x0000FFFF);
  278. _irqlevel_changed_(&oldirql, LOWER);
  279. SetAntenna(Adapter);
  280. _irqlevel_changed_(&oldirql, RAISE);
  281. } else {
  282. antenna = (Adapter->mppriv.antenna_tx << 16) | Adapter->mppriv.antenna_rx;
  283. *(u32 *)poid_par_priv->information_buf = antenna;
  284. }
  285. return status;
  286. }
  287. NDIS_STATUS oid_rt_pro_set_tx_power_control_hdl(struct oid_par_priv *poid_par_priv)
  288. {
  289. #ifdef PLATFORM_OS_XP
  290. _irqL oldirql;
  291. #endif
  292. u32 tx_pwr_idx;
  293. NDIS_STATUS status = NDIS_STATUS_SUCCESS;
  294. PADAPTER Adapter = (PADAPTER)(poid_par_priv->adapter_context);
  295. if (poid_par_priv->type_of_oid != SET_OID)
  296. return NDIS_STATUS_NOT_ACCEPTED;
  297. if (poid_par_priv->information_buf_len != sizeof(u32))
  298. return NDIS_STATUS_INVALID_LENGTH;
  299. tx_pwr_idx = *((u32 *)poid_par_priv->information_buf);
  300. if (tx_pwr_idx > MAX_TX_PWR_INDEX_N_MODE)
  301. return NDIS_STATUS_NOT_ACCEPTED;
  302. Adapter->mppriv.txpoweridx = (u8)tx_pwr_idx;
  303. _irqlevel_changed_(&oldirql, LOWER);
  304. SetTxPower(Adapter);
  305. _irqlevel_changed_(&oldirql, RAISE);
  306. return status;
  307. }
  308. /* ------------------------------------------------------------------------------
  309. * **************** oid_rtl_seg_81_80_20 section start ****************
  310. * ------------------------------------------------------------------------------ */
  311. NDIS_STATUS oid_rt_pro_query_tx_packet_sent_hdl(struct oid_par_priv *poid_par_priv)
  312. {
  313. NDIS_STATUS status = NDIS_STATUS_SUCCESS;
  314. PADAPTER Adapter = (PADAPTER)(poid_par_priv->adapter_context);
  315. if (poid_par_priv->type_of_oid != QUERY_OID) {
  316. status = NDIS_STATUS_NOT_ACCEPTED;
  317. return status;
  318. }
  319. if (poid_par_priv->information_buf_len == sizeof(ULONG)) {
  320. *(ULONG *)poid_par_priv->information_buf = Adapter->mppriv.tx_pktcount;
  321. *poid_par_priv->bytes_rw = poid_par_priv->information_buf_len;
  322. } else
  323. status = NDIS_STATUS_INVALID_LENGTH;
  324. return status;
  325. }
  326. /* ------------------------------------------------------------------------------ */
  327. NDIS_STATUS oid_rt_pro_query_rx_packet_received_hdl(struct oid_par_priv *poid_par_priv)
  328. {
  329. NDIS_STATUS status = NDIS_STATUS_SUCCESS;
  330. PADAPTER Adapter = (PADAPTER)(poid_par_priv->adapter_context);
  331. if (poid_par_priv->type_of_oid != QUERY_OID) {
  332. status = NDIS_STATUS_NOT_ACCEPTED;
  333. return status;
  334. }
  335. if (poid_par_priv->information_buf_len == sizeof(ULONG)) {
  336. *(ULONG *)poid_par_priv->information_buf = Adapter->mppriv.rx_pktcount;
  337. *poid_par_priv->bytes_rw = poid_par_priv->information_buf_len;
  338. } else
  339. status = NDIS_STATUS_INVALID_LENGTH;
  340. return status;
  341. }
  342. /* ------------------------------------------------------------------------------ */
  343. NDIS_STATUS oid_rt_pro_query_rx_packet_crc32_error_hdl(struct oid_par_priv *poid_par_priv)
  344. {
  345. NDIS_STATUS status = NDIS_STATUS_SUCCESS;
  346. PADAPTER Adapter = (PADAPTER)(poid_par_priv->adapter_context);
  347. if (poid_par_priv->type_of_oid != QUERY_OID) {
  348. status = NDIS_STATUS_NOT_ACCEPTED;
  349. return status;
  350. }
  351. if (poid_par_priv->information_buf_len == sizeof(ULONG)) {
  352. *(ULONG *)poid_par_priv->information_buf = Adapter->mppriv.rx_crcerrpktcount;
  353. *poid_par_priv->bytes_rw = poid_par_priv->information_buf_len;
  354. } else
  355. status = NDIS_STATUS_INVALID_LENGTH;
  356. return status;
  357. }
  358. /* ------------------------------------------------------------------------------ */
  359. NDIS_STATUS oid_rt_pro_reset_tx_packet_sent_hdl(struct oid_par_priv *poid_par_priv)
  360. {
  361. NDIS_STATUS status = NDIS_STATUS_SUCCESS;
  362. PADAPTER Adapter = (PADAPTER)(poid_par_priv->adapter_context);
  363. if (poid_par_priv->type_of_oid != SET_OID) {
  364. status = NDIS_STATUS_NOT_ACCEPTED;
  365. return status;
  366. }
  367. Adapter->mppriv.tx_pktcount = 0;
  368. return status;
  369. }
  370. /* ------------------------------------------------------------------------------ */
  371. NDIS_STATUS oid_rt_pro_reset_rx_packet_received_hdl(struct oid_par_priv *poid_par_priv)
  372. {
  373. NDIS_STATUS status = NDIS_STATUS_SUCCESS;
  374. PADAPTER Adapter = (PADAPTER)(poid_par_priv->adapter_context);
  375. if (poid_par_priv->type_of_oid != SET_OID) {
  376. status = NDIS_STATUS_NOT_ACCEPTED;
  377. return status;
  378. }
  379. if (poid_par_priv->information_buf_len == sizeof(ULONG)) {
  380. Adapter->mppriv.rx_pktcount = 0;
  381. Adapter->mppriv.rx_crcerrpktcount = 0;
  382. } else
  383. status = NDIS_STATUS_INVALID_LENGTH;
  384. return status;
  385. }
  386. /* ------------------------------------------------------------------------------ */
  387. NDIS_STATUS oid_rt_reset_phy_rx_packet_count_hdl(struct oid_par_priv *poid_par_priv)
  388. {
  389. #ifdef PLATFORM_OS_XP
  390. _irqL oldirql;
  391. #endif
  392. NDIS_STATUS status = NDIS_STATUS_SUCCESS;
  393. PADAPTER Adapter = (PADAPTER)(poid_par_priv->adapter_context);
  394. if (poid_par_priv->type_of_oid != SET_OID) {
  395. status = NDIS_STATUS_NOT_ACCEPTED;
  396. return status;
  397. }
  398. _irqlevel_changed_(&oldirql, LOWER);
  399. ResetPhyRxPktCount(Adapter);
  400. _irqlevel_changed_(&oldirql, RAISE);
  401. return status;
  402. }
  403. /* ------------------------------------------------------------------------------ */
  404. NDIS_STATUS oid_rt_get_phy_rx_packet_received_hdl(struct oid_par_priv *poid_par_priv)
  405. {
  406. #ifdef PLATFORM_OS_XP
  407. _irqL oldirql;
  408. #endif
  409. NDIS_STATUS status = NDIS_STATUS_SUCCESS;
  410. PADAPTER Adapter = (PADAPTER)(poid_par_priv->adapter_context);
  411. if (poid_par_priv->type_of_oid != QUERY_OID)
  412. return NDIS_STATUS_NOT_ACCEPTED;
  413. if (poid_par_priv->information_buf_len != sizeof(ULONG))
  414. return NDIS_STATUS_INVALID_LENGTH;
  415. _irqlevel_changed_(&oldirql, LOWER);
  416. *(ULONG *)poid_par_priv->information_buf = GetPhyRxPktReceived(Adapter);
  417. _irqlevel_changed_(&oldirql, RAISE);
  418. *poid_par_priv->bytes_rw = poid_par_priv->information_buf_len;
  419. return status;
  420. }
  421. /* ------------------------------------------------------------------------------ */
  422. NDIS_STATUS oid_rt_get_phy_rx_packet_crc32_error_hdl(struct oid_par_priv *poid_par_priv)
  423. {
  424. #ifdef PLATFORM_OS_XP
  425. _irqL oldirql;
  426. #endif
  427. NDIS_STATUS status = NDIS_STATUS_SUCCESS;
  428. PADAPTER Adapter = (PADAPTER)(poid_par_priv->adapter_context);
  429. if (poid_par_priv->type_of_oid != QUERY_OID)
  430. return NDIS_STATUS_NOT_ACCEPTED;
  431. if (poid_par_priv->information_buf_len != sizeof(ULONG))
  432. return NDIS_STATUS_INVALID_LENGTH;
  433. _irqlevel_changed_(&oldirql, LOWER);
  434. *(ULONG *)poid_par_priv->information_buf = GetPhyRxPktCRC32Error(Adapter);
  435. _irqlevel_changed_(&oldirql, RAISE);
  436. *poid_par_priv->bytes_rw = poid_par_priv->information_buf_len;
  437. return status;
  438. }
  439. /* **************** oid_rtl_seg_81_80_20 section end **************** */
  440. NDIS_STATUS oid_rt_pro_set_continuous_tx_hdl(struct oid_par_priv *poid_par_priv)
  441. {
  442. #ifdef PLATFORM_OS_XP
  443. _irqL oldirql;
  444. #endif
  445. u32 bStartTest;
  446. NDIS_STATUS status = NDIS_STATUS_SUCCESS;
  447. PADAPTER Adapter = (PADAPTER)(poid_par_priv->adapter_context);
  448. if (poid_par_priv->type_of_oid != SET_OID)
  449. return NDIS_STATUS_NOT_ACCEPTED;
  450. bStartTest = *((u32 *)poid_par_priv->information_buf);
  451. _irqlevel_changed_(&oldirql, LOWER);
  452. SetContinuousTx(Adapter, (u8)bStartTest);
  453. if (bStartTest) {
  454. struct mp_priv *pmp_priv = &Adapter->mppriv;
  455. if (pmp_priv->tx.stop == 0) {
  456. pmp_priv->tx.stop = 1;
  457. RTW_INFO("%s: pkt tx is running...\n", __func__);
  458. rtw_msleep_os(5);
  459. }
  460. pmp_priv->tx.stop = 0;
  461. pmp_priv->tx.count = 1;
  462. SetPacketTx(Adapter);
  463. }
  464. _irqlevel_changed_(&oldirql, RAISE);
  465. return status;
  466. }
  467. NDIS_STATUS oid_rt_pro_set_single_carrier_tx_hdl(struct oid_par_priv *poid_par_priv)
  468. {
  469. #ifdef PLATFORM_OS_XP
  470. _irqL oldirql;
  471. #endif
  472. u32 bStartTest;
  473. NDIS_STATUS status = NDIS_STATUS_SUCCESS;
  474. PADAPTER Adapter = (PADAPTER)(poid_par_priv->adapter_context);
  475. if (poid_par_priv->type_of_oid != SET_OID)
  476. return NDIS_STATUS_NOT_ACCEPTED;
  477. bStartTest = *((u32 *)poid_par_priv->information_buf);
  478. _irqlevel_changed_(&oldirql, LOWER);
  479. SetSingleCarrierTx(Adapter, (u8)bStartTest);
  480. if (bStartTest) {
  481. struct mp_priv *pmp_priv = &Adapter->mppriv;
  482. if (pmp_priv->tx.stop == 0) {
  483. pmp_priv->tx.stop = 1;
  484. RTW_INFO("%s: pkt tx is running...\n", __func__);
  485. rtw_msleep_os(5);
  486. }
  487. pmp_priv->tx.stop = 0;
  488. pmp_priv->tx.count = 1;
  489. SetPacketTx(Adapter);
  490. }
  491. _irqlevel_changed_(&oldirql, RAISE);
  492. return status;
  493. }
  494. NDIS_STATUS oid_rt_pro_set_carrier_suppression_tx_hdl(struct oid_par_priv *poid_par_priv)
  495. {
  496. #ifdef PLATFORM_OS_XP
  497. _irqL oldirql;
  498. #endif
  499. u32 bStartTest;
  500. NDIS_STATUS status = NDIS_STATUS_SUCCESS;
  501. PADAPTER Adapter = (PADAPTER)(poid_par_priv->adapter_context);
  502. if (poid_par_priv->type_of_oid != SET_OID)
  503. return NDIS_STATUS_NOT_ACCEPTED;
  504. bStartTest = *((u32 *)poid_par_priv->information_buf);
  505. _irqlevel_changed_(&oldirql, LOWER);
  506. SetCarrierSuppressionTx(Adapter, (u8)bStartTest);
  507. if (bStartTest) {
  508. struct mp_priv *pmp_priv = &Adapter->mppriv;
  509. if (pmp_priv->tx.stop == 0) {
  510. pmp_priv->tx.stop = 1;
  511. RTW_INFO("%s: pkt tx is running...\n", __func__);
  512. rtw_msleep_os(5);
  513. }
  514. pmp_priv->tx.stop = 0;
  515. pmp_priv->tx.count = 1;
  516. SetPacketTx(Adapter);
  517. }
  518. _irqlevel_changed_(&oldirql, RAISE);
  519. return status;
  520. }
  521. NDIS_STATUS oid_rt_pro_set_single_tone_tx_hdl(struct oid_par_priv *poid_par_priv)
  522. {
  523. #ifdef PLATFORM_OS_XP
  524. _irqL oldirql;
  525. #endif
  526. u32 bStartTest;
  527. NDIS_STATUS status = NDIS_STATUS_SUCCESS;
  528. PADAPTER Adapter = (PADAPTER)(poid_par_priv->adapter_context);
  529. if (poid_par_priv->type_of_oid != SET_OID)
  530. return NDIS_STATUS_NOT_ACCEPTED;
  531. bStartTest = *((u32 *)poid_par_priv->information_buf);
  532. _irqlevel_changed_(&oldirql, LOWER);
  533. SetSingleToneTx(Adapter, (u8)bStartTest);
  534. _irqlevel_changed_(&oldirql, RAISE);
  535. return status;
  536. }
  537. NDIS_STATUS oid_rt_pro_set_modulation_hdl(struct oid_par_priv *poid_par_priv)
  538. {
  539. return 0;
  540. }
  541. NDIS_STATUS oid_rt_pro_trigger_gpio_hdl(struct oid_par_priv *poid_par_priv)
  542. {
  543. PADAPTER Adapter = (PADAPTER)(poid_par_priv->adapter_context);
  544. #ifdef PLATFORM_OS_XP
  545. _irqL oldirql;
  546. #endif
  547. NDIS_STATUS status = NDIS_STATUS_SUCCESS;
  548. if (poid_par_priv->type_of_oid != SET_OID)
  549. return NDIS_STATUS_NOT_ACCEPTED;
  550. _irqlevel_changed_(&oldirql, LOWER);
  551. rtw_hal_set_hwreg(Adapter, HW_VAR_TRIGGER_GPIO_0, 0);
  552. _irqlevel_changed_(&oldirql, RAISE);
  553. return status;
  554. }
  555. /* **************** oid_rtl_seg_81_80_00 section end ****************
  556. * ------------------------------------------------------------------------------ */
  557. NDIS_STATUS oid_rt_pro8711_join_bss_hdl(struct oid_par_priv *poid_par_priv)
  558. {
  559. #if 0
  560. PADAPTER Adapter = (PADAPTER)(poid_par_priv->adapter_context);
  561. #ifdef PLATFORM_OS_XP
  562. _irqL oldirql;
  563. #endif
  564. NDIS_STATUS status = NDIS_STATUS_SUCCESS;
  565. PNDIS_802_11_SSID pssid;
  566. if (poid_par_priv->type_of_oid != SET_OID)
  567. return NDIS_STATUS_NOT_ACCEPTED;
  568. *poid_par_priv->bytes_needed = (u32)sizeof(NDIS_802_11_SSID);
  569. *poid_par_priv->bytes_rw = 0;
  570. if (poid_par_priv->information_buf_len < *poid_par_priv->bytes_needed)
  571. return NDIS_STATUS_INVALID_LENGTH;
  572. pssid = (PNDIS_802_11_SSID)poid_par_priv->information_buf;
  573. _irqlevel_changed_(&oldirql, LOWER);
  574. if (mp_start_joinbss(Adapter, pssid) == _FAIL)
  575. status = NDIS_STATUS_NOT_ACCEPTED;
  576. _irqlevel_changed_(&oldirql, RAISE);
  577. *poid_par_priv->bytes_rw = sizeof(NDIS_802_11_SSID);
  578. return status;
  579. #else
  580. return 0;
  581. #endif
  582. }
  583. /* ------------------------------------------------------------------------------ */
  584. NDIS_STATUS oid_rt_pro_read_register_hdl(struct oid_par_priv *poid_par_priv)
  585. {
  586. #ifdef PLATFORM_OS_XP
  587. _irqL oldirql;
  588. #endif
  589. pRW_Reg RegRWStruct;
  590. u32 offset, width;
  591. NDIS_STATUS status = NDIS_STATUS_SUCCESS;
  592. PADAPTER Adapter = (PADAPTER)(poid_par_priv->adapter_context);
  593. if (poid_par_priv->type_of_oid != QUERY_OID)
  594. return NDIS_STATUS_NOT_ACCEPTED;
  595. RegRWStruct = (pRW_Reg)poid_par_priv->information_buf;
  596. offset = RegRWStruct->offset;
  597. width = RegRWStruct->width;
  598. if (offset > 0xFFF)
  599. return NDIS_STATUS_NOT_ACCEPTED;
  600. _irqlevel_changed_(&oldirql, LOWER);
  601. switch (width) {
  602. case 1:
  603. RegRWStruct->value = rtw_read8(Adapter, offset);
  604. break;
  605. case 2:
  606. RegRWStruct->value = rtw_read16(Adapter, offset);
  607. break;
  608. default:
  609. width = 4;
  610. RegRWStruct->value = rtw_read32(Adapter, offset);
  611. break;
  612. }
  613. _irqlevel_changed_(&oldirql, RAISE);
  614. *poid_par_priv->bytes_rw = width;
  615. return status;
  616. }
  617. /* ------------------------------------------------------------------------------ */
  618. NDIS_STATUS oid_rt_pro_write_register_hdl(struct oid_par_priv *poid_par_priv)
  619. {
  620. #ifdef PLATFORM_OS_XP
  621. _irqL oldirql;
  622. #endif
  623. pRW_Reg RegRWStruct;
  624. u32 offset, width, value;
  625. NDIS_STATUS status = NDIS_STATUS_SUCCESS;
  626. PADAPTER padapter = (PADAPTER)(poid_par_priv->adapter_context);
  627. if (poid_par_priv->type_of_oid != SET_OID)
  628. return NDIS_STATUS_NOT_ACCEPTED;
  629. RegRWStruct = (pRW_Reg)poid_par_priv->information_buf;
  630. offset = RegRWStruct->offset;
  631. width = RegRWStruct->width;
  632. value = RegRWStruct->value;
  633. if (offset > 0xFFF)
  634. return NDIS_STATUS_NOT_ACCEPTED;
  635. _irqlevel_changed_(&oldirql, LOWER);
  636. switch (RegRWStruct->width) {
  637. case 1:
  638. if (value > 0xFF) {
  639. status = NDIS_STATUS_NOT_ACCEPTED;
  640. break;
  641. }
  642. rtw_write8(padapter, offset, (u8)value);
  643. break;
  644. case 2:
  645. if (value > 0xFFFF) {
  646. status = NDIS_STATUS_NOT_ACCEPTED;
  647. break;
  648. }
  649. rtw_write16(padapter, offset, (u16)value);
  650. break;
  651. case 4:
  652. rtw_write32(padapter, offset, value);
  653. break;
  654. default:
  655. status = NDIS_STATUS_NOT_ACCEPTED;
  656. break;
  657. }
  658. _irqlevel_changed_(&oldirql, RAISE);
  659. return status;
  660. }
  661. /* ------------------------------------------------------------------------------ */
  662. NDIS_STATUS oid_rt_pro_burst_read_register_hdl(struct oid_par_priv *poid_par_priv)
  663. {
  664. #if 0
  665. #ifdef PLATFORM_OS_XP
  666. _irqL oldirql;
  667. #endif
  668. pBurst_RW_Reg pBstRwReg;
  669. NDIS_STATUS status = NDIS_STATUS_SUCCESS;
  670. PADAPTER padapter = (PADAPTER)(poid_par_priv->adapter_context);
  671. if (poid_par_priv->type_of_oid != QUERY_OID)
  672. return NDIS_STATUS_NOT_ACCEPTED;
  673. pBstRwReg = (pBurst_RW_Reg)poid_par_priv->information_buf;
  674. _irqlevel_changed_(&oldirql, LOWER);
  675. rtw_read_mem(padapter, pBstRwReg->offset, (u32)pBstRwReg->len, pBstRwReg->Data);
  676. _irqlevel_changed_(&oldirql, RAISE);
  677. *poid_par_priv->bytes_rw = poid_par_priv->information_buf_len;
  678. return status;
  679. #else
  680. return 0;
  681. #endif
  682. }
  683. /* ------------------------------------------------------------------------------ */
  684. NDIS_STATUS oid_rt_pro_burst_write_register_hdl(struct oid_par_priv *poid_par_priv)
  685. {
  686. #if 0
  687. #ifdef PLATFORM_OS_XP
  688. _irqL oldirql;
  689. #endif
  690. pBurst_RW_Reg pBstRwReg;
  691. NDIS_STATUS status = NDIS_STATUS_SUCCESS;
  692. PADAPTER padapter = (PADAPTER)(poid_par_priv->adapter_context);
  693. if (poid_par_priv->type_of_oid != SET_OID)
  694. return NDIS_STATUS_NOT_ACCEPTED;
  695. pBstRwReg = (pBurst_RW_Reg)poid_par_priv->information_buf;
  696. _irqlevel_changed_(&oldirql, LOWER);
  697. rtw_write_mem(padapter, pBstRwReg->offset, (u32)pBstRwReg->len, pBstRwReg->Data);
  698. _irqlevel_changed_(&oldirql, RAISE);
  699. return status;
  700. #else
  701. return 0;
  702. #endif
  703. }
  704. /* ------------------------------------------------------------------------------ */
  705. NDIS_STATUS oid_rt_pro_write_txcmd_hdl(struct oid_par_priv *poid_par_priv)
  706. {
  707. #if 0
  708. NDIS_STATUS status = NDIS_STATUS_SUCCESS;
  709. PADAPTER Adapter = (PADAPTER)(poid_par_priv->adapter_context);
  710. #ifdef PLATFORM_OS_XP
  711. _irqL oldirql;
  712. #endif
  713. TX_CMD_Desc *TxCmd_Info;
  714. if (poid_par_priv->type_of_oid != SET_OID)
  715. return NDIS_STATUS_NOT_ACCEPTED;
  716. TxCmd_Info = (TX_CMD_Desc *)poid_par_priv->information_buf;
  717. _irqlevel_changed_(&oldirql, LOWER);
  718. rtw_write32(Adapter, TxCmd_Info->offset + 0, (unsigned int)TxCmd_Info->TxCMD.value[0]);
  719. rtw_write32(Adapter, TxCmd_Info->offset + 4, (unsigned int)TxCmd_Info->TxCMD.value[1]);
  720. _irqlevel_changed_(&oldirql, RAISE);
  721. return status;
  722. #else
  723. return 0;
  724. #endif
  725. }
  726. /* ------------------------------------------------------------------------------ */
  727. NDIS_STATUS oid_rt_pro_read16_eeprom_hdl(struct oid_par_priv *poid_par_priv)
  728. {
  729. #if 0
  730. #ifdef PLATFORM_OS_XP
  731. _irqL oldirql;
  732. #endif
  733. pEEPROM_RWParam pEEPROM;
  734. NDIS_STATUS status = NDIS_STATUS_SUCCESS;
  735. PADAPTER padapter = (PADAPTER)(poid_par_priv->adapter_context);
  736. if (poid_par_priv->type_of_oid != QUERY_OID)
  737. return NDIS_STATUS_NOT_ACCEPTED;
  738. pEEPROM = (pEEPROM_RWParam)poid_par_priv->information_buf;
  739. _irqlevel_changed_(&oldirql, LOWER);
  740. pEEPROM->value = eeprom_read16(padapter, (u16)(pEEPROM->offset >> 1));
  741. _irqlevel_changed_(&oldirql, RAISE);
  742. *poid_par_priv->bytes_rw = poid_par_priv->information_buf_len;
  743. return status;
  744. #else
  745. return 0;
  746. #endif
  747. }
  748. /* ------------------------------------------------------------------------------ */
  749. NDIS_STATUS oid_rt_pro_write16_eeprom_hdl(struct oid_par_priv *poid_par_priv)
  750. {
  751. #if 0
  752. #ifdef PLATFORM_OS_XP
  753. _irqL oldirql;
  754. #endif
  755. pEEPROM_RWParam pEEPROM;
  756. NDIS_STATUS status = NDIS_STATUS_SUCCESS;
  757. PADAPTER padapter = (PADAPTER)(poid_par_priv->adapter_context);
  758. if (poid_par_priv->type_of_oid != SET_OID)
  759. return NDIS_STATUS_NOT_ACCEPTED;
  760. pEEPROM = (pEEPROM_RWParam)poid_par_priv->information_buf;
  761. _irqlevel_changed_(&oldirql, LOWER);
  762. eeprom_write16(padapter, (u16)(pEEPROM->offset >> 1), pEEPROM->value);
  763. _irqlevel_changed_(&oldirql, RAISE);
  764. *poid_par_priv->bytes_rw = poid_par_priv->information_buf_len;
  765. return status;
  766. #else
  767. return 0;
  768. #endif
  769. }
  770. /* ------------------------------------------------------------------------------ */
  771. NDIS_STATUS oid_rt_pro8711_wi_poll_hdl(struct oid_par_priv *poid_par_priv)
  772. {
  773. #if 0
  774. PADAPTER Adapter = (PADAPTER)(poid_par_priv->adapter_context);
  775. NDIS_STATUS status = NDIS_STATUS_SUCCESS;
  776. struct mp_wiparam *pwi_param;
  777. if (poid_par_priv->type_of_oid != QUERY_OID)
  778. return NDIS_STATUS_NOT_ACCEPTED;
  779. if (poid_par_priv->information_buf_len < sizeof(struct mp_wiparam))
  780. return NDIS_STATUS_INVALID_LENGTH;
  781. if (Adapter->mppriv.workparam.bcompleted == _FALSE)
  782. return NDIS_STATUS_NOT_ACCEPTED;
  783. pwi_param = (struct mp_wiparam *)poid_par_priv->information_buf;
  784. _rtw_memcpy(pwi_param, &Adapter->mppriv.workparam, sizeof(struct mp_wiparam));
  785. Adapter->mppriv.act_in_progress = _FALSE;
  786. *poid_par_priv->bytes_rw = poid_par_priv->information_buf_len;
  787. return status;
  788. #else
  789. return 0;
  790. #endif
  791. }
  792. /* ------------------------------------------------------------------------------ */
  793. NDIS_STATUS oid_rt_pro8711_pkt_loss_hdl(struct oid_par_priv *poid_par_priv)
  794. {
  795. #if 0
  796. PADAPTER Adapter = (PADAPTER)(poid_par_priv->adapter_context);
  797. NDIS_STATUS status = NDIS_STATUS_SUCCESS;
  798. if (poid_par_priv->type_of_oid != QUERY_OID)
  799. return NDIS_STATUS_NOT_ACCEPTED;
  800. if (poid_par_priv->information_buf_len < sizeof(uint) * 2) {
  801. return NDIS_STATUS_INVALID_LENGTH;
  802. }
  803. if (*(uint *)poid_par_priv->information_buf == 1) /* init==1 */
  804. Adapter->mppriv.rx_pktloss = 0;
  805. *((uint *)poid_par_priv->information_buf + 1) = Adapter->mppriv.rx_pktloss;
  806. *poid_par_priv->bytes_rw = poid_par_priv->information_buf_len;
  807. return status;
  808. #else
  809. return 0;
  810. #endif
  811. }
  812. /* ------------------------------------------------------------------------------ */
  813. NDIS_STATUS oid_rt_rd_attrib_mem_hdl(struct oid_par_priv *poid_par_priv)
  814. {
  815. #if 0
  816. PADAPTER Adapter = (PADAPTER)(poid_par_priv->adapter_context);
  817. struct io_queue *pio_queue = (struct io_queue *)Adapter->pio_queue;
  818. struct intf_hdl *pintfhdl = &pio_queue->intf;
  819. #ifdef PLATFORM_OS_XP
  820. _irqL oldirql;
  821. #endif
  822. NDIS_STATUS status = NDIS_STATUS_SUCCESS;
  823. #ifdef CONFIG_SDIO_HCI
  824. void (*_attrib_read)(struct intf_hdl *pintfhdl, u32 addr, u32 cnt, u8 *pmem);
  825. #endif
  826. if (poid_par_priv->type_of_oid != QUERY_OID)
  827. return NDIS_STATUS_NOT_ACCEPTED;
  828. #ifdef CONFIG_SDIO_HCI
  829. _irqlevel_changed_(&oldirql, LOWER);
  830. {
  831. u32 *plmem = (u32 *)poid_par_priv->information_buf + 2;
  832. _attrib_read = pintfhdl->io_ops._attrib_read;
  833. _attrib_read(pintfhdl, *((u32 *)poid_par_priv->information_buf),
  834. *((u32 *)poid_par_priv->information_buf + 1), (u8 *)plmem);
  835. *poid_par_priv->bytes_rw = poid_par_priv->information_buf_len;
  836. }
  837. _irqlevel_changed_(&oldirql, RAISE);
  838. #endif
  839. return status;
  840. #else
  841. return 0;
  842. #endif
  843. }
  844. /* ------------------------------------------------------------------------------ */
  845. NDIS_STATUS oid_rt_wr_attrib_mem_hdl(struct oid_par_priv *poid_par_priv)
  846. {
  847. #if 0
  848. PADAPTER Adapter = (PADAPTER)(poid_par_priv->adapter_context);
  849. struct io_queue *pio_queue = (struct io_queue *)Adapter->pio_queue;
  850. struct intf_hdl *pintfhdl = &pio_queue->intf;
  851. #ifdef PLATFORM_OS_XP
  852. _irqL oldirql;
  853. #endif
  854. NDIS_STATUS status = NDIS_STATUS_SUCCESS;
  855. #ifdef CONFIG_SDIO_HCI
  856. void (*_attrib_write)(struct intf_hdl *pintfhdl, u32 addr, u32 cnt, u8 *pmem);
  857. #endif
  858. if (poid_par_priv->type_of_oid != SET_OID)
  859. return NDIS_STATUS_NOT_ACCEPTED;
  860. #ifdef CONFIG_SDIO_HCI
  861. _irqlevel_changed_(&oldirql, LOWER);
  862. {
  863. u32 *plmem = (u32 *)poid_par_priv->information_buf + 2;
  864. _attrib_write = pintfhdl->io_ops._attrib_write;
  865. _attrib_write(pintfhdl, *(u32 *)poid_par_priv->information_buf,
  866. *((u32 *)poid_par_priv->information_buf + 1), (u8 *)plmem);
  867. }
  868. _irqlevel_changed_(&oldirql, RAISE);
  869. #endif
  870. return status;
  871. #else
  872. return 0;
  873. #endif
  874. }
  875. /* ------------------------------------------------------------------------------ */
  876. NDIS_STATUS oid_rt_pro_set_rf_intfs_hdl(struct oid_par_priv *poid_par_priv)
  877. {
  878. #if 0
  879. PADAPTER Adapter = (PADAPTER)(poid_par_priv->adapter_context);
  880. #ifdef PLATFORM_OS_XP
  881. _irqL oldirql;
  882. #endif
  883. NDIS_STATUS status = NDIS_STATUS_SUCCESS;
  884. if (poid_par_priv->type_of_oid != SET_OID)
  885. return NDIS_STATUS_NOT_ACCEPTED;
  886. _irqlevel_changed_(&oldirql, LOWER);
  887. if (rtw_setrfintfs_cmd(Adapter, *(unsigned char *)poid_par_priv->information_buf) == _FAIL)
  888. status = NDIS_STATUS_NOT_ACCEPTED;
  889. _irqlevel_changed_(&oldirql, RAISE);
  890. return status;
  891. #else
  892. return 0;
  893. #endif
  894. }
  895. /* ------------------------------------------------------------------------------ */
  896. NDIS_STATUS oid_rt_poll_rx_status_hdl(struct oid_par_priv *poid_par_priv)
  897. {
  898. #if 0
  899. PADAPTER Adapter = (PADAPTER)(poid_par_priv->adapter_context);
  900. NDIS_STATUS status = NDIS_STATUS_SUCCESS;
  901. if (poid_par_priv->type_of_oid != QUERY_OID)
  902. return NDIS_STATUS_NOT_ACCEPTED;
  903. _rtw_memcpy(poid_par_priv->information_buf, (unsigned char *)&Adapter->mppriv.rxstat, sizeof(struct recv_stat));
  904. *poid_par_priv->bytes_rw = poid_par_priv->information_buf_len;
  905. return status;
  906. #else
  907. return 0;
  908. #endif
  909. }
  910. /* ------------------------------------------------------------------------------ */
  911. NDIS_STATUS oid_rt_pro_cfg_debug_message_hdl(struct oid_par_priv *poid_par_priv)
  912. {
  913. #if 0
  914. PADAPTER Adapter = (PADAPTER)(poid_par_priv->adapter_context);
  915. NDIS_STATUS status = NDIS_STATUS_SUCCESS;
  916. PCFG_DBG_MSG_STRUCT pdbg_msg;
  917. #if 0/*#ifdef CONFIG_DEBUG_RTL871X*/
  918. pdbg_msg = (PCFG_DBG_MSG_STRUCT)(poid_par_priv->information_buf);
  919. if (poid_par_priv->type_of_oid == SET_OID) {
  920. GlobalDebugLevel = pdbg_msg->DebugLevel;
  921. GlobalDebugComponents = (pdbg_msg->DebugComponent_H32 << 32) | pdbg_msg->DebugComponent_L32;
  922. } else {
  923. pdbg_msg->DebugLevel = GlobalDebugLevel;
  924. pdbg_msg->DebugComponent_H32 = (u32)(GlobalDebugComponents >> 32);
  925. pdbg_msg->DebugComponent_L32 = (u32)GlobalDebugComponents;
  926. *poid_par_priv->bytes_rw = poid_par_priv->information_buf_len;
  927. }
  928. #endif
  929. return status;
  930. #else
  931. return 0;
  932. #endif
  933. }
  934. /* ------------------------------------------------------------------------------ */
  935. NDIS_STATUS oid_rt_pro_set_data_rate_ex_hdl(struct oid_par_priv *poid_par_priv)
  936. {
  937. PADAPTER Adapter = (PADAPTER)(poid_par_priv->adapter_context);
  938. #ifdef PLATFORM_OS_XP
  939. _irqL oldirql;
  940. #endif
  941. NDIS_STATUS status = NDIS_STATUS_SUCCESS;
  942. if (poid_par_priv->type_of_oid != SET_OID)
  943. return NDIS_STATUS_NOT_ACCEPTED;
  944. _irqlevel_changed_(&oldirql, LOWER);
  945. if (rtw_setdatarate_cmd(Adapter, poid_par_priv->information_buf) != _SUCCESS)
  946. status = NDIS_STATUS_NOT_ACCEPTED;
  947. _irqlevel_changed_(&oldirql, RAISE);
  948. return status;
  949. }
  950. /* ----------------------------------------------------------------------------- */
  951. NDIS_STATUS oid_rt_get_thermal_meter_hdl(struct oid_par_priv *poid_par_priv)
  952. {
  953. #ifdef PLATFORM_OS_XP
  954. _irqL oldirql;
  955. #endif
  956. NDIS_STATUS status = NDIS_STATUS_SUCCESS;
  957. u8 thermal = 0;
  958. PADAPTER Adapter = (PADAPTER)(poid_par_priv->adapter_context);
  959. if (poid_par_priv->type_of_oid != QUERY_OID)
  960. return NDIS_STATUS_NOT_ACCEPTED;
  961. if (poid_par_priv->information_buf_len < sizeof(u32))
  962. return NDIS_STATUS_INVALID_LENGTH;
  963. _irqlevel_changed_(&oldirql, LOWER);
  964. GetThermalMeter(Adapter, &thermal);
  965. _irqlevel_changed_(&oldirql, RAISE);
  966. *(u32 *)poid_par_priv->information_buf = (u32)thermal;
  967. *poid_par_priv->bytes_rw = sizeof(u32);
  968. return status;
  969. }
  970. /* ----------------------------------------------------------------------------- */
  971. NDIS_STATUS oid_rt_pro_read_tssi_hdl(struct oid_par_priv *poid_par_priv)
  972. {
  973. #if 0
  974. PADAPTER Adapter = (PADAPTER)(poid_par_priv->adapter_context);
  975. #ifdef PLATFORM_OS_XP
  976. _irqL oldirql;
  977. #endif
  978. NDIS_STATUS status = NDIS_STATUS_SUCCESS;
  979. if (poid_par_priv->type_of_oid != SET_OID)
  980. return NDIS_STATUS_NOT_ACCEPTED;
  981. if (Adapter->mppriv.act_in_progress == _TRUE)
  982. return NDIS_STATUS_NOT_ACCEPTED;
  983. if (poid_par_priv->information_buf_len < sizeof(u8))
  984. return NDIS_STATUS_INVALID_LENGTH;
  985. /* init workparam */
  986. Adapter->mppriv.act_in_progress = _TRUE;
  987. Adapter->mppriv.workparam.bcompleted = _FALSE;
  988. Adapter->mppriv.workparam.act_type = MPT_READ_TSSI;
  989. Adapter->mppriv.workparam.io_offset = 0;
  990. Adapter->mppriv.workparam.io_value = 0xFFFFFFFF;
  991. _irqlevel_changed_(&oldirql, LOWER);
  992. if (!rtw_gettssi_cmd(Adapter, 0, (u8 *)&Adapter->mppriv.workparam.io_value))
  993. status = NDIS_STATUS_NOT_ACCEPTED;
  994. _irqlevel_changed_(&oldirql, RAISE);
  995. return status;
  996. #else
  997. return 0;
  998. #endif
  999. }
  1000. /* ------------------------------------------------------------------------------ */
  1001. NDIS_STATUS oid_rt_pro_set_power_tracking_hdl(struct oid_par_priv *poid_par_priv)
  1002. {
  1003. #ifdef PLATFORM_OS_XP
  1004. _irqL oldirql;
  1005. #endif
  1006. NDIS_STATUS status = NDIS_STATUS_SUCCESS;
  1007. PADAPTER Adapter = (PADAPTER)(poid_par_priv->adapter_context);
  1008. /* if (poid_par_priv->type_of_oid != SET_OID)
  1009. * return NDIS_STATUS_NOT_ACCEPTED; */
  1010. if (poid_par_priv->information_buf_len < sizeof(u8))
  1011. return NDIS_STATUS_INVALID_LENGTH;
  1012. _irqlevel_changed_(&oldirql, LOWER);
  1013. if (poid_par_priv->type_of_oid == SET_OID) {
  1014. u8 enable;
  1015. enable = *(u8 *)poid_par_priv->information_buf;
  1016. SetPowerTracking(Adapter, enable);
  1017. } else
  1018. GetPowerTracking(Adapter, (u8 *)poid_par_priv->information_buf);
  1019. _irqlevel_changed_(&oldirql, RAISE);
  1020. return status;
  1021. }
  1022. /* ----------------------------------------------------------------------------- */
  1023. NDIS_STATUS oid_rt_pro_set_basic_rate_hdl(struct oid_par_priv *poid_par_priv)
  1024. {
  1025. #if 0
  1026. #ifdef PLATFORM_OS_XP
  1027. _irqL oldirql;
  1028. #endif
  1029. u32 ratevalue;
  1030. u8 datarates[NumRates];
  1031. int i;
  1032. NDIS_STATUS status = NDIS_STATUS_SUCCESS;
  1033. PADAPTER padapter = (PADAPTER)(poid_par_priv->adapter_context);
  1034. if (poid_par_priv->type_of_oid != SET_OID)
  1035. return NDIS_STATUS_NOT_ACCEPTED;
  1036. #if 0
  1037. ratevalue = *((u32 *)poid_par_priv->information_buf);
  1038. for (i = 0; i < NumRates; i++) {
  1039. if (ratevalue == mpdatarate[i])
  1040. datarates[i] = mpdatarate[i];
  1041. else
  1042. datarates[i] = 0xff;
  1043. }
  1044. _irqlevel_changed_(&oldirql, LOWER);
  1045. if (rtw_setbasicrate_cmd(padapter, datarates) != _SUCCESS)
  1046. status = NDIS_STATUS_NOT_ACCEPTED;
  1047. _irqlevel_changed_(&oldirql, RAISE);
  1048. #endif
  1049. return status;
  1050. #else
  1051. return 0;
  1052. #endif
  1053. }
  1054. /* ------------------------------------------------------------------------------ */
  1055. NDIS_STATUS oid_rt_pro_qry_pwrstate_hdl(struct oid_par_priv *poid_par_priv)
  1056. {
  1057. #if 0
  1058. PADAPTER Adapter = (PADAPTER)(poid_par_priv->adapter_context);
  1059. NDIS_STATUS status = NDIS_STATUS_SUCCESS;
  1060. if (poid_par_priv->type_of_oid != QUERY_OID)
  1061. return NDIS_STATUS_NOT_ACCEPTED;
  1062. if (poid_par_priv->information_buf_len < 8)
  1063. return NDIS_STATUS_INVALID_LENGTH;
  1064. *poid_par_priv->bytes_rw = 8;
  1065. _rtw_memcpy(poid_par_priv->information_buf, &(adapter_to_pwrctl(Adapter)->pwr_mode), 8);
  1066. *poid_par_priv->bytes_rw = poid_par_priv->information_buf_len;
  1067. return status;
  1068. #else
  1069. return 0;
  1070. #endif
  1071. }
  1072. /* ------------------------------------------------------------------------------ */
  1073. NDIS_STATUS oid_rt_pro_set_pwrstate_hdl(struct oid_par_priv *poid_par_priv)
  1074. {
  1075. #if 0
  1076. PADAPTER Adapter = (PADAPTER)(poid_par_priv->adapter_context);
  1077. NDIS_STATUS status = NDIS_STATUS_SUCCESS;
  1078. uint pwr_mode, smart_ps;
  1079. if (poid_par_priv->type_of_oid != SET_OID)
  1080. return NDIS_STATUS_NOT_ACCEPTED;
  1081. *poid_par_priv->bytes_rw = 0;
  1082. *poid_par_priv->bytes_needed = 8;
  1083. if (poid_par_priv->information_buf_len < 8)
  1084. return NDIS_STATUS_INVALID_LENGTH;
  1085. pwr_mode = *(uint *)(poid_par_priv->information_buf);
  1086. smart_ps = *(uint *)((int)poid_par_priv->information_buf + 4);
  1087. *poid_par_priv->bytes_rw = 8;
  1088. return status;
  1089. #else
  1090. return 0;
  1091. #endif
  1092. }
  1093. /* ------------------------------------------------------------------------------ */
  1094. NDIS_STATUS oid_rt_pro_h2c_set_rate_table_hdl(struct oid_par_priv *poid_par_priv)
  1095. {
  1096. #if 0
  1097. PADAPTER Adapter = (PADAPTER)(poid_par_priv->adapter_context);
  1098. #ifdef PLATFORM_OS_XP
  1099. _irqL oldirql;
  1100. #endif
  1101. NDIS_STATUS status = NDIS_STATUS_SUCCESS;
  1102. struct setratable_parm *prate_table;
  1103. u8 res;
  1104. if (poid_par_priv->type_of_oid != SET_OID)
  1105. return NDIS_STATUS_NOT_ACCEPTED;
  1106. *poid_par_priv->bytes_needed = sizeof(struct setratable_parm);
  1107. if (poid_par_priv->information_buf_len < sizeof(struct setratable_parm))
  1108. return NDIS_STATUS_INVALID_LENGTH;
  1109. prate_table = (struct setratable_parm *)poid_par_priv->information_buf;
  1110. _irqlevel_changed_(&oldirql, LOWER);
  1111. res = rtw_setrttbl_cmd(Adapter, prate_table);
  1112. _irqlevel_changed_(&oldirql, RAISE);
  1113. if (res == _FAIL)
  1114. status = NDIS_STATUS_FAILURE;
  1115. return status;
  1116. #else
  1117. return 0;
  1118. #endif
  1119. }
  1120. /* ------------------------------------------------------------------------------ */
  1121. NDIS_STATUS oid_rt_pro_h2c_get_rate_table_hdl(struct oid_par_priv *poid_par_priv)
  1122. {
  1123. #if 0
  1124. PADAPTER Adapter = (PADAPTER)(poid_par_priv->adapter_context);
  1125. NDIS_STATUS status = NDIS_STATUS_SUCCESS;
  1126. if (poid_par_priv->type_of_oid != QUERY_OID)
  1127. return NDIS_STATUS_NOT_ACCEPTED;
  1128. #if 0
  1129. struct mp_wi_cntx *pmp_wi_cntx = &(Adapter->mppriv.wi_cntx);
  1130. u8 res = _SUCCESS;
  1131. DEBUG_INFO(("===> Set OID_RT_PRO_H2C_GET_RATE_TABLE.\n"));
  1132. if (pmp_wi_cntx->bmp_wi_progress == _TRUE) {
  1133. DEBUG_ERR(("\n mp workitem is progressing, not allow to set another workitem right now!!!\n"));
  1134. Status = NDIS_STATUS_NOT_ACCEPTED;
  1135. break;
  1136. } else {
  1137. pmp_wi_cntx->bmp_wi_progress = _TRUE;
  1138. pmp_wi_cntx->param.bcompleted = _FALSE;
  1139. pmp_wi_cntx->param.act_type = MPT_GET_RATE_TABLE;
  1140. pmp_wi_cntx->param.io_offset = 0x0;
  1141. pmp_wi_cntx->param.bytes_cnt = sizeof(struct getratable_rsp);
  1142. pmp_wi_cntx->param.io_value = 0xffffffff;
  1143. res = rtw_getrttbl_cmd(Adapter, (struct getratable_rsp *)pmp_wi_cntx->param.data);
  1144. *poid_par_priv->bytes_rw = poid_par_priv->information_buf_len;
  1145. if (res != _SUCCESS)
  1146. Status = NDIS_STATUS_NOT_ACCEPTED;
  1147. }
  1148. DEBUG_INFO(("\n <=== Set OID_RT_PRO_H2C_GET_RATE_TABLE.\n"));
  1149. #endif
  1150. return status;
  1151. #else
  1152. return 0;
  1153. #endif
  1154. }
  1155. /* **************** oid_rtl_seg_87_12_00 section start **************** */
  1156. NDIS_STATUS oid_rt_pro_encryption_ctrl_hdl(struct oid_par_priv *poid_par_priv)
  1157. {
  1158. #if 0
  1159. PADAPTER Adapter = (PADAPTER)(poid_par_priv->adapter_context);
  1160. struct security_priv *psecuritypriv = &Adapter->securitypriv;
  1161. NDIS_STATUS status = NDIS_STATUS_SUCCESS;
  1162. ENCRY_CTRL_STATE encry_mode;
  1163. *poid_par_priv->bytes_needed = sizeof(u8);
  1164. if (poid_par_priv->information_buf_len < *poid_par_priv->bytes_needed)
  1165. return NDIS_STATUS_INVALID_LENGTH;
  1166. if (poid_par_priv->type_of_oid == SET_OID) {
  1167. encry_mode = *((u8 *)poid_par_priv->information_buf);
  1168. switch (encry_mode) {
  1169. case HW_CONTROL:
  1170. #if 0
  1171. Adapter->registrypriv.software_decrypt = _FALSE;
  1172. Adapter->registrypriv.software_encrypt = _FALSE;
  1173. #else
  1174. psecuritypriv->sw_decrypt = _FALSE;
  1175. psecuritypriv->sw_encrypt = _FALSE;
  1176. #endif
  1177. break;
  1178. case SW_CONTROL:
  1179. #if 0
  1180. Adapter->registrypriv.software_decrypt = _TRUE;
  1181. Adapter->registrypriv.software_encrypt = _TRUE;
  1182. #else
  1183. psecuritypriv->sw_decrypt = _TRUE;
  1184. psecuritypriv->sw_encrypt = _TRUE;
  1185. #endif
  1186. break;
  1187. case HW_ENCRY_SW_DECRY:
  1188. #if 0
  1189. Adapter->registrypriv.software_decrypt = _TRUE;
  1190. Adapter->registrypriv.software_encrypt = _FALSE;
  1191. #else
  1192. psecuritypriv->sw_decrypt = _TRUE;
  1193. psecuritypriv->sw_encrypt = _FALSE;
  1194. #endif
  1195. break;
  1196. case SW_ENCRY_HW_DECRY:
  1197. #if 0
  1198. Adapter->registrypriv.software_decrypt = _FALSE;
  1199. Adapter->registrypriv.software_encrypt = _TRUE;
  1200. #else
  1201. psecuritypriv->sw_decrypt = _FALSE;
  1202. psecuritypriv->sw_encrypt = _TRUE;
  1203. #endif
  1204. break;
  1205. }
  1206. } else {
  1207. #if 0
  1208. if (Adapter->registrypriv.software_encrypt == _FALSE) {
  1209. if (Adapter->registrypriv.software_decrypt == _FALSE)
  1210. encry_mode = HW_CONTROL;
  1211. else
  1212. encry_mode = HW_ENCRY_SW_DECRY;
  1213. } else {
  1214. if (Adapter->registrypriv.software_decrypt == _FALSE)
  1215. encry_mode = SW_ENCRY_HW_DECRY;
  1216. else
  1217. encry_mode = SW_CONTROL;
  1218. }
  1219. #else
  1220. if ((psecuritypriv->sw_encrypt == _FALSE) && (psecuritypriv->sw_decrypt == _FALSE))
  1221. encry_mode = HW_CONTROL;
  1222. else if ((psecuritypriv->sw_encrypt == _FALSE) && (psecuritypriv->sw_decrypt == _TRUE))
  1223. encry_mode = HW_ENCRY_SW_DECRY;
  1224. else if ((psecuritypriv->sw_encrypt == _TRUE) && (psecuritypriv->sw_decrypt == _FALSE))
  1225. encry_mode = SW_ENCRY_HW_DECRY;
  1226. else if ((psecuritypriv->sw_encrypt == _TRUE) && (psecuritypriv->sw_decrypt == _TRUE))
  1227. encry_mode = SW_CONTROL;
  1228. #endif
  1229. *(u8 *)poid_par_priv->information_buf = encry_mode;
  1230. *poid_par_priv->bytes_rw = poid_par_priv->information_buf_len;
  1231. }
  1232. return status;
  1233. #else
  1234. return 0;
  1235. #endif
  1236. }
  1237. /* ------------------------------------------------------------------------------ */
  1238. NDIS_STATUS oid_rt_pro_add_sta_info_hdl(struct oid_par_priv *poid_par_priv)
  1239. {
  1240. #if 0
  1241. PADAPTER Adapter = (PADAPTER)(poid_par_priv->adapter_context);
  1242. #ifdef PLATFORM_OS_XP
  1243. _irqL oldirql;
  1244. #endif
  1245. NDIS_STATUS status = NDIS_STATUS_SUCCESS;
  1246. struct sta_info *psta = NULL;
  1247. UCHAR *macaddr;
  1248. if (poid_par_priv->type_of_oid != SET_OID)
  1249. return NDIS_STATUS_NOT_ACCEPTED;
  1250. *poid_par_priv->bytes_needed = ETH_ALEN;
  1251. if (poid_par_priv->information_buf_len < *poid_par_priv->bytes_needed)
  1252. return NDIS_STATUS_INVALID_LENGTH;
  1253. macaddr = (UCHAR *) poid_par_priv->information_buf ;
  1254. _irqlevel_changed_(&oldirql, LOWER);
  1255. psta = rtw_get_stainfo(&Adapter->stapriv, macaddr);
  1256. if (psta == NULL) { /* the sta have been in sta_info_queue => do nothing */
  1257. psta = rtw_alloc_stainfo(&Adapter->stapriv, macaddr);
  1258. if (psta == NULL) {
  1259. status = NDIS_STATUS_FAILURE;
  1260. }
  1261. }
  1262. _irqlevel_changed_(&oldirql, RAISE);
  1263. return status;
  1264. #else
  1265. return 0;
  1266. #endif
  1267. }
  1268. /* ------------------------------------------------------------------------------ */
  1269. NDIS_STATUS oid_rt_pro_dele_sta_info_hdl(struct oid_par_priv *poid_par_priv)
  1270. {
  1271. #if 0
  1272. PADAPTER Adapter = (PADAPTER)(poid_par_priv->adapter_context);
  1273. #ifdef PLATFORM_OS_XP
  1274. _irqL oldirql;
  1275. #endif
  1276. NDIS_STATUS status = NDIS_STATUS_SUCCESS;
  1277. struct sta_info *psta = NULL;
  1278. UCHAR *macaddr;
  1279. if (poid_par_priv->type_of_oid != SET_OID)
  1280. return NDIS_STATUS_NOT_ACCEPTED;
  1281. *poid_par_priv->bytes_needed = ETH_ALEN;
  1282. if (poid_par_priv->information_buf_len < *poid_par_priv->bytes_needed)
  1283. return NDIS_STATUS_INVALID_LENGTH;
  1284. macaddr = (UCHAR *) poid_par_priv->information_buf ;
  1285. psta = rtw_get_stainfo(&Adapter->stapriv, macaddr);
  1286. if (psta != NULL) {
  1287. /* _enter_critical(&(Adapter->stapriv.sta_hash_lock), &irqL); */
  1288. rtw_free_stainfo(Adapter, psta);
  1289. /* _exit_critical(&(Adapter->stapriv.sta_hash_lock), &irqL); */
  1290. }
  1291. return status;
  1292. #else
  1293. return 0;
  1294. #endif
  1295. }
  1296. /* ------------------------------------------------------------------------------ */
  1297. #if 0
  1298. static u32 mp_query_drv_var(_adapter *padapter, u8 offset, u32 var)
  1299. {
  1300. #ifdef CONFIG_SDIO_HCI
  1301. if (offset == 1) {
  1302. u16 tmp_blk_num;
  1303. tmp_blk_num = rtw_read16(padapter, SDIO_RX0_RDYBLK_NUM);
  1304. if (adapter_to_dvobj(padapter)->rxblknum != tmp_blk_num) {
  1305. /* sd_recv_rxfifo(padapter); */
  1306. }
  1307. }
  1308. #if 0
  1309. if (offset <= 100) { /* For setting data rate and query data rate */
  1310. if (offset == 100) { /* For query data rate */
  1311. var = padapter->registrypriv.tx_rate;
  1312. } else if (offset < 0x1d) { /* For setting data rate */
  1313. padapter->registrypriv.tx_rate = offset;
  1314. var = padapter->registrypriv.tx_rate;
  1315. padapter->registrypriv.use_rate = _TRUE;
  1316. } else { /* not use the data rate */
  1317. padapter->registrypriv.use_rate = _FALSE;
  1318. }
  1319. } else if (offset <= 110) { /* for setting debug level */
  1320. if (offset == 110) { /* For query data rate */
  1321. padapter->registrypriv.dbg_level = GlobalDebugLevel;
  1322. var = padapter->registrypriv.dbg_level;
  1323. } else if (offset < 110 && offset > 100) {
  1324. padapter->registrypriv.dbg_level = GlobalDebugLevel = offset - 100;
  1325. var = padapter->registrypriv.dbg_level;
  1326. }
  1327. } else if (offset > 110 && offset < 116) {
  1328. if (115 == offset) {
  1329. } else {
  1330. switch (offset) {
  1331. case 111:
  1332. adapter_to_dvobj(padapter)->tx_block_mode = 1;
  1333. adapter_to_dvobj(padapter)->rx_block_mode = 1;
  1334. break;
  1335. case 112:
  1336. adapter_to_dvobj(padapter)->tx_block_mode = 1;
  1337. adapter_to_dvobj(padapter)->rx_block_mode = 0;
  1338. break;
  1339. case 113:
  1340. adapter_to_dvobj(padapter)->tx_block_mode = 0;
  1341. adapter_to_dvobj(padapter)->rx_block_mode = 1;
  1342. break;
  1343. case 114:
  1344. adapter_to_dvobj(padapter)->tx_block_mode = 0;
  1345. adapter_to_dvobj(padapter)->rx_block_mode = 0;
  1346. break;
  1347. default:
  1348. break;
  1349. }
  1350. }
  1351. } else if (offset >= 127) {
  1352. u64 prnt_dbg_comp;
  1353. u8 chg_idx;
  1354. u64 tmp_dbg_comp;
  1355. chg_idx = offset - 0x80;
  1356. tmp_dbg_comp = BIT(chg_idx);
  1357. prnt_dbg_comp = padapter->registrypriv.dbg_component = GlobalDebugComponents;
  1358. if (offset == 127) {
  1359. /* prnt_dbg_comp=padapter->registrypriv.dbg_component= GlobalDebugComponents; */
  1360. var = (u32)(padapter->registrypriv.dbg_component);
  1361. prnt_dbg_comp = GlobalDebugComponents;
  1362. prnt_dbg_comp = GlobalDebugComponents = padapter->registrypriv.dbg_component;
  1363. } else {
  1364. prnt_dbg_comp = GlobalDebugComponents;
  1365. prnt_dbg_comp = GlobalDebugComponents = padapter->registrypriv.dbg_component;
  1366. if (GlobalDebugComponents & tmp_dbg_comp) {
  1367. /* this bit is already set, now clear it */
  1368. GlobalDebugComponents = GlobalDebugComponents & (~tmp_dbg_comp);
  1369. } else {
  1370. /* this bit is not set, now set it. */
  1371. GlobalDebugComponents = GlobalDebugComponents | tmp_dbg_comp;
  1372. }
  1373. prnt_dbg_comp = GlobalDebugComponents;
  1374. var = (u32)(GlobalDebugComponents);
  1375. /* GlobalDebugComponents=padapter->registrypriv.dbg_component; */
  1376. }
  1377. }
  1378. #endif
  1379. #endif
  1380. return var;
  1381. }
  1382. #endif
  1383. NDIS_STATUS oid_rt_pro_query_dr_variable_hdl(struct oid_par_priv *poid_par_priv)
  1384. {
  1385. #if 0
  1386. PADAPTER Adapter = (PADAPTER)(poid_par_priv->adapter_context);
  1387. #ifdef PLATFORM_OS_XP
  1388. _irqL oldirql;
  1389. #endif
  1390. NDIS_STATUS status = NDIS_STATUS_SUCCESS;
  1391. DR_VARIABLE_STRUCT *pdrv_var;
  1392. if (poid_par_priv->type_of_oid != QUERY_OID)
  1393. return NDIS_STATUS_NOT_ACCEPTED;
  1394. *poid_par_priv->bytes_needed = sizeof(DR_VARIABLE_STRUCT);
  1395. if (poid_par_priv->information_buf_len < *poid_par_priv->bytes_needed)
  1396. return NDIS_STATUS_INVALID_LENGTH;
  1397. pdrv_var = (struct _DR_VARIABLE_STRUCT_ *)poid_par_priv->information_buf;
  1398. _irqlevel_changed_(&oldirql, LOWER);
  1399. pdrv_var->variable = mp_query_drv_var(Adapter, pdrv_var->offset, pdrv_var->variable);
  1400. _irqlevel_changed_(&oldirql, RAISE);
  1401. *poid_par_priv->bytes_rw = poid_par_priv->information_buf_len;
  1402. return status;
  1403. #else
  1404. return 0;
  1405. #endif
  1406. }
  1407. /* ------------------------------------------------------------------------------ */
  1408. NDIS_STATUS oid_rt_pro_rx_packet_type_hdl(struct oid_par_priv *poid_par_priv)
  1409. {
  1410. #if 0
  1411. PADAPTER Adapter = (PADAPTER)(poid_par_priv->adapter_context);
  1412. NDIS_STATUS status = NDIS_STATUS_SUCCESS;
  1413. if (poid_par_priv->information_buf_len < sizeof(UCHAR)) {
  1414. status = NDIS_STATUS_INVALID_LENGTH;
  1415. *poid_par_priv->bytes_needed = sizeof(UCHAR);
  1416. return status;
  1417. }
  1418. if (poid_par_priv->type_of_oid == SET_OID) {
  1419. Adapter->mppriv.rx_with_status = *(UCHAR *) poid_par_priv->information_buf;
  1420. } else {
  1421. *(UCHAR *) poid_par_priv->information_buf = Adapter->mppriv.rx_with_status;
  1422. *poid_par_priv->bytes_rw = poid_par_priv->information_buf_len;
  1423. /* *(u32 *)&Adapter->eeprompriv.mac_addr[0]=rtw_read32(Adapter, 0x10250050); */
  1424. /* *(u16 *)&Adapter->eeprompriv.mac_addr[4]=rtw_read16(Adapter, 0x10250054); */
  1425. }
  1426. #endif
  1427. return NDIS_STATUS_SUCCESS;
  1428. }
  1429. /* ------------------------------------------------------------------------------ */
  1430. NDIS_STATUS oid_rt_pro_read_efuse_hdl(struct oid_par_priv *poid_par_priv)
  1431. {
  1432. #ifdef PLATFORM_OS_XP
  1433. _irqL oldirql;
  1434. #endif
  1435. PEFUSE_ACCESS_STRUCT pefuse;
  1436. u8 *data;
  1437. u16 addr = 0, cnts = 0, max_available_size = 0;
  1438. NDIS_STATUS status = NDIS_STATUS_SUCCESS;
  1439. PADAPTER Adapter = (PADAPTER)(poid_par_priv->adapter_context);
  1440. if (poid_par_priv->type_of_oid != QUERY_OID)
  1441. return NDIS_STATUS_NOT_ACCEPTED;
  1442. if (poid_par_priv->information_buf_len < sizeof(EFUSE_ACCESS_STRUCT))
  1443. return NDIS_STATUS_INVALID_LENGTH;
  1444. pefuse = (PEFUSE_ACCESS_STRUCT)poid_par_priv->information_buf;
  1445. addr = pefuse->start_addr;
  1446. cnts = pefuse->cnts;
  1447. data = pefuse->data;
  1448. EFUSE_GetEfuseDefinition(Adapter, EFUSE_WIFI, TYPE_AVAILABLE_EFUSE_BYTES_TOTAL, (PVOID)&max_available_size, _FALSE);
  1449. if ((addr + cnts) > max_available_size) {
  1450. return NDIS_STATUS_NOT_ACCEPTED;
  1451. }
  1452. _irqlevel_changed_(&oldirql, LOWER);
  1453. if (rtw_efuse_access(Adapter, _FALSE, addr, cnts, data) == _FAIL) {
  1454. status = NDIS_STATUS_FAILURE;
  1455. } else
  1456. *poid_par_priv->bytes_rw = poid_par_priv->information_buf_len;
  1457. _irqlevel_changed_(&oldirql, RAISE);
  1458. return status;
  1459. }
  1460. /* ------------------------------------------------------------------------------ */
  1461. NDIS_STATUS oid_rt_pro_write_efuse_hdl(struct oid_par_priv *poid_par_priv)
  1462. {
  1463. #ifdef PLATFORM_OS_XP
  1464. _irqL oldirql;
  1465. #endif
  1466. PEFUSE_ACCESS_STRUCT pefuse;
  1467. u8 *data;
  1468. u16 addr = 0, cnts = 0, max_available_size = 0;
  1469. NDIS_STATUS status = NDIS_STATUS_SUCCESS;
  1470. PADAPTER Adapter = (PADAPTER)(poid_par_priv->adapter_context);
  1471. if (poid_par_priv->type_of_oid != SET_OID)
  1472. return NDIS_STATUS_NOT_ACCEPTED;
  1473. pefuse = (PEFUSE_ACCESS_STRUCT)poid_par_priv->information_buf;
  1474. addr = pefuse->start_addr;
  1475. cnts = pefuse->cnts;
  1476. data = pefuse->data;
  1477. EFUSE_GetEfuseDefinition(Adapter, EFUSE_WIFI, TYPE_AVAILABLE_EFUSE_BYTES_TOTAL, (PVOID)&max_available_size, _FALSE);
  1478. if ((addr + cnts) > max_available_size) {
  1479. return NDIS_STATUS_NOT_ACCEPTED;
  1480. }
  1481. _irqlevel_changed_(&oldirql, LOWER);
  1482. if (rtw_efuse_access(Adapter, _TRUE, addr, cnts, data) == _FAIL)
  1483. status = NDIS_STATUS_FAILURE;
  1484. _irqlevel_changed_(&oldirql, RAISE);
  1485. return status;
  1486. }
  1487. /* ------------------------------------------------------------------------------ */
  1488. NDIS_STATUS oid_rt_pro_rw_efuse_pgpkt_hdl(struct oid_par_priv *poid_par_priv)
  1489. {
  1490. #ifdef PLATFORM_OS_XP
  1491. _irqL oldirql;
  1492. #endif
  1493. PPGPKT_STRUCT ppgpkt;
  1494. NDIS_STATUS status = NDIS_STATUS_SUCCESS;
  1495. PADAPTER Adapter = (PADAPTER)(poid_par_priv->adapter_context);
  1496. *poid_par_priv->bytes_rw = 0;
  1497. if (poid_par_priv->information_buf_len < sizeof(PGPKT_STRUCT))
  1498. return NDIS_STATUS_INVALID_LENGTH;
  1499. ppgpkt = (PPGPKT_STRUCT)poid_par_priv->information_buf;
  1500. _irqlevel_changed_(&oldirql, LOWER);
  1501. if (poid_par_priv->type_of_oid == QUERY_OID) {
  1502. Efuse_PowerSwitch(Adapter, _FALSE, _TRUE);
  1503. if (Efuse_PgPacketRead(Adapter, ppgpkt->offset, ppgpkt->data, _FALSE) == _TRUE)
  1504. *poid_par_priv->bytes_rw = poid_par_priv->information_buf_len;
  1505. else
  1506. status = NDIS_STATUS_FAILURE;
  1507. Efuse_PowerSwitch(Adapter, _FALSE, _FALSE);
  1508. } else {
  1509. Efuse_PowerSwitch(Adapter, _TRUE, _TRUE);
  1510. if (Efuse_PgPacketWrite(Adapter, ppgpkt->offset, ppgpkt->word_en, ppgpkt->data, _FALSE) == _TRUE)
  1511. *poid_par_priv->bytes_rw = poid_par_priv->information_buf_len;
  1512. else
  1513. status = NDIS_STATUS_FAILURE;
  1514. Efuse_PowerSwitch(Adapter, _TRUE, _FALSE);
  1515. }
  1516. _irqlevel_changed_(&oldirql, RAISE);
  1517. return status;
  1518. }
  1519. /* ------------------------------------------------------------------------------ */
  1520. NDIS_STATUS oid_rt_get_efuse_current_size_hdl(struct oid_par_priv *poid_par_priv)
  1521. {
  1522. #ifdef PLATFORM_OS_XP
  1523. _irqL oldirql;
  1524. #endif
  1525. u16 size;
  1526. u8 ret;
  1527. NDIS_STATUS status = NDIS_STATUS_SUCCESS;
  1528. PADAPTER Adapter = (PADAPTER)(poid_par_priv->adapter_context);
  1529. if (poid_par_priv->type_of_oid != QUERY_OID)
  1530. return NDIS_STATUS_NOT_ACCEPTED;
  1531. if (poid_par_priv->information_buf_len < sizeof(u32))
  1532. return NDIS_STATUS_INVALID_LENGTH;
  1533. _irqlevel_changed_(&oldirql, LOWER);
  1534. ret = efuse_GetCurrentSize(Adapter, &size);
  1535. _irqlevel_changed_(&oldirql, RAISE);
  1536. if (ret == _SUCCESS) {
  1537. *(u32 *)poid_par_priv->information_buf = size;
  1538. *poid_par_priv->bytes_rw = poid_par_priv->information_buf_len;
  1539. } else
  1540. status = NDIS_STATUS_FAILURE;
  1541. return status;
  1542. }
  1543. /* ------------------------------------------------------------------------------ */
  1544. NDIS_STATUS oid_rt_get_efuse_max_size_hdl(struct oid_par_priv *poid_par_priv)
  1545. {
  1546. NDIS_STATUS status = NDIS_STATUS_SUCCESS;
  1547. PADAPTER Adapter = (PADAPTER)(poid_par_priv->adapter_context);
  1548. if (poid_par_priv->type_of_oid != QUERY_OID)
  1549. return NDIS_STATUS_NOT_ACCEPTED;
  1550. if (poid_par_priv->information_buf_len < sizeof(u32))
  1551. return NDIS_STATUS_INVALID_LENGTH;
  1552. *(u32 *)poid_par_priv->information_buf = efuse_GetMaxSize(Adapter);
  1553. *poid_par_priv->bytes_rw = poid_par_priv->information_buf_len;
  1554. return status;
  1555. }
  1556. /* ------------------------------------------------------------------------------ */
  1557. NDIS_STATUS oid_rt_pro_efuse_hdl(struct oid_par_priv *poid_par_priv)
  1558. {
  1559. NDIS_STATUS status;
  1560. if (poid_par_priv->type_of_oid == QUERY_OID)
  1561. status = oid_rt_pro_read_efuse_hdl(poid_par_priv);
  1562. else
  1563. status = oid_rt_pro_write_efuse_hdl(poid_par_priv);
  1564. return status;
  1565. }
  1566. /* ------------------------------------------------------------------------------ */
  1567. NDIS_STATUS oid_rt_pro_efuse_map_hdl(struct oid_par_priv *poid_par_priv)
  1568. {
  1569. #ifdef PLATFORM_OS_XP
  1570. _irqL oldirql;
  1571. #endif
  1572. u8 *data;
  1573. NDIS_STATUS status = NDIS_STATUS_SUCCESS;
  1574. PADAPTER Adapter = (PADAPTER)(poid_par_priv->adapter_context);
  1575. u16 mapLen = 0;
  1576. EFUSE_GetEfuseDefinition(Adapter, EFUSE_WIFI, TYPE_EFUSE_MAP_LEN, (PVOID)&mapLen, _FALSE);
  1577. *poid_par_priv->bytes_rw = 0;
  1578. if (poid_par_priv->information_buf_len < mapLen)
  1579. return NDIS_STATUS_INVALID_LENGTH;
  1580. data = (u8 *)poid_par_priv->information_buf;
  1581. _irqlevel_changed_(&oldirql, LOWER);
  1582. if (poid_par_priv->type_of_oid == QUERY_OID) {
  1583. if (rtw_efuse_map_read(Adapter, 0, mapLen, data) == _SUCCESS)
  1584. *poid_par_priv->bytes_rw = mapLen;
  1585. else {
  1586. status = NDIS_STATUS_FAILURE;
  1587. }
  1588. } else {
  1589. /* SET_OID */
  1590. if (rtw_efuse_map_write(Adapter, 0, mapLen, data) == _SUCCESS)
  1591. *poid_par_priv->bytes_rw = mapLen;
  1592. else {
  1593. status = NDIS_STATUS_FAILURE;
  1594. }
  1595. }
  1596. _irqlevel_changed_(&oldirql, RAISE);
  1597. return status;
  1598. }
  1599. NDIS_STATUS oid_rt_set_crystal_cap_hdl(struct oid_par_priv *poid_par_priv)
  1600. {
  1601. NDIS_STATUS status = NDIS_STATUS_SUCCESS;
  1602. #if 0
  1603. PADAPTER Adapter = (PADAPTER)(poid_par_priv->adapter_context);
  1604. #ifdef PLATFORM_OS_XP
  1605. _irqL oldirql;
  1606. #endif
  1607. u32 crystal_cap = 0;
  1608. if (poid_par_priv->type_of_oid != SET_OID)
  1609. return NDIS_STATUS_NOT_ACCEPTED;
  1610. if (poid_par_priv->information_buf_len < sizeof(u32))
  1611. return NDIS_STATUS_INVALID_LENGTH;
  1612. crystal_cap = *((u32 *)poid_par_priv->information_buf); /* 4 */
  1613. if (crystal_cap > 0xf)
  1614. return NDIS_STATUS_NOT_ACCEPTED;
  1615. Adapter->mppriv.curr_crystalcap = crystal_cap;
  1616. _irqlevel_changed_(&oldirql, LOWER);
  1617. SetCrystalCap(Adapter);
  1618. _irqlevel_changed_(&oldirql, RAISE);
  1619. #endif
  1620. return status;
  1621. }
  1622. NDIS_STATUS oid_rt_set_rx_packet_type_hdl(struct oid_par_priv *poid_par_priv)
  1623. {
  1624. #ifdef PLATFORM_OS_XP
  1625. _irqL oldirql;
  1626. #endif
  1627. u8 rx_pkt_type;
  1628. /* u32 rcr_val32; */
  1629. NDIS_STATUS status = NDIS_STATUS_SUCCESS;
  1630. /* PADAPTER padapter = (PADAPTER)(poid_par_priv->adapter_context); */
  1631. if (poid_par_priv->type_of_oid != SET_OID)
  1632. return NDIS_STATUS_NOT_ACCEPTED;
  1633. if (poid_par_priv->information_buf_len < sizeof(u8))
  1634. return NDIS_STATUS_INVALID_LENGTH;
  1635. rx_pkt_type = *((u8 *)poid_par_priv->information_buf); /* 4 */
  1636. #if 0
  1637. _irqlevel_changed_(&oldirql, LOWER);
  1638. #if 0
  1639. rcr_val8 = rtw_read8(Adapter, 0x10250048);/* RCR */
  1640. rcr_val8 &= ~(RCR_AB | RCR_AM | RCR_APM | RCR_AAP);
  1641. if (rx_pkt_type == RX_PKT_BROADCAST)
  1642. rcr_val8 |= (RCR_AB | RCR_ACRC32);
  1643. else if (rx_pkt_type == RX_PKT_DEST_ADDR)
  1644. rcr_val8 |= (RCR_AAP | RCR_AM | RCR_ACRC32);
  1645. else if (rx_pkt_type == RX_PKT_PHY_MATCH)
  1646. rcr_val8 |= (RCR_APM | RCR_ACRC32);
  1647. else
  1648. rcr_val8 &= ~(RCR_AAP | RCR_APM | RCR_AM | RCR_AB | RCR_ACRC32);
  1649. rtw_write8(padapter, 0x10250048, rcr_val8);
  1650. #else
  1651. rcr_val32 = rtw_read32(padapter, RCR);/* RCR = 0x10250048 */
  1652. rcr_val32 &= ~(RCR_CBSSID | RCR_AB | RCR_AM | RCR_APM | RCR_AAP);
  1653. #if 0
  1654. if (rx_pkt_type == RX_PKT_BROADCAST)
  1655. rcr_val32 |= (RCR_AB | RCR_AM | RCR_APM | RCR_AAP | RCR_ACRC32);
  1656. else if (rx_pkt_type == RX_PKT_DEST_ADDR) {
  1657. /* rcr_val32 |= (RCR_CBSSID|RCR_AAP|RCR_AM|RCR_ACRC32); */
  1658. rcr_val32 |= (RCR_CBSSID | RCR_APM | RCR_ACRC32);
  1659. } else if (rx_pkt_type == RX_PKT_PHY_MATCH) {
  1660. rcr_val32 |= (RCR_APM | RCR_ACRC32);
  1661. /* rcr_val32 |= (RCR_AAP|RCR_ACRC32); */
  1662. } else
  1663. rcr_val32 &= ~(RCR_AAP | RCR_APM | RCR_AM | RCR_AB | RCR_ACRC32);
  1664. #else
  1665. switch (rx_pkt_type) {
  1666. case RX_PKT_BROADCAST:
  1667. rcr_val32 |= (RCR_AB | RCR_AM | RCR_APM | RCR_AAP | RCR_ACRC32);
  1668. break;
  1669. case RX_PKT_DEST_ADDR:
  1670. rcr_val32 |= (RCR_AB | RCR_AM | RCR_APM | RCR_AAP | RCR_ACRC32);
  1671. break;
  1672. case RX_PKT_PHY_MATCH:
  1673. rcr_val32 |= (RCR_APM | RCR_ACRC32);
  1674. break;
  1675. default:
  1676. rcr_val32 &= ~(RCR_AAP | RCR_APM | RCR_AM | RCR_AB | RCR_ACRC32);
  1677. break;
  1678. }
  1679. if (rx_pkt_type == RX_PKT_DEST_ADDR)
  1680. padapter->mppriv.check_mp_pkt = 1;
  1681. else
  1682. padapter->mppriv.check_mp_pkt = 0;
  1683. #endif
  1684. rtw_write32(padapter, RCR, rcr_val32);
  1685. #endif
  1686. _irqlevel_changed_(&oldirql, RAISE);
  1687. #endif
  1688. return status;
  1689. }
  1690. NDIS_STATUS oid_rt_pro_set_tx_agc_offset_hdl(struct oid_par_priv *poid_par_priv)
  1691. {
  1692. #if 0
  1693. PADAPTER Adapter = (PADAPTER)(poid_par_priv->adapter_context);
  1694. #ifdef PLATFORM_OS_XP
  1695. _irqL oldirql;
  1696. #endif
  1697. NDIS_STATUS status = NDIS_STATUS_SUCCESS;
  1698. u32 txagc;
  1699. if (poid_par_priv->type_of_oid != SET_OID)
  1700. return NDIS_STATUS_NOT_ACCEPTED;
  1701. if (poid_par_priv->information_buf_len < sizeof(u32))
  1702. return NDIS_STATUS_INVALID_LENGTH;
  1703. txagc = *(u32 *)poid_par_priv->information_buf;
  1704. _irqlevel_changed_(&oldirql, LOWER);
  1705. SetTxAGCOffset(Adapter, txagc);
  1706. _irqlevel_changed_(&oldirql, RAISE);
  1707. return status;
  1708. #else
  1709. return 0;
  1710. #endif
  1711. }
  1712. NDIS_STATUS oid_rt_pro_set_pkt_test_mode_hdl(struct oid_par_priv *poid_par_priv)
  1713. {
  1714. #if 0
  1715. PADAPTER Adapter = (PADAPTER)(poid_par_priv->adapter_context);
  1716. NDIS_STATUS status = NDIS_STATUS_SUCCESS;
  1717. struct mlme_priv *pmlmepriv = &Adapter->mlmepriv;
  1718. struct mp_priv *pmppriv = &Adapter->mppriv;
  1719. u32 type;
  1720. if (poid_par_priv->type_of_oid != SET_OID)
  1721. return NDIS_STATUS_NOT_ACCEPTED;
  1722. if (poid_par_priv->information_buf_len < sizeof(u32))
  1723. return NDIS_STATUS_INVALID_LENGTH;
  1724. type = *(u32 *)poid_par_priv->information_buf;
  1725. if (_LOOPBOOK_MODE_ == type) {
  1726. pmppriv->mode = type;
  1727. set_fwstate(pmlmepriv, WIFI_MP_LPBK_STATE); /* append txdesc */
  1728. } else if (_2MAC_MODE_ == type) {
  1729. pmppriv->mode = type;
  1730. _clr_fwstate_(pmlmepriv, WIFI_MP_LPBK_STATE);
  1731. } else
  1732. status = NDIS_STATUS_NOT_ACCEPTED;
  1733. return status;
  1734. #else
  1735. return 0;
  1736. #endif
  1737. }
  1738. unsigned int mp_ioctl_xmit_packet_hdl(struct oid_par_priv *poid_par_priv)
  1739. {
  1740. PMP_XMIT_PARM pparm;
  1741. PADAPTER padapter;
  1742. struct mp_priv *pmp_priv;
  1743. struct pkt_attrib *pattrib;
  1744. pparm = (PMP_XMIT_PARM)poid_par_priv->information_buf;
  1745. padapter = (PADAPTER)poid_par_priv->adapter_context;
  1746. pmp_priv = &padapter->mppriv;
  1747. if (poid_par_priv->type_of_oid == QUERY_OID) {
  1748. pparm->enable = !pmp_priv->tx.stop;
  1749. pparm->count = pmp_priv->tx.sended;
  1750. } else {
  1751. if (pparm->enable == 0)
  1752. pmp_priv->tx.stop = 1;
  1753. else if (pmp_priv->tx.stop == 1) {
  1754. pmp_priv->tx.stop = 0;
  1755. pmp_priv->tx.count = pparm->count;
  1756. pmp_priv->tx.payload = pparm->payload_type;
  1757. pattrib = &pmp_priv->tx.attrib;
  1758. pattrib->pktlen = pparm->length;
  1759. _rtw_memcpy(pattrib->dst, pparm->da, ETH_ALEN);
  1760. SetPacketTx(padapter);
  1761. } else
  1762. return NDIS_STATUS_FAILURE;
  1763. }
  1764. return NDIS_STATUS_SUCCESS;
  1765. }
  1766. #if 0
  1767. unsigned int mp_ioctl_xmit_packet_hdl(struct oid_par_priv *poid_par_priv)
  1768. {
  1769. unsigned char *pframe, *pmp_pkt;
  1770. struct ethhdr *pethhdr;
  1771. struct pkt_attrib *pattrib;
  1772. struct rtw_ieee80211_hdr *pwlanhdr;
  1773. unsigned short *fctrl;
  1774. int llc_sz, payload_len;
  1775. struct mp_xmit_frame *pxframe = NULL;
  1776. struct mp_xmit_packet *pmp_xmitpkt = (struct mp_xmit_packet *)param;
  1777. u8 addr3[] = {0x02, 0xE0, 0x4C, 0x87, 0x66, 0x55};
  1778. /* RTW_INFO("+mp_ioctl_xmit_packet_hdl\n"); */
  1779. pxframe = alloc_mp_xmitframe(&padapter->mppriv);
  1780. if (pxframe == NULL) {
  1781. DEBUG_ERR(("Can't alloc pmpframe %d:%s\n", __LINE__, __FILE__));
  1782. return -1;
  1783. }
  1784. /* mp_xmit_pkt */
  1785. payload_len = pmp_xmitpkt->len - 14;
  1786. pmp_pkt = (unsigned char *)pmp_xmitpkt->mem;
  1787. pethhdr = (struct ethhdr *)pmp_pkt;
  1788. /* RTW_INFO("payload_len=%d, pkt_mem=0x%x\n", pmp_xmitpkt->len, (void*)pmp_xmitpkt->mem); */
  1789. /* RTW_INFO("pxframe=0x%x\n", (void*)pxframe); */
  1790. /* RTW_INFO("pxframe->mem=0x%x\n", (void*)pxframe->mem); */
  1791. /* update attribute */
  1792. pattrib = &pxframe->attrib;
  1793. memset((u8 *)(pattrib), 0, sizeof(struct pkt_attrib));
  1794. pattrib->pktlen = pmp_xmitpkt->len;
  1795. pattrib->ether_type = ntohs(pethhdr->h_proto);
  1796. pattrib->hdrlen = 24;
  1797. pattrib->nr_frags = 1;
  1798. pattrib->priority = 0;
  1799. #ifndef CONFIG_MP_LINUX
  1800. if (IS_MCAST(pethhdr->h_dest))
  1801. pattrib->mac_id = 4;
  1802. else
  1803. pattrib->mac_id = 5;
  1804. #else
  1805. pattrib->mac_id = 5;
  1806. #endif
  1807. /* */
  1808. memset(pxframe->mem, 0 , WLANHDR_OFFSET);
  1809. pframe = (u8 *)(pxframe->mem) + WLANHDR_OFFSET;
  1810. pwlanhdr = (struct rtw_ieee80211_hdr *)pframe;
  1811. fctrl = &(pwlanhdr->frame_ctl);
  1812. *(fctrl) = 0;
  1813. set_frame_sub_type(pframe, WIFI_DATA);
  1814. _rtw_memcpy(pwlanhdr->addr1, pethhdr->h_dest, ETH_ALEN);
  1815. _rtw_memcpy(pwlanhdr->addr2, pethhdr->h_source, ETH_ALEN);
  1816. _rtw_memcpy(pwlanhdr->addr3, addr3, ETH_ALEN);
  1817. pwlanhdr->seq_ctl = 0;
  1818. pframe += pattrib->hdrlen;
  1819. llc_sz = rtw_put_snap(pframe, pattrib->ether_type);
  1820. pframe += llc_sz;
  1821. _rtw_memcpy(pframe, (void *)(pmp_pkt + 14), payload_len);
  1822. pattrib->last_txcmdsz = pattrib->hdrlen + llc_sz + payload_len;
  1823. DEBUG_INFO(("issuing mp_xmit_frame, tx_len=%d, ether_type=0x%x\n", pattrib->last_txcmdsz, pattrib->ether_type));
  1824. xmit_mp_frame(padapter, pxframe);
  1825. return _SUCCESS;
  1826. }
  1827. #endif
  1828. /* ------------------------------------------------------------------------------ */
  1829. NDIS_STATUS oid_rt_set_power_down_hdl(struct oid_par_priv *poid_par_priv)
  1830. {
  1831. #ifdef PLATFORM_OS_XP
  1832. _irqL oldirql;
  1833. #endif
  1834. u8 bpwrup;
  1835. NDIS_STATUS status = NDIS_STATUS_SUCCESS;
  1836. #ifdef PLATFORM_LINUX
  1837. #if defined(CONFIG_SDIO_HCI) || defined(CONFIG_GSPI_HCI)
  1838. PADAPTER padapter = (PADAPTER)(poid_par_priv->adapter_context);
  1839. #endif
  1840. #endif
  1841. if (poid_par_priv->type_of_oid != SET_OID) {
  1842. status = NDIS_STATUS_NOT_ACCEPTED;
  1843. return status;
  1844. }
  1845. _irqlevel_changed_(&oldirql, LOWER);
  1846. bpwrup = *(u8 *)poid_par_priv->information_buf;
  1847. /* CALL the power_down function */
  1848. #ifdef PLATFORM_LINUX
  1849. #if defined(CONFIG_RTL8712) /* Linux MP insmod unknown symbol */
  1850. dev_power_down(padapter, bpwrup);
  1851. #endif
  1852. #endif
  1853. _irqlevel_changed_(&oldirql, RAISE);
  1854. /* DEBUG_ERR(("\n <=== Query OID_RT_PRO_READ_REGISTER. */
  1855. /* Add:0x%08x Width:%d Value:0x%08x\n",RegRWStruct->offset,RegRWStruct->width,RegRWStruct->value)); */
  1856. return status;
  1857. }
  1858. /* ------------------------------------------------------------------------------ */
  1859. NDIS_STATUS oid_rt_get_power_mode_hdl(struct oid_par_priv *poid_par_priv)
  1860. {
  1861. #if 0
  1862. NDIS_STATUS status = NDIS_STATUS_SUCCESS;
  1863. PADAPTER Adapter = (PADAPTER)(poid_par_priv->adapter_context);
  1864. /* #ifdef PLATFORM_OS_XP */
  1865. /* _irqL oldirql;
  1866. * #endif */
  1867. if (poid_par_priv->type_of_oid != QUERY_OID) {
  1868. status = NDIS_STATUS_NOT_ACCEPTED;
  1869. return status;
  1870. }
  1871. if (poid_par_priv->information_buf_len < sizeof(u32)) {
  1872. status = NDIS_STATUS_INVALID_LENGTH;
  1873. return status;
  1874. }
  1875. /* _irqlevel_changed_(&oldirql, LOWER); */
  1876. *(int *)poid_par_priv->information_buf = Adapter->registrypriv.low_power ? POWER_LOW : POWER_NORMAL;
  1877. *poid_par_priv->bytes_rw = poid_par_priv->information_buf_len;
  1878. /* _irqlevel_changed_(&oldirql, RAISE); */
  1879. return status;
  1880. #else
  1881. return 0;
  1882. #endif
  1883. }