Release 4.14 drivers/irqchip/irq-atmel-aic5.c

/*
 * Atmel AT91 AIC5 (Advanced Interrupt Controller) driver
 *
 *  Copyright (C) 2004 SAN People
 *  Copyright (C) 2004 ATMEL
 *  Copyright (C) Rick Bronson
 *  Copyright (C) 2014 Free Electrons
 *
 *  Author: Boris BREZILLON <boris.brezillon@free-electrons.com>
 *
 * This file is licensed under the terms of the GNU General Public
 * License version 2.  This program is licensed "as is" without any
 * warranty of any kind, whether express or implied.
 */

#include <linux/init.h>
#include <linux/module.h>
#include <linux/mm.h>
#include <linux/bitmap.h>
#include <linux/types.h>
#include <linux/irq.h>
#include <linux/irqchip.h>
#include <linux/of.h>
#include <linux/of_address.h>
#include <linux/of_irq.h>
#include <linux/irqdomain.h>
#include <linux/err.h>
#include <linux/slab.h>
#include <linux/io.h>

#include <asm/exception.h>
#include <asm/mach/irq.h>

#include "irq-atmel-aic-common.h"

/* Number of irq lines managed by AIC */

#define NR_AIC5_IRQS	128


#define AT91_AIC5_SSR		0x0

#define AT91_AIC5_INTSEL_MSK	(0x7f << 0)


#define AT91_AIC5_SMR			0x4


#define AT91_AIC5_SVR			0x8

#define AT91_AIC5_IVR			0x10

#define AT91_AIC5_FVR			0x14

#define AT91_AIC5_ISR			0x18


#define AT91_AIC5_IPR0			0x20

#define AT91_AIC5_IPR1			0x24

#define AT91_AIC5_IPR2			0x28

#define AT91_AIC5_IPR3			0x2c

#define AT91_AIC5_IMR			0x30

#define AT91_AIC5_CISR			0x34


#define AT91_AIC5_IECR			0x40

#define AT91_AIC5_IDCR			0x44

#define AT91_AIC5_ICCR			0x48

#define AT91_AIC5_ISCR			0x4c

#define AT91_AIC5_EOICR			0x38

#define AT91_AIC5_SPU			0x3c

#define AT91_AIC5_DCR			0x6c


#define AT91_AIC5_FFER			0x50

#define AT91_AIC5_FFDR			0x54

#define AT91_AIC5_FFSR			0x58


static struct irq_domain *aic5_domain;


static asmlinkage void __exception_irq_entry

aic5_handle(struct pt_regs *regs)
{
	struct irq_chip_generic *bgc = irq_get_domain_generic_chip(aic5_domain, 0);
	u32 irqnr;
	u32 irqstat;

	irqnr = irq_reg_readl(bgc, AT91_AIC5_IVR);
	irqstat = irq_reg_readl(bgc, AT91_AIC5_ISR);

	if (!irqstat)
		irq_reg_writel(bgc, 0, AT91_AIC5_EOICR);
	else
		handle_domain_irq(aic5_domain, irqnr, regs);
}

Contributors
Person
Tokens
Prop
Commits
CommitProp
Boris Brezillon
58
79.45%
1
20.00%
Ludovic Desroches
9
12.33%
2
40.00%
Kevin Cernekee
3
4.11%
1
20.00%
Marc Zyngier
3
4.11%
1
20.00%
Total
73
100.00%
5
100.00%



static void aic5_mask(struct irq_data *d)
{
	struct irq_domain *domain = d->domain;
	struct irq_chip_generic *bgc = irq_get_domain_generic_chip(domain, 0);
	struct irq_chip_generic *gc = irq_data_get_irq_chip_data(d);

	/*
         * Disable interrupt on AIC5. We always take the lock of the
         * first irq chip as all chips share the same registers.
         */
	irq_gc_lock(bgc);
	irq_reg_writel(gc, d->hwirq, AT91_AIC5_SSR);
	irq_reg_writel(gc, 1, AT91_AIC5_IDCR);
	gc->mask_cache &= ~d->mask;
	irq_gc_unlock(bgc);
}

