os_intfs.c 72 KB

123456789101112131415161718192021222324252627282930313233343536373839404142434445464748495051525354555657585960616263646566676869707172737475767778798081828384858687888990919293949596979899100101102103104105106107108109110111112113114115116117118119120121122123124125126127128129130131132133134135136137138139140141142143144145146147148149150151152153154155156157158159160161162163164165166167168169170171172173174175176177178179180181182183184185186187188189190191192193194195196197198199200201202203204205206207208209210211212213214215216217218219220221222223224225226227228229230231232233234235236237238239240241242243244245246247248249250251252253254255256257258259260261262263264265266267268269270271272273274275276277278279280281282283284285286287288289290291292293294295296297298299300301302303304305306307308309310311312313314315316317318319320321322323324325326327328329330331332333334335336337338339340341342343344345346347348349350351352353354355356357358359360361362363364365366367368369370371372373374375376377378379380381382383384385386387388389390391392393394395396397398399400401402403404405406407408409410411412413414415416417418419420421422423424425426427428429430431432433434435436437438439440441442443444445446447448449450451452453454455456457458459460461462463464465466467468469470471472473474475476477478479480481482483484485486487488489490491492493494495496497498499500501502503504505506507508509510511512513514515516517518519520521522523524525526527528529530531532533534535536537538539540541542543544545546547548549550551552553554555556557558559560561562563564565566567568569570571572573574575576577578579580581582583584585586587588589590591592593594595596597598599600601602603604605606607608609610611612613614615616617618619620621622623624625626627628629630631632633634635636637638639640641642643644645646647648649650651652653654655656657658659660661662663664665666667668669670671672673674675676677678679680681682683684685686687688689690691692693694695696697698699700701702703704705706707708709710711712713714715716717718719720721722723724725726727728729730731732733734735736737738739740741742743744745746747748749750751752753754755756757758759760761762763764765766767768769770771772773774775776777778779780781782783784785786787788789790791792793794795796797798799800801802803804805806807808809810811812813814815816817818819820821822823824825826827828829830831832833834835836837838839840841842843844845846847848849850851852853854855856857858859860861862863864865866867868869870871872873874875876877878879880881882883884885886887888889890891892893894895896897898899900901902903904905906907908909910911912913914915916917918919920921922923924925926927928929930931932933934935936937938939940941942943944945946947948949950951952953954955956957958959960961962963964965966967968969970971972973974975976977978979980981982983984985986987988989990991992993994995996997998999100010011002100310041005100610071008100910101011101210131014101510161017101810191020102110221023102410251026102710281029103010311032103310341035103610371038103910401041104210431044104510461047104810491050105110521053105410551056105710581059106010611062106310641065106610671068106910701071107210731074107510761077107810791080108110821083108410851086108710881089109010911092109310941095109610971098109911001101110211031104110511061107110811091110111111121113111411151116111711181119112011211122112311241125112611271128112911301131113211331134113511361137113811391140114111421143114411451146114711481149115011511152115311541155115611571158115911601161116211631164116511661167116811691170117111721173117411751176117711781179118011811182118311841185118611871188118911901191119211931194119511961197119811991200120112021203120412051206120712081209121012111212121312141215121612171218121912201221122212231224122512261227122812291230123112321233123412351236123712381239124012411242124312441245124612471248124912501251125212531254125512561257125812591260126112621263126412651266126712681269127012711272127312741275127612771278127912801281128212831284128512861287128812891290129112921293129412951296129712981299130013011302130313041305130613071308130913101311131213131314131513161317131813191320132113221323132413251326132713281329133013311332133313341335133613371338133913401341134213431344134513461347134813491350135113521353135413551356135713581359136013611362136313641365136613671368136913701371137213731374137513761377137813791380138113821383138413851386138713881389139013911392139313941395139613971398139914001401140214031404140514061407140814091410141114121413141414151416141714181419142014211422142314241425142614271428142914301431143214331434143514361437143814391440144114421443144414451446144714481449145014511452145314541455145614571458145914601461146214631464146514661467146814691470147114721473147414751476147714781479148014811482148314841485148614871488148914901491149214931494149514961497149814991500150115021503150415051506150715081509151015111512151315141515151615171518151915201521152215231524152515261527152815291530153115321533153415351536153715381539154015411542154315441545154615471548154915501551155215531554155515561557155815591560156115621563156415651566156715681569157015711572157315741575157615771578157915801581158215831584158515861587158815891590159115921593159415951596159715981599160016011602160316041605160616071608160916101611161216131614161516161617161816191620162116221623162416251626162716281629163016311632163316341635163616371638163916401641164216431644164516461647164816491650165116521653165416551656165716581659166016611662166316641665166616671668166916701671167216731674167516761677167816791680168116821683168416851686168716881689169016911692169316941695169616971698169917001701170217031704170517061707170817091710171117121713171417151716171717181719172017211722172317241725172617271728172917301731173217331734173517361737173817391740174117421743174417451746174717481749175017511752175317541755175617571758175917601761176217631764176517661767176817691770177117721773177417751776177717781779178017811782178317841785178617871788178917901791179217931794179517961797179817991800180118021803180418051806180718081809181018111812181318141815181618171818181918201821182218231824182518261827182818291830183118321833183418351836183718381839184018411842184318441845184618471848184918501851185218531854185518561857185818591860186118621863186418651866186718681869187018711872187318741875187618771878187918801881188218831884188518861887188818891890189118921893189418951896189718981899190019011902190319041905190619071908190919101911191219131914191519161917191819191920192119221923192419251926192719281929193019311932193319341935193619371938193919401941194219431944194519461947194819491950195119521953195419551956195719581959196019611962196319641965196619671968196919701971197219731974197519761977197819791980198119821983198419851986198719881989199019911992199319941995199619971998199920002001200220032004200520062007200820092010201120122013201420152016201720182019202020212022202320242025202620272028202920302031203220332034203520362037203820392040204120422043204420452046204720482049205020512052205320542055205620572058205920602061206220632064206520662067206820692070207120722073207420752076207720782079208020812082208320842085208620872088208920902091209220932094209520962097209820992100210121022103210421052106210721082109211021112112211321142115211621172118211921202121212221232124212521262127212821292130213121322133213421352136213721382139214021412142214321442145214621472148214921502151215221532154215521562157215821592160216121622163216421652166216721682169217021712172217321742175217621772178217921802181218221832184218521862187218821892190219121922193219421952196219721982199220022012202220322042205220622072208220922102211221222132214221522162217221822192220222122222223222422252226222722282229223022312232223322342235223622372238223922402241224222432244224522462247224822492250225122522253225422552256225722582259226022612262226322642265226622672268226922702271227222732274227522762277227822792280228122822283228422852286228722882289229022912292229322942295229622972298229923002301230223032304230523062307230823092310231123122313231423152316231723182319232023212322232323242325232623272328232923302331233223332334233523362337233823392340234123422343234423452346234723482349235023512352235323542355235623572358235923602361236223632364236523662367236823692370237123722373237423752376237723782379238023812382238323842385238623872388238923902391239223932394239523962397239823992400240124022403240424052406240724082409241024112412241324142415241624172418241924202421242224232424242524262427242824292430243124322433243424352436243724382439244024412442244324442445244624472448244924502451245224532454245524562457245824592460246124622463246424652466246724682469247024712472247324742475247624772478247924802481248224832484248524862487248824892490249124922493249424952496249724982499250025012502250325042505250625072508250925102511251225132514251525162517251825192520252125222523252425252526252725282529253025312532253325342535253625372538253925402541254225432544254525462547254825492550255125522553255425552556255725582559256025612562256325642565256625672568256925702571257225732574257525762577257825792580258125822583258425852586258725882589259025912592259325942595259625972598259926002601260226032604260526062607260826092610261126122613261426152616261726182619262026212622262326242625262626272628262926302631263226332634263526362637263826392640264126422643264426452646264726482649265026512652265326542655265626572658265926602661266226632664266526662667266826692670267126722673267426752676267726782679268026812682268326842685268626872688268926902691269226932694269526962697269826992700270127022703270427052706270727082709271027112712271327142715271627172718271927202721272227232724272527262727272827292730273127322733273427352736273727382739274027412742274327442745274627472748274927502751275227532754275527562757275827592760276127622763276427652766276727682769277027712772277327742775277627772778277927802781278227832784278527862787278827892790279127922793279427952796
  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 _OS_INTFS_C_
  21. #include <drv_types.h>
  22. #if defined (PLATFORM_LINUX) && defined (PLATFORM_WINDOWS)
  23. #error "Shall be Linux or Windows, but not both!\n"
  24. #endif
  25. MODULE_LICENSE("GPL");
  26. MODULE_DESCRIPTION("Realtek Wireless Lan Driver");
  27. MODULE_AUTHOR("Realtek Semiconductor Corp.");
  28. MODULE_VERSION(DRIVERVERSION);
  29. /* module param defaults */
  30. int rtw_chip_version = 0x00;
  31. int rtw_rfintfs = HWPI;
  32. int rtw_lbkmode = 0;//RTL8712_AIR_TRX;
  33. int rtw_network_mode = Ndis802_11IBSS;//Ndis802_11Infrastructure;//infra, ad-hoc, auto
  34. //NDIS_802_11_SSID ssid;
  35. int rtw_channel = 1;//ad-hoc support requirement
  36. int rtw_wireless_mode = WIRELESS_MODE_MAX;
  37. int rtw_vrtl_carrier_sense = AUTO_VCS;
  38. int rtw_vcs_type = RTS_CTS;//*
  39. int rtw_rts_thresh = 2347;//*
  40. int rtw_frag_thresh = 2346;//*
  41. int rtw_preamble = PREAMBLE_LONG;//long, short, auto
  42. int rtw_scan_mode = 1;//active, passive
  43. int rtw_adhoc_tx_pwr = 1;
  44. int rtw_soft_ap = 0;
  45. //int smart_ps = 1;
  46. #ifdef CONFIG_POWER_SAVING
  47. int rtw_power_mgnt = 1;
  48. #ifdef CONFIG_IPS_LEVEL_2
  49. int rtw_ips_mode = IPS_LEVEL_2;
  50. #else
  51. int rtw_ips_mode = IPS_NORMAL;
  52. #endif
  53. #else
  54. int rtw_power_mgnt = PS_MODE_ACTIVE;
  55. int rtw_ips_mode = IPS_NONE;
  56. #endif
  57. int rtw_smart_ps = 2;
  58. #ifdef CONFIG_TX_EARLY_MODE
  59. int rtw_early_mode=1;
  60. #endif
  61. module_param(rtw_ips_mode, int, 0644);
  62. MODULE_PARM_DESC(rtw_ips_mode,"The default IPS mode");
  63. int rtw_radio_enable = 1;
  64. int rtw_long_retry_lmt = 7;
  65. int rtw_short_retry_lmt = 7;
  66. int rtw_busy_thresh = 40;
  67. //int qos_enable = 0; //*
  68. int rtw_ack_policy = NORMAL_ACK;
  69. int rtw_mp_mode = 0;
  70. int rtw_software_encrypt = 0;
  71. int rtw_software_decrypt = 0;
  72. int rtw_acm_method = 0;// 0:By SW 1:By HW.
  73. int rtw_wmm_enable = 1;// default is set to enable the wmm.
  74. int rtw_uapsd_enable = 0;
  75. int rtw_uapsd_max_sp = NO_LIMIT;
  76. int rtw_uapsd_acbk_en = 0;
  77. int rtw_uapsd_acbe_en = 0;
  78. int rtw_uapsd_acvi_en = 0;
  79. int rtw_uapsd_acvo_en = 0;
  80. #ifdef CONFIG_80211N_HT
  81. int rtw_ht_enable = 1;
  82. // 0: 20 MHz, 1: 40 MHz, 2: 80 MHz, 3: 160MHz, 4: 80+80MHz
  83. // 2.4G use bit 0 ~ 3, 5G use bit 4 ~ 7
  84. // 0x21 means enable 2.4G 40MHz & 5G 80MHz
  85. int rtw_bw_mode = 0x21;
  86. int rtw_cbw40_enable = 3; // 0 :diable, bit(0): enable 2.4g, bit(1): enable 5g
  87. int rtw_ampdu_enable = 1;//for enable tx_ampdu
  88. int rtw_rx_stbc = 1;// 0: disable, bit(0):enable 2.4g, bit(1):enable 5g, default is set to enable 2.4GHZ for IOT issue with bufflao's AP at 5GHZ
  89. int rtw_ampdu_amsdu = 0;// 0: disabled, 1:enabled, 2:auto
  90. // Short GI support Bit Map
  91. // BIT0 - 20MHz, 0: support, 1: non-support
  92. // BIT1 - 40MHz, 0: support, 1: non-support
  93. // BIT2 - 80MHz, 0: support, 1: non-support
  94. // BIT3 - 160MHz, 0: support, 1: non-support
  95. int rtw_short_gi = 0xf;
  96. #endif //CONFIG_80211N_HT
  97. #ifdef CONFIG_80211AC_VHT
  98. int rtw_vht_enable = 1;
  99. int rtw_ampdu_factor = 7;
  100. int rtw_vht_rate_sel = 0;
  101. // BIT0: Enable VHT LDPC Rx, BIT1: Enable VHT LDPC Tx, BIT4: Enable HT LDPC Rx, BIT5: Enable HT LDPC Tx
  102. int rtw_ldpc_cap = 0x33;
  103. // BIT0: Enable VHT STBC Rx, BIT1: Enable VHT STBC Tx, BIT4: Enable HT STBC Rx, BIT5: Enable HT STBC Tx
  104. int rtw_stbc_cap = 0x3;
  105. // BIT0: Enable VHT Beamformer, BIT1: Enable VHT Beamformee, BIT4: Enable HT Beamformer, BIT5: Enable HT Beamformee
  106. int rtw_beamform_cap = 0;
  107. #endif //CONFIG_80211AC_VHT
  108. int rtw_lowrate_two_xmit = 1;//Use 2 path Tx to transmit MCS0~7 and legacy mode
  109. //int rf_config = RF_1T2R; // 1T2R
  110. int rtw_rf_config = RF_MAX_TYPE; //auto
  111. int rtw_low_power = 0;
  112. #ifdef CONFIG_WIFI_TEST
  113. int rtw_wifi_spec = 1;//for wifi test
  114. #else
  115. int rtw_wifi_spec = 0;
  116. #endif
  117. int rtw_channel_plan = RT_CHANNEL_DOMAIN_MAX;
  118. #ifdef CONFIG_BT_COEXIST
  119. int rtw_btcoex_enable = 1;
  120. int rtw_bt_iso = 2;// 0:Low, 1:High, 2:From Efuse
  121. int rtw_bt_sco = 3;// 0:Idle, 1:None-SCO, 2:SCO, 3:From Counter, 4.Busy, 5.OtherBusy
  122. int rtw_bt_ampdu =1 ;// 0:Disable BT control A-MPDU, 1:Enable BT control A-MPDU.
  123. #endif
  124. int rtw_AcceptAddbaReq = _TRUE;// 0:Reject AP's Add BA req, 1:Accept AP's Add BA req.
  125. int rtw_antdiv_cfg = 2; // 0:OFF , 1:ON, 2:decide by Efuse config
  126. int rtw_antdiv_type = 0 ; //0:decide by efuse 1: for 88EE, 1Tx and 1RxCG are diversity.(2 Ant with SPDT), 2: for 88EE, 1Tx and 2Rx are diversity.( 2 Ant, Tx and RxCG are both on aux port, RxCS is on main port ), 3: for 88EE, 1Tx and 1RxCG are fixed.(1Ant, Tx and RxCG are both on aux port)
  127. #ifdef CONFIG_USB_AUTOSUSPEND
  128. int rtw_enusbss = 1;//0:disable,1:enable
  129. #else
  130. int rtw_enusbss = 0;//0:disable,1:enable
  131. #endif
  132. int rtw_hwpdn_mode=2;//0:disable,1:enable,2: by EFUSE config
  133. #ifdef CONFIG_HW_PWRP_DETECTION
  134. int rtw_hwpwrp_detect = 1;
  135. #else
  136. int rtw_hwpwrp_detect = 0; //HW power ping detect 0:disable , 1:enable
  137. #endif
  138. #ifdef CONFIG_USB_HCI
  139. int rtw_hw_wps_pbc = 1;
  140. #else
  141. int rtw_hw_wps_pbc = 0;
  142. #endif
  143. #ifdef CONFIG_TX_MCAST2UNI
  144. int rtw_mc2u_disable = 0;
  145. #endif // CONFIG_TX_MCAST2UNI
  146. #ifdef CONFIG_DUALMAC_CONCURRENT
  147. int rtw_dmsp = 0;
  148. #endif // CONFIG_DUALMAC_CONCURRENT
  149. #ifdef CONFIG_80211D
  150. int rtw_80211d = 0;
  151. #endif
  152. #ifdef CONFIG_REGULATORY_CTRL
  153. int rtw_regulatory_id =2;
  154. #else
  155. int rtw_regulatory_id = 0xff;// Regulatory tab id, 0xff = follow efuse's setting
  156. #endif
  157. module_param(rtw_regulatory_id, int, 0644);
  158. #ifdef CONFIG_SPECIAL_SETTING_FOR_FUNAI_TV
  159. int rtw_force_ant = 2;//0 :normal, 1:Main ant, 2:Aux ant
  160. int rtw_force_igi =0;//0 :normal
  161. module_param(rtw_force_ant, int, 0644);
  162. module_param(rtw_force_igi, int, 0644);
  163. #endif
  164. char* ifname = "wlan%d";
  165. module_param(ifname, charp, 0644);
  166. MODULE_PARM_DESC(ifname, "The default name to allocate for first interface");
  167. char* if2name = "wlan%d";
  168. module_param(if2name, charp, 0644);
  169. MODULE_PARM_DESC(if2name, "The default name to allocate for second interface");
  170. char* rtw_initmac = 0; // temp mac address if users want to use instead of the mac address in Efuse
  171. #ifdef CONFIG_MULTI_VIR_IFACES
  172. int rtw_ext_iface_num = 1;//primary/secondary iface is excluded
  173. module_param(rtw_ext_iface_num, int, 0644);
  174. #endif //CONFIG_MULTI_VIR_IFACES
  175. module_param(rtw_initmac, charp, 0644);
  176. module_param(rtw_channel_plan, int, 0644);
  177. module_param(rtw_chip_version, int, 0644);
  178. module_param(rtw_rfintfs, int, 0644);
  179. module_param(rtw_lbkmode, int, 0644);
  180. module_param(rtw_network_mode, int, 0644);
  181. module_param(rtw_channel, int, 0644);
  182. module_param(rtw_mp_mode, int, 0644);
  183. module_param(rtw_wmm_enable, int, 0644);
  184. module_param(rtw_vrtl_carrier_sense, int, 0644);
  185. module_param(rtw_vcs_type, int, 0644);
  186. module_param(rtw_busy_thresh, int, 0644);
  187. #ifdef CONFIG_80211N_HT
  188. module_param(rtw_ht_enable, int, 0644);
  189. module_param(rtw_bw_mode, int, 0644);
  190. module_param(rtw_ampdu_enable, int, 0644);
  191. module_param(rtw_rx_stbc, int, 0644);
  192. module_param(rtw_ampdu_amsdu, int, 0644);
  193. #endif //CONFIG_80211N_HT
  194. #ifdef CONFIG_80211AC_VHT
  195. module_param(rtw_vht_enable, int, 0644);
  196. #endif //CONFIG_80211AC_VHT
  197. module_param(rtw_lowrate_two_xmit, int, 0644);
  198. module_param(rtw_rf_config, int, 0644);
  199. module_param(rtw_power_mgnt, int, 0644);
  200. module_param(rtw_smart_ps, int, 0644);
  201. module_param(rtw_low_power, int, 0644);
  202. module_param(rtw_wifi_spec, int, 0644);
  203. module_param(rtw_antdiv_cfg, int, 0644);
  204. module_param(rtw_antdiv_type, int, 0644);
  205. module_param(rtw_enusbss, int, 0644);
  206. module_param(rtw_hwpdn_mode, int, 0644);
  207. module_param(rtw_hwpwrp_detect, int, 0644);
  208. module_param(rtw_hw_wps_pbc, int, 0644);
  209. #ifdef CONFIG_TX_EARLY_MODE
  210. module_param(rtw_early_mode, int, 0644);
  211. #endif
  212. #ifdef CONFIG_ADAPTOR_INFO_CACHING_FILE
  213. char *rtw_adaptor_info_caching_file_path= "/data/misc/wifi/rtw_cache";
  214. module_param(rtw_adaptor_info_caching_file_path, charp, 0644);
  215. MODULE_PARM_DESC(rtw_adaptor_info_caching_file_path, "The path of adapter info cache file");
  216. #endif //CONFIG_ADAPTOR_INFO_CACHING_FILE
  217. #ifdef CONFIG_LAYER2_ROAMING
  218. uint rtw_max_roaming_times=2;
  219. module_param(rtw_max_roaming_times, uint, 0644);
  220. MODULE_PARM_DESC(rtw_max_roaming_times,"The max roaming times to try");
  221. #endif //CONFIG_LAYER2_ROAMING
  222. #ifdef CONFIG_IOL
  223. int rtw_fw_iol=1;// 0:Disable, 1:enable, 2:by usb speed
  224. module_param(rtw_fw_iol, int, 0644);
  225. MODULE_PARM_DESC(rtw_fw_iol,"FW IOL");
  226. #endif //CONFIG_IOL
  227. #ifdef CONFIG_FILE_FWIMG
  228. char *rtw_fw_file_path= "";
  229. module_param(rtw_fw_file_path, charp, 0644);
  230. MODULE_PARM_DESC(rtw_fw_file_path, "The path of fw image");
  231. #endif //CONFIG_FILE_FWIMG
  232. #ifdef CONFIG_TX_MCAST2UNI
  233. module_param(rtw_mc2u_disable, int, 0644);
  234. #endif // CONFIG_TX_MCAST2UNI
  235. #ifdef CONFIG_DUALMAC_CONCURRENT
  236. module_param(rtw_dmsp, int, 0644);
  237. #endif // CONFIG_DUALMAC_CONCURRENT
  238. #ifdef CONFIG_80211D
  239. module_param(rtw_80211d, int, 0644);
  240. MODULE_PARM_DESC(rtw_80211d, "Enable 802.11d mechanism");
  241. #endif
  242. #ifdef CONFIG_BT_COEXIST
  243. module_param(rtw_btcoex_enable, int, 0644);
  244. MODULE_PARM_DESC(rtw_btcoex_enable, "Enable BT co-existence mechanism");
  245. #endif
  246. uint rtw_notch_filter = RTW_NOTCH_FILTER;
  247. module_param(rtw_notch_filter, uint, 0644);
  248. MODULE_PARM_DESC(rtw_notch_filter, "0:Disable, 1:Enable, 2:Enable only for P2P");
  249. static uint loadparam(PADAPTER padapter, _nic_hdl pnetdev);
  250. int _netdev_open(struct net_device *pnetdev);
  251. int netdev_open (struct net_device *pnetdev);
  252. static int netdev_close (struct net_device *pnetdev);
  253. //#ifdef RTK_DMP_PLATFORM
  254. #ifdef CONFIG_PROC_DEBUG
  255. #define RTL8192C_PROC_NAME "rtl819xC"
  256. #define RTL8192D_PROC_NAME "rtl819xD"
  257. static char rtw_proc_name[IFNAMSIZ];
  258. static struct proc_dir_entry *rtw_proc = NULL;
  259. static int rtw_proc_cnt = 0;
  260. #define RTW_PROC_NAME DRV_NAME
  261. #if(LINUX_VERSION_CODE >= KERNEL_VERSION(3,10,0))
  262. typedef ssize_t (*read_proc_t) (struct file *, char __user *, ssize_t, loff_t *);
  263. static inline struct proc_dir_entry *create_proc_read_entry(const char *name,
  264. mode_t mode, struct proc_dir_entry *base,
  265. read_proc_t *read_proc, void * data)
  266. {
  267. struct file_operations fops = {
  268. read: read_proc
  269. };
  270. struct proc_dir_entry *res = proc_create(name, mode, base, &fops);
  271. //if (res) {
  272. // res->data = data;
  273. //}
  274. return res;
  275. }
  276. typedef ssize_t (*write_proc_t) (struct file *, const char __user *, ssize_t, loff_t *);
  277. static inline struct proc_dir_entry *create_proc_read_write_entry(const char *name,
  278. mode_t mode, struct proc_dir_entry *base,
  279. read_proc_t *read_proc, void * data, write_proc_t *write_proc)
  280. {
  281. struct file_operations fops = {
  282. read: read_proc,
  283. write: write_proc
  284. };
  285. struct proc_dir_entry *res = proc_create(name, mode, base, &fops);
  286. //if (res) {
  287. // res->data = data;
  288. //}
  289. return res;
  290. }
  291. #endif
  292. void rtw_proc_init_one(struct net_device *dev)
  293. {
  294. struct proc_dir_entry *dir_dev = NULL;
  295. struct proc_dir_entry *entry=NULL;
  296. _adapter *padapter = rtw_netdev_priv(dev);
  297. u8 rf_type;
  298. if(rtw_proc == NULL)
  299. {
  300. if(padapter->chip_type == RTL8188C_8192C)
  301. {
  302. _rtw_memcpy(rtw_proc_name, RTL8192C_PROC_NAME, sizeof(RTL8192C_PROC_NAME));
  303. }
  304. else if(padapter->chip_type == RTL8192D)
  305. {
  306. _rtw_memcpy(rtw_proc_name, RTL8192D_PROC_NAME, sizeof(RTL8192D_PROC_NAME));
  307. }
  308. else if(padapter->chip_type == RTL8723A)
  309. {
  310. _rtw_memcpy(rtw_proc_name, RTW_PROC_NAME, sizeof(RTW_PROC_NAME));
  311. }
  312. else if(padapter->chip_type == RTL8188E)
  313. {
  314. _rtw_memcpy(rtw_proc_name, RTW_PROC_NAME, sizeof(RTW_PROC_NAME));
  315. }
  316. else
  317. {
  318. _rtw_memcpy(rtw_proc_name, RTW_PROC_NAME, sizeof(RTW_PROC_NAME));
  319. }
  320. #if(LINUX_VERSION_CODE < KERNEL_VERSION(2,6,24))
  321. rtw_proc=create_proc_entry(rtw_proc_name, S_IFDIR, proc_net);
  322. #elif(LINUX_VERSION_CODE < KERNEL_VERSION(3,10,0))
  323. rtw_proc=create_proc_entry(rtw_proc_name, S_IFDIR, init_net.proc_net);
  324. #else
  325. rtw_proc=proc_create(rtw_proc_name, S_IFDIR, init_net.proc_net, NULL);
  326. #endif
  327. if (rtw_proc == NULL) {
  328. DBG_871X(KERN_ERR "Unable to create rtw_proc directory\n");
  329. return;
  330. }
  331. entry = create_proc_read_entry("ver_info", S_IFREG | S_IRUGO, rtw_proc, proc_get_drv_version, dev);
  332. if (!entry) {
  333. DBG_871X("Unable to create_proc_read_entry!\n");
  334. return;
  335. }
  336. }
  337. if(padapter->dir_dev == NULL)
  338. {
  339. #if(LINUX_VERSION_CODE < KERNEL_VERSION(3,10,0))
  340. padapter->dir_dev = create_proc_entry(dev->name,
  341. S_IFDIR | S_IRUGO | S_IXUGO,
  342. rtw_proc);
  343. #else
  344. padapter->dir_dev = proc_create(dev->name,
  345. S_IFDIR | S_IRUGO | S_IXUGO,
  346. rtw_proc, NULL);
  347. #endif
  348. dir_dev = padapter->dir_dev;
  349. if(dir_dev==NULL)
  350. {
  351. if(rtw_proc_cnt == 0)
  352. {
  353. if(rtw_proc){
  354. #if(LINUX_VERSION_CODE < KERNEL_VERSION(2,6,24))
  355. remove_proc_entry(rtw_proc_name, proc_net);
  356. #else
  357. remove_proc_entry(rtw_proc_name, init_net.proc_net);
  358. #endif
  359. rtw_proc = NULL;
  360. }
  361. }
  362. DBG_871X("Unable to create dir_dev directory\n");
  363. return;
  364. }
  365. }
  366. else
  367. {
  368. return;
  369. }
  370. rtw_proc_cnt++;
  371. entry = create_proc_read_write_entry("write_reg", S_IFREG | S_IRUGO,
  372. dir_dev, proc_get_write_reg, dev, proc_set_write_reg);
  373. if (!entry) {
  374. DBG_871X("Unable to create_proc_read_entry!\n");
  375. return;
  376. }
  377. entry = create_proc_read_write_entry("read_reg", S_IFREG | S_IRUGO,
  378. dir_dev, proc_get_read_reg, dev, proc_set_read_reg);
  379. if (!entry) {
  380. DBG_871X("Unable to create_proc_read_entry!\n");
  381. return;
  382. }
  383. entry = create_proc_read_entry("fwstate", S_IFREG | S_IRUGO,
  384. dir_dev, proc_get_fwstate, dev);
  385. if (!entry) {
  386. DBG_871X("Unable to create_proc_read_entry!\n");
  387. return;
  388. }
  389. entry = create_proc_read_entry("sec_info", S_IFREG | S_IRUGO,
  390. dir_dev, proc_get_sec_info, dev);
  391. if (!entry) {
  392. DBG_871X("Unable to create_proc_read_entry!\n");
  393. return;
  394. }
  395. entry = create_proc_read_entry("mlmext_state", S_IFREG | S_IRUGO,
  396. dir_dev, proc_get_mlmext_state, dev);
  397. if (!entry) {
  398. DBG_871X("Unable to create_proc_read_entry!\n");
  399. return;
  400. }
  401. entry = create_proc_read_entry("qos_option", S_IFREG | S_IRUGO,
  402. dir_dev, proc_get_qos_option, dev);
  403. if (!entry) {
  404. DBG_871X("Unable to create_proc_read_entry!\n");
  405. return;
  406. }
  407. entry = create_proc_read_entry("ht_option", S_IFREG | S_IRUGO,
  408. dir_dev, proc_get_ht_option, dev);
  409. if (!entry) {
  410. DBG_871X("Unable to create_proc_read_entry!\n");
  411. return;
  412. }
  413. entry = create_proc_read_entry("rf_info", S_IFREG | S_IRUGO,
  414. dir_dev, proc_get_rf_info, dev);
  415. if (!entry) {
  416. DBG_871X("Unable to create_proc_read_entry!\n");
  417. return;
  418. }
  419. entry = create_proc_read_entry("ap_info", S_IFREG | S_IRUGO,
  420. dir_dev, proc_get_ap_info, dev);
  421. if (!entry) {
  422. DBG_871X("Unable to create_proc_read_entry!\n");
  423. return;
  424. }
  425. entry = create_proc_read_entry("adapter_state", S_IFREG | S_IRUGO,
  426. dir_dev, proc_get_adapter_state, dev);
  427. if (!entry) {
  428. DBG_871X("Unable to create_proc_read_entry!\n");
  429. return;
  430. }
  431. entry = create_proc_read_entry("trx_info", S_IFREG | S_IRUGO,
  432. dir_dev, proc_get_trx_info, dev);
  433. if (!entry) {
  434. DBG_871X("Unable to create_proc_read_entry!\n");
  435. return;
  436. }
  437. entry = create_proc_read_entry("mac_reg_dump1", S_IFREG | S_IRUGO,
  438. dir_dev, proc_get_mac_reg_dump1, dev);
  439. if (!entry) {
  440. DBG_871X("Unable to create_proc_read_entry!\n");
  441. return;
  442. }
  443. entry = create_proc_read_entry("mac_reg_dump2", S_IFREG | S_IRUGO,
  444. dir_dev, proc_get_mac_reg_dump2, dev);
  445. if (!entry) {
  446. DBG_871X("Unable to create_proc_read_entry!\n");
  447. return;
  448. }
  449. entry = create_proc_read_entry("mac_reg_dump3", S_IFREG | S_IRUGO,
  450. dir_dev, proc_get_mac_reg_dump3, dev);
  451. if (!entry) {
  452. DBG_871X("Unable to create_proc_read_entry!\n");
  453. return;
  454. }
  455. entry = create_proc_read_entry("bb_reg_dump1", S_IFREG | S_IRUGO,
  456. dir_dev, proc_get_bb_reg_dump1, dev);
  457. if (!entry) {
  458. DBG_871X("Unable to create_proc_read_entry!\n");
  459. return;
  460. }
  461. entry = create_proc_read_entry("bb_reg_dump2", S_IFREG | S_IRUGO,
  462. dir_dev, proc_get_bb_reg_dump2, dev);
  463. if (!entry) {
  464. DBG_871X("Unable to create_proc_read_entry!\n");
  465. return;
  466. }
  467. entry = create_proc_read_entry("bb_reg_dump3", S_IFREG | S_IRUGO,
  468. dir_dev, proc_get_bb_reg_dump3, dev);
  469. if (!entry) {
  470. DBG_871X("Unable to create_proc_read_entry!\n");
  471. return;
  472. }
  473. entry = create_proc_read_entry("rf_reg_dump1", S_IFREG | S_IRUGO,
  474. dir_dev, proc_get_rf_reg_dump1, dev);
  475. if (!entry) {
  476. DBG_871X("Unable to create_proc_read_entry!\n");
  477. return;
  478. }
  479. entry = create_proc_read_entry("rf_reg_dump2", S_IFREG | S_IRUGO,
  480. dir_dev, proc_get_rf_reg_dump2, dev);
  481. if (!entry) {
  482. DBG_871X("Unable to create_proc_read_entry!\n");
  483. return;
  484. }
  485. rtw_hal_get_hwreg(padapter, HW_VAR_RF_TYPE, (u8 *)(&rf_type));
  486. if((RF_1T2R == rf_type) ||(RF_1T1R ==rf_type )) {
  487. entry = create_proc_read_entry("rf_reg_dump3", S_IFREG | S_IRUGO,
  488. dir_dev, proc_get_rf_reg_dump3, dev);
  489. if (!entry) {
  490. DBG_871X("Unable to create_proc_read_entry!\n");
  491. return;
  492. }
  493. entry = create_proc_read_entry("rf_reg_dump4", S_IFREG | S_IRUGO,
  494. dir_dev, proc_get_rf_reg_dump4, dev);
  495. if (!entry) {
  496. DBG_871X("Unable to create_proc_read_entry!\n");
  497. return;
  498. }
  499. }
  500. #ifdef CONFIG_AP_MODE
  501. entry = create_proc_read_entry("all_sta_info", S_IFREG | S_IRUGO,
  502. dir_dev, proc_get_all_sta_info, dev);
  503. if (!entry) {
  504. DBG_871X("Unable to create_proc_read_entry!\n");
  505. return;
  506. }
  507. #endif
  508. #ifdef DBG_MEMORY_LEAK
  509. entry = create_proc_read_entry("_malloc_cnt", S_IFREG | S_IRUGO,
  510. dir_dev, proc_get_malloc_cnt, dev);
  511. if (!entry) {
  512. DBG_871X("Unable to create_proc_read_entry!\n");
  513. return;
  514. }
  515. #endif
  516. #ifdef CONFIG_FIND_BEST_CHANNEL
  517. entry = create_proc_read_entry("best_channel", S_IFREG | S_IRUGO,
  518. dir_dev, proc_get_best_channel, dev);
  519. if (!entry) {
  520. DBG_871X("Unable to create_proc_read_entry!\n");
  521. return;
  522. }
  523. #endif
  524. entry = create_proc_read_write_entry("rx_signal", S_IFREG | S_IRUGO,
  525. dir_dev, proc_get_rx_signal, dev, proc_set_rx_signal);
  526. if (!entry) {
  527. DBG_871X("Unable to create_proc_read_entry!\n");
  528. return;
  529. }
  530. #ifdef CONFIG_80211N_HT
  531. entry = create_proc_read_write_entry("ht_enable", S_IFREG | S_IRUGO,
  532. dir_dev, proc_get_ht_enable, dev, proc_set_ht_enable);
  533. if (!entry) {
  534. DBG_871X("Unable to create_proc_read_entry!\n");
  535. return;
  536. }
  537. entry = create_proc_read_write_entry("bw_mode", S_IFREG | S_IRUGO,
  538. dir_dev, proc_get_bw_mode, dev, proc_set_bw_mode);
  539. if (!entry) {
  540. DBG_871X("Unable to create_proc_read_entry!\n");
  541. return;
  542. }
  543. entry = create_proc_read_write_entry("ampdu_enable", S_IFREG | S_IRUGO,
  544. dir_dev, proc_get_ampdu_enable, dev, proc_set_ampdu_enable);
  545. if (!entry) {
  546. DBG_871X("Unable to create_proc_read_entry!\n");
  547. return;
  548. }
  549. entry = create_proc_read_write_entry("rx_stbc", S_IFREG | S_IRUGO,
  550. dir_dev, proc_get_rx_stbc, dev, proc_set_rx_stbc);
  551. if (!entry) {
  552. DBG_871X("Unable to create_proc_read_entry!\n");
  553. return;
  554. }
  555. #endif //CONFIG_80211N_HT
  556. entry = create_proc_read_entry("path_rssi", S_IFREG | S_IRUGO,
  557. dir_dev, proc_get_two_path_rssi, dev);
  558. entry = create_proc_read_write_entry("rssi_disp", S_IFREG | S_IRUGO,
  559. dir_dev, proc_get_rssi_disp, dev, proc_set_rssi_disp);
  560. if (!entry) {
  561. DBG_871X("Unable to create_proc_read_entry!\n");
  562. return;
  563. }
  564. #ifdef CONFIG_BT_COEXIST
  565. entry = create_proc_read_write_entry("btcoex_dbg", S_IFREG | S_IRUGO,
  566. dir_dev, proc_get_btcoex_dbg, dev, proc_set_btcoex_dbg);
  567. if (!entry) {
  568. DBG_871X("Unable to create_proc_read_entry!\n");
  569. return;
  570. }
  571. #endif /*CONFIG_BT_COEXIST*/
  572. #if defined(DBG_CONFIG_ERROR_DETECT)
  573. entry = create_proc_read_write_entry("sreset", S_IFREG | S_IRUGO,
  574. dir_dev, proc_get_sreset, dev, proc_set_sreset);
  575. if (!entry) {
  576. DBG_871X("Unable to create_proc_read_entry!\n");
  577. return;
  578. }
  579. #endif /* DBG_CONFIG_ERROR_DETECT */
  580. }
  581. void rtw_proc_remove_one(struct net_device *dev)
  582. {
  583. struct proc_dir_entry *dir_dev = NULL;
  584. _adapter *padapter = rtw_netdev_priv(dev);
  585. u8 rf_type;
  586. dir_dev = padapter->dir_dev;
  587. padapter->dir_dev = NULL;
  588. if (dir_dev) {
  589. remove_proc_entry("write_reg", dir_dev);
  590. remove_proc_entry("read_reg", dir_dev);
  591. remove_proc_entry("fwstate", dir_dev);
  592. remove_proc_entry("sec_info", dir_dev);
  593. remove_proc_entry("mlmext_state", dir_dev);
  594. remove_proc_entry("qos_option", dir_dev);
  595. remove_proc_entry("ht_option", dir_dev);
  596. remove_proc_entry("rf_info", dir_dev);
  597. remove_proc_entry("ap_info", dir_dev);
  598. remove_proc_entry("adapter_state", dir_dev);
  599. remove_proc_entry("trx_info", dir_dev);
  600. remove_proc_entry("mac_reg_dump1", dir_dev);
  601. remove_proc_entry("mac_reg_dump2", dir_dev);
  602. remove_proc_entry("mac_reg_dump3", dir_dev);
  603. remove_proc_entry("bb_reg_dump1", dir_dev);
  604. remove_proc_entry("bb_reg_dump2", dir_dev);
  605. remove_proc_entry("bb_reg_dump3", dir_dev);
  606. remove_proc_entry("rf_reg_dump1", dir_dev);
  607. remove_proc_entry("rf_reg_dump2", dir_dev);
  608. rtw_hal_get_hwreg(padapter, HW_VAR_RF_TYPE, (u8 *)(&rf_type));
  609. if((RF_1T2R == rf_type) ||(RF_1T1R ==rf_type )) {
  610. remove_proc_entry("rf_reg_dump3", dir_dev);
  611. remove_proc_entry("rf_reg_dump4", dir_dev);
  612. }
  613. #ifdef CONFIG_AP_MODE
  614. remove_proc_entry("all_sta_info", dir_dev);
  615. #endif
  616. #ifdef DBG_MEMORY_LEAK
  617. remove_proc_entry("_malloc_cnt", dir_dev);
  618. #endif
  619. #ifdef CONFIG_FIND_BEST_CHANNEL
  620. remove_proc_entry("best_channel", dir_dev);
  621. #endif
  622. remove_proc_entry("rx_signal", dir_dev);
  623. #ifdef CONFIG_80211N_HT
  624. remove_proc_entry("bw_mode", dir_dev);
  625. remove_proc_entry("ht_enable", dir_dev);
  626. remove_proc_entry("ampdu_enable", dir_dev);
  627. remove_proc_entry("rx_stbc", dir_dev);
  628. #endif //CONFIG_80211N_HT
  629. remove_proc_entry("path_rssi", dir_dev);
  630. remove_proc_entry("rssi_disp", dir_dev);
  631. #ifdef CONFIG_BT_COEXIST
  632. remove_proc_entry("btcoex_dbg", dir_dev);
  633. #endif //CONFIG_BT_COEXIST
  634. #if defined(DBG_CONFIG_ERROR_DETECT)
  635. remove_proc_entry("sreset", dir_dev);
  636. #endif /* DBG_CONFIG_ERROR_DETECT */
  637. remove_proc_entry(dev->name, rtw_proc);
  638. dir_dev = NULL;
  639. }
  640. else
  641. {
  642. return;
  643. }
  644. rtw_proc_cnt--;
  645. if(rtw_proc_cnt == 0)
  646. {
  647. if(rtw_proc){
  648. remove_proc_entry("ver_info", rtw_proc);
  649. #if(LINUX_VERSION_CODE < KERNEL_VERSION(2,6,24))
  650. remove_proc_entry(rtw_proc_name, proc_net);
  651. #else
  652. remove_proc_entry(rtw_proc_name, init_net.proc_net);
  653. #endif
  654. rtw_proc = NULL;
  655. }
  656. }
  657. }
  658. #endif
  659. uint loadparam( _adapter *padapter, _nic_hdl pnetdev)
  660. {
  661. uint status = _SUCCESS;
  662. struct registry_priv *registry_par = &padapter->registrypriv;
  663. _func_enter_;
  664. registry_par->chip_version = (u8)rtw_chip_version;
  665. registry_par->rfintfs = (u8)rtw_rfintfs;
  666. registry_par->lbkmode = (u8)rtw_lbkmode;
  667. //registry_par->hci = (u8)hci;
  668. registry_par->network_mode = (u8)rtw_network_mode;
  669. _rtw_memcpy(registry_par->ssid.Ssid, "ANY", 3);
  670. registry_par->ssid.SsidLength = 3;
  671. registry_par->channel = (u8)rtw_channel;
  672. registry_par->wireless_mode = (u8)rtw_wireless_mode;
  673. if (IsSupported24G(registry_par->wireless_mode) && (!IsSupported5G(registry_par->wireless_mode))
  674. && (registry_par->channel > 14)) {
  675. registry_par->channel = 1;
  676. }
  677. else if (IsSupported5G(registry_par->wireless_mode) && (!IsSupported24G(registry_par->wireless_mode))
  678. && (registry_par->channel <= 14)) {
  679. registry_par->channel = 36;
  680. }
  681. registry_par->vrtl_carrier_sense = (u8)rtw_vrtl_carrier_sense ;
  682. registry_par->vcs_type = (u8)rtw_vcs_type;
  683. registry_par->rts_thresh=(u16)rtw_rts_thresh;
  684. registry_par->frag_thresh=(u16)rtw_frag_thresh;
  685. registry_par->preamble = (u8)rtw_preamble;
  686. registry_par->scan_mode = (u8)rtw_scan_mode;
  687. registry_par->adhoc_tx_pwr = (u8)rtw_adhoc_tx_pwr;
  688. registry_par->soft_ap= (u8)rtw_soft_ap;
  689. registry_par->smart_ps = (u8)rtw_smart_ps;
  690. registry_par->power_mgnt = (u8)rtw_power_mgnt;
  691. registry_par->ips_mode = (u8)rtw_ips_mode;
  692. registry_par->radio_enable = (u8)rtw_radio_enable;
  693. registry_par->long_retry_lmt = (u8)rtw_long_retry_lmt;
  694. registry_par->short_retry_lmt = (u8)rtw_short_retry_lmt;
  695. registry_par->busy_thresh = (u16)rtw_busy_thresh;
  696. //registry_par->qos_enable = (u8)rtw_qos_enable;
  697. registry_par->ack_policy = (u8)rtw_ack_policy;
  698. registry_par->mp_mode = (u8)rtw_mp_mode;
  699. registry_par->software_encrypt = (u8)rtw_software_encrypt;
  700. registry_par->software_decrypt = (u8)rtw_software_decrypt;
  701. registry_par->acm_method = (u8)rtw_acm_method;
  702. //UAPSD
  703. registry_par->wmm_enable = (u8)rtw_wmm_enable;
  704. registry_par->uapsd_enable = (u8)rtw_uapsd_enable;
  705. registry_par->uapsd_max_sp = (u8)rtw_uapsd_max_sp;
  706. registry_par->uapsd_acbk_en = (u8)rtw_uapsd_acbk_en;
  707. registry_par->uapsd_acbe_en = (u8)rtw_uapsd_acbe_en;
  708. registry_par->uapsd_acvi_en = (u8)rtw_uapsd_acvi_en;
  709. registry_par->uapsd_acvo_en = (u8)rtw_uapsd_acvo_en;
  710. #ifdef CONFIG_80211N_HT
  711. registry_par->ht_enable = (u8)rtw_ht_enable;
  712. registry_par->bw_mode = (u8)rtw_bw_mode;
  713. registry_par->ampdu_enable = (u8)rtw_ampdu_enable;
  714. registry_par->rx_stbc = (u8)rtw_rx_stbc;
  715. registry_par->ampdu_amsdu = (u8)rtw_ampdu_amsdu;
  716. registry_par->short_gi = (u8)rtw_short_gi;
  717. #endif
  718. #ifdef CONFIG_80211AC_VHT
  719. registry_par->vht_enable = (u8)rtw_vht_enable;
  720. registry_par->ampdu_factor = (u8)rtw_ampdu_factor;
  721. registry_par->vht_rate_sel = (u8)rtw_vht_rate_sel;
  722. registry_par->ldpc_cap = (u8)rtw_ldpc_cap;
  723. registry_par->stbc_cap = (u8)rtw_stbc_cap;
  724. registry_par->beamform_cap = (u8)rtw_beamform_cap;
  725. #endif
  726. #ifdef CONFIG_TX_EARLY_MODE
  727. registry_par->early_mode = (u8)rtw_early_mode;
  728. #endif
  729. registry_par->lowrate_two_xmit = (u8)rtw_lowrate_two_xmit;
  730. registry_par->rf_config = (u8)rtw_rf_config;
  731. registry_par->low_power = (u8)rtw_low_power;
  732. registry_par->wifi_spec = (u8)rtw_wifi_spec;
  733. registry_par->channel_plan = (u8)rtw_channel_plan;
  734. #ifdef CONFIG_BT_COEXIST
  735. registry_par->btcoex = (u8)rtw_btcoex_enable;
  736. registry_par->bt_iso = (u8)rtw_bt_iso;
  737. registry_par->bt_sco = (u8)rtw_bt_sco;
  738. registry_par->bt_ampdu = (u8)rtw_bt_ampdu;
  739. #endif
  740. registry_par->bAcceptAddbaReq = (u8)rtw_AcceptAddbaReq;
  741. registry_par->antdiv_cfg = (u8)rtw_antdiv_cfg;
  742. registry_par->antdiv_type = (u8)rtw_antdiv_type;
  743. #ifdef CONFIG_AUTOSUSPEND
  744. registry_par->usbss_enable = (u8)rtw_enusbss;//0:disable,1:enable
  745. #endif
  746. #ifdef SUPPORT_HW_RFOFF_DETECTED
  747. registry_par->hwpdn_mode = (u8)rtw_hwpdn_mode;//0:disable,1:enable,2:by EFUSE config
  748. registry_par->hwpwrp_detect = (u8)rtw_hwpwrp_detect;//0:disable,1:enable
  749. #endif
  750. registry_par->hw_wps_pbc = (u8)rtw_hw_wps_pbc;
  751. #ifdef CONFIG_ADAPTOR_INFO_CACHING_FILE
  752. snprintf(registry_par->adaptor_info_caching_file_path, PATH_LENGTH_MAX, "%s", rtw_adaptor_info_caching_file_path);
  753. registry_par->adaptor_info_caching_file_path[PATH_LENGTH_MAX-1]=0;
  754. #endif
  755. #ifdef CONFIG_LAYER2_ROAMING
  756. registry_par->max_roaming_times = (u8)rtw_max_roaming_times;
  757. #ifdef CONFIG_INTEL_WIDI
  758. registry_par->max_roaming_times = (u8)rtw_max_roaming_times + 2;
  759. #endif // CONFIG_INTEL_WIDI
  760. #endif
  761. #ifdef CONFIG_IOL
  762. registry_par->fw_iol = rtw_fw_iol;
  763. #endif
  764. #ifdef CONFIG_DUALMAC_CONCURRENT
  765. registry_par->dmsp= (u8)rtw_dmsp;
  766. #endif
  767. #ifdef CONFIG_80211D
  768. registry_par->enable80211d = (u8)rtw_80211d;
  769. #endif
  770. snprintf(registry_par->ifname, 16, "%s", ifname);
  771. snprintf(registry_par->if2name, 16, "%s", if2name);
  772. registry_par->notch_filter = (u8)rtw_notch_filter;
  773. #ifdef CONFIG_SPECIAL_SETTING_FOR_FUNAI_TV
  774. registry_par->force_ant = (u8)rtw_force_ant;
  775. registry_par->force_igi = (u8)rtw_force_igi;
  776. #endif
  777. registry_par->regulatory_tid = (u8)rtw_regulatory_id;
  778. #ifdef CONFIG_MULTI_VIR_IFACES
  779. registry_par->ext_iface_num = (u8)rtw_ext_iface_num;
  780. #endif //CONFIG_MULTI_VIR_IFACES
  781. _func_exit_;
  782. return status;
  783. }
  784. static int rtw_net_set_mac_address(struct net_device *pnetdev, void *p)
  785. {
  786. _adapter *padapter = (_adapter *)rtw_netdev_priv(pnetdev);
  787. struct sockaddr *addr = p;
  788. if(padapter->bup == _FALSE)
  789. {
  790. //DBG_871X("r8711_net_set_mac_address(), MAC=%x:%x:%x:%x:%x:%x\n", addr->sa_data[0], addr->sa_data[1], addr->sa_data[2], addr->sa_data[3],
  791. //addr->sa_data[4], addr->sa_data[5]);
  792. _rtw_memcpy(padapter->eeprompriv.mac_addr, addr->sa_data, ETH_ALEN);
  793. //_rtw_memcpy(pnetdev->dev_addr, addr->sa_data, ETH_ALEN);
  794. //padapter->bset_hwaddr = _TRUE;
  795. }
  796. return 0;
  797. }
  798. static struct net_device_stats *rtw_net_get_stats(struct net_device *pnetdev)
  799. {
  800. _adapter *padapter = (_adapter *)rtw_netdev_priv(pnetdev);
  801. struct xmit_priv *pxmitpriv = &(padapter->xmitpriv);
  802. struct recv_priv *precvpriv = &(padapter->recvpriv);
  803. padapter->stats.tx_packets = pxmitpriv->tx_pkts;//pxmitpriv->tx_pkts++;
  804. padapter->stats.rx_packets = precvpriv->rx_pkts;//precvpriv->rx_pkts++;
  805. padapter->stats.tx_dropped = pxmitpriv->tx_drop;
  806. padapter->stats.rx_dropped = precvpriv->rx_drop;
  807. padapter->stats.tx_bytes = pxmitpriv->tx_bytes;
  808. padapter->stats.rx_bytes = precvpriv->rx_bytes;
  809. return &padapter->stats;
  810. }
  811. #if (LINUX_VERSION_CODE>=KERNEL_VERSION(2,6,35))
  812. /*
  813. * AC to queue mapping
  814. *
  815. * AC_VO -> queue 0
  816. * AC_VI -> queue 1
  817. * AC_BE -> queue 2
  818. * AC_BK -> queue 3
  819. */
  820. static const u16 rtw_1d_to_queue[8] = { 2, 3, 3, 2, 1, 1, 0, 0 };
  821. /* Given a data frame determine the 802.1p/1d tag to use. */
  822. unsigned int rtw_classify8021d(struct sk_buff *skb)
  823. {
  824. unsigned int dscp;
  825. /* skb->priority values from 256->263 are magic values to
  826. * directly indicate a specific 802.1d priority. This is used
  827. * to allow 802.1d priority to be passed directly in from VLAN
  828. * tags, etc.
  829. */
  830. if (skb->priority >= 256 && skb->priority <= 263)
  831. return skb->priority - 256;
  832. switch (skb->protocol) {
  833. case htons(ETH_P_IP):
  834. dscp = ip_hdr(skb)->tos & 0xfc;
  835. break;
  836. default:
  837. return 0;
  838. }
  839. return dscp >> 5;
  840. }
  841. static u16 rtw_select_queue(struct net_device *dev, struct sk_buff *skb)
  842. {
  843. _adapter *padapter = rtw_netdev_priv(dev);
  844. struct mlme_priv *pmlmepriv = &padapter->mlmepriv;
  845. skb->priority = rtw_classify8021d(skb);
  846. if(pmlmepriv->acm_mask != 0)
  847. {
  848. skb->priority = qos_acm(pmlmepriv->acm_mask, skb->priority);
  849. }
  850. return rtw_1d_to_queue[skb->priority];
  851. }
  852. u16 rtw_recv_select_queue(struct sk_buff *skb)
  853. {
  854. struct iphdr *piphdr;
  855. unsigned int dscp;
  856. u16 eth_type;
  857. u32 priority;
  858. u8 *pdata = skb->data;
  859. _rtw_memcpy(&eth_type, pdata+(ETH_ALEN<<1), 2);
  860. switch (eth_type) {
  861. case htons(ETH_P_IP):
  862. piphdr = (struct iphdr *)(pdata+ETH_HLEN);
  863. dscp = piphdr->tos & 0xfc;
  864. priority = dscp >> 5;
  865. break;
  866. default:
  867. priority = 0;
  868. }
  869. return rtw_1d_to_queue[priority];
  870. }
  871. #endif
  872. #if (LINUX_VERSION_CODE>=KERNEL_VERSION(2,6,29))
  873. static const struct net_device_ops rtw_netdev_ops = {
  874. .ndo_open = netdev_open,
  875. .ndo_stop = netdev_close,
  876. .ndo_start_xmit = rtw_xmit_entry,
  877. #if (LINUX_VERSION_CODE>=KERNEL_VERSION(2,6,35))
  878. .ndo_select_queue = rtw_select_queue,
  879. #endif
  880. .ndo_set_mac_address = rtw_net_set_mac_address,
  881. .ndo_get_stats = rtw_net_get_stats,
  882. .ndo_do_ioctl = rtw_ioctl,
  883. };
  884. #endif
  885. int rtw_init_netdev_name(struct net_device *pnetdev, const char *ifname)
  886. {
  887. _adapter *padapter = rtw_netdev_priv(pnetdev);
  888. #ifdef CONFIG_EASY_REPLACEMENT
  889. struct net_device *TargetNetdev = NULL;
  890. _adapter *TargetAdapter = NULL;
  891. struct net *devnet = NULL;
  892. if(padapter->bDongle == 1)
  893. {
  894. #if (LINUX_VERSION_CODE < KERNEL_VERSION(2,6,24))
  895. TargetNetdev = dev_get_by_name("wlan0");
  896. #else
  897. #if (LINUX_VERSION_CODE < KERNEL_VERSION(2,6,26))
  898. devnet = pnetdev->nd_net;
  899. #else
  900. devnet = dev_net(pnetdev);
  901. #endif
  902. TargetNetdev = dev_get_by_name(devnet, "wlan0");
  903. #endif
  904. if(TargetNetdev) {
  905. DBG_871X("Force onboard module driver disappear !!!\n");
  906. TargetAdapter = rtw_netdev_priv(TargetNetdev);
  907. TargetAdapter->DriverState = DRIVER_DISAPPEAR;
  908. padapter->pid[0] = TargetAdapter->pid[0];
  909. padapter->pid[1] = TargetAdapter->pid[1];
  910. padapter->pid[2] = TargetAdapter->pid[2];
  911. dev_put(TargetNetdev);
  912. unregister_netdev(TargetNetdev);
  913. if(TargetAdapter->chip_type == padapter->chip_type)
  914. rtw_proc_remove_one(TargetNetdev);
  915. padapter->DriverState = DRIVER_REPLACE_DONGLE;
  916. }
  917. }
  918. #endif //CONFIG_EASY_REPLACEMENT
  919. if(dev_alloc_name(pnetdev, ifname) < 0)
  920. {
  921. RT_TRACE(_module_os_intfs_c_,_drv_err_,("dev_alloc_name, fail! \n"));
  922. }
  923. netif_carrier_off(pnetdev);
  924. //rtw_netif_stop_queue(pnetdev);
  925. return 0;
  926. }
  927. struct net_device *rtw_init_netdev(_adapter *old_padapter)
  928. {
  929. _adapter *padapter;
  930. struct net_device *pnetdev;
  931. RT_TRACE(_module_os_intfs_c_,_drv_info_,("+init_net_dev\n"));
  932. if(old_padapter != NULL)
  933. pnetdev = rtw_alloc_etherdev_with_old_priv(sizeof(_adapter), (void *)old_padapter);
  934. else
  935. pnetdev = rtw_alloc_etherdev(sizeof(_adapter));
  936. if (!pnetdev)
  937. return NULL;
  938. padapter = rtw_netdev_priv(pnetdev);
  939. padapter->pnetdev = pnetdev;
  940. #if LINUX_VERSION_CODE < KERNEL_VERSION(2,6,24)
  941. SET_MODULE_OWNER(pnetdev);
  942. #endif
  943. //pnetdev->init = NULL;
  944. #if (LINUX_VERSION_CODE>=KERNEL_VERSION(2,6,29))
  945. DBG_871X("register rtw_netdev_ops to netdev_ops\n");
  946. pnetdev->netdev_ops = &rtw_netdev_ops;
  947. #else
  948. pnetdev->open = netdev_open;
  949. pnetdev->stop = netdev_close;
  950. pnetdev->hard_start_xmit = rtw_xmit_entry;
  951. pnetdev->set_mac_address = rtw_net_set_mac_address;
  952. pnetdev->get_stats = rtw_net_get_stats;
  953. pnetdev->do_ioctl = rtw_ioctl;
  954. #endif
  955. #ifdef CONFIG_TCP_CSUM_OFFLOAD_TX
  956. pnetdev->features |= NETIF_F_IP_CSUM;
  957. #endif
  958. //pnetdev->tx_timeout = NULL;
  959. pnetdev->watchdog_timeo = HZ*3; /* 3 second timeout */
  960. #ifdef CONFIG_WIRELESS_EXT
  961. pnetdev->wireless_handlers = (struct iw_handler_def *)&rtw_handlers_def;
  962. #endif
  963. #ifdef WIRELESS_SPY
  964. //priv->wireless_data.spy_data = &priv->spy_data;
  965. //pnetdev->wireless_data = &priv->wireless_data;
  966. #endif
  967. //step 2.
  968. loadparam(padapter, pnetdev);
  969. return pnetdev;
  970. }
  971. u32 rtw_start_drv_threads(_adapter *padapter)
  972. {
  973. u32 _status = _SUCCESS;
  974. RT_TRACE(_module_os_intfs_c_,_drv_info_,("+rtw_start_drv_threads\n"));
  975. #ifdef CONFIG_XMIT_THREAD_MODE
  976. #if defined(CONFIG_SDIO_HCI) && defined(CONFIG_CONCURRENT_MODE)
  977. if(padapter->adapter_type == PRIMARY_ADAPTER){
  978. #endif
  979. padapter->xmitThread = kthread_run(rtw_xmit_thread, padapter, "RTW_XMIT_THREAD");
  980. if(IS_ERR(padapter->xmitThread))
  981. _status = _FAIL;
  982. #if defined(CONFIG_SDIO_HCI) && defined(CONFIG_CONCURRENT_MODE)
  983. }
  984. #endif // CONFIG_SDIO_HCI+CONFIG_CONCURRENT_MODE
  985. #endif
  986. #ifdef CONFIG_RECV_THREAD_MODE
  987. padapter->recvThread = kthread_run(rtw_recv_thread, padapter, "RTW_RECV_THREAD");
  988. if(IS_ERR(padapter->recvThread))
  989. _status = _FAIL;
  990. #endif
  991. #ifdef CONFIG_CONCURRENT_MODE
  992. if(padapter->isprimary == _TRUE)
  993. #endif //CONFIG_CONCURRENT_MODE
  994. {
  995. padapter->cmdThread = kthread_run(rtw_cmd_thread, padapter, "RTW_CMD_THREAD");
  996. if(IS_ERR(padapter->cmdThread))
  997. _status = _FAIL;
  998. else
  999. _rtw_down_sema(&padapter->cmdpriv.terminate_cmdthread_sema); //wait for cmd_thread to run
  1000. }
  1001. #ifdef CONFIG_EVENT_THREAD_MODE
  1002. padapter->evtThread = kthread_run(event_thread, padapter, "RTW_EVENT_THREAD");
  1003. if(IS_ERR(padapter->evtThread))
  1004. _status = _FAIL;
  1005. #endif
  1006. rtw_hal_start_thread(padapter);
  1007. return _status;
  1008. }
  1009. void rtw_stop_drv_threads (_adapter *padapter)
  1010. {
  1011. RT_TRACE(_module_os_intfs_c_,_drv_info_,("+rtw_stop_drv_threads\n"));
  1012. #ifdef CONFIG_CONCURRENT_MODE
  1013. if(padapter->isprimary == _TRUE)
  1014. #endif //CONFIG_CONCURRENT_MODE
  1015. {
  1016. //Below is to termindate rtw_cmd_thread & event_thread...
  1017. _rtw_up_sema(&padapter->cmdpriv.cmd_queue_sema);
  1018. //_rtw_up_sema(&padapter->cmdpriv.cmd_done_sema);
  1019. if(padapter->cmdThread){
  1020. _rtw_down_sema(&padapter->cmdpriv.terminate_cmdthread_sema);
  1021. }
  1022. }
  1023. #ifdef CONFIG_EVENT_THREAD_MODE
  1024. _rtw_up_sema(&padapter->evtpriv.evt_notify);
  1025. if(padapter->evtThread){
  1026. _rtw_down_sema(&padapter->evtpriv.terminate_evtthread_sema);
  1027. }
  1028. #endif
  1029. #ifdef CONFIG_XMIT_THREAD_MODE
  1030. // Below is to termindate tx_thread...
  1031. #if defined(CONFIG_SDIO_HCI) && defined(CONFIG_CONCURRENT_MODE)
  1032. // Only wake-up primary adapter
  1033. if(padapter->adapter_type == PRIMARY_ADAPTER)
  1034. #endif //SDIO_HCI + CONCURRENT
  1035. {
  1036. _rtw_up_sema(&padapter->xmitpriv.xmit_sema);
  1037. _rtw_down_sema(&padapter->xmitpriv.terminate_xmitthread_sema);
  1038. }
  1039. RT_TRACE(_module_os_intfs_c_,_drv_info_,("\n drv_halt: rtw_xmit_thread can be terminated ! \n"));
  1040. #endif
  1041. #ifdef CONFIG_RECV_THREAD_MODE
  1042. // Below is to termindate rx_thread...
  1043. _rtw_up_sema(&padapter->recvpriv.recv_sema);
  1044. _rtw_down_sema(&padapter->recvpriv.terminate_recvthread_sema);
  1045. RT_TRACE(_module_os_intfs_c_,_drv_info_,("\n drv_halt:recv_thread can be terminated! \n"));
  1046. #endif
  1047. rtw_hal_stop_thread(padapter);
  1048. }
  1049. u8 rtw_init_default_value(_adapter *padapter);
  1050. u8 rtw_init_default_value(_adapter *padapter)
  1051. {
  1052. u8 ret = _SUCCESS;
  1053. struct registry_priv* pregistrypriv = &padapter->registrypriv;
  1054. struct xmit_priv *pxmitpriv = &padapter->xmitpriv;
  1055. struct mlme_priv *pmlmepriv= &padapter->mlmepriv;
  1056. struct security_priv *psecuritypriv = &padapter->securitypriv;
  1057. //xmit_priv
  1058. pxmitpriv->vcs_setting = pregistrypriv->vrtl_carrier_sense;
  1059. pxmitpriv->vcs = pregistrypriv->vcs_type;
  1060. pxmitpriv->vcs_type = pregistrypriv->vcs_type;
  1061. //pxmitpriv->rts_thresh = pregistrypriv->rts_thresh;
  1062. pxmitpriv->frag_len = pregistrypriv->frag_thresh;
  1063. //recv_priv
  1064. //mlme_priv
  1065. pmlmepriv->scan_interval = SCAN_INTERVAL;// 30*2 sec = 60sec
  1066. pmlmepriv->scan_mode = SCAN_ACTIVE;
  1067. //qos_priv
  1068. //pmlmepriv->qospriv.qos_option = pregistrypriv->wmm_enable;
  1069. //ht_priv
  1070. #ifdef CONFIG_80211N_HT
  1071. pmlmepriv->htpriv.ampdu_enable = _FALSE;//set to disabled
  1072. #endif
  1073. //security_priv
  1074. //rtw_get_encrypt_decrypt_from_registrypriv(padapter);
  1075. psecuritypriv->binstallGrpkey = _FAIL;
  1076. psecuritypriv->sw_encrypt=pregistrypriv->software_encrypt;
  1077. psecuritypriv->sw_decrypt=pregistrypriv->software_decrypt;
  1078. psecuritypriv->dot11AuthAlgrthm = dot11AuthAlgrthm_Open; //open system
  1079. psecuritypriv->dot11PrivacyAlgrthm = _NO_PRIVACY_;
  1080. psecuritypriv->dot11PrivacyKeyIndex = 0;
  1081. psecuritypriv->dot118021XGrpPrivacy = _NO_PRIVACY_;
  1082. psecuritypriv->dot118021XGrpKeyid = 1;
  1083. psecuritypriv->ndisauthtype = Ndis802_11AuthModeOpen;
  1084. psecuritypriv->ndisencryptstatus = Ndis802_11WEPDisabled;
  1085. //pwrctrl_priv
  1086. //registry_priv
  1087. rtw_init_registrypriv_dev_network(padapter);
  1088. rtw_update_registrypriv_dev_network(padapter);
  1089. //hal_priv
  1090. rtw_hal_def_value_init(padapter);
  1091. //misc.
  1092. padapter->bReadPortCancel = _FALSE;
  1093. padapter->bWritePortCancel = _FALSE;
  1094. padapter->bLinkInfoDump = 0;
  1095. padapter->bNotifyChannelChange = 0;
  1096. #ifdef CONFIG_P2P
  1097. padapter->bShowGetP2PState = 1;
  1098. #endif
  1099. return ret;
  1100. }
  1101. u8 rtw_reset_drv_sw(_adapter *padapter)
  1102. {
  1103. u8 ret8=_SUCCESS;
  1104. struct mlme_priv *pmlmepriv= &padapter->mlmepriv;
  1105. struct pwrctrl_priv *pwrctrlpriv = &padapter->pwrctrlpriv;
  1106. //hal_priv
  1107. rtw_hal_def_value_init(padapter);
  1108. padapter->bReadPortCancel = _FALSE;
  1109. padapter->bWritePortCancel = _FALSE;
  1110. padapter->bLinkInfoDump = 0;
  1111. pmlmepriv->scan_interval = SCAN_INTERVAL;// 30*2 sec = 60sec
  1112. padapter->xmitpriv.tx_pkts = 0;
  1113. padapter->recvpriv.rx_pkts = 0;
  1114. pmlmepriv->LinkDetectInfo.bBusyTraffic = _FALSE;
  1115. _clr_fwstate_(pmlmepriv, _FW_UNDER_SURVEY |_FW_UNDER_LINKING);
  1116. #ifdef CONFIG_AUTOSUSPEND
  1117. #if (LINUX_VERSION_CODE>=KERNEL_VERSION(2,6,22) && LINUX_VERSION_CODE<=KERNEL_VERSION(2,6,34))
  1118. adapter_to_dvobj(padapter)->pusbdev->autosuspend_disabled = 1;//autosuspend disabled by the user
  1119. #endif
  1120. #endif
  1121. #ifdef DBG_CONFIG_ERROR_DETECT
  1122. rtw_hal_sreset_reset_value(padapter);
  1123. #endif
  1124. pwrctrlpriv->pwr_state_check_cnts = 0;
  1125. //mlmeextpriv
  1126. padapter->mlmeextpriv.sitesurvey_res.state= SCAN_DISABLE;
  1127. #ifdef CONFIG_NEW_SIGNAL_STAT_PROCESS
  1128. rtw_set_signal_stat_timer(&padapter->recvpriv);
  1129. #endif
  1130. return ret8;
  1131. }
  1132. u8 rtw_init_drv_sw(_adapter *padapter)
  1133. {
  1134. u8 ret8=_SUCCESS;
  1135. _func_enter_;
  1136. RT_TRACE(_module_os_intfs_c_,_drv_info_,("+rtw_init_drv_sw\n"));
  1137. ret8 = rtw_init_default_value(padapter);
  1138. if ((rtw_init_cmd_priv(&padapter->cmdpriv)) == _FAIL)
  1139. {
  1140. RT_TRACE(_module_os_intfs_c_,_drv_err_,("\n Can't init cmd_priv\n"));
  1141. ret8=_FAIL;
  1142. goto exit;
  1143. }
  1144. padapter->cmdpriv.padapter=padapter;
  1145. if ((rtw_init_evt_priv(&padapter->evtpriv)) == _FAIL)
  1146. {
  1147. RT_TRACE(_module_os_intfs_c_,_drv_err_,("\n Can't init evt_priv\n"));
  1148. ret8=_FAIL;
  1149. goto exit;
  1150. }
  1151. if (rtw_init_mlme_priv(padapter) == _FAIL)
  1152. {
  1153. RT_TRACE(_module_os_intfs_c_,_drv_err_,("\n Can't init mlme_priv\n"));
  1154. ret8=_FAIL;
  1155. goto exit;
  1156. }
  1157. #ifdef CONFIG_P2P
  1158. rtw_init_wifidirect_timers(padapter);
  1159. init_wifidirect_info(padapter, P2P_ROLE_DISABLE);
  1160. reset_global_wifidirect_info(padapter);
  1161. #ifdef CONFIG_IOCTL_CFG80211
  1162. rtw_init_cfg80211_wifidirect_info(padapter);
  1163. #endif
  1164. #ifdef CONFIG_WFD
  1165. if(rtw_init_wifi_display_info(padapter) == _FAIL)
  1166. RT_TRACE(_module_os_intfs_c_,_drv_err_,("\n Can't init init_wifi_display_info\n"));
  1167. #endif
  1168. #endif /* CONFIG_P2P */
  1169. if(init_mlme_ext_priv(padapter) == _FAIL)
  1170. {
  1171. RT_TRACE(_module_os_intfs_c_,_drv_err_,("\n Can't init mlme_ext_priv\n"));
  1172. ret8=_FAIL;
  1173. goto exit;
  1174. }
  1175. #ifdef CONFIG_TDLS
  1176. if(rtw_init_tdls_info(padapter) == _FAIL)
  1177. {
  1178. DBG_871X("Can't rtw_init_tdls_info\n");
  1179. ret8=_FAIL;
  1180. goto exit;
  1181. }
  1182. #endif //CONFIG_TDLS
  1183. if(_rtw_init_xmit_priv(&padapter->xmitpriv, padapter) == _FAIL)
  1184. {
  1185. DBG_871X("Can't _rtw_init_xmit_priv\n");
  1186. ret8=_FAIL;
  1187. goto exit;
  1188. }
  1189. if(_rtw_init_recv_priv(&padapter->recvpriv, padapter) == _FAIL)
  1190. {
  1191. DBG_871X("Can't _rtw_init_recv_priv\n");
  1192. ret8=_FAIL;
  1193. goto exit;
  1194. }
  1195. // We don't need to memset padapter->XXX to zero, because adapter is allocated by rtw_zvmalloc().
  1196. //_rtw_memset((unsigned char *)&padapter->securitypriv, 0, sizeof (struct security_priv));
  1197. //_init_timer(&(padapter->securitypriv.tkip_timer), padapter->pifp, rtw_use_tkipkey_handler, padapter);
  1198. if(_rtw_init_sta_priv(&padapter->stapriv) == _FAIL)
  1199. {
  1200. DBG_871X("Can't _rtw_init_sta_priv\n");
  1201. ret8=_FAIL;
  1202. goto exit;
  1203. }
  1204. padapter->stapriv.padapter = padapter;
  1205. padapter->setband = GHZ24_50;
  1206. rtw_init_bcmc_stainfo(padapter);
  1207. rtw_init_pwrctrl_priv(padapter);
  1208. //_rtw_memset((u8 *)&padapter->qospriv, 0, sizeof (struct qos_priv));//move to mlme_priv
  1209. #ifdef CONFIG_MP_INCLUDED
  1210. if (init_mp_priv(padapter) == _FAIL) {
  1211. DBG_871X("%s: initialize MP private data Fail!\n", __func__);
  1212. }
  1213. #endif
  1214. rtw_hal_dm_init(padapter);
  1215. rtw_hal_sw_led_init(padapter);
  1216. #ifdef DBG_CONFIG_ERROR_DETECT
  1217. rtw_hal_sreset_init(padapter);
  1218. #endif
  1219. #ifdef CONFIG_INTEL_WIDI
  1220. if(rtw_init_intel_widi(padapter) == _FAIL)
  1221. {
  1222. DBG_871X("Can't rtw_init_intel_widi\n");
  1223. ret8=_FAIL;
  1224. goto exit;
  1225. }
  1226. #endif //CONFIG_INTEL_WIDI
  1227. #ifdef CONFIG_WAPI_SUPPORT
  1228. padapter->WapiSupport = true; //set true temp, will revise according to Efuse or Registry value later.
  1229. rtw_wapi_init(padapter);
  1230. #endif
  1231. #ifdef CONFIG_BR_EXT
  1232. _rtw_spinlock_init(&padapter->br_ext_lock);
  1233. #endif // CONFIG_BR_EXT
  1234. exit:
  1235. RT_TRACE(_module_os_intfs_c_,_drv_info_,("-rtw_init_drv_sw\n"));
  1236. _func_exit_;
  1237. return ret8;
  1238. }
  1239. #ifdef CONFIG_WOWLAN
  1240. void rtw_cancel_dynamic_chk_timer(_adapter *padapter)
  1241. {
  1242. _cancel_timer_ex(&padapter->mlmepriv.dynamic_chk_timer);
  1243. RT_TRACE(_module_os_intfs_c_,_drv_info_,("rtw_cancel_all_timer:cancel dynamic_chk_timer! \n"));
  1244. }
  1245. #endif
  1246. void rtw_cancel_all_timer(_adapter *padapter)
  1247. {
  1248. RT_TRACE(_module_os_intfs_c_,_drv_info_,("+rtw_cancel_all_timer\n"));
  1249. _cancel_timer_ex(&padapter->mlmepriv.assoc_timer);
  1250. RT_TRACE(_module_os_intfs_c_,_drv_info_,("rtw_cancel_all_timer:cancel association timer complete! \n"));
  1251. //_cancel_timer_ex(&padapter->securitypriv.tkip_timer);
  1252. //RT_TRACE(_module_os_intfs_c_,_drv_info_,("rtw_cancel_all_timer:cancel tkip_timer! \n"));
  1253. _cancel_timer_ex(&padapter->mlmepriv.scan_to_timer);
  1254. RT_TRACE(_module_os_intfs_c_,_drv_info_,("rtw_cancel_all_timer:cancel scan_to_timer! \n"));
  1255. _cancel_timer_ex(&padapter->mlmepriv.dynamic_chk_timer);
  1256. RT_TRACE(_module_os_intfs_c_,_drv_info_,("rtw_cancel_all_timer:cancel dynamic_chk_timer! \n"));
  1257. // cancel sw led timer
  1258. rtw_hal_sw_led_deinit(padapter);
  1259. RT_TRACE(_module_os_intfs_c_,_drv_info_,("rtw_cancel_all_timer:cancel DeInitSwLeds! \n"));
  1260. _cancel_timer_ex(&padapter->pwrctrlpriv.pwr_state_check_timer);
  1261. #ifdef CONFIG_IOCTL_CFG80211
  1262. #ifdef CONFIG_P2P
  1263. _cancel_timer_ex(&padapter->cfg80211_wdinfo.remain_on_ch_timer);
  1264. #endif //CONFIG_P2P
  1265. #endif //CONFIG_IOCTL_CFG80211
  1266. #ifdef CONFIG_SET_SCAN_DENY_TIMER
  1267. _cancel_timer_ex(&padapter->mlmepriv.set_scan_deny_timer);
  1268. rtw_clear_scan_deny(padapter);
  1269. RT_TRACE(_module_os_intfs_c_,_drv_info_,("rtw_cancel_all_timer:cancel set_scan_deny_timer! \n"));
  1270. #endif
  1271. #ifdef CONFIG_NEW_SIGNAL_STAT_PROCESS
  1272. _cancel_timer_ex(&padapter->recvpriv.signal_stat_timer);
  1273. #endif
  1274. //cancel dm timer
  1275. rtw_hal_dm_deinit(padapter);
  1276. #ifdef CONFIG_PLATFORM_FS_MX61
  1277. msleep(50);
  1278. #endif
  1279. }
  1280. u8 rtw_free_drv_sw(_adapter *padapter)
  1281. {
  1282. struct net_device *pnetdev = (struct net_device*)padapter->pnetdev;
  1283. RT_TRACE(_module_os_intfs_c_,_drv_info_,("==>rtw_free_drv_sw"));
  1284. #ifdef CONFIG_WAPI_SUPPORT
  1285. rtw_wapi_free(padapter);
  1286. #endif
  1287. //we can call rtw_p2p_enable here, but:
  1288. // 1. rtw_p2p_enable may have IO operation
  1289. // 2. rtw_p2p_enable is bundled with wext interface
  1290. #ifdef CONFIG_P2P
  1291. {
  1292. struct wifidirect_info *pwdinfo = &padapter->wdinfo;
  1293. if(!rtw_p2p_chk_state(pwdinfo, P2P_STATE_NONE))
  1294. {
  1295. _cancel_timer_ex( &pwdinfo->find_phase_timer );
  1296. _cancel_timer_ex( &pwdinfo->restore_p2p_state_timer );
  1297. _cancel_timer_ex( &pwdinfo->pre_tx_scan_timer);
  1298. #ifdef CONFIG_CONCURRENT_MODE
  1299. _cancel_timer_ex( &pwdinfo->ap_p2p_switch_timer );
  1300. #endif // CONFIG_CONCURRENT_MODE
  1301. rtw_p2p_set_state(pwdinfo, P2P_STATE_NONE);
  1302. }
  1303. }
  1304. #endif
  1305. #ifdef CONFIG_BR_EXT
  1306. _rtw_spinlock_free(&padapter->br_ext_lock);
  1307. #endif // CONFIG_BR_EXT
  1308. #ifdef CONFIG_INTEL_WIDI
  1309. rtw_free_intel_widi(padapter);
  1310. #endif //CONFIG_INTEL_WIDI
  1311. free_mlme_ext_priv(&padapter->mlmeextpriv);
  1312. #ifdef CONFIG_TDLS
  1313. //rtw_free_tdls_info(&padapter->tdlsinfo);
  1314. #endif //CONFIG_TDLS
  1315. rtw_free_cmd_priv(&padapter->cmdpriv);
  1316. rtw_free_evt_priv(&padapter->evtpriv);
  1317. rtw_free_mlme_priv(&padapter->mlmepriv);
  1318. //free_io_queue(padapter);
  1319. _rtw_free_xmit_priv(&padapter->xmitpriv);
  1320. _rtw_free_sta_priv(&padapter->stapriv); //will free bcmc_stainfo here
  1321. _rtw_free_recv_priv(&padapter->recvpriv);
  1322. rtw_free_pwrctrl_priv(padapter);
  1323. //rtw_mfree((void *)padapter, sizeof (padapter));
  1324. #ifdef CONFIG_DRVEXT_MODULE
  1325. free_drvext(&padapter->drvextpriv);
  1326. #endif
  1327. rtw_hal_free_data(padapter);
  1328. RT_TRACE(_module_os_intfs_c_,_drv_info_,("<==rtw_free_drv_sw\n"));
  1329. //free the old_pnetdev
  1330. if(padapter->rereg_nd_name_priv.old_pnetdev) {
  1331. free_netdev(padapter->rereg_nd_name_priv.old_pnetdev);
  1332. padapter->rereg_nd_name_priv.old_pnetdev = NULL;
  1333. }
  1334. // clear pbuddy_adapter to avoid access wrong pointer.
  1335. if(padapter->pbuddy_adapter != NULL) {
  1336. padapter->pbuddy_adapter->pbuddy_adapter = NULL;
  1337. }
  1338. RT_TRACE(_module_os_intfs_c_,_drv_info_,("-rtw_free_drv_sw\n"));
  1339. return _SUCCESS;
  1340. }
  1341. #ifdef CONFIG_CONCURRENT_MODE
  1342. #ifdef CONFIG_MULTI_VIR_IFACES
  1343. int _netdev_vir_if_open(struct net_device *pnetdev)
  1344. {
  1345. _adapter *padapter = (_adapter *)rtw_netdev_priv(pnetdev);
  1346. _adapter *primary_padapter = GET_PRIMARY_ADAPTER(padapter);
  1347. DBG_871X(FUNC_NDEV_FMT" enter\n", FUNC_NDEV_ARG(pnetdev));
  1348. if(!primary_padapter)
  1349. goto _netdev_virtual_iface_open_error;
  1350. if(primary_padapter->bup == _FALSE || primary_padapter->hw_init_completed == _FALSE)
  1351. {
  1352. _netdev_open(primary_padapter->pnetdev);
  1353. }
  1354. if(padapter->bup == _FALSE && primary_padapter->bup == _TRUE &&
  1355. primary_padapter->hw_init_completed == _TRUE)
  1356. {
  1357. int i;
  1358. padapter->bDriverStopped = _FALSE;
  1359. padapter->bSurpriseRemoved = _FALSE;
  1360. padapter->bCardDisableWOHSM = _FALSE;
  1361. rtw_hal_clone_data(padapter, primary_padapter);
  1362. padapter->bFWReady = primary_padapter->bFWReady;
  1363. if(rtw_start_drv_threads(padapter) == _FAIL)
  1364. {
  1365. goto _netdev_virtual_iface_open_error;
  1366. }
  1367. padapter->dir_dev = NULL;
  1368. rtw_proc_init_one(pnetdev);
  1369. #ifdef CONFIG_IOCTL_CFG80211
  1370. rtw_cfg80211_init_wiphy(padapter);
  1371. #endif
  1372. padapter->bup = _TRUE;
  1373. padapter->hw_init_completed = _TRUE;
  1374. }
  1375. padapter->net_closed = _FALSE;
  1376. _set_timer(&padapter->mlmepriv.dynamic_chk_timer, 2000);
  1377. if(!rtw_netif_queue_stopped(pnetdev))
  1378. rtw_netif_start_queue(pnetdev);
  1379. else
  1380. rtw_netif_wake_queue(pnetdev);
  1381. DBG_871X(FUNC_NDEV_FMT" exit\n", FUNC_NDEV_ARG(pnetdev));
  1382. return 0;
  1383. _netdev_virtual_iface_open_error:
  1384. padapter->bup = _FALSE;
  1385. netif_carrier_off(pnetdev);
  1386. rtw_netif_stop_queue(pnetdev);
  1387. return (-1);
  1388. }
  1389. int netdev_vir_if_open(struct net_device *pnetdev)
  1390. {
  1391. int ret;
  1392. _adapter *padapter = (_adapter *)rtw_netdev_priv(pnetdev);
  1393. _enter_critical_mutex(&(adapter_to_dvobj(padapter)->hw_init_mutex), NULL);
  1394. ret = _netdev_vir_if_open(pnetdev);
  1395. _exit_critical_mutex(&(adapter_to_dvobj(padapter)->hw_init_mutex), NULL);
  1396. #ifdef CONFIG_AUTO_AP_MODE
  1397. //if(padapter->iface_id == 2)
  1398. // rtw_start_auto_ap(padapter);
  1399. #endif
  1400. return ret;
  1401. }
  1402. static int netdev_vir_if_close(struct net_device *pnetdev)
  1403. {
  1404. _adapter *padapter = (_adapter *)rtw_netdev_priv(pnetdev);
  1405. padapter->net_closed = _TRUE;
  1406. if(pnetdev)
  1407. {
  1408. if (!rtw_netif_queue_stopped(pnetdev))
  1409. rtw_netif_stop_queue(pnetdev);
  1410. }
  1411. #ifdef CONFIG_IOCTL_CFG80211
  1412. rtw_scan_abort(padapter);
  1413. wdev_to_priv(padapter->rtw_wdev)->bandroid_scan = _FALSE;
  1414. #endif
  1415. return 0;
  1416. }
  1417. #if (LINUX_VERSION_CODE>=KERNEL_VERSION(2,6,29))
  1418. static const struct net_device_ops rtw_netdev_vir_if_ops = {
  1419. .ndo_open = netdev_vir_if_open,
  1420. .ndo_stop = netdev_vir_if_close,
  1421. .ndo_start_xmit = rtw_xmit_entry,
  1422. .ndo_set_mac_address = rtw_net_set_mac_address,
  1423. .ndo_get_stats = rtw_net_get_stats,
  1424. .ndo_do_ioctl = rtw_ioctl,
  1425. #if (LINUX_VERSION_CODE>=KERNEL_VERSION(2,6,35))
  1426. .ndo_select_queue = rtw_select_queue,
  1427. #endif
  1428. };
  1429. #endif
  1430. _adapter *rtw_drv_add_vir_if(_adapter *primary_padapter,
  1431. void (*set_intf_ops)(_adapter *primary_padapter,struct _io_ops *pops))
  1432. {
  1433. int res = _FAIL;
  1434. struct net_device *pnetdev=NULL;
  1435. _adapter *padapter = NULL;
  1436. struct dvobj_priv *pdvobjpriv;
  1437. u8 mac[ETH_ALEN];
  1438. /*
  1439. if((primary_padapter->bup == _FALSE) ||
  1440. (rtw_buddy_adapter_up(primary_padapter) == _FALSE))
  1441. {
  1442. goto error_rtw_drv_add_iface;
  1443. }
  1444. */
  1445. /****** init netdev ******/
  1446. pnetdev = rtw_init_netdev(NULL);
  1447. if (!pnetdev)
  1448. goto error_rtw_drv_add_iface;
  1449. #if (LINUX_VERSION_CODE>=KERNEL_VERSION(2,6,29))
  1450. DBG_871X("register rtw_netdev_virtual_iface_ops to netdev_ops\n");
  1451. pnetdev->netdev_ops = &rtw_netdev_vir_if_ops;
  1452. #else
  1453. pnetdev->open = netdev_vir_if_open;
  1454. pnetdev->stop = netdev_vir_if_close;
  1455. #endif
  1456. #ifdef CONFIG_NO_WIRELESS_HANDLERS
  1457. pnetdev->wireless_handlers = NULL;
  1458. #endif
  1459. /****** init adapter ******/
  1460. padapter = rtw_netdev_priv(pnetdev);
  1461. _rtw_memcpy(padapter, primary_padapter, sizeof(_adapter));
  1462. //
  1463. padapter->bup = _FALSE;
  1464. padapter->net_closed = _TRUE;
  1465. padapter->hw_init_completed = _FALSE;
  1466. //set adapter_type/iface type
  1467. padapter->isprimary = _FALSE;
  1468. padapter->adapter_type = MAX_ADAPTER;
  1469. padapter->pbuddy_adapter = primary_padapter;
  1470. #if 0
  1471. #ifndef CONFIG_HWPORT_SWAP //Port0 -> Pri , Port1 -> Sec
  1472. padapter->iface_type = IFACE_PORT1;
  1473. #else
  1474. padapter->iface_type = IFACE_PORT0;
  1475. #endif //CONFIG_HWPORT_SWAP
  1476. #else
  1477. //extended virtual interfaces always are set to port0
  1478. padapter->iface_type = IFACE_PORT0;
  1479. #endif
  1480. //
  1481. padapter->pnetdev = pnetdev;
  1482. /****** setup dvobj ******/
  1483. pdvobjpriv = adapter_to_dvobj(padapter);
  1484. padapter->iface_id = pdvobjpriv->iface_nums;
  1485. pdvobjpriv->padapters[pdvobjpriv->iface_nums++] = padapter;
  1486. SET_NETDEV_DEV(pnetdev, dvobj_to_dev(pdvobjpriv));
  1487. #ifdef CONFIG_IOCTL_CFG80211
  1488. rtw_wdev_alloc(padapter, dvobj_to_dev(pdvobjpriv));
  1489. #endif //CONFIG_IOCTL_CFG80211
  1490. //set interface_type/chip_type/HardwareType
  1491. padapter->interface_type = primary_padapter->interface_type;
  1492. padapter->chip_type = primary_padapter->chip_type;
  1493. padapter->HardwareType = primary_padapter->HardwareType;
  1494. //step 2. hook HalFunc, allocate HalData
  1495. //hal_set_hal_ops(padapter);
  1496. rtw_set_hal_ops(padapter);
  1497. padapter->HalFunc.inirp_init = NULL;
  1498. padapter->HalFunc.inirp_deinit = NULL;
  1499. padapter->intf_start = NULL;
  1500. padapter->intf_stop = NULL;
  1501. //step init_io_priv
  1502. if ((rtw_init_io_priv(padapter, set_intf_ops)) == _FAIL) {
  1503. RT_TRACE(_module_hci_intfs_c_,_drv_err_,(" \n Can't init io_reqs\n"));
  1504. }
  1505. //step read_chip_version
  1506. rtw_hal_read_chip_version(padapter);
  1507. //step usb endpoint mapping
  1508. rtw_hal_chip_configure(padapter);
  1509. //init drv data
  1510. if(rtw_init_drv_sw(padapter)!= _SUCCESS)
  1511. goto error_rtw_drv_add_iface;
  1512. //get mac address from primary_padapter
  1513. _rtw_memcpy(mac, primary_padapter->eeprompriv.mac_addr, ETH_ALEN);
  1514. if (((mac[0]==0xff) &&(mac[1]==0xff) && (mac[2]==0xff) &&
  1515. (mac[3]==0xff) && (mac[4]==0xff) &&(mac[5]==0xff)) ||
  1516. ((mac[0]==0x0) && (mac[1]==0x0) && (mac[2]==0x0) &&
  1517. (mac[3]==0x0) && (mac[4]==0x0) &&(mac[5]==0x0)))
  1518. {
  1519. mac[0] = 0x00;
  1520. mac[1] = 0xe0;
  1521. mac[2] = 0x4c;
  1522. mac[3] = 0x87;
  1523. mac[4] = 0x11;
  1524. mac[5] = 0x22;
  1525. }
  1526. else
  1527. {
  1528. //If the BIT1 is 0, the address is universally administered.
  1529. //If it is 1, the address is locally administered
  1530. #if 1 //needs enable MBSSID CAM
  1531. mac[0] |= BIT(1); // locally administered
  1532. mac[0] |= (padapter->iface_id-1)<<4;
  1533. #endif
  1534. }
  1535. _rtw_memcpy(padapter->eeprompriv.mac_addr, mac, ETH_ALEN);
  1536. padapter->dir_dev = NULL;
  1537. res = _SUCCESS;
  1538. return padapter;
  1539. error_rtw_drv_add_iface:
  1540. if(padapter)
  1541. rtw_free_drv_sw(padapter);
  1542. if (pnetdev)
  1543. rtw_free_netdev(pnetdev);
  1544. return NULL;
  1545. }
  1546. void rtw_drv_stop_vir_if(_adapter *padapter)
  1547. {
  1548. struct net_device *pnetdev=NULL;
  1549. if (padapter == NULL)
  1550. return;
  1551. pnetdev = padapter->pnetdev;
  1552. if(pnetdev)
  1553. {
  1554. unregister_netdev(pnetdev); //will call netdev_close()
  1555. rtw_proc_remove_one(pnetdev);
  1556. }
  1557. rtw_cancel_all_timer(padapter);
  1558. if(padapter->bup == _TRUE)
  1559. {
  1560. padapter->bDriverStopped = _TRUE;
  1561. #ifdef CONFIG_XMIT_ACK
  1562. if (padapter->xmitpriv.ack_tx)
  1563. rtw_ack_tx_done(&padapter->xmitpriv, RTW_SCTX_DONE_DRV_STOP);
  1564. #endif
  1565. if(padapter->intf_stop)
  1566. {
  1567. padapter->intf_stop(padapter);
  1568. }
  1569. rtw_stop_drv_threads(padapter);
  1570. padapter->bup = _FALSE;
  1571. }
  1572. #ifdef CONFIG_IOCTL_CFG80211
  1573. rtw_wdev_unregister(padapter->rtw_wdev);
  1574. #endif //CONFIG_IOCTL_CFG80211
  1575. }
  1576. void rtw_drv_free_vir_if(_adapter *padapter)
  1577. {
  1578. struct net_device *pnetdev=NULL;
  1579. if (padapter == NULL)
  1580. return;
  1581. padapter->pbuddy_adapter = NULL;
  1582. pnetdev = padapter->pnetdev;
  1583. #ifdef CONFIG_IOCTL_CFG80211
  1584. rtw_wdev_free(padapter->rtw_wdev);
  1585. #endif //CONFIG_IOCTL_CFG80211
  1586. rtw_free_drv_sw(padapter);
  1587. rtw_free_netdev(pnetdev);
  1588. }
  1589. void rtw_drv_stop_vir_ifaces(struct dvobj_priv *dvobj)
  1590. {
  1591. int i;
  1592. //struct dvobj_priv *dvobj = primary_padapter->dvobj;
  1593. for(i=2;i<dvobj->iface_nums;i++)
  1594. {
  1595. rtw_drv_stop_vir_if(dvobj->padapters[i]);
  1596. }
  1597. }
  1598. void rtw_drv_free_vir_ifaces(struct dvobj_priv *dvobj)
  1599. {
  1600. int i;
  1601. //struct dvobj_priv *dvobj = primary_padapter->dvobj;
  1602. for(i=2;i<dvobj->iface_nums;i++)
  1603. {
  1604. rtw_drv_free_vir_if(dvobj->padapters[i]);
  1605. }
  1606. }
  1607. void rtw_drv_del_vir_if(_adapter *padapter)
  1608. {
  1609. rtw_drv_stop_vir_if(padapter);
  1610. rtw_drv_free_vir_if(padapter);
  1611. }
  1612. void rtw_drv_del_vir_ifaces(_adapter *primary_padapter)
  1613. {
  1614. int i;
  1615. struct dvobj_priv *dvobj = primary_padapter->dvobj;
  1616. for(i=2;i<dvobj->iface_nums;i++)
  1617. {
  1618. rtw_drv_del_vir_if(dvobj->padapters[i]);
  1619. }
  1620. }
  1621. #endif //CONFIG_MULTI_VIR_IFACES
  1622. int _netdev_if2_open(struct net_device *pnetdev)
  1623. {
  1624. _adapter *padapter = (_adapter *)rtw_netdev_priv(pnetdev);
  1625. _adapter *primary_padapter = padapter->pbuddy_adapter;
  1626. DBG_871X("+871x_drv - if2_open, bup=%d\n", padapter->bup);
  1627. if(primary_padapter->bup == _FALSE || primary_padapter->hw_init_completed == _FALSE)
  1628. {
  1629. _netdev_open(primary_padapter->pnetdev);
  1630. }
  1631. if(padapter->bup == _FALSE && primary_padapter->bup == _TRUE &&
  1632. primary_padapter->hw_init_completed == _TRUE)
  1633. {
  1634. int i;
  1635. padapter->bDriverStopped = _FALSE;
  1636. padapter->bSurpriseRemoved = _FALSE;
  1637. padapter->bCardDisableWOHSM = _FALSE;
  1638. // _rtw_memcpy(padapter->HalData, primary_padapter->HalData, padapter->hal_data_sz);
  1639. rtw_hal_clone_data(padapter, primary_padapter);
  1640. padapter->bFWReady = primary_padapter->bFWReady;
  1641. //if (init_mlme_ext_priv(padapter) == _FAIL)
  1642. // goto netdev_if2_open_error;
  1643. if(rtw_start_drv_threads(padapter) == _FAIL)
  1644. {
  1645. goto netdev_if2_open_error;
  1646. }
  1647. if(padapter->intf_start)
  1648. {
  1649. padapter->intf_start(padapter);
  1650. }
  1651. padapter->hw_init_completed = _TRUE;
  1652. padapter->dir_dev = NULL;
  1653. rtw_proc_init_one(pnetdev);
  1654. #ifdef CONFIG_IOCTL_CFG80211
  1655. rtw_cfg80211_init_wiphy(padapter);
  1656. #endif
  1657. padapter->bup = _TRUE;
  1658. }
  1659. padapter->net_closed = _FALSE;
  1660. _set_timer(&padapter->mlmepriv.dynamic_chk_timer, 2000);
  1661. if(!rtw_netif_queue_stopped(pnetdev))
  1662. rtw_netif_start_queue(pnetdev);
  1663. else
  1664. rtw_netif_wake_queue(pnetdev);
  1665. DBG_871X("-871x_drv - if2_open, bup=%d\n", padapter->bup);
  1666. return 0;
  1667. netdev_if2_open_error:
  1668. padapter->bup = _FALSE;
  1669. netif_carrier_off(pnetdev);
  1670. rtw_netif_stop_queue(pnetdev);
  1671. return (-1);
  1672. }
  1673. int netdev_if2_open(struct net_device *pnetdev)
  1674. {
  1675. int ret;
  1676. _adapter *padapter = (_adapter *)rtw_netdev_priv(pnetdev);
  1677. _enter_critical_mutex(&(adapter_to_dvobj(padapter)->hw_init_mutex), NULL);
  1678. ret = _netdev_if2_open(pnetdev);
  1679. _exit_critical_mutex(&(adapter_to_dvobj(padapter)->hw_init_mutex), NULL);
  1680. #ifdef CONFIG_AUTO_AP_MODE
  1681. //if(padapter->iface_id == 2)
  1682. rtw_start_auto_ap(padapter);
  1683. #endif
  1684. return ret;
  1685. }
  1686. static int netdev_if2_close(struct net_device *pnetdev)
  1687. {
  1688. _adapter *padapter = (_adapter *)rtw_netdev_priv(pnetdev);
  1689. padapter->net_closed = _TRUE;
  1690. if(pnetdev)
  1691. {
  1692. if (!rtw_netif_queue_stopped(pnetdev))
  1693. rtw_netif_stop_queue(pnetdev);
  1694. }
  1695. #ifdef CONFIG_IOCTL_CFG80211
  1696. rtw_scan_abort(padapter);
  1697. wdev_to_priv(padapter->rtw_wdev)->bandroid_scan = _FALSE;
  1698. #endif
  1699. return 0;
  1700. }
  1701. #if (LINUX_VERSION_CODE>=KERNEL_VERSION(2,6,29))
  1702. static const struct net_device_ops rtw_netdev_if2_ops = {
  1703. .ndo_open = netdev_if2_open,
  1704. .ndo_stop = netdev_if2_close,
  1705. .ndo_start_xmit = rtw_xmit_entry,
  1706. .ndo_set_mac_address = rtw_net_set_mac_address,
  1707. .ndo_get_stats = rtw_net_get_stats,
  1708. .ndo_do_ioctl = rtw_ioctl,
  1709. #if (LINUX_VERSION_CODE>=KERNEL_VERSION(2,6,35))
  1710. .ndo_select_queue = rtw_select_queue,
  1711. #endif
  1712. };
  1713. #endif
  1714. _adapter *rtw_drv_if2_init(_adapter *primary_padapter,
  1715. void (*set_intf_ops)(_adapter *primary_padapter,struct _io_ops *pops))
  1716. {
  1717. int res = _FAIL;
  1718. struct net_device *pnetdev = NULL;
  1719. _adapter *padapter = NULL;
  1720. struct dvobj_priv *pdvobjpriv;
  1721. u8 mac[ETH_ALEN];
  1722. /****** init netdev ******/
  1723. pnetdev = rtw_init_netdev(NULL);
  1724. if (!pnetdev)
  1725. goto error_rtw_drv_if2_init;
  1726. #if (LINUX_VERSION_CODE>=KERNEL_VERSION(2,6,29))
  1727. DBG_871X("register rtw_netdev_if2_ops to netdev_ops\n");
  1728. pnetdev->netdev_ops = &rtw_netdev_if2_ops;
  1729. #else
  1730. pnetdev->open = netdev_if2_open;
  1731. pnetdev->stop = netdev_if2_close;
  1732. #endif
  1733. #ifdef CONFIG_NO_WIRELESS_HANDLERS
  1734. pnetdev->wireless_handlers = NULL;
  1735. #endif
  1736. /****** init adapter ******/
  1737. padapter = rtw_netdev_priv(pnetdev);
  1738. _rtw_memcpy(padapter, primary_padapter, sizeof(_adapter));
  1739. //
  1740. padapter->bup = _FALSE;
  1741. padapter->net_closed = _TRUE;
  1742. padapter->hw_init_completed = _FALSE;
  1743. //set adapter_type/iface type
  1744. padapter->isprimary = _FALSE;
  1745. padapter->adapter_type = SECONDARY_ADAPTER;
  1746. padapter->pbuddy_adapter = primary_padapter;
  1747. padapter->iface_id = IFACE_ID1;
  1748. #ifndef CONFIG_HWPORT_SWAP //Port0 -> Pri , Port1 -> Sec
  1749. padapter->iface_type = IFACE_PORT1;
  1750. #else
  1751. padapter->iface_type = IFACE_PORT0;
  1752. #endif //CONFIG_HWPORT_SWAP
  1753. //
  1754. padapter->pnetdev = pnetdev;
  1755. /****** setup dvobj ******/
  1756. pdvobjpriv = adapter_to_dvobj(padapter);
  1757. pdvobjpriv->if2 = padapter;
  1758. pdvobjpriv->padapters[pdvobjpriv->iface_nums++] = padapter;
  1759. SET_NETDEV_DEV(pnetdev, dvobj_to_dev(pdvobjpriv));
  1760. #ifdef CONFIG_IOCTL_CFG80211
  1761. rtw_wdev_alloc(padapter, dvobj_to_dev(pdvobjpriv));
  1762. #endif //CONFIG_IOCTL_CFG80211
  1763. //set interface_type/chip_type/HardwareType
  1764. padapter->interface_type = primary_padapter->interface_type;
  1765. padapter->chip_type = primary_padapter->chip_type;
  1766. padapter->HardwareType = primary_padapter->HardwareType;
  1767. //step 2. hook HalFunc, allocate HalData
  1768. //hal_set_hal_ops(padapter);
  1769. rtw_set_hal_ops(padapter);
  1770. padapter->HalFunc.inirp_init = NULL;
  1771. padapter->HalFunc.inirp_deinit = NULL;
  1772. //
  1773. padapter->intf_start = primary_padapter->intf_start;
  1774. padapter->intf_stop = primary_padapter->intf_stop;
  1775. //step init_io_priv
  1776. if ((rtw_init_io_priv(padapter, set_intf_ops)) == _FAIL) {
  1777. RT_TRACE(_module_hci_intfs_c_,_drv_err_,(" \n Can't init io_reqs\n"));
  1778. }
  1779. //step read_chip_version
  1780. rtw_hal_read_chip_version(padapter);
  1781. //step usb endpoint mapping
  1782. rtw_hal_chip_configure(padapter);
  1783. //init drv data
  1784. if(rtw_init_drv_sw(padapter)!= _SUCCESS)
  1785. goto error_rtw_drv_if2_init;
  1786. //get mac address from primary_padapter
  1787. _rtw_memcpy(mac, primary_padapter->eeprompriv.mac_addr, ETH_ALEN);
  1788. if (((mac[0]==0xff) &&(mac[1]==0xff) && (mac[2]==0xff) &&
  1789. (mac[3]==0xff) && (mac[4]==0xff) &&(mac[5]==0xff)) ||
  1790. ((mac[0]==0x0) && (mac[1]==0x0) && (mac[2]==0x0) &&
  1791. (mac[3]==0x0) && (mac[4]==0x0) &&(mac[5]==0x0)))
  1792. {
  1793. mac[0] = 0x00;
  1794. mac[1] = 0xe0;
  1795. mac[2] = 0x4c;
  1796. mac[3] = 0x87;
  1797. mac[4] = 0x11;
  1798. mac[5] = 0x22;
  1799. }
  1800. else
  1801. {
  1802. //If the BIT1 is 0, the address is universally administered.
  1803. //If it is 1, the address is locally administered
  1804. mac[0] |= BIT(1); // locally administered
  1805. }
  1806. _rtw_memcpy(padapter->eeprompriv.mac_addr, mac, ETH_ALEN);
  1807. rtw_init_wifidirect_addrs(padapter, padapter->eeprompriv.mac_addr, padapter->eeprompriv.mac_addr);
  1808. primary_padapter->pbuddy_adapter = padapter;
  1809. padapter->dir_dev = NULL;
  1810. res = _SUCCESS;
  1811. return padapter;
  1812. error_rtw_drv_if2_init:
  1813. if(padapter)
  1814. rtw_free_drv_sw(padapter);
  1815. if (pnetdev)
  1816. rtw_free_netdev(pnetdev);
  1817. return NULL;
  1818. }
  1819. void rtw_drv_if2_free(_adapter *if2)
  1820. {
  1821. _adapter *padapter = if2;
  1822. struct net_device *pnetdev = NULL;
  1823. if (padapter == NULL)
  1824. return;
  1825. pnetdev = padapter->pnetdev;
  1826. #ifdef CONFIG_IOCTL_CFG80211
  1827. rtw_wdev_free(padapter->rtw_wdev);
  1828. #endif /* CONFIG_IOCTL_CFG80211 */
  1829. rtw_free_drv_sw(padapter);
  1830. rtw_free_netdev(pnetdev);
  1831. }
  1832. void rtw_drv_if2_stop(_adapter *if2)
  1833. {
  1834. _adapter *padapter = if2;
  1835. struct net_device *pnetdev = NULL;
  1836. if (padapter == NULL)
  1837. return;
  1838. pnetdev = padapter->pnetdev;
  1839. if (pnetdev) {
  1840. unregister_netdev(pnetdev); //will call netdev_close()
  1841. rtw_proc_remove_one(pnetdev);
  1842. }
  1843. rtw_cancel_all_timer(padapter);
  1844. if (padapter->bup == _TRUE) {
  1845. padapter->bDriverStopped = _TRUE;
  1846. #ifdef CONFIG_XMIT_ACK
  1847. if (padapter->xmitpriv.ack_tx)
  1848. rtw_ack_tx_done(&padapter->xmitpriv, RTW_SCTX_DONE_DRV_STOP);
  1849. #endif
  1850. if(padapter->intf_stop)
  1851. {
  1852. padapter->intf_stop(padapter);
  1853. }
  1854. rtw_stop_drv_threads(padapter);
  1855. padapter->bup = _FALSE;
  1856. }
  1857. #ifdef CONFIG_IOCTL_CFG80211
  1858. rtw_wdev_unregister(padapter->rtw_wdev);
  1859. #endif
  1860. }
  1861. #endif //end of CONFIG_CONCURRENT_MODE
  1862. #ifdef CONFIG_BR_EXT
  1863. void netdev_br_init(struct net_device *netdev)
  1864. {
  1865. _adapter *adapter = (_adapter *)rtw_netdev_priv(netdev);
  1866. #if (LINUX_VERSION_CODE > KERNEL_VERSION(2, 6, 35))
  1867. rcu_read_lock();
  1868. #endif // (LINUX_VERSION_CODE > KERNEL_VERSION(2, 6, 35))
  1869. //if(check_fwstate(pmlmepriv, WIFI_STATION_STATE|WIFI_ADHOC_STATE) == _TRUE)
  1870. {
  1871. //struct net_bridge *br = netdev->br_port->br;//->dev->dev_addr;
  1872. #if (LINUX_VERSION_CODE <= KERNEL_VERSION(2, 6, 35))
  1873. if (netdev->br_port)
  1874. #else // (LINUX_VERSION_CODE <= KERNEL_VERSION(2, 6, 35))
  1875. if (rcu_dereference(adapter->pnetdev->rx_handler_data))
  1876. #endif // (LINUX_VERSION_CODE <= KERNEL_VERSION(2, 6, 35))
  1877. {
  1878. struct net_device *br_netdev;
  1879. #if (LINUX_VERSION_CODE < KERNEL_VERSION(2,6,24))
  1880. br_netdev = dev_get_by_name(CONFIG_BR_EXT_BRNAME);
  1881. #else // (LINUX_VERSION_CODE < KERNEL_VERSION(2,6,24))
  1882. struct net *devnet = NULL;
  1883. #if (LINUX_VERSION_CODE < KERNEL_VERSION(2,6,26))
  1884. devnet = netdev->nd_net;
  1885. #else // (LINUX_VERSION_CODE < KERNEL_VERSION(2,6,26))
  1886. devnet = dev_net(netdev);
  1887. #endif // (LINUX_VERSION_CODE < KERNEL_VERSION(2,6,26))
  1888. br_netdev = dev_get_by_name(devnet, CONFIG_BR_EXT_BRNAME);
  1889. #endif // (LINUX_VERSION_CODE < KERNEL_VERSION(2,6,24))
  1890. if (br_netdev) {
  1891. memcpy(adapter->br_mac, br_netdev->dev_addr, ETH_ALEN);
  1892. dev_put(br_netdev);
  1893. } else
  1894. printk("%s()-%d: dev_get_by_name(%s) failed!", __FUNCTION__, __LINE__, CONFIG_BR_EXT_BRNAME);
  1895. }
  1896. adapter->ethBrExtInfo.addPPPoETag = 1;
  1897. }
  1898. #if (LINUX_VERSION_CODE > KERNEL_VERSION(2, 6, 35))
  1899. rcu_read_unlock();
  1900. #endif // (LINUX_VERSION_CODE > KERNEL_VERSION(2, 6, 35))
  1901. }
  1902. #endif //CONFIG_BR_EXT
  1903. static int _rtw_drv_register_netdev(_adapter *padapter, char *name)
  1904. {
  1905. int ret = _SUCCESS;
  1906. struct net_device *pnetdev = padapter->pnetdev;
  1907. /* alloc netdev name */
  1908. rtw_init_netdev_name(pnetdev, name);
  1909. _rtw_memcpy(pnetdev->dev_addr, padapter->eeprompriv.mac_addr, ETH_ALEN);
  1910. /* Tell the network stack we exist */
  1911. if (register_netdev(pnetdev) != 0) {
  1912. DBG_871X(FUNC_NDEV_FMT "Failed!\n", FUNC_NDEV_ARG(pnetdev));
  1913. ret = _FAIL;
  1914. goto error_register_netdev;
  1915. }
  1916. DBG_871X("%s, MAC Address (if%d) = " MAC_FMT "\n", __FUNCTION__, (padapter->iface_id+1), MAC_ARG(pnetdev->dev_addr));
  1917. return ret;
  1918. error_register_netdev:
  1919. if(padapter->iface_id > IFACE_ID0)
  1920. {
  1921. rtw_free_drv_sw(padapter);
  1922. rtw_free_netdev(pnetdev);
  1923. }
  1924. return ret;
  1925. }
  1926. int rtw_drv_register_netdev(_adapter *if1)
  1927. {
  1928. int i, status = _SUCCESS;
  1929. struct dvobj_priv *dvobj = if1->dvobj;
  1930. if(dvobj->iface_nums < IFACE_ID_MAX)
  1931. {
  1932. for(i=0; i<dvobj->iface_nums; i++)
  1933. {
  1934. _adapter *padapter = dvobj->padapters[i];
  1935. if(padapter)
  1936. {
  1937. char *name;
  1938. if(padapter->iface_id == IFACE_ID0)
  1939. name = if1->registrypriv.ifname;
  1940. else if(padapter->iface_id == IFACE_ID1)
  1941. name = if1->registrypriv.if2name;
  1942. else
  1943. name = "wlan%d";
  1944. if((status = _rtw_drv_register_netdev(padapter, name)) != _SUCCESS) {
  1945. break;
  1946. }
  1947. }
  1948. }
  1949. }
  1950. return status;
  1951. }
  1952. int _netdev_open(struct net_device *pnetdev)
  1953. {
  1954. uint status;
  1955. _adapter *padapter = (_adapter *)rtw_netdev_priv(pnetdev);
  1956. struct pwrctrl_priv *pwrctrlpriv = &padapter->pwrctrlpriv;
  1957. RT_TRACE(_module_os_intfs_c_,_drv_info_,("+871x_drv - dev_open\n"));
  1958. DBG_871X("+871x_drv - drv_open, bup=%d\n", padapter->bup);
  1959. if(pwrctrlpriv->ps_flag == _TRUE){
  1960. padapter->net_closed = _FALSE;
  1961. goto netdev_open_normal_process;
  1962. }
  1963. if(padapter->bup == _FALSE)
  1964. {
  1965. padapter->bDriverStopped = _FALSE;
  1966. padapter->bSurpriseRemoved = _FALSE;
  1967. padapter->bCardDisableWOHSM = _FALSE;
  1968. status = rtw_hal_init(padapter);
  1969. if (status ==_FAIL)
  1970. {
  1971. RT_TRACE(_module_os_intfs_c_,_drv_err_,("rtl871x_hal_init(): Can't init h/w!\n"));
  1972. goto netdev_open_error;
  1973. }
  1974. DBG_871X("MAC Address = "MAC_FMT"\n", MAC_ARG(pnetdev->dev_addr));
  1975. status=rtw_start_drv_threads(padapter);
  1976. if(status ==_FAIL)
  1977. {
  1978. DBG_871X("Initialize driver software resource Failed!\n");
  1979. goto netdev_open_error;
  1980. }
  1981. if (init_hw_mlme_ext(padapter) == _FAIL)
  1982. {
  1983. DBG_871X("can't init mlme_ext_priv\n");
  1984. goto netdev_open_error;
  1985. }
  1986. #ifdef CONFIG_DRVEXT_MODULE
  1987. init_drvext(padapter);
  1988. #endif
  1989. if(padapter->intf_start)
  1990. {
  1991. padapter->intf_start(padapter);
  1992. }
  1993. #ifndef RTK_DMP_PLATFORM
  1994. rtw_proc_init_one(pnetdev);
  1995. #endif
  1996. #ifdef CONFIG_IOCTL_CFG80211
  1997. rtw_cfg80211_init_wiphy(padapter);
  1998. #endif
  1999. rtw_led_control(padapter, LED_CTL_NO_LINK);
  2000. padapter->bup = _TRUE;
  2001. }
  2002. padapter->net_closed = _FALSE;
  2003. _set_timer(&padapter->mlmepriv.dynamic_chk_timer, 2000);
  2004. padapter->pwrctrlpriv.bips_processing = _FALSE;
  2005. rtw_set_pwr_state_check_timer(&padapter->pwrctrlpriv);
  2006. //netif_carrier_on(pnetdev);//call this func when rtw_joinbss_event_callback return success
  2007. if(!rtw_netif_queue_stopped(pnetdev))
  2008. rtw_netif_start_queue(pnetdev);
  2009. else
  2010. rtw_netif_wake_queue(pnetdev);
  2011. #ifdef CONFIG_BR_EXT
  2012. netdev_br_init(pnetdev);
  2013. #endif // CONFIG_BR_EXT
  2014. netdev_open_normal_process:
  2015. #ifdef CONFIG_CONCURRENT_MODE
  2016. {
  2017. _adapter *sec_adapter = padapter->pbuddy_adapter;
  2018. if(sec_adapter && (sec_adapter->bup == _FALSE || sec_adapter->hw_init_completed == _FALSE))
  2019. _netdev_if2_open(sec_adapter->pnetdev);
  2020. }
  2021. #endif
  2022. RT_TRACE(_module_os_intfs_c_,_drv_info_,("-871x_drv - dev_open\n"));
  2023. DBG_871X("-871x_drv - drv_open, bup=%d\n", padapter->bup);
  2024. return 0;
  2025. netdev_open_error:
  2026. padapter->bup = _FALSE;
  2027. netif_carrier_off(pnetdev);
  2028. rtw_netif_stop_queue(pnetdev);
  2029. RT_TRACE(_module_os_intfs_c_,_drv_err_,("-871x_drv - dev_open, fail!\n"));
  2030. DBG_871X("-871x_drv - drv_open fail, bup=%d\n", padapter->bup);
  2031. return (-1);
  2032. }
  2033. int netdev_open(struct net_device *pnetdev)
  2034. {
  2035. int ret;
  2036. _adapter *padapter = (_adapter *)rtw_netdev_priv(pnetdev);
  2037. _enter_critical_mutex(&(adapter_to_dvobj(padapter)->hw_init_mutex), NULL);
  2038. ret = _netdev_open(pnetdev);
  2039. _exit_critical_mutex(&(adapter_to_dvobj(padapter)->hw_init_mutex), NULL);
  2040. return ret;
  2041. }
  2042. #ifdef CONFIG_IPS
  2043. int ips_netdrv_open(_adapter *padapter)
  2044. {
  2045. int status = _SUCCESS;
  2046. padapter->net_closed = _FALSE;
  2047. DBG_871X("===> %s.........\n",__FUNCTION__);
  2048. padapter->bDriverStopped = _FALSE;
  2049. padapter->bSurpriseRemoved = _FALSE;
  2050. padapter->bCardDisableWOHSM = _FALSE;
  2051. //padapter->bup = _TRUE;
  2052. status = rtw_hal_init(padapter);
  2053. if (status ==_FAIL)
  2054. {
  2055. RT_TRACE(_module_os_intfs_c_,_drv_err_,("ips_netdrv_open(): Can't init h/w!\n"));
  2056. goto netdev_open_error;
  2057. }
  2058. if(padapter->intf_start)
  2059. {
  2060. padapter->intf_start(padapter);
  2061. }
  2062. rtw_set_pwr_state_check_timer(&padapter->pwrctrlpriv);
  2063. _set_timer(&padapter->mlmepriv.dynamic_chk_timer,5000);
  2064. return _SUCCESS;
  2065. netdev_open_error:
  2066. //padapter->bup = _FALSE;
  2067. DBG_871X("-ips_netdrv_open - drv_open failure, bup=%d\n", padapter->bup);
  2068. return _FAIL;
  2069. }
  2070. int rtw_ips_pwr_up(_adapter *padapter)
  2071. {
  2072. int result;
  2073. u32 start_time = rtw_get_current_time();
  2074. DBG_871X("===> rtw_ips_pwr_up..............\n");
  2075. rtw_reset_drv_sw(padapter);
  2076. result = ips_netdrv_open(padapter);
  2077. rtw_led_control(padapter, LED_CTL_NO_LINK);
  2078. DBG_871X("<=== rtw_ips_pwr_up.............. in %dms\n", rtw_get_passing_time_ms(start_time));
  2079. return result;
  2080. }
  2081. void rtw_ips_pwr_down(_adapter *padapter)
  2082. {
  2083. u32 start_time = rtw_get_current_time();
  2084. DBG_871X("===> rtw_ips_pwr_down...................\n");
  2085. padapter->bCardDisableWOHSM = _TRUE;
  2086. padapter->net_closed = _TRUE;
  2087. rtw_ips_dev_unload(padapter);
  2088. padapter->bCardDisableWOHSM = _FALSE;
  2089. DBG_871X("<=== rtw_ips_pwr_down..................... in %dms\n", rtw_get_passing_time_ms(start_time));
  2090. }
  2091. #endif
  2092. void rtw_ips_dev_unload(_adapter *padapter)
  2093. {
  2094. struct net_device *pnetdev= (struct net_device*)padapter->pnetdev;
  2095. struct xmit_priv *pxmitpriv = &(padapter->xmitpriv);
  2096. DBG_871X("====> %s...\n",__FUNCTION__);
  2097. rtw_hal_set_hwreg(padapter, HW_VAR_FIFO_CLEARN_UP, 0);
  2098. if(padapter->intf_stop)
  2099. {
  2100. padapter->intf_stop(padapter);
  2101. }
  2102. //s5.
  2103. if(padapter->bSurpriseRemoved == _FALSE)
  2104. {
  2105. rtw_hal_deinit(padapter);
  2106. }
  2107. }
  2108. int pm_netdev_open(struct net_device *pnetdev,u8 bnormal)
  2109. {
  2110. int status;
  2111. if (_TRUE == bnormal)
  2112. status = netdev_open(pnetdev);
  2113. #ifdef CONFIG_IPS
  2114. else
  2115. status = (_SUCCESS == ips_netdrv_open((_adapter *)rtw_netdev_priv(pnetdev)))?(0):(-1);
  2116. #endif
  2117. return status;
  2118. }
  2119. static int netdev_close(struct net_device *pnetdev)
  2120. {
  2121. _adapter *padapter = (_adapter *)rtw_netdev_priv(pnetdev);
  2122. RT_TRACE(_module_os_intfs_c_,_drv_info_,("+871x_drv - drv_close\n"));
  2123. if(padapter->pwrctrlpriv.bInternalAutoSuspend == _TRUE)
  2124. {
  2125. //rtw_pwr_wakeup(padapter);
  2126. if(padapter->pwrctrlpriv.rf_pwrstate == rf_off)
  2127. padapter->pwrctrlpriv.ps_flag = _TRUE;
  2128. }
  2129. padapter->net_closed = _TRUE;
  2130. /* if(!padapter->hw_init_completed)
  2131. {
  2132. DBG_871X("(1)871x_drv - drv_close, bup=%d, hw_init_completed=%d\n", padapter->bup, padapter->hw_init_completed);
  2133. padapter->bDriverStopped = _TRUE;
  2134. rtw_dev_unload(padapter);
  2135. }
  2136. else*/
  2137. if(padapter->pwrctrlpriv.rf_pwrstate == rf_on){
  2138. DBG_871X("(2)871x_drv - drv_close, bup=%d, hw_init_completed=%d\n", padapter->bup, padapter->hw_init_completed);
  2139. //s1.
  2140. if(pnetdev)
  2141. {
  2142. if (!rtw_netif_queue_stopped(pnetdev))
  2143. rtw_netif_stop_queue(pnetdev);
  2144. }
  2145. #ifndef CONFIG_ANDROID
  2146. //s2.
  2147. LeaveAllPowerSaveMode(padapter);
  2148. rtw_disassoc_cmd(padapter, 500, _FALSE);
  2149. //s2-2. indicate disconnect to os
  2150. rtw_indicate_disconnect(padapter);
  2151. //s2-3.
  2152. rtw_free_assoc_resources(padapter, 1);
  2153. //s2-4.
  2154. rtw_free_network_queue(padapter,_TRUE);
  2155. #endif
  2156. // Close LED
  2157. rtw_led_control(padapter, LED_CTL_POWER_OFF);
  2158. }
  2159. #ifdef CONFIG_BR_EXT
  2160. //if (OPMODE & (WIFI_STATION_STATE | WIFI_ADHOC_STATE))
  2161. {
  2162. //void nat25_db_cleanup(_adapter *priv);
  2163. nat25_db_cleanup(padapter);
  2164. }
  2165. #endif // CONFIG_BR_EXT
  2166. #ifdef CONFIG_P2P
  2167. #ifdef CONFIG_IOCTL_CFG80211
  2168. if( padapter->wdinfo.driver_interface == DRIVER_CFG80211 )
  2169. {
  2170. if(wdev_to_priv(padapter->rtw_wdev)->p2p_enabled == _TRUE)
  2171. wdev_to_priv(padapter->rtw_wdev)->p2p_enabled = _FALSE;
  2172. }
  2173. #endif //CONFIG_IOCTL_CFG80211
  2174. rtw_p2p_enable(padapter, P2P_ROLE_DISABLE);
  2175. #endif //CONFIG_P2P
  2176. #ifdef CONFIG_IOCTL_CFG80211
  2177. rtw_scan_abort(padapter);
  2178. wdev_to_priv(padapter->rtw_wdev)->bandroid_scan = _FALSE;
  2179. padapter->rtw_wdev->iftype = NL80211_IFTYPE_MONITOR; //set this at the end
  2180. #endif //CONFIG_IOCTL_CFG80211
  2181. #ifdef CONFIG_WAPI_SUPPORT
  2182. rtw_wapi_disable_tx(padapter);
  2183. #endif
  2184. RT_TRACE(_module_os_intfs_c_,_drv_info_,("-871x_drv - drv_close\n"));
  2185. DBG_871X("-871x_drv - drv_close, bup=%d\n", padapter->bup);
  2186. return 0;
  2187. }
  2188. void rtw_ndev_destructor(struct net_device *ndev)
  2189. {
  2190. DBG_871X(FUNC_NDEV_FMT"\n", FUNC_NDEV_ARG(ndev));
  2191. #ifdef CONFIG_IOCTL_CFG80211
  2192. if (ndev->ieee80211_ptr)
  2193. rtw_mfree((u8 *)ndev->ieee80211_ptr, sizeof(struct wireless_dev));
  2194. #endif
  2195. free_netdev(ndev);
  2196. }