Linux Audio

Check our new training course

Linux BSP development engineering services

Need help to port Linux and bootloaders to your hardware?
Loading...
v3.1
  1/*
  2 * wm831x-irq.c  --  Interrupt controller support for Wolfson WM831x PMICs
  3 *
  4 * Copyright 2009 Wolfson Microelectronics PLC.
  5 *
  6 * Author: Mark Brown <broonie@opensource.wolfsonmicro.com>
  7 *
  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.
 12 *
 13 */
 14
 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>
 
 21
 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>
 26
 27#include <linux/delay.h>
 28
 29struct wm831x_irq_data {
 30	int primary;
 31	int reg;
 32	int mask;
 33};
 34
 35static struct wm831x_irq_data wm831x_irqs[] = {
 36	[WM831X_IRQ_TEMP_THW] = {
 37		.primary = WM831X_TEMP_INT,
 38		.reg = 1,
 39		.mask = WM831X_TEMP_THW_EINT,
 40	},
 41	[WM831X_IRQ_GPIO_1] = {
 42		.primary = WM831X_GP_INT,
 43		.reg = 5,
 44		.mask = WM831X_GP1_EINT,
 45	},
 46	[WM831X_IRQ_GPIO_2] = {
 47		.primary = WM831X_GP_INT,
 48		.reg = 5,
 49		.mask = WM831X_GP2_EINT,
 50	},
 51	[WM831X_IRQ_GPIO_3] = {
 52		.primary = WM831X_GP_INT,
 53		.reg = 5,
 54		.mask = WM831X_GP3_EINT,
 55	},
 56	[WM831X_IRQ_GPIO_4] = {
 57		.primary = WM831X_GP_INT,
 58		.reg = 5,
 59		.mask = WM831X_GP4_EINT,
 60	},
 61	[WM831X_IRQ_GPIO_5] = {
 62		.primary = WM831X_GP_INT,
 63		.reg = 5,
 64		.mask = WM831X_GP5_EINT,
 65	},
 66	[WM831X_IRQ_GPIO_6] = {
 67		.primary = WM831X_GP_INT,
 68		.reg = 5,
 69		.mask = WM831X_GP6_EINT,
 70	},
 71	[WM831X_IRQ_GPIO_7] = {
 72		.primary = WM831X_GP_INT,
 73		.reg = 5,
 74		.mask = WM831X_GP7_EINT,
 75	},
 76	[WM831X_IRQ_GPIO_8] = {
 77		.primary = WM831X_GP_INT,
 78		.reg = 5,
 79		.mask = WM831X_GP8_EINT,
 80	},
 81	[WM831X_IRQ_GPIO_9] = {
 82		.primary = WM831X_GP_INT,
 83		.reg = 5,
 84		.mask = WM831X_GP9_EINT,
 85	},
 86	[WM831X_IRQ_GPIO_10] = {
 87		.primary = WM831X_GP_INT,
 88		.reg = 5,
 89		.mask = WM831X_GP10_EINT,
 90	},
 91	[WM831X_IRQ_GPIO_11] = {
 92		.primary = WM831X_GP_INT,
 93		.reg = 5,
 94		.mask = WM831X_GP11_EINT,
 95	},
 96	[WM831X_IRQ_GPIO_12] = {
 97		.primary = WM831X_GP_INT,
 98		.reg = 5,
 99		.mask = WM831X_GP12_EINT,
100	},
101	[WM831X_IRQ_GPIO_13] = {
102		.primary = WM831X_GP_INT,
103		.reg = 5,
104		.mask = WM831X_GP13_EINT,
105	},
106	[WM831X_IRQ_GPIO_14] = {
107		.primary = WM831X_GP_INT,
108		.reg = 5,
109		.mask = WM831X_GP14_EINT,
110	},
111	[WM831X_IRQ_GPIO_15] = {
112		.primary = WM831X_GP_INT,
113		.reg = 5,
114		.mask = WM831X_GP15_EINT,
115	},
116	[WM831X_IRQ_GPIO_16] = {
117		.primary = WM831X_GP_INT,
118		.reg = 5,
119		.mask = WM831X_GP16_EINT,
120	},
121	[WM831X_IRQ_ON] = {
122		.primary = WM831X_ON_PIN_INT,
123		.reg = 1,
124		.mask = WM831X_ON_PIN_EINT,
125	},
126	[WM831X_IRQ_PPM_SYSLO] = {
127		.primary = WM831X_PPM_INT,
128		.reg = 1,
129		.mask = WM831X_PPM_SYSLO_EINT,
130	},
131	[WM831X_IRQ_PPM_PWR_SRC] = {
132		.primary = WM831X_PPM_INT,
133		.reg = 1,
134		.mask = WM831X_PPM_PWR_SRC_EINT,
135	},
136	[WM831X_IRQ_PPM_USB_CURR] = {
137		.primary = WM831X_PPM_INT,
138		.reg = 1,
139		.mask = WM831X_PPM_USB_CURR_EINT,
140	},
141	[WM831X_IRQ_WDOG_TO] = {
142		.primary = WM831X_WDOG_INT,
143		.reg = 1,
144		.mask = WM831X_WDOG_TO_EINT,
145	},
146	[WM831X_IRQ_RTC_PER] = {
147		.primary = WM831X_RTC_INT,
148		.reg = 1,
149		.mask = WM831X_RTC_PER_EINT,
150	},
151	[WM831X_IRQ_RTC_ALM] = {
152		.primary = WM831X_RTC_INT,
153		.reg = 1,
154		.mask = WM831X_RTC_ALM_EINT,
155	},
156	[WM831X_IRQ_CHG_BATT_HOT] = {
157		.primary = WM831X_CHG_INT,
158		.reg = 2,
159		.mask = WM831X_CHG_BATT_HOT_EINT,
160	},
161	[WM831X_IRQ_CHG_BATT_COLD] = {
162		.primary = WM831X_CHG_INT,
163		.reg = 2,
164		.mask = WM831X_CHG_BATT_COLD_EINT,
165	},
166	[WM831X_IRQ_CHG_BATT_FAIL] = {
167		.primary = WM831X_CHG_INT,
168		.reg = 2,
169		.mask = WM831X_CHG_BATT_FAIL_EINT,
170	},
171	[WM831X_IRQ_CHG_OV] = {
172		.primary = WM831X_CHG_INT,
173		.reg = 2,
174		.mask = WM831X_CHG_OV_EINT,
175	},
176	[WM831X_IRQ_CHG_END] = {
177		.primary = WM831X_CHG_INT,
178		.reg = 2,
179		.mask = WM831X_CHG_END_EINT,
180	},
181	[WM831X_IRQ_CHG_TO] = {
182		.primary = WM831X_CHG_INT,
183		.reg = 2,
184		.mask = WM831X_CHG_TO_EINT,
185	},
186	[WM831X_IRQ_CHG_MODE] = {
187		.primary = WM831X_CHG_INT,
188		.reg = 2,
189		.mask = WM831X_CHG_MODE_EINT,
190	},
191	[WM831X_IRQ_CHG_START] = {
192		.primary = WM831X_CHG_INT,
193		.reg = 2,
194		.mask = WM831X_CHG_START_EINT,
195	},
196	[WM831X_IRQ_TCHDATA] = {
197		.primary = WM831X_TCHDATA_INT,
198		.reg = 1,
199		.mask = WM831X_TCHDATA_EINT,
200	},
201	[WM831X_IRQ_TCHPD] = {
202		.primary = WM831X_TCHPD_INT,
203		.reg = 1,
204		.mask = WM831X_TCHPD_EINT,
205	},
206	[WM831X_IRQ_AUXADC_DATA] = {
207		.primary = WM831X_AUXADC_INT,
208		.reg = 1,
209		.mask = WM831X_AUXADC_DATA_EINT,
210	},
211	[WM831X_IRQ_AUXADC_DCOMP1] = {
212		.primary = WM831X_AUXADC_INT,
213		.reg = 1,
214		.mask = WM831X_AUXADC_DCOMP1_EINT,
215	},
216	[WM831X_IRQ_AUXADC_DCOMP2] = {
217		.primary = WM831X_AUXADC_INT,
218		.reg = 1,
219		.mask = WM831X_AUXADC_DCOMP2_EINT,
220	},
221	[WM831X_IRQ_AUXADC_DCOMP3] = {
222		.primary = WM831X_AUXADC_INT,
223		.reg = 1,
224		.mask = WM831X_AUXADC_DCOMP3_EINT,
225	},
226	[WM831X_IRQ_AUXADC_DCOMP4] = {
227		.primary = WM831X_AUXADC_INT,
228		.reg = 1,
229		.mask = WM831X_AUXADC_DCOMP4_EINT,
230	},
231	[WM831X_IRQ_CS1] = {
232		.primary = WM831X_CS_INT,
233		.reg = 2,
234		.mask = WM831X_CS1_EINT,
235	},
236	[WM831X_IRQ_CS2] = {
237		.primary = WM831X_CS_INT,
238		.reg = 2,
239		.mask = WM831X_CS2_EINT,
240	},
241	[WM831X_IRQ_HC_DC1] = {
242		.primary = WM831X_HC_INT,
243		.reg = 4,
244		.mask = WM831X_HC_DC1_EINT,
245	},
246	[WM831X_IRQ_HC_DC2] = {
247		.primary = WM831X_HC_INT,
248		.reg = 4,
249		.mask = WM831X_HC_DC2_EINT,
250	},
251	[WM831X_IRQ_UV_LDO1] = {
252		.primary = WM831X_UV_INT,
253		.reg = 3,
254		.mask = WM831X_UV_LDO1_EINT,
255	},
256	[WM831X_IRQ_UV_LDO2] = {
257		.primary = WM831X_UV_INT,
258		.reg = 3,
259		.mask = WM831X_UV_LDO2_EINT,
260	},
261	[WM831X_IRQ_UV_LDO3] = {
262		.primary = WM831X_UV_INT,
263		.reg = 3,
264		.mask = WM831X_UV_LDO3_EINT,
265	},
266	[WM831X_IRQ_UV_LDO4] = {
267		.primary = WM831X_UV_INT,
268		.reg = 3,
269		.mask = WM831X_UV_LDO4_EINT,
270	},
271	[WM831X_IRQ_UV_LDO5] = {
272		.primary = WM831X_UV_INT,
273		.reg = 3,
274		.mask = WM831X_UV_LDO5_EINT,
275	},
276	[WM831X_IRQ_UV_LDO6] = {
277		.primary = WM831X_UV_INT,
278		.reg = 3,
279		.mask = WM831X_UV_LDO6_EINT,
280	},
281	[WM831X_IRQ_UV_LDO7] = {
282		.primary = WM831X_UV_INT,
283		.reg = 3,
284		.mask = WM831X_UV_LDO7_EINT,
285	},
286	[WM831X_IRQ_UV_LDO8] = {
287		.primary = WM831X_UV_INT,
288		.reg = 3,
289		.mask = WM831X_UV_LDO8_EINT,
290	},
291	[WM831X_IRQ_UV_LDO9] = {
292		.primary = WM831X_UV_INT,
293		.reg = 3,
294		.mask = WM831X_UV_LDO9_EINT,
295	},
296	[WM831X_IRQ_UV_LDO10] = {
297		.primary = WM831X_UV_INT,
298		.reg = 3,
299		.mask = WM831X_UV_LDO10_EINT,
300	},
301	[WM831X_IRQ_UV_DC1] = {
302		.primary = WM831X_UV_INT,
303		.reg = 4,
304		.mask = WM831X_UV_DC1_EINT,
305	},
306	[WM831X_IRQ_UV_DC2] = {
307		.primary = WM831X_UV_INT,
308		.reg = 4,
309		.mask = WM831X_UV_DC2_EINT,
310	},
311	[WM831X_IRQ_UV_DC3] = {
312		.primary = WM831X_UV_INT,
313		.reg = 4,
314		.mask = WM831X_UV_DC3_EINT,
315	},
316	[WM831X_IRQ_UV_DC4] = {
317		.primary = WM831X_UV_INT,
318		.reg = 4,
319		.mask = WM831X_UV_DC4_EINT,
320	},
321};
322
323static inline int irq_data_to_status_reg(struct wm831x_irq_data *irq_data)
324{
325	return WM831X_INTERRUPT_STATUS_1 - 1 + irq_data->reg;
326}
327
328static inline int irq_data_to_mask_reg(struct wm831x_irq_data *irq_data)
329{
330	return WM831X_INTERRUPT_STATUS_1_MASK - 1 + irq_data->reg;
331}
332
333static inline struct wm831x_irq_data *irq_to_wm831x_irq(struct wm831x *wm831x,
334							int irq)
335{
336	return &wm831x_irqs[irq - wm831x->irq_base];
337}
338
339static void wm831x_irq_lock(struct irq_data *data)
340{
341	struct wm831x *wm831x = irq_data_get_irq_chip_data(data);
342
343	mutex_lock(&wm831x->irq_lock);
344}
345
346static void wm831x_irq_sync_unlock(struct irq_data *data)
347{
348	struct wm831x *wm831x = irq_data_get_irq_chip_data(data);
349	int i;
350
351	for (i = 0; i < ARRAY_SIZE(wm831x->gpio_update); i++) {
352		if (wm831x->gpio_update[i]) {
353			wm831x_set_bits(wm831x, WM831X_GPIO1_CONTROL + i,
354					WM831X_GPN_INT_MODE | WM831X_GPN_POL,
355					wm831x->gpio_update[i]);
356			wm831x->gpio_update[i] = 0;
357		}
358	}
359
360	for (i = 0; i < ARRAY_SIZE(wm831x->irq_masks_cur); i++) {
361		/* If there's been a change in the mask write it back
362		 * to the hardware. */
363		if (wm831x->irq_masks_cur[i] != wm831x->irq_masks_cache[i]) {
364			dev_dbg(wm831x->dev, "IRQ mask sync: %x = %x\n",
365				WM831X_INTERRUPT_STATUS_1_MASK + i,
366				wm831x->irq_masks_cur[i]);
367
368			wm831x->irq_masks_cache[i] = wm831x->irq_masks_cur[i];
369			wm831x_reg_write(wm831x,
370					 WM831X_INTERRUPT_STATUS_1_MASK + i,
371					 wm831x->irq_masks_cur[i]);
372		}
373	}
374
375	mutex_unlock(&wm831x->irq_lock);
376}
377
378static void wm831x_irq_enable(struct irq_data *data)
379{
380	struct wm831x *wm831x = irq_data_get_irq_chip_data(data);
381	struct wm831x_irq_data *irq_data = irq_to_wm831x_irq(wm831x,
382							     data->irq);
383
384	wm831x->irq_masks_cur[irq_data->reg - 1] &= ~irq_data->mask;
385}
386
387static void wm831x_irq_disable(struct irq_data *data)
388{
389	struct wm831x *wm831x = irq_data_get_irq_chip_data(data);
390	struct wm831x_irq_data *irq_data = irq_to_wm831x_irq(wm831x,
391							     data->irq);
392
393	wm831x->irq_masks_cur[irq_data->reg - 1] |= irq_data->mask;
394}
395
396static int wm831x_irq_set_type(struct irq_data *data, unsigned int type)
397{
398	struct wm831x *wm831x = irq_data_get_irq_chip_data(data);
399	int irq;
400
401	irq = data->irq - wm831x->irq_base;
402
403	if (irq < WM831X_IRQ_GPIO_1 || irq > WM831X_IRQ_GPIO_11) {
404		/* Ignore internal-only IRQs */
405		if (irq >= 0 && irq < WM831X_NUM_IRQS)
406			return 0;
407		else
408			return -EINVAL;
409	}
410
411	/* Rebase the IRQ into the GPIO range so we've got a sensible array
412	 * index.
413	 */
414	irq -= WM831X_IRQ_GPIO_1;
415
416	/* We set the high bit to flag that we need an update; don't
417	 * do the update here as we can be called with the bus lock
418	 * held.
419	 */
 
 
420	switch (type) {
421	case IRQ_TYPE_EDGE_BOTH:
422		wm831x->gpio_update[irq] = 0x10000 | WM831X_GPN_INT_MODE;
423		break;
424	case IRQ_TYPE_EDGE_RISING:
425		wm831x->gpio_update[irq] = 0x10000 | WM831X_GPN_POL;
426		break;
427	case IRQ_TYPE_EDGE_FALLING:
428		wm831x->gpio_update[irq] = 0x10000;
429		break;
 
 
 
 
 
 
 
 
430	default:
431		return -EINVAL;
432	}
433
434	return 0;
435}
436
437static struct irq_chip wm831x_irq_chip = {
438	.name			= "wm831x",
439	.irq_bus_lock		= wm831x_irq_lock,
440	.irq_bus_sync_unlock	= wm831x_irq_sync_unlock,
441	.irq_disable		= wm831x_irq_disable,
442	.irq_enable		= wm831x_irq_enable,
443	.irq_set_type		= wm831x_irq_set_type,
444};
445
446/* The processing of the primary interrupt occurs in a thread so that
447 * we can interact with the device over I2C or SPI. */
448static irqreturn_t wm831x_irq_thread(int irq, void *data)
449{
450	struct wm831x *wm831x = data;
451	unsigned int i;
452	int primary, status_addr;
453	int status_regs[WM831X_NUM_IRQ_REGS] = { 0 };
454	int read[WM831X_NUM_IRQ_REGS] = { 0 };
455	int *status;
456
457	primary = wm831x_reg_read(wm831x, WM831X_SYSTEM_INTERRUPTS);
458	if (primary < 0) {
459		dev_err(wm831x->dev, "Failed to read system interrupt: %d\n",
460			primary);
461		goto out;
462	}
463
464	/* The touch interrupts are visible in the primary register as
465	 * an optimisation; open code this to avoid complicating the
466	 * main handling loop and so we can also skip iterating the
467	 * descriptors.
468	 */
469	if (primary & WM831X_TCHPD_INT)
470		handle_nested_irq(wm831x->irq_base + WM831X_IRQ_TCHPD);
 
471	if (primary & WM831X_TCHDATA_INT)
472		handle_nested_irq(wm831x->irq_base + WM831X_IRQ_TCHDATA);
473	if (primary & (WM831X_TCHDATA_EINT | WM831X_TCHPD_EINT))
474		goto out;
475
476	for (i = 0; i < ARRAY_SIZE(wm831x_irqs); i++) {
477		int offset = wm831x_irqs[i].reg - 1;
478
479		if (!(primary & wm831x_irqs[i].primary))
480			continue;
481
482		status = &status_regs[offset];
483
484		/* Hopefully there should only be one register to read
485		 * each time otherwise we ought to do a block read. */
486		if (!read[offset]) {
487			status_addr = irq_data_to_status_reg(&wm831x_irqs[i]);
488
489			*status = wm831x_reg_read(wm831x, status_addr);
490			if (*status < 0) {
491				dev_err(wm831x->dev,
492					"Failed to read IRQ status: %d\n",
493					*status);
494				goto out;
495			}
496
497			read[offset] = 1;
498
499			/* Ignore any bits that we don't think are masked */
500			*status &= ~wm831x->irq_masks_cur[offset];
501
502			/* Acknowledge now so we don't miss
503			 * notifications while we handle.
504			 */
505			wm831x_reg_write(wm831x, status_addr, *status);
506		}
507
508		if (*status & wm831x_irqs[i].mask)
509			handle_nested_irq(wm831x->irq_base + i);
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
510	}
511
512out:
513	return IRQ_HANDLED;
514}
515
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
516int wm831x_irq_init(struct wm831x *wm831x, int irq)
517{
518	struct wm831x_pdata *pdata = wm831x->dev->platform_data;
519	int i, cur_irq, ret;
 
520
521	mutex_init(&wm831x->irq_lock);
522
523	/* Mask the individual interrupt sources */
524	for (i = 0; i < ARRAY_SIZE(wm831x->irq_masks_cur); i++) {
525		wm831x->irq_masks_cur[i] = 0xffff;
526		wm831x->irq_masks_cache[i] = 0xffff;
527		wm831x_reg_write(wm831x, WM831X_INTERRUPT_STATUS_1_MASK + i,
528				 0xffff);
529	}
530
531	/* Try to dynamically allocate IRQs if no base is specified */
532	if (!pdata || !pdata->irq_base)
533		wm831x->irq_base = -1;
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
534	else
535		wm831x->irq_base = pdata->irq_base;
 
 
 
536
537	wm831x->irq_base = irq_alloc_descs(wm831x->irq_base, 0,
538					   WM831X_NUM_IRQS, 0);
539	if (wm831x->irq_base < 0) {
540		dev_warn(wm831x->dev, "Failed to allocate IRQs: %d\n",
541			 wm831x->irq_base);
542		wm831x->irq_base = 0;
543		return 0;
544	}
545
546	if (pdata && pdata->irq_cmos)
547		i = 0;
548	else
549		i = WM831X_IRQ_OD;
550
551	wm831x_set_bits(wm831x, WM831X_IRQ_CONFIG,
552			WM831X_IRQ_OD, i);
553
554	/* Try to flag /IRQ as a wake source; there are a number of
555	 * unconditional wake sources in the PMIC so this isn't
556	 * conditional but we don't actually care *too* much if it
557	 * fails.
558	 */
559	ret = enable_irq_wake(irq);
560	if (ret != 0) {
561		dev_warn(wm831x->dev, "Can't enable IRQ as wake source: %d\n",
562			 ret);
563	}
564
565	wm831x->irq = irq;
566
567	/* Register them with genirq */
568	for (cur_irq = wm831x->irq_base;
569	     cur_irq < ARRAY_SIZE(wm831x_irqs) + wm831x->irq_base;
570	     cur_irq++) {
571		irq_set_chip_data(cur_irq, wm831x);
572		irq_set_chip_and_handler(cur_irq, &wm831x_irq_chip,
573					 handle_edge_irq);
574		irq_set_nested_thread(cur_irq, 1);
575
576		/* ARM needs us to explicitly flag the IRQ as valid
577		 * and will set them noprobe when we do so. */
578#ifdef CONFIG_ARM
579		set_irq_flags(cur_irq, IRQF_VALID);
580#else
581		irq_set_noprobe(cur_irq);
582#endif
583	}
584
585	if (irq) {
 
 
 
 
 
 
 
 
 
 
 
 
586		ret = request_threaded_irq(irq, NULL, wm831x_irq_thread,
587					   IRQF_TRIGGER_LOW | IRQF_ONESHOT,
588					   "wm831x", wm831x);
589		if (ret != 0) {
590			dev_err(wm831x->dev, "Failed to request IRQ %d: %d\n",
591				irq, ret);
592			return ret;
593		}
594	} else {
595		dev_warn(wm831x->dev,
596			 "No interrupt specified - functionality limited\n");
597	}
598
599
600
601	/* Enable top level interrupts, we mask at secondary level */
602	wm831x_reg_write(wm831x, WM831X_SYSTEM_INTERRUPTS_MASK, 0);
603
604	return 0;
605}
606
607void wm831x_irq_exit(struct wm831x *wm831x)
608{
609	if (wm831x->irq)
610		free_irq(wm831x->irq, wm831x);
611}
v3.15
  1/*
  2 * wm831x-irq.c  --  Interrupt controller support for Wolfson WM831x PMICs
  3 *
  4 * Copyright 2009 Wolfson Microelectronics PLC.
  5 *
  6 * Author: Mark Brown <broonie@opensource.wolfsonmicro.com>
  7 *
  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.
 12 *
 13 */
 14
 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>
 21#include <linux/irqdomain.h>
 22
 23#include <linux/mfd/wm831x/core.h>
 24#include <linux/mfd/wm831x/pdata.h>
 25#include <linux/mfd/wm831x/gpio.h>
 26#include <linux/mfd/wm831x/irq.h>
 27
 28#include <linux/delay.h>
 29
 30struct wm831x_irq_data {
 31	int primary;
 32	int reg;
 33	int mask;
 34};
 35
 36static struct wm831x_irq_data wm831x_irqs[] = {
 37	[WM831X_IRQ_TEMP_THW] = {
 38		.primary = WM831X_TEMP_INT,
 39		.reg = 1,
 40		.mask = WM831X_TEMP_THW_EINT,
 41	},
 42	[WM831X_IRQ_GPIO_1] = {
 43		.primary = WM831X_GP_INT,
 44		.reg = 5,
 45		.mask = WM831X_GP1_EINT,
 46	},
 47	[WM831X_IRQ_GPIO_2] = {
 48		.primary = WM831X_GP_INT,
 49		.reg = 5,
 50		.mask = WM831X_GP2_EINT,
 51	},
 52	[WM831X_IRQ_GPIO_3] = {
 53		.primary = WM831X_GP_INT,
 54		.reg = 5,
 55		.mask = WM831X_GP3_EINT,
 56	},
 57	[WM831X_IRQ_GPIO_4] = {
 58		.primary = WM831X_GP_INT,
 59		.reg = 5,
 60		.mask = WM831X_GP4_EINT,
 61	},
 62	[WM831X_IRQ_GPIO_5] = {
 63		.primary = WM831X_GP_INT,
 64		.reg = 5,
 65		.mask = WM831X_GP5_EINT,
 66	},
 67	[WM831X_IRQ_GPIO_6] = {
 68		.primary = WM831X_GP_INT,
 69		.reg = 5,
 70		.mask = WM831X_GP6_EINT,
 71	},
 72	[WM831X_IRQ_GPIO_7] = {
 73		.primary = WM831X_GP_INT,
 74		.reg = 5,
 75		.mask = WM831X_GP7_EINT,
 76	},
 77	[WM831X_IRQ_GPIO_8] = {
 78		.primary = WM831X_GP_INT,
 79		.reg = 5,
 80		.mask = WM831X_GP8_EINT,
 81	},
 82	[WM831X_IRQ_GPIO_9] = {
 83		.primary = WM831X_GP_INT,
 84		.reg = 5,
 85		.mask = WM831X_GP9_EINT,
 86	},
 87	[WM831X_IRQ_GPIO_10] = {
 88		.primary = WM831X_GP_INT,
 89		.reg = 5,
 90		.mask = WM831X_GP10_EINT,
 91	},
 92	[WM831X_IRQ_GPIO_11] = {
 93		.primary = WM831X_GP_INT,
 94		.reg = 5,
 95		.mask = WM831X_GP11_EINT,
 96	},
 97	[WM831X_IRQ_GPIO_12] = {
 98		.primary = WM831X_GP_INT,
 99		.reg = 5,
100		.mask = WM831X_GP12_EINT,
101	},
102	[WM831X_IRQ_GPIO_13] = {
103		.primary = WM831X_GP_INT,
104		.reg = 5,
105		.mask = WM831X_GP13_EINT,
106	},
107	[WM831X_IRQ_GPIO_14] = {
108		.primary = WM831X_GP_INT,
109		.reg = 5,
110		.mask = WM831X_GP14_EINT,
111	},
112	[WM831X_IRQ_GPIO_15] = {
113		.primary = WM831X_GP_INT,
114		.reg = 5,
115		.mask = WM831X_GP15_EINT,
116	},
117	[WM831X_IRQ_GPIO_16] = {
118		.primary = WM831X_GP_INT,
119		.reg = 5,
120		.mask = WM831X_GP16_EINT,
121	},
122	[WM831X_IRQ_ON] = {
123		.primary = WM831X_ON_PIN_INT,
124		.reg = 1,
125		.mask = WM831X_ON_PIN_EINT,
126	},
127	[WM831X_IRQ_PPM_SYSLO] = {
128		.primary = WM831X_PPM_INT,
129		.reg = 1,
130		.mask = WM831X_PPM_SYSLO_EINT,
131	},
132	[WM831X_IRQ_PPM_PWR_SRC] = {
133		.primary = WM831X_PPM_INT,
134		.reg = 1,
135		.mask = WM831X_PPM_PWR_SRC_EINT,
136	},
137	[WM831X_IRQ_PPM_USB_CURR] = {
138		.primary = WM831X_PPM_INT,
139		.reg = 1,
140		.mask = WM831X_PPM_USB_CURR_EINT,
141	},
142	[WM831X_IRQ_WDOG_TO] = {
143		.primary = WM831X_WDOG_INT,
144		.reg = 1,
145		.mask = WM831X_WDOG_TO_EINT,
146	},
147	[WM831X_IRQ_RTC_PER] = {
148		.primary = WM831X_RTC_INT,
149		.reg = 1,
150		.mask = WM831X_RTC_PER_EINT,
151	},
152	[WM831X_IRQ_RTC_ALM] = {
153		.primary = WM831X_RTC_INT,
154		.reg = 1,
155		.mask = WM831X_RTC_ALM_EINT,
156	},
157	[WM831X_IRQ_CHG_BATT_HOT] = {
158		.primary = WM831X_CHG_INT,
159		.reg = 2,
160		.mask = WM831X_CHG_BATT_HOT_EINT,
161	},
162	[WM831X_IRQ_CHG_BATT_COLD] = {
163		.primary = WM831X_CHG_INT,
164		.reg = 2,
165		.mask = WM831X_CHG_BATT_COLD_EINT,
166	},
167	[WM831X_IRQ_CHG_BATT_FAIL] = {
168		.primary = WM831X_CHG_INT,
169		.reg = 2,
170		.mask = WM831X_CHG_BATT_FAIL_EINT,
171	},
172	[WM831X_IRQ_CHG_OV] = {
173		.primary = WM831X_CHG_INT,
174		.reg = 2,
175		.mask = WM831X_CHG_OV_EINT,
176	},
177	[WM831X_IRQ_CHG_END] = {
178		.primary = WM831X_CHG_INT,
179		.reg = 2,
180		.mask = WM831X_CHG_END_EINT,
181	},
182	[WM831X_IRQ_CHG_TO] = {
183		.primary = WM831X_CHG_INT,
184		.reg = 2,
185		.mask = WM831X_CHG_TO_EINT,
186	},
187	[WM831X_IRQ_CHG_MODE] = {
188		.primary = WM831X_CHG_INT,
189		.reg = 2,
190		.mask = WM831X_CHG_MODE_EINT,
191	},
192	[WM831X_IRQ_CHG_START] = {
193		.primary = WM831X_CHG_INT,
194		.reg = 2,
195		.mask = WM831X_CHG_START_EINT,
196	},
197	[WM831X_IRQ_TCHDATA] = {
198		.primary = WM831X_TCHDATA_INT,
199		.reg = 1,
200		.mask = WM831X_TCHDATA_EINT,
201	},
202	[WM831X_IRQ_TCHPD] = {
203		.primary = WM831X_TCHPD_INT,
204		.reg = 1,
205		.mask = WM831X_TCHPD_EINT,
206	},
207	[WM831X_IRQ_AUXADC_DATA] = {
208		.primary = WM831X_AUXADC_INT,
209		.reg = 1,
210		.mask = WM831X_AUXADC_DATA_EINT,
211	},
212	[WM831X_IRQ_AUXADC_DCOMP1] = {
213		.primary = WM831X_AUXADC_INT,
214		.reg = 1,
215		.mask = WM831X_AUXADC_DCOMP1_EINT,
216	},
217	[WM831X_IRQ_AUXADC_DCOMP2] = {
218		.primary = WM831X_AUXADC_INT,
219		.reg = 1,
220		.mask = WM831X_AUXADC_DCOMP2_EINT,
221	},
222	[WM831X_IRQ_AUXADC_DCOMP3] = {
223		.primary = WM831X_AUXADC_INT,
224		.reg = 1,
225		.mask = WM831X_AUXADC_DCOMP3_EINT,
226	},
227	[WM831X_IRQ_AUXADC_DCOMP4] = {
228		.primary = WM831X_AUXADC_INT,
229		.reg = 1,
230		.mask = WM831X_AUXADC_DCOMP4_EINT,
231	},
232	[WM831X_IRQ_CS1] = {
233		.primary = WM831X_CS_INT,
234		.reg = 2,
235		.mask = WM831X_CS1_EINT,
236	},
237	[WM831X_IRQ_CS2] = {
238		.primary = WM831X_CS_INT,
239		.reg = 2,
240		.mask = WM831X_CS2_EINT,
241	},
242	[WM831X_IRQ_HC_DC1] = {
243		.primary = WM831X_HC_INT,
244		.reg = 4,
245		.mask = WM831X_HC_DC1_EINT,
246	},
247	[WM831X_IRQ_HC_DC2] = {
248		.primary = WM831X_HC_INT,
249		.reg = 4,
250		.mask = WM831X_HC_DC2_EINT,
251	},
252	[WM831X_IRQ_UV_LDO1] = {
253		.primary = WM831X_UV_INT,
254		.reg = 3,
255		.mask = WM831X_UV_LDO1_EINT,
256	},
257	[WM831X_IRQ_UV_LDO2] = {
258		.primary = WM831X_UV_INT,
259		.reg = 3,
260		.mask = WM831X_UV_LDO2_EINT,
261	},
262	[WM831X_IRQ_UV_LDO3] = {
263		.primary = WM831X_UV_INT,
264		.reg = 3,
265		.mask = WM831X_UV_LDO3_EINT,
266	},
267	[WM831X_IRQ_UV_LDO4] = {
268		.primary = WM831X_UV_INT,
269		.reg = 3,
270		.mask = WM831X_UV_LDO4_EINT,
271	},
272	[WM831X_IRQ_UV_LDO5] = {
273		.primary = WM831X_UV_INT,
274		.reg = 3,
275		.mask = WM831X_UV_LDO5_EINT,
276	},
277	[WM831X_IRQ_UV_LDO6] = {
278		.primary = WM831X_UV_INT,
279		.reg = 3,
280		.mask = WM831X_UV_LDO6_EINT,
281	},
282	[WM831X_IRQ_UV_LDO7] = {
283		.primary = WM831X_UV_INT,
284		.reg = 3,
285		.mask = WM831X_UV_LDO7_EINT,
286	},
287	[WM831X_IRQ_UV_LDO8] = {
288		.primary = WM831X_UV_INT,
289		.reg = 3,
290		.mask = WM831X_UV_LDO8_EINT,
291	},
292	[WM831X_IRQ_UV_LDO9] = {
293		.primary = WM831X_UV_INT,
294		.reg = 3,
295		.mask = WM831X_UV_LDO9_EINT,
296	},
297	[WM831X_IRQ_UV_LDO10] = {
298		.primary = WM831X_UV_INT,
299		.reg = 3,
300		.mask = WM831X_UV_LDO10_EINT,
301	},
302	[WM831X_IRQ_UV_DC1] = {
303		.primary = WM831X_UV_INT,
304		.reg = 4,
305		.mask = WM831X_UV_DC1_EINT,
306	},
307	[WM831X_IRQ_UV_DC2] = {
308		.primary = WM831X_UV_INT,
309		.reg = 4,
310		.mask = WM831X_UV_DC2_EINT,
311	},
312	[WM831X_IRQ_UV_DC3] = {
313		.primary = WM831X_UV_INT,
314		.reg = 4,
315		.mask = WM831X_UV_DC3_EINT,
316	},
317	[WM831X_IRQ_UV_DC4] = {
318		.primary = WM831X_UV_INT,
319		.reg = 4,
320		.mask = WM831X_UV_DC4_EINT,
321	},
322};
323
324static inline int irq_data_to_status_reg(struct wm831x_irq_data *irq_data)
325{
326	return WM831X_INTERRUPT_STATUS_1 - 1 + irq_data->reg;
327}
328
 
 
 
 
 
