interrupt.c 17 KB

123456789101112131415161718192021222324252627282930313233343536373839404142434445464748495051525354555657585960616263646566676869707172737475767778798081828384858687888990919293949596979899100101102103104105106107108109110111112113114115116117118119120121122123124125126127128129130131132133134135136137138139140141142143144145146147148149150151152153154155156157158159160161162163164165166167168169170171172173174175176177178179180181182183184185186187188189190191192193194195196197198199200201202203204205206207208209210211212213214215216217218219220221222223224225226227228229230231232233234235236237238239240241242243244245246247248249250251252253254255256257258259260261262263264265266267268269270271272273274275276277278279280281282283284285286287288289290291292293294295296297298299300301302303304305306307308309310311312313314315316317318319320321322323324325326327328329330331332333334335336337338339340341342343344345346347348349350351352353354355356357358359360361362363364365366367368369370371372373374375376377378379380381382383384385386387388389390391392393394395396397398399400401402403404405406407408409410411412413414415416417418419420421422423424425426427428429430431432433434435436437438439440441442443444445446447448449450451452453454455456457458459460461462463464465466467468469470471472473474475476477478479480481482483484485486487488489490491492493494495496497498499500501502503504505506507508509510511512513514515516517518519520521522523524525526527528529530531532533534535536537538539540541542543544545546547548549550551552553554555556557558559560561562563564565566567568569570571572573574575576577578579580581582583584585586587588589590591592593594595596597598599600601602603604605606607608609610611612613614615616617618619620621622623624625
  1. /*
  2. * Copyright (c) 2012-2014 Qualcomm Atheros, Inc.
  3. *
  4. * Permission to use, copy, modify, and/or distribute this software for any
  5. * purpose with or without fee is hereby granted, provided that the above
  6. * copyright notice and this permission notice appear in all copies.
  7. *
  8. * THE SOFTWARE IS PROVIDED "AS IS" AND THE AUTHOR DISCLAIMS ALL WARRANTIES
  9. * WITH REGARD TO THIS SOFTWARE INCLUDING ALL IMPLIED WARRANTIES OF
  10. * MERCHANTABILITY AND FITNESS. IN NO EVENT SHALL THE AUTHOR BE LIABLE FOR
  11. * ANY SPECIAL, DIRECT, INDIRECT, OR CONSEQUENTIAL DAMAGES OR ANY DAMAGES
  12. * WHATSOEVER RESULTING FROM LOSS OF USE, DATA OR PROFITS, WHETHER IN AN
  13. * ACTION OF CONTRACT, NEGLIGENCE OR OTHER TORTIOUS ACTION, ARISING OUT OF
  14. * OR IN CONNECTION WITH THE USE OR PERFORMANCE OF THIS SOFTWARE.
  15. */
  16. #include <linux/interrupt.h>
  17. #include "wil6210.h"
  18. #include "trace.h"
  19. /**
  20. * Theory of operation:
  21. *
  22. * There is ISR pseudo-cause register,
  23. * dma_rgf->DMA_RGF.PSEUDO_CAUSE.PSEUDO_CAUSE
  24. * Its bits represents OR'ed bits from 3 real ISR registers:
  25. * TX, RX, and MISC.
  26. *
  27. * Registers may be configured to either "write 1 to clear" or
  28. * "clear on read" mode
  29. *
  30. * When handling interrupt, one have to mask/unmask interrupts for the
  31. * real ISR registers, or hardware may malfunction.
  32. *
  33. */
  34. #define WIL6210_IRQ_DISABLE (0xFFFFFFFFUL)
  35. #define WIL6210_IMC_RX (BIT_DMA_EP_RX_ICR_RX_DONE | \
  36. BIT_DMA_EP_RX_ICR_RX_HTRSH)
  37. #define WIL6210_IMC_TX (BIT_DMA_EP_TX_ICR_TX_DONE | \
  38. BIT_DMA_EP_TX_ICR_TX_DONE_N(0))
  39. #define WIL6210_IMC_MISC (ISR_MISC_FW_READY | \
  40. ISR_MISC_MBOX_EVT | \
  41. ISR_MISC_FW_ERROR)
  42. #define WIL6210_IRQ_PSEUDO_MASK (u32)(~(BIT_DMA_PSEUDO_CAUSE_RX | \
  43. BIT_DMA_PSEUDO_CAUSE_TX | \
  44. BIT_DMA_PSEUDO_CAUSE_MISC))
  45. #if defined(CONFIG_WIL6210_ISR_COR)
  46. /* configure to Clear-On-Read mode */
  47. #define WIL_ICR_ICC_VALUE (0xFFFFFFFFUL)
  48. static inline void wil_icr_clear(u32 x, void __iomem *addr)
  49. {
  50. }
  51. #else /* defined(CONFIG_WIL6210_ISR_COR) */
  52. /* configure to Write-1-to-Clear mode */
  53. #define WIL_ICR_ICC_VALUE (0UL)
  54. static inline void wil_icr_clear(u32 x, void __iomem *addr)
  55. {
  56. iowrite32(x, addr);
  57. }
  58. #endif /* defined(CONFIG_WIL6210_ISR_COR) */
  59. static inline u32 wil_ioread32_and_clear(void __iomem *addr)
  60. {
  61. u32 x = ioread32(addr);
  62. wil_icr_clear(x, addr);
  63. return x;
  64. }
  65. static void wil6210_mask_irq_tx(struct wil6210_priv *wil)
  66. {
  67. iowrite32(WIL6210_IRQ_DISABLE, wil->csr +
  68. HOSTADDR(RGF_DMA_EP_TX_ICR) +
  69. offsetof(struct RGF_ICR, IMS));
  70. }
  71. static void wil6210_mask_irq_rx(struct wil6210_priv *wil)
  72. {
  73. iowrite32(WIL6210_IRQ_DISABLE, wil->csr +
  74. HOSTADDR(RGF_DMA_EP_RX_ICR) +
  75. offsetof(struct RGF_ICR, IMS));
  76. }
  77. static void wil6210_mask_irq_misc(struct wil6210_priv *wil)
  78. {
  79. iowrite32(WIL6210_IRQ_DISABLE, wil->csr +
  80. HOSTADDR(RGF_DMA_EP_MISC_ICR) +
  81. offsetof(struct RGF_ICR, IMS));
  82. }
  83. static void wil6210_mask_irq_pseudo(struct wil6210_priv *wil)
  84. {
  85. wil_dbg_irq(wil, "%s()\n", __func__);
  86. iowrite32(WIL6210_IRQ_DISABLE, wil->csr +
  87. HOSTADDR(RGF_DMA_PSEUDO_CAUSE_MASK_SW));
  88. clear_bit(wil_status_irqen, wil->status);
  89. }
  90. void wil6210_unmask_irq_tx(struct wil6210_priv *wil)
  91. {
  92. iowrite32(WIL6210_IMC_TX, wil->csr +
  93. HOSTADDR(RGF_DMA_EP_TX_ICR) +
  94. offsetof(struct RGF_ICR, IMC));
  95. }
  96. void wil6210_unmask_irq_rx(struct wil6210_priv *wil)
  97. {
  98. iowrite32(WIL6210_IMC_RX, wil->csr +
  99. HOSTADDR(RGF_DMA_EP_RX_ICR) +
  100. offsetof(struct RGF_ICR, IMC));
  101. }
  102. static void wil6210_unmask_irq_misc(struct wil6210_priv *wil)
  103. {
  104. iowrite32(WIL6210_IMC_MISC, wil->csr +
  105. HOSTADDR(RGF_DMA_EP_MISC_ICR) +
  106. offsetof(struct RGF_ICR, IMC));
  107. }
  108. static void wil6210_unmask_irq_pseudo(struct wil6210_priv *wil)
  109. {
  110. wil_dbg_irq(wil, "%s()\n", __func__);
  111. set_bit(wil_status_irqen, wil->status);
  112. iowrite32(WIL6210_IRQ_PSEUDO_MASK, wil->csr +
  113. HOSTADDR(RGF_DMA_PSEUDO_CAUSE_MASK_SW));
  114. }
  115. void wil_mask_irq(struct wil6210_priv *wil)
  116. {
  117. wil_dbg_irq(wil, "%s()\n", __func__);
  118. wil6210_mask_irq_tx(wil);
  119. wil6210_mask_irq_rx(wil);
  120. wil6210_mask_irq_misc(wil);
  121. wil6210_mask_irq_pseudo(wil);
  122. }
  123. void wil_unmask_irq(struct wil6210_priv *wil)
  124. {
  125. wil_dbg_irq(wil, "%s()\n", __func__);
  126. iowrite32(WIL_ICR_ICC_VALUE, wil->csr + HOSTADDR(RGF_DMA_EP_RX_ICR) +
  127. offsetof(struct RGF_ICR, ICC));
  128. iowrite32(WIL_ICR_ICC_VALUE, wil->csr + HOSTADDR(RGF_DMA_EP_TX_ICR) +
  129. offsetof(struct RGF_ICR, ICC));
  130. iowrite32(WIL_ICR_ICC_VALUE, wil->csr + HOSTADDR(RGF_DMA_EP_MISC_ICR) +
  131. offsetof(struct RGF_ICR, ICC));
  132. wil6210_unmask_irq_pseudo(wil);
  133. wil6210_unmask_irq_tx(wil);
  134. wil6210_unmask_irq_rx(wil);
  135. wil6210_unmask_irq_misc(wil);
  136. }
  137. /* target write operation */
  138. #define W(a, v) do { iowrite32(v, wil->csr + HOSTADDR(a)); wmb(); } while (0)
  139. void wil_configure_interrupt_moderation(struct wil6210_priv *wil)
  140. {
  141. wil_dbg_irq(wil, "%s()\n", __func__);
  142. /* disable interrupt moderation for monitor
  143. * to get better timestamp precision
  144. */
  145. if (wil->wdev->iftype == NL80211_IFTYPE_MONITOR)
  146. return;
  147. /* Disable and clear tx counter before (re)configuration */
  148. W(RGF_DMA_ITR_TX_CNT_CTL, BIT_DMA_ITR_TX_CNT_CTL_CLR);
  149. W(RGF_DMA_ITR_TX_CNT_TRSH, wil->tx_max_burst_duration);
  150. wil_info(wil, "set ITR_TX_CNT_TRSH = %d usec\n",
  151. wil->tx_max_burst_duration);
  152. /* Configure TX max burst duration timer to use usec units */
  153. W(RGF_DMA_ITR_TX_CNT_CTL,
  154. BIT_DMA_ITR_TX_CNT_CTL_EN | BIT_DMA_ITR_TX_CNT_CTL_EXT_TIC_SEL);
  155. /* Disable and clear tx idle counter before (re)configuration */
  156. W(RGF_DMA_ITR_TX_IDL_CNT_CTL, BIT_DMA_ITR_TX_IDL_CNT_CTL_CLR);
  157. W(RGF_DMA_ITR_TX_IDL_CNT_TRSH, wil->tx_interframe_timeout);
  158. wil_info(wil, "set ITR_TX_IDL_CNT_TRSH = %d usec\n",
  159. wil->tx_interframe_timeout);
  160. /* Configure TX max burst duration timer to use usec units */
  161. W(RGF_DMA_ITR_TX_IDL_CNT_CTL, BIT_DMA_ITR_TX_IDL_CNT_CTL_EN |
  162. BIT_DMA_ITR_TX_IDL_CNT_CTL_EXT_TIC_SEL);
  163. /* Disable and clear rx counter before (re)configuration */
  164. W(RGF_DMA_ITR_RX_CNT_CTL, BIT_DMA_ITR_RX_CNT_CTL_CLR);
  165. W(RGF_DMA_ITR_RX_CNT_TRSH, wil->rx_max_burst_duration);
  166. wil_info(wil, "set ITR_RX_CNT_TRSH = %d usec\n",
  167. wil->rx_max_burst_duration);
  168. /* Configure TX max burst duration timer to use usec units */
  169. W(RGF_DMA_ITR_RX_CNT_CTL,
  170. BIT_DMA_ITR_RX_CNT_CTL_EN | BIT_DMA_ITR_RX_CNT_CTL_EXT_TIC_SEL);
  171. /* Disable and clear rx idle counter before (re)configuration */
  172. W(RGF_DMA_ITR_RX_IDL_CNT_CTL, BIT_DMA_ITR_RX_IDL_CNT_CTL_CLR);
  173. W(RGF_DMA_ITR_RX_IDL_CNT_TRSH, wil->rx_interframe_timeout);
  174. wil_info(wil, "set ITR_RX_IDL_CNT_TRSH = %d usec\n",
  175. wil->rx_interframe_timeout);
  176. /* Configure TX max burst duration timer to use usec units */
  177. W(RGF_DMA_ITR_RX_IDL_CNT_CTL, BIT_DMA_ITR_RX_IDL_CNT_CTL_EN |
  178. BIT_DMA_ITR_RX_IDL_CNT_CTL_EXT_TIC_SEL);
  179. }
  180. #undef W
  181. static irqreturn_t wil6210_irq_rx(int irq, void *cookie)
  182. {
  183. struct wil6210_priv *wil = cookie;
  184. u32 isr = wil_ioread32_and_clear(wil->csr +
  185. HOSTADDR(RGF_DMA_EP_RX_ICR) +
  186. offsetof(struct RGF_ICR, ICR));
  187. bool need_unmask = true;
  188. trace_wil6210_irq_rx(isr);
  189. wil_dbg_irq(wil, "ISR RX 0x%08x\n", isr);
  190. if (unlikely(!isr)) {
  191. wil_err(wil, "spurious IRQ: RX\n");
  192. return IRQ_NONE;
  193. }
  194. wil6210_mask_irq_rx(wil);
  195. /* RX_DONE and RX_HTRSH interrupts are the same if interrupt
  196. * moderation is not used. Interrupt moderation may cause RX
  197. * buffer overflow while RX_DONE is delayed. The required
  198. * action is always the same - should empty the accumulated
  199. * packets from the RX ring.
  200. */
  201. if (likely(isr & (BIT_DMA_EP_RX_ICR_RX_DONE |
  202. BIT_DMA_EP_RX_ICR_RX_HTRSH))) {
  203. wil_dbg_irq(wil, "RX done\n");
  204. if (unlikely(isr & BIT_DMA_EP_RX_ICR_RX_HTRSH))
  205. wil_err_ratelimited(wil,
  206. "Received \"Rx buffer is in risk of overflow\" interrupt\n");
  207. isr &= ~(BIT_DMA_EP_RX_ICR_RX_DONE |
  208. BIT_DMA_EP_RX_ICR_RX_HTRSH);
  209. if (likely(test_bit(wil_status_reset_done, wil->status))) {
  210. if (likely(test_bit(wil_status_napi_en, wil->status))) {
  211. wil_dbg_txrx(wil, "NAPI(Rx) schedule\n");
  212. need_unmask = false;
  213. napi_schedule(&wil->napi_rx);
  214. } else {
  215. wil_err(wil,
  216. "Got Rx interrupt while stopping interface\n");
  217. }
  218. } else {
  219. wil_err(wil, "Got Rx interrupt while in reset\n");
  220. }
  221. }
  222. if (unlikely(isr))
  223. wil_err(wil, "un-handled RX ISR bits 0x%08x\n", isr);
  224. /* Rx IRQ will be enabled when NAPI processing finished */
  225. atomic_inc(&wil->isr_count_rx);
  226. if (unlikely(need_unmask))
  227. wil6210_unmask_irq_rx(wil);
  228. return IRQ_HANDLED;
  229. }
  230. static irqreturn_t wil6210_irq_tx(int irq, void *cookie)
  231. {
  232. struct wil6210_priv *wil = cookie;
  233. u32 isr = wil_ioread32_and_clear(wil->csr +
  234. HOSTADDR(RGF_DMA_EP_TX_ICR) +
  235. offsetof(struct RGF_ICR, ICR));
  236. bool need_unmask = true;
  237. trace_wil6210_irq_tx(isr);
  238. wil_dbg_irq(wil, "ISR TX 0x%08x\n", isr);
  239. if (unlikely(!isr)) {
  240. wil_err(wil, "spurious IRQ: TX\n");
  241. return IRQ_NONE;
  242. }
  243. wil6210_mask_irq_tx(wil);
  244. if (likely(isr & BIT_DMA_EP_TX_ICR_TX_DONE)) {
  245. wil_dbg_irq(wil, "TX done\n");
  246. isr &= ~BIT_DMA_EP_TX_ICR_TX_DONE;
  247. /* clear also all VRING interrupts */
  248. isr &= ~(BIT(25) - 1UL);
  249. if (likely(test_bit(wil_status_reset_done, wil->status))) {
  250. wil_dbg_txrx(wil, "NAPI(Tx) schedule\n");
  251. need_unmask = false;
  252. napi_schedule(&wil->napi_tx);
  253. } else {
  254. wil_err(wil, "Got Tx interrupt while in reset\n");
  255. }
  256. }
  257. if (unlikely(isr))
  258. wil_err(wil, "un-handled TX ISR bits 0x%08x\n", isr);
  259. /* Tx IRQ will be enabled when NAPI processing finished */
  260. atomic_inc(&wil->isr_count_tx);
  261. if (unlikely(need_unmask))
  262. wil6210_unmask_irq_tx(wil);
  263. return IRQ_HANDLED;
  264. }
  265. static void wil_notify_fw_error(struct wil6210_priv *wil)
  266. {
  267. struct device *dev = &wil_to_ndev(wil)->dev;
  268. char *envp[3] = {
  269. [0] = "SOURCE=wil6210",
  270. [1] = "EVENT=FW_ERROR",
  271. [2] = NULL,
  272. };
  273. wil_err(wil, "Notify about firmware error\n");
  274. kobject_uevent_env(&dev->kobj, KOBJ_CHANGE, envp);
  275. }
  276. static void wil_cache_mbox_regs(struct wil6210_priv *wil)
  277. {
  278. /* make shadow copy of registers that should not change on run time */
  279. wil_memcpy_fromio_32(&wil->mbox_ctl, wil->csr + HOST_MBOX,
  280. sizeof(struct wil6210_mbox_ctl));
  281. wil_mbox_ring_le2cpus(&wil->mbox_ctl.rx);
  282. wil_mbox_ring_le2cpus(&wil->mbox_ctl.tx);
  283. }
  284. static irqreturn_t wil6210_irq_misc(int irq, void *cookie)
  285. {
  286. struct wil6210_priv *wil = cookie;
  287. u32 isr = wil_ioread32_and_clear(wil->csr +
  288. HOSTADDR(RGF_DMA_EP_MISC_ICR) +
  289. offsetof(struct RGF_ICR, ICR));
  290. trace_wil6210_irq_misc(isr);
  291. wil_dbg_irq(wil, "ISR MISC 0x%08x\n", isr);
  292. if (!isr) {
  293. wil_err(wil, "spurious IRQ: MISC\n");
  294. return IRQ_NONE;
  295. }
  296. wil6210_mask_irq_misc(wil);
  297. if (isr & ISR_MISC_FW_ERROR) {
  298. wil_err(wil, "Firmware error detected\n");
  299. clear_bit(wil_status_fwready, wil->status);
  300. /*
  301. * do not clear @isr here - we do 2-nd part in thread
  302. * there, user space get notified, and it should be done
  303. * in non-atomic context
  304. */
  305. }
  306. if (isr & ISR_MISC_FW_READY) {
  307. wil_dbg_irq(wil, "IRQ: FW ready\n");
  308. wil_cache_mbox_regs(wil);
  309. set_bit(wil_status_reset_done, wil->status);
  310. /**
  311. * Actual FW ready indicated by the
  312. * WMI_FW_READY_EVENTID
  313. */
  314. isr &= ~ISR_MISC_FW_READY;
  315. }
  316. wil->isr_misc = isr;
  317. if (isr) {
  318. return IRQ_WAKE_THREAD;
  319. } else {
  320. wil6210_unmask_irq_misc(wil);
  321. return IRQ_HANDLED;
  322. }
  323. }
  324. static irqreturn_t wil6210_irq_misc_thread(int irq, void *cookie)
  325. {
  326. struct wil6210_priv *wil = cookie;
  327. u32 isr = wil->isr_misc;
  328. trace_wil6210_irq_misc_thread(isr);
  329. wil_dbg_irq(wil, "Thread ISR MISC 0x%08x\n", isr);
  330. if (isr & ISR_MISC_FW_ERROR) {
  331. wil_notify_fw_error(wil);
  332. isr &= ~ISR_MISC_FW_ERROR;
  333. wil_fw_error_recovery(wil);
  334. }
  335. if (isr & ISR_MISC_MBOX_EVT) {
  336. wil_dbg_irq(wil, "MBOX event\n");
  337. wmi_recv_cmd(wil);
  338. isr &= ~ISR_MISC_MBOX_EVT;
  339. }
  340. if (isr)
  341. wil_dbg_irq(wil, "un-handled MISC ISR bits 0x%08x\n", isr);
  342. wil->isr_misc = 0;
  343. wil6210_unmask_irq_misc(wil);
  344. return IRQ_HANDLED;
  345. }
  346. /**
  347. * thread IRQ handler
  348. */
  349. static irqreturn_t wil6210_thread_irq(int irq, void *cookie)
  350. {
  351. struct wil6210_priv *wil = cookie;
  352. wil_dbg_irq(wil, "Thread IRQ\n");
  353. /* Discover real IRQ cause */
  354. if (wil->isr_misc)
  355. wil6210_irq_misc_thread(irq, cookie);
  356. wil6210_unmask_irq_pseudo(wil);
  357. return IRQ_HANDLED;
  358. }
  359. /* DEBUG
  360. * There is subtle bug in hardware that causes IRQ to raise when it should be
  361. * masked. It is quite rare and hard to debug.
  362. *
  363. * Catch irq issue if it happens and print all I can.
  364. */
  365. static int wil6210_debug_irq_mask(struct wil6210_priv *wil, u32 pseudo_cause)
  366. {
  367. if (!test_bit(wil_status_irqen, wil->status)) {
  368. u32 icm_rx = wil_ioread32_and_clear(wil->csr +
  369. HOSTADDR(RGF_DMA_EP_RX_ICR) +
  370. offsetof(struct RGF_ICR, ICM));
  371. u32 icr_rx = wil_ioread32_and_clear(wil->csr +
  372. HOSTADDR(RGF_DMA_EP_RX_ICR) +
  373. offsetof(struct RGF_ICR, ICR));
  374. u32 imv_rx = ioread32(wil->csr +
  375. HOSTADDR(RGF_DMA_EP_RX_ICR) +
  376. offsetof(struct RGF_ICR, IMV));
  377. u32 icm_tx = wil_ioread32_and_clear(wil->csr +
  378. HOSTADDR(RGF_DMA_EP_TX_ICR) +
  379. offsetof(struct RGF_ICR, ICM));
  380. u32 icr_tx = wil_ioread32_and_clear(wil->csr +
  381. HOSTADDR(RGF_DMA_EP_TX_ICR) +
  382. offsetof(struct RGF_ICR, ICR));
  383. u32 imv_tx = ioread32(wil->csr +
  384. HOSTADDR(RGF_DMA_EP_TX_ICR) +
  385. offsetof(struct RGF_ICR, IMV));
  386. u32 icm_misc = wil_ioread32_and_clear(wil->csr +
  387. HOSTADDR(RGF_DMA_EP_MISC_ICR) +
  388. offsetof(struct RGF_ICR, ICM));
  389. u32 icr_misc = wil_ioread32_and_clear(wil->csr +
  390. HOSTADDR(RGF_DMA_EP_MISC_ICR) +
  391. offsetof(struct RGF_ICR, ICR));
  392. u32 imv_misc = ioread32(wil->csr +
  393. HOSTADDR(RGF_DMA_EP_MISC_ICR) +
  394. offsetof(struct RGF_ICR, IMV));
  395. wil_err(wil, "IRQ when it should be masked: pseudo 0x%08x\n"
  396. "Rx icm:icr:imv 0x%08x 0x%08x 0x%08x\n"
  397. "Tx icm:icr:imv 0x%08x 0x%08x 0x%08x\n"
  398. "Misc icm:icr:imv 0x%08x 0x%08x 0x%08x\n",
  399. pseudo_cause,
  400. icm_rx, icr_rx, imv_rx,
  401. icm_tx, icr_tx, imv_tx,
  402. icm_misc, icr_misc, imv_misc);
  403. return -EINVAL;
  404. }
  405. return 0;
  406. }
  407. static irqreturn_t wil6210_hardirq(int irq, void *cookie)
  408. {
  409. irqreturn_t rc = IRQ_HANDLED;
  410. struct wil6210_priv *wil = cookie;
  411. u32 pseudo_cause = ioread32(wil->csr + HOSTADDR(RGF_DMA_PSEUDO_CAUSE));
  412. /**
  413. * pseudo_cause is Clear-On-Read, no need to ACK
  414. */
  415. if (unlikely((pseudo_cause == 0) || ((pseudo_cause & 0xff) == 0xff)))
  416. return IRQ_NONE;
  417. /* FIXME: IRQ mask debug */
  418. if (unlikely(wil6210_debug_irq_mask(wil, pseudo_cause)))
  419. return IRQ_NONE;
  420. trace_wil6210_irq_pseudo(pseudo_cause);
  421. wil_dbg_irq(wil, "Pseudo IRQ 0x%08x\n", pseudo_cause);
  422. wil6210_mask_irq_pseudo(wil);
  423. /* Discover real IRQ cause
  424. * There are 2 possible phases for every IRQ:
  425. * - hard IRQ handler called right here
  426. * - threaded handler called later
  427. *
  428. * Hard IRQ handler reads and clears ISR.
  429. *
  430. * If threaded handler requested, hard IRQ handler
  431. * returns IRQ_WAKE_THREAD and saves ISR register value
  432. * for the threaded handler use.
  433. *
  434. * voting for wake thread - need at least 1 vote
  435. */
  436. if ((pseudo_cause & BIT_DMA_PSEUDO_CAUSE_RX) &&
  437. (wil6210_irq_rx(irq, cookie) == IRQ_WAKE_THREAD))
  438. rc = IRQ_WAKE_THREAD;
  439. if ((pseudo_cause & BIT_DMA_PSEUDO_CAUSE_TX) &&
  440. (wil6210_irq_tx(irq, cookie) == IRQ_WAKE_THREAD))
  441. rc = IRQ_WAKE_THREAD;
  442. if ((pseudo_cause & BIT_DMA_PSEUDO_CAUSE_MISC) &&
  443. (wil6210_irq_misc(irq, cookie) == IRQ_WAKE_THREAD))
  444. rc = IRQ_WAKE_THREAD;
  445. /* if thread is requested, it will unmask IRQ */
  446. if (rc != IRQ_WAKE_THREAD)
  447. wil6210_unmask_irq_pseudo(wil);
  448. return rc;
  449. }
  450. static int wil6210_request_3msi(struct wil6210_priv *wil, int irq)
  451. {
  452. int rc;
  453. /*
  454. * IRQ's are in the following order:
  455. * - Tx
  456. * - Rx
  457. * - Misc
  458. */
  459. rc = request_irq(irq, wil6210_irq_tx, IRQF_SHARED,
  460. WIL_NAME"_tx", wil);
  461. if (rc)
  462. return rc;
  463. rc = request_irq(irq + 1, wil6210_irq_rx, IRQF_SHARED,
  464. WIL_NAME"_rx", wil);
  465. if (rc)
  466. goto free0;
  467. rc = request_threaded_irq(irq + 2, wil6210_irq_misc,
  468. wil6210_irq_misc_thread,
  469. IRQF_SHARED, WIL_NAME"_misc", wil);
  470. if (rc)
  471. goto free1;
  472. return 0;
  473. /* error branch */
  474. free1:
  475. free_irq(irq + 1, wil);
  476. free0:
  477. free_irq(irq, wil);
  478. return rc;
  479. }
  480. /* can't use wil_ioread32_and_clear because ICC value is not set yet */
  481. static inline void wil_clear32(void __iomem *addr)
  482. {
  483. u32 x = ioread32(addr);
  484. iowrite32(x, addr);
  485. }
  486. void wil6210_clear_irq(struct wil6210_priv *wil)
  487. {
  488. wil_clear32(wil->csr + HOSTADDR(RGF_DMA_EP_RX_ICR) +
  489. offsetof(struct RGF_ICR, ICR));
  490. wil_clear32(wil->csr + HOSTADDR(RGF_DMA_EP_TX_ICR) +
  491. offsetof(struct RGF_ICR, ICR));
  492. wil_clear32(wil->csr + HOSTADDR(RGF_DMA_EP_MISC_ICR) +
  493. offsetof(struct RGF_ICR, ICR));
  494. wmb(); /* make sure write completed */
  495. }
  496. int wil6210_init_irq(struct wil6210_priv *wil, int irq)
  497. {
  498. int rc;
  499. wil_dbg_misc(wil, "%s() n_msi=%d\n", __func__, wil->n_msi);
  500. if (wil->n_msi == 3)
  501. rc = wil6210_request_3msi(wil, irq);
  502. else
  503. rc = request_threaded_irq(irq, wil6210_hardirq,
  504. wil6210_thread_irq,
  505. wil->n_msi ? 0 : IRQF_SHARED,
  506. WIL_NAME, wil);
  507. return rc;
  508. }
  509. void wil6210_fini_irq(struct wil6210_priv *wil, int irq)
  510. {
  511. wil_dbg_misc(wil, "%s()\n", __func__);
  512. wil_mask_irq(wil);
  513. free_irq(irq, wil);
  514. if (wil->n_msi == 3) {
  515. free_irq(irq + 1, wil);
  516. free_irq(irq + 2, wil);
  517. }
  518. }