Linux Audio

Check our new training course

Loading...
v5.9
  1// SPDX-License-Identifier: GPL-2.0
  2/*
  3 * Renesas INTC External IRQ Pin Driver
  4 *
  5 *  Copyright (C) 2013 Magnus Damm
 
 
 
 
 
 
 
 
 
 
 
 
 
  6 */
  7
  8#include <linux/init.h>
  9#include <linux/of.h>
 10#include <linux/platform_device.h>
 11#include <linux/spinlock.h>
 12#include <linux/interrupt.h>
 13#include <linux/ioport.h>
 14#include <linux/io.h>
 15#include <linux/irq.h>
 16#include <linux/irqdomain.h>
 17#include <linux/err.h>
 18#include <linux/slab.h>
 19#include <linux/module.h>
 20#include <linux/of_device.h>
 21#include <linux/pm_runtime.h>
 22
 23#define INTC_IRQPIN_MAX 8 /* maximum 8 interrupts per driver instance */
 24
 25#define INTC_IRQPIN_REG_SENSE 0 /* ICRn */
 26#define INTC_IRQPIN_REG_PRIO 1 /* INTPRInn */
 27#define INTC_IRQPIN_REG_SOURCE 2 /* INTREQnn */
 28#define INTC_IRQPIN_REG_MASK 3 /* INTMSKnn */
 29#define INTC_IRQPIN_REG_CLEAR 4 /* INTMSKCLRnn */
 30#define INTC_IRQPIN_REG_NR_MANDATORY 5
 31#define INTC_IRQPIN_REG_IRLM 5 /* ICR0 with IRLM bit (optional) */
 32#define INTC_IRQPIN_REG_NR 6
 33
 34/* INTC external IRQ PIN hardware register access:
 35 *
 36 * SENSE is read-write 32-bit with 2-bits or 4-bits per IRQ (*)
 37 * PRIO is read-write 32-bit with 4-bits per IRQ (**)
 38 * SOURCE is read-only 32-bit or 8-bit with 1-bit per IRQ (***)
 39 * MASK is write-only 32-bit or 8-bit with 1-bit per IRQ (***)
 40 * CLEAR is write-only 32-bit or 8-bit with 1-bit per IRQ (***)
 41 *
 42 * (*) May be accessed by more than one driver instance - lock needed
 43 * (**) Read-modify-write access by one driver instance - lock needed
 44 * (***) Accessed by one driver instance only - no locking needed
 45 */
 46
 47struct intc_irqpin_iomem {
 48	void __iomem *iomem;
 49	unsigned long (*read)(void __iomem *iomem);
 50	void (*write)(void __iomem *iomem, unsigned long data);
 51	int width;
 52};
 53
 54struct intc_irqpin_irq {
 55	int hw_irq;
 56	int requested_irq;
 57	int domain_irq;
 58	struct intc_irqpin_priv *p;
 59};
 60
 61struct intc_irqpin_priv {
 62	struct intc_irqpin_iomem iomem[INTC_IRQPIN_REG_NR];
 63	struct intc_irqpin_irq irq[INTC_IRQPIN_MAX];
 64	unsigned int sense_bitfield_width;
 
 65	struct platform_device *pdev;
 66	struct irq_chip irq_chip;
 67	struct irq_domain *irq_domain;
 68	atomic_t wakeup_path;
 69	unsigned shared_irqs:1;
 70	u8 shared_irq_mask;
 71};
 72
 73struct intc_irqpin_config {
 74	unsigned int irlm_bit;
 75	unsigned needs_irlm:1;
 76};
 77
 78static unsigned long intc_irqpin_read32(void __iomem *iomem)
 79{
 80	return ioread32(iomem);
 81}
 82
 83static unsigned long intc_irqpin_read8(void __iomem *iomem)
 84{
 85	return ioread8(iomem);
 86}
 87
 88static void intc_irqpin_write32(void __iomem *iomem, unsigned long data)
 89{
 90	iowrite32(data, iomem);
 91}
 92
 93static void intc_irqpin_write8(void __iomem *iomem, unsigned long data)
 94{
 95	iowrite8(data, iomem);
 96}
 97
 98static inline unsigned long intc_irqpin_read(struct intc_irqpin_priv *p,
 99					     int reg)
