162306a36Sopenharmony_ci/*
262306a36Sopenharmony_ci * Atmel AT91 AIC (Advanced Interrupt Controller) driver
362306a36Sopenharmony_ci *
462306a36Sopenharmony_ci *  Copyright (C) 2004 SAN People
562306a36Sopenharmony_ci *  Copyright (C) 2004 ATMEL
662306a36Sopenharmony_ci *  Copyright (C) Rick Bronson
762306a36Sopenharmony_ci *  Copyright (C) 2014 Free Electrons
862306a36Sopenharmony_ci *
962306a36Sopenharmony_ci *  Author: Boris BREZILLON <boris.brezillon@free-electrons.com>
1062306a36Sopenharmony_ci *
1162306a36Sopenharmony_ci * This file is licensed under the terms of the GNU General Public
1262306a36Sopenharmony_ci * License version 2.  This program is licensed "as is" without any
1362306a36Sopenharmony_ci * warranty of any kind, whether express or implied.
1462306a36Sopenharmony_ci */
1562306a36Sopenharmony_ci
1662306a36Sopenharmony_ci#include <linux/init.h>
1762306a36Sopenharmony_ci#include <linux/module.h>
1862306a36Sopenharmony_ci#include <linux/mm.h>
1962306a36Sopenharmony_ci#include <linux/bitmap.h>
2062306a36Sopenharmony_ci#include <linux/types.h>
2162306a36Sopenharmony_ci#include <linux/irq.h>
2262306a36Sopenharmony_ci#include <linux/irqchip.h>
2362306a36Sopenharmony_ci#include <linux/of.h>
2462306a36Sopenharmony_ci#include <linux/of_address.h>
2562306a36Sopenharmony_ci#include <linux/of_irq.h>
2662306a36Sopenharmony_ci#include <linux/irqdomain.h>
2762306a36Sopenharmony_ci#include <linux/err.h>
2862306a36Sopenharmony_ci#include <linux/slab.h>
2962306a36Sopenharmony_ci#include <linux/io.h>
3062306a36Sopenharmony_ci
3162306a36Sopenharmony_ci#include <asm/exception.h>
3262306a36Sopenharmony_ci#include <asm/mach/irq.h>
3362306a36Sopenharmony_ci
3462306a36Sopenharmony_ci#include "irq-atmel-aic-common.h"
3562306a36Sopenharmony_ci
3662306a36Sopenharmony_ci/* Number of irq lines managed by AIC */
3762306a36Sopenharmony_ci#define NR_AIC_IRQS	32
3862306a36Sopenharmony_ci
3962306a36Sopenharmony_ci#define AT91_AIC_SMR(n)			((n) * 4)
4062306a36Sopenharmony_ci
4162306a36Sopenharmony_ci#define AT91_AIC_SVR(n)			(0x80 + ((n) * 4))
4262306a36Sopenharmony_ci#define AT91_AIC_IVR			0x100
4362306a36Sopenharmony_ci#define AT91_AIC_FVR			0x104
4462306a36Sopenharmony_ci#define AT91_AIC_ISR			0x108
4562306a36Sopenharmony_ci
4662306a36Sopenharmony_ci#define AT91_AIC_IPR			0x10c
4762306a36Sopenharmony_ci#define AT91_AIC_IMR			0x110
4862306a36Sopenharmony_ci#define AT91_AIC_CISR			0x114
4962306a36Sopenharmony_ci
5062306a36Sopenharmony_ci#define AT91_AIC_IECR			0x120
5162306a36Sopenharmony_ci#define AT91_AIC_IDCR			0x124
5262306a36Sopenharmony_ci#define AT91_AIC_ICCR			0x128
5362306a36Sopenharmony_ci#define AT91_AIC_ISCR			0x12c
5462306a36Sopenharmony_ci#define AT91_AIC_EOICR			0x130
5562306a36Sopenharmony_ci#define AT91_AIC_SPU			0x134
5662306a36Sopenharmony_ci#define AT91_AIC_DCR			0x138
5762306a36Sopenharmony_ci
5862306a36Sopenharmony_cistatic struct irq_domain *aic_domain;
5962306a36Sopenharmony_ci
6062306a36Sopenharmony_cistatic asmlinkage void __exception_irq_entry
6162306a36Sopenharmony_ciaic_handle(struct pt_regs *regs)
6262306a36Sopenharmony_ci{
6362306a36Sopenharmony_ci	struct irq_domain_chip_generic *dgc = aic_domain->gc;
6462306a36Sopenharmony_ci	struct irq_chip_generic *gc = dgc->gc[0];
6562306a36Sopenharmony_ci	u32 irqnr;
6662306a36Sopenharmony_ci	u32 irqstat;
6762306a36Sopenharmony_ci
6862306a36Sopenharmony_ci	irqnr = irq_reg_readl(gc, AT91_AIC_IVR);
6962306a36Sopenharmony_ci	irqstat = irq_reg_readl(gc, AT91_AIC_ISR);
7062306a36Sopenharmony_ci
7162306a36Sopenharmony_ci	if (!irqstat)
7262306a36Sopenharmony_ci		irq_reg_writel(gc, 0, AT91_AIC_EOICR);
7362306a36Sopenharmony_ci	else
7462306a36Sopenharmony_ci		generic_handle_domain_irq(aic_domain, irqnr);
7562306a36Sopenharmony_ci}
7662306a36Sopenharmony_ci
7762306a36Sopenharmony_cistatic int aic_retrigger(struct irq_data *d)
7862306a36Sopenharmony_ci{
7962306a36Sopenharmony_ci	struct irq_chip_generic *gc = irq_data_get_irq_chip_data(d);
8062306a36Sopenharmony_ci
8162306a36Sopenharmony_ci	/* Enable interrupt on AIC5 */
8262306a36Sopenharmony_ci	irq_gc_lock(gc);
8362306a36Sopenharmony_ci	irq_reg_writel(gc, d->mask, AT91_AIC_ISCR);
8462306a36Sopenharmony_ci	irq_gc_unlock(gc);
8562306a36Sopenharmony_ci
8662306a36Sopenharmony_ci	return 1;
8762306a36Sopenharmony_ci}
8862306a36Sopenharmony_ci
8962306a36Sopenharmony_cistatic int aic_set_type(struct irq_data *d, unsigned type)
9062306a36Sopenharmony_ci{
9162306a36Sopenharmony_ci	struct irq_chip_generic *gc = irq_data_get_irq_chip_data(d);
9262306a36Sopenharmony_ci	unsigned int smr;
9362306a36Sopenharmony_ci	int ret;
9462306a36Sopenharmony_ci
9562306a36Sopenharmony_ci	smr = irq_reg_readl(gc, AT91_AIC_SMR(d->hwirq));
9662306a36Sopenharmony_ci	ret = aic_common_set_type(d, type, &smr);
9762306a36Sopenharmony_ci	if (ret)
9862306a36Sopenharmony_ci		return ret;
9962306a36Sopenharmony_ci
10062306a36Sopenharmony_ci	irq_reg_writel(gc, smr, AT91_AIC_SMR(d->hwirq));
10162306a36Sopenharmony_ci
10262306a36Sopenharmony_ci	return 0;
10362306a36Sopenharmony_ci}
10462306a36Sopenharmony_ci
10562306a36Sopenharmony_ci#ifdef CONFIG_PM
10662306a36Sopenharmony_cistatic void aic_suspend(struct irq_data *d)
10762306a36Sopenharmony_ci{
10862306a36Sopenharmony_ci	struct irq_chip_generic *gc = irq_data_get_irq_chip_data(d);
10962306a36Sopenharmony_ci
11062306a36Sopenharmony_ci	irq_gc_lock(gc);
11162306a36Sopenharmony_ci	irq_reg_writel(gc, gc->mask_cache, AT91_AIC_IDCR);
11262306a36Sopenharmony_ci	irq_reg_writel(gc, gc->wake_active, AT91_AIC_IECR);
11362306a36Sopenharmony_ci	irq_gc_unlock(gc);
11462306a36Sopenharmony_ci}
11562306a36Sopenharmony_ci
11662306a36Sopenharmony_cistatic void aic_resume(struct irq_data *d)
11762306a36Sopenharmony_ci{
11862306a36Sopenharmony_ci	struct irq_chip_generic *gc = irq_data_get_irq_chip_data(d);
11962306a36Sopenharmony_ci
12062306a36Sopenharmony_ci	irq_gc_lock(gc);
12162306a36Sopenharmony_ci	irq_reg_writel(gc, gc->wake_active, AT91_AIC_IDCR);
12262306a36Sopenharmony_ci	irq_reg_writel(gc, gc->mask_cache, AT91_AIC_IECR);
12362306a36Sopenharmony_ci	irq_gc_unlock(gc);
12462306a36Sopenharmony_ci}
12562306a36Sopenharmony_ci
12662306a36Sopenharmony_cistatic void aic_pm_shutdown(struct irq_data *d)
12762306a36Sopenharmony_ci{
12862306a36Sopenharmony_ci	struct irq_chip_generic *gc = irq_data_get_irq_chip_data(d);
12962306a36Sopenharmony_ci
13062306a36Sopenharmony_ci	irq_gc_lock(gc);
13162306a36Sopenharmony_ci	irq_reg_writel(gc, 0xffffffff, AT91_AIC_IDCR);
13262306a36Sopenharmony_ci	irq_reg_writel(gc, 0xffffffff, AT91_AIC_ICCR);
13362306a36Sopenharmony_ci	irq_gc_unlock(gc);
13462306a36Sopenharmony_ci}
13562306a36Sopenharmony_ci#else
13662306a36Sopenharmony_ci#define aic_suspend		NULL
13762306a36Sopenharmony_ci#define aic_resume		NULL
13862306a36Sopenharmony_ci#define aic_pm_shutdown		NULL
13962306a36Sopenharmony_ci#endif /* CONFIG_PM */
14062306a36Sopenharmony_ci
14162306a36Sopenharmony_cistatic void __init aic_hw_init(struct irq_domain *domain)
14262306a36Sopenharmony_ci{
14362306a36Sopenharmony_ci	struct irq_chip_generic *gc = irq_get_domain_generic_chip(domain, 0);
14462306a36Sopenharmony_ci	int i;
14562306a36Sopenharmony_ci
14662306a36Sopenharmony_ci	/*
14762306a36Sopenharmony_ci	 * Perform 8 End Of Interrupt Command to make sure AIC
14862306a36Sopenharmony_ci	 * will not Lock out nIRQ
14962306a36Sopenharmony_ci	 */
15062306a36Sopenharmony_ci	for (i = 0; i < 8; i++)
15162306a36Sopenharmony_ci		irq_reg_writel(gc, 0, AT91_AIC_EOICR);
15262306a36Sopenharmony_ci
15362306a36Sopenharmony_ci	/*
15462306a36Sopenharmony_ci	 * Spurious Interrupt ID in Spurious Vector Register.
15562306a36Sopenharmony_ci	 * When there is no current interrupt, the IRQ Vector Register
15662306a36Sopenharmony_ci	 * reads the value stored in AIC_SPU
15762306a36Sopenharmony_ci	 */
15862306a36Sopenharmony_ci	irq_reg_writel(gc, 0xffffffff, AT91_AIC_SPU);
15962306a36Sopenharmony_ci
16062306a36Sopenharmony_ci	/* No debugging in AIC: Debug (Protect) Control Register */
16162306a36Sopenharmony_ci	irq_reg_writel(gc, 0, AT91_AIC_DCR);
16262306a36Sopenharmony_ci
16362306a36Sopenharmony_ci	/* Disable and clear all interrupts initially */
16462306a36Sopenharmony_ci	irq_reg_writel(gc, 0xffffffff, AT91_AIC_IDCR);
16562306a36Sopenharmony_ci	irq_reg_writel(gc, 0xffffffff, AT91_AIC_ICCR);
16662306a36Sopenharmony_ci
16762306a36Sopenharmony_ci	for (i = 0; i < 32; i++)
16862306a36Sopenharmony_ci		irq_reg_writel(gc, i, AT91_AIC_SVR(i));
16962306a36Sopenharmony_ci}
17062306a36Sopenharmony_ci
17162306a36Sopenharmony_cistatic int aic_irq_domain_xlate(struct irq_domain *d,
17262306a36Sopenharmony_ci				struct device_node *ctrlr,
17362306a36Sopenharmony_ci				const u32 *intspec, unsigned int intsize,
17462306a36Sopenharmony_ci				irq_hw_number_t *out_hwirq,
17562306a36Sopenharmony_ci				unsigned int *out_type)
17662306a36Sopenharmony_ci{
17762306a36Sopenharmony_ci	struct irq_domain_chip_generic *dgc = d->gc;
17862306a36Sopenharmony_ci	struct irq_chip_generic *gc;
17962306a36Sopenharmony_ci	unsigned long flags;
18062306a36Sopenharmony_ci	unsigned smr;
18162306a36Sopenharmony_ci	int idx;
18262306a36Sopenharmony_ci	int ret;
18362306a36Sopenharmony_ci
18462306a36Sopenharmony_ci	if (!dgc)
18562306a36Sopenharmony_ci		return -EINVAL;
18662306a36Sopenharmony_ci
18762306a36Sopenharmony_ci	ret = aic_common_irq_domain_xlate(d, ctrlr, intspec, intsize,
18862306a36Sopenharmony_ci					  out_hwirq, out_type);
18962306a36Sopenharmony_ci	if (ret)
19062306a36Sopenharmony_ci		return ret;
19162306a36Sopenharmony_ci
19262306a36Sopenharmony_ci	idx = intspec[0] / dgc->irqs_per_chip;
19362306a36Sopenharmony_ci	if (idx >= dgc->num_chips)
19462306a36Sopenharmony_ci		return -EINVAL;
19562306a36Sopenharmony_ci
19662306a36Sopenharmony_ci	gc = dgc->gc[idx];
19762306a36Sopenharmony_ci
19862306a36Sopenharmony_ci	irq_gc_lock_irqsave(gc, flags);
19962306a36Sopenharmony_ci	smr = irq_reg_readl(gc, AT91_AIC_SMR(*out_hwirq));
20062306a36Sopenharmony_ci	aic_common_set_priority(intspec[2], &smr);
20162306a36Sopenharmony_ci	irq_reg_writel(gc, smr, AT91_AIC_SMR(*out_hwirq));
20262306a36Sopenharmony_ci	irq_gc_unlock_irqrestore(gc, flags);
20362306a36Sopenharmony_ci
20462306a36Sopenharmony_ci	return ret;
20562306a36Sopenharmony_ci}
20662306a36Sopenharmony_ci
20762306a36Sopenharmony_cistatic const struct irq_domain_ops aic_irq_ops = {
20862306a36Sopenharmony_ci	.map	= irq_map_generic_chip,
20962306a36Sopenharmony_ci	.xlate	= aic_irq_domain_xlate,
21062306a36Sopenharmony_ci};
21162306a36Sopenharmony_ci
21262306a36Sopenharmony_cistatic void __init at91rm9200_aic_irq_fixup(void)
21362306a36Sopenharmony_ci{
21462306a36Sopenharmony_ci	aic_common_rtc_irq_fixup();
21562306a36Sopenharmony_ci}
21662306a36Sopenharmony_ci
21762306a36Sopenharmony_cistatic void __init at91sam9260_aic_irq_fixup(void)
21862306a36Sopenharmony_ci{
21962306a36Sopenharmony_ci	aic_common_rtt_irq_fixup();
22062306a36Sopenharmony_ci}
22162306a36Sopenharmony_ci
22262306a36Sopenharmony_cistatic void __init at91sam9g45_aic_irq_fixup(void)
22362306a36Sopenharmony_ci{
22462306a36Sopenharmony_ci	aic_common_rtc_irq_fixup();
22562306a36Sopenharmony_ci	aic_common_rtt_irq_fixup();
22662306a36Sopenharmony_ci}
22762306a36Sopenharmony_ci
22862306a36Sopenharmony_cistatic const struct of_device_id aic_irq_fixups[] __initconst = {
22962306a36Sopenharmony_ci	{ .compatible = "atmel,at91rm9200", .data = at91rm9200_aic_irq_fixup },
23062306a36Sopenharmony_ci	{ .compatible = "atmel,at91sam9g45", .data = at91sam9g45_aic_irq_fixup },
23162306a36Sopenharmony_ci	{ .compatible = "atmel,at91sam9n12", .data = at91rm9200_aic_irq_fixup },
23262306a36Sopenharmony_ci	{ .compatible = "atmel,at91sam9rl", .data = at91sam9g45_aic_irq_fixup },
23362306a36Sopenharmony_ci	{ .compatible = "atmel,at91sam9x5", .data = at91rm9200_aic_irq_fixup },
23462306a36Sopenharmony_ci	{ .compatible = "atmel,at91sam9260", .data = at91sam9260_aic_irq_fixup },
23562306a36Sopenharmony_ci	{ .compatible = "atmel,at91sam9261", .data = at91sam9260_aic_irq_fixup },
23662306a36Sopenharmony_ci	{ .compatible = "atmel,at91sam9263", .data = at91sam9260_aic_irq_fixup },
23762306a36Sopenharmony_ci	{ .compatible = "atmel,at91sam9g20", .data = at91sam9260_aic_irq_fixup },
23862306a36Sopenharmony_ci	{ /* sentinel */ },
23962306a36Sopenharmony_ci};
24062306a36Sopenharmony_ci
24162306a36Sopenharmony_cistatic int __init aic_of_init(struct device_node *node,
24262306a36Sopenharmony_ci			      struct device_node *parent)
24362306a36Sopenharmony_ci{
24462306a36Sopenharmony_ci	struct irq_chip_generic *gc;
24562306a36Sopenharmony_ci	struct irq_domain *domain;
24662306a36Sopenharmony_ci
24762306a36Sopenharmony_ci	if (aic_domain)
24862306a36Sopenharmony_ci		return -EEXIST;
24962306a36Sopenharmony_ci
25062306a36Sopenharmony_ci	domain = aic_common_of_init(node, &aic_irq_ops, "atmel-aic",
25162306a36Sopenharmony_ci				    NR_AIC_IRQS, aic_irq_fixups);
25262306a36Sopenharmony_ci	if (IS_ERR(domain))
25362306a36Sopenharmony_ci		return PTR_ERR(domain);
25462306a36Sopenharmony_ci
25562306a36Sopenharmony_ci	aic_domain = domain;
25662306a36Sopenharmony_ci	gc = irq_get_domain_generic_chip(domain, 0);
25762306a36Sopenharmony_ci
25862306a36Sopenharmony_ci	gc->chip_types[0].regs.eoi = AT91_AIC_EOICR;
25962306a36Sopenharmony_ci	gc->chip_types[0].regs.enable = AT91_AIC_IECR;
26062306a36Sopenharmony_ci	gc->chip_types[0].regs.disable = AT91_AIC_IDCR;
26162306a36Sopenharmony_ci	gc->chip_types[0].chip.irq_mask = irq_gc_mask_disable_reg;
26262306a36Sopenharmony_ci	gc->chip_types[0].chip.irq_unmask = irq_gc_unmask_enable_reg;
26362306a36Sopenharmony_ci	gc->chip_types[0].chip.irq_retrigger = aic_retrigger;
26462306a36Sopenharmony_ci	gc->chip_types[0].chip.irq_set_type = aic_set_type;
26562306a36Sopenharmony_ci	gc->chip_types[0].chip.irq_suspend = aic_suspend;
26662306a36Sopenharmony_ci	gc->chip_types[0].chip.irq_resume = aic_resume;
26762306a36Sopenharmony_ci	gc->chip_types[0].chip.irq_pm_shutdown = aic_pm_shutdown;
26862306a36Sopenharmony_ci
26962306a36Sopenharmony_ci	aic_hw_init(domain);
27062306a36Sopenharmony_ci	set_handle_irq(aic_handle);
27162306a36Sopenharmony_ci
27262306a36Sopenharmony_ci	return 0;
27362306a36Sopenharmony_ci}
27462306a36Sopenharmony_ciIRQCHIP_DECLARE(at91rm9200_aic, "atmel,at91rm9200-aic", aic_of_init);
275