From 93bf62580a68533dc8252b9a2a055c02f34ecb67 Mon Sep 17 00:00:00 2001
From: Christian Cunningham <cc@localhost>
Date: Thu, 24 Mar 2022 09:38:08 -0700
Subject: Modularized

---
 kernel/exceptions/fiq.S | 27 +++++++++++++++++++++++++++
 1 file changed, 27 insertions(+)
 create mode 100644 kernel/exceptions/fiq.S

(limited to 'kernel/exceptions/fiq.S')

diff --git a/kernel/exceptions/fiq.S b/kernel/exceptions/fiq.S
new file mode 100644
index 0000000..005ed76
--- /dev/null
+++ b/kernel/exceptions/fiq.S
@@ -0,0 +1,27 @@
+.section ".text.exceptions"
+.globl fiq
+fiq:
+	cpsid aif
+	stmfd sp!, {r0-r12,lr}
+	bl c_fiq_handler
+	cmp r0, #1
+	bne 1f
+	// Schedule if interrupted a thread
+	mrs r1, spsr
+	and r1, r1, #0x1f
+	cmp r1, #0x10
+	bne 1f
+	ldmfd sp!, {r0-r12,lr}
+	// Don't skip missed instruction upon return
+	sub lr, #4
+	push {r3}
+	// Store the instruction in a special area for
+	//  future processing
+	ldr r3, =irqlr
+	str lr, [r3, #0]
+	pop {r3}
+	cps #0x13
+	b schedule
+1:
+	ldmfd sp!, {r0-r12,lr}
+	subs pc, lr, #4
-- 
cgit v1.2.1