blob: 201cf06ef5d8e4c1ab6643062ff7d699648b4e7d [file] [log] [blame]
Vladimir Kondratiev2be7d222012-12-20 13:13:19 -08001/*
2 * Copyright (c) 2012 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
17#include <linux/interrupt.h>
18
19#include "wil6210.h"
Vladimir Kondratiev98658092013-05-12 14:43:35 +030020#include "trace.h"
Vladimir Kondratiev2be7d222012-12-20 13:13:19 -080021
22/**
23 * Theory of operation:
24 *
25 * There is ISR pseudo-cause register,
26 * dma_rgf->DMA_RGF.PSEUDO_CAUSE.PSEUDO_CAUSE
27 * Its bits represents OR'ed bits from 3 real ISR registers:
28 * TX, RX, and MISC.
29 *
30 * Registers may be configured to either "write 1 to clear" or
31 * "clear on read" mode
32 *
33 * When handling interrupt, one have to mask/unmask interrupts for the
34 * real ISR registers, or hardware may malfunction.
35 *
36 */
37
38#define WIL6210_IRQ_DISABLE (0xFFFFFFFFUL)
39#define WIL6210_IMC_RX BIT_DMA_EP_RX_ICR_RX_DONE
40#define WIL6210_IMC_TX (BIT_DMA_EP_TX_ICR_TX_DONE | \
41 BIT_DMA_EP_TX_ICR_TX_DONE_N(0))
Vladimir Kondratiev72694942013-01-28 18:30:56 +020042#define WIL6210_IMC_MISC (ISR_MISC_FW_READY | \
43 ISR_MISC_MBOX_EVT | \
44 ISR_MISC_FW_ERROR)
Vladimir Kondratiev2be7d222012-12-20 13:13:19 -080045
46#define WIL6210_IRQ_PSEUDO_MASK (u32)(~(BIT_DMA_PSEUDO_CAUSE_RX | \
47 BIT_DMA_PSEUDO_CAUSE_TX | \
48 BIT_DMA_PSEUDO_CAUSE_MISC))
49
50#if defined(CONFIG_WIL6210_ISR_COR)
51/* configure to Clear-On-Read mode */
52#define WIL_ICR_ICC_VALUE (0xFFFFFFFFUL)
53
54static inline void wil_icr_clear(u32 x, void __iomem *addr)
55{
Vladimir Kondratiev2be7d222012-12-20 13:13:19 -080056}
57#else /* defined(CONFIG_WIL6210_ISR_COR) */
58/* configure to Write-1-to-Clear mode */
59#define WIL_ICR_ICC_VALUE (0UL)
60
61static inline void wil_icr_clear(u32 x, void __iomem *addr)
62{
63 iowrite32(x, addr);
64}
65#endif /* defined(CONFIG_WIL6210_ISR_COR) */
66
67static inline u32 wil_ioread32_and_clear(void __iomem *addr)
68{
69 u32 x = ioread32(addr);
70
71 wil_icr_clear(x, addr);
72
73 return x;
74}
75
76static void wil6210_mask_irq_tx(struct wil6210_priv *wil)
77{
78 iowrite32(WIL6210_IRQ_DISABLE, wil->csr +
79 HOSTADDR(RGF_DMA_EP_TX_ICR) +
80 offsetof(struct RGF_ICR, IMS));
81}
82
83static void wil6210_mask_irq_rx(struct wil6210_priv *wil)
84{
85 iowrite32(WIL6210_IRQ_DISABLE, wil->csr +
86 HOSTADDR(RGF_DMA_EP_RX_ICR) +
87 offsetof(struct RGF_ICR, IMS));
88}
89
90static void wil6210_mask_irq_misc(struct wil6210_priv *wil)
91{
92 iowrite32(WIL6210_IRQ_DISABLE, wil->csr +
93 HOSTADDR(RGF_DMA_EP_MISC_ICR) +
94 offsetof(struct RGF_ICR, IMS));
95}
96
97static void wil6210_mask_irq_pseudo(struct wil6210_priv *wil)
98{
Vladimir Kondratiev77438822013-01-28 18:31:06 +020099 wil_dbg_irq(wil, "%s()\n", __func__);
Vladimir Kondratiev2be7d222012-12-20 13:13:19 -0800100
101 iowrite32(WIL6210_IRQ_DISABLE, wil->csr +
102 HOSTADDR(RGF_DMA_PSEUDO_CAUSE_MASK_SW));
103
104 clear_bit(wil_status_irqen, &wil->status);
105}
106
Vladimir Kondratieve0287c42013-05-12 14:43:36 +0300107void wil6210_unmask_irq_tx(struct wil6210_priv *wil)
Vladimir Kondratiev2be7d222012-12-20 13:13:19 -0800108{
109 iowrite32(WIL6210_IMC_TX, wil->csr +
110 HOSTADDR(RGF_DMA_EP_TX_ICR) +
111 offsetof(struct RGF_ICR, IMC));
112}
113
Vladimir Kondratieve0287c42013-05-12 14:43:36 +0300114void wil6210_unmask_irq_rx(struct wil6210_priv *wil)
Vladimir Kondratiev2be7d222012-12-20 13:13:19 -0800115{
116 iowrite32(WIL6210_IMC_RX, wil->csr +
117 HOSTADDR(RGF_DMA_EP_RX_ICR) +
118 offsetof(struct RGF_ICR, IMC));
119}
120
121static void wil6210_unmask_irq_misc(struct wil6210_priv *wil)
122{
123 iowrite32(WIL6210_IMC_MISC, wil->csr +
124 HOSTADDR(RGF_DMA_EP_MISC_ICR) +
125 offsetof(struct RGF_ICR, IMC));
126}
127
128static void wil6210_unmask_irq_pseudo(struct wil6210_priv *wil)
129{
Vladimir Kondratiev77438822013-01-28 18:31:06 +0200130 wil_dbg_irq(wil, "%s()\n", __func__);
Vladimir Kondratiev2be7d222012-12-20 13:13:19 -0800131
132 set_bit(wil_status_irqen, &wil->status);
133
134 iowrite32(WIL6210_IRQ_PSEUDO_MASK, wil->csr +
135 HOSTADDR(RGF_DMA_PSEUDO_CAUSE_MASK_SW));
136}
137
138void wil6210_disable_irq(struct wil6210_priv *wil)
139{
Vladimir Kondratiev77438822013-01-28 18:31:06 +0200140 wil_dbg_irq(wil, "%s()\n", __func__);
Vladimir Kondratiev2be7d222012-12-20 13:13:19 -0800141
142 wil6210_mask_irq_tx(wil);
143 wil6210_mask_irq_rx(wil);
144 wil6210_mask_irq_misc(wil);
145 wil6210_mask_irq_pseudo(wil);
146}
147
148void wil6210_enable_irq(struct wil6210_priv *wil)
149{
Vladimir Kondratiev77438822013-01-28 18:31:06 +0200150 wil_dbg_irq(wil, "%s()\n", __func__);
Vladimir Kondratiev2be7d222012-12-20 13:13:19 -0800151
152 iowrite32(WIL_ICR_ICC_VALUE, wil->csr + HOSTADDR(RGF_DMA_EP_RX_ICR) +
153 offsetof(struct RGF_ICR, ICC));
154 iowrite32(WIL_ICR_ICC_VALUE, wil->csr + HOSTADDR(RGF_DMA_EP_TX_ICR) +
155 offsetof(struct RGF_ICR, ICC));
156 iowrite32(WIL_ICR_ICC_VALUE, wil->csr + HOSTADDR(RGF_DMA_EP_MISC_ICR) +
157 offsetof(struct RGF_ICR, ICC));
158
Vladimir Kondratiev83982cb2014-01-08 11:50:47 +0200159 /* interrupt moderation parameters */
160 if (wil->wdev->iftype == NL80211_IFTYPE_MONITOR) {
161 /* disable interrupt moderation for monitor
162 * to get better timestamp precision
163 */
164 iowrite32(0, wil->csr + HOSTADDR(RGF_DMA_ITR_CNT_CRL));
165 } else {
166 iowrite32(WIL6210_ITR_TRSH,
167 wil->csr + HOSTADDR(RGF_DMA_ITR_CNT_TRSH));
168 iowrite32(BIT_DMA_ITR_CNT_CRL_EN,
169 wil->csr + HOSTADDR(RGF_DMA_ITR_CNT_CRL));
170 }
171
Vladimir Kondratiev2be7d222012-12-20 13:13:19 -0800172 wil6210_unmask_irq_pseudo(wil);
173 wil6210_unmask_irq_tx(wil);
174 wil6210_unmask_irq_rx(wil);
175 wil6210_unmask_irq_misc(wil);
176}
177
178static irqreturn_t wil6210_irq_rx(int irq, void *cookie)
179{
180 struct wil6210_priv *wil = cookie;
181 u32 isr = wil_ioread32_and_clear(wil->csr +
182 HOSTADDR(RGF_DMA_EP_RX_ICR) +
183 offsetof(struct RGF_ICR, ICR));
184
Vladimir Kondratiev98658092013-05-12 14:43:35 +0300185 trace_wil6210_irq_rx(isr);
Vladimir Kondratiev77438822013-01-28 18:31:06 +0200186 wil_dbg_irq(wil, "ISR RX 0x%08x\n", isr);
Vladimir Kondratiev2be7d222012-12-20 13:13:19 -0800187
188 if (!isr) {
189 wil_err(wil, "spurious IRQ: RX\n");
190 return IRQ_NONE;
191 }
192
193 wil6210_mask_irq_rx(wil);
194
195 if (isr & BIT_DMA_EP_RX_ICR_RX_DONE) {
Vladimir Kondratiev77438822013-01-28 18:31:06 +0200196 wil_dbg_irq(wil, "RX done\n");
Vladimir Kondratiev2be7d222012-12-20 13:13:19 -0800197 isr &= ~BIT_DMA_EP_RX_ICR_RX_DONE;
Vladimir Kondratiev0fef1812014-03-17 15:34:18 +0200198 if (test_bit(wil_status_reset_done, &wil->status)) {
199 wil_dbg_txrx(wil, "NAPI(Rx) schedule\n");
200 napi_schedule(&wil->napi_rx);
201 } else {
202 wil_err(wil, "Got Rx interrupt while in reset\n");
203 }
Vladimir Kondratiev2be7d222012-12-20 13:13:19 -0800204 }
205
206 if (isr)
207 wil_err(wil, "un-handled RX ISR bits 0x%08x\n", isr);
208
Vladimir Kondratieve0287c42013-05-12 14:43:36 +0300209 /* Rx IRQ will be enabled when NAPI processing finished */
Vladimir Kondratiev2be7d222012-12-20 13:13:19 -0800210
211 return IRQ_HANDLED;
212}
213
214static irqreturn_t wil6210_irq_tx(int irq, void *cookie)
215{
216 struct wil6210_priv *wil = cookie;
217 u32 isr = wil_ioread32_and_clear(wil->csr +
218 HOSTADDR(RGF_DMA_EP_TX_ICR) +
219 offsetof(struct RGF_ICR, ICR));
220
Vladimir Kondratiev98658092013-05-12 14:43:35 +0300221 trace_wil6210_irq_tx(isr);
Vladimir Kondratiev77438822013-01-28 18:31:06 +0200222 wil_dbg_irq(wil, "ISR TX 0x%08x\n", isr);
Vladimir Kondratiev2be7d222012-12-20 13:13:19 -0800223
224 if (!isr) {
225 wil_err(wil, "spurious IRQ: TX\n");
226 return IRQ_NONE;
227 }
228
229 wil6210_mask_irq_tx(wil);
230
231 if (isr & BIT_DMA_EP_TX_ICR_TX_DONE) {
Vladimir Kondratiev77438822013-01-28 18:31:06 +0200232 wil_dbg_irq(wil, "TX done\n");
Vladimir Kondratiev2be7d222012-12-20 13:13:19 -0800233 isr &= ~BIT_DMA_EP_TX_ICR_TX_DONE;
Vladimir Kondratieve0287c42013-05-12 14:43:36 +0300234 /* clear also all VRING interrupts */
235 isr &= ~(BIT(25) - 1UL);
Vladimir Kondratiev0fef1812014-03-17 15:34:18 +0200236 if (test_bit(wil_status_reset_done, &wil->status)) {
237 wil_dbg_txrx(wil, "NAPI(Tx) schedule\n");
238 napi_schedule(&wil->napi_tx);
239 } else {
240 wil_err(wil, "Got Tx interrupt while in reset\n");
241 }
Vladimir Kondratiev2be7d222012-12-20 13:13:19 -0800242 }
243
244 if (isr)
245 wil_err(wil, "un-handled TX ISR bits 0x%08x\n", isr);
246
Vladimir Kondratieve0287c42013-05-12 14:43:36 +0300247 /* Tx IRQ will be enabled when NAPI processing finished */
Vladimir Kondratiev2be7d222012-12-20 13:13:19 -0800248
249 return IRQ_HANDLED;
250}
251
Vladimir Kondratiev72694942013-01-28 18:30:56 +0200252static void wil_notify_fw_error(struct wil6210_priv *wil)
253{
254 struct device *dev = &wil_to_ndev(wil)->dev;
255 char *envp[3] = {
256 [0] = "SOURCE=wil6210",
257 [1] = "EVENT=FW_ERROR",
258 [2] = NULL,
259 };
260 kobject_uevent_env(&dev->kobj, KOBJ_CHANGE, envp);
261}
262
Vladimir Kondratiev55f7acd2013-03-13 14:12:49 +0200263static void wil_cache_mbox_regs(struct wil6210_priv *wil)
264{
265 /* make shadow copy of registers that should not change on run time */
266 wil_memcpy_fromio_32(&wil->mbox_ctl, wil->csr + HOST_MBOX,
267 sizeof(struct wil6210_mbox_ctl));
268 wil_mbox_ring_le2cpus(&wil->mbox_ctl.rx);
269 wil_mbox_ring_le2cpus(&wil->mbox_ctl.tx);
270}
271
Vladimir Kondratiev2be7d222012-12-20 13:13:19 -0800272static irqreturn_t wil6210_irq_misc(int irq, void *cookie)
273{
274 struct wil6210_priv *wil = cookie;
275 u32 isr = wil_ioread32_and_clear(wil->csr +
276 HOSTADDR(RGF_DMA_EP_MISC_ICR) +
277 offsetof(struct RGF_ICR, ICR));
278
Vladimir Kondratiev98658092013-05-12 14:43:35 +0300279 trace_wil6210_irq_misc(isr);
Vladimir Kondratiev77438822013-01-28 18:31:06 +0200280 wil_dbg_irq(wil, "ISR MISC 0x%08x\n", isr);
Vladimir Kondratiev2be7d222012-12-20 13:13:19 -0800281
282 if (!isr) {
283 wil_err(wil, "spurious IRQ: MISC\n");
284 return IRQ_NONE;
285 }
286
287 wil6210_mask_irq_misc(wil);
288
Vladimir Kondratiev72694942013-01-28 18:30:56 +0200289 if (isr & ISR_MISC_FW_ERROR) {
Vladimir Kondratievde70ab82013-03-13 14:12:46 +0200290 wil_err(wil, "Firmware error detected\n");
Vladimir Kondratiev72694942013-01-28 18:30:56 +0200291 clear_bit(wil_status_fwready, &wil->status);
Vladimir Kondratievde70ab82013-03-13 14:12:46 +0200292 /*
293 * do not clear @isr here - we do 2-nd part in thread
294 * there, user space get notified, and it should be done
295 * in non-atomic context
296 */
Vladimir Kondratiev72694942013-01-28 18:30:56 +0200297 }
298
Vladimir Kondratiev2be7d222012-12-20 13:13:19 -0800299 if (isr & ISR_MISC_FW_READY) {
Vladimir Kondratiev77438822013-01-28 18:31:06 +0200300 wil_dbg_irq(wil, "IRQ: FW ready\n");
Vladimir Kondratiev55f7acd2013-03-13 14:12:49 +0200301 wil_cache_mbox_regs(wil);
302 set_bit(wil_status_reset_done, &wil->status);
Vladimir Kondratiev2be7d222012-12-20 13:13:19 -0800303 /**
304 * Actual FW ready indicated by the
305 * WMI_FW_READY_EVENTID
306 */
307 isr &= ~ISR_MISC_FW_READY;
308 }
309
310 wil->isr_misc = isr;
311
312 if (isr) {
313 return IRQ_WAKE_THREAD;
314 } else {
315 wil6210_unmask_irq_misc(wil);
316 return IRQ_HANDLED;
317 }
318}
319
320static irqreturn_t wil6210_irq_misc_thread(int irq, void *cookie)
321{
322 struct wil6210_priv *wil = cookie;
323 u32 isr = wil->isr_misc;
324
Vladimir Kondratiev98658092013-05-12 14:43:35 +0300325 trace_wil6210_irq_misc_thread(isr);
Vladimir Kondratiev77438822013-01-28 18:31:06 +0200326 wil_dbg_irq(wil, "Thread ISR MISC 0x%08x\n", isr);
Vladimir Kondratiev2be7d222012-12-20 13:13:19 -0800327
Vladimir Kondratievde70ab82013-03-13 14:12:46 +0200328 if (isr & ISR_MISC_FW_ERROR) {
329 wil_notify_fw_error(wil);
330 isr &= ~ISR_MISC_FW_ERROR;
331 }
332
Vladimir Kondratiev2be7d222012-12-20 13:13:19 -0800333 if (isr & ISR_MISC_MBOX_EVT) {
Vladimir Kondratiev77438822013-01-28 18:31:06 +0200334 wil_dbg_irq(wil, "MBOX event\n");
Vladimir Kondratiev2be7d222012-12-20 13:13:19 -0800335 wmi_recv_cmd(wil);
336 isr &= ~ISR_MISC_MBOX_EVT;
337 }
338
339 if (isr)
340 wil_err(wil, "un-handled MISC ISR bits 0x%08x\n", isr);
341
342 wil->isr_misc = 0;
343
344 wil6210_unmask_irq_misc(wil);
345
346 return IRQ_HANDLED;
347}
348
349/**
350 * thread IRQ handler
351 */
352static irqreturn_t wil6210_thread_irq(int irq, void *cookie)
353{
354 struct wil6210_priv *wil = cookie;
355
Vladimir Kondratiev77438822013-01-28 18:31:06 +0200356 wil_dbg_irq(wil, "Thread IRQ\n");
Vladimir Kondratiev2be7d222012-12-20 13:13:19 -0800357 /* Discover real IRQ cause */
358 if (wil->isr_misc)
359 wil6210_irq_misc_thread(irq, cookie);
360
361 wil6210_unmask_irq_pseudo(wil);
362
363 return IRQ_HANDLED;
364}
365
366/* DEBUG
367 * There is subtle bug in hardware that causes IRQ to raise when it should be
368 * masked. It is quite rare and hard to debug.
369 *
370 * Catch irq issue if it happens and print all I can.
371 */
372static int wil6210_debug_irq_mask(struct wil6210_priv *wil, u32 pseudo_cause)
373{
374 if (!test_bit(wil_status_irqen, &wil->status)) {
375 u32 icm_rx = wil_ioread32_and_clear(wil->csr +
376 HOSTADDR(RGF_DMA_EP_RX_ICR) +
377 offsetof(struct RGF_ICR, ICM));
378 u32 icr_rx = wil_ioread32_and_clear(wil->csr +
379 HOSTADDR(RGF_DMA_EP_RX_ICR) +
380 offsetof(struct RGF_ICR, ICR));
381 u32 imv_rx = ioread32(wil->csr +
382 HOSTADDR(RGF_DMA_EP_RX_ICR) +
383 offsetof(struct RGF_ICR, IMV));
384 u32 icm_tx = wil_ioread32_and_clear(wil->csr +
385 HOSTADDR(RGF_DMA_EP_TX_ICR) +
386 offsetof(struct RGF_ICR, ICM));
387 u32 icr_tx = wil_ioread32_and_clear(wil->csr +
388 HOSTADDR(RGF_DMA_EP_TX_ICR) +
389 offsetof(struct RGF_ICR, ICR));
390 u32 imv_tx = ioread32(wil->csr +
391 HOSTADDR(RGF_DMA_EP_TX_ICR) +
392 offsetof(struct RGF_ICR, IMV));
393 u32 icm_misc = wil_ioread32_and_clear(wil->csr +
394 HOSTADDR(RGF_DMA_EP_MISC_ICR) +
395 offsetof(struct RGF_ICR, ICM));
396 u32 icr_misc = wil_ioread32_and_clear(wil->csr +
397 HOSTADDR(RGF_DMA_EP_MISC_ICR) +
398 offsetof(struct RGF_ICR, ICR));
399 u32 imv_misc = ioread32(wil->csr +
400 HOSTADDR(RGF_DMA_EP_MISC_ICR) +
401 offsetof(struct RGF_ICR, IMV));
402 wil_err(wil, "IRQ when it should be masked: pseudo 0x%08x\n"
403 "Rx icm:icr:imv 0x%08x 0x%08x 0x%08x\n"
404 "Tx icm:icr:imv 0x%08x 0x%08x 0x%08x\n"
405 "Misc icm:icr:imv 0x%08x 0x%08x 0x%08x\n",
406 pseudo_cause,
407 icm_rx, icr_rx, imv_rx,
408 icm_tx, icr_tx, imv_tx,
409 icm_misc, icr_misc, imv_misc);
410
411 return -EINVAL;
412 }
413
414 return 0;
415}
416
417static irqreturn_t wil6210_hardirq(int irq, void *cookie)
418{
419 irqreturn_t rc = IRQ_HANDLED;
420 struct wil6210_priv *wil = cookie;
421 u32 pseudo_cause = ioread32(wil->csr + HOSTADDR(RGF_DMA_PSEUDO_CAUSE));
422
423 /**
424 * pseudo_cause is Clear-On-Read, no need to ACK
425 */
426 if ((pseudo_cause == 0) || ((pseudo_cause & 0xff) == 0xff))
427 return IRQ_NONE;
428
429 /* FIXME: IRQ mask debug */
430 if (wil6210_debug_irq_mask(wil, pseudo_cause))
431 return IRQ_NONE;
432
Vladimir Kondratiev98658092013-05-12 14:43:35 +0300433 trace_wil6210_irq_pseudo(pseudo_cause);
Vladimir Kondratiev77438822013-01-28 18:31:06 +0200434 wil_dbg_irq(wil, "Pseudo IRQ 0x%08x\n", pseudo_cause);
Vladimir Kondratiev4789d722013-01-28 18:30:57 +0200435
Vladimir Kondratiev2be7d222012-12-20 13:13:19 -0800436 wil6210_mask_irq_pseudo(wil);
437
438 /* Discover real IRQ cause
439 * There are 2 possible phases for every IRQ:
440 * - hard IRQ handler called right here
441 * - threaded handler called later
442 *
443 * Hard IRQ handler reads and clears ISR.
444 *
445 * If threaded handler requested, hard IRQ handler
446 * returns IRQ_WAKE_THREAD and saves ISR register value
447 * for the threaded handler use.
448 *
449 * voting for wake thread - need at least 1 vote
450 */
451 if ((pseudo_cause & BIT_DMA_PSEUDO_CAUSE_RX) &&
452 (wil6210_irq_rx(irq, cookie) == IRQ_WAKE_THREAD))
453 rc = IRQ_WAKE_THREAD;
454
455 if ((pseudo_cause & BIT_DMA_PSEUDO_CAUSE_TX) &&
456 (wil6210_irq_tx(irq, cookie) == IRQ_WAKE_THREAD))
457 rc = IRQ_WAKE_THREAD;
458
459 if ((pseudo_cause & BIT_DMA_PSEUDO_CAUSE_MISC) &&
460 (wil6210_irq_misc(irq, cookie) == IRQ_WAKE_THREAD))
461 rc = IRQ_WAKE_THREAD;
462
463 /* if thread is requested, it will unmask IRQ */
464 if (rc != IRQ_WAKE_THREAD)
465 wil6210_unmask_irq_pseudo(wil);
466
Vladimir Kondratiev2be7d222012-12-20 13:13:19 -0800467 return rc;
468}
469
470static int wil6210_request_3msi(struct wil6210_priv *wil, int irq)
471{
472 int rc;
473 /*
474 * IRQ's are in the following order:
475 * - Tx
476 * - Rx
477 * - Misc
478 */
479
480 rc = request_irq(irq, wil6210_irq_tx, IRQF_SHARED,
481 WIL_NAME"_tx", wil);
482 if (rc)
483 return rc;
484
485 rc = request_irq(irq + 1, wil6210_irq_rx, IRQF_SHARED,
486 WIL_NAME"_rx", wil);
487 if (rc)
488 goto free0;
489
490 rc = request_threaded_irq(irq + 2, wil6210_irq_misc,
491 wil6210_irq_misc_thread,
492 IRQF_SHARED, WIL_NAME"_misc", wil);
493 if (rc)
494 goto free1;
495
496 return 0;
497 /* error branch */
498free1:
499 free_irq(irq + 1, wil);
500free0:
501 free_irq(irq, wil);
502
503 return rc;
504}
Vladimir Kondratievf4b5a802014-03-17 15:34:13 +0200505/* can't use wil_ioread32_and_clear because ICC value is not ser yet */
506static inline void wil_clear32(void __iomem *addr)
507{
508 u32 x = ioread32(addr);
509
510 iowrite32(x, addr);
511}
512
513void wil6210_clear_irq(struct wil6210_priv *wil)
514{
515 wil_clear32(wil->csr + HOSTADDR(RGF_DMA_EP_RX_ICR) +
516 offsetof(struct RGF_ICR, ICR));
517 wil_clear32(wil->csr + HOSTADDR(RGF_DMA_EP_TX_ICR) +
518 offsetof(struct RGF_ICR, ICR));
519 wil_clear32(wil->csr + HOSTADDR(RGF_DMA_EP_MISC_ICR) +
520 offsetof(struct RGF_ICR, ICR));
521}
Vladimir Kondratiev2be7d222012-12-20 13:13:19 -0800522
523int wil6210_init_irq(struct wil6210_priv *wil, int irq)
524{
525 int rc;
526 if (wil->n_msi == 3)
527 rc = wil6210_request_3msi(wil, irq);
528 else
529 rc = request_threaded_irq(irq, wil6210_hardirq,
530 wil6210_thread_irq,
531 wil->n_msi ? 0 : IRQF_SHARED,
532 WIL_NAME, wil);
533 if (rc)
534 return rc;
535
536 wil6210_enable_irq(wil);
537
538 return 0;
539}
540
541void wil6210_fini_irq(struct wil6210_priv *wil, int irq)
542{
543 wil6210_disable_irq(wil);
544 free_irq(irq, wil);
545 if (wil->n_msi == 3) {
546 free_irq(irq + 1, wil);
547 free_irq(irq + 2, wil);
548 }
549}