pci.c 66 KB

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