blob: 5fe985cd3dfd53c878612ef46d7d62201d67a23b [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
107static void wil6210_unmask_irq_tx(struct wil6210_priv *wil)
108{
109 iowrite32(WIL6210_IMC_TX, wil->csr +
110 HOSTADDR(RGF_DMA_EP_TX_ICR) +
111 offsetof(struct RGF_ICR, IMC));
112}
113
114static void wil6210_unmask_irq_rx(struct wil6210_priv *wil)
115{
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
159 wil6210_unmask_irq_pseudo(wil);
160 wil6210_unmask_irq_tx(wil);
161 wil6210_unmask_irq_rx(wil);
162 wil6210_unmask_irq_misc(wil);
163}
164
165static irqreturn_t wil6210_irq_rx(int irq, void *cookie)
166{
167 struct wil6210_priv *wil = cookie;
168 u32 isr = wil_ioread32_and_clear(wil->csr +
169 HOSTADDR(RGF_DMA_EP_RX_ICR) +
170 offsetof(struct RGF_ICR, ICR));
171
Vladimir Kondratiev98658092013-05-12 14:43:35 +0300172 trace_wil6210_irq_rx(isr);
Vladimir Kondratiev77438822013-01-28 18:31:06 +0200173 wil_dbg_irq(wil, "ISR RX 0x%08x\n", isr);
Vladimir Kondratiev2be7d222012-12-20 13:13:19 -0800174
175 if (!isr) {
176 wil_err(wil, "spurious IRQ: RX\n");
177 return IRQ_NONE;
178 }
179
180 wil6210_mask_irq_rx(wil);
181
182 if (isr & BIT_DMA_EP_RX_ICR_RX_DONE) {
Vladimir Kondratiev77438822013-01-28 18:31:06 +0200183 wil_dbg_irq(wil, "RX done\n");
Vladimir Kondratiev2be7d222012-12-20 13:13:19 -0800184 isr &= ~BIT_DMA_EP_RX_ICR_RX_DONE;
185 wil_rx_handle(wil);
186 }
187
188 if (isr)
189 wil_err(wil, "un-handled RX ISR bits 0x%08x\n", isr);
190
191 wil6210_unmask_irq_rx(wil);
192
193 return IRQ_HANDLED;
194}
195
196static irqreturn_t wil6210_irq_tx(int irq, void *cookie)
197{
198 struct wil6210_priv *wil = cookie;
199 u32 isr = wil_ioread32_and_clear(wil->csr +
200 HOSTADDR(RGF_DMA_EP_TX_ICR) +
201 offsetof(struct RGF_ICR, ICR));
202
Vladimir Kondratiev98658092013-05-12 14:43:35 +0300203 trace_wil6210_irq_tx(isr);
Vladimir Kondratiev77438822013-01-28 18:31:06 +0200204 wil_dbg_irq(wil, "ISR TX 0x%08x\n", isr);
Vladimir Kondratiev2be7d222012-12-20 13:13:19 -0800205
206 if (!isr) {
207 wil_err(wil, "spurious IRQ: TX\n");
208 return IRQ_NONE;
209 }
210
211 wil6210_mask_irq_tx(wil);
212
213 if (isr & BIT_DMA_EP_TX_ICR_TX_DONE) {
214 uint i;
Vladimir Kondratiev77438822013-01-28 18:31:06 +0200215 wil_dbg_irq(wil, "TX done\n");
Vladimir Kondratiev2be7d222012-12-20 13:13:19 -0800216 isr &= ~BIT_DMA_EP_TX_ICR_TX_DONE;
217 for (i = 0; i < 24; i++) {
218 u32 mask = BIT_DMA_EP_TX_ICR_TX_DONE_N(i);
219 if (isr & mask) {
220 isr &= ~mask;
Vladimir Kondratiev77438822013-01-28 18:31:06 +0200221 wil_dbg_irq(wil, "TX done(%i)\n", i);
Vladimir Kondratiev2be7d222012-12-20 13:13:19 -0800222 wil_tx_complete(wil, i);
223 }
224 }
225 }
226
227 if (isr)
228 wil_err(wil, "un-handled TX ISR bits 0x%08x\n", isr);
229
230 wil6210_unmask_irq_tx(wil);
231
232 return IRQ_HANDLED;
233}
234
Vladimir Kondratiev72694942013-01-28 18:30:56 +0200235static void wil_notify_fw_error(struct wil6210_priv *wil)
236{
237 struct device *dev = &wil_to_ndev(wil)->dev;
238 char *envp[3] = {
239 [0] = "SOURCE=wil6210",
240 [1] = "EVENT=FW_ERROR",
241 [2] = NULL,
242 };
243 kobject_uevent_env(&dev->kobj, KOBJ_CHANGE, envp);
244}
245
Vladimir Kondratiev55f7acd2013-03-13 14:12:49 +0200246static void wil_cache_mbox_regs(struct wil6210_priv *wil)
247{
248 /* make shadow copy of registers that should not change on run time */
249 wil_memcpy_fromio_32(&wil->mbox_ctl, wil->csr + HOST_MBOX,
250 sizeof(struct wil6210_mbox_ctl));
251 wil_mbox_ring_le2cpus(&wil->mbox_ctl.rx);
252 wil_mbox_ring_le2cpus(&wil->mbox_ctl.tx);
253}
254
Vladimir Kondratiev2be7d222012-12-20 13:13:19 -0800255static irqreturn_t wil6210_irq_misc(int irq, void *cookie)
256{
257 struct wil6210_priv *wil = cookie;
258 u32 isr = wil_ioread32_and_clear(wil->csr +
259 HOSTADDR(RGF_DMA_EP_MISC_ICR) +
260 offsetof(struct RGF_ICR, ICR));
261
Vladimir Kondratiev98658092013-05-12 14:43:35 +0300262 trace_wil6210_irq_misc(isr);
Vladimir Kondratiev77438822013-01-28 18:31:06 +0200263 wil_dbg_irq(wil, "ISR MISC 0x%08x\n", isr);
Vladimir Kondratiev2be7d222012-12-20 13:13:19 -0800264
265 if (!isr) {
266 wil_err(wil, "spurious IRQ: MISC\n");
267 return IRQ_NONE;
268 }
269
270 wil6210_mask_irq_misc(wil);
271
Vladimir Kondratiev72694942013-01-28 18:30:56 +0200272 if (isr & ISR_MISC_FW_ERROR) {
Vladimir Kondratievde70ab82013-03-13 14:12:46 +0200273 wil_err(wil, "Firmware error detected\n");
Vladimir Kondratiev72694942013-01-28 18:30:56 +0200274 clear_bit(wil_status_fwready, &wil->status);
Vladimir Kondratievde70ab82013-03-13 14:12:46 +0200275 /*
276 * do not clear @isr here - we do 2-nd part in thread
277 * there, user space get notified, and it should be done
278 * in non-atomic context
279 */
Vladimir Kondratiev72694942013-01-28 18:30:56 +0200280 }
281
Vladimir Kondratiev2be7d222012-12-20 13:13:19 -0800282 if (isr & ISR_MISC_FW_READY) {
Vladimir Kondratiev77438822013-01-28 18:31:06 +0200283 wil_dbg_irq(wil, "IRQ: FW ready\n");
Vladimir Kondratiev55f7acd2013-03-13 14:12:49 +0200284 wil_cache_mbox_regs(wil);
285 set_bit(wil_status_reset_done, &wil->status);
Vladimir Kondratiev2be7d222012-12-20 13:13:19 -0800286 /**
287 * Actual FW ready indicated by the
288 * WMI_FW_READY_EVENTID
289 */
290 isr &= ~ISR_MISC_FW_READY;
291 }
292
293 wil->isr_misc = isr;
294
295 if (isr) {
296 return IRQ_WAKE_THREAD;
297 } else {
298 wil6210_unmask_irq_misc(wil);
299 return IRQ_HANDLED;
300 }
301}
302
303static irqreturn_t wil6210_irq_misc_thread(int irq, void *cookie)
304{
305 struct wil6210_priv *wil = cookie;
306 u32 isr = wil->isr_misc;
307
Vladimir Kondratiev98658092013-05-12 14:43:35 +0300308 trace_wil6210_irq_misc_thread(isr);
Vladimir Kondratiev77438822013-01-28 18:31:06 +0200309 wil_dbg_irq(wil, "Thread ISR MISC 0x%08x\n", isr);
Vladimir Kondratiev2be7d222012-12-20 13:13:19 -0800310
Vladimir Kondratievde70ab82013-03-13 14:12:46 +0200311 if (isr & ISR_MISC_FW_ERROR) {
312 wil_notify_fw_error(wil);
313 isr &= ~ISR_MISC_FW_ERROR;
314 }
315
Vladimir Kondratiev2be7d222012-12-20 13:13:19 -0800316 if (isr & ISR_MISC_MBOX_EVT) {
Vladimir Kondratiev77438822013-01-28 18:31:06 +0200317 wil_dbg_irq(wil, "MBOX event\n");
Vladimir Kondratiev2be7d222012-12-20 13:13:19 -0800318 wmi_recv_cmd(wil);
319 isr &= ~ISR_MISC_MBOX_EVT;
320 }
321
322 if (isr)
323 wil_err(wil, "un-handled MISC ISR bits 0x%08x\n", isr);
324
325 wil->isr_misc = 0;
326
327 wil6210_unmask_irq_misc(wil);
328
329 return IRQ_HANDLED;
330}
331
332/**
333 * thread IRQ handler
334 */
335static irqreturn_t wil6210_thread_irq(int irq, void *cookie)
336{
337 struct wil6210_priv *wil = cookie;
338
Vladimir Kondratiev77438822013-01-28 18:31:06 +0200339 wil_dbg_irq(wil, "Thread IRQ\n");
Vladimir Kondratiev2be7d222012-12-20 13:13:19 -0800340 /* Discover real IRQ cause */
341 if (wil->isr_misc)
342 wil6210_irq_misc_thread(irq, cookie);
343
344 wil6210_unmask_irq_pseudo(wil);
345
346 return IRQ_HANDLED;
347}
348
349/* DEBUG
350 * There is subtle bug in hardware that causes IRQ to raise when it should be
351 * masked. It is quite rare and hard to debug.
352 *
353 * Catch irq issue if it happens and print all I can.
354 */
355static int wil6210_debug_irq_mask(struct wil6210_priv *wil, u32 pseudo_cause)
356{
357 if (!test_bit(wil_status_irqen, &wil->status)) {
358 u32 icm_rx = wil_ioread32_and_clear(wil->csr +
359 HOSTADDR(RGF_DMA_EP_RX_ICR) +
360 offsetof(struct RGF_ICR, ICM));
361 u32 icr_rx = wil_ioread32_and_clear(wil->csr +
362 HOSTADDR(RGF_DMA_EP_RX_ICR) +
363 offsetof(struct RGF_ICR, ICR));
364 u32 imv_rx = ioread32(wil->csr +
365 HOSTADDR(RGF_DMA_EP_RX_ICR) +
366 offsetof(struct RGF_ICR, IMV));
367 u32 icm_tx = wil_ioread32_and_clear(wil->csr +
368 HOSTADDR(RGF_DMA_EP_TX_ICR) +
369 offsetof(struct RGF_ICR, ICM));
370 u32 icr_tx = wil_ioread32_and_clear(wil->csr +
371 HOSTADDR(RGF_DMA_EP_TX_ICR) +
372 offsetof(struct RGF_ICR, ICR));
373 u32 imv_tx = ioread32(wil->csr +
374 HOSTADDR(RGF_DMA_EP_TX_ICR) +
375 offsetof(struct RGF_ICR, IMV));
376 u32 icm_misc = wil_ioread32_and_clear(wil->csr +
377 HOSTADDR(RGF_DMA_EP_MISC_ICR) +
378 offsetof(struct RGF_ICR, ICM));
379 u32 icr_misc = wil_ioread32_and_clear(wil->csr +
380 HOSTADDR(RGF_DMA_EP_MISC_ICR) +
381 offsetof(struct RGF_ICR, ICR));
382 u32 imv_misc = ioread32(wil->csr +
383 HOSTADDR(RGF_DMA_EP_MISC_ICR) +
384 offsetof(struct RGF_ICR, IMV));
385 wil_err(wil, "IRQ when it should be masked: pseudo 0x%08x\n"
386 "Rx icm:icr:imv 0x%08x 0x%08x 0x%08x\n"
387 "Tx icm:icr:imv 0x%08x 0x%08x 0x%08x\n"
388 "Misc icm:icr:imv 0x%08x 0x%08x 0x%08x\n",
389 pseudo_cause,
390 icm_rx, icr_rx, imv_rx,
391 icm_tx, icr_tx, imv_tx,
392 icm_misc, icr_misc, imv_misc);
393
394 return -EINVAL;
395 }
396
397 return 0;
398}
399
400static irqreturn_t wil6210_hardirq(int irq, void *cookie)
401{
402 irqreturn_t rc = IRQ_HANDLED;
403 struct wil6210_priv *wil = cookie;
404 u32 pseudo_cause = ioread32(wil->csr + HOSTADDR(RGF_DMA_PSEUDO_CAUSE));
405
406 /**
407 * pseudo_cause is Clear-On-Read, no need to ACK
408 */
409 if ((pseudo_cause == 0) || ((pseudo_cause & 0xff) == 0xff))
410 return IRQ_NONE;
411
412 /* FIXME: IRQ mask debug */
413 if (wil6210_debug_irq_mask(wil, pseudo_cause))
414 return IRQ_NONE;
415
Vladimir Kondratiev98658092013-05-12 14:43:35 +0300416 trace_wil6210_irq_pseudo(pseudo_cause);
Vladimir Kondratiev77438822013-01-28 18:31:06 +0200417 wil_dbg_irq(wil, "Pseudo IRQ 0x%08x\n", pseudo_cause);
Vladimir Kondratiev4789d722013-01-28 18:30:57 +0200418
Vladimir Kondratiev2be7d222012-12-20 13:13:19 -0800419 wil6210_mask_irq_pseudo(wil);
420
421 /* Discover real IRQ cause
422 * There are 2 possible phases for every IRQ:
423 * - hard IRQ handler called right here
424 * - threaded handler called later
425 *
426 * Hard IRQ handler reads and clears ISR.
427 *
428 * If threaded handler requested, hard IRQ handler
429 * returns IRQ_WAKE_THREAD and saves ISR register value
430 * for the threaded handler use.
431 *
432 * voting for wake thread - need at least 1 vote
433 */
434 if ((pseudo_cause & BIT_DMA_PSEUDO_CAUSE_RX) &&
435 (wil6210_irq_rx(irq, cookie) == IRQ_WAKE_THREAD))
436 rc = IRQ_WAKE_THREAD;
437
438 if ((pseudo_cause & BIT_DMA_PSEUDO_CAUSE_TX) &&
439 (wil6210_irq_tx(irq, cookie) == IRQ_WAKE_THREAD))
440 rc = IRQ_WAKE_THREAD;
441
442 if ((pseudo_cause & BIT_DMA_PSEUDO_CAUSE_MISC) &&
443 (wil6210_irq_misc(irq, cookie) == IRQ_WAKE_THREAD))
444 rc = IRQ_WAKE_THREAD;
445
446 /* if thread is requested, it will unmask IRQ */
447 if (rc != IRQ_WAKE_THREAD)
448 wil6210_unmask_irq_pseudo(wil);
449
Vladimir Kondratiev2be7d222012-12-20 13:13:19 -0800450 return rc;
451}
452
453static int wil6210_request_3msi(struct wil6210_priv *wil, int irq)
454{
455 int rc;
456 /*
457 * IRQ's are in the following order:
458 * - Tx
459 * - Rx
460 * - Misc
461 */
462
463 rc = request_irq(irq, wil6210_irq_tx, IRQF_SHARED,
464 WIL_NAME"_tx", wil);
465 if (rc)
466 return rc;
467
468 rc = request_irq(irq + 1, wil6210_irq_rx, IRQF_SHARED,
469 WIL_NAME"_rx", wil);
470 if (rc)
471 goto free0;
472
473 rc = request_threaded_irq(irq + 2, wil6210_irq_misc,
474 wil6210_irq_misc_thread,
475 IRQF_SHARED, WIL_NAME"_misc", wil);
476 if (rc)
477 goto free1;
478
479 return 0;
480 /* error branch */
481free1:
482 free_irq(irq + 1, wil);
483free0:
484 free_irq(irq, wil);
485
486 return rc;
487}
488
489int wil6210_init_irq(struct wil6210_priv *wil, int irq)
490{
491 int rc;
492 if (wil->n_msi == 3)
493 rc = wil6210_request_3msi(wil, irq);
494 else
495 rc = request_threaded_irq(irq, wil6210_hardirq,
496 wil6210_thread_irq,
497 wil->n_msi ? 0 : IRQF_SHARED,
498 WIL_NAME, wil);
499 if (rc)
500 return rc;
501
502 wil6210_enable_irq(wil);
503
504 return 0;
505}
506
507void wil6210_fini_irq(struct wil6210_priv *wil, int irq)
508{
509 wil6210_disable_irq(wil);
510 free_irq(irq, wil);
511 if (wil->n_msi == 3) {
512 free_irq(irq + 1, wil);
513 free_irq(irq + 2, wil);
514 }
515}