2009-04-13 22:13:45 +02:00
|
|
|
/*
|
|
|
|
|
mini - a Free Software replacement for the Nintendo/BroadOn IOS.
|
2009-04-13 23:00:22 +02:00
|
|
|
IRQ support
|
2009-04-13 22:13:45 +02:00
|
|
|
|
|
|
|
|
Copyright (C) 2008, 2009 Hector Martin "marcan" <marcan@marcansoft.com>
|
|
|
|
|
|
2009-05-11 07:53:16 +02:00
|
|
|
# This code is licensed to you under the terms of the GNU GPL, version 2;
|
|
|
|
|
# see file COPYING or http://www.gnu.org/licenses/old-licenses/gpl-2.0.txt
|
2009-04-13 22:13:45 +02:00
|
|
|
*/
|
2009-05-11 07:53:16 +02:00
|
|
|
|
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
|
2009-04-13 22:13:45 +02:00
|
|
|
|