329static inline struct wm831x_irq_data *irq_to_wm831x_irq(struct wm831x *wm831x,
330							int irq)
331{
332	return &wm831x_irqs[irq];
333}
334
335static void wm831x_irq_lock(struct irq_data *data)
336{
337	struct wm831x *wm831x = irq_data_get_irq_chip_data(data);
338
339	mutex_lock(&wm831x->irq_lock);
340}
341
342static void wm831x_irq_sync_unlock(struct irq_data *data)
343{
344	struct wm831x *wm831x = irq_data_get_irq_chip_data(data);
345	int i;
346
347	for (i = 0; i < ARRAY_SIZE(wm831x->gpio_update); i++) {
348		if (wm831x->gpio_update[i]) {
349			wm831x_set_bits(wm831x, WM831X_GPIO1_CONTROL + i,
350					WM831X_GPN_INT_MODE | WM831X_GPN_POL,
351					wm831x->gpio_update[i]);
352			wm831x->gpio_update[i] = 0;
353		}
354	}
355
356	for (i = 0; i < ARRAY_SIZE(wm831x->irq_masks_cur); i++) {
357		/* If there's been a change in the mask write it back
358		 * to the hardware. */
359		if (wm831x->irq_masks_cur[i] != wm831x->irq_masks_cache[i]) {
360			dev_dbg(wm831x->dev, "IRQ mask sync: %x = %x\n",
361				WM831X_INTERRUPT_STATUS_1_MASK + i,
362				wm831x->irq_masks_cur[i]);
363
364			wm831x->irq_masks_cache[i] = wm831x->irq_masks_cur[i];
365			wm831x_reg_write(wm831x,
366					 WM831X_INTERRUPT_STATUS_1_MASK + i,
367					 wm831x->irq_masks_cur[i]);
368		}
369	}
370
371	mutex_unlock(&wm831x->irq_lock);
372}
373
374static void wm831x_irq_enable(struct irq_data *data)
375{
376	struct wm831x *wm831x = irq_data_get_irq_chip_data(data);
377	struct wm831x_irq_data *irq_data = irq_to_wm831x_irq(wm831x,
378							     data->hwirq);
379
380	wm831x->irq_masks_cur[irq_data->reg - 1] &= ~irq_data->mask;
381}
382
383static void wm831x_irq_disable(struct irq_data *data)
384{
385	struct wm831x *wm831x = irq_data_get_irq_chip_data(data);
386	struct wm831x_irq_data *irq_data = irq_to_wm831x_irq(wm831x,
387							     data->hwirq);
388
389	wm831x->irq_masks_cur[irq_data->reg - 1] |= irq_data->mask;
390}
391
392static int wm831x_irq_set_type(struct irq_data *data, unsigned int type)
393{
394	struct wm831x *wm831x = irq_data_get_irq_chip_data(data);
395	int irq;
396
397	irq = data->hwirq;
398
399	if (irq < WM831X_IRQ_GPIO_1 || irq > WM831X_IRQ_GPIO_11) {
400		/* Ignore internal-only IRQs */
401		if (irq >= 0 && irq < WM831X_NUM_IRQS)
402			return 0;
403		else
404			return -EINVAL;
405	}
406
407	/* Rebase the IRQ into the GPIO range so we've got a sensible array
408	 * index.
409	 */
410	irq -= WM831X_IRQ_GPIO_1;
411
412	/* We set the high bit to flag that we need an update; don't
413	 * do the update here as we can be called with the bus lock
414	 * held.
415	 */
416	wm831x->gpio_level_low[irq] = false;
417	wm831x->gpio_level_high[irq] = false;
418	switch (type) {
419	case IRQ_TYPE_EDGE_BOTH:
420		wm831x->gpio_update[irq] = 0x10000 | WM831X_GPN_INT_MODE;
421		break;
422	case IRQ_TYPE_EDGE_RISING:
423		wm831x->gpio_update[irq] = 0x10000 | WM831X_GPN_POL;
424		break;
425	case IRQ_TYPE_EDGE_FALLING:
426		wm831x->gpio_update[irq] = 0x10000;
427		break;
428	case IRQ_TYPE_LEVEL_HIGH:
429		wm831x->gpio_update[irq] = 0x10000 | WM831X_GPN_POL;
430		wm831x->gpio_level_high[irq] = true;
431		break;
432	case IRQ_TYPE_LEVEL_LOW:
433		wm831x->gpio_update[irq] = 0x10000;
434		wm831x->gpio_level_low[irq] = true;
435		break;
436	default:
437		return -EINVAL;
438	}
439
440	return 0;
441}
442
443static struct irq_chip wm831x_irq_chip = {
444	.name			= "wm831x",
445	.irq_bus_lock		= wm831x_irq_lock,
446	.irq_bus_sync_unlock	= wm831x_irq_sync_unlock,
447	.irq_disable		= wm831x_irq_disable,
448	.irq_enable		= wm831x_irq_enable,
449	.irq_set_type		= wm831x_irq_set_type,
450};
451
452/* The processing of the primary interrupt occurs in a thread so that
453 * we can interact with the device over I2C or SPI. */
454static irqreturn_t wm831x_irq_thread(int irq, void *data)
455{
456	struct wm831x *wm831x = data;
457	unsigned int i;
458	int primary, status_addr, ret;
459	int status_regs[WM831X_NUM_IRQ_REGS] = { 0 };
460	int read[WM831X_NUM_IRQ_REGS] = { 0 };
461	int *status;
462
463	primary = wm831x_reg_read(wm831x, WM831X_SYSTEM_INTERRUPTS);
464	if (primary < 0) {
465		dev_err(wm831x->dev, "Failed to read system interrupt: %d\n",
466			primary);
467		goto out;
468	}
469
470	/* The touch interrupts are visible in the primary register as
471	 * an optimisation; open code this to avoid complicating the
472	 * main handling loop and so we can also skip iterating the
473	 * descriptors.
474	 */
475	if (primary & WM831X_TCHPD_INT)
476		handle_nested_irq(irq_find_mapping(wm831x->irq_domain,
477						   WM831X_IRQ_TCHPD));
478	if (primary & WM831X_TCHDATA_INT)
479		handle_nested_irq(irq_find_mapping(wm831x->irq_domain,
480						   WM831X_IRQ_TCHDATA));
481	primary &= ~(WM831X_TCHDATA_EINT | WM831X_TCHPD_EINT);
482
483	for (i = 0; i < ARRAY_SIZE(wm831x_irqs); i++) {
484		int offset = wm831x_irqs[i].reg - 1;
485
486		if (!(primary & wm831x_irqs[i].primary))
487			continue;
488
489		status = &status_regs[offset];
490
491		/* Hopefully there should only be one register to read
492		 * each time otherwise we ought to do a block read. */
493		if (!read[offset]) {
494			status_addr = irq_data_to_status_reg(&wm831x_irqs[i]);
495
496			*status = wm831x_reg_read(wm831x, status_addr);
497			if (*status < 0) {
498				dev_err(wm831x->dev,
499					"Failed to read IRQ status: %d\n",
500					*status);
501				goto out;
502			}
503
504			read[offset] = 1;
505
506			/* Ignore any bits that we don't think are masked */
507			*status &= ~wm831x->irq_masks_cur[offset];
508
509			/* Acknowledge now so we don't miss
510			 * notifications while we handle.
511			 */
512			wm831x_reg_write(wm831x, status_addr, *status);
513		}
514
515		if (*status & wm831x_irqs[i].mask)
516			handle_nested_irq(irq_find_mapping(wm831x->irq_domain,
517							   i));
518
519		/* Simulate an edge triggered IRQ by polling the input
520		 * status.  This is sucky but improves interoperability.
521		 */
522		if (primary == WM831X_GP_INT &&
523		    wm831x->gpio_level_high[i - WM831X_IRQ_GPIO_1]) {
524			ret = wm831x_reg_read(wm831x, WM831X_GPIO_LEVEL);
525			while (ret & 1 << (i - WM831X_IRQ_GPIO_1)) {
526				handle_nested_irq(irq_find_mapping(wm831x->irq_domain,
527								   i));
528				ret = wm831x_reg_read(wm831x,
529						      WM831X_GPIO_LEVEL);
530			}
531		}
532
533		if (primary == WM831X_GP_INT &&
534		    wm831x->gpio_level_low[i - WM831X_IRQ_GPIO_1]) {
535			ret = wm831x_reg_read(wm831x, WM831X_GPIO_LEVEL);
536			while (!(ret & 1 << (i - WM831X_IRQ_GPIO_1))) {
537				handle_nested_irq(irq_find_mapping(wm831x->irq_domain,
538								   i));
539				ret = wm831x_reg_read(wm831x,
540						      WM831X_GPIO_LEVEL);
541			}
542		}
543	}
544
545out:
546	return IRQ_HANDLED;
547}
548
549static int wm831x_irq_map(struct irq_domain *h, unsigned int virq,
550			  irq_hw_number_t hw)
551{
552	irq_set_chip_data(virq, h->host_data);
553	irq_set_chip_and_handler(virq, &wm831x_irq_chip, handle_edge_irq);
554	irq_set_nested_thread(virq, 1);
555
556	/* ARM needs us to explicitly flag the IRQ as valid
557	 * and will set them noprobe when we do so. */
558#ifdef CONFIG_ARM
559	set_irq_flags(virq, IRQF_VALID);
560#else
561	irq_set_noprobe(virq);
562#endif
563
564	return 0;
565}
566
567static struct irq_domain_ops wm831x_irq_domain_ops = {
568	.map	= wm831x_irq_map,
569	.xlate	= irq_domain_xlate_twocell,
570};
571
572int wm831x_irq_init(struct wm831x *wm831x, int irq)
573{
574	struct wm831x_pdata *pdata = dev_get_platdata(wm831x->dev);
575	struct irq_domain *domain;
576	int i, ret, irq_base;
577
578	mutex_init(&wm831x->irq_lock);
579
580	/* Mask the individual interrupt sources */
581	for (i = 0; i < ARRAY_SIZE(wm831x->irq_masks_cur); i++) {
582		wm831x->irq_masks_cur[i] = 0xffff;
583		wm831x->irq_masks_cache[i] = 0xffff;
584		wm831x_reg_write(wm831x, WM831X_INTERRUPT_STATUS_1_MASK + i,
585				 0xffff);
586	}
587
588	/* Try to dynamically allocate IRQs if no base is specified */
589	if (pdata && pdata->irq_base) {
590		irq_base = irq_alloc_descs(pdata->irq_base, 0,
591					   WM831X_NUM_IRQS, 0);
592		if (irq_base < 0) {
593			dev_warn(wm831x->dev, "Failed to allocate IRQs: %d\n",
594				 irq_base);
595			irq_base = 0;
596		}
597	} else {
598		irq_base = 0;
599	}
600
601	if (irq_base)
602		domain = irq_domain_add_legacy(wm831x->dev->of_node,
603					       ARRAY_SIZE(wm831x_irqs),
604					       irq_base, 0,
605					       &wm831x_irq_domain_ops,
606					       wm831x);
607	else
608		domain = irq_domain_add_linear(wm831x->dev->of_node,
609					       ARRAY_SIZE(wm831x_irqs),
610					       &wm831x_irq_domain_ops,
611					       wm831x);
612
613	if (!domain) {
614		dev_warn(wm831x->dev, "Failed to allocate IRQ domain\n");
615		return -EINVAL;
 
 
 
 
616	}
617
618	if (pdata && pdata->irq_cmos)
619		i = 0;
620	else
621		i = WM831X_IRQ_OD;
622
623	wm831x_set_bits(wm831x, WM831X_IRQ_CONFIG,
624			WM831X_IRQ_OD, i);
625
 
 
 
 
 
 
 
 
 
 
 
626	wm831x->irq = irq;
627	wm831x->irq_domain = domain;
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
628
629	if (irq) {
630		/* Try to flag /IRQ as a wake source; there are a number of
631		 * unconditional wake sources in the PMIC so this isn't
632		 * conditional but we don't actually care *too* much if it
633		 * fails.
634		 */
635		ret = enable_irq_wake(irq);
636		if (ret != 0) {
637			dev_warn(wm831x->dev,
638				 "Can't enable IRQ as wake source: %d\n",
639				 ret);
640		}
641
642		ret = request_threaded_irq(irq, NULL, wm831x_irq_thread,
643					   IRQF_TRIGGER_LOW | IRQF_ONESHOT,
644					   "wm831x", wm831x);
645		if (ret != 0) {
646			dev_err(wm831x->dev, "Failed to request IRQ %d: %d\n",
647				irq, ret);
648			return ret;
649		}
650	} else {
651		dev_warn(wm831x->dev,
652			 "No interrupt specified - functionality limited\n");
653	}
 
 
654
655	/* Enable top level interrupts, we mask at secondary level */
656	wm831x_reg_write(wm831x, WM831X_SYSTEM_INTERRUPTS_MASK, 0);
657
658	return 0;
659}
660
661void wm831x_irq_exit(struct wm831x *wm831x)
662{
663	if (wm831x->irq)
664		free_irq(wm831x->irq, wm831x);
665}