1b1479ebbSBoris BREZILLON /* 2b1479ebbSBoris BREZILLON * Atmel AT91 AIC (Advanced Interrupt Controller) driver 3b1479ebbSBoris BREZILLON * 4b1479ebbSBoris BREZILLON * Copyright (C) 2004 SAN People 5b1479ebbSBoris BREZILLON * Copyright (C) 2004 ATMEL 6b1479ebbSBoris BREZILLON * Copyright (C) Rick Bronson 7b1479ebbSBoris BREZILLON * Copyright (C) 2014 Free Electrons 8b1479ebbSBoris BREZILLON * 9b1479ebbSBoris BREZILLON * Author: Boris BREZILLON <boris.brezillon@free-electrons.com> 10b1479ebbSBoris BREZILLON * 11b1479ebbSBoris BREZILLON * This file is licensed under the terms of the GNU General Public 12b1479ebbSBoris BREZILLON * License version 2. This program is licensed "as is" without any 13b1479ebbSBoris BREZILLON * warranty of any kind, whether express or implied. 14b1479ebbSBoris BREZILLON */ 15b1479ebbSBoris BREZILLON 16b1479ebbSBoris BREZILLON #include <linux/init.h> 17b1479ebbSBoris BREZILLON #include <linux/module.h> 18b1479ebbSBoris BREZILLON #include <linux/mm.h> 19b1479ebbSBoris BREZILLON #include <linux/bitmap.h> 20b1479ebbSBoris BREZILLON #include <linux/types.h> 21b1479ebbSBoris BREZILLON #include <linux/irq.h> 22b1479ebbSBoris BREZILLON #include <linux/of.h> 23b1479ebbSBoris BREZILLON #include <linux/of_address.h> 24b1479ebbSBoris BREZILLON #include <linux/of_irq.h> 25b1479ebbSBoris BREZILLON #include <linux/irqdomain.h> 26b1479ebbSBoris BREZILLON #include <linux/err.h> 27b1479ebbSBoris BREZILLON #include <linux/slab.h> 28b1479ebbSBoris BREZILLON #include <linux/io.h> 29b1479ebbSBoris BREZILLON 30b1479ebbSBoris BREZILLON #include <asm/exception.h> 31b1479ebbSBoris BREZILLON #include <asm/mach/irq.h> 32b1479ebbSBoris BREZILLON 33b1479ebbSBoris BREZILLON #include "irq-atmel-aic-common.h" 34b1479ebbSBoris BREZILLON #include "irqchip.h" 35b1479ebbSBoris BREZILLON 36b1479ebbSBoris BREZILLON /* Number of irq lines managed by AIC */ 37b1479ebbSBoris BREZILLON #define NR_AIC_IRQS 32 38b1479ebbSBoris BREZILLON 39b1479ebbSBoris BREZILLON #define AT91_AIC_SMR(n) ((n) * 4) 40b1479ebbSBoris BREZILLON 41b1479ebbSBoris BREZILLON #define AT91_AIC_SVR(n) (0x80 + ((n) * 4)) 42b1479ebbSBoris BREZILLON #define AT91_AIC_IVR 0x100 43b1479ebbSBoris BREZILLON #define AT91_AIC_FVR 0x104 44b1479ebbSBoris BREZILLON #define AT91_AIC_ISR 0x108 45b1479ebbSBoris BREZILLON 46b1479ebbSBoris BREZILLON #define AT91_AIC_IPR 0x10c 47b1479ebbSBoris BREZILLON #define AT91_AIC_IMR 0x110 48b1479ebbSBoris BREZILLON #define AT91_AIC_CISR 0x114 49b1479ebbSBoris BREZILLON 50b1479ebbSBoris BREZILLON #define AT91_AIC_IECR 0x120 51b1479ebbSBoris BREZILLON #define AT91_AIC_IDCR 0x124 52b1479ebbSBoris BREZILLON #define AT91_AIC_ICCR 0x128 53b1479ebbSBoris BREZILLON #define AT91_AIC_ISCR 0x12c 54b1479ebbSBoris BREZILLON #define AT91_AIC_EOICR 0x130 55b1479ebbSBoris BREZILLON #define AT91_AIC_SPU 0x134 56b1479ebbSBoris BREZILLON #define AT91_AIC_DCR 0x138 57b1479ebbSBoris BREZILLON 58b1479ebbSBoris BREZILLON static struct irq_domain *aic_domain; 59b1479ebbSBoris BREZILLON 60b1479ebbSBoris BREZILLON static asmlinkage void __exception_irq_entry 61b1479ebbSBoris BREZILLON aic_handle(struct pt_regs *regs) 62b1479ebbSBoris BREZILLON { 63b1479ebbSBoris BREZILLON struct irq_domain_chip_generic *dgc = aic_domain->gc; 64b1479ebbSBoris BREZILLON struct irq_chip_generic *gc = dgc->gc[0]; 65b1479ebbSBoris BREZILLON u32 irqnr; 66b1479ebbSBoris BREZILLON u32 irqstat; 67b1479ebbSBoris BREZILLON 68b1479ebbSBoris BREZILLON irqnr = irq_reg_readl(gc->reg_base + AT91_AIC_IVR); 69b1479ebbSBoris BREZILLON irqstat = irq_reg_readl(gc->reg_base + AT91_AIC_ISR); 70b1479ebbSBoris BREZILLON 71b1479ebbSBoris BREZILLON irqnr = irq_find_mapping(aic_domain, irqnr); 72b1479ebbSBoris BREZILLON 73b1479ebbSBoris BREZILLON if (!irqstat) 74b1479ebbSBoris BREZILLON irq_reg_writel(0, gc->reg_base + AT91_AIC_EOICR); 75b1479ebbSBoris BREZILLON else 76b1479ebbSBoris BREZILLON handle_IRQ(irqnr, regs); 77b1479ebbSBoris BREZILLON } 78b1479ebbSBoris BREZILLON 79b1479ebbSBoris BREZILLON static int aic_retrigger(struct irq_data *d) 80b1479ebbSBoris BREZILLON { 81b1479ebbSBoris BREZILLON struct irq_chip_generic *gc = irq_data_get_irq_chip_data(d); 82b1479ebbSBoris BREZILLON 83b1479ebbSBoris BREZILLON /* Enable interrupt on AIC5 */ 84b1479ebbSBoris BREZILLON irq_gc_lock(gc); 85b1479ebbSBoris BREZILLON irq_reg_writel(d->mask, gc->reg_base + AT91_AIC_ISCR); 86b1479ebbSBoris BREZILLON irq_gc_unlock(gc); 87b1479ebbSBoris BREZILLON 88b1479ebbSBoris BREZILLON return 0; 89b1479ebbSBoris BREZILLON } 90b1479ebbSBoris BREZILLON 91b1479ebbSBoris BREZILLON static int aic_set_type(struct irq_data *d, unsigned type) 92b1479ebbSBoris BREZILLON { 93b1479ebbSBoris BREZILLON struct irq_chip_generic *gc = irq_data_get_irq_chip_data(d); 94b1479ebbSBoris BREZILLON unsigned int smr; 95b1479ebbSBoris BREZILLON int ret; 96b1479ebbSBoris BREZILLON 97b1479ebbSBoris BREZILLON smr = irq_reg_readl(gc->reg_base + AT91_AIC_SMR(d->hwirq)); 98b1479ebbSBoris BREZILLON ret = aic_common_set_type(d, type, &smr); 99b1479ebbSBoris BREZILLON if (ret) 100b1479ebbSBoris BREZILLON return ret; 101b1479ebbSBoris BREZILLON 102b1479ebbSBoris BREZILLON irq_reg_writel(smr, gc->reg_base + AT91_AIC_SMR(d->hwirq)); 103b1479ebbSBoris BREZILLON 104b1479ebbSBoris BREZILLON return 0; 105b1479ebbSBoris BREZILLON } 106b1479ebbSBoris BREZILLON 107b1479ebbSBoris BREZILLON #ifdef CONFIG_PM 108b1479ebbSBoris BREZILLON static void aic_suspend(struct irq_data *d) 109b1479ebbSBoris BREZILLON { 110b1479ebbSBoris BREZILLON struct irq_chip_generic *gc = irq_data_get_irq_chip_data(d); 111b1479ebbSBoris BREZILLON 112b1479ebbSBoris BREZILLON irq_gc_lock(gc); 113b1479ebbSBoris BREZILLON irq_reg_writel(gc->mask_cache, gc->reg_base + AT91_AIC_IDCR); 114b1479ebbSBoris BREZILLON irq_reg_writel(gc->wake_active, gc->reg_base + AT91_AIC_IECR); 115b1479ebbSBoris BREZILLON irq_gc_unlock(gc); 116b1479ebbSBoris BREZILLON } 117b1479ebbSBoris BREZILLON 118b1479ebbSBoris BREZILLON static void aic_resume(struct irq_data *d) 119b1479ebbSBoris BREZILLON { 120b1479ebbSBoris BREZILLON struct irq_chip_generic *gc = irq_data_get_irq_chip_data(d); 121b1479ebbSBoris BREZILLON 122b1479ebbSBoris BREZILLON irq_gc_lock(gc); 123b1479ebbSBoris BREZILLON irq_reg_writel(gc->wake_active, gc->reg_base + AT91_AIC_IDCR); 124b1479ebbSBoris BREZILLON irq_reg_writel(gc->mask_cache, gc->reg_base + AT91_AIC_IECR); 125b1479ebbSBoris BREZILLON irq_gc_unlock(gc); 126b1479ebbSBoris BREZILLON } 127b1479ebbSBoris BREZILLON 128b1479ebbSBoris BREZILLON static void aic_pm_shutdown(struct irq_data *d) 129b1479ebbSBoris BREZILLON { 130b1479ebbSBoris BREZILLON struct irq_chip_generic *gc = irq_data_get_irq_chip_data(d); 131b1479ebbSBoris BREZILLON 132b1479ebbSBoris BREZILLON irq_gc_lock(gc); 133b1479ebbSBoris BREZILLON irq_reg_writel(0xffffffff, gc->reg_base + AT91_AIC_IDCR); 134b1479ebbSBoris BREZILLON irq_reg_writel(0xffffffff, gc->reg_base + AT91_AIC_ICCR); 135b1479ebbSBoris BREZILLON irq_gc_unlock(gc); 136b1479ebbSBoris BREZILLON } 137b1479ebbSBoris BREZILLON #else 138b1479ebbSBoris BREZILLON #define aic_suspend NULL 139b1479ebbSBoris BREZILLON #define aic_resume NULL 140b1479ebbSBoris BREZILLON #define aic_pm_shutdown NULL 141b1479ebbSBoris BREZILLON #endif /* CONFIG_PM */ 142b1479ebbSBoris BREZILLON 143b1479ebbSBoris BREZILLON static void __init aic_hw_init(struct irq_domain *domain) 144b1479ebbSBoris BREZILLON { 145b1479ebbSBoris BREZILLON struct irq_chip_generic *gc = irq_get_domain_generic_chip(domain, 0); 146b1479ebbSBoris BREZILLON int i; 147b1479ebbSBoris BREZILLON 148b1479ebbSBoris BREZILLON /* 149b1479ebbSBoris BREZILLON * Perform 8 End Of Interrupt Command to make sure AIC 150b1479ebbSBoris BREZILLON * will not Lock out nIRQ 151b1479ebbSBoris BREZILLON */ 152b1479ebbSBoris BREZILLON for (i = 0; i < 8; i++) 153b1479ebbSBoris BREZILLON irq_reg_writel(0, gc->reg_base + AT91_AIC_EOICR); 154b1479ebbSBoris BREZILLON 155b1479ebbSBoris BREZILLON /* 156b1479ebbSBoris BREZILLON * Spurious Interrupt ID in Spurious Vector Register. 157b1479ebbSBoris BREZILLON * When there is no current interrupt, the IRQ Vector Register 158b1479ebbSBoris BREZILLON * reads the value stored in AIC_SPU 159b1479ebbSBoris BREZILLON */ 160b1479ebbSBoris BREZILLON irq_reg_writel(0xffffffff, gc->reg_base + AT91_AIC_SPU); 161b1479ebbSBoris BREZILLON 162b1479ebbSBoris BREZILLON /* No debugging in AIC: Debug (Protect) Control Register */ 163b1479ebbSBoris BREZILLON irq_reg_writel(0, gc->reg_base + AT91_AIC_DCR); 164b1479ebbSBoris BREZILLON 165b1479ebbSBoris BREZILLON /* Disable and clear all interrupts initially */ 166b1479ebbSBoris BREZILLON irq_reg_writel(0xffffffff, gc->reg_base + AT91_AIC_IDCR); 167b1479ebbSBoris BREZILLON irq_reg_writel(0xffffffff, gc->reg_base + AT91_AIC_ICCR); 168b1479ebbSBoris BREZILLON 169b1479ebbSBoris BREZILLON for (i = 0; i < 32; i++) 170b1479ebbSBoris BREZILLON irq_reg_writel(i, gc->reg_base + AT91_AIC_SVR(i)); 171b1479ebbSBoris BREZILLON } 172b1479ebbSBoris BREZILLON 173b1479ebbSBoris BREZILLON static int aic_irq_domain_xlate(struct irq_domain *d, 174b1479ebbSBoris BREZILLON struct device_node *ctrlr, 175b1479ebbSBoris BREZILLON const u32 *intspec, unsigned int intsize, 176b1479ebbSBoris BREZILLON irq_hw_number_t *out_hwirq, 177b1479ebbSBoris BREZILLON unsigned int *out_type) 178b1479ebbSBoris BREZILLON { 179b1479ebbSBoris BREZILLON struct irq_domain_chip_generic *dgc = d->gc; 180b1479ebbSBoris BREZILLON struct irq_chip_generic *gc; 181b1479ebbSBoris BREZILLON unsigned smr; 182b1479ebbSBoris BREZILLON int idx; 183b1479ebbSBoris BREZILLON int ret; 184b1479ebbSBoris BREZILLON 185b1479ebbSBoris BREZILLON if (!dgc) 186b1479ebbSBoris BREZILLON return -EINVAL; 187b1479ebbSBoris BREZILLON 188b1479ebbSBoris BREZILLON ret = aic_common_irq_domain_xlate(d, ctrlr, intspec, intsize, 189b1479ebbSBoris BREZILLON out_hwirq, out_type); 190b1479ebbSBoris BREZILLON if (ret) 191b1479ebbSBoris BREZILLON return ret; 192b1479ebbSBoris BREZILLON 193b1479ebbSBoris BREZILLON idx = intspec[0] / dgc->irqs_per_chip; 194b1479ebbSBoris BREZILLON if (idx >= dgc->num_chips) 195b1479ebbSBoris BREZILLON return -EINVAL; 196b1479ebbSBoris BREZILLON 197b1479ebbSBoris BREZILLON gc = dgc->gc[idx]; 198b1479ebbSBoris BREZILLON 199b1479ebbSBoris BREZILLON irq_gc_lock(gc); 200b1479ebbSBoris BREZILLON smr = irq_reg_readl(gc->reg_base + AT91_AIC_SMR(*out_hwirq)); 201b1479ebbSBoris BREZILLON ret = aic_common_set_priority(intspec[2], &smr); 202b1479ebbSBoris BREZILLON if (!ret) 203b1479ebbSBoris BREZILLON irq_reg_writel(smr, gc->reg_base + AT91_AIC_SMR(*out_hwirq)); 204b1479ebbSBoris BREZILLON irq_gc_unlock(gc); 205b1479ebbSBoris BREZILLON 206b1479ebbSBoris BREZILLON return ret; 207b1479ebbSBoris BREZILLON } 208b1479ebbSBoris BREZILLON 209b1479ebbSBoris BREZILLON static const struct irq_domain_ops aic_irq_ops = { 210b1479ebbSBoris BREZILLON .map = irq_map_generic_chip, 211b1479ebbSBoris BREZILLON .xlate = aic_irq_domain_xlate, 212b1479ebbSBoris BREZILLON }; 213b1479ebbSBoris BREZILLON 214*6704d12dSBoris BREZILLON static void __init at91sam9_aic_irq_fixup(struct device_node *root) 215*6704d12dSBoris BREZILLON { 216*6704d12dSBoris BREZILLON aic_common_rtc_irq_fixup(root); 217*6704d12dSBoris BREZILLON } 218*6704d12dSBoris BREZILLON 219*6704d12dSBoris BREZILLON static const struct of_device_id __initdata aic_irq_fixups[] = { 220*6704d12dSBoris BREZILLON { .compatible = "atmel,at91sam9g45", .data = at91sam9_aic_irq_fixup }, 221*6704d12dSBoris BREZILLON { .compatible = "atmel,at91sam9n12", .data = at91sam9_aic_irq_fixup }, 222*6704d12dSBoris BREZILLON { .compatible = "atmel,at91sam9rl", .data = at91sam9_aic_irq_fixup }, 223*6704d12dSBoris BREZILLON { .compatible = "atmel,at91sam9x5", .data = at91sam9_aic_irq_fixup }, 224*6704d12dSBoris BREZILLON { /* sentinel */ }, 225*6704d12dSBoris BREZILLON }; 226*6704d12dSBoris BREZILLON 227b1479ebbSBoris BREZILLON static int __init aic_of_init(struct device_node *node, 228b1479ebbSBoris BREZILLON struct device_node *parent) 229b1479ebbSBoris BREZILLON { 230b1479ebbSBoris BREZILLON struct irq_chip_generic *gc; 231b1479ebbSBoris BREZILLON struct irq_domain *domain; 232b1479ebbSBoris BREZILLON 233b1479ebbSBoris BREZILLON if (aic_domain) 234b1479ebbSBoris BREZILLON return -EEXIST; 235b1479ebbSBoris BREZILLON 236b1479ebbSBoris BREZILLON domain = aic_common_of_init(node, &aic_irq_ops, "atmel-aic", 237b1479ebbSBoris BREZILLON NR_AIC_IRQS); 238b1479ebbSBoris BREZILLON if (IS_ERR(domain)) 239b1479ebbSBoris BREZILLON return PTR_ERR(domain); 240b1479ebbSBoris BREZILLON 241*6704d12dSBoris BREZILLON aic_common_irq_fixup(aic_irq_fixups); 242*6704d12dSBoris BREZILLON 243b1479ebbSBoris BREZILLON aic_domain = domain; 244b1479ebbSBoris BREZILLON gc = irq_get_domain_generic_chip(domain, 0); 245b1479ebbSBoris BREZILLON 246b1479ebbSBoris BREZILLON gc->chip_types[0].regs.eoi = AT91_AIC_EOICR; 247b1479ebbSBoris BREZILLON gc->chip_types[0].regs.enable = AT91_AIC_IECR; 248b1479ebbSBoris BREZILLON gc->chip_types[0].regs.disable = AT91_AIC_IDCR; 249b1479ebbSBoris BREZILLON gc->chip_types[0].chip.irq_mask = irq_gc_mask_disable_reg; 250b1479ebbSBoris BREZILLON gc->chip_types[0].chip.irq_unmask = irq_gc_unmask_enable_reg; 251b1479ebbSBoris BREZILLON gc->chip_types[0].chip.irq_retrigger = aic_retrigger; 252b1479ebbSBoris BREZILLON gc->chip_types[0].chip.irq_set_type = aic_set_type; 253b1479ebbSBoris BREZILLON gc->chip_types[0].chip.irq_suspend = aic_suspend; 254b1479ebbSBoris BREZILLON gc->chip_types[0].chip.irq_resume = aic_resume; 255b1479ebbSBoris BREZILLON gc->chip_types[0].chip.irq_pm_shutdown = aic_pm_shutdown; 256b1479ebbSBoris BREZILLON 257b1479ebbSBoris BREZILLON aic_hw_init(domain); 258b1479ebbSBoris BREZILLON set_handle_irq(aic_handle); 259b1479ebbSBoris BREZILLON 260b1479ebbSBoris BREZILLON return 0; 261b1479ebbSBoris BREZILLON } 262b1479ebbSBoris BREZILLON IRQCHIP_DECLARE(at91rm9200_aic, "atmel,at91rm9200-aic", aic_of_init); 263