Loading arch/arm/mach-omap2/irq.c +47 −81 Original line number Diff line number Diff line Loading @@ -49,8 +49,8 @@ #define OMAP3_IRQ_BASE OMAP2_L4_IO_ADDRESS(OMAP34XX_IC_BASE) #define INTCPS_SIR_IRQ_OFFSET 0x0040 /* omap2/3 active interrupt offset */ #define ACTIVEIRQ_MASK 0x7f /* omap2/3 active interrupt bits */ #define INTCPS_NR_ILR_REGS 128 #define INTCPS_NR_MIR_REGS 3 #define INTCPS_NR_IRQS 96 /* * OMAP2 has a number of different interrupt controllers, each interrupt Loading @@ -58,15 +58,6 @@ * fairly consistent for each bank, but not all registers are implemented * for each bank.. when in doubt, consult the TRM. */ static struct omap_irq_bank { void __iomem *base_reg; unsigned int nr_irqs; } __attribute__ ((aligned(4))) irq_banks[] = { { /* MPU INTC */ .nr_irqs = 96, }, }; static struct irq_domain *domain; static void __iomem *omap_irq_base; Loading @@ -78,7 +69,7 @@ struct omap3_intc_regs { u32 protection; u32 idle; u32 threshold; u32 ilr[INTCPS_NR_IRQS]; u32 ilr[INTCPS_NR_ILR_REGS]; u32 mir[INTCPS_NR_MIR_REGS]; }; Loading @@ -105,13 +96,14 @@ static void omap_mask_ack_irq(struct irq_data *d) omap_ack_irq(d); } static void __init omap_irq_bank_init_one(struct omap_irq_bank *bank) static void __init omap_irq_soft_reset(void) { unsigned long tmp; tmp = intc_readl(INTC_REVISION) & 0xff; pr_info("IRQ: Found an INTC at 0x%p (revision %ld.%ld) with %d interrupts\n", bank->base_reg, tmp >> 4, tmp & 0xf, bank->nr_irqs); omap_irq_base, tmp >> 4, tmp & 0xf, omap_nr_irqs); tmp = intc_readl(INTC_SYSCONFIG); tmp |= 1 << 1; /* soft reset */ Loading @@ -126,17 +118,12 @@ static void __init omap_irq_bank_init_one(struct omap_irq_bank *bank) int omap_irq_pending(void) { int i; for (i = 0; i < ARRAY_SIZE(irq_banks); i++) { struct omap_irq_bank *bank = irq_banks + i; int irq; for (irq = 0; irq < bank->nr_irqs; irq += 32) for (irq = 0; irq < omap_nr_irqs; irq += 32) if (intc_readl(INTC_PENDING_IRQ0 + ((irq >> 5) << 5))) return 1; } return 0; } Loading @@ -163,9 +150,7 @@ omap_alloc_gc(void __iomem *base, unsigned int irq_start, unsigned int num) static void __init omap_init_irq(u32 base, int nr_irqs, struct device_node *node) { unsigned long nr_of_irqs = 0; unsigned int nr_banks = 0; int i, j, irq_base; int j, irq_base; omap_irq_base = ioremap(base, SZ_4K); if (WARN_ON(!omap_irq_base)) Loading @@ -182,29 +167,10 @@ static void __init omap_init_irq(u32 base, int nr_irqs, domain = irq_domain_add_legacy(node, nr_irqs, irq_base, 0, &irq_domain_simple_ops, NULL); for (i = 0; i < ARRAY_SIZE(irq_banks); i++) { struct omap_irq_bank *bank = irq_banks + i; bank->nr_irqs = nr_irqs; /* Static mapping, never released */ bank->base_reg = ioremap(base, SZ_4K); if (!bank->base_reg) { pr_err("Could not ioremap irq bank%i\n", i); continue; } omap_irq_bank_init_one(bank); for (j = 0; j < bank->nr_irqs; j += 32) omap_alloc_gc(bank->base_reg + j, j + irq_base, 32); omap_irq_soft_reset(); nr_of_irqs += bank->nr_irqs; nr_banks++; } pr_info("Total of %ld interrupts on %d active controller%s\n", nr_of_irqs, nr_banks, nr_banks > 1 ? "s" : ""); for (j = 0; j < omap_nr_irqs; j += 32) omap_alloc_gc(omap_irq_base + j, j + irq_base, 32); } void __init omap2_init_irq(void) Loading Loading @@ -303,45 +269,45 @@ void __init omap_intc_of_init(void) } #if defined(CONFIG_ARCH_OMAP3) || defined(CONFIG_SOC_AM33XX) static struct omap3_intc_regs intc_context[ARRAY_SIZE(irq_banks)]; static struct omap3_intc_regs intc_context; void omap_intc_save_context(void) { int ind = 0, i = 0; for (ind = 0; ind < ARRAY_SIZE(irq_banks); ind++) { intc_context[ind].sysconfig = int i; intc_context.sysconfig = intc_readl(INTC_SYSCONFIG); intc_context[ind].protection = intc_context.protection = intc_readl(INTC_PROTECTION); intc_context[ind].idle = intc_context.idle = intc_readl(INTC_IDLE); intc_context[ind].threshold = intc_context.threshold = intc_readl(INTC_THRESHOLD); for (i = 0; i < INTCPS_NR_IRQS; i++) intc_context[ind].ilr[i] = for (i = 0; i < omap_nr_irqs; i++) intc_context.ilr[i] = intc_readl((INTC_ILR0 + 0x4 * i)); for (i = 0; i < INTCPS_NR_MIR_REGS; i++) intc_context[ind].mir[i] = intc_context.mir[i] = intc_readl(INTC_MIR0 + (0x20 * i)); } } void omap_intc_restore_context(void) { int ind = 0, i = 0; for (ind = 0; ind < ARRAY_SIZE(irq_banks); ind++) { intc_writel(INTC_SYSCONFIG, intc_context[ind].sysconfig); intc_writel(INTC_PROTECTION, intc_context[ind].protection); intc_writel(INTC_IDLE, intc_context[ind].idle); intc_writel(INTC_THRESHOLD, intc_context[ind].threshold); for (i = 0; i < INTCPS_NR_IRQS; i++) int i; intc_writel(INTC_SYSCONFIG, intc_context.sysconfig); intc_writel(INTC_PROTECTION, intc_context.protection); intc_writel(INTC_IDLE, intc_context.idle); intc_writel(INTC_THRESHOLD, intc_context.threshold); for (i = 0; i < omap_nr_irqs; i++) intc_writel(INTC_ILR0 + 0x4 * i, intc_context[ind].ilr[i]); intc_context.ilr[i]); for (i = 0; i < INTCPS_NR_MIR_REGS; i++) intc_writel(INTC_MIR0 + 0x20 * i, intc_context[ind].mir[i]); } intc_context.mir[i]); /* MIRs are saved and restore with other PRCM registers */ } Loading Loading
arch/arm/mach-omap2/irq.c +47 −81 Original line number Diff line number Diff line Loading @@ -49,8 +49,8 @@ #define OMAP3_IRQ_BASE OMAP2_L4_IO_ADDRESS(OMAP34XX_IC_BASE) #define INTCPS_SIR_IRQ_OFFSET 0x0040 /* omap2/3 active interrupt offset */ #define ACTIVEIRQ_MASK 0x7f /* omap2/3 active interrupt bits */ #define INTCPS_NR_ILR_REGS 128 #define INTCPS_NR_MIR_REGS 3 #define INTCPS_NR_IRQS 96 /* * OMAP2 has a number of different interrupt controllers, each interrupt Loading @@ -58,15 +58,6 @@ * fairly consistent for each bank, but not all registers are implemented * for each bank.. when in doubt, consult the TRM. */ static struct omap_irq_bank { void __iomem *base_reg; unsigned int nr_irqs; } __attribute__ ((aligned(4))) irq_banks[] = { { /* MPU INTC */ .nr_irqs = 96, }, }; static struct irq_domain *domain; static void __iomem *omap_irq_base; Loading @@ -78,7 +69,7 @@ struct omap3_intc_regs { u32 protection; u32 idle; u32 threshold; u32 ilr[INTCPS_NR_IRQS]; u32 ilr[INTCPS_NR_ILR_REGS]; u32 mir[INTCPS_NR_MIR_REGS]; }; Loading @@ -105,13 +96,14 @@ static void omap_mask_ack_irq(struct irq_data *d) omap_ack_irq(d); } static void __init omap_irq_bank_init_one(struct omap_irq_bank *bank) static void __init omap_irq_soft_reset(void) { unsigned long tmp; tmp = intc_readl(INTC_REVISION) & 0xff; pr_info("IRQ: Found an INTC at 0x%p (revision %ld.%ld) with %d interrupts\n", bank->base_reg, tmp >> 4, tmp & 0xf, bank->nr_irqs); omap_irq_base, tmp >> 4, tmp & 0xf, omap_nr_irqs); tmp = intc_readl(INTC_SYSCONFIG); tmp |= 1 << 1; /* soft reset */ Loading @@ -126,17 +118,12 @@ static void __init omap_irq_bank_init_one(struct omap_irq_bank *bank) int omap_irq_pending(void) { int i; for (i = 0; i < ARRAY_SIZE(irq_banks); i++) { struct omap_irq_bank *bank = irq_banks + i; int irq; for (irq = 0; irq < bank->nr_irqs; irq += 32) for (irq = 0; irq < omap_nr_irqs; irq += 32) if (intc_readl(INTC_PENDING_IRQ0 + ((irq >> 5) << 5))) return 1; } return 0; } Loading @@ -163,9 +150,7 @@ omap_alloc_gc(void __iomem *base, unsigned int irq_start, unsigned int num) static void __init omap_init_irq(u32 base, int nr_irqs, struct device_node *node) { unsigned long nr_of_irqs = 0; unsigned int nr_banks = 0; int i, j, irq_base; int j, irq_base; omap_irq_base = ioremap(base, SZ_4K); if (WARN_ON(!omap_irq_base)) Loading @@ -182,29 +167,10 @@ static void __init omap_init_irq(u32 base, int nr_irqs, domain = irq_domain_add_legacy(node, nr_irqs, irq_base, 0, &irq_domain_simple_ops, NULL); for (i = 0; i < ARRAY_SIZE(irq_banks); i++) { struct omap_irq_bank *bank = irq_banks + i; bank->nr_irqs = nr_irqs; /* Static mapping, never released */ bank->base_reg = ioremap(base, SZ_4K); if (!bank->base_reg) { pr_err("Could not ioremap irq bank%i\n", i); continue; } omap_irq_bank_init_one(bank); for (j = 0; j < bank->nr_irqs; j += 32) omap_alloc_gc(bank->base_reg + j, j + irq_base, 32); omap_irq_soft_reset(); nr_of_irqs += bank->nr_irqs; nr_banks++; } pr_info("Total of %ld interrupts on %d active controller%s\n", nr_of_irqs, nr_banks, nr_banks > 1 ? "s" : ""); for (j = 0; j < omap_nr_irqs; j += 32) omap_alloc_gc(omap_irq_base + j, j + irq_base, 32); } void __init omap2_init_irq(void) Loading Loading @@ -303,45 +269,45 @@ void __init omap_intc_of_init(void) } #if defined(CONFIG_ARCH_OMAP3) || defined(CONFIG_SOC_AM33XX) static struct omap3_intc_regs intc_context[ARRAY_SIZE(irq_banks)]; static struct omap3_intc_regs intc_context; void omap_intc_save_context(void) { int ind = 0, i = 0; for (ind = 0; ind < ARRAY_SIZE(irq_banks); ind++) { intc_context[ind].sysconfig = int i; intc_context.sysconfig = intc_readl(INTC_SYSCONFIG); intc_context[ind].protection = intc_context.protection = intc_readl(INTC_PROTECTION); intc_context[ind].idle = intc_context.idle = intc_readl(INTC_IDLE); intc_context[ind].threshold = intc_context.threshold = intc_readl(INTC_THRESHOLD); for (i = 0; i < INTCPS_NR_IRQS; i++) intc_context[ind].ilr[i] = for (i = 0; i < omap_nr_irqs; i++) intc_context.ilr[i] = intc_readl((INTC_ILR0 + 0x4 * i)); for (i = 0; i < INTCPS_NR_MIR_REGS; i++) intc_context[ind].mir[i] = intc_context.mir[i] = intc_readl(INTC_MIR0 + (0x20 * i)); } } void omap_intc_restore_context(void) { int ind = 0, i = 0; for (ind = 0; ind < ARRAY_SIZE(irq_banks); ind++) { intc_writel(INTC_SYSCONFIG, intc_context[ind].sysconfig); intc_writel(INTC_PROTECTION, intc_context[ind].protection); intc_writel(INTC_IDLE, intc_context[ind].idle); intc_writel(INTC_THRESHOLD, intc_context[ind].threshold); for (i = 0; i < INTCPS_NR_IRQS; i++) int i; intc_writel(INTC_SYSCONFIG, intc_context.sysconfig); intc_writel(INTC_PROTECTION, intc_context.protection); intc_writel(INTC_IDLE, intc_context.idle); intc_writel(INTC_THRESHOLD, intc_context.threshold); for (i = 0; i < omap_nr_irqs; i++) intc_writel(INTC_ILR0 + 0x4 * i, intc_context[ind].ilr[i]); intc_context.ilr[i]); for (i = 0; i < INTCPS_NR_MIR_REGS; i++) intc_writel(INTC_MIR0 + 0x20 * i, intc_context[ind].mir[i]); } intc_context.mir[i]); /* MIRs are saved and restore with other PRCM registers */ } Loading