rtw_mp_ioctl.c 65 KB

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