CRIS: v32: Better irq mapping code
Signed-off-by: Jesper Nilsson <jesper.nilsson@axis.com>
This commit is contained in:
parent
403a1c4f13
commit
e75a320eda
|
@ -97,7 +97,11 @@ extern void breakh_BUG(void);
|
|||
/*
|
||||
* Build the IRQ handler stubs using macros from irq.h.
|
||||
*/
|
||||
#ifdef CONFIG_CRIS_MACH_ARTPEC3
|
||||
BUILD_TIMER_IRQ(0x31, 0)
|
||||
#else
|
||||
BUILD_IRQ(0x31)
|
||||
#endif
|
||||
BUILD_IRQ(0x32)
|
||||
BUILD_IRQ(0x33)
|
||||
BUILD_IRQ(0x34)
|
||||
|
@ -123,7 +127,11 @@ BUILD_IRQ(0x47)
|
|||
BUILD_IRQ(0x48)
|
||||
BUILD_IRQ(0x49)
|
||||
BUILD_IRQ(0x4a)
|
||||
#ifdef CONFIG_ETRAXFS
|
||||
BUILD_TIMER_IRQ(0x4b, 0)
|
||||
#else
|
||||
BUILD_IRQ(0x4b)
|
||||
#endif
|
||||
BUILD_IRQ(0x4c)
|
||||
BUILD_IRQ(0x4d)
|
||||
BUILD_IRQ(0x4e)
|
||||
|
@ -199,25 +207,20 @@ block_irq(int irq, int cpu)
|
|||
unsigned long flags;
|
||||
|
||||
spin_lock_irqsave(&irq_lock, flags);
|
||||
if (irq - FIRST_IRQ < 32)
|
||||
/* Remember, 1 let thru, 0 block. */
|
||||
if (irq - FIRST_IRQ < 32) {
|
||||
intr_mask = REG_RD_INT_VECT(intr_vect, irq_regs[cpu],
|
||||
rw_mask, 0);
|
||||
else
|
||||
intr_mask = REG_RD_INT_VECT(intr_vect, irq_regs[cpu],
|
||||
rw_mask, 1);
|
||||
|
||||
/* Remember; 1 let thru, 0 block. */
|
||||
if (irq - FIRST_IRQ < 32)
|
||||
intr_mask &= ~(1 << (irq - FIRST_IRQ));
|
||||
else
|
||||
intr_mask &= ~(1 << (irq - FIRST_IRQ - 32));
|
||||
|
||||
if (irq - FIRST_IRQ < 32)
|
||||
REG_WR_INT_VECT(intr_vect, irq_regs[cpu], rw_mask,
|
||||
0, intr_mask);
|
||||
else
|
||||
} else {
|
||||
intr_mask = REG_RD_INT_VECT(intr_vect, irq_regs[cpu],
|
||||
rw_mask, 1);
|
||||
intr_mask &= ~(1 << (irq - FIRST_IRQ - 32));
|
||||
REG_WR_INT_VECT(intr_vect, irq_regs[cpu], rw_mask,
|
||||
1, intr_mask);
|
||||
}
|
||||
spin_unlock_irqrestore(&irq_lock, flags);
|
||||
}
|
||||
|
||||
|
@ -228,26 +231,20 @@ unblock_irq(int irq, int cpu)
|
|||
unsigned long flags;
|
||||
|
||||
spin_lock_irqsave(&irq_lock, flags);
|
||||
if (irq - FIRST_IRQ < 32)
|
||||
/* Remember, 1 let thru, 0 block. */
|
||||
if (irq - FIRST_IRQ < 32) {
|
||||
intr_mask = REG_RD_INT_VECT(intr_vect, irq_regs[cpu],
|
||||
rw_mask, 0);
|
||||
else
|
||||
intr_mask = REG_RD_INT_VECT(intr_vect, irq_regs[cpu],
|
||||
rw_mask, 1);
|
||||
|
||||
/* Remember; 1 let thru, 0 block. */
|
||||
if (irq - FIRST_IRQ < 32)
|
||||
intr_mask |= (1 << (irq - FIRST_IRQ));
|
||||
else
|
||||
intr_mask |= (1 << (irq - FIRST_IRQ - 32));
|
||||
|
||||
if (irq - FIRST_IRQ < 32)
|
||||
REG_WR_INT_VECT(intr_vect, irq_regs[cpu], rw_mask,
|
||||
0, intr_mask);
|
||||
else
|
||||
} else {
|
||||
intr_mask = REG_RD_INT_VECT(intr_vect, irq_regs[cpu],
|
||||
rw_mask, 1);
|
||||
intr_mask |= (1 << (irq - FIRST_IRQ - 32));
|
||||
REG_WR_INT_VECT(intr_vect, irq_regs[cpu], rw_mask,
|
||||
1, intr_mask);
|
||||
|
||||
}
|
||||
spin_unlock_irqrestore(&irq_lock, flags);
|
||||
}
|
||||
|
||||
|
|
Loading…
Reference in New Issue