From 89fa3666e18a80632238471840de1df792409fcb Mon Sep 17 00:00:00 2001
From: red031000 <rubenru09@aol.com>
Date: Wed, 3 Jun 2020 19:26:33 +0100
Subject: split valarm and decomp system

---
 arm7/lib/src/OS_system.c | 65 ++++++++++++++++++++++++++++++++++++++++++++++++
 1 file changed, 65 insertions(+)
 create mode 100644 arm7/lib/src/OS_system.c

(limited to 'arm7/lib/src')

diff --git a/arm7/lib/src/OS_system.c b/arm7/lib/src/OS_system.c
new file mode 100644
index 00000000..120eddbf
--- /dev/null
+++ b/arm7/lib/src/OS_system.c
@@ -0,0 +1,65 @@
+#include "function_target.h"
+#include "OS_system.h"
+
+#pragma optimize_for_size on
+
+extern void FUN_037F8CB4(s32 count);
+
+ARM_FUNC asm OSIntrMode OS_EnableInterrupts(void)
+{
+    mrs	r0, CPSR
+    bic	r1, r0, #HW_PSR_DISABLE_IRQ
+    msr	CPSR_c, r1
+    and	r0, r0, #HW_PSR_DISABLE_IRQ
+    bx	lr
+}
+
+ARM_FUNC asm OSIntrMode OS_DisableInterrupts(void)
+{
+    mrs	r0, CPSR
+    orr	r1, r0, #HW_PSR_DISABLE_IRQ
+    msr	CPSR_c, r1
+    and	r0, r0, #HW_PSR_DISABLE_IRQ
+    bx	lr
+}
+
+ARM_FUNC asm OSIntrMode OS_RestoreInterrupts(register OSIntrMode state)
+{
+    mrs	r1, CPSR
+    bic	r2, r1, #HW_PSR_DISABLE_IRQ
+    orr	r2, r2, r0
+    msr	CPSR_c, r2
+    and	r0, r1, #HW_PSR_DISABLE_IRQ
+    bx	lr
+}
+
+ARM_FUNC asm OSIntrMode OS_DisableInterrupts_IrqAndFiq(void)
+{
+    mrs	r0, CPSR
+    orr	r1, r0, #HW_PSR_DISABLE_IRQ_FIQ
+    msr	CPSR_c, r1
+    and	r0, r0, #HW_PSR_DISABLE_IRQ_FIQ
+    bx	lr
+}
+
+ARM_FUNC asm OSIntrMode OS_RestoreInterrupts_IrqAndFiq(register OSIntrMode state)
+{
+    mrs	r1, CPSR
+    bic	r2, r1, #HW_PSR_DISABLE_IRQ_FIQ
+    orr	r2, r2, r0
+    msr	CPSR_c, r2
+    and	r0, r1, #HW_PSR_DISABLE_IRQ_FIQ
+    bx	lr
+}
+
+ARM_FUNC asm OSProcMode OS_GetProcMode(void)
+{
+    mrs	r0, CPSR
+    and	r0, r0, #HW_PSR_CPU_MODE_MASK
+    bx	lr
+}
+
+ARM_FUNC void OS_SpinWait(u32 cycle)
+{
+    FUN_037F8CB4((s32)cycle / 4);
+}
-- 
cgit v1.2.3