100{
101	struct intc_irqpin_iomem *i = &p->iomem[reg];
102
103	return i->read(i->iomem);
104}
105
106static inline void intc_irqpin_write(struct intc_irqpin_priv *p,
107				     int reg, unsigned long data)
108{
109	struct intc_irqpin_iomem *i = &p->iomem[reg];
110
111	i->write(i->iomem, data);
112}
113
114static inline unsigned long intc_irqpin_hwirq_mask(struct intc_irqpin_priv *p,
115						   int reg, int hw_irq)
116{
117	return BIT((p->iomem[reg].width - 1) - hw_irq);
118}
119
120static inline void intc_irqpin_irq_write_hwirq(struct intc_irqpin_priv *p,
121					       int reg, int hw_irq)
122{
123	intc_irqpin_write(p, reg, intc_irqpin_hwirq_mask(p, reg, hw_irq));
124}
125
126static DEFINE_RAW_SPINLOCK(intc_irqpin_lock); /* only used by slow path */
127
128static void intc_irqpin_read_modify_write(struct intc_irqpin_priv *p,
129					  int reg, int shift,
130					  int width, int value)
131{
132	unsigned long flags;
133	unsigned long tmp;
134
135	raw_spin_lock_irqsave(&intc_irqpin_lock, flags);
136
137	tmp = intc_irqpin_read(p, reg);
138	tmp &= ~(((1 << width) - 1) << shift);
139	tmp |= value << shift;
140	intc_irqpin_write(p, reg, tmp);
141
142	raw_spin_unlock_irqrestore(&intc_irqpin_lock, flags);
143}
144
145static void intc_irqpin_mask_unmask_prio(struct intc_irqpin_priv *p,
146					 int irq, int do_mask)
147{
148	/* The PRIO register is assumed to be 32-bit with fixed 4-bit fields. */
149	int bitfield_width = 4;
150	int shift = 32 - (irq + 1) * bitfield_width;
151
152	intc_irqpin_read_modify_write(p, INTC_IRQPIN_REG_PRIO,
153				      shift, bitfield_width,
154				      do_mask ? 0 : (1 << bitfield_width) - 1);
155}
156
157static int intc_irqpin_set_sense(struct intc_irqpin_priv *p, int irq, int value)
158{
159	/* The SENSE register is assumed to be 32-bit. */
160	int bitfield_width = p->sense_bitfield_width;
161	int shift = 32 - (irq + 1) * bitfield_width;
162
163	dev_dbg(&p->pdev->dev, "sense irq = %d, mode = %d\n", irq, value);
164
165	if (value >= (1 << bitfield_width))
166		return -EINVAL;
167
168	intc_irqpin_read_modify_write(p, INTC_IRQPIN_REG_SENSE, shift,
169				      bitfield_width, value);
170	return 0;
171}
172
173static void intc_irqpin_dbg(struct intc_irqpin_irq *i, char *str)
174{
175	dev_dbg(&i->p->pdev->dev, "%s (%d:%d:%d)\n",
176		str, i->requested_irq, i->hw_irq, i->domain_irq);
177}
178
179static void intc_irqpin_irq_enable(struct irq_data *d)
180{
181	struct intc_irqpin_priv *p = irq_data_get_irq_chip_data(d);
182	int hw_irq = irqd_to_hwirq(d);
183
184	intc_irqpin_dbg(&p->irq[hw_irq], "enable");
185	intc_irqpin_irq_write_hwirq(p, INTC_IRQPIN_REG_CLEAR, hw_irq);
186}
187
188static void intc_irqpin_irq_disable(struct irq_data *d)
189{
190	struct intc_irqpin_priv *p = irq_data_get_irq_chip_data(d);
191	int hw_irq = irqd_to_hwirq(d);
192
193	intc_irqpin_dbg(&p->irq[hw_irq], "disable");
194	intc_irqpin_irq_write_hwirq(p, INTC_IRQPIN_REG_MASK, hw_irq);
195}
196
197static void intc_irqpin_shared_irq_enable(struct irq_data *d)
198{
199	struct intc_irqpin_priv *p = irq_data_get_irq_chip_data(d);
200	int hw_irq = irqd_to_hwirq(d);
201
202	intc_irqpin_dbg(&p->irq[hw_irq], "shared enable");
203	intc_irqpin_irq_write_hwirq(p, INTC_IRQPIN_REG_CLEAR, hw_irq);
204
205	p->shared_irq_mask &= ~BIT(hw_irq);
206}
207
208static void intc_irqpin_shared_irq_disable(struct irq_data *d)
209{
210	struct intc_irqpin_priv *p = irq_data_get_irq_chip_data(d);
211	int hw_irq = irqd_to_hwirq(d);
212
213	intc_irqpin_dbg(&p->irq[hw_irq], "shared disable");
214	intc_irqpin_irq_write_hwirq(p, INTC_IRQPIN_REG_MASK, hw_irq);
215
216	p->shared_irq_mask |= BIT(hw_irq);
217}
218
219static void intc_irqpin_irq_enable_force(struct irq_data *d)
220{
221	struct intc_irqpin_priv *p = irq_data_get_irq_chip_data(d);
222	int irq = p->irq[irqd_to_hwirq(d)].requested_irq;
223
224	intc_irqpin_irq_enable(d);
225
226	/* enable interrupt through parent interrupt controller,
227	 * assumes non-shared interrupt with 1:1 mapping
228	 * needed for busted IRQs on some SoCs like sh73a0
229	 */
230	irq_get_chip(irq)->irq_unmask(irq_get_irq_data(irq));
231}
232
233static void intc_irqpin_irq_disable_force(struct irq_data *d)
234{
235	struct intc_irqpin_priv *p = irq_data_get_irq_chip_data(d);
236	int irq = p->irq[irqd_to_hwirq(d)].requested_irq;
237
238	/* disable interrupt through parent interrupt controller,
239	 * assumes non-shared interrupt with 1:1 mapping
240	 * needed for busted IRQs on some SoCs like sh73a0
241	 */
242	irq_get_chip(irq)->irq_mask(irq_get_irq_data(irq));
243	intc_irqpin_irq_disable(d);
244}
245
246#define INTC_IRQ_SENSE_VALID 0x10
247#define INTC_IRQ_SENSE(x) (x + INTC_IRQ_SENSE_VALID)
248
249static unsigned char intc_irqpin_sense[IRQ_TYPE_SENSE_MASK + 1] = {
250	[IRQ_TYPE_EDGE_FALLING] = INTC_IRQ_SENSE(0x00),
251	[IRQ_TYPE_EDGE_RISING] = INTC_IRQ_SENSE(0x01),
252	[IRQ_TYPE_LEVEL_LOW] = INTC_IRQ_SENSE(0x02),
253	[IRQ_TYPE_LEVEL_HIGH] = INTC_IRQ_SENSE(0x03),
254	[IRQ_TYPE_EDGE_BOTH] = INTC_IRQ_SENSE(0x04),
255};
256
257static int intc_irqpin_irq_set_type(struct irq_data *d, unsigned int type)
258{
259	unsigned char value = intc_irqpin_sense[type & IRQ_TYPE_SENSE_MASK];
260	struct intc_irqpin_priv *p = irq_data_get_irq_chip_data(d);
261
262	if (!(value & INTC_IRQ_SENSE_VALID))
263		return -EINVAL;
264
265	return intc_irqpin_set_sense(p, irqd_to_hwirq(d),
266				     value ^ INTC_IRQ_SENSE_VALID);
267}
268
269static int intc_irqpin_irq_set_wake(struct irq_data *d, unsigned int on)
270{
271	struct intc_irqpin_priv *p = irq_data_get_irq_chip_data(d);
272	int hw_irq = irqd_to_hwirq(d);
273
274	irq_set_irq_wake(p->irq[hw_irq].requested_irq, on);
275	if (on)
276		atomic_inc(&p->wakeup_path);
277	else
278		atomic_dec(&p->wakeup_path);
279
280	return 0;
281}
282
283static irqreturn_t intc_irqpin_irq_handler(int irq, void *dev_id)
284{
285	struct intc_irqpin_irq *i = dev_id;
286	struct intc_irqpin_priv *p = i->p;
287	unsigned long bit;
288
289	intc_irqpin_dbg(i, "demux1");
290	bit = intc_irqpin_hwirq_mask(p, INTC_IRQPIN_REG_SOURCE, i->hw_irq);
291
292	if (intc_irqpin_read(p, INTC_IRQPIN_REG_SOURCE) & bit) {
293		intc_irqpin_write(p, INTC_IRQPIN_REG_SOURCE, ~bit);
294		intc_irqpin_dbg(i, "demux2");
295		generic_handle_irq(i->domain_irq);
296		return IRQ_HANDLED;
297	}
298	return IRQ_NONE;
299}
300
301static irqreturn_t intc_irqpin_shared_irq_handler(int irq, void *dev_id)
302{
303	struct intc_irqpin_priv *p = dev_id;
304	unsigned int reg_source = intc_irqpin_read(p, INTC_IRQPIN_REG_SOURCE);
305	irqreturn_t status = IRQ_NONE;
306	int k;
307
308	for (k = 0; k < 8; k++) {
309		if (reg_source & BIT(7 - k)) {
310			if (BIT(k) & p->shared_irq_mask)
311				continue;
312
313			status |= intc_irqpin_irq_handler(irq, &p->irq[k]);
314		}
315	}
316
317	return status;
318}
319
320/*
321 * This lock class tells lockdep that INTC External IRQ Pin irqs are in a
322 * different category than their parents, so it won't report false recursion.
323 */
324static struct lock_class_key intc_irqpin_irq_lock_class;
325
326/* And this is for the request mutex */
327static struct lock_class_key intc_irqpin_irq_request_class;
328
329static int intc_irqpin_irq_domain_map(struct irq_domain *h, unsigned int virq,
330				      irq_hw_number_t hw)
331{
332	struct intc_irqpin_priv *p = h->host_data;
333
334	p->irq[hw].domain_irq = virq;
335	p->irq[hw].hw_irq = hw;
336
337	intc_irqpin_dbg(&p->irq[hw], "map");
338	irq_set_chip_data(virq, h->host_data);
339	irq_set_lockdep_class(virq, &intc_irqpin_irq_lock_class,
340			      &intc_irqpin_irq_request_class);
341	irq_set_chip_and_handler(virq, &p->irq_chip, handle_level_irq);
 
342	return 0;
343}
344
345static const struct irq_domain_ops intc_irqpin_irq_domain_ops = {
346	.map	= intc_irqpin_irq_domain_map,
347	.xlate  = irq_domain_xlate_twocell,
348};
349
350static const struct intc_irqpin_config intc_irqpin_irlm_r8a777x = {
351	.irlm_bit = 23, /* ICR0.IRLM0 */
352	.needs_irlm = 1,
353};
354
355static const struct intc_irqpin_config intc_irqpin_rmobile = {
356	.needs_irlm = 0,
357};
358
359static const struct of_device_id intc_irqpin_dt_ids[] = {
360	{ .compatible = "renesas,intc-irqpin", },
361	{ .compatible = "renesas,intc-irqpin-r8a7778",
362	  .data = &intc_irqpin_irlm_r8a777x },
363	{ .compatible = "renesas,intc-irqpin-r8a7779",
364	  .data = &intc_irqpin_irlm_r8a777x },
365	{ .compatible = "renesas,intc-irqpin-r8a7740",
366	  .data = &intc_irqpin_rmobile },
367	{ .compatible = "renesas,intc-irqpin-sh73a0",
368	  .data = &intc_irqpin_rmobile },
369	{},
370};
371MODULE_DEVICE_TABLE(of, intc_irqpin_dt_ids);
372
373static int intc_irqpin_probe(struct platform_device *pdev)
374{
375	const struct intc_irqpin_config *config;
376	struct device *dev = &pdev->dev;
377	struct intc_irqpin_priv *p;
378	struct intc_irqpin_iomem *i;
379	struct resource *io[INTC_IRQPIN_REG_NR];
380	struct resource *irq;
381	struct irq_chip *irq_chip;
382	void (*enable_fn)(struct irq_data *d);
383	void (*disable_fn)(struct irq_data *d);
384	const char *name = dev_name(dev);
385	bool control_parent;
386	unsigned int nirqs;
387	int ref_irq;
388	int ret;
389	int k;
390
391	p = devm_kzalloc(dev, sizeof(*p), GFP_KERNEL);
392	if (!p)
393		return -ENOMEM;
 
 
 
394
395	/* deal with driver instance configuration */
396	of_property_read_u32(dev->of_node, "sense-bitfield-width",
397			     &p->sense_bitfield_width);
398	control_parent = of_property_read_bool(dev->of_node, "control-parent");
399	if (!p->sense_bitfield_width)
400		p->sense_bitfield_width = 4; /* default to 4 bits */
 
 
 
 
 
401
402	p->pdev = pdev;
403	platform_set_drvdata(pdev, p);
404
405	config = of_device_get_match_data(dev);
406
407	pm_runtime_enable(dev);
408	pm_runtime_get_sync(dev);
409
410	/* get hold of register banks */
411	memset(io, 0, sizeof(io));
412	for (k = 0; k < INTC_IRQPIN_REG_NR; k++) {
413		io[k] = platform_get_resource(pdev, IORESOURCE_MEM, k);
414		if (!io[k] && k < INTC_IRQPIN_REG_NR_MANDATORY) {
415			dev_err(dev, "not enough IOMEM resources\n");
416			ret = -EINVAL;
417			goto err0;
418		}
419	}
420
421	/* allow any number of IRQs between 1 and INTC_IRQPIN_MAX */
422	for (k = 0; k < INTC_IRQPIN_MAX; k++) {
423		irq = platform_get_resource(pdev, IORESOURCE_IRQ, k);
424		if (!irq)
425			break;
426
427		p->irq[k].p = p;
428		p->irq[k].requested_irq = irq->start;
429	}
430
431	nirqs = k;
432	if (nirqs < 1) {
433		dev_err(dev, "not enough IRQ resources\n");
434		ret = -EINVAL;
435		goto err0;
436	}
437
438	/* ioremap IOMEM and setup read/write callbacks */
439	for (k = 0; k < INTC_IRQPIN_REG_NR; k++) {
440		i = &p->iomem[k];
441
442		/* handle optional registers */
443		if (!io[k])
444			continue;
445
446		switch (resource_size(io[k])) {
447		case 1:
448			i->width = 8;
449			i->read = intc_irqpin_read8;
450			i->write = intc_irqpin_write8;
451			break;
452		case 4:
453			i->width = 32;
454			i->read = intc_irqpin_read32;
455			i->write = intc_irqpin_write32;
456			break;
457		default:
458			dev_err(dev, "IOMEM size mismatch\n");
459			ret = -EINVAL;
460			goto err0;
461		}
462
463		i->iomem = devm_ioremap(dev, io[k]->start,
464					resource_size(io[k]));
465		if (!i->iomem) {
466			dev_err(dev, "failed to remap IOMEM\n");
467			ret = -ENXIO;
468			goto err0;
469		}
470	}
471
472	/* configure "individual IRQ mode" where needed */
473	if (config && config->needs_irlm) {
474		if (io[INTC_IRQPIN_REG_IRLM])
475			intc_irqpin_read_modify_write(p, INTC_IRQPIN_REG_IRLM,
476						      config->irlm_bit, 1, 1);
477		else
478			dev_warn(dev, "unable to select IRLM mode\n");
479	}
480
481	/* mask all interrupts using priority */
482	for (k = 0; k < nirqs; k++)
483		intc_irqpin_mask_unmask_prio(p, k, 1);
484
485	/* clear all pending interrupts */
486	intc_irqpin_write(p, INTC_IRQPIN_REG_SOURCE, 0x0);
487
488	/* scan for shared interrupt lines */
489	ref_irq = p->irq[0].requested_irq;
490	p->shared_irqs = 1;
491	for (k = 1; k < nirqs; k++) {
492		if (ref_irq != p->irq[k].requested_irq) {
493			p->shared_irqs = 0;
494			break;
495		}
496	}
497
498	/* use more severe masking method if requested */
499	if (control_parent) {
500		enable_fn = intc_irqpin_irq_enable_force;
501		disable_fn = intc_irqpin_irq_disable_force;
502	} else if (!p->shared_irqs) {
503		enable_fn = intc_irqpin_irq_enable;
504		disable_fn = intc_irqpin_irq_disable;
505	} else {
506		enable_fn = intc_irqpin_shared_irq_enable;
507		disable_fn = intc_irqpin_shared_irq_disable;
508	}
509
510	irq_chip = &p->irq_chip;
511	irq_chip->name = "intc-irqpin";
512	irq_chip->parent_device = dev;
513	irq_chip->irq_mask = disable_fn;
514	irq_chip->irq_unmask = enable_fn;
 
 
515	irq_chip->irq_set_type = intc_irqpin_irq_set_type;
516	irq_chip->irq_set_wake = intc_irqpin_irq_set_wake;
517	irq_chip->flags	= IRQCHIP_MASK_ON_SUSPEND;
518
519	p->irq_domain = irq_domain_add_simple(dev->of_node, nirqs, 0,
 
 
520					      &intc_irqpin_irq_domain_ops, p);
521	if (!p->irq_domain) {
522		ret = -ENXIO;
523		dev_err(dev, "cannot initialize irq domain\n");
524		goto err0;
525	}
526
527	if (p->shared_irqs) {
528		/* request one shared interrupt */
529		if (devm_request_irq(dev, p->irq[0].requested_irq,
530				intc_irqpin_shared_irq_handler,
531				IRQF_SHARED, name, p)) {
532			dev_err(dev, "failed to request low IRQ\n");
533			ret = -ENOENT;
534			goto err1;
535		}
536	} else {
537		/* request interrupts one by one */
538		for (k = 0; k < nirqs; k++) {
539			if (devm_request_irq(dev, p->irq[k].requested_irq,
540					     intc_irqpin_irq_handler, 0, name,
541					     &p->irq[k])) {
542				dev_err(dev, "failed to request low IRQ\n");
 
 
543				ret = -ENOENT;
544				goto err1;
545			}
546		}
547	}
548
549	/* unmask all interrupts on prio level */
550	for (k = 0; k < nirqs; k++)
551		intc_irqpin_mask_unmask_prio(p, k, 0);
552
553	dev_info(dev, "driving %d irqs\n", nirqs);
 
 
 
 
 
 
 
554
555	return 0;
556
557err1:
558	irq_domain_remove(p->irq_domain);
559err0:
560	pm_runtime_put(dev);
561	pm_runtime_disable(dev);
562	return ret;
563}
564
565static int intc_irqpin_remove(struct platform_device *pdev)
566{
567	struct intc_irqpin_priv *p = platform_get_drvdata(pdev);
568
569	irq_domain_remove(p->irq_domain);
570	pm_runtime_put(&pdev->dev);
571	pm_runtime_disable(&pdev->dev);
572	return 0;
573}
574
575static int __maybe_unused intc_irqpin_suspend(struct device *dev)
576{
577	struct intc_irqpin_priv *p = dev_get_drvdata(dev);
578
579	if (atomic_read(&p->wakeup_path))
580		device_set_wakeup_path(dev);
581
582	return 0;
583}
584
585static SIMPLE_DEV_PM_OPS(intc_irqpin_pm_ops, intc_irqpin_suspend, NULL);
 
 
 
 
586
587static struct platform_driver intc_irqpin_device_driver = {
588	.probe		= intc_irqpin_probe,
589	.remove		= intc_irqpin_remove,
590	.driver		= {
591		.name	= "renesas_intc_irqpin",
592		.of_match_table = intc_irqpin_dt_ids,
593		.pm	= &intc_irqpin_pm_ops,
594	}
595};
596
597static int __init intc_irqpin_init(void)
598{
599	return platform_driver_register(&intc_irqpin_device_driver);
600}
601postcore_initcall(intc_irqpin_init);
602
603static void __exit intc_irqpin_exit(void)
604{
605	platform_driver_unregister(&intc_irqpin_device_driver);
606}
607module_exit(intc_irqpin_exit);
608
609MODULE_AUTHOR("Magnus Damm");
610MODULE_DESCRIPTION("Renesas INTC External IRQ Pin Driver");
611MODULE_LICENSE("GPL v2");
v3.15
 
  1/*
  2 * Renesas INTC External IRQ Pin Driver
  3 *
  4 *  Copyright (C) 2013 Magnus Damm
  5 *
  6 * This program is free software; you can redistribute it and/or modify
  7 * it under the terms of the GNU General Public License as published by
  8 * the Free Software Foundation; either version 2 of the License
  9 *
 10 * This program is distributed in the hope that it will be useful,
 11 * but WITHOUT ANY WARRANTY; without even the implied warranty of
 12 * MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE.  See the
 13 * GNU General Public License for more details.
 14 *
 15 * You should have received a copy of the GNU General Public License
 16 * along with this program; if not, write to the Free Software
 17 * Foundation, Inc., 59 Temple Place, Suite 330, Boston, MA  02111-1307  USA
 18 */
 19
 20#include <linux/init.h>
 21#include <linux/of.h>
 22#include <linux/platform_device.h>
 23#include <linux/spinlock.h>
 24#include <linux/interrupt.h>
 25#include <linux/ioport.h>
 26#include <linux/io.h>
 27#include <linux/irq.h>
 28#include <linux/irqdomain.h>
 29#include <linux/err.h>
 30#include <linux/slab.h>
 31#include <linux/module.h>
 32#include <linux/platform_data/irq-renesas-intc-irqpin.h>
 
 33
 34#define INTC_IRQPIN_MAX 8 /* maximum 8 interrupts per driver instance */
 35
 36#define INTC_IRQPIN_REG_SENSE 0 /* ICRn */
 37#define INTC_IRQPIN_REG_PRIO 1 /* INTPRInn */
 38#define INTC_IRQPIN_REG_SOURCE 2 /* INTREQnn */
 39#define INTC_IRQPIN_REG_MASK 3 /* INTMSKnn */
 40#define INTC_IRQPIN_REG_CLEAR 4 /* INTMSKCLRnn */
 41#define INTC_IRQPIN_REG_NR 5
 
 
 42
 43/* INTC external IRQ PIN hardware register access:
 44 *
 45 * SENSE is read-write 32-bit with 2-bits or 4-bits per IRQ (*)
 46 * PRIO is read-write 32-bit with 4-bits per IRQ (**)
 47 * SOURCE is read-only 32-bit or 8-bit with 1-bit per IRQ (***)
 48 * MASK is write-only 32-bit or 8-bit with 1-bit per IRQ (***)
 49 * CLEAR is write-only 32-bit or 8-bit with 1-bit per IRQ (***)
 50 *
 51 * (*) May be accessed by more than one driver instance - lock needed
 52 * (**) Read-modify-write access by one driver instance - lock needed
 53 * (***) Accessed by one driver instance only - no locking needed
 54 */
 55
 56struct intc_irqpin_iomem {
 57	void __iomem *iomem;
 58	unsigned long (*read)(void __iomem *iomem);
 59	void (*write)(void __iomem *iomem, unsigned long data);
 60	int width;
 61};
 62
 63struct intc_irqpin_irq {
 64	int hw_irq;
 65	int requested_irq;
 66	int domain_irq;
 67	struct intc_irqpin_priv *p;
 68};
 69
 70struct intc_irqpin_priv {
 71	struct intc_irqpin_iomem iomem[INTC_IRQPIN_REG_NR];
 72	struct intc_irqpin_irq irq[INTC_IRQPIN_MAX];
 73	struct renesas_intc_irqpin_config config;
 74	unsigned int number_of_irqs;
 75	struct platform_device *pdev;
 76	struct irq_chip irq_chip;
 77	struct irq_domain *irq_domain;
 78	bool shared_irqs;
 
 79	u8 shared_irq_mask;
 80};
 81
 
 
 
 
 
 82static unsigned long intc_irqpin_read32(void __iomem *iomem)
 83{
 84	return ioread32(iomem);
 85}
 86
 87static unsigned long intc_irqpin_read8(void __iomem *iomem)
 88{
 89	return ioread8(iomem);
 90}
 91
 92static void intc_irqpin_write32(void __iomem *iomem, unsigned long data)
 93{
 94	iowrite32(data, iomem);
 95}
 96
 97static void intc_irqpin_write8(void __iomem *iomem, unsigned long data)
 98{
 99	iowrite8(data, iomem);
100}
101
102static inline unsigned long intc_irqpin_read(struct intc_irqpin_priv *p,
103					     int reg)
104{
105	struct intc_irqpin_iomem *i = &p->iomem[reg];
106
107	return i->read(i->iomem);
108}
109
110static inline void intc_irqpin_write(struct intc_irqpin_priv *p,
111				     int reg, unsigned long data)
112{
113	struct intc_irqpin_iomem *i = &p->iomem[reg];
114
115	i->write(i->iomem, data);
116}
117
118static inline unsigned long intc_irqpin_hwirq_mask(struct intc_irqpin_priv *p,
119						   int reg, int hw_irq)
120{
121	return BIT((p->iomem[reg].width - 1) - hw_irq);
122}
123
124static inline void intc_irqpin_irq_write_hwirq(struct intc_irqpin_priv *p,
125					       int reg, int hw_irq)
126{
127	intc_irqpin_write(p, reg, intc_irqpin_hwirq_mask(p, reg, hw_irq));
128}
129
130static DEFINE_RAW_SPINLOCK(intc_irqpin_lock); /* only used by slow path */
131
132static void intc_irqpin_read_modify_write(struct intc_irqpin_priv *p,
133					  int reg, int shift,
134					  int width, int value)
135{
136	unsigned long flags;
137	unsigned long tmp;
138
139	raw_spin_lock_irqsave(&intc_irqpin_lock, flags);
140
141	tmp = intc_irqpin_read(p, reg);
142	tmp &= ~(((1 << width) - 1) << shift);
143	tmp |= value << shift;
144	intc_irqpin_write(p, reg, tmp);
145
146	raw_spin_unlock_irqrestore(&intc_irqpin_lock, flags);
147}
148
149static void intc_irqpin_mask_unmask_prio(struct intc_irqpin_priv *p,
150					 int irq, int do_mask)
151{
152	/* The PRIO register is assumed to be 32-bit with fixed 4-bit fields. */
153	int bitfield_width = 4;
154	int shift = 32 - (irq + 1) * bitfield_width;
155
156	intc_irqpin_read_modify_write(p, INTC_IRQPIN_REG_PRIO,
157				      shift, bitfield_width,
158				      do_mask ? 0 : (1 << bitfield_width) - 1);
159}
160
161static int intc_irqpin_set_sense(struct intc_irqpin_priv *p, int irq, int value)
162{
163	/* The SENSE register is assumed to be 32-bit. */
164	int bitfield_width = p->config.sense_bitfield_width;
165	int shift = 32 - (irq + 1) * bitfield_width;
166
167	dev_dbg(&p->pdev->dev, "sense irq = %d, mode = %d\n", irq, value);
168
169	if (value >= (1 << bitfield_width))
170		return -EINVAL;
171
172	intc_irqpin_read_modify_write(p, INTC_IRQPIN_REG_SENSE, shift,
173				      bitfield_width, value);
174	return 0;
175}
176
177static void intc_irqpin_dbg(struct intc_irqpin_irq *i, char *str)
178{
179	dev_dbg(&i->p->pdev->dev, "%s (%d:%d:%d)\n",
180		str, i->requested_irq, i->hw_irq, i->domain_irq);
181}
182
183static void intc_irqpin_irq_enable(struct irq_data *d)
184{
185	struct intc_irqpin_priv *p = irq_data_get_irq_chip_data(d);
186	int hw_irq = irqd_to_hwirq(d);
187
188	intc_irqpin_dbg(&p->irq[hw_irq], "enable");
189	intc_irqpin_irq_write_hwirq(p, INTC_IRQPIN_REG_CLEAR, hw_irq);
190}
191
192static void intc_irqpin_irq_disable(struct irq_data *d)
193{
194	struct intc_irqpin_priv *p = irq_data_get_irq_chip_data(d);
195	int hw_irq = irqd_to_hwirq(d);
196
197	intc_irqpin_dbg(&p->irq[hw_irq], "disable");
198	intc_irqpin_irq_write_hwirq(p, INTC_IRQPIN_REG_MASK, hw_irq);
199}
200
201static void intc_irqpin_shared_irq_enable(struct irq_data *d)
202{
203	struct intc_irqpin_priv *p = irq_data_get_irq_chip_data(d);
204	int hw_irq = irqd_to_hwirq(d);
205
206	intc_irqpin_dbg(&p->irq[hw_irq], "shared enable");
207	intc_irqpin_irq_write_hwirq(p, INTC_IRQPIN_REG_CLEAR, hw_irq);
208
209	p->shared_irq_mask &= ~BIT(hw_irq);
210}
211
212static void intc_irqpin_shared_irq_disable(struct irq_data *d)
213{
214	struct intc_irqpin_priv *p = irq_data_get_irq_chip_data(d);
215	int hw_irq = irqd_to_hwirq(d);
216
217	intc_irqpin_dbg(&p->irq[hw_irq], "shared disable");
218	intc_irqpin_irq_write_hwirq(p, INTC_IRQPIN_REG_MASK, hw_irq);
219
220	p->shared_irq_mask |= BIT(hw_irq);
221}
222
223static void intc_irqpin_irq_enable_force(struct irq_data *d)
224{
225	struct intc_irqpin_priv *p = irq_data_get_irq_chip_data(d);
226	int irq = p->irq[irqd_to_hwirq(d)].requested_irq;
227
228	intc_irqpin_irq_enable(d);
229
230	/* enable interrupt through parent interrupt controller,
231	 * assumes non-shared interrupt with 1:1 mapping
232	 * needed for busted IRQs on some SoCs like sh73a0
233	 */
234	irq_get_chip(irq)->irq_unmask(irq_get_irq_data(irq));
235}
236
237static void intc_irqpin_irq_disable_force(struct irq_data *d)
238{
239	struct intc_irqpin_priv *p = irq_data_get_irq_chip_data(d);
240	int irq = p->irq[irqd_to_hwirq(d)].requested_irq;
241
242	/* disable interrupt through parent interrupt controller,
243	 * assumes non-shared interrupt with 1:1 mapping
244	 * needed for busted IRQs on some SoCs like sh73a0
245	 */
246	irq_get_chip(irq)->irq_mask(irq_get_irq_data(irq));
247	intc_irqpin_irq_disable(d);
248}
249
250#define INTC_IRQ_SENSE_VALID 0x10
251#define INTC_IRQ_SENSE(x) (x + INTC_IRQ_SENSE_VALID)
252
253static unsigned char intc_irqpin_sense[IRQ_TYPE_SENSE_MASK + 1] = {
254	[IRQ_TYPE_EDGE_FALLING] = INTC_IRQ_SENSE(0x00),
255	[IRQ_TYPE_EDGE_RISING] = INTC_IRQ_SENSE(0x01),
256	[IRQ_TYPE_LEVEL_LOW] = INTC_IRQ_SENSE(0x02),
257	[IRQ_TYPE_LEVEL_HIGH] = INTC_IRQ_SENSE(0x03),
258	[IRQ_TYPE_EDGE_BOTH] = INTC_IRQ_SENSE(0x04),
259};
260
261static int intc_irqpin_irq_set_type(struct irq_data *d, unsigned int type)
262{
263	unsigned char value = intc_irqpin_sense[type & IRQ_TYPE_SENSE_MASK];
264	struct intc_irqpin_priv *p = irq_data_get_irq_chip_data(d);
265
266	if (!(value & INTC_IRQ_SENSE_VALID))
267		return -EINVAL;
268
269	return intc_irqpin_set_sense(p, irqd_to_hwirq(d),
270				     value ^ INTC_IRQ_SENSE_VALID);
271}
272
 
 
 
 
 
 
 
 
 
 
 
 
 
 
273static irqreturn_t intc_irqpin_irq_handler(int irq, void *dev_id)
274{
275	struct intc_irqpin_irq *i = dev_id;
276	struct intc_irqpin_priv *p = i->p;
277	unsigned long bit;
278
279	intc_irqpin_dbg(i, "demux1");
280	bit = intc_irqpin_hwirq_mask(p, INTC_IRQPIN_REG_SOURCE, i->hw_irq);
281
282	if (intc_irqpin_read(p, INTC_IRQPIN_REG_SOURCE) & bit) {
283		intc_irqpin_write(p, INTC_IRQPIN_REG_SOURCE, ~bit);
284		intc_irqpin_dbg(i, "demux2");
285		generic_handle_irq(i->domain_irq);
286		return IRQ_HANDLED;
287	}
288	return IRQ_NONE;
289}
290
291static irqreturn_t intc_irqpin_shared_irq_handler(int irq, void *dev_id)
292{
293	struct intc_irqpin_priv *p = dev_id;
294	unsigned int reg_source = intc_irqpin_read(p, INTC_IRQPIN_REG_SOURCE);
295	irqreturn_t status = IRQ_NONE;
296	int k;
297
298	for (k = 0; k < 8; k++) {
299		if (reg_source & BIT(7 - k)) {
300			if (BIT(k) & p->shared_irq_mask)
301				continue;
302
303			status |= intc_irqpin_irq_handler(irq, &p->irq[k]);
304		}
305	}
306
307	return status;
308}
309
 
 
 
 
 
 
 
 
 
