Loading arch/arm/mach-sa1100/irq.c +34 −18 Original line number Diff line number Diff line Loading @@ -20,13 +20,19 @@ #include <soc/sa1100/pwer.h> #include <mach/hardware.h> #include <mach/irqs.h> #include <asm/mach/irq.h> #include <asm/exception.h> #include "generic.h" #define ICIP 0x00 /* IC IRQ Pending reg. */ #define ICMR 0x04 /* IC Mask Reg. */ #define ICLR 0x08 /* IC Level Reg. */ #define ICCR 0x0C /* IC Control Reg. */ #define ICFP 0x10 /* IC FIQ Pending reg. */ #define ICPR 0x20 /* IC Pending Reg. */ static void __iomem *iobase; /* * We don't need to ACK IRQs on the SA1100 unless they're GPIOs Loading @@ -34,12 +40,20 @@ */ static void sa1100_mask_irq(struct irq_data *d) { ICMR &= ~BIT(d->hwirq); u32 reg; reg = readl_relaxed(iobase + ICMR); reg &= ~BIT(d->hwirq); writel_relaxed(reg, iobase + ICMR); } static void sa1100_unmask_irq(struct irq_data *d) { ICMR |= BIT(d->hwirq); u32 reg; reg = readl_relaxed(iobase + ICMR); reg |= BIT(d->hwirq); writel_relaxed(reg, iobase + ICMR); } static int sa1100_set_wake(struct irq_data *d, unsigned int on) Loading Loading @@ -87,16 +101,14 @@ static int sa1100irq_suspend(void) struct sa1100irq_state *st = &sa1100irq_state; st->saved = 1; st->icmr = ICMR; st->iclr = ICLR; st->iccr = ICCR; st->icmr = readl_relaxed(iobase + ICMR); st->iclr = readl_relaxed(iobase + ICLR); st->iccr = readl_relaxed(iobase + ICCR); /* * Disable all GPIO-based interrupts. */ ICMR &= ~(IC_GPIO11_27|IC_GPIO10|IC_GPIO9|IC_GPIO8|IC_GPIO7| IC_GPIO6|IC_GPIO5|IC_GPIO4|IC_GPIO3|IC_GPIO2| IC_GPIO1|IC_GPIO0); writel_relaxed(st->icmr & 0xfffff000, iobase + ICMR); return 0; } Loading @@ -106,10 +118,10 @@ static void sa1100irq_resume(void) struct sa1100irq_state *st = &sa1100irq_state; if (st->saved) { ICCR = st->iccr; ICLR = st->iclr; writel_relaxed(st->iccr, iobase + ICCR); writel_relaxed(st->iclr, iobase + ICLR); ICMR = st->icmr; writel_relaxed(st->icmr, iobase + ICMR); } } Loading @@ -132,8 +144,8 @@ sa1100_handle_irq(struct pt_regs *regs) uint32_t icip, icmr, mask; do { icip = (ICIP); icmr = (ICMR); icip = readl_relaxed(iobase + ICIP); icmr = readl_relaxed(iobase + ICMR); mask = icip & icmr; if (mask == 0) Loading @@ -148,17 +160,21 @@ void __init sa1100_init_irq(void) { request_resource(&iomem_resource, &irq_resource); iobase = ioremap(irq_resource.start, SZ_64K); if (WARN_ON(!iobase)) return; /* disable all IRQs */ ICMR = 0; writel_relaxed(0, iobase + ICMR); /* all IRQs are IRQ, not FIQ */ ICLR = 0; writel_relaxed(0, iobase + ICLR); /* * Whatever the doc says, this has to be set for the wait-on-irq * instruction to work... on a SA1100 rev 9 at least. */ ICCR = 1; writel_relaxed(1, iobase + ICCR); sa1100_normal_irqdomain = irq_domain_add_simple(NULL, 32, IRQ_GPIO0_SC, Loading Loading
arch/arm/mach-sa1100/irq.c +34 −18 Original line number Diff line number Diff line Loading @@ -20,13 +20,19 @@ #include <soc/sa1100/pwer.h> #include <mach/hardware.h> #include <mach/irqs.h> #include <asm/mach/irq.h> #include <asm/exception.h> #include "generic.h" #define ICIP 0x00 /* IC IRQ Pending reg. */ #define ICMR 0x04 /* IC Mask Reg. */ #define ICLR 0x08 /* IC Level Reg. */ #define ICCR 0x0C /* IC Control Reg. */ #define ICFP 0x10 /* IC FIQ Pending reg. */ #define ICPR 0x20 /* IC Pending Reg. */ static void __iomem *iobase; /* * We don't need to ACK IRQs on the SA1100 unless they're GPIOs Loading @@ -34,12 +40,20 @@ */ static void sa1100_mask_irq(struct irq_data *d) { ICMR &= ~BIT(d->hwirq); u32 reg; reg = readl_relaxed(iobase + ICMR); reg &= ~BIT(d->hwirq); writel_relaxed(reg, iobase + ICMR); } static void sa1100_unmask_irq(struct irq_data *d) { ICMR |= BIT(d->hwirq); u32 reg; reg = readl_relaxed(iobase + ICMR); reg |= BIT(d->hwirq); writel_relaxed(reg, iobase + ICMR); } static int sa1100_set_wake(struct irq_data *d, unsigned int on) Loading Loading @@ -87,16 +101,14 @@ static int sa1100irq_suspend(void) struct sa1100irq_state *st = &sa1100irq_state; st->saved = 1; st->icmr = ICMR; st->iclr = ICLR; st->iccr = ICCR; st->icmr = readl_relaxed(iobase + ICMR); st->iclr = readl_relaxed(iobase + ICLR); st->iccr = readl_relaxed(iobase + ICCR); /* * Disable all GPIO-based interrupts. */ ICMR &= ~(IC_GPIO11_27|IC_GPIO10|IC_GPIO9|IC_GPIO8|IC_GPIO7| IC_GPIO6|IC_GPIO5|IC_GPIO4|IC_GPIO3|IC_GPIO2| IC_GPIO1|IC_GPIO0); writel_relaxed(st->icmr & 0xfffff000, iobase + ICMR); return 0; } Loading @@ -106,10 +118,10 @@ static void sa1100irq_resume(void) struct sa1100irq_state *st = &sa1100irq_state; if (st->saved) { ICCR = st->iccr; ICLR = st->iclr; writel_relaxed(st->iccr, iobase + ICCR); writel_relaxed(st->iclr, iobase + ICLR); ICMR = st->icmr; writel_relaxed(st->icmr, iobase + ICMR); } } Loading @@ -132,8 +144,8 @@ sa1100_handle_irq(struct pt_regs *regs) uint32_t icip, icmr, mask; do { icip = (ICIP); icmr = (ICMR); icip = readl_relaxed(iobase + ICIP); icmr = readl_relaxed(iobase + ICMR); mask = icip & icmr; if (mask == 0) Loading @@ -148,17 +160,21 @@ void __init sa1100_init_irq(void) { request_resource(&iomem_resource, &irq_resource); iobase = ioremap(irq_resource.start, SZ_64K); if (WARN_ON(!iobase)) return; /* disable all IRQs */ ICMR = 0; writel_relaxed(0, iobase + ICMR); /* all IRQs are IRQ, not FIQ */ ICLR = 0; writel_relaxed(0, iobase + ICLR); /* * Whatever the doc says, this has to be set for the wait-on-irq * instruction to work... on a SA1100 rev 9 at least. */ ICCR = 1; writel_relaxed(1, iobase + ICCR); sa1100_normal_irqdomain = irq_domain_add_simple(NULL, 32, IRQ_GPIO0_SC, Loading