Contributors
Person
Tokens
Prop
Commits
CommitProp
Boris Brezillon
59
71.95%
1
25.00%
Ludovic Desroches
19
23.17%
2
50.00%
Kevin Cernekee
4
4.88%
1
25.00%
Total
82
100.00%
4
100.00%



static void aic5_unmask(struct irq_data *d)
{
	struct irq_domain *domain = d->domain;
	struct irq_chip_generic *bgc = irq_get_domain_generic_chip(domain, 0);
	struct irq_chip_generic *gc = irq_data_get_irq_chip_data(d);

	/*
         * Enable interrupt on AIC5. We always take the lock of the
         * first irq chip as all chips share the same registers.
         */
	irq_gc_lock(bgc);
	irq_reg_writel(gc, d->hwirq, AT91_AIC5_SSR);
	irq_reg_writel(gc, 1, AT91_AIC5_IECR);
	gc->mask_cache |= d->mask;
	irq_gc_unlock(bgc);
}

Contributors
Person
Tokens
Prop
Commits
CommitProp
Boris Brezillon
58
71.60%
1
25.00%
Ludovic Desroches
19
23.46%
2
50.00%
Kevin Cernekee
4
4.94%
1
25.00%
Total
81
100.00%
4
100.00%



static int aic5_retrigger(struct irq_data *d)
{
	struct irq_domain *domain = d->domain;
	struct irq_chip_generic *bgc = irq_get_domain_generic_chip(domain, 0);

	/* Enable interrupt on AIC5 */
	irq_gc_lock(bgc);
	irq_reg_writel(bgc, d->hwirq, AT91_AIC5_SSR);
	irq_reg_writel(bgc, 1, AT91_AIC5_ISCR);
	irq_gc_unlock(bgc);

	return 0;
}

Contributors
Person
Tokens
Prop
Commits
CommitProp
Boris Brezillon
54
81.82%
1
25.00%
Ludovic Desroches
10
15.15%
2
50.00%
Kevin Cernekee
2
3.03%
1
25.00%
Total
66
100.00%
4
100.00%



static int aic5_set_type(struct irq_data *d, unsigned type)
{
	struct irq_domain *domain = d->domain;
	struct irq_chip_generic *bgc = irq_get_domain_generic_chip(domain, 0);
	unsigned int smr;
	int ret;

	irq_gc_lock(bgc);
	irq_reg_writel(bgc, d->hwirq, AT91_AIC5_SSR);
	smr = irq_reg_readl(bgc, AT91_AIC5_SMR);
	ret = aic_common_set_type(d, type, &smr);
	if (!ret)
		irq_reg_writel(bgc, smr, AT91_AIC5_SMR);
	irq_gc_unlock(bgc);

	return ret;
}

Contributors
Person
Tokens
Prop
Commits
CommitProp
Boris Brezillon
87
86.14%
1
25.00%
Ludovic Desroches
11
10.89%
2
50.00%
Kevin Cernekee
3
2.97%
1
25.00%
Total
101
100.00%
4
100.00%

#ifdef CONFIG_PM

static u32 *smr_cache;



static void aic5_suspend(struct irq_data *d)
{
	struct irq_domain *domain = d->domain;
	struct irq_domain_chip_generic *dgc = domain->gc;
	struct irq_chip_generic *bgc = irq_get_domain_generic_chip(domain, 0);
	struct irq_chip_generic *gc = irq_data_get_irq_chip_data(d);
	int i;
	u32 mask;

	if (smr_cache)
		for (i = 0; i < domain->revmap_size; i++) {
			irq_reg_writel(bgc, i, AT91_AIC5_SSR);
			smr_cache[i] = irq_reg_readl(bgc, AT91_AIC5_SMR);
		}

	irq_gc_lock(bgc);
	for (i = 0; i < dgc->irqs_per_chip; i++) {
		mask = 1 << i;
		if ((mask & gc->mask_cache) == (mask & gc->wake_active))
			continue;

		irq_reg_writel(bgc, i + gc->irq_base, AT91_AIC5_SSR);
		if (mask & gc->wake_active)
			irq_reg_writel(bgc, 1, AT91_AIC5_IECR);
		else
			irq_reg_writel(bgc, 1, AT91_AIC5_IDCR);
	}
	irq_gc_unlock(bgc);
}

