pci.c 66 KB

1234567891011121314151617181920212223242526272829303132333435363738394041424344454647484950515253545556575859606162636465666768697071727374757677787980818283848586878889909192939495969798991001011021031041051061071081091101111121131141151161171181191201211221231241251261271281291301311321331341351361371381391401411421431441451461471481491501511521531541551561571581591601611621631641651661671681691701711721731741751761771781791801811821831841851861871881891901911921931941951961971981992002012022032042052062072082092102112122132142152162172182192202212222232242252262272282292302312322332342352362372382392402412422432442452462472482492502512522532542552562572582592602612622632642652662672682692702712722732742752762772782792802812822832842852862872882892902912922932942952962972982993003013023033043053063073083093103113123133143153163173183193203213223233243253263273283293303313323333343353363373383393403413423433443453463473483493503513523533543553563573583593603613623633643653663673683693703713723733743753763773783793803813823833843853863873883893903913923933943953963973983994004014024034044054064074084094104114124134144154164174184194204214224234244254264274284294304314324334344354364374384394404414424434444454464474484494504514524534544554564574584594604614624634644654664674684694704714724734744754764774784794804814824834844854864874884894904914924934944954964974984995005015025035045055065075085095105115125135145155165175185195205215225235245255265275285295305315325335345355365375385395405415425435445455465475485495505515525535545555565575585595605615625635645655665675685695705715725735745755765775785795805815825835845855865875885895905915925935945955965975985996006016026036046056066076086096106116126136146156166176186196206216226236246256266276286296306316326336346356366376386396406416426436446456466476486496506516526536546556566576586596606616626636646656666676686696706716726736746756766776786796806816826836846856866876886896906916926936946956966976986997007017027037047057067077087097107117127137147157167177187197207217227237247257267277287297307317327337347357367377387397407417427437447457467477487497507517527537547557567577587597607617627637647657667677687697707717727737747757767777787797807817827837847857867877887897907917927937947957967977987998008018028038048058068078088098108118128138148158168178188198208218228238248258268278288298308318328338348358368378388398408418428438448458468478488498508518528538548558568578588598608618628638648658668678688698708718728738748758768778788798808818828838848858868878888898908918928938948958968978988999009019029039049059069079089099109119129139149159169179189199209219229239249259269279289299309319329339349359369379389399409419429439449459469479489499509519529539549559569579589599609619629639649659669679689699709719729739749759769779789799809819829839849859869879889899909919929939949959969979989991000100110021003100410051006100710081009101010111012101310141015101610171018101910201021102210231024102510261027102810291030103110321033103410351036103710381039104010411042104310441045104610471048104910501051105210531054105510561057105810591060106110621063106410651066106710681069107010711072107310741075107610771078107910801081108210831084108510861087108810891090109110921093109410951096109710981099110011011102110311041105110611071108110911101111111211131114111511161117111811191120112111221123112411251126112711281129113011311132113311341135113611371138113911401141114211431144114511461147114811491150115111521153115411551156115711581159116011611162116311641165116611671168116911701171117211731174117511761177117811791180118111821183118411851186118711881189119011911192119311941195119611971198119912001201120212031204120512061207120812091210121112121213121412151216121712181219122012211222122312241225122612271228122912301231123212331234123512361237123812391240124112421243124412451246124712481249125012511252125312541255125612571258125912601261126212631264126512661267126812691270127112721273127412751276127712781279128012811282128312841285128612871288128912901291129212931294129512961297129812991300130113021303130413051306130713081309131013111312131313141315131613171318131913201321132213231324132513261327132813291330133113321333133413351336133713381339134013411342134313441345134613471348134913501351135213531354135513561357135813591360136113621363136413651366136713681369137013711372137313741375137613771378137913801381138213831384138513861387138813891390139113921393139413951396139713981399140014011402140314041405140614071408140914101411141214131414141514161417141814191420142114221423142414251426142714281429143014311432143314341435143614371438143914401441144214431444144514461447144814491450145114521453145414551456145714581459146014611462146314641465146614671468146914701471147214731474147514761477147814791480148114821483148414851486148714881489149014911492149314941495149614971498149915001501150215031504150515061507150815091510151115121513151415151516151715181519152015211522152315241525152615271528152915301531153215331534153515361537153815391540154115421543154415451546154715481549155015511552155315541555155615571558155915601561156215631564156515661567156815691570157115721573157415751576157715781579158015811582158315841585158615871588158915901591159215931594159515961597159815991600160116021603160416051606160716081609161016111612161316141615161616171618161916201621162216231624162516261627162816291630163116321633163416351636163716381639164016411642164316441645164616471648164916501651165216531654165516561657165816591660166116621663166416651666166716681669167016711672167316741675167616771678167916801681168216831684168516861687168816891690169116921693169416951696169716981699170017011702170317041705170617071708170917101711171217131714171517161717171817191720172117221723172417251726172717281729173017311732173317341735173617371738173917401741174217431744174517461747174817491750175117521753175417551756175717581759176017611762176317641765176617671768176917701771177217731774177517761777177817791780178117821783178417851786178717881789179017911792179317941795179617971798179918001801180218031804180518061807180818091810181118121813181418151816181718181819182018211822182318241825182618271828182918301831183218331834183518361837183818391840184118421843184418451846184718481849185018511852185318541855185618571858185918601861186218631864186518661867186818691870187118721873187418751876187718781879188018811882188318841885188618871888188918901891189218931894189518961897189818991900190119021903190419051906190719081909191019111912191319141915191619171918191919201921192219231924192519261927192819291930193119321933193419351936193719381939194019411942194319441945194619471948194919501951195219531954195519561957195819591960196119621963196419651966196719681969197019711972197319741975197619771978197919801981198219831984198519861987198819891990199119921993199419951996199719981999200020012002200320042005200620072008200920102011201220132014201520162017201820192020202120222023202420252026202720282029203020312032203320342035203620372038203920402041204220432044204520462047204820492050205120522053205420552056205720582059206020612062206320642065206620672068206920702071207220732074207520762077207820792080208120822083208420852086208720882089209020912092209320942095209620972098209921002101210221032104210521062107210821092110211121122113211421152116211721182119212021212122212321242125212621272128212921302131213221332134213521362137213821392140214121422143214421452146214721482149215021512152215321542155215621572158215921602161216221632164216521662167216821692170217121722173217421752176217721782179218021812182218321842185218621872188218921902191219221932194219521962197219821992200220122022203220422052206220722082209221022112212221322142215221622172218221922202221222222232224222522262227222822292230223122322233223422352236223722382239224022412242224322442245224622472248224922502251225222532254225522562257225822592260226122622263226422652266226722682269227022712272227322742275227622772278227922802281228222832284228522862287228822892290229122922293229422952296229722982299230023012302230323042305230623072308230923102311231223132314231523162317231823192320232123222323232423252326232723282329233023312332233323342335233623372338233923402341234223432344234523462347234823492350235123522353235423552356235723582359236023612362236323642365236623672368236923702371237223732374237523762377237823792380238123822383238423852386238723882389239023912392239323942395239623972398239924002401240224032404240524062407240824092410241124122413241424152416241724182419242024212422242324242425242624272428242924302431243224332434243524362437243824392440244124422443
  1. /******************************************************************************
  2. *
  3. * Copyright(c) 2009-2012 Realtek Corporation.
  4. *
  5. * This program is free software; you can redistribute it and/or modify it
  6. * under the terms of version 2 of the GNU General Public License as
  7. * published by the Free Software Foundation.
  8. *
  9. * This program is distributed in the hope that it will be useful, but WITHOUT
  10. * ANY WARRANTY; without even the implied warranty of MERCHANTABILITY or
  11. * FITNESS FOR A PARTICULAR PURPOSE. See the GNU General Public License for
  12. * more details.
  13. *
  14. * The full GNU General Public License is included in this distribution in the
  15. * file called LICENSE.
  16. *
  17. * Contact Information:
  18. * wlanfae <wlanfae@realtek.com>
  19. * Realtek Corporation, No. 2, Innovation Road II, Hsinchu Science Park,
  20. * Hsinchu 300, Taiwan.
  21. *
  22. * Larry Finger <Larry.Finger@lwfinger.net>
  23. *
  24. *****************************************************************************/
  25. #include "wifi.h"
  26. #include "core.h"
  27. #include "pci.h"
  28. #include "base.h"
  29. #include "ps.h"
  30. #include "efuse.h"
  31. #include <linux/interrupt.h>
  32. #include <linux/export.h>
  33. #include <linux/kmemleak.h>
  34. #include <linux/module.h>
  35. MODULE_AUTHOR("lizhaoming <chaoming_li@realsil.com.cn>");
  36. MODULE_AUTHOR("Realtek WlanFAE <wlanfae@realtek.com>");
  37. MODULE_AUTHOR("Larry Finger <Larry.FInger@lwfinger.net>");
  38. MODULE_LICENSE("GPL");
  39. MODULE_DESCRIPTION("PCI basic driver for rtlwifi");
  40. static const u16 pcibridge_vendors[PCI_BRIDGE_VENDOR_MAX] = {
  41. INTEL_VENDOR_ID,
  42. ATI_VENDOR_ID,
  43. AMD_VENDOR_ID,
  44. SIS_VENDOR_ID
  45. };
  46. static const u8 ac_to_hwq[] = {
  47. VO_QUEUE,
  48. VI_QUEUE,
  49. BE_QUEUE,
  50. BK_QUEUE
  51. };
  52. static u8 _rtl_mac_to_hwqueue(struct ieee80211_hw *hw,
  53. struct sk_buff *skb)
  54. {
  55. struct rtl_hal *rtlhal = rtl_hal(rtl_priv(hw));
  56. __le16 fc = rtl_get_fc(skb);
  57. u8 queue_index = skb_get_queue_mapping(skb);
  58. if (unlikely(ieee80211_is_beacon(fc)))
  59. return BEACON_QUEUE;
  60. if (ieee80211_is_mgmt(fc) || ieee80211_is_ctl(fc))
  61. return MGNT_QUEUE;
  62. if (rtlhal->hw_type == HARDWARE_TYPE_RTL8192SE)
  63. if (ieee80211_is_nullfunc(fc))
  64. return HIGH_QUEUE;
  65. return ac_to_hwq[queue_index];
  66. }
  67. /* Update PCI dependent default settings*/
  68. static void _rtl_pci_update_default_setting(struct ieee80211_hw *hw)
  69. {
  70. struct rtl_priv *rtlpriv = rtl_priv(hw);
  71. struct rtl_pci_priv *pcipriv = rtl_pcipriv(hw);
  72. struct rtl_ps_ctl *ppsc = rtl_psc(rtl_priv(hw));
  73. struct rtl_pci *rtlpci = rtl_pcidev(rtl_pcipriv(hw));
  74. u8 pcibridge_vendor = pcipriv->ndis_adapter.pcibridge_vendor;
  75. u8 init_aspm;
  76. ppsc->reg_rfps_level = 0;
  77. ppsc->support_aspm = false;
  78. /*Update PCI ASPM setting */
  79. ppsc->const_amdpci_aspm = rtlpci->const_amdpci_aspm;
  80. switch (rtlpci->const_pci_aspm) {
  81. case 0:
  82. /*No ASPM */
  83. break;
  84. case 1:
  85. /*ASPM dynamically enabled/disable. */
  86. ppsc->reg_rfps_level |= RT_RF_LPS_LEVEL_ASPM;
  87. break;
  88. case 2:
  89. /*ASPM with Clock Req dynamically enabled/disable. */
  90. ppsc->reg_rfps_level |= (RT_RF_LPS_LEVEL_ASPM |
  91. RT_RF_OFF_LEVL_CLK_REQ);
  92. break;
  93. case 3:
  94. /*
  95. * Always enable ASPM and Clock Req
  96. * from initialization to halt.
  97. * */
  98. ppsc->reg_rfps_level &= ~(RT_RF_LPS_LEVEL_ASPM);
  99. ppsc->reg_rfps_level |= (RT_RF_PS_LEVEL_ALWAYS_ASPM |
  100. RT_RF_OFF_LEVL_CLK_REQ);
  101. break;
  102. case 4:
  103. /*
  104. * Always enable ASPM without Clock Req
  105. * from initialization to halt.
  106. * */
  107. ppsc->reg_rfps_level &= ~(RT_RF_LPS_LEVEL_ASPM |
  108. RT_RF_OFF_LEVL_CLK_REQ);
  109. ppsc->reg_rfps_level |= RT_RF_PS_LEVEL_ALWAYS_ASPM;
  110. break;
  111. }
  112. ppsc->reg_rfps_level |= RT_RF_OFF_LEVL_HALT_NIC;
  113. /*Update Radio OFF setting */
  114. switch (rtlpci->const_hwsw_rfoff_d3) {
  115. case 1:
  116. if (ppsc->reg_rfps_level & RT_RF_LPS_LEVEL_ASPM)
  117. ppsc->reg_rfps_level |= RT_RF_OFF_LEVL_ASPM;
  118. break;
  119. case 2:
  120. if (ppsc->reg_rfps_level & RT_RF_LPS_LEVEL_ASPM)
  121. ppsc->reg_rfps_level |= RT_RF_OFF_LEVL_ASPM;
  122. ppsc->reg_rfps_level |= RT_RF_OFF_LEVL_HALT_NIC;
  123. break;
  124. case 3:
  125. ppsc->reg_rfps_level |= RT_RF_OFF_LEVL_PCI_D3;
  126. break;
  127. }
  128. /*Set HW definition to determine if it supports ASPM. */
  129. switch (rtlpci->const_support_pciaspm) {
  130. case 0:{
  131. /*Not support ASPM. */
  132. bool support_aspm = false;
  133. ppsc->support_aspm = support_aspm;
  134. break;
  135. }
  136. case 1:{
  137. /*Support ASPM. */
  138. bool support_aspm = true;
  139. bool support_backdoor = true;
  140. ppsc->support_aspm = support_aspm;
  141. /*if (priv->oem_id == RT_CID_TOSHIBA &&
  142. !priv->ndis_adapter.amd_l1_patch)
  143. support_backdoor = false; */
  144. ppsc->support_backdoor = support_backdoor;
  145. break;
  146. }
  147. case 2:
  148. /*ASPM value set by chipset. */
  149. if (pcibridge_vendor == PCI_BRIDGE_VENDOR_INTEL) {
  150. bool support_aspm = true;
  151. ppsc->support_aspm = support_aspm;
  152. }
  153. break;
  154. default:
  155. pr_err("switch case %#x not processed\n",
  156. rtlpci->const_support_pciaspm);
  157. break;
  158. }
  159. /* toshiba aspm issue, toshiba will set aspm selfly
  160. * so we should not set aspm in driver */
  161. pci_read_config_byte(rtlpci->pdev, 0x80, &init_aspm);
  162. if (rtlpriv->rtlhal.hw_type == HARDWARE_TYPE_RTL8192SE &&
  163. init_aspm == 0x43)
  164. ppsc->support_aspm = false;
  165. }
  166. static bool _rtl_pci_platform_switch_device_pci_aspm(
  167. struct ieee80211_hw *hw,
  168. u8 value)
  169. {
  170. struct rtl_pci *rtlpci = rtl_pcidev(rtl_pcipriv(hw));
  171. struct rtl_hal *rtlhal = rtl_hal(rtl_priv(hw));
  172. if (rtlhal->hw_type != HARDWARE_TYPE_RTL8192SE)
  173. value |= 0x40;
  174. pci_write_config_byte(rtlpci->pdev, 0x80, value);
  175. return false;
  176. }
  177. /*When we set 0x01 to enable clk request. Set 0x0 to disable clk req.*/
  178. static void _rtl_pci_switch_clk_req(struct ieee80211_hw *hw, u8 value)
  179. {
  180. struct rtl_pci *rtlpci = rtl_pcidev(rtl_pcipriv(hw));
  181. struct rtl_hal *rtlhal = rtl_hal(rtl_priv(hw));
  182. pci_write_config_byte(rtlpci->pdev, 0x81, value);
  183. if (rtlhal->hw_type == HARDWARE_TYPE_RTL8192SE)
  184. udelay(100);
  185. }
  186. /*Disable RTL8192SE ASPM & Disable Pci Bridge ASPM*/
  187. static void rtl_pci_disable_aspm(struct ieee80211_hw *hw)
  188. {
  189. struct rtl_priv *rtlpriv = rtl_priv(hw);
  190. struct rtl_pci_priv *pcipriv = rtl_pcipriv(hw);
  191. struct rtl_ps_ctl *ppsc = rtl_psc(rtl_priv(hw));
  192. struct rtl_pci *rtlpci = rtl_pcidev(rtl_pcipriv(hw));
  193. u8 pcibridge_vendor = pcipriv->ndis_adapter.pcibridge_vendor;
  194. u8 num4bytes = pcipriv->ndis_adapter.num4bytes;
  195. /*Retrieve original configuration settings. */
  196. u8 linkctrl_reg = pcipriv->ndis_adapter.linkctrl_reg;
  197. u16 pcibridge_linkctrlreg = pcipriv->ndis_adapter.
  198. pcibridge_linkctrlreg;
  199. u16 aspmlevel = 0;
  200. u8 tmp_u1b = 0;
  201. if (!ppsc->support_aspm)
  202. return;
  203. if (pcibridge_vendor == PCI_BRIDGE_VENDOR_UNKNOWN) {
  204. RT_TRACE(rtlpriv, COMP_POWER, DBG_TRACE,
  205. "PCI(Bridge) UNKNOWN\n");
  206. return;
  207. }
  208. if (ppsc->reg_rfps_level & RT_RF_OFF_LEVL_CLK_REQ) {
  209. RT_CLEAR_PS_LEVEL(ppsc, RT_RF_OFF_LEVL_CLK_REQ);
  210. _rtl_pci_switch_clk_req(hw, 0x0);
  211. }
  212. /*for promising device will in L0 state after an I/O. */
  213. pci_read_config_byte(rtlpci->pdev, 0x80, &tmp_u1b);
  214. /*Set corresponding value. */
  215. aspmlevel |= BIT(0) | BIT(1);
  216. linkctrl_reg &= ~aspmlevel;
  217. pcibridge_linkctrlreg &= ~(BIT(0) | BIT(1));
  218. _rtl_pci_platform_switch_device_pci_aspm(hw, linkctrl_reg);
  219. udelay(50);
  220. /*4 Disable Pci Bridge ASPM */
  221. pci_write_config_byte(rtlpci->pdev, (num4bytes << 2),
  222. pcibridge_linkctrlreg);
  223. udelay(50);
  224. }
  225. /*
  226. *Enable RTL8192SE ASPM & Enable Pci Bridge ASPM for
  227. *power saving We should follow the sequence to enable
  228. *RTL8192SE first then enable Pci Bridge ASPM
  229. *or the system will show bluescreen.
  230. */
  231. static void rtl_pci_enable_aspm(struct ieee80211_hw *hw)
  232. {
  233. struct rtl_priv *rtlpriv = rtl_priv(hw);
  234. struct rtl_pci_priv *pcipriv = rtl_pcipriv(hw);
  235. struct rtl_ps_ctl *ppsc = rtl_psc(rtl_priv(hw));
  236. struct rtl_pci *rtlpci = rtl_pcidev(rtl_pcipriv(hw));
  237. u8 pcibridge_vendor = pcipriv->ndis_adapter.pcibridge_vendor;
  238. u8 num4bytes = pcipriv->ndis_adapter.num4bytes;
  239. u16 aspmlevel;
  240. u8 u_pcibridge_aspmsetting;
  241. u8 u_device_aspmsetting;
  242. if (!ppsc->support_aspm)
  243. return;
  244. if (pcibridge_vendor == PCI_BRIDGE_VENDOR_UNKNOWN) {
  245. RT_TRACE(rtlpriv, COMP_POWER, DBG_TRACE,
  246. "PCI(Bridge) UNKNOWN\n");
  247. return;
  248. }
  249. /*4 Enable Pci Bridge ASPM */
  250. u_pcibridge_aspmsetting =
  251. pcipriv->ndis_adapter.pcibridge_linkctrlreg |
  252. rtlpci->const_hostpci_aspm_setting;
  253. if (pcibridge_vendor == PCI_BRIDGE_VENDOR_INTEL)
  254. u_pcibridge_aspmsetting &= ~BIT(0);
  255. pci_write_config_byte(rtlpci->pdev, (num4bytes << 2),
  256. u_pcibridge_aspmsetting);
  257. RT_TRACE(rtlpriv, COMP_INIT, DBG_LOUD,
  258. "PlatformEnableASPM(): Write reg[%x] = %x\n",
  259. (pcipriv->ndis_adapter.pcibridge_pciehdr_offset + 0x10),
  260. u_pcibridge_aspmsetting);
  261. udelay(50);
  262. /*Get ASPM level (with/without Clock Req) */
  263. aspmlevel = rtlpci->const_devicepci_aspm_setting;
  264. u_device_aspmsetting = pcipriv->ndis_adapter.linkctrl_reg;
  265. /*_rtl_pci_platform_switch_device_pci_aspm(dev,*/
  266. /*(priv->ndis_adapter.linkctrl_reg | ASPMLevel)); */
  267. u_device_aspmsetting |= aspmlevel;
  268. _rtl_pci_platform_switch_device_pci_aspm(hw, u_device_aspmsetting);
  269. if (ppsc->reg_rfps_level & RT_RF_OFF_LEVL_CLK_REQ) {
  270. _rtl_pci_switch_clk_req(hw, (ppsc->reg_rfps_level &
  271. RT_RF_OFF_LEVL_CLK_REQ) ? 1 : 0);
  272. RT_SET_PS_LEVEL(ppsc, RT_RF_OFF_LEVL_CLK_REQ);
  273. }
  274. udelay(100);
  275. }
  276. static bool rtl_pci_get_amd_l1_patch(struct ieee80211_hw *hw)
  277. {
  278. struct rtl_pci *rtlpci = rtl_pcidev(rtl_pcipriv(hw));
  279. bool status = false;
  280. u8 offset_e0;
  281. unsigned offset_e4;
  282. pci_write_config_byte(rtlpci->pdev, 0xe0, 0xa0);
  283. pci_read_config_byte(rtlpci->pdev, 0xe0, &offset_e0);
  284. if (offset_e0 == 0xA0) {
  285. pci_read_config_dword(rtlpci->pdev, 0xe4, &offset_e4);
  286. if (offset_e4 & BIT(23))
  287. status = true;
  288. }
  289. return status;
  290. }
  291. static bool rtl_pci_check_buddy_priv(struct ieee80211_hw *hw,
  292. struct rtl_priv **buddy_priv)
  293. {
  294. struct rtl_priv *rtlpriv = rtl_priv(hw);
  295. struct rtl_pci_priv *pcipriv = rtl_pcipriv(hw);
  296. bool find_buddy_priv = false;
  297. struct rtl_priv *tpriv;
  298. struct rtl_pci_priv *tpcipriv = NULL;
  299. if (!list_empty(&rtlpriv->glb_var->glb_priv_list)) {
  300. list_for_each_entry(tpriv, &rtlpriv->glb_var->glb_priv_list,
  301. list) {
  302. tpcipriv = (struct rtl_pci_priv *)tpriv->priv;
  303. RT_TRACE(rtlpriv, COMP_INIT, DBG_LOUD,
  304. "pcipriv->ndis_adapter.funcnumber %x\n",
  305. pcipriv->ndis_adapter.funcnumber);
  306. RT_TRACE(rtlpriv, COMP_INIT, DBG_LOUD,
  307. "tpcipriv->ndis_adapter.funcnumber %x\n",
  308. tpcipriv->ndis_adapter.funcnumber);
  309. if ((pcipriv->ndis_adapter.busnumber ==
  310. tpcipriv->ndis_adapter.busnumber) &&
  311. (pcipriv->ndis_adapter.devnumber ==
  312. tpcipriv->ndis_adapter.devnumber) &&
  313. (pcipriv->ndis_adapter.funcnumber !=
  314. tpcipriv->ndis_adapter.funcnumber)) {
  315. find_buddy_priv = true;
  316. break;
  317. }
  318. }
  319. }
  320. RT_TRACE(rtlpriv, COMP_INIT, DBG_LOUD,
  321. "find_buddy_priv %d\n", find_buddy_priv);
  322. if (find_buddy_priv)
  323. *buddy_priv = tpriv;
  324. return find_buddy_priv;
  325. }
  326. static void rtl_pci_get_linkcontrol_field(struct ieee80211_hw *hw)
  327. {
  328. struct rtl_pci_priv *pcipriv = rtl_pcipriv(hw);
  329. struct rtl_pci *rtlpci = rtl_pcidev(pcipriv);
  330. u8 capabilityoffset = pcipriv->ndis_adapter.pcibridge_pciehdr_offset;
  331. u8 linkctrl_reg;
  332. u8 num4bbytes;
  333. num4bbytes = (capabilityoffset + 0x10) / 4;
  334. /*Read Link Control Register */
  335. pci_read_config_byte(rtlpci->pdev, (num4bbytes << 2), &linkctrl_reg);
  336. pcipriv->ndis_adapter.pcibridge_linkctrlreg = linkctrl_reg;
  337. }
  338. static void rtl_pci_parse_configuration(struct pci_dev *pdev,
  339. struct ieee80211_hw *hw)
  340. {
  341. struct rtl_priv *rtlpriv = rtl_priv(hw);
  342. struct rtl_pci_priv *pcipriv = rtl_pcipriv(hw);
  343. u8 tmp;
  344. u16 linkctrl_reg;
  345. /*Link Control Register */
  346. pcie_capability_read_word(pdev, PCI_EXP_LNKCTL, &linkctrl_reg);
  347. pcipriv->ndis_adapter.linkctrl_reg = (u8)linkctrl_reg;
  348. RT_TRACE(rtlpriv, COMP_INIT, DBG_TRACE, "Link Control Register =%x\n",
  349. pcipriv->ndis_adapter.linkctrl_reg);
  350. pci_read_config_byte(pdev, 0x98, &tmp);
  351. tmp |= BIT(4);
  352. pci_write_config_byte(pdev, 0x98, tmp);
  353. tmp = 0x17;
  354. pci_write_config_byte(pdev, 0x70f, tmp);
  355. }
  356. static void rtl_pci_init_aspm(struct ieee80211_hw *hw)
  357. {
  358. struct rtl_ps_ctl *ppsc = rtl_psc(rtl_priv(hw));
  359. _rtl_pci_update_default_setting(hw);
  360. if (ppsc->reg_rfps_level & RT_RF_PS_LEVEL_ALWAYS_ASPM) {
  361. /*Always enable ASPM & Clock Req. */
  362. rtl_pci_enable_aspm(hw);
  363. RT_SET_PS_LEVEL(ppsc, RT_RF_PS_LEVEL_ALWAYS_ASPM);
  364. }
  365. }
  366. static void _rtl_pci_io_handler_init(struct device *dev,
  367. struct ieee80211_hw *hw)
  368. {
  369. struct rtl_priv *rtlpriv = rtl_priv(hw);
  370. rtlpriv->io.dev = dev;
  371. rtlpriv->io.write8_async = pci_write8_async;
  372. rtlpriv->io.write16_async = pci_write16_async;
  373. rtlpriv->io.write32_async = pci_write32_async;
  374. rtlpriv->io.read8_sync = pci_read8_sync;
  375. rtlpriv->io.read16_sync = pci_read16_sync;
  376. rtlpriv->io.read32_sync = pci_read32_sync;
  377. }
  378. static bool _rtl_update_earlymode_info(struct ieee80211_hw *hw,
  379. struct sk_buff *skb, struct rtl_tcb_desc *tcb_desc, u8 tid)
  380. {
  381. struct rtl_priv *rtlpriv = rtl_priv(hw);
  382. struct ieee80211_tx_info *info = IEEE80211_SKB_CB(skb);
  383. struct rtl_hal *rtlhal = rtl_hal(rtl_priv(hw));
  384. struct sk_buff *next_skb;
  385. u8 additionlen = FCS_LEN;
  386. /* here open is 4, wep/tkip is 8, aes is 12*/
  387. if (info->control.hw_key)
  388. additionlen += info->control.hw_key->icv_len;
  389. /* The most skb num is 6 */
  390. tcb_desc->empkt_num = 0;
  391. spin_lock_bh(&rtlpriv->locks.waitq_lock);
  392. skb_queue_walk(&rtlpriv->mac80211.skb_waitq[tid], next_skb) {
  393. struct ieee80211_tx_info *next_info;
  394. next_info = IEEE80211_SKB_CB(next_skb);
  395. if (next_info->flags & IEEE80211_TX_CTL_AMPDU) {
  396. tcb_desc->empkt_len[tcb_desc->empkt_num] =
  397. next_skb->len + additionlen;
  398. tcb_desc->empkt_num++;
  399. } else {
  400. break;
  401. }
  402. if (skb_queue_is_last(&rtlpriv->mac80211.skb_waitq[tid],
  403. next_skb))
  404. break;
  405. if (tcb_desc->empkt_num >= rtlhal->max_earlymode_num)
  406. break;
  407. }
  408. spin_unlock_bh(&rtlpriv->locks.waitq_lock);
  409. return true;
  410. }
  411. /* just for early mode now */
  412. static void _rtl_pci_tx_chk_waitq(struct ieee80211_hw *hw)
  413. {
  414. struct rtl_priv *rtlpriv = rtl_priv(hw);
  415. struct rtl_mac *mac = rtl_mac(rtl_priv(hw));
  416. struct rtl_pci *rtlpci = rtl_pcidev(rtl_pcipriv(hw));
  417. struct sk_buff *skb = NULL;
  418. struct ieee80211_tx_info *info = NULL;
  419. struct rtl_hal *rtlhal = rtl_hal(rtl_priv(hw));
  420. int tid;
  421. if (!rtlpriv->rtlhal.earlymode_enable)
  422. return;
  423. if (rtlpriv->dm.supp_phymode_switch &&
  424. (rtlpriv->easy_concurrent_ctl.switch_in_process ||
  425. (rtlpriv->buddy_priv &&
  426. rtlpriv->buddy_priv->easy_concurrent_ctl.switch_in_process)))
  427. return;
  428. /* we juse use em for BE/BK/VI/VO */
  429. for (tid = 7; tid >= 0; tid--) {
  430. u8 hw_queue = ac_to_hwq[rtl_tid_to_ac(tid)];
  431. struct rtl8192_tx_ring *ring = &rtlpci->tx_ring[hw_queue];
  432. while (!mac->act_scanning &&
  433. rtlpriv->psc.rfpwr_state == ERFON) {
  434. struct rtl_tcb_desc tcb_desc;
  435. memset(&tcb_desc, 0, sizeof(struct rtl_tcb_desc));
  436. spin_lock_bh(&rtlpriv->locks.waitq_lock);
  437. if (!skb_queue_empty(&mac->skb_waitq[tid]) &&
  438. (ring->entries - skb_queue_len(&ring->queue) >
  439. rtlhal->max_earlymode_num)) {
  440. skb = skb_dequeue(&mac->skb_waitq[tid]);
  441. } else {
  442. spin_unlock_bh(&rtlpriv->locks.waitq_lock);
  443. break;
  444. }
  445. spin_unlock_bh(&rtlpriv->locks.waitq_lock);
  446. /* Some macaddr can't do early mode. like
  447. * multicast/broadcast/no_qos data */
  448. info = IEEE80211_SKB_CB(skb);
  449. if (info->flags & IEEE80211_TX_CTL_AMPDU)
  450. _rtl_update_earlymode_info(hw, skb,
  451. &tcb_desc, tid);
  452. rtlpriv->intf_ops->adapter_tx(hw, NULL, skb, &tcb_desc);
  453. }
  454. }
  455. }
  456. static void _rtl_pci_tx_isr(struct ieee80211_hw *hw, int prio)
  457. {
  458. struct rtl_priv *rtlpriv = rtl_priv(hw);
  459. struct rtl_pci *rtlpci = rtl_pcidev(rtl_pcipriv(hw));
  460. struct rtl8192_tx_ring *ring = &rtlpci->tx_ring[prio];
  461. while (skb_queue_len(&ring->queue)) {
  462. struct sk_buff *skb;
  463. struct ieee80211_tx_info *info;
  464. __le16 fc;
  465. u8 tid;
  466. u8 *entry;
  467. if (rtlpriv->use_new_trx_flow)
  468. entry = (u8 *)(&ring->buffer_desc[ring->idx]);
  469. else
  470. entry = (u8 *)(&ring->desc[ring->idx]);
  471. if (rtlpriv->cfg->ops->get_available_desc &&
  472. rtlpriv->cfg->ops->get_available_desc(hw, prio) <= 1) {
  473. RT_TRACE(rtlpriv, (COMP_INTR | COMP_SEND), DBG_DMESG,
  474. "no available desc!\n");
  475. return;
  476. }
  477. if (!rtlpriv->cfg->ops->is_tx_desc_closed(hw, prio, ring->idx))
  478. return;
  479. ring->idx = (ring->idx + 1) % ring->entries;
  480. skb = __skb_dequeue(&ring->queue);
  481. pci_unmap_single(rtlpci->pdev,
  482. rtlpriv->cfg->ops->
  483. get_desc((u8 *)entry, true,
  484. HW_DESC_TXBUFF_ADDR),
  485. skb->len, PCI_DMA_TODEVICE);
  486. /* remove early mode header */
  487. if (rtlpriv->rtlhal.earlymode_enable)
  488. skb_pull(skb, EM_HDR_LEN);
  489. RT_TRACE(rtlpriv, (COMP_INTR | COMP_SEND), DBG_TRACE,
  490. "new ring->idx:%d, free: skb_queue_len:%d, free: seq:%x\n",
  491. ring->idx,
  492. skb_queue_len(&ring->queue),
  493. *(u16 *)(skb->data + 22));
  494. if (prio == TXCMD_QUEUE) {
  495. dev_kfree_skb(skb);
  496. goto tx_status_ok;
  497. }
  498. /* for sw LPS, just after NULL skb send out, we can
  499. * sure AP knows we are sleeping, we should not let
  500. * rf sleep
  501. */
  502. fc = rtl_get_fc(skb);
  503. if (ieee80211_is_nullfunc(fc)) {
  504. if (ieee80211_has_pm(fc)) {
  505. rtlpriv->mac80211.offchan_delay = true;
  506. rtlpriv->psc.state_inap = true;
  507. } else {
  508. rtlpriv->psc.state_inap = false;
  509. }
  510. }
  511. if (ieee80211_is_action(fc)) {
  512. struct ieee80211_mgmt *action_frame =
  513. (struct ieee80211_mgmt *)skb->data;
  514. if (action_frame->u.action.u.ht_smps.action ==
  515. WLAN_HT_ACTION_SMPS) {
  516. dev_kfree_skb(skb);
  517. goto tx_status_ok;
  518. }
  519. }
  520. /* update tid tx pkt num */
  521. tid = rtl_get_tid(skb);
  522. if (tid <= 7)
  523. rtlpriv->link_info.tidtx_inperiod[tid]++;
  524. info = IEEE80211_SKB_CB(skb);
  525. ieee80211_tx_info_clear_status(info);
  526. info->flags |= IEEE80211_TX_STAT_ACK;
  527. /*info->status.rates[0].count = 1; */
  528. ieee80211_tx_status_irqsafe(hw, skb);
  529. if ((ring->entries - skb_queue_len(&ring->queue)) <= 4) {
  530. RT_TRACE(rtlpriv, COMP_ERR, DBG_DMESG,
  531. "more desc left, wake skb_queue@%d, ring->idx = %d, skb_queue_len = 0x%x\n",
  532. prio, ring->idx,
  533. skb_queue_len(&ring->queue));
  534. ieee80211_wake_queue(hw,
  535. skb_get_queue_mapping
  536. (skb));
  537. }
  538. tx_status_ok:
  539. skb = NULL;
  540. }
  541. if (((rtlpriv->link_info.num_rx_inperiod +
  542. rtlpriv->link_info.num_tx_inperiod) > 8) ||
  543. (rtlpriv->link_info.num_rx_inperiod > 2))
  544. rtl_lps_leave(hw);
  545. }
  546. static int _rtl_pci_init_one_rxdesc(struct ieee80211_hw *hw,
  547. struct sk_buff *new_skb, u8 *entry,
  548. int rxring_idx, int desc_idx)
  549. {
  550. struct rtl_priv *rtlpriv = rtl_priv(hw);
  551. struct rtl_pci *rtlpci = rtl_pcidev(rtl_pcipriv(hw));
  552. u32 bufferaddress;
  553. u8 tmp_one = 1;
  554. struct sk_buff *skb;
  555. if (likely(new_skb)) {
  556. skb = new_skb;
  557. goto remap;
  558. }
  559. skb = dev_alloc_skb(rtlpci->rxbuffersize);
  560. if (!skb)
  561. return 0;
  562. remap:
  563. /* just set skb->cb to mapping addr for pci_unmap_single use */
  564. *((dma_addr_t *)skb->cb) =
  565. pci_map_single(rtlpci->pdev, skb_tail_pointer(skb),
  566. rtlpci->rxbuffersize, PCI_DMA_FROMDEVICE);
  567. bufferaddress = *((dma_addr_t *)skb->cb);
  568. if (pci_dma_mapping_error(rtlpci->pdev, bufferaddress))
  569. return 0;
  570. rtlpci->rx_ring[rxring_idx].rx_buf[desc_idx] = skb;
  571. if (rtlpriv->use_new_trx_flow) {
  572. rtlpriv->cfg->ops->set_desc(hw, (u8 *)entry, false,
  573. HW_DESC_RX_PREPARE,
  574. (u8 *)&bufferaddress);
  575. } else {
  576. rtlpriv->cfg->ops->set_desc(hw, (u8 *)entry, false,
  577. HW_DESC_RXBUFF_ADDR,
  578. (u8 *)&bufferaddress);
  579. rtlpriv->cfg->ops->set_desc(hw, (u8 *)entry, false,
  580. HW_DESC_RXPKT_LEN,
  581. (u8 *)&rtlpci->rxbuffersize);
  582. rtlpriv->cfg->ops->set_desc(hw, (u8 *)entry, false,
  583. HW_DESC_RXOWN,
  584. (u8 *)&tmp_one);
  585. }
  586. return 1;
  587. }
  588. /* inorder to receive 8K AMSDU we have set skb to
  589. * 9100bytes in init rx ring, but if this packet is
  590. * not a AMSDU, this large packet will be sent to
  591. * TCP/IP directly, this cause big packet ping fail
  592. * like: "ping -s 65507", so here we will realloc skb
  593. * based on the true size of packet, Mac80211
  594. * Probably will do it better, but does not yet.
  595. *
  596. * Some platform will fail when alloc skb sometimes.
  597. * in this condition, we will send the old skb to
  598. * mac80211 directly, this will not cause any other
  599. * issues, but only this packet will be lost by TCP/IP
  600. */
  601. static void _rtl_pci_rx_to_mac80211(struct ieee80211_hw *hw,
  602. struct sk_buff *skb,
  603. struct ieee80211_rx_status rx_status)
  604. {
  605. if (unlikely(!rtl_action_proc(hw, skb, false))) {
  606. dev_kfree_skb_any(skb);
  607. } else {
  608. struct sk_buff *uskb = NULL;
  609. u8 *pdata;
  610. uskb = dev_alloc_skb(skb->len + 128);
  611. if (likely(uskb)) {
  612. memcpy(IEEE80211_SKB_RXCB(uskb), &rx_status,
  613. sizeof(rx_status));
  614. pdata = (u8 *)skb_put(uskb, skb->len);
  615. memcpy(pdata, skb->data, skb->len);
  616. dev_kfree_skb_any(skb);
  617. ieee80211_rx_irqsafe(hw, uskb);
  618. } else {
  619. ieee80211_rx_irqsafe(hw, skb);
  620. }
  621. }
  622. }
  623. /*hsisr interrupt handler*/
  624. static void _rtl_pci_hs_interrupt(struct ieee80211_hw *hw)
  625. {
  626. struct rtl_priv *rtlpriv = rtl_priv(hw);
  627. struct rtl_pci *rtlpci = rtl_pcidev(rtl_pcipriv(hw));
  628. rtl_write_byte(rtlpriv, rtlpriv->cfg->maps[MAC_HSISR],
  629. rtl_read_byte(rtlpriv, rtlpriv->cfg->maps[MAC_HSISR]) |
  630. rtlpci->sys_irq_mask);
  631. }
  632. static void _rtl_pci_rx_interrupt(struct ieee80211_hw *hw)
  633. {
  634. struct rtl_priv *rtlpriv = rtl_priv(hw);
  635. struct rtl_pci *rtlpci = rtl_pcidev(rtl_pcipriv(hw));
  636. int rxring_idx = RTL_PCI_RX_MPDU_QUEUE;
  637. struct ieee80211_rx_status rx_status = { 0 };
  638. unsigned int count = rtlpci->rxringcount;
  639. u8 own;
  640. u8 tmp_one;
  641. bool unicast = false;
  642. u8 hw_queue = 0;
  643. unsigned int rx_remained_cnt;
  644. struct rtl_stats stats = {
  645. .signal = 0,
  646. .rate = 0,
  647. };
  648. /*RX NORMAL PKT */
  649. while (count--) {
  650. struct ieee80211_hdr *hdr;
  651. __le16 fc;
  652. u16 len;
  653. /*rx buffer descriptor */
  654. struct rtl_rx_buffer_desc *buffer_desc = NULL;
  655. /*if use new trx flow, it means wifi info */
  656. struct rtl_rx_desc *pdesc = NULL;
  657. /*rx pkt */
  658. struct sk_buff *skb = rtlpci->rx_ring[rxring_idx].rx_buf[
  659. rtlpci->rx_ring[rxring_idx].idx];
  660. struct sk_buff *new_skb;
  661. if (rtlpriv->use_new_trx_flow) {
  662. rx_remained_cnt =
  663. rtlpriv->cfg->ops->rx_desc_buff_remained_cnt(hw,
  664. hw_queue);
  665. if (rx_remained_cnt == 0)
  666. return;
  667. buffer_desc = &rtlpci->rx_ring[rxring_idx].buffer_desc[
  668. rtlpci->rx_ring[rxring_idx].idx];
  669. pdesc = (struct rtl_rx_desc *)skb->data;
  670. } else { /* rx descriptor */
  671. pdesc = &rtlpci->rx_ring[rxring_idx].desc[
  672. rtlpci->rx_ring[rxring_idx].idx];
  673. own = (u8)rtlpriv->cfg->ops->get_desc((u8 *)pdesc,
  674. false,
  675. HW_DESC_OWN);
  676. if (own) /* wait data to be filled by hardware */
  677. return;
  678. }
  679. /* Reaching this point means: data is filled already
  680. * AAAAAAttention !!!
  681. * We can NOT access 'skb' before 'pci_unmap_single'
  682. */
  683. pci_unmap_single(rtlpci->pdev, *((dma_addr_t *)skb->cb),
  684. rtlpci->rxbuffersize, PCI_DMA_FROMDEVICE);
  685. /* get a new skb - if fail, old one will be reused */
  686. new_skb = dev_alloc_skb(rtlpci->rxbuffersize);
  687. if (unlikely(!new_skb))
  688. goto no_new;
  689. memset(&rx_status , 0 , sizeof(rx_status));
  690. rtlpriv->cfg->ops->query_rx_desc(hw, &stats,
  691. &rx_status, (u8 *)pdesc, skb);
  692. if (rtlpriv->use_new_trx_flow)
  693. rtlpriv->cfg->ops->rx_check_dma_ok(hw,
  694. (u8 *)buffer_desc,
  695. hw_queue);
  696. len = rtlpriv->cfg->ops->get_desc((u8 *)pdesc, false,
  697. HW_DESC_RXPKT_LEN);
  698. if (skb->end - skb->tail > len) {
  699. skb_put(skb, len);
  700. if (rtlpriv->use_new_trx_flow)
  701. skb_reserve(skb, stats.rx_drvinfo_size +
  702. stats.rx_bufshift + 24);
  703. else
  704. skb_reserve(skb, stats.rx_drvinfo_size +
  705. stats.rx_bufshift);
  706. } else {
  707. RT_TRACE(rtlpriv, COMP_ERR, DBG_WARNING,
  708. "skb->end - skb->tail = %d, len is %d\n",
  709. skb->end - skb->tail, len);
  710. dev_kfree_skb_any(skb);
  711. goto new_trx_end;
  712. }
  713. /* handle command packet here */
  714. if (rtlpriv->cfg->ops->rx_command_packet &&
  715. rtlpriv->cfg->ops->rx_command_packet(hw, &stats, skb)) {
  716. dev_kfree_skb_any(skb);
  717. goto new_trx_end;
  718. }
  719. /*
  720. * NOTICE This can not be use for mac80211,
  721. * this is done in mac80211 code,
  722. * if done here sec DHCP will fail
  723. * skb_trim(skb, skb->len - 4);
  724. */
  725. hdr = rtl_get_hdr(skb);
  726. fc = rtl_get_fc(skb);
  727. if (!stats.crc && !stats.hwerror) {
  728. memcpy(IEEE80211_SKB_RXCB(skb), &rx_status,
  729. sizeof(rx_status));
  730. if (is_broadcast_ether_addr(hdr->addr1)) {
  731. ;/*TODO*/
  732. } else if (is_multicast_ether_addr(hdr->addr1)) {
  733. ;/*TODO*/
  734. } else {
  735. unicast = true;
  736. rtlpriv->stats.rxbytesunicast += skb->len;
  737. }
  738. rtl_is_special_data(hw, skb, false, true);
  739. if (ieee80211_is_data(fc)) {
  740. rtlpriv->cfg->ops->led_control(hw, LED_CTL_RX);
  741. if (unicast)
  742. rtlpriv->link_info.num_rx_inperiod++;
  743. }
  744. /* static bcn for roaming */
  745. rtl_beacon_statistic(hw, skb);
  746. rtl_p2p_info(hw, (void *)skb->data, skb->len);
  747. /* for sw lps */
  748. rtl_swlps_beacon(hw, (void *)skb->data, skb->len);
  749. rtl_recognize_peer(hw, (void *)skb->data, skb->len);
  750. if ((rtlpriv->mac80211.opmode == NL80211_IFTYPE_AP) &&
  751. (rtlpriv->rtlhal.current_bandtype ==
  752. BAND_ON_2_4G) &&
  753. (ieee80211_is_beacon(fc) ||
  754. ieee80211_is_probe_resp(fc))) {
  755. dev_kfree_skb_any(skb);
  756. } else {
  757. _rtl_pci_rx_to_mac80211(hw, skb, rx_status);
  758. }
  759. } else {
  760. dev_kfree_skb_any(skb);
  761. }
  762. new_trx_end:
  763. if (rtlpriv->use_new_trx_flow) {
  764. rtlpci->rx_ring[hw_queue].next_rx_rp += 1;
  765. rtlpci->rx_ring[hw_queue].next_rx_rp %=
  766. RTL_PCI_MAX_RX_COUNT;
  767. rx_remained_cnt--;
  768. rtl_write_word(rtlpriv, 0x3B4,
  769. rtlpci->rx_ring[hw_queue].next_rx_rp);
  770. }
  771. if (((rtlpriv->link_info.num_rx_inperiod +
  772. rtlpriv->link_info.num_tx_inperiod) > 8) ||
  773. (rtlpriv->link_info.num_rx_inperiod > 2))
  774. rtl_lps_leave(hw);
  775. skb = new_skb;
  776. no_new:
  777. if (rtlpriv->use_new_trx_flow) {
  778. _rtl_pci_init_one_rxdesc(hw, skb, (u8 *)buffer_desc,
  779. rxring_idx,
  780. rtlpci->rx_ring[rxring_idx].idx);
  781. } else {
  782. _rtl_pci_init_one_rxdesc(hw, skb, (u8 *)pdesc,
  783. rxring_idx,
  784. rtlpci->rx_ring[rxring_idx].idx);
  785. if (rtlpci->rx_ring[rxring_idx].idx ==
  786. rtlpci->rxringcount - 1)
  787. rtlpriv->cfg->ops->set_desc(hw, (u8 *)pdesc,
  788. false,
  789. HW_DESC_RXERO,
  790. (u8 *)&tmp_one);
  791. }
  792. rtlpci->rx_ring[rxring_idx].idx =
  793. (rtlpci->rx_ring[rxring_idx].idx + 1) %
  794. rtlpci->rxringcount;
  795. }
  796. }
  797. static irqreturn_t _rtl_pci_interrupt(int irq, void *dev_id)
  798. {
  799. struct ieee80211_hw *hw = dev_id;
  800. struct rtl_pci *rtlpci = rtl_pcidev(rtl_pcipriv(hw));
  801. struct rtl_priv *rtlpriv = rtl_priv(hw);
  802. struct rtl_hal *rtlhal = rtl_hal(rtl_priv(hw));
  803. unsigned long flags;
  804. u32 inta = 0;
  805. u32 intb = 0;
  806. irqreturn_t ret = IRQ_HANDLED;
  807. if (rtlpci->irq_enabled == 0)
  808. return ret;
  809. spin_lock_irqsave(&rtlpriv->locks.irq_th_lock , flags);
  810. rtlpriv->cfg->ops->disable_interrupt(hw);
  811. /*read ISR: 4/8bytes */
  812. rtlpriv->cfg->ops->interrupt_recognized(hw, &inta, &intb);
  813. /*Shared IRQ or HW disappared */
  814. if (!inta || inta == 0xffff)
  815. goto done;
  816. /*<1> beacon related */
  817. if (inta & rtlpriv->cfg->maps[RTL_IMR_TBDOK]) {
  818. RT_TRACE(rtlpriv, COMP_INTR, DBG_TRACE,
  819. "beacon ok interrupt!\n");
  820. }
  821. if (unlikely(inta & rtlpriv->cfg->maps[RTL_IMR_TBDER])) {
  822. RT_TRACE(rtlpriv, COMP_INTR, DBG_TRACE,
  823. "beacon err interrupt!\n");
  824. }
  825. if (inta & rtlpriv->cfg->maps[RTL_IMR_BDOK]) {
  826. RT_TRACE(rtlpriv, COMP_INTR, DBG_TRACE, "beacon interrupt!\n");
  827. }
  828. if (inta & rtlpriv->cfg->maps[RTL_IMR_BCNINT]) {
  829. RT_TRACE(rtlpriv, COMP_INTR, DBG_TRACE,
  830. "prepare beacon for interrupt!\n");
  831. tasklet_schedule(&rtlpriv->works.irq_prepare_bcn_tasklet);
  832. }
  833. /*<2> Tx related */
  834. if (unlikely(intb & rtlpriv->cfg->maps[RTL_IMR_TXFOVW]))
  835. RT_TRACE(rtlpriv, COMP_ERR, DBG_WARNING, "IMR_TXFOVW!\n");
  836. if (inta & rtlpriv->cfg->maps[RTL_IMR_MGNTDOK]) {
  837. RT_TRACE(rtlpriv, COMP_INTR, DBG_TRACE,
  838. "Manage ok interrupt!\n");
  839. _rtl_pci_tx_isr(hw, MGNT_QUEUE);
  840. }
  841. if (inta & rtlpriv->cfg->maps[RTL_IMR_HIGHDOK]) {
  842. RT_TRACE(rtlpriv, COMP_INTR, DBG_TRACE,
  843. "HIGH_QUEUE ok interrupt!\n");
  844. _rtl_pci_tx_isr(hw, HIGH_QUEUE);
  845. }
  846. if (inta & rtlpriv->cfg->maps[RTL_IMR_BKDOK]) {
  847. rtlpriv->link_info.num_tx_inperiod++;
  848. RT_TRACE(rtlpriv, COMP_INTR, DBG_TRACE,
  849. "BK Tx OK interrupt!\n");
  850. _rtl_pci_tx_isr(hw, BK_QUEUE);
  851. }
  852. if (inta & rtlpriv->cfg->maps[RTL_IMR_BEDOK]) {
  853. rtlpriv->link_info.num_tx_inperiod++;
  854. RT_TRACE(rtlpriv, COMP_INTR, DBG_TRACE,
  855. "BE TX OK interrupt!\n");
  856. _rtl_pci_tx_isr(hw, BE_QUEUE);
  857. }
  858. if (inta & rtlpriv->cfg->maps[RTL_IMR_VIDOK]) {
  859. rtlpriv->link_info.num_tx_inperiod++;
  860. RT_TRACE(rtlpriv, COMP_INTR, DBG_TRACE,
  861. "VI TX OK interrupt!\n");
  862. _rtl_pci_tx_isr(hw, VI_QUEUE);
  863. }
  864. if (inta & rtlpriv->cfg->maps[RTL_IMR_VODOK]) {
  865. rtlpriv->link_info.num_tx_inperiod++;
  866. RT_TRACE(rtlpriv, COMP_INTR, DBG_TRACE,
  867. "Vo TX OK interrupt!\n");
  868. _rtl_pci_tx_isr(hw, VO_QUEUE);
  869. }
  870. if (rtlhal->hw_type == HARDWARE_TYPE_RTL8192SE) {
  871. if (inta & rtlpriv->cfg->maps[RTL_IMR_COMDOK]) {
  872. rtlpriv->link_info.num_tx_inperiod++;
  873. RT_TRACE(rtlpriv, COMP_INTR, DBG_TRACE,
  874. "CMD TX OK interrupt!\n");
  875. _rtl_pci_tx_isr(hw, TXCMD_QUEUE);
  876. }
  877. }
  878. /*<3> Rx related */
  879. if (inta & rtlpriv->cfg->maps[RTL_IMR_ROK]) {
  880. RT_TRACE(rtlpriv, COMP_INTR, DBG_TRACE, "Rx ok interrupt!\n");
  881. _rtl_pci_rx_interrupt(hw);
  882. }
  883. if (unlikely(inta & rtlpriv->cfg->maps[RTL_IMR_RDU])) {
  884. RT_TRACE(rtlpriv, COMP_ERR, DBG_WARNING,
  885. "rx descriptor unavailable!\n");
  886. _rtl_pci_rx_interrupt(hw);
  887. }
  888. if (unlikely(intb & rtlpriv->cfg->maps[RTL_IMR_RXFOVW])) {
  889. RT_TRACE(rtlpriv, COMP_ERR, DBG_WARNING, "rx overflow !\n");
  890. _rtl_pci_rx_interrupt(hw);
  891. }
  892. /*<4> fw related*/
  893. if (rtlhal->hw_type == HARDWARE_TYPE_RTL8723AE) {
  894. if (inta & rtlpriv->cfg->maps[RTL_IMR_C2HCMD]) {
  895. RT_TRACE(rtlpriv, COMP_INTR, DBG_TRACE,
  896. "firmware interrupt!\n");
  897. queue_delayed_work(rtlpriv->works.rtl_wq,
  898. &rtlpriv->works.fwevt_wq, 0);
  899. }
  900. }
  901. /*<5> hsisr related*/
  902. /* Only 8188EE & 8723BE Supported.
  903. * If Other ICs Come in, System will corrupt,
  904. * because maps[RTL_IMR_HSISR_IND] & maps[MAC_HSISR]
  905. * are not initialized
  906. */
  907. if (rtlhal->hw_type == HARDWARE_TYPE_RTL8188EE ||
  908. rtlhal->hw_type == HARDWARE_TYPE_RTL8723BE) {
  909. if (unlikely(inta & rtlpriv->cfg->maps[RTL_IMR_HSISR_IND])) {
  910. RT_TRACE(rtlpriv, COMP_INTR, DBG_TRACE,
  911. "hsisr interrupt!\n");
  912. _rtl_pci_hs_interrupt(hw);
  913. }
  914. }
  915. if (rtlpriv->rtlhal.earlymode_enable)
  916. tasklet_schedule(&rtlpriv->works.irq_tasklet);
  917. done:
  918. rtlpriv->cfg->ops->enable_interrupt(hw);
  919. spin_unlock_irqrestore(&rtlpriv->locks.irq_th_lock, flags);
  920. return ret;
  921. }
  922. static void _rtl_pci_irq_tasklet(struct ieee80211_hw *hw)
  923. {
  924. _rtl_pci_tx_chk_waitq(hw);
  925. }
  926. static void _rtl_pci_prepare_bcn_tasklet(struct ieee80211_hw *hw)
  927. {
  928. struct rtl_priv *rtlpriv = rtl_priv(hw);
  929. struct rtl_pci *rtlpci = rtl_pcidev(rtl_pcipriv(hw));
  930. struct rtl_mac *mac = rtl_mac(rtl_priv(hw));
  931. struct rtl8192_tx_ring *ring = NULL;
  932. struct ieee80211_hdr *hdr = NULL;
  933. struct ieee80211_tx_info *info = NULL;
  934. struct sk_buff *pskb = NULL;
  935. struct rtl_tx_desc *pdesc = NULL;
  936. struct rtl_tcb_desc tcb_desc;
  937. /*This is for new trx flow*/
  938. struct rtl_tx_buffer_desc *pbuffer_desc = NULL;
  939. u8 temp_one = 1;
  940. u8 *entry;
  941. memset(&tcb_desc, 0, sizeof(struct rtl_tcb_desc));
  942. ring = &rtlpci->tx_ring[BEACON_QUEUE];
  943. pskb = __skb_dequeue(&ring->queue);
  944. if (rtlpriv->use_new_trx_flow)
  945. entry = (u8 *)(&ring->buffer_desc[ring->idx]);
  946. else
  947. entry = (u8 *)(&ring->desc[ring->idx]);
  948. if (pskb) {
  949. pci_unmap_single(rtlpci->pdev,
  950. rtlpriv->cfg->ops->get_desc(
  951. (u8 *)entry, true, HW_DESC_TXBUFF_ADDR),
  952. pskb->len, PCI_DMA_TODEVICE);
  953. kfree_skb(pskb);
  954. }
  955. /*NB: the beacon data buffer must be 32-bit aligned. */
  956. pskb = ieee80211_beacon_get(hw, mac->vif);
  957. if (pskb == NULL)
  958. return;
  959. hdr = rtl_get_hdr(pskb);
  960. info = IEEE80211_SKB_CB(pskb);
  961. pdesc = &ring->desc[0];
  962. if (rtlpriv->use_new_trx_flow)
  963. pbuffer_desc = &ring->buffer_desc[0];
  964. rtlpriv->cfg->ops->fill_tx_desc(hw, hdr, (u8 *)pdesc,
  965. (u8 *)pbuffer_desc, info, NULL, pskb,
  966. BEACON_QUEUE, &tcb_desc);
  967. __skb_queue_tail(&ring->queue, pskb);
  968. if (rtlpriv->use_new_trx_flow) {
  969. temp_one = 4;
  970. rtlpriv->cfg->ops->set_desc(hw, (u8 *)pbuffer_desc, true,
  971. HW_DESC_OWN, (u8 *)&temp_one);
  972. } else {
  973. rtlpriv->cfg->ops->set_desc(hw, (u8 *)pdesc, true, HW_DESC_OWN,
  974. &temp_one);
  975. }
  976. return;
  977. }
  978. static void _rtl_pci_init_trx_var(struct ieee80211_hw *hw)
  979. {
  980. struct rtl_pci *rtlpci = rtl_pcidev(rtl_pcipriv(hw));
  981. struct rtl_priv *rtlpriv = rtl_priv(hw);
  982. struct rtl_hal *rtlhal = rtl_hal(rtlpriv);
  983. u8 i;
  984. u16 desc_num;
  985. if (rtlhal->hw_type == HARDWARE_TYPE_RTL8192EE)
  986. desc_num = TX_DESC_NUM_92E;
  987. else
  988. desc_num = RT_TXDESC_NUM;
  989. for (i = 0; i < RTL_PCI_MAX_TX_QUEUE_COUNT; i++)
  990. rtlpci->txringcount[i] = desc_num;
  991. /*
  992. *we just alloc 2 desc for beacon queue,
  993. *because we just need first desc in hw beacon.
  994. */
  995. rtlpci->txringcount[BEACON_QUEUE] = 2;
  996. /*BE queue need more descriptor for performance
  997. *consideration or, No more tx desc will happen,
  998. *and may cause mac80211 mem leakage.
  999. */
  1000. if (!rtl_priv(hw)->use_new_trx_flow)
  1001. rtlpci->txringcount[BE_QUEUE] = RT_TXDESC_NUM_BE_QUEUE;
  1002. rtlpci->rxbuffersize = 9100; /*2048/1024; */
  1003. rtlpci->rxringcount = RTL_PCI_MAX_RX_COUNT; /*64; */
  1004. }
  1005. static void _rtl_pci_init_struct(struct ieee80211_hw *hw,
  1006. struct pci_dev *pdev)
  1007. {
  1008. struct rtl_priv *rtlpriv = rtl_priv(hw);
  1009. struct rtl_mac *mac = rtl_mac(rtl_priv(hw));
  1010. struct rtl_pci *rtlpci = rtl_pcidev(rtl_pcipriv(hw));
  1011. struct rtl_hal *rtlhal = rtl_hal(rtl_priv(hw));
  1012. rtlpci->up_first_time = true;
  1013. rtlpci->being_init_adapter = false;
  1014. rtlhal->hw = hw;
  1015. rtlpci->pdev = pdev;
  1016. /*Tx/Rx related var */
  1017. _rtl_pci_init_trx_var(hw);
  1018. /*IBSS*/
  1019. mac->beacon_interval = 100;
  1020. /*AMPDU*/
  1021. mac->min_space_cfg = 0;
  1022. mac->max_mss_density = 0;
  1023. /*set sane AMPDU defaults */
  1024. mac->current_ampdu_density = 7;
  1025. mac->current_ampdu_factor = 3;
  1026. /*Retry Limit*/
  1027. mac->retry_short = 7;
  1028. mac->retry_long = 7;
  1029. /*QOS*/
  1030. rtlpci->acm_method = EACMWAY2_SW;
  1031. /*task */
  1032. tasklet_init(&rtlpriv->works.irq_tasklet,
  1033. (void (*)(unsigned long))_rtl_pci_irq_tasklet,
  1034. (unsigned long)hw);
  1035. tasklet_init(&rtlpriv->works.irq_prepare_bcn_tasklet,
  1036. (void (*)(unsigned long))_rtl_pci_prepare_bcn_tasklet,
  1037. (unsigned long)hw);
  1038. INIT_WORK(&rtlpriv->works.lps_change_work,
  1039. rtl_lps_change_work_callback);
  1040. }
  1041. static int _rtl_pci_init_tx_ring(struct ieee80211_hw *hw,
  1042. unsigned int prio, unsigned int entries)
  1043. {
  1044. struct rtl_pci *rtlpci = rtl_pcidev(rtl_pcipriv(hw));
  1045. struct rtl_priv *rtlpriv = rtl_priv(hw);
  1046. struct rtl_tx_buffer_desc *buffer_desc;
  1047. struct rtl_tx_desc *desc;
  1048. dma_addr_t buffer_desc_dma, desc_dma;
  1049. u32 nextdescaddress;
  1050. int i;
  1051. /* alloc tx buffer desc for new trx flow*/
  1052. if (rtlpriv->use_new_trx_flow) {
  1053. buffer_desc =
  1054. pci_zalloc_consistent(rtlpci->pdev,
  1055. sizeof(*buffer_desc) * entries,
  1056. &buffer_desc_dma);
  1057. if (!buffer_desc || (unsigned long)buffer_desc & 0xFF) {
  1058. pr_err("Cannot allocate TX ring (prio = %d)\n",
  1059. prio);
  1060. return -ENOMEM;
  1061. }
  1062. rtlpci->tx_ring[prio].buffer_desc = buffer_desc;
  1063. rtlpci->tx_ring[prio].buffer_desc_dma = buffer_desc_dma;
  1064. rtlpci->tx_ring[prio].cur_tx_rp = 0;
  1065. rtlpci->tx_ring[prio].cur_tx_wp = 0;
  1066. rtlpci->tx_ring[prio].avl_desc = entries;
  1067. }
  1068. /* alloc dma for this ring */
  1069. desc = pci_zalloc_consistent(rtlpci->pdev,
  1070. sizeof(*desc) * entries, &desc_dma);
  1071. if (!desc || (unsigned long)desc & 0xFF) {
  1072. pr_err("Cannot allocate TX ring (prio = %d)\n", prio);
  1073. return -ENOMEM;
  1074. }
  1075. rtlpci->tx_ring[prio].desc = desc;
  1076. rtlpci->tx_ring[prio].dma = desc_dma;
  1077. rtlpci->tx_ring[prio].idx = 0;
  1078. rtlpci->tx_ring[prio].entries = entries;
  1079. skb_queue_head_init(&rtlpci->tx_ring[prio].queue);
  1080. RT_TRACE(rtlpriv, COMP_INIT, DBG_LOUD, "queue:%d, ring_addr:%p\n",
  1081. prio, desc);
  1082. /* init every desc in this ring */
  1083. if (!rtlpriv->use_new_trx_flow) {
  1084. for (i = 0; i < entries; i++) {
  1085. nextdescaddress = (u32)desc_dma +
  1086. ((i + 1) % entries) *
  1087. sizeof(*desc);
  1088. rtlpriv->cfg->ops->set_desc(hw, (u8 *)&desc[i],
  1089. true,
  1090. HW_DESC_TX_NEXTDESC_ADDR,
  1091. (u8 *)&nextdescaddress);
  1092. }
  1093. }
  1094. return 0;
  1095. }
  1096. static int _rtl_pci_init_rx_ring(struct ieee80211_hw *hw, int rxring_idx)
  1097. {
  1098. struct rtl_pci *rtlpci = rtl_pcidev(rtl_pcipriv(hw));
  1099. struct rtl_priv *rtlpriv = rtl_priv(hw);
  1100. int i;
  1101. if (rtlpriv->use_new_trx_flow) {
  1102. struct rtl_rx_buffer_desc *entry = NULL;
  1103. /* alloc dma for this ring */
  1104. rtlpci->rx_ring[rxring_idx].buffer_desc =
  1105. pci_zalloc_consistent(rtlpci->pdev,
  1106. sizeof(*rtlpci->rx_ring[rxring_idx].
  1107. buffer_desc) *
  1108. rtlpci->rxringcount,
  1109. &rtlpci->rx_ring[rxring_idx].dma);
  1110. if (!rtlpci->rx_ring[rxring_idx].buffer_desc ||
  1111. (ulong)rtlpci->rx_ring[rxring_idx].buffer_desc & 0xFF) {
  1112. pr_err("Cannot allocate RX ring\n");
  1113. return -ENOMEM;
  1114. }
  1115. /* init every desc in this ring */
  1116. rtlpci->rx_ring[rxring_idx].idx = 0;
  1117. for (i = 0; i < rtlpci->rxringcount; i++) {
  1118. entry = &rtlpci->rx_ring[rxring_idx].buffer_desc[i];
  1119. if (!_rtl_pci_init_one_rxdesc(hw, NULL, (u8 *)entry,
  1120. rxring_idx, i))
  1121. return -ENOMEM;
  1122. }
  1123. } else {
  1124. struct rtl_rx_desc *entry = NULL;
  1125. u8 tmp_one = 1;
  1126. /* alloc dma for this ring */
  1127. rtlpci->rx_ring[rxring_idx].desc =
  1128. pci_zalloc_consistent(rtlpci->pdev,
  1129. sizeof(*rtlpci->rx_ring[rxring_idx].
  1130. desc) * rtlpci->rxringcount,
  1131. &rtlpci->rx_ring[rxring_idx].dma);
  1132. if (!rtlpci->rx_ring[rxring_idx].desc ||
  1133. (unsigned long)rtlpci->rx_ring[rxring_idx].desc & 0xFF) {
  1134. pr_err("Cannot allocate RX ring\n");
  1135. return -ENOMEM;
  1136. }
  1137. /* init every desc in this ring */
  1138. rtlpci->rx_ring[rxring_idx].idx = 0;
  1139. for (i = 0; i < rtlpci->rxringcount; i++) {
  1140. entry = &rtlpci->rx_ring[rxring_idx].desc[i];
  1141. if (!_rtl_pci_init_one_rxdesc(hw, NULL, (u8 *)entry,
  1142. rxring_idx, i))
  1143. return -ENOMEM;
  1144. }
  1145. rtlpriv->cfg->ops->set_desc(hw, (u8 *)entry, false,
  1146. HW_DESC_RXERO, &tmp_one);
  1147. }
  1148. return 0;
  1149. }
  1150. static void _rtl_pci_free_tx_ring(struct ieee80211_hw *hw,
  1151. unsigned int prio)
  1152. {
  1153. struct rtl_priv *rtlpriv = rtl_priv(hw);
  1154. struct rtl_pci *rtlpci = rtl_pcidev(rtl_pcipriv(hw));
  1155. struct rtl8192_tx_ring *ring = &rtlpci->tx_ring[prio];
  1156. /* free every desc in this ring */
  1157. while (skb_queue_len(&ring->queue)) {
  1158. u8 *entry;
  1159. struct sk_buff *skb = __skb_dequeue(&ring->queue);
  1160. if (rtlpriv->use_new_trx_flow)
  1161. entry = (u8 *)(&ring->buffer_desc[ring->idx]);
  1162. else
  1163. entry = (u8 *)(&ring->desc[ring->idx]);
  1164. pci_unmap_single(rtlpci->pdev,
  1165. rtlpriv->cfg->
  1166. ops->get_desc((u8 *)entry, true,
  1167. HW_DESC_TXBUFF_ADDR),
  1168. skb->len, PCI_DMA_TODEVICE);
  1169. kfree_skb(skb);
  1170. ring->idx = (ring->idx + 1) % ring->entries;
  1171. }
  1172. /* free dma of this ring */
  1173. pci_free_consistent(rtlpci->pdev,
  1174. sizeof(*ring->desc) * ring->entries,
  1175. ring->desc, ring->dma);
  1176. ring->desc = NULL;
  1177. if (rtlpriv->use_new_trx_flow) {
  1178. pci_free_consistent(rtlpci->pdev,
  1179. sizeof(*ring->buffer_desc) * ring->entries,
  1180. ring->buffer_desc, ring->buffer_desc_dma);
  1181. ring->buffer_desc = NULL;
  1182. }
  1183. }
  1184. static void _rtl_pci_free_rx_ring(struct ieee80211_hw *hw, int rxring_idx)
  1185. {
  1186. struct rtl_priv *rtlpriv = rtl_priv(hw);
  1187. struct rtl_pci *rtlpci = rtl_pcidev(rtl_pcipriv(hw));
  1188. int i;
  1189. /* free every desc in this ring */
  1190. for (i = 0; i < rtlpci->rxringcount; i++) {
  1191. struct sk_buff *skb = rtlpci->rx_ring[rxring_idx].rx_buf[i];
  1192. if (!skb)
  1193. continue;
  1194. pci_unmap_single(rtlpci->pdev, *((dma_addr_t *)skb->cb),
  1195. rtlpci->rxbuffersize, PCI_DMA_FROMDEVICE);
  1196. kfree_skb(skb);
  1197. }
  1198. /* free dma of this ring */
  1199. if (rtlpriv->use_new_trx_flow) {
  1200. pci_free_consistent(rtlpci->pdev,
  1201. sizeof(*rtlpci->rx_ring[rxring_idx].
  1202. buffer_desc) * rtlpci->rxringcount,
  1203. rtlpci->rx_ring[rxring_idx].buffer_desc,
  1204. rtlpci->rx_ring[rxring_idx].dma);
  1205. rtlpci->rx_ring[rxring_idx].buffer_desc = NULL;
  1206. } else {
  1207. pci_free_consistent(rtlpci->pdev,
  1208. sizeof(*rtlpci->rx_ring[rxring_idx].desc) *
  1209. rtlpci->rxringcount,
  1210. rtlpci->rx_ring[rxring_idx].desc,
  1211. rtlpci->rx_ring[rxring_idx].dma);
  1212. rtlpci->rx_ring[rxring_idx].desc = NULL;
  1213. }
  1214. }
  1215. static int _rtl_pci_init_trx_ring(struct ieee80211_hw *hw)
  1216. {
  1217. struct rtl_pci *rtlpci = rtl_pcidev(rtl_pcipriv(hw));
  1218. int ret;
  1219. int i, rxring_idx;
  1220. /* rxring_idx 0:RX_MPDU_QUEUE
  1221. * rxring_idx 1:RX_CMD_QUEUE
  1222. */
  1223. for (rxring_idx = 0; rxring_idx < RTL_PCI_MAX_RX_QUEUE; rxring_idx++) {
  1224. ret = _rtl_pci_init_rx_ring(hw, rxring_idx);
  1225. if (ret)
  1226. return ret;
  1227. }
  1228. for (i = 0; i < RTL_PCI_MAX_TX_QUEUE_COUNT; i++) {
  1229. ret = _rtl_pci_init_tx_ring(hw, i,
  1230. rtlpci->txringcount[i]);
  1231. if (ret)
  1232. goto err_free_rings;
  1233. }
  1234. return 0;
  1235. err_free_rings:
  1236. for (rxring_idx = 0; rxring_idx < RTL_PCI_MAX_RX_QUEUE; rxring_idx++)
  1237. _rtl_pci_free_rx_ring(hw, rxring_idx);
  1238. for (i = 0; i < RTL_PCI_MAX_TX_QUEUE_COUNT; i++)
  1239. if (rtlpci->tx_ring[i].desc ||
  1240. rtlpci->tx_ring[i].buffer_desc)
  1241. _rtl_pci_free_tx_ring(hw, i);
  1242. return 1;
  1243. }
  1244. static int _rtl_pci_deinit_trx_ring(struct ieee80211_hw *hw)
  1245. {
  1246. u32 i, rxring_idx;
  1247. /*free rx rings */
  1248. for (rxring_idx = 0; rxring_idx < RTL_PCI_MAX_RX_QUEUE; rxring_idx++)
  1249. _rtl_pci_free_rx_ring(hw, rxring_idx);
  1250. /*free tx rings */
  1251. for (i = 0; i < RTL_PCI_MAX_TX_QUEUE_COUNT; i++)
  1252. _rtl_pci_free_tx_ring(hw, i);
  1253. return 0;
  1254. }
  1255. int rtl_pci_reset_trx_ring(struct ieee80211_hw *hw)
  1256. {
  1257. struct rtl_priv *rtlpriv = rtl_priv(hw);
  1258. struct rtl_pci *rtlpci = rtl_pcidev(rtl_pcipriv(hw));
  1259. int i, rxring_idx;
  1260. unsigned long flags;
  1261. u8 tmp_one = 1;
  1262. u32 bufferaddress;
  1263. /* rxring_idx 0:RX_MPDU_QUEUE */
  1264. /* rxring_idx 1:RX_CMD_QUEUE */
  1265. for (rxring_idx = 0; rxring_idx < RTL_PCI_MAX_RX_QUEUE; rxring_idx++) {
  1266. /* force the rx_ring[RX_MPDU_QUEUE/
  1267. * RX_CMD_QUEUE].idx to the first one
  1268. *new trx flow, do nothing
  1269. */
  1270. if (!rtlpriv->use_new_trx_flow &&
  1271. rtlpci->rx_ring[rxring_idx].desc) {
  1272. struct rtl_rx_desc *entry = NULL;
  1273. rtlpci->rx_ring[rxring_idx].idx = 0;
  1274. for (i = 0; i < rtlpci->rxringcount; i++) {
  1275. entry = &rtlpci->rx_ring[rxring_idx].desc[i];
  1276. bufferaddress =
  1277. rtlpriv->cfg->ops->get_desc((u8 *)entry,
  1278. false , HW_DESC_RXBUFF_ADDR);
  1279. memset((u8 *)entry , 0 ,
  1280. sizeof(*rtlpci->rx_ring
  1281. [rxring_idx].desc));/*clear one entry*/
  1282. if (rtlpriv->use_new_trx_flow) {
  1283. rtlpriv->cfg->ops->set_desc(hw,
  1284. (u8 *)entry, false,
  1285. HW_DESC_RX_PREPARE,
  1286. (u8 *)&bufferaddress);
  1287. } else {
  1288. rtlpriv->cfg->ops->set_desc(hw,
  1289. (u8 *)entry, false,
  1290. HW_DESC_RXBUFF_ADDR,
  1291. (u8 *)&bufferaddress);
  1292. rtlpriv->cfg->ops->set_desc(hw,
  1293. (u8 *)entry, false,
  1294. HW_DESC_RXPKT_LEN,
  1295. (u8 *)&rtlpci->rxbuffersize);
  1296. rtlpriv->cfg->ops->set_desc(hw,
  1297. (u8 *)entry, false,
  1298. HW_DESC_RXOWN,
  1299. (u8 *)&tmp_one);
  1300. }
  1301. }
  1302. rtlpriv->cfg->ops->set_desc(hw, (u8 *)entry, false,
  1303. HW_DESC_RXERO, (u8 *)&tmp_one);
  1304. }
  1305. rtlpci->rx_ring[rxring_idx].idx = 0;
  1306. }
  1307. /*
  1308. *after reset, release previous pending packet,
  1309. *and force the tx idx to the first one
  1310. */
  1311. spin_lock_irqsave(&rtlpriv->locks.irq_th_lock, flags);
  1312. for (i = 0; i < RTL_PCI_MAX_TX_QUEUE_COUNT; i++) {
  1313. if (rtlpci->tx_ring[i].desc ||
  1314. rtlpci->tx_ring[i].buffer_desc) {
  1315. struct rtl8192_tx_ring *ring = &rtlpci->tx_ring[i];
  1316. while (skb_queue_len(&ring->queue)) {
  1317. u8 *entry;
  1318. struct sk_buff *skb =
  1319. __skb_dequeue(&ring->queue);
  1320. if (rtlpriv->use_new_trx_flow)
  1321. entry = (u8 *)(&ring->buffer_desc
  1322. [ring->idx]);
  1323. else
  1324. entry = (u8 *)(&ring->desc[ring->idx]);
  1325. pci_unmap_single(rtlpci->pdev,
  1326. rtlpriv->cfg->ops->
  1327. get_desc((u8 *)
  1328. entry,
  1329. true,
  1330. HW_DESC_TXBUFF_ADDR),
  1331. skb->len, PCI_DMA_TODEVICE);
  1332. dev_kfree_skb_irq(skb);
  1333. ring->idx = (ring->idx + 1) % ring->entries;
  1334. }
  1335. ring->idx = 0;
  1336. }
  1337. }
  1338. spin_unlock_irqrestore(&rtlpriv->locks.irq_th_lock, flags);
  1339. return 0;
  1340. }
  1341. static bool rtl_pci_tx_chk_waitq_insert(struct ieee80211_hw *hw,
  1342. struct ieee80211_sta *sta,
  1343. struct sk_buff *skb)
  1344. {
  1345. struct rtl_priv *rtlpriv = rtl_priv(hw);
  1346. struct rtl_sta_info *sta_entry = NULL;
  1347. u8 tid = rtl_get_tid(skb);
  1348. __le16 fc = rtl_get_fc(skb);
  1349. if (!sta)
  1350. return false;
  1351. sta_entry = (struct rtl_sta_info *)sta->drv_priv;
  1352. if (!rtlpriv->rtlhal.earlymode_enable)
  1353. return false;
  1354. if (ieee80211_is_nullfunc(fc))
  1355. return false;
  1356. if (ieee80211_is_qos_nullfunc(fc))
  1357. return false;
  1358. if (ieee80211_is_pspoll(fc))
  1359. return false;
  1360. if (sta_entry->tids[tid].agg.agg_state != RTL_AGG_OPERATIONAL)
  1361. return false;
  1362. if (_rtl_mac_to_hwqueue(hw, skb) > VO_QUEUE)
  1363. return false;
  1364. if (tid > 7)
  1365. return false;
  1366. /* maybe every tid should be checked */
  1367. if (!rtlpriv->link_info.higher_busytxtraffic[tid])
  1368. return false;
  1369. spin_lock_bh(&rtlpriv->locks.waitq_lock);
  1370. skb_queue_tail(&rtlpriv->mac80211.skb_waitq[tid], skb);
  1371. spin_unlock_bh(&rtlpriv->locks.waitq_lock);
  1372. return true;
  1373. }
  1374. static int rtl_pci_tx(struct ieee80211_hw *hw,
  1375. struct ieee80211_sta *sta,
  1376. struct sk_buff *skb,
  1377. struct rtl_tcb_desc *ptcb_desc)
  1378. {
  1379. struct rtl_priv *rtlpriv = rtl_priv(hw);
  1380. struct rtl_sta_info *sta_entry = NULL;
  1381. struct ieee80211_tx_info *info = IEEE80211_SKB_CB(skb);
  1382. struct rtl8192_tx_ring *ring;
  1383. struct rtl_tx_desc *pdesc;
  1384. struct rtl_tx_buffer_desc *ptx_bd_desc = NULL;
  1385. u16 idx;
  1386. u8 hw_queue = _rtl_mac_to_hwqueue(hw, skb);
  1387. unsigned long flags;
  1388. struct ieee80211_hdr *hdr = rtl_get_hdr(skb);
  1389. __le16 fc = rtl_get_fc(skb);
  1390. u8 *pda_addr = hdr->addr1;
  1391. struct rtl_pci *rtlpci = rtl_pcidev(rtl_pcipriv(hw));
  1392. /*ssn */
  1393. u8 tid = 0;
  1394. u16 seq_number = 0;
  1395. u8 own;
  1396. u8 temp_one = 1;
  1397. if (ieee80211_is_mgmt(fc))
  1398. rtl_tx_mgmt_proc(hw, skb);
  1399. if (rtlpriv->psc.sw_ps_enabled) {
  1400. if (ieee80211_is_data(fc) && !ieee80211_is_nullfunc(fc) &&
  1401. !ieee80211_has_pm(fc))
  1402. hdr->frame_control |= cpu_to_le16(IEEE80211_FCTL_PM);
  1403. }
  1404. rtl_action_proc(hw, skb, true);
  1405. if (is_multicast_ether_addr(pda_addr))
  1406. rtlpriv->stats.txbytesmulticast += skb->len;
  1407. else if (is_broadcast_ether_addr(pda_addr))
  1408. rtlpriv->stats.txbytesbroadcast += skb->len;
  1409. else
  1410. rtlpriv->stats.txbytesunicast += skb->len;
  1411. spin_lock_irqsave(&rtlpriv->locks.irq_th_lock, flags);
  1412. ring = &rtlpci->tx_ring[hw_queue];
  1413. if (hw_queue != BEACON_QUEUE) {
  1414. if (rtlpriv->use_new_trx_flow)
  1415. idx = ring->cur_tx_wp;
  1416. else
  1417. idx = (ring->idx + skb_queue_len(&ring->queue)) %
  1418. ring->entries;
  1419. } else {
  1420. idx = 0;
  1421. }
  1422. pdesc = &ring->desc[idx];
  1423. if (rtlpriv->use_new_trx_flow) {
  1424. ptx_bd_desc = &ring->buffer_desc[idx];
  1425. } else {
  1426. own = (u8) rtlpriv->cfg->ops->get_desc((u8 *)pdesc,
  1427. true, HW_DESC_OWN);
  1428. if ((own == 1) && (hw_queue != BEACON_QUEUE)) {
  1429. RT_TRACE(rtlpriv, COMP_ERR, DBG_WARNING,
  1430. "No more TX desc@%d, ring->idx = %d, idx = %d, skb_queue_len = 0x%x\n",
  1431. hw_queue, ring->idx, idx,
  1432. skb_queue_len(&ring->queue));
  1433. spin_unlock_irqrestore(&rtlpriv->locks.irq_th_lock,
  1434. flags);
  1435. return skb->len;
  1436. }
  1437. }
  1438. if (rtlpriv->cfg->ops->get_available_desc &&
  1439. rtlpriv->cfg->ops->get_available_desc(hw, hw_queue) == 0) {
  1440. RT_TRACE(rtlpriv, COMP_ERR, DBG_WARNING,
  1441. "get_available_desc fail\n");
  1442. spin_unlock_irqrestore(&rtlpriv->locks.irq_th_lock,
  1443. flags);
  1444. return skb->len;
  1445. }
  1446. if (ieee80211_is_data_qos(fc)) {
  1447. tid = rtl_get_tid(skb);
  1448. if (sta) {
  1449. sta_entry = (struct rtl_sta_info *)sta->drv_priv;
  1450. seq_number = (le16_to_cpu(hdr->seq_ctrl) &
  1451. IEEE80211_SCTL_SEQ) >> 4;
  1452. seq_number += 1;
  1453. if (!ieee80211_has_morefrags(hdr->frame_control))
  1454. sta_entry->tids[tid].seq_number = seq_number;
  1455. }
  1456. }
  1457. if (ieee80211_is_data(fc))
  1458. rtlpriv->cfg->ops->led_control(hw, LED_CTL_TX);
  1459. rtlpriv->cfg->ops->fill_tx_desc(hw, hdr, (u8 *)pdesc,
  1460. (u8 *)ptx_bd_desc, info, sta, skb, hw_queue, ptcb_desc);
  1461. __skb_queue_tail(&ring->queue, skb);
  1462. if (rtlpriv->use_new_trx_flow) {
  1463. rtlpriv->cfg->ops->set_desc(hw, (u8 *)pdesc, true,
  1464. HW_DESC_OWN, &hw_queue);
  1465. } else {
  1466. rtlpriv->cfg->ops->set_desc(hw, (u8 *)pdesc, true,
  1467. HW_DESC_OWN, &temp_one);
  1468. }
  1469. if ((ring->entries - skb_queue_len(&ring->queue)) < 2 &&
  1470. hw_queue != BEACON_QUEUE) {
  1471. RT_TRACE(rtlpriv, COMP_ERR, DBG_LOUD,
  1472. "less desc left, stop skb_queue@%d, ring->idx = %d, idx = %d, skb_queue_len = 0x%x\n",
  1473. hw_queue, ring->idx, idx,
  1474. skb_queue_len(&ring->queue));
  1475. ieee80211_stop_queue(hw, skb_get_queue_mapping(skb));
  1476. }
  1477. spin_unlock_irqrestore(&rtlpriv->locks.irq_th_lock, flags);
  1478. rtlpriv->cfg->ops->tx_polling(hw, hw_queue);
  1479. return 0;
  1480. }
  1481. static void rtl_pci_flush(struct ieee80211_hw *hw, u32 queues, bool drop)
  1482. {
  1483. struct rtl_priv *rtlpriv = rtl_priv(hw);
  1484. struct rtl_pci_priv *pcipriv = rtl_pcipriv(hw);
  1485. struct rtl_hal *rtlhal = rtl_hal(rtl_priv(hw));
  1486. struct rtl_mac *mac = rtl_mac(rtl_priv(hw));
  1487. u16 i = 0;
  1488. int queue_id;
  1489. struct rtl8192_tx_ring *ring;
  1490. if (mac->skip_scan)
  1491. return;
  1492. for (queue_id = RTL_PCI_MAX_TX_QUEUE_COUNT - 1; queue_id >= 0;) {
  1493. u32 queue_len;
  1494. if (((queues >> queue_id) & 0x1) == 0) {
  1495. queue_id--;
  1496. continue;
  1497. }
  1498. ring = &pcipriv->dev.tx_ring[queue_id];
  1499. queue_len = skb_queue_len(&ring->queue);
  1500. if (queue_len == 0 || queue_id == BEACON_QUEUE ||
  1501. queue_id == TXCMD_QUEUE) {
  1502. queue_id--;
  1503. continue;
  1504. } else {
  1505. msleep(20);
  1506. i++;
  1507. }
  1508. /* we just wait 1s for all queues */
  1509. if (rtlpriv->psc.rfpwr_state == ERFOFF ||
  1510. is_hal_stop(rtlhal) || i >= 200)
  1511. return;
  1512. }
  1513. }
  1514. static void rtl_pci_deinit(struct ieee80211_hw *hw)
  1515. {
  1516. struct rtl_priv *rtlpriv = rtl_priv(hw);
  1517. struct rtl_pci *rtlpci = rtl_pcidev(rtl_pcipriv(hw));
  1518. _rtl_pci_deinit_trx_ring(hw);
  1519. synchronize_irq(rtlpci->pdev->irq);
  1520. tasklet_kill(&rtlpriv->works.irq_tasklet);
  1521. cancel_work_sync(&rtlpriv->works.lps_change_work);
  1522. flush_workqueue(rtlpriv->works.rtl_wq);
  1523. destroy_workqueue(rtlpriv->works.rtl_wq);
  1524. }
  1525. static int rtl_pci_init(struct ieee80211_hw *hw, struct pci_dev *pdev)
  1526. {
  1527. int err;
  1528. _rtl_pci_init_struct(hw, pdev);
  1529. err = _rtl_pci_init_trx_ring(hw);
  1530. if (err) {
  1531. pr_err("tx ring initialization failed\n");
  1532. return err;
  1533. }
  1534. return 0;
  1535. }
  1536. static int rtl_pci_start(struct ieee80211_hw *hw)
  1537. {
  1538. struct rtl_priv *rtlpriv = rtl_priv(hw);
  1539. struct rtl_hal *rtlhal = rtl_hal(rtl_priv(hw));
  1540. struct rtl_pci *rtlpci = rtl_pcidev(rtl_pcipriv(hw));
  1541. struct rtl_ps_ctl *ppsc = rtl_psc(rtl_priv(hw));
  1542. struct rtl_mac *rtlmac = rtl_mac(rtl_priv(hw));
  1543. int err;
  1544. rtl_pci_reset_trx_ring(hw);
  1545. rtlpci->driver_is_goingto_unload = false;
  1546. if (rtlpriv->cfg->ops->get_btc_status &&
  1547. rtlpriv->cfg->ops->get_btc_status()) {
  1548. rtlpriv->btcoexist.btc_ops->btc_init_variables(rtlpriv);
  1549. rtlpriv->btcoexist.btc_ops->btc_init_hal_vars(rtlpriv);
  1550. }
  1551. err = rtlpriv->cfg->ops->hw_init(hw);
  1552. if (err) {
  1553. RT_TRACE(rtlpriv, COMP_INIT, DBG_DMESG,
  1554. "Failed to config hardware!\n");
  1555. return err;
  1556. }
  1557. rtlpriv->cfg->ops->set_hw_reg(hw, HW_VAR_RETRY_LIMIT,
  1558. &rtlmac->retry_long);
  1559. rtlpriv->cfg->ops->enable_interrupt(hw);
  1560. RT_TRACE(rtlpriv, COMP_INIT, DBG_LOUD, "enable_interrupt OK\n");
  1561. rtl_init_rx_config(hw);
  1562. /*should be after adapter start and interrupt enable. */
  1563. set_hal_start(rtlhal);
  1564. RT_CLEAR_PS_LEVEL(ppsc, RT_RF_OFF_LEVL_HALT_NIC);
  1565. rtlpci->up_first_time = false;
  1566. RT_TRACE(rtlpriv, COMP_INIT, DBG_DMESG, "rtl_pci_start OK\n");
  1567. return 0;
  1568. }
  1569. static void rtl_pci_stop(struct ieee80211_hw *hw)
  1570. {
  1571. struct rtl_priv *rtlpriv = rtl_priv(hw);
  1572. struct rtl_pci *rtlpci = rtl_pcidev(rtl_pcipriv(hw));
  1573. struct rtl_ps_ctl *ppsc = rtl_psc(rtl_priv(hw));
  1574. struct rtl_hal *rtlhal = rtl_hal(rtl_priv(hw));
  1575. unsigned long flags;
  1576. u8 RFInProgressTimeOut = 0;
  1577. if (rtlpriv->cfg->ops->get_btc_status())
  1578. rtlpriv->btcoexist.btc_ops->btc_halt_notify();
  1579. /*
  1580. *should be before disable interrupt&adapter
  1581. *and will do it immediately.
  1582. */
  1583. set_hal_stop(rtlhal);
  1584. rtlpci->driver_is_goingto_unload = true;
  1585. rtlpriv->cfg->ops->disable_interrupt(hw);
  1586. cancel_work_sync(&rtlpriv->works.lps_change_work);
  1587. spin_lock_irqsave(&rtlpriv->locks.rf_ps_lock, flags);
  1588. while (ppsc->rfchange_inprogress) {
  1589. spin_unlock_irqrestore(&rtlpriv->locks.rf_ps_lock, flags);
  1590. if (RFInProgressTimeOut > 100) {
  1591. spin_lock_irqsave(&rtlpriv->locks.rf_ps_lock, flags);
  1592. break;
  1593. }
  1594. mdelay(1);
  1595. RFInProgressTimeOut++;
  1596. spin_lock_irqsave(&rtlpriv->locks.rf_ps_lock, flags);
  1597. }
  1598. ppsc->rfchange_inprogress = true;
  1599. spin_unlock_irqrestore(&rtlpriv->locks.rf_ps_lock, flags);
  1600. rtlpriv->cfg->ops->hw_disable(hw);
  1601. /* some things are not needed if firmware not available */
  1602. if (!rtlpriv->max_fw_size)
  1603. return;
  1604. rtlpriv->cfg->ops->led_control(hw, LED_CTL_POWER_OFF);
  1605. spin_lock_irqsave(&rtlpriv->locks.rf_ps_lock, flags);
  1606. ppsc->rfchange_inprogress = false;
  1607. spin_unlock_irqrestore(&rtlpriv->locks.rf_ps_lock, flags);
  1608. rtl_pci_enable_aspm(hw);
  1609. }
  1610. static bool _rtl_pci_find_adapter(struct pci_dev *pdev,
  1611. struct ieee80211_hw *hw)
  1612. {
  1613. struct rtl_priv *rtlpriv = rtl_priv(hw);
  1614. struct rtl_pci_priv *pcipriv = rtl_pcipriv(hw);
  1615. struct rtl_hal *rtlhal = rtl_hal(rtl_priv(hw));
  1616. struct pci_dev *bridge_pdev = pdev->bus->self;
  1617. u16 venderid;
  1618. u16 deviceid;
  1619. u8 revisionid;
  1620. u16 irqline;
  1621. u8 tmp;
  1622. pcipriv->ndis_adapter.pcibridge_vendor = PCI_BRIDGE_VENDOR_UNKNOWN;
  1623. venderid = pdev->vendor;
  1624. deviceid = pdev->device;
  1625. pci_read_config_byte(pdev, 0x8, &revisionid);
  1626. pci_read_config_word(pdev, 0x3C, &irqline);
  1627. /* PCI ID 0x10ec:0x8192 occurs for both RTL8192E, which uses
  1628. * r8192e_pci, and RTL8192SE, which uses this driver. If the
  1629. * revision ID is RTL_PCI_REVISION_ID_8192PCIE (0x01), then
  1630. * the correct driver is r8192e_pci, thus this routine should
  1631. * return false.
  1632. */
  1633. if (deviceid == RTL_PCI_8192SE_DID &&
  1634. revisionid == RTL_PCI_REVISION_ID_8192PCIE)
  1635. return false;
  1636. if (deviceid == RTL_PCI_8192_DID ||
  1637. deviceid == RTL_PCI_0044_DID ||
  1638. deviceid == RTL_PCI_0047_DID ||
  1639. deviceid == RTL_PCI_8192SE_DID ||
  1640. deviceid == RTL_PCI_8174_DID ||
  1641. deviceid == RTL_PCI_8173_DID ||
  1642. deviceid == RTL_PCI_8172_DID ||
  1643. deviceid == RTL_PCI_8171_DID) {
  1644. switch (revisionid) {
  1645. case RTL_PCI_REVISION_ID_8192PCIE:
  1646. RT_TRACE(rtlpriv, COMP_INIT, DBG_DMESG,
  1647. "8192 PCI-E is found - vid/did=%x/%x\n",
  1648. venderid, deviceid);
  1649. rtlhal->hw_type = HARDWARE_TYPE_RTL8192E;
  1650. return false;
  1651. case RTL_PCI_REVISION_ID_8192SE:
  1652. RT_TRACE(rtlpriv, COMP_INIT, DBG_DMESG,
  1653. "8192SE is found - vid/did=%x/%x\n",
  1654. venderid, deviceid);
  1655. rtlhal->hw_type = HARDWARE_TYPE_RTL8192SE;
  1656. break;
  1657. default:
  1658. RT_TRACE(rtlpriv, COMP_ERR, DBG_WARNING,
  1659. "Err: Unknown device - vid/did=%x/%x\n",
  1660. venderid, deviceid);
  1661. rtlhal->hw_type = HARDWARE_TYPE_RTL8192SE;
  1662. break;
  1663. }
  1664. } else if (deviceid == RTL_PCI_8723AE_DID) {
  1665. rtlhal->hw_type = HARDWARE_TYPE_RTL8723AE;
  1666. RT_TRACE(rtlpriv, COMP_INIT, DBG_DMESG,
  1667. "8723AE PCI-E is found - "
  1668. "vid/did=%x/%x\n", venderid, deviceid);
  1669. } else if (deviceid == RTL_PCI_8192CET_DID ||
  1670. deviceid == RTL_PCI_8192CE_DID ||
  1671. deviceid == RTL_PCI_8191CE_DID ||
  1672. deviceid == RTL_PCI_8188CE_DID) {
  1673. rtlhal->hw_type = HARDWARE_TYPE_RTL8192CE;
  1674. RT_TRACE(rtlpriv, COMP_INIT, DBG_DMESG,
  1675. "8192C PCI-E is found - vid/did=%x/%x\n",
  1676. venderid, deviceid);
  1677. } else if (deviceid == RTL_PCI_8192DE_DID ||
  1678. deviceid == RTL_PCI_8192DE_DID2) {
  1679. rtlhal->hw_type = HARDWARE_TYPE_RTL8192DE;
  1680. RT_TRACE(rtlpriv, COMP_INIT, DBG_DMESG,
  1681. "8192D PCI-E is found - vid/did=%x/%x\n",
  1682. venderid, deviceid);
  1683. } else if (deviceid == RTL_PCI_8188EE_DID) {
  1684. rtlhal->hw_type = HARDWARE_TYPE_RTL8188EE;
  1685. RT_TRACE(rtlpriv, COMP_INIT, DBG_LOUD,
  1686. "Find adapter, Hardware type is 8188EE\n");
  1687. } else if (deviceid == RTL_PCI_8723BE_DID) {
  1688. rtlhal->hw_type = HARDWARE_TYPE_RTL8723BE;
  1689. RT_TRACE(rtlpriv, COMP_INIT , DBG_LOUD,
  1690. "Find adapter, Hardware type is 8723BE\n");
  1691. } else if (deviceid == RTL_PCI_8192EE_DID) {
  1692. rtlhal->hw_type = HARDWARE_TYPE_RTL8192EE;
  1693. RT_TRACE(rtlpriv, COMP_INIT , DBG_LOUD,
  1694. "Find adapter, Hardware type is 8192EE\n");
  1695. } else if (deviceid == RTL_PCI_8821AE_DID) {
  1696. rtlhal->hw_type = HARDWARE_TYPE_RTL8821AE;
  1697. RT_TRACE(rtlpriv, COMP_INIT , DBG_LOUD,
  1698. "Find adapter, Hardware type is 8821AE\n");
  1699. } else if (deviceid == RTL_PCI_8812AE_DID) {
  1700. rtlhal->hw_type = HARDWARE_TYPE_RTL8812AE;
  1701. RT_TRACE(rtlpriv, COMP_INIT , DBG_LOUD,
  1702. "Find adapter, Hardware type is 8812AE\n");
  1703. } else {
  1704. RT_TRACE(rtlpriv, COMP_ERR, DBG_WARNING,
  1705. "Err: Unknown device - vid/did=%x/%x\n",
  1706. venderid, deviceid);
  1707. rtlhal->hw_type = RTL_DEFAULT_HARDWARE_TYPE;
  1708. }
  1709. if (rtlhal->hw_type == HARDWARE_TYPE_RTL8192DE) {
  1710. if (revisionid == 0 || revisionid == 1) {
  1711. if (revisionid == 0) {
  1712. RT_TRACE(rtlpriv, COMP_INIT, DBG_LOUD,
  1713. "Find 92DE MAC0\n");
  1714. rtlhal->interfaceindex = 0;
  1715. } else if (revisionid == 1) {
  1716. RT_TRACE(rtlpriv, COMP_INIT, DBG_LOUD,
  1717. "Find 92DE MAC1\n");
  1718. rtlhal->interfaceindex = 1;
  1719. }
  1720. } else {
  1721. RT_TRACE(rtlpriv, COMP_INIT, DBG_LOUD,
  1722. "Unknown device - VendorID/DeviceID=%x/%x, Revision=%x\n",
  1723. venderid, deviceid, revisionid);
  1724. rtlhal->interfaceindex = 0;
  1725. }
  1726. }
  1727. /* 92ee use new trx flow */
  1728. if (rtlhal->hw_type == HARDWARE_TYPE_RTL8192EE)
  1729. rtlpriv->use_new_trx_flow = true;
  1730. else
  1731. rtlpriv->use_new_trx_flow = false;
  1732. /*find bus info */
  1733. pcipriv->ndis_adapter.busnumber = pdev->bus->number;
  1734. pcipriv->ndis_adapter.devnumber = PCI_SLOT(pdev->devfn);
  1735. pcipriv->ndis_adapter.funcnumber = PCI_FUNC(pdev->devfn);
  1736. /*find bridge info */
  1737. pcipriv->ndis_adapter.pcibridge_vendor = PCI_BRIDGE_VENDOR_UNKNOWN;
  1738. /* some ARM have no bridge_pdev and will crash here
  1739. * so we should check if bridge_pdev is NULL
  1740. */
  1741. if (bridge_pdev) {
  1742. /*find bridge info if available */
  1743. pcipriv->ndis_adapter.pcibridge_vendorid = bridge_pdev->vendor;
  1744. for (tmp = 0; tmp < PCI_BRIDGE_VENDOR_MAX; tmp++) {
  1745. if (bridge_pdev->vendor == pcibridge_vendors[tmp]) {
  1746. pcipriv->ndis_adapter.pcibridge_vendor = tmp;
  1747. RT_TRACE(rtlpriv, COMP_INIT, DBG_DMESG,
  1748. "Pci Bridge Vendor is found index: %d\n",
  1749. tmp);
  1750. break;
  1751. }
  1752. }
  1753. }
  1754. if (pcipriv->ndis_adapter.pcibridge_vendor !=
  1755. PCI_BRIDGE_VENDOR_UNKNOWN) {
  1756. pcipriv->ndis_adapter.pcibridge_busnum =
  1757. bridge_pdev->bus->number;
  1758. pcipriv->ndis_adapter.pcibridge_devnum =
  1759. PCI_SLOT(bridge_pdev->devfn);
  1760. pcipriv->ndis_adapter.pcibridge_funcnum =
  1761. PCI_FUNC(bridge_pdev->devfn);
  1762. pcipriv->ndis_adapter.pcibridge_pciehdr_offset =
  1763. pci_pcie_cap(bridge_pdev);
  1764. pcipriv->ndis_adapter.num4bytes =
  1765. (pcipriv->ndis_adapter.pcibridge_pciehdr_offset + 0x10) / 4;
  1766. rtl_pci_get_linkcontrol_field(hw);
  1767. if (pcipriv->ndis_adapter.pcibridge_vendor ==
  1768. PCI_BRIDGE_VENDOR_AMD) {
  1769. pcipriv->ndis_adapter.amd_l1_patch =
  1770. rtl_pci_get_amd_l1_patch(hw);
  1771. }
  1772. }
  1773. RT_TRACE(rtlpriv, COMP_INIT, DBG_DMESG,
  1774. "pcidev busnumber:devnumber:funcnumber:vendor:link_ctl %d:%d:%d:%x:%x\n",
  1775. pcipriv->ndis_adapter.busnumber,
  1776. pcipriv->ndis_adapter.devnumber,
  1777. pcipriv->ndis_adapter.funcnumber,
  1778. pdev->vendor, pcipriv->ndis_adapter.linkctrl_reg);
  1779. RT_TRACE(rtlpriv, COMP_INIT, DBG_DMESG,
  1780. "pci_bridge busnumber:devnumber:funcnumber:vendor:pcie_cap:link_ctl_reg:amd %d:%d:%d:%x:%x:%x:%x\n",
  1781. pcipriv->ndis_adapter.pcibridge_busnum,
  1782. pcipriv->ndis_adapter.pcibridge_devnum,
  1783. pcipriv->ndis_adapter.pcibridge_funcnum,
  1784. pcibridge_vendors[pcipriv->ndis_adapter.pcibridge_vendor],
  1785. pcipriv->ndis_adapter.pcibridge_pciehdr_offset,
  1786. pcipriv->ndis_adapter.pcibridge_linkctrlreg,
  1787. pcipriv->ndis_adapter.amd_l1_patch);
  1788. rtl_pci_parse_configuration(pdev, hw);
  1789. list_add_tail(&rtlpriv->list, &rtlpriv->glb_var->glb_priv_list);
  1790. return true;
  1791. }
  1792. static int rtl_pci_intr_mode_msi(struct ieee80211_hw *hw)
  1793. {
  1794. struct rtl_priv *rtlpriv = rtl_priv(hw);
  1795. struct rtl_pci_priv *pcipriv = rtl_pcipriv(hw);
  1796. struct rtl_pci *rtlpci = rtl_pcidev(pcipriv);
  1797. int ret;
  1798. ret = pci_enable_msi(rtlpci->pdev);
  1799. if (ret < 0)
  1800. return ret;
  1801. ret = request_irq(rtlpci->pdev->irq, &_rtl_pci_interrupt,
  1802. IRQF_SHARED, KBUILD_MODNAME, hw);
  1803. if (ret < 0) {
  1804. pci_disable_msi(rtlpci->pdev);
  1805. return ret;
  1806. }
  1807. rtlpci->using_msi = true;
  1808. RT_TRACE(rtlpriv, COMP_INIT|COMP_INTR, DBG_DMESG,
  1809. "MSI Interrupt Mode!\n");
  1810. return 0;
  1811. }
  1812. static int rtl_pci_intr_mode_legacy(struct ieee80211_hw *hw)
  1813. {
  1814. struct rtl_priv *rtlpriv = rtl_priv(hw);
  1815. struct rtl_pci_priv *pcipriv = rtl_pcipriv(hw);
  1816. struct rtl_pci *rtlpci = rtl_pcidev(pcipriv);
  1817. int ret;
  1818. ret = request_irq(rtlpci->pdev->irq, &_rtl_pci_interrupt,
  1819. IRQF_SHARED, KBUILD_MODNAME, hw);
  1820. if (ret < 0)
  1821. return ret;
  1822. rtlpci->using_msi = false;
  1823. RT_TRACE(rtlpriv, COMP_INIT|COMP_INTR, DBG_DMESG,
  1824. "Pin-based Interrupt Mode!\n");
  1825. return 0;
  1826. }
  1827. static int rtl_pci_intr_mode_decide(struct ieee80211_hw *hw)
  1828. {
  1829. struct rtl_pci_priv *pcipriv = rtl_pcipriv(hw);
  1830. struct rtl_pci *rtlpci = rtl_pcidev(pcipriv);
  1831. int ret;
  1832. if (rtlpci->msi_support) {
  1833. ret = rtl_pci_intr_mode_msi(hw);
  1834. if (ret < 0)
  1835. ret = rtl_pci_intr_mode_legacy(hw);
  1836. } else {
  1837. ret = rtl_pci_intr_mode_legacy(hw);
  1838. }
  1839. return ret;
  1840. }
  1841. int rtl_pci_probe(struct pci_dev *pdev,
  1842. const struct pci_device_id *id)
  1843. {
  1844. struct ieee80211_hw *hw = NULL;
  1845. struct rtl_priv *rtlpriv = NULL;
  1846. struct rtl_pci_priv *pcipriv = NULL;
  1847. struct rtl_pci *rtlpci;
  1848. unsigned long pmem_start, pmem_len, pmem_flags;
  1849. int err;
  1850. err = pci_enable_device(pdev);
  1851. if (err) {
  1852. WARN_ONCE(true, "%s : Cannot enable new PCI device\n",
  1853. pci_name(pdev));
  1854. return err;
  1855. }
  1856. if (!pci_set_dma_mask(pdev, DMA_BIT_MASK(32))) {
  1857. if (pci_set_consistent_dma_mask(pdev, DMA_BIT_MASK(32))) {
  1858. WARN_ONCE(true,
  1859. "rtlwifi: Unable to obtain 32bit DMA for consistent allocations\n");
  1860. err = -ENOMEM;
  1861. goto fail1;
  1862. }
  1863. }
  1864. pci_set_master(pdev);
  1865. hw = ieee80211_alloc_hw(sizeof(struct rtl_pci_priv) +
  1866. sizeof(struct rtl_priv), &rtl_ops);
  1867. if (!hw) {
  1868. WARN_ONCE(true,
  1869. "%s : ieee80211 alloc failed\n", pci_name(pdev));
  1870. err = -ENOMEM;
  1871. goto fail1;
  1872. }
  1873. SET_IEEE80211_DEV(hw, &pdev->dev);
  1874. pci_set_drvdata(pdev, hw);
  1875. rtlpriv = hw->priv;
  1876. rtlpriv->hw = hw;
  1877. pcipriv = (void *)rtlpriv->priv;
  1878. pcipriv->dev.pdev = pdev;
  1879. init_completion(&rtlpriv->firmware_loading_complete);
  1880. /*proximity init here*/
  1881. rtlpriv->proximity.proxim_on = false;
  1882. pcipriv = (void *)rtlpriv->priv;
  1883. pcipriv->dev.pdev = pdev;
  1884. /* init cfg & intf_ops */
  1885. rtlpriv->rtlhal.interface = INTF_PCI;
  1886. rtlpriv->cfg = (struct rtl_hal_cfg *)(id->driver_data);
  1887. rtlpriv->intf_ops = &rtl_pci_ops;
  1888. rtlpriv->glb_var = &rtl_global_var;
  1889. /* MEM map */
  1890. err = pci_request_regions(pdev, KBUILD_MODNAME);
  1891. if (err) {
  1892. WARN_ONCE(true, "rtlwifi: Can't obtain PCI resources\n");
  1893. goto fail1;
  1894. }
  1895. pmem_start = pci_resource_start(pdev, rtlpriv->cfg->bar_id);
  1896. pmem_len = pci_resource_len(pdev, rtlpriv->cfg->bar_id);
  1897. pmem_flags = pci_resource_flags(pdev, rtlpriv->cfg->bar_id);
  1898. /*shared mem start */
  1899. rtlpriv->io.pci_mem_start =
  1900. (unsigned long)pci_iomap(pdev,
  1901. rtlpriv->cfg->bar_id, pmem_len);
  1902. if (rtlpriv->io.pci_mem_start == 0) {
  1903. WARN_ONCE(true, "rtlwifi: Can't map PCI mem\n");
  1904. err = -ENOMEM;
  1905. goto fail2;
  1906. }
  1907. RT_TRACE(rtlpriv, COMP_INIT, DBG_DMESG,
  1908. "mem mapped space: start: 0x%08lx len:%08lx flags:%08lx, after map:0x%08lx\n",
  1909. pmem_start, pmem_len, pmem_flags,
  1910. rtlpriv->io.pci_mem_start);
  1911. /* Disable Clk Request */
  1912. pci_write_config_byte(pdev, 0x81, 0);
  1913. /* leave D3 mode */
  1914. pci_write_config_byte(pdev, 0x44, 0);
  1915. pci_write_config_byte(pdev, 0x04, 0x06);
  1916. pci_write_config_byte(pdev, 0x04, 0x07);
  1917. /* find adapter */
  1918. if (!_rtl_pci_find_adapter(pdev, hw)) {
  1919. err = -ENODEV;
  1920. goto fail3;
  1921. }
  1922. /* Init IO handler */
  1923. _rtl_pci_io_handler_init(&pdev->dev, hw);
  1924. /*like read eeprom and so on */
  1925. rtlpriv->cfg->ops->read_eeprom_info(hw);
  1926. if (rtlpriv->cfg->ops->init_sw_vars(hw)) {
  1927. pr_err("Can't init_sw_vars\n");
  1928. err = -ENODEV;
  1929. goto fail3;
  1930. }
  1931. rtlpriv->cfg->ops->init_sw_leds(hw);
  1932. /*aspm */
  1933. rtl_pci_init_aspm(hw);
  1934. /* Init mac80211 sw */
  1935. err = rtl_init_core(hw);
  1936. if (err) {
  1937. pr_err("Can't allocate sw for mac80211\n");
  1938. goto fail3;
  1939. }
  1940. /* Init PCI sw */
  1941. err = rtl_pci_init(hw, pdev);
  1942. if (err) {
  1943. pr_err("Failed to init PCI\n");
  1944. goto fail3;
  1945. }
  1946. err = ieee80211_register_hw(hw);
  1947. if (err) {
  1948. pr_err("Can't register mac80211 hw.\n");
  1949. err = -ENODEV;
  1950. goto fail3;
  1951. }
  1952. rtlpriv->mac80211.mac80211_registered = 1;
  1953. /*init rfkill */
  1954. rtl_init_rfkill(hw); /* Init PCI sw */
  1955. rtlpci = rtl_pcidev(pcipriv);
  1956. err = rtl_pci_intr_mode_decide(hw);
  1957. if (err) {
  1958. RT_TRACE(rtlpriv, COMP_INIT, DBG_DMESG,
  1959. "%s: failed to register IRQ handler\n",
  1960. wiphy_name(hw->wiphy));
  1961. goto fail3;
  1962. }
  1963. rtlpci->irq_alloc = 1;
  1964. set_bit(RTL_STATUS_INTERFACE_START, &rtlpriv->status);
  1965. return 0;
  1966. fail3:
  1967. pci_set_drvdata(pdev, NULL);
  1968. rtl_deinit_core(hw);
  1969. if (rtlpriv->io.pci_mem_start != 0)
  1970. pci_iounmap(pdev, (void __iomem *)rtlpriv->io.pci_mem_start);
  1971. fail2:
  1972. pci_release_regions(pdev);
  1973. complete(&rtlpriv->firmware_loading_complete);
  1974. fail1:
  1975. if (hw)
  1976. ieee80211_free_hw(hw);
  1977. pci_disable_device(pdev);
  1978. return err;
  1979. }
  1980. EXPORT_SYMBOL(rtl_pci_probe);
  1981. void rtl_pci_disconnect(struct pci_dev *pdev)
  1982. {
  1983. struct ieee80211_hw *hw = pci_get_drvdata(pdev);
  1984. struct rtl_pci_priv *pcipriv = rtl_pcipriv(hw);
  1985. struct rtl_priv *rtlpriv = rtl_priv(hw);
  1986. struct rtl_pci *rtlpci = rtl_pcidev(pcipriv);
  1987. struct rtl_mac *rtlmac = rtl_mac(rtlpriv);
  1988. /* just in case driver is removed before firmware callback */
  1989. wait_for_completion(&rtlpriv->firmware_loading_complete);
  1990. clear_bit(RTL_STATUS_INTERFACE_START, &rtlpriv->status);
  1991. /*ieee80211_unregister_hw will call ops_stop */
  1992. if (rtlmac->mac80211_registered == 1) {
  1993. ieee80211_unregister_hw(hw);
  1994. rtlmac->mac80211_registered = 0;
  1995. } else {
  1996. rtl_deinit_deferred_work(hw);
  1997. rtlpriv->intf_ops->adapter_stop(hw);
  1998. }
  1999. rtlpriv->cfg->ops->disable_interrupt(hw);
  2000. /*deinit rfkill */
  2001. rtl_deinit_rfkill(hw);
  2002. rtl_pci_deinit(hw);
  2003. rtl_deinit_core(hw);
  2004. rtlpriv->cfg->ops->deinit_sw_vars(hw);
  2005. if (rtlpci->irq_alloc) {
  2006. free_irq(rtlpci->pdev->irq, hw);
  2007. rtlpci->irq_alloc = 0;
  2008. }
  2009. if (rtlpci->using_msi)
  2010. pci_disable_msi(rtlpci->pdev);
  2011. list_del(&rtlpriv->list);
  2012. if (rtlpriv->io.pci_mem_start != 0) {
  2013. pci_iounmap(pdev, (void __iomem *)rtlpriv->io.pci_mem_start);
  2014. pci_release_regions(pdev);
  2015. }
  2016. pci_disable_device(pdev);
  2017. rtl_pci_disable_aspm(hw);
  2018. pci_set_drvdata(pdev, NULL);
  2019. ieee80211_free_hw(hw);
  2020. }
  2021. EXPORT_SYMBOL(rtl_pci_disconnect);
  2022. #ifdef CONFIG_PM_SLEEP
  2023. /***************************************
  2024. kernel pci power state define:
  2025. PCI_D0 ((pci_power_t __force) 0)
  2026. PCI_D1 ((pci_power_t __force) 1)
  2027. PCI_D2 ((pci_power_t __force) 2)
  2028. PCI_D3hot ((pci_power_t __force) 3)
  2029. PCI_D3cold ((pci_power_t __force) 4)
  2030. PCI_UNKNOWN ((pci_power_t __force) 5)
  2031. This function is called when system
  2032. goes into suspend state mac80211 will
  2033. call rtl_mac_stop() from the mac80211
  2034. suspend function first, So there is
  2035. no need to call hw_disable here.
  2036. ****************************************/
  2037. int rtl_pci_suspend(struct device *dev)
  2038. {
  2039. struct pci_dev *pdev = to_pci_dev(dev);
  2040. struct ieee80211_hw *hw = pci_get_drvdata(pdev);
  2041. struct rtl_priv *rtlpriv = rtl_priv(hw);
  2042. rtlpriv->cfg->ops->hw_suspend(hw);
  2043. rtl_deinit_rfkill(hw);
  2044. return 0;
  2045. }
  2046. EXPORT_SYMBOL(rtl_pci_suspend);
  2047. int rtl_pci_resume(struct device *dev)
  2048. {
  2049. struct pci_dev *pdev = to_pci_dev(dev);
  2050. struct ieee80211_hw *hw = pci_get_drvdata(pdev);
  2051. struct rtl_priv *rtlpriv = rtl_priv(hw);
  2052. rtlpriv->cfg->ops->hw_resume(hw);
  2053. rtl_init_rfkill(hw);
  2054. return 0;
  2055. }
  2056. EXPORT_SYMBOL(rtl_pci_resume);
  2057. #endif /* CONFIG_PM_SLEEP */
  2058. const struct rtl_intf_ops rtl_pci_ops = {
  2059. .read_efuse_byte = read_efuse_byte,
  2060. .adapter_start = rtl_pci_start,
  2061. .adapter_stop = rtl_pci_stop,
  2062. .check_buddy_priv = rtl_pci_check_buddy_priv,
  2063. .adapter_tx = rtl_pci_tx,
  2064. .flush = rtl_pci_flush,
  2065. .reset_trx_ring = rtl_pci_reset_trx_ring,
  2066. .waitq_insert = rtl_pci_tx_chk_waitq_insert,
  2067. .disable_aspm = rtl_pci_disable_aspm,
  2068. .enable_aspm = rtl_pci_enable_aspm,
  2069. };