os_intfs.c 72 KB

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