2 * wm831x-irq.c -- Interrupt controller support for Wolfson WM831x PMICs
4 * Copyright 2009 Wolfson Microelectronics PLC.
6 * Author: Mark Brown <broonie@opensource.wolfsonmicro.com>
8 * This program is free software; you can redistribute it and/or modify it
9 * under the terms of the GNU General Public License as published by the
10 * Free Software Foundation; either version 2 of the License, or (at your
11 * option) any later version.
15 #include <linux/kernel.h>
16 #include <linux/module.h>
17 #include <linux/i2c.h>
18 #include <linux/irq.h>
19 #include <linux/mfd/core.h>
20 #include <linux/interrupt.h>
22 #include <linux/mfd/wm831x/core.h>
23 #include <linux/mfd/wm831x/pdata.h>
24 #include <linux/mfd/wm831x/gpio.h>
25 #include <linux/mfd/wm831x/irq.h>
27 #include <linux/delay.h>
28 #include <linux/wakelock.h>
30 * Since generic IRQs don't currently support interrupt controllers on
31 * interrupt driven buses we don't use genirq but instead provide an
32 * interface that looks very much like the standard ones. This leads
33 * to some bodges, including storing interrupt handler information in
34 * the static irq_data table we use to look up the data for individual
35 * interrupts, but hopefully won't last too long.
37 #define WM831X_IRQ_TYPE IRQF_TRIGGER_LOW
39 struct wm831x_irq_data {
45 struct wm831x_handle_irq
48 struct list_head queue;
51 static struct wm831x_irq_data wm831x_irqs[] = {
52 [WM831X_IRQ_TEMP_THW] = {
53 .primary = WM831X_TEMP_INT,
55 .mask = WM831X_TEMP_THW_EINT,
57 [WM831X_IRQ_GPIO_1] = {
58 .primary = WM831X_GP_INT,
60 .mask = WM831X_GP1_EINT,
62 [WM831X_IRQ_GPIO_2] = {
63 .primary = WM831X_GP_INT,
65 .mask = WM831X_GP2_EINT,
67 [WM831X_IRQ_GPIO_3] = {
68 .primary = WM831X_GP_INT,
70 .mask = WM831X_GP3_EINT,
72 [WM831X_IRQ_GPIO_4] = {
73 .primary = WM831X_GP_INT,
75 .mask = WM831X_GP4_EINT,
77 [WM831X_IRQ_GPIO_5] = {
78 .primary = WM831X_GP_INT,
80 .mask = WM831X_GP5_EINT,
82 [WM831X_IRQ_GPIO_6] = {
83 .primary = WM831X_GP_INT,
85 .mask = WM831X_GP6_EINT,
87 [WM831X_IRQ_GPIO_7] = {
88 .primary = WM831X_GP_INT,
90 .mask = WM831X_GP7_EINT,
92 [WM831X_IRQ_GPIO_8] = {
93 .primary = WM831X_GP_INT,
95 .mask = WM831X_GP8_EINT,
97 [WM831X_IRQ_GPIO_9] = {
98 .primary = WM831X_GP_INT,
100 .mask = WM831X_GP9_EINT,
102 [WM831X_IRQ_GPIO_10] = {
103 .primary = WM831X_GP_INT,
105 .mask = WM831X_GP10_EINT,
107 [WM831X_IRQ_GPIO_11] = {
108 .primary = WM831X_GP_INT,
110 .mask = WM831X_GP11_EINT,
112 [WM831X_IRQ_GPIO_12] = {
113 .primary = WM831X_GP_INT,
115 .mask = WM831X_GP12_EINT,
117 [WM831X_IRQ_GPIO_13] = {
118 .primary = WM831X_GP_INT,
120 .mask = WM831X_GP13_EINT,
122 [WM831X_IRQ_GPIO_14] = {
123 .primary = WM831X_GP_INT,
125 .mask = WM831X_GP14_EINT,
127 [WM831X_IRQ_GPIO_15] = {
128 .primary = WM831X_GP_INT,
130 .mask = WM831X_GP15_EINT,
132 [WM831X_IRQ_GPIO_16] = {
133 .primary = WM831X_GP_INT,
135 .mask = WM831X_GP16_EINT,
138 .primary = WM831X_ON_PIN_INT,
140 .mask = WM831X_ON_PIN_EINT,
142 [WM831X_IRQ_PPM_SYSLO] = {
143 .primary = WM831X_PPM_INT,
145 .mask = WM831X_PPM_SYSLO_EINT,
147 [WM831X_IRQ_PPM_PWR_SRC] = {
148 .primary = WM831X_PPM_INT,
150 .mask = WM831X_PPM_PWR_SRC_EINT,
152 [WM831X_IRQ_PPM_USB_CURR] = {
153 .primary = WM831X_PPM_INT,
155 .mask = WM831X_PPM_USB_CURR_EINT,
157 [WM831X_IRQ_WDOG_TO] = {
158 .primary = WM831X_WDOG_INT,
160 .mask = WM831X_WDOG_TO_EINT,
162 [WM831X_IRQ_RTC_PER] = {
163 .primary = WM831X_RTC_INT,
165 .mask = WM831X_RTC_PER_EINT,
167 [WM831X_IRQ_RTC_ALM] = {
168 .primary = WM831X_RTC_INT,
170 .mask = WM831X_RTC_ALM_EINT,
172 [WM831X_IRQ_CHG_BATT_HOT] = {
173 .primary = WM831X_CHG_INT,
175 .mask = WM831X_CHG_BATT_HOT_EINT,
177 [WM831X_IRQ_CHG_BATT_COLD] = {
178 .primary = WM831X_CHG_INT,
180 .mask = WM831X_CHG_BATT_COLD_EINT,
182 [WM831X_IRQ_CHG_BATT_FAIL] = {
183 .primary = WM831X_CHG_INT,
185 .mask = WM831X_CHG_BATT_FAIL_EINT,
187 [WM831X_IRQ_CHG_OV] = {
188 .primary = WM831X_CHG_INT,
190 .mask = WM831X_CHG_OV_EINT,
192 [WM831X_IRQ_CHG_END] = {
193 .primary = WM831X_CHG_INT,
195 .mask = WM831X_CHG_END_EINT,
197 [WM831X_IRQ_CHG_TO] = {
198 .primary = WM831X_CHG_INT,
200 .mask = WM831X_CHG_TO_EINT,
202 [WM831X_IRQ_CHG_MODE] = {
203 .primary = WM831X_CHG_INT,
205 .mask = WM831X_CHG_MODE_EINT,
207 [WM831X_IRQ_CHG_START] = {
208 .primary = WM831X_CHG_INT,
210 .mask = WM831X_CHG_START_EINT,
212 [WM831X_IRQ_TCHDATA] = {
213 .primary = WM831X_TCHDATA_INT,
215 .mask = WM831X_TCHDATA_EINT,
217 [WM831X_IRQ_TCHPD] = {
218 .primary = WM831X_TCHPD_INT,
220 .mask = WM831X_TCHPD_EINT,
222 [WM831X_IRQ_AUXADC_DATA] = {
223 .primary = WM831X_AUXADC_INT,
225 .mask = WM831X_AUXADC_DATA_EINT,
227 [WM831X_IRQ_AUXADC_DCOMP1] = {
228 .primary = WM831X_AUXADC_INT,
230 .mask = WM831X_AUXADC_DCOMP1_EINT,
232 [WM831X_IRQ_AUXADC_DCOMP2] = {
233 .primary = WM831X_AUXADC_INT,
235 .mask = WM831X_AUXADC_DCOMP2_EINT,
237 [WM831X_IRQ_AUXADC_DCOMP3] = {
238 .primary = WM831X_AUXADC_INT,
240 .mask = WM831X_AUXADC_DCOMP3_EINT,
242 [WM831X_IRQ_AUXADC_DCOMP4] = {
243 .primary = WM831X_AUXADC_INT,
245 .mask = WM831X_AUXADC_DCOMP4_EINT,
248 .primary = WM831X_CS_INT,
250 .mask = WM831X_CS1_EINT,
253 .primary = WM831X_CS_INT,
255 .mask = WM831X_CS2_EINT,
257 [WM831X_IRQ_HC_DC1] = {
258 .primary = WM831X_HC_INT,
260 .mask = WM831X_HC_DC1_EINT,
262 [WM831X_IRQ_HC_DC2] = {
263 .primary = WM831X_HC_INT,
265 .mask = WM831X_HC_DC2_EINT,
267 [WM831X_IRQ_UV_LDO1] = {
268 .primary = WM831X_UV_INT,
270 .mask = WM831X_UV_LDO1_EINT,
272 [WM831X_IRQ_UV_LDO2] = {
273 .primary = WM831X_UV_INT,
275 .mask = WM831X_UV_LDO2_EINT,
277 [WM831X_IRQ_UV_LDO3] = {
278 .primary = WM831X_UV_INT,
280 .mask = WM831X_UV_LDO3_EINT,
282 [WM831X_IRQ_UV_LDO4] = {
283 .primary = WM831X_UV_INT,
285 .mask = WM831X_UV_LDO4_EINT,
287 [WM831X_IRQ_UV_LDO5] = {
288 .primary = WM831X_UV_INT,
290 .mask = WM831X_UV_LDO5_EINT,
292 [WM831X_IRQ_UV_LDO6] = {
293 .primary = WM831X_UV_INT,
295 .mask = WM831X_UV_LDO6_EINT,
297 [WM831X_IRQ_UV_LDO7] = {
298 .primary = WM831X_UV_INT,
300 .mask = WM831X_UV_LDO7_EINT,
302 [WM831X_IRQ_UV_LDO8] = {
303 .primary = WM831X_UV_INT,
305 .mask = WM831X_UV_LDO8_EINT,
307 [WM831X_IRQ_UV_LDO9] = {
308 .primary = WM831X_UV_INT,
310 .mask = WM831X_UV_LDO9_EINT,
312 [WM831X_IRQ_UV_LDO10] = {
313 .primary = WM831X_UV_INT,
315 .mask = WM831X_UV_LDO10_EINT,
317 [WM831X_IRQ_UV_DC1] = {
318 .primary = WM831X_UV_INT,
320 .mask = WM831X_UV_DC1_EINT,
322 [WM831X_IRQ_UV_DC2] = {
323 .primary = WM831X_UV_INT,
325 .mask = WM831X_UV_DC2_EINT,
327 [WM831X_IRQ_UV_DC3] = {
328 .primary = WM831X_UV_INT,
330 .mask = WM831X_UV_DC3_EINT,
332 [WM831X_IRQ_UV_DC4] = {
333 .primary = WM831X_UV_INT,
335 .mask = WM831X_UV_DC4_EINT,
339 static inline int irq_data_to_status_reg(struct wm831x_irq_data *irq_data)
341 return WM831X_INTERRUPT_STATUS_1 - 1 + irq_data->reg;
344 static inline int irq_data_to_mask_reg(struct wm831x_irq_data *irq_data)
346 return WM831X_INTERRUPT_STATUS_1_MASK - 1 + irq_data->reg;
349 static inline struct wm831x_irq_data *irq_to_wm831x_irq(struct wm831x *wm831x,
352 return &wm831x_irqs[irq - wm831x->irq_base];
355 static void wm831x_irq_lock(unsigned int irq)
357 struct wm831x *wm831x = get_irq_chip_data(irq);
359 mutex_lock(&wm831x->irq_lock);
362 static void wm831x_irq_sync_unlock(unsigned int irq)
364 struct wm831x *wm831x = get_irq_chip_data(irq);
367 for (i = 0; i < ARRAY_SIZE(wm831x->irq_masks_cur); i++) {
368 /* If there's been a change in the mask write it back
369 * to the hardware. */
370 if (wm831x->irq_masks_cur[i] != wm831x->irq_masks_cache[i]) {
371 wm831x->irq_masks_cache[i] = wm831x->irq_masks_cur[i];
372 wm831x_reg_write(wm831x,
373 WM831X_INTERRUPT_STATUS_1_MASK + i,
374 wm831x->irq_masks_cur[i]);
378 mutex_unlock(&wm831x->irq_lock);
381 static void wm831x_irq_unmask(unsigned int irq)
383 struct wm831x *wm831x = get_irq_chip_data(irq);
384 struct wm831x_irq_data *irq_data = irq_to_wm831x_irq(wm831x, irq);
386 wm831x->irq_masks_cur[irq_data->reg - 1] &= ~irq_data->mask;
387 //printk("%s:irq=%d\n",__FUNCTION__,irq);
390 static void wm831x_irq_mask(unsigned int irq)
392 struct wm831x *wm831x = get_irq_chip_data(irq);
393 struct wm831x_irq_data *irq_data = irq_to_wm831x_irq(wm831x, irq);
395 wm831x->irq_masks_cur[irq_data->reg - 1] |= irq_data->mask;
396 //printk("%s:irq=%d\n",__FUNCTION__,irq);
399 static void wm831x_irq_disable(unsigned int irq)
401 struct wm831x *wm831x = get_irq_chip_data(irq);
402 struct wm831x_irq_data *irq_data = irq_to_wm831x_irq(wm831x, irq);
404 wm831x->irq_masks_cur[irq_data->reg - 1] |= irq_data->mask;
405 //printk("%s:irq=%d\n",__FUNCTION__,irq);
408 static int wm831x_irq_set_type(unsigned int irq, unsigned int type)
410 struct wm831x *wm831x = get_irq_chip_data(irq);
413 irq = irq - wm831x->irq_base;
414 if (irq < WM831X_IRQ_GPIO_1 || irq > WM831X_IRQ_GPIO_12) {
415 /* Ignore internal-only IRQs */
416 if (irq >= 0 && irq < WM831X_NUM_IRQS)
421 //printk("wm831x_irq_set_type:type=%x,irq=%d\n",type,irq);
423 case IRQ_TYPE_EDGE_BOTH:
424 val = WM831X_GPN_INT_MODE;
426 case IRQ_TYPE_EDGE_RISING:
427 val = WM831X_GPN_POL;
429 case IRQ_TYPE_EDGE_FALLING:
436 return wm831x_set_bits(wm831x, WM831X_GPIO1_CONTROL + irq - 1,
437 WM831X_GPN_INT_MODE | WM831X_GPN_POL, val);
440 static int wm831x_irq_set_wake(unsigned irq, unsigned state)
442 struct wm831x *wm831x = get_irq_chip_data(irq);
445 if ((irq > wm831x->irq_base + WM831X_IRQ_TEMP_THW) &&( irq < wm831x->irq_base + WM831X_NUM_IRQS))
448 wm831x_irq_unmask(irq);
450 wm831x_irq_mask(irq);
455 printk("%s:irq number err!irq=%d\n",__FUNCTION__,irq);
462 static struct irq_chip wm831x_irq_chip = {
464 .bus_lock = wm831x_irq_lock,
465 .bus_sync_unlock = wm831x_irq_sync_unlock,
466 .disable = wm831x_irq_disable,
467 .mask = wm831x_irq_mask,
468 .unmask = wm831x_irq_unmask,
469 .set_type = wm831x_irq_set_type,
470 .set_wake = wm831x_irq_set_wake,
474 static void wm831x_handle_worker(struct work_struct *work)
476 struct wm831x *wm831x = container_of(work, struct wm831x, handle_work);
481 struct wm831x_handle_irq *hd = NULL;
483 spin_lock_irqsave(&wm831x->work_lock, flags);
484 if (!list_empty(&wm831x->handle_queue)) {
485 hd = list_first_entry(&wm831x->handle_queue, struct wm831x_handle_irq, queue);
486 list_del(&hd->queue);
488 spin_unlock_irqrestore(&wm831x->work_lock, flags);
490 if (!hd) // trans_queue empty
493 irq = hd->irq; //get wm831x intterupt status
494 //printk("%s:irq=%d\n",__FUNCTION__,irq);
496 /*start to handle wm831x intterupt*/
497 handle_nested_irq(wm831x->irq_base + irq);
504 /* Main interrupt handling occurs in a workqueue since we need
505 * interrupts enabled to interact with the chip. */
506 static void wm831x_irq_worker(struct work_struct *work)
508 struct wm831x *wm831x = container_of(work, struct wm831x, irq_work);
511 int status_regs[WM831X_NUM_IRQ_REGS] = { 0 };
512 int read[WM831X_NUM_IRQ_REGS] = { 0 };
515 struct wm831x_handle_irq *hd;
518 #if (WM831X_IRQ_TYPE != IRQF_TRIGGER_LOW)
519 /*mask wm831x irq at first*/
520 ret = wm831x_set_bits(wm831x, WM831X_IRQ_CONFIG,
521 WM831X_IRQ_IM_MASK, WM831X_IRQ_IM_EANBLE);
523 dev_err(wm831x->dev, "Failed to mask irq: %d\n", ret);
528 primary = wm831x_reg_read(wm831x, WM831X_SYSTEM_INTERRUPTS);
530 dev_err(wm831x->dev, "Failed to read system interrupt: %d\n",
535 mutex_lock(&wm831x->irq_lock);
537 for (i = 0; i < ARRAY_SIZE(wm831x_irqs); i++) {
538 int offset = wm831x_irqs[i].reg - 1;
540 if (!(primary & wm831x_irqs[i].primary))
543 status = &status_regs[offset];
545 /* Hopefully there should only be one register to read
546 * each time otherwise we ought to do a block read. */
548 *status = wm831x_reg_read(wm831x,
549 irq_data_to_status_reg(&wm831x_irqs[i]));
552 "Failed to read IRQ status: %d\n",
560 /* Report it if it isn't masked, or forget the status. */
561 if ((*status & ~wm831x->irq_masks_cur[offset])
562 & wm831x_irqs[i].mask)
565 /*add intterupt handle on list*/
566 hd = kzalloc(sizeof(struct wm831x_handle_irq), GFP_KERNEL);
569 printk("err:%s:ENOMEM\n",__FUNCTION__);
573 if(i == WM831X_IRQ_ON)
574 wake_lock(&wm831x->handle_wake); //keep wake while handle WM831X_IRQ_ON
576 spin_lock_irqsave(&wm831x->work_lock, flags);
577 list_add_tail(&hd->queue, &wm831x->handle_queue);
578 spin_unlock_irqrestore(&wm831x->work_lock, flags);
579 queue_work(wm831x->handle_wq, &wm831x->handle_work);
582 if(i == WM831X_IRQ_ON)
583 wake_lock(&wm831x->handle_wake); //keep wake while handle WM831X_IRQ_ON
584 handle_nested_irq(wm831x->irq_base + i);
590 *status &= ~wm831x_irqs[i].mask;
594 mutex_unlock(&wm831x->irq_lock);
597 for (i = 0; i < ARRAY_SIZE(status_regs); i++) {
599 wm831x_reg_write(wm831x, WM831X_INTERRUPT_STATUS_1 + i,
603 #if (WM831X_IRQ_TYPE != IRQF_TRIGGER_LOW)
604 ret = wm831x_set_bits(wm831x, WM831X_IRQ_CONFIG,
605 WM831X_IRQ_IM_MASK, 0);
607 dev_err(wm831x->dev, "Failed to open irq: %d\n", ret);
610 #if (WM831X_IRQ_TYPE == IRQF_TRIGGER_LOW)
611 enable_irq(wm831x->irq);
613 wake_unlock(&wm831x->irq_wake);
616 /* The processing of the primary interrupt occurs in a thread so that
617 * we can interact with the device over I2C or SPI. */
618 static irqreturn_t wm831x_irq_thread(int irq, void *data)
620 struct wm831x *wm831x = data;
622 /* Shut the interrupt to the CPU up and schedule the actual
623 * handler; we can't check that the IRQ is asserted. */
624 #if (WM831X_IRQ_TYPE == IRQF_TRIGGER_LOW)
625 disable_irq_nosync(irq);
627 wake_lock(&wm831x->irq_wake);
628 if(wm831x->flag_suspend)
630 spin_lock(&wm831x->flag_lock);
631 wm831x->flag_suspend = 0;
632 spin_unlock(&wm831x->flag_lock);
633 msdelay = 50; //wait for spi/i2c resume
634 printk("%s:msdelay=%d\n",__FUNCTION__,msdelay);
639 queue_delayed_work(wm831x->irq_wq, &wm831x->irq_work, msecs_to_jiffies(msdelay));
640 //printk("%s\n",__FUNCTION__);
644 int wm831x_irq_init(struct wm831x *wm831x, int irq)
646 struct wm831x_pdata *pdata = wm831x->dev->platform_data;
648 printk( "wm831x_irq_init:irq=%d,%d\n",irq,pdata->irq_base);
649 mutex_init(&wm831x->irq_lock);
651 /* Mask the individual interrupt sources */
652 for (i = 0; i < ARRAY_SIZE(wm831x->irq_masks_cur); i++) {
653 wm831x->irq_masks_cur[i] = 0xffff;
654 wm831x->irq_masks_cache[i] = 0xffff;
655 wm831x_reg_write(wm831x, WM831X_INTERRUPT_STATUS_1_MASK + i,
660 dev_warn(wm831x->dev,
661 "No interrupt specified - functionality limited\n");
665 if (!pdata || !pdata->irq_base) {
667 "No interrupt base specified, no interrupts\n");
671 wm831x->irq_wq = create_singlethread_workqueue("wm831x-irq");
672 if (!wm831x->irq_wq) {
673 dev_err(wm831x->dev, "Failed to allocate IRQ worker\n");
679 wm831x->flag_suspend = 0;
680 wm831x->irq_base = pdata->irq_base;
681 INIT_DELAYED_WORK(&wm831x->irq_work, wm831x_irq_worker);
682 wake_lock_init(&wm831x->irq_wake, WAKE_LOCK_SUSPEND, "wm831x_irq_wake");
683 wake_lock_init(&wm831x->handle_wake, WAKE_LOCK_SUSPEND, "wm831x_handle_wake");
685 wm831x->handle_wq = create_rt_workqueue("wm831x_handle_wq");
686 if (!wm831x->handle_wq) {
687 printk("cannot create workqueue\n");
690 INIT_WORK(&wm831x->handle_work, wm831x_handle_worker);
691 INIT_LIST_HEAD(&wm831x->handle_queue);
695 /* Register them with genirq */
696 for (cur_irq = wm831x->irq_base;
697 cur_irq < ARRAY_SIZE(wm831x_irqs) + wm831x->irq_base;
699 set_irq_chip_data(cur_irq, wm831x);
700 set_irq_chip_and_handler(cur_irq, &wm831x_irq_chip,
702 set_irq_nested_thread(cur_irq, 1);
704 /* ARM needs us to explicitly flag the IRQ as valid
705 * and will set them noprobe when we do so. */
707 set_irq_flags(cur_irq, IRQF_VALID);
709 set_irq_noprobe(cur_irq);
712 #if (WM831X_IRQ_TYPE == IRQF_TRIGGER_LOW)
713 ret = request_threaded_irq(wm831x->irq, wm831x_irq_thread, NULL,
714 IRQF_TRIGGER_LOW| IRQF_ONESHOT,//IRQF_TRIGGER_FALLING, //
717 ret = request_threaded_irq(wm831x->irq, wm831x_irq_thread, NULL,
718 IRQF_TRIGGER_FALLING, //IRQF_TRIGGER_LOW| IRQF_ONESHOT,//
722 dev_err(wm831x->dev, "Failed to request IRQ %d: %d\n",
727 enable_irq_wake(wm831x->irq); // so wm831x irq can wake up system
728 /* Enable top level interrupts, we mask at secondary level */
729 wm831x_reg_write(wm831x, WM831X_SYSTEM_INTERRUPTS_MASK, 0);
734 void wm831x_irq_exit(struct wm831x *wm831x)
737 free_irq(wm831x->irq, wm831x);