From 3e8104ab13d257389a695e1db56ddc77c10a1bc8 Mon Sep 17 00:00:00 2001
From: Christian Cunningham <cc@localhost>
Date: Thu, 14 Oct 2021 14:24:43 -0700
Subject: Added FIQ

---
 src/boot.S | 14 +++++++++++++-
 1 file changed, 13 insertions(+), 1 deletion(-)

(limited to 'src/boot.S')

diff --git a/src/boot.S b/src/boot.S
index f0caebc..17cc794 100644
--- a/src/boot.S
+++ b/src/boot.S
@@ -14,7 +14,7 @@ reset:
 
     // set vector address.
     ldr r0, =vector
-    mcR P15, 0, r0, c12, c0, 0
+    mcr p15, 0, r0, c12, c0, 0
 
     // save cpsr.
     mrs r0, cpsr
@@ -74,6 +74,16 @@ disable_irq:
     cpsid i
     bx lr
 
+.globl enable_fiq
+enable_fiq:
+    cpsie i
+    bx lr
+
+.globl disable_fiq
+disable_fiq:
+    cpsid f
+    bx lr
+
 .align 5
 vector:
     ldr pc, reset_handler
@@ -93,6 +103,8 @@ 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
 
 .global a_irq_handler
 a_irq_handler:
-- 
cgit v1.2.1