Contributors
Person
Tokens
Prop
Commits
CommitProp
Boris Brezillon
138
72.25%
1
25.00%
Alexandre Belloni
42
21.99%
1
25.00%
Kevin Cernekee
6
3.14%
1
25.00%
Ludovic Desroches
5
2.62%
1
25.00%
Total
191
100.00%
4
100.00%



static void aic5_resume(struct irq_data *d)
{
	struct irq_domain *domain = d->domain;
	struct irq_domain_chip_generic *dgc = domain->gc;
	struct irq_chip_generic *bgc = irq_get_domain_generic_chip(domain, 0);
	struct irq_chip_generic *gc = irq_data_get_irq_chip_data(d);
	int i;
	u32 mask;

	irq_gc_lock(bgc);

	if (smr_cache) {
		irq_reg_writel(bgc, 0xffffffff, AT91_AIC5_SPU);
		for (i = 0; i < domain->revmap_size; i++) {
			irq_reg_writel(bgc, i, AT91_AIC5_SSR);
			irq_reg_writel(bgc, i, AT91_AIC5_SVR);
			irq_reg_writel(bgc, smr_cache[i], AT91_AIC5_SMR);
		}
	}

	for (i = 0; i < dgc->irqs_per_chip; i++) {
		mask = 1 << i;

		if (!smr_cache &&
		    ((mask & gc->mask_cache) == (mask & gc->wake_active)))
			continue;

		irq_reg_writel(bgc, i + gc->irq_base, AT91_AIC5_SSR);
		if (mask & gc->mask_cache)
			irq_reg_writel(bgc, 1, AT91_AIC5_IECR);
		else
			irq_reg_writel(bgc, 1, AT91_AIC5_IDCR);
	}
	irq_gc_unlock(bgc);
}

Contributors
Person
Tokens
Prop
Commits
CommitProp
Boris Brezillon
138
63.89%
1
25.00%
Alexandre Belloni
67
31.02%
1
25.00%
Kevin Cernekee
6
2.78%
1
25.00%
Ludovic Desroches
5
2.31%
1
25.00%
Total
216
100.00%
4
100.00%



static void aic5_pm_shutdown(struct irq_data *d)
{
	struct irq_domain *domain = d->domain;
	struct irq_domain_chip_generic *dgc = domain->gc;
	struct irq_chip_generic *bgc = irq_get_domain_generic_chip(domain, 0);
	struct irq_chip_generic *gc = irq_data_get_irq_chip_data(d);
	int i;

	irq_gc_lock(bgc);
	for (i = 0; i < dgc->irqs_per_chip; i++) {
		irq_reg_writel(bgc, i + gc->irq_base, AT91_AIC5_SSR);
		irq_reg_writel(bgc, 1, AT91_AIC5_IDCR);
		irq_reg_writel(bgc, 1, AT91_AIC5_ICCR);
	}
	irq_gc_unlock(bgc);
}
Contributors
Person
Tokens
Prop
Commits
CommitProp
Boris Brezillon
101
90.18%
1
33.33%
Kevin Cernekee
6
5.36%
1
33.33%
Ludovic Desroches
5
4.46%
1
33.33%
Total
112
100.00%
3
100.00%

#else

#define aic5_suspend		NULL

#define aic5_resume		NULL

#define aic5_pm_shutdown	NULL
#endif /* CONFIG_PM */



static void __init aic5_hw_init(struct irq_domain *domain)
{
	struct irq_chip_generic *gc = irq_get_domain_generic_chip(domain, 0);
	int i;

	/*
         * Perform 8 End Of Interrupt Command to make sure AIC
         * will not Lock out nIRQ
         */
	for (i = 0; i < 8; i++)
		irq_reg_writel(gc, 0, AT91_AIC5_EOICR);

	/*
         * Spurious Interrupt ID in Spurious Vector Register.
         * When there is no current interrupt, the IRQ Vector Register
         * reads the value stored in AIC_SPU
         */
	irq_reg_writel(gc, 0xffffffff, AT91_AIC5_SPU);

	/* No debugging in AIC: Debug (Protect) Control Register */
	irq_reg_writel(gc, 0, AT91_AIC5_DCR);

	/* Disable and clear all interrupts initially */
	for (i = 0; i < domain->revmap_size; i++) {
		irq_reg_writel(gc, i, AT91_AIC5_SSR);
		irq_reg_writel(gc, i, AT91_AIC5_SVR);
		irq_reg_writel(gc, 1, AT91_AIC5_IDCR);
		irq_reg_writel(gc, 1, AT91_AIC5_ICCR);
	}
}

Contributors
Person
Tokens
Prop
Commits
CommitProp
Boris Brezillon
110
88.71%
1
50.00%
Kevin Cernekee
14
11.29%
1
50.00%
Total
124
100.00%
2
100.00%



static int aic5_irq_domain_xlate(struct irq_domain *d,
				 struct device_node *ctrlr,
				 const u32 *intspec, unsigned int intsize,
				 irq_hw_number_t *out_hwirq,
				 unsigned int *out_type)
{
	struct irq_chip_generic *bgc = irq_get_domain_generic_chip(d, 0);
	unsigned long flags;
	unsigned smr;
	int ret;

	if (!bgc)
		return -EINVAL;

	ret = aic_common_irq_domain_xlate(d, ctrlr, intspec, intsize,
					  out_hwirq, out_type);
	if (ret)
		return ret;

	irq_gc_lock_irqsave(bgc, flags);
	irq_reg_writel(bgc, *out_hwirq, AT91_AIC5_SSR);
	smr = irq_reg_readl(bgc, AT91_AIC5_SMR);
	aic_common_set_priority(intspec[2], &smr);
	irq_reg_writel(bgc, smr, AT91_AIC5_SMR);
	irq_gc_unlock_irqrestore(bgc, flags);

	return ret;
}

Contributors
Person
Tokens
Prop
Commits
CommitProp
Boris Brezillon
128
88.28%
2
40.00%
Ludovic Desroches
14
9.66%
2
40.00%
Kevin Cernekee
3
2.07%
1
20.00%
Total
145
100.00%
5
100.00%


static const struct irq_domain_ops aic5_irq_ops = {
	.map	= irq_map_generic_chip,
	.xlate	= aic5_irq_domain_xlate,
};



static void __init sama5d3_aic_irq_fixup(void)
{
	aic_common_rtc_irq_fixup();
}

Contributors
Person
Tokens
Prop
Commits
CommitProp
Boris Brezillon
12
100.00%
2
100.00%
Total
12
100.00%
2
100.00%


static const struct of_device_id aic5_irq_fixups[] __initconst = {
	{ .compatible = "atmel,sama5d3", .data = sama5d3_aic_irq_fixup },
	{ .compatible = "atmel,sama5d4", .data = sama5d3_aic_irq_fixup },
	{ /* sentinel */ },
};



static int __init aic5_of_init(struct device_node *node,
			       struct device_node *parent,
			       int nirqs)
{
	struct irq_chip_generic *gc;
	struct irq_domain *domain;
	int nchips;
	int i;

	if (nirqs > NR_AIC5_IRQS)
		return -EINVAL;

	if (aic5_domain)
		return -EEXIST;

	domain = aic_common_of_init(node, &aic5_irq_ops, "atmel-aic5",
				    nirqs, aic5_irq_fixups);
	if (IS_ERR(domain))
		return PTR_ERR(domain);

	aic5_domain = domain;
	nchips = aic5_domain->revmap_size / 32;
	for (i = 0; i < nchips; i++) {
		gc = irq_get_domain_generic_chip(domain, i * 32);

		gc->chip_types[0].regs.eoi = AT91_AIC5_EOICR;
		gc->chip_types[0].chip.irq_mask = aic5_mask;
		gc->chip_types[0].chip.irq_unmask = aic5_unmask;
		gc->chip_types[0].chip.irq_retrigger = aic5_retrigger;
		gc->chip_types[0].chip.irq_set_type = aic5_set_type;
		gc->chip_types[0].chip.irq_suspend = aic5_suspend;
		gc->chip_types[0].chip.irq_resume = aic5_resume;
		gc->chip_types[0].chip.irq_pm_shutdown = aic5_pm_shutdown;
	}

	aic5_hw_init(domain);
	set_handle_irq(aic5_handle);

	return 0;
}

Contributors
Person
Tokens
Prop
Commits
CommitProp
Boris Brezillon
236
99.16%
1
50.00%
Kim (Woogyom) Milo
2
0.84%
1
50.00%
Total
238
100.00%
2
100.00%


#define NR_SAMA5D2_IRQS		77



static int __init sama5d2_aic5_of_init(struct device_node *node,
				       struct device_node *parent)
{
#ifdef CONFIG_PM
	smr_cache = kcalloc(DIV_ROUND_UP(NR_SAMA5D2_IRQS, 32) * 32,
			    sizeof(*smr_cache), GFP_KERNEL);
	if (!smr_cache)
		return -ENOMEM;
#endif

	return aic5_of_init(node, parent, NR_SAMA5D2_IRQS);
}
Contributors
Person
Tokens
Prop
Commits
CommitProp
Alexandre Belloni
36
57.14%
1
50.00%
Nicolas Ferre
27
42.86%
1
50.00%
Total
63
100.00%
2
100.00%

IRQCHIP_DECLARE(sama5d2_aic5, "atmel,sama5d2-aic", sama5d2_aic5_of_init);


#define NR_SAMA5D3_IRQS		48



static int __init sama5d3_aic5_of_init(struct device_node *node,
				       struct device_node *parent)
{
	return aic5_of_init(node, parent, NR_SAMA5D3_IRQS);
}
Contributors
Person
Tokens
Prop
Commits
CommitProp
Boris Brezillon
27
100.00%
1
100.00%
Total
27
100.00%
1
100.00%

IRQCHIP_DECLARE(sama5d3_aic5, "atmel,sama5d3-aic", sama5d3_aic5_of_init);


#define NR_SAMA5D4_IRQS		68



static int __init sama5d4_aic5_of_init(struct device_node *node,
				       struct device_node *parent)
{
	return aic5_of_init(node, parent, NR_SAMA5D4_IRQS);
}
Contributors
Person
Tokens
Prop
Commits
CommitProp
Alexandre Belloni
27
100.00%
1
100.00%
Total
27
100.00%
1
100.00%

IRQCHIP_DECLARE(sama5d4_aic5, "atmel,sama5d4-aic", sama5d4_aic5_of_init);
Overall Contributors
Person
Tokens
Prop
Commits
CommitProp
Boris Brezillon
1433
78.18%
4
25.00%
Alexandre Belloni
203
11.07%
3
18.75%
Ludovic Desroches
97
5.29%
3
18.75%
Kevin Cernekee
51
2.78%
1
6.25%
Nicolas Ferre
40
2.18%
1
6.25%
Marc Zyngier
3
0.16%
1
6.25%
Joël Porquet
3
0.16%
1
6.25%
Kim (Woogyom) Milo
2
0.11%
1
6.25%
Nico Pitre
1
0.05%
1
6.25%
Total
1833
100.00%
16
100.00%
Directory: drivers/irqchip

Information contained on this website is for historical information purposes only and does not indicate or represent copyright ownership.