2009-01-08 23:27:22 +01:00
|
|
|
#include "hollywood.h"
|
|
|
|
|
#include "irq.h"
|
|
|
|
|
|
|
|
|
|
.globl v_irq
|
|
|
|
|
.globl irq_setup_stack
|
|
|
|
|
.globl irq_kill
|
|
|
|
|
.globl irq_restore
|
|
|
|
|
.extern __irqstack_addr
|
|
|
|
|
.extern irq_handler
|
|
|
|
|
|
|
|
|
|
irq_setup_stack:
|
|
|
|
|
@ Switch to IRQ mode
|
|
|
|
|
mrs r0, cpsr
|
2009-01-16 08:47:49 +01:00
|
|
|
msr cpsr_c, #0xd2
|
2009-01-08 23:27:22 +01:00
|
|
|
|
|
|
|
|
@ Setup interrupt stack
|
2009-01-16 08:47:49 +01:00
|
|
|
ldr sp, =__irqstack_addr
|
2009-01-08 23:27:22 +01:00
|
|
|
|
|
|
|
|
@ Restore mode
|
2009-01-16 08:47:49 +01:00
|
|
|
msr cpsr_c, r0
|
2009-01-08 23:27:22 +01:00
|
|
|
bx lr
|
|
|
|
|
|
|
|
|
|
v_irq:
|
|
|
|
|
push {r0-r3, r9, r12, lr}
|
|
|
|
|
|
|
|
|
|
blx irq_handler
|
|
|
|
|
|
|
|
|
|
pop {r0-r3, r9, r12, lr}
|
|
|
|
|
subs pc, lr, #4
|
|
|
|
|
|
|
|
|
|
irq_kill:
|
|
|
|
|
mrs r1, cpsr
|
|
|
|
|
and r0, r1, #(CPSR_IRQDIS|CPSR_FIQDIS)
|
|
|
|
|
orr r1, r1, #(CPSR_IRQDIS|CPSR_FIQDIS)
|
2009-01-16 08:47:49 +01:00
|
|
|
msr cpsr_c, r1
|
2009-01-08 23:27:22 +01:00
|
|
|
bx lr
|
|
|
|
|
|
|
|
|
|
irq_restore:
|
|
|
|
|
mrs r1, cpsr
|
|
|
|
|
bic r1, r1, #(CPSR_IRQDIS|CPSR_FIQDIS)
|
|
|
|
|
orr r1, r1, r0
|
2009-01-16 08:47:49 +01:00
|
|
|
msr cpsr_c, r1
|
2009-01-08 23:27:22 +01:00
|
|
|
bx lr
|