310static int intc_irqpin_irq_domain_map(struct irq_domain *h, unsigned int virq,
311				      irq_hw_number_t hw)
312{
313	struct intc_irqpin_priv *p = h->host_data;
314
315	p->irq[hw].domain_irq = virq;
316	p->irq[hw].hw_irq = hw;
317
318	intc_irqpin_dbg(&p->irq[hw], "map");
319	irq_set_chip_data(virq, h->host_data);
 
 
320	irq_set_chip_and_handler(virq, &p->irq_chip, handle_level_irq);
321	set_irq_flags(virq, IRQF_VALID); /* kill me now */
322	return 0;
323}
324
325static struct irq_domain_ops intc_irqpin_irq_domain_ops = {
326	.map	= intc_irqpin_irq_domain_map,
327	.xlate  = irq_domain_xlate_twocell,
328};
329
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
330static int intc_irqpin_probe(struct platform_device *pdev)
331{
332	struct renesas_intc_irqpin_config *pdata = pdev->dev.platform_data;
 
333	struct intc_irqpin_priv *p;
334	struct intc_irqpin_iomem *i;
335	struct resource *io[INTC_IRQPIN_REG_NR];
336	struct resource *irq;
337	struct irq_chip *irq_chip;
338	void (*enable_fn)(struct irq_data *d);
339	void (*disable_fn)(struct irq_data *d);
340	const char *name = dev_name(&pdev->dev);
 
 
341	int ref_irq;
342	int ret;
343	int k;
344
345	p = devm_kzalloc(&pdev->dev, sizeof(*p), GFP_KERNEL);
346	if (!p) {
347		dev_err(&pdev->dev, "failed to allocate driver data\n");
348		ret = -ENOMEM;
349		goto err0;
350	}
351
352	/* deal with driver instance configuration */
353	if (pdata) {
354		memcpy(&p->config, pdata, sizeof(*pdata));
355	} else {
356		of_property_read_u32(pdev->dev.of_node, "sense-bitfield-width",
357				     &p->config.sense_bitfield_width);
358		p->config.control_parent = of_property_read_bool(pdev->dev.of_node,
359								 "control-parent");
360	}
361	if (!p->config.sense_bitfield_width)
362		p->config.sense_bitfield_width = 4; /* default to 4 bits */
363
364	p->pdev = pdev;
365	platform_set_drvdata(pdev, p);
366
367	/* get hold of manadatory IOMEM */
 
 
 
 
 
 
368	for (k = 0; k < INTC_IRQPIN_REG_NR; k++) {
369		io[k] = platform_get_resource(pdev, IORESOURCE_MEM, k);
370		if (!io[k]) {
371			dev_err(&pdev->dev, "not enough IOMEM resources\n");
372			ret = -EINVAL;
373			goto err0;
374		}
375	}
376
377	/* allow any number of IRQs between 1 and INTC_IRQPIN_MAX */
378	for (k = 0; k < INTC_IRQPIN_MAX; k++) {
379		irq = platform_get_resource(pdev, IORESOURCE_IRQ, k);
380		if (!irq)
381			break;
382
383		p->irq[k].p = p;
384		p->irq[k].requested_irq = irq->start;
385	}
386
387	p->number_of_irqs = k;
388	if (p->number_of_irqs < 1) {
389		dev_err(&pdev->dev, "not enough IRQ resources\n");
390		ret = -EINVAL;
391		goto err0;
392	}
393
394	/* ioremap IOMEM and setup read/write callbacks */
395	for (k = 0; k < INTC_IRQPIN_REG_NR; k++) {
396		i = &p->iomem[k];
397
 
 
 
 
398		switch (resource_size(io[k])) {
399		case 1:
400			i->width = 8;
401			i->read = intc_irqpin_read8;
402			i->write = intc_irqpin_write8;
403			break;
404		case 4:
405			i->width = 32;
406			i->read = intc_irqpin_read32;
407			i->write = intc_irqpin_write32;
408			break;
409		default:
410			dev_err(&pdev->dev, "IOMEM size mismatch\n");
411			ret = -EINVAL;
412			goto err0;
413		}
414
415		i->iomem = devm_ioremap_nocache(&pdev->dev, io[k]->start,
416						resource_size(io[k]));
417		if (!i->iomem) {
418			dev_err(&pdev->dev, "failed to remap IOMEM\n");
419			ret = -ENXIO;
420			goto err0;
421		}
422	}
423
 
 
 
 
 
 
 
 
 
424	/* mask all interrupts using priority */
425	for (k = 0; k < p->number_of_irqs; k++)
426		intc_irqpin_mask_unmask_prio(p, k, 1);
427
428	/* clear all pending interrupts */
429	intc_irqpin_write(p, INTC_IRQPIN_REG_SOURCE, 0x0);
430
431	/* scan for shared interrupt lines */
432	ref_irq = p->irq[0].requested_irq;
433	p->shared_irqs = true;
434	for (k = 1; k < p->number_of_irqs; k++) {
435		if (ref_irq != p->irq[k].requested_irq) {
436			p->shared_irqs = false;
437			break;
438		}
439	}
440
441	/* use more severe masking method if requested */
442	if (p->config.control_parent) {
443		enable_fn = intc_irqpin_irq_enable_force;
444		disable_fn = intc_irqpin_irq_disable_force;
445	} else if (!p->shared_irqs) {
446		enable_fn = intc_irqpin_irq_enable;
447		disable_fn = intc_irqpin_irq_disable;
448	} else {
449		enable_fn = intc_irqpin_shared_irq_enable;
450		disable_fn = intc_irqpin_shared_irq_disable;
451	}
452
453	irq_chip = &p->irq_chip;
454	irq_chip->name = name;
 
455	irq_chip->irq_mask = disable_fn;
456	irq_chip->irq_unmask = enable_fn;
457	irq_chip->irq_enable = enable_fn;
458	irq_chip->irq_disable = disable_fn;
459	irq_chip->irq_set_type = intc_irqpin_irq_set_type;
460	irq_chip->flags	= IRQCHIP_SKIP_SET_WAKE;
 
461
462	p->irq_domain = irq_domain_add_simple(pdev->dev.of_node,
463					      p->number_of_irqs,
464					      p->config.irq_base,
465					      &intc_irqpin_irq_domain_ops, p);
466	if (!p->irq_domain) {
467		ret = -ENXIO;
468		dev_err(&pdev->dev, "cannot initialize irq domain\n");
469		goto err0;
470	}
471
472	if (p->shared_irqs) {
473		/* request one shared interrupt */
474		if (devm_request_irq(&pdev->dev, p->irq[0].requested_irq,
475				intc_irqpin_shared_irq_handler,
476				IRQF_SHARED, name, p)) {
477			dev_err(&pdev->dev, "failed to request low IRQ\n");
478			ret = -ENOENT;
479			goto err1;
480		}
481	} else {
482		/* request interrupts one by one */
483		for (k = 0; k < p->number_of_irqs; k++) {
484			if (devm_request_irq(&pdev->dev,
485					p->irq[k].requested_irq,
486					intc_irqpin_irq_handler,
487					0, name, &p->irq[k])) {
488				dev_err(&pdev->dev,
489					"failed to request low IRQ\n");
490				ret = -ENOENT;
491				goto err1;
492			}
493		}
494	}
495
496	/* unmask all interrupts on prio level */
497	for (k = 0; k < p->number_of_irqs; k++)
498		intc_irqpin_mask_unmask_prio(p, k, 0);
499
500	dev_info(&pdev->dev, "driving %d irqs\n", p->number_of_irqs);
501
502	/* warn in case of mismatch if irq base is specified */
503	if (p->config.irq_base) {
504		if (p->config.irq_base != p->irq[0].domain_irq)
505			dev_warn(&pdev->dev, "irq base mismatch (%d/%d)\n",
506				 p->config.irq_base, p->irq[0].domain_irq);
507	}
508
509	return 0;
510
511err1:
512	irq_domain_remove(p->irq_domain);
513err0:
 
 
514	return ret;
515}
516
517static int intc_irqpin_remove(struct platform_device *pdev)
518{
519	struct intc_irqpin_priv *p = platform_get_drvdata(pdev);
520
521	irq_domain_remove(p->irq_domain);
 
 
 
 
 
 
 
 
 
 
 
522
523	return 0;
524}
525
526static const struct of_device_id intc_irqpin_dt_ids[] = {
527	{ .compatible = "renesas,intc-irqpin", },
528	{},
529};
530MODULE_DEVICE_TABLE(of, intc_irqpin_dt_ids);
531
532static struct platform_driver intc_irqpin_device_driver = {
533	.probe		= intc_irqpin_probe,
534	.remove		= intc_irqpin_remove,
535	.driver		= {
536		.name	= "renesas_intc_irqpin",
537		.of_match_table = intc_irqpin_dt_ids,
538		.owner  = THIS_MODULE,
539	}
540};
541
542static int __init intc_irqpin_init(void)
543{
544	return platform_driver_register(&intc_irqpin_device_driver);
545}
546postcore_initcall(intc_irqpin_init);
547
548static void __exit intc_irqpin_exit(void)
549{
550	platform_driver_unregister(&intc_irqpin_device_driver);
551}
552module_exit(intc_irqpin_exit);
553
554MODULE_AUTHOR("Magnus Damm");
555MODULE_DESCRIPTION("Renesas INTC External IRQ Pin Driver");
556MODULE_LICENSE("GPL v2");