Commit d2c37068 authored by Haojian Zhuang's avatar Haojian Zhuang Committed by Eric Miao

[ARM] pxa: initialize default interrupt priority and use ICHP for IRQ handling

Signed-off-by: default avatarHaojian Zhuang <haojian.zhuang@marvell.com>
Signed-off-by: default avatarEric Miao <eric.y.miao@gmail.com>
parent 6ba39282
...@@ -24,34 +24,27 @@ ...@@ -24,34 +24,27 @@
mov \tmp, \tmp, lsr #13 mov \tmp, \tmp, lsr #13
and \tmp, \tmp, #0x7 @ Core G and \tmp, \tmp, #0x7 @ Core G
cmp \tmp, #1 cmp \tmp, #1
bhi 1004f bhi 1002f
@ Core Generation 1 (PXA25x)
mov \base, #io_p2v(0x40000000) @ IIR Ctl = 0x40d00000 mov \base, #io_p2v(0x40000000) @ IIR Ctl = 0x40d00000
add \base, \base, #0x00d00000 add \base, \base, #0x00d00000
ldr \irqstat, [\base, #0] @ ICIP ldr \irqstat, [\base, #0] @ ICIP
ldr \irqnr, [\base, #4] @ ICMR ldr \irqnr, [\base, #4] @ ICMR
b 1002f
1004:
mrc p6, 0, \irqstat, c6, c0, 0 @ ICIP2
mrc p6, 0, \irqnr, c7, c0, 0 @ ICMR2
ands \irqnr, \irqstat, \irqnr ands \irqnr, \irqstat, \irqnr
beq 1003f beq 1001f
rsb \irqstat, \irqnr, #0 rsb \irqstat, \irqnr, #0
and \irqstat, \irqstat, \irqnr and \irqstat, \irqstat, \irqnr
clz \irqnr, \irqstat clz \irqnr, \irqstat
rsb \irqnr, \irqnr, #31 rsb \irqnr, \irqnr, #(31 + PXA_IRQ(0))
add \irqnr, \irqnr, #(32 + PXA_IRQ(0))
b 1001f b 1001f
1003:
mrc p6, 0, \irqstat, c0, c0, 0 @ ICIP
mrc p6, 0, \irqnr, c1, c0, 0 @ ICMR
1002: 1002:
ands \irqnr, \irqstat, \irqnr @ Core Generation 2 (PXA27x) or Core Generation 3 (PXA3xx)
mrc p6, 0, \irqstat, c5, c0, 0 @ ICHP
tst \irqstat, #0x80000000
beq 1001f beq 1001f
rsb \irqstat, \irqnr, #0 bic \irqstat, \irqstat, #0x80000000
and \irqstat, \irqstat, \irqnr mov \irqnr, \irqstat, lsr #16
clz \irqnr, \irqstat
rsb \irqnr, \irqnr, #(31 + PXA_IRQ(0))
1001: 1001:
.endm .endm
...@@ -120,7 +120,7 @@ static void __init pxa_init_low_gpio_irq(set_wake_t fn) ...@@ -120,7 +120,7 @@ static void __init pxa_init_low_gpio_irq(set_wake_t fn)
void __init pxa_init_irq(int irq_nr, set_wake_t fn) void __init pxa_init_irq(int irq_nr, set_wake_t fn)
{ {
int irq; int irq, i;
pxa_internal_irq_nr = irq_nr; pxa_internal_irq_nr = irq_nr;
...@@ -129,6 +129,12 @@ void __init pxa_init_irq(int irq_nr, set_wake_t fn) ...@@ -129,6 +129,12 @@ void __init pxa_init_irq(int irq_nr, set_wake_t fn)
_ICLR(irq) = 0; /* all IRQs are IRQ, not FIQ */ _ICLR(irq) = 0; /* all IRQs are IRQ, not FIQ */
} }
/* initialize interrupt priority */
if (cpu_is_pxa27x() || cpu_is_pxa3xx()) {
for (i = 0; i < irq_nr; i++)
IPR(i) = i | (1 << 31);
}
/* only unmasked interrupts kick us out of idle */ /* only unmasked interrupts kick us out of idle */
ICCR = 1; ICCR = 1;
......
Markdown is supported
0%
or
You are about to add 0 people to the discussion. Proceed with caution.
Finish editing this message first!
Please register or to comment