arm: davinci: Use generic irq chip
Simple conversion which simply uses the fact that the second irq chip base address has offset 0x04 to the first one. Signed-off-by: Thomas Gleixner <tglx@linutronix.de> Reviewed-and-Tested-by: Kevin Hilman <khilman@ti.com> Tested-by: Sekhar Nori <nsekhar@ti.com>
This commit is contained in:
committed by
Sekhar Nori
parent
cfefd21e69
commit
aac4dd1dab
@@ -29,8 +29,6 @@
|
|||||||
#include <mach/common.h>
|
#include <mach/common.h>
|
||||||
#include <asm/mach/irq.h>
|
#include <asm/mach/irq.h>
|
||||||
|
|
||||||
#define IRQ_BIT(irq) ((irq) & 0x1f)
|
|
||||||
|
|
||||||
#define FIQ_REG0_OFFSET 0x0000
|
#define FIQ_REG0_OFFSET 0x0000
|
||||||
#define FIQ_REG1_OFFSET 0x0004
|
#define FIQ_REG1_OFFSET 0x0004
|
||||||
#define IRQ_REG0_OFFSET 0x0008
|
#define IRQ_REG0_OFFSET 0x0008
|
||||||
@@ -42,78 +40,33 @@
|
|||||||
#define IRQ_INTPRI0_REG_OFFSET 0x0030
|
#define IRQ_INTPRI0_REG_OFFSET 0x0030
|
||||||
#define IRQ_INTPRI7_REG_OFFSET 0x004C
|
#define IRQ_INTPRI7_REG_OFFSET 0x004C
|
||||||
|
|
||||||
static inline unsigned int davinci_irq_readl(int offset)
|
|
||||||
{
|
|
||||||
return __raw_readl(davinci_intc_base + offset);
|
|
||||||
}
|
|
||||||
|
|
||||||
static inline void davinci_irq_writel(unsigned long value, int offset)
|
static inline void davinci_irq_writel(unsigned long value, int offset)
|
||||||
{
|
{
|
||||||
__raw_writel(value, davinci_intc_base + offset);
|
__raw_writel(value, davinci_intc_base + offset);
|
||||||
}
|
}
|
||||||
|
|
||||||
/* Disable interrupt */
|
static __init void
|
||||||
static void davinci_mask_irq(struct irq_data *d)
|
davinci_alloc_gc(void __iomem *base, unsigned int irq_start, unsigned int num)
|
||||||
{
|
{
|
||||||
unsigned int mask;
|
struct irq_chip_generic *gc;
|
||||||
u32 l;
|
struct irq_chip_type *ct;
|
||||||
|
|
||||||
mask = 1 << IRQ_BIT(d->irq);
|
gc = irq_alloc_generic_chip("AINTC", 1, irq_start, base, handle_edge_irq);
|
||||||
|
ct = gc->chip_types;
|
||||||
|
ct->chip.irq_ack = irq_gc_ack;
|
||||||
|
ct->chip.irq_mask = irq_gc_mask_clr_bit;
|
||||||
|
ct->chip.irq_unmask = irq_gc_mask_set_bit;
|
||||||
|
|
||||||
if (d->irq > 31) {
|
ct->regs.ack = IRQ_REG0_OFFSET;
|
||||||
l = davinci_irq_readl(IRQ_ENT_REG1_OFFSET);
|
ct->regs.mask = IRQ_ENT_REG0_OFFSET;
|
||||||
l &= ~mask;
|
irq_setup_generic_chip(gc, IRQ_MSK(num), IRQ_GC_INIT_MASK_CACHE,
|
||||||
davinci_irq_writel(l, IRQ_ENT_REG1_OFFSET);
|
IRQ_NOREQUEST | IRQ_NOPROBE, 0);
|
||||||
} else {
|
|
||||||
l = davinci_irq_readl(IRQ_ENT_REG0_OFFSET);
|
|
||||||
l &= ~mask;
|
|
||||||
davinci_irq_writel(l, IRQ_ENT_REG0_OFFSET);
|
|
||||||
}
|
|
||||||
}
|
}
|
||||||
|
|
||||||
/* Enable interrupt */
|
|
||||||
static void davinci_unmask_irq(struct irq_data *d)
|
|
||||||
{
|
|
||||||
unsigned int mask;
|
|
||||||
u32 l;
|
|
||||||
|
|
||||||
mask = 1 << IRQ_BIT(d->irq);
|
|
||||||
|
|
||||||
if (d->irq > 31) {
|
|
||||||
l = davinci_irq_readl(IRQ_ENT_REG1_OFFSET);
|
|
||||||
l |= mask;
|
|
||||||
davinci_irq_writel(l, IRQ_ENT_REG1_OFFSET);
|
|
||||||
} else {
|
|
||||||
l = davinci_irq_readl(IRQ_ENT_REG0_OFFSET);
|
|
||||||
l |= mask;
|
|
||||||
davinci_irq_writel(l, IRQ_ENT_REG0_OFFSET);
|
|
||||||
}
|
|
||||||
}
|
|
||||||
|
|
||||||
/* EOI interrupt */
|
|
||||||
static void davinci_ack_irq(struct irq_data *d)
|
|
||||||
{
|
|
||||||
unsigned int mask;
|
|
||||||
|
|
||||||
mask = 1 << IRQ_BIT(d->irq);
|
|
||||||
|
|
||||||
if (d->irq > 31)
|
|
||||||
davinci_irq_writel(mask, IRQ_REG1_OFFSET);
|
|
||||||
else
|
|
||||||
davinci_irq_writel(mask, IRQ_REG0_OFFSET);
|
|
||||||
}
|
|
||||||
|
|
||||||
static struct irq_chip davinci_irq_chip_0 = {
|
|
||||||
.name = "AINTC",
|
|
||||||
.irq_ack = davinci_ack_irq,
|
|
||||||
.irq_mask = davinci_mask_irq,
|
|
||||||
.irq_unmask = davinci_unmask_irq,
|
|
||||||
};
|
|
||||||
|
|
||||||
/* ARM Interrupt Controller Initialization */
|
/* ARM Interrupt Controller Initialization */
|
||||||
void __init davinci_irq_init(void)
|
void __init davinci_irq_init(void)
|
||||||
{
|
{
|
||||||
unsigned i;
|
unsigned i, j;
|
||||||
const u8 *davinci_def_priorities = davinci_soc_info.intc_irq_prios;
|
const u8 *davinci_def_priorities = davinci_soc_info.intc_irq_prios;
|
||||||
|
|
||||||
davinci_intc_type = DAVINCI_INTC_TYPE_AINTC;
|
davinci_intc_type = DAVINCI_INTC_TYPE_AINTC;
|
||||||
@@ -144,7 +97,6 @@ void __init davinci_irq_init(void)
|
|||||||
davinci_irq_writel(~0x0, IRQ_REG1_OFFSET);
|
davinci_irq_writel(~0x0, IRQ_REG1_OFFSET);
|
||||||
|
|
||||||
for (i = IRQ_INTPRI0_REG_OFFSET; i <= IRQ_INTPRI7_REG_OFFSET; i += 4) {
|
for (i = IRQ_INTPRI0_REG_OFFSET; i <= IRQ_INTPRI7_REG_OFFSET; i += 4) {
|
||||||
unsigned j;
|
|
||||||
u32 pri;
|
u32 pri;
|
||||||
|
|
||||||
for (j = 0, pri = 0; j < 32; j += 4, davinci_def_priorities++)
|
for (j = 0, pri = 0; j < 32; j += 4, davinci_def_priorities++)
|
||||||
@@ -152,13 +104,8 @@ void __init davinci_irq_init(void)
|
|||||||
davinci_irq_writel(pri, i);
|
davinci_irq_writel(pri, i);
|
||||||
}
|
}
|
||||||
|
|
||||||
/* set up genirq dispatch for ARM INTC */
|
for (i = 0, j = 0; i < davinci_soc_info.intc_irq_num; i += 32, j += 0x04)
|
||||||
for (i = 0; i < davinci_soc_info.intc_irq_num; i++) {
|
davinci_alloc_gc(davinci_intc_base + j, i, 32);
|
||||||
irq_set_chip(i, &davinci_irq_chip_0);
|
|
||||||
set_irq_flags(i, IRQF_VALID | IRQF_PROBE);
|
irq_set_handler(IRQ_TINT1_TINT34, handle_level_irq);
|
||||||
if (i != IRQ_TINT1_TINT34)
|
|
||||||
irq_set_handler(i, handle_edge_irq);
|
|
||||||
else
|
|
||||||
irq_set_handler(i, handle_level_irq);
|
|
||||||
}
|
|
||||||
}
|
}
|
||||||
|
Reference in New Issue
Block a user