From 524649007feb5f978fca83b5c885cd58481e0969 Mon Sep 17 00:00:00 2001
From: Christian Cunningham <cc@localhost>
Date: Sat, 13 Nov 2021 00:12:01 -0700
Subject: Fixed FIQ

---
 src/boot.S | 11 +++++++----
 1 file changed, 7 insertions(+), 4 deletions(-)

(limited to 'src/boot.S')

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:
-- 
cgit v1.2.1