aboutsummaryrefslogtreecommitdiff
path: root/src/boot.S
diff options
context:
space:
mode:
authorChristian Cunningham <cc@localhost>2021-11-13 00:12:01 -0700
committerChristian Cunningham <cc@localhost>2021-11-13 00:12:01 -0700
commit524649007feb5f978fca83b5c885cd58481e0969 (patch)
treefe08358f843aec9fbc86cc0e709a57cba5d599cd /src/boot.S
parent5dd65b890ff476617869d2164bc2d652c6f68d2e (diff)
Fixed FIQ
Diffstat (limited to 'src/boot.S')
-rw-r--r--src/boot.S11
1 files changed, 7 insertions, 4 deletions
diff --git a/src/boot.S b/src/boot.S
index 17cc794..89a99cc 100644
--- a/src/boot.S
+++ b/src/boot.S
@@ -59,6 +59,11 @@ irq:
pop {r0,r1,r2,r3,r4,r5,r6,r7,r8,r9,r10,r11,r12,lr}
subs pc, lr, #4
+fiq:
+ push {r0,r1,r2,r3,r4,r5,r6,r7,r8,r9,r10,r11,r12,lr}
+ pop {r0,r1,r2,r3,r4,r5,r6,r7,r8,r9,r10,r11,r12,lr}
+ subs pc, lr, #4
+
.globl io_halt
io_halt:
wfi
@@ -76,7 +81,7 @@ disable_irq:
.globl enable_fiq
enable_fiq:
- cpsie i
+ cpsie f
bx lr
.globl disable_fiq
@@ -102,9 +107,7 @@ prefetch_handler: .word io_halt
data_handler: .word io_halt
unused_handler: .word io_halt
irq_handler: .word irq
-fiq_handler: .word io_halt
-//irq_handler: .word io_halt
-//fiq_handler: .word irq
+fiq_handler: .word fiq
.global a_irq_handler
a_irq_handler: