Merge remote-tracking branch 'origin/master' into pikalax_work

1 files changed, 77 insertions, 0 deletions

diff --git a/arm9/lib/NitroSDK/src/OS_system.c b/arm9/lib/NitroSDK/src/OS_system.c
new file mode 100644
index 00000000..f5f5faba
--- /dev/null
+++ b/arm9/lib/NitroSDK/src/OS_system.c
@@ -0,0 +1,77 @@
+#include "OS_system.h"
+#include "OS_irqHandler.h"
+#include "syscall.h"
+
+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(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(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 OSIntrMode OS_GetCpsrIrq(void)
+{
+    mrs r0, cpsr
+    and r0, r0, #HW_PSR_DISABLE_IRQ
+    bx lr
+}
+
+ARM_FUNC asm OSProcMode OS_GetProcMode(void)
+{
+    mrs r0, cpsr
+    and r0, r0, #HW_PSR_CPU_MODE_MASK
+    bx lr
+}
+
+ARM_FUNC asm void OS_SpinWait(u32 cycles)
+{
+    subs r0, r0, #0x4
+    bhs OS_SpinWait
+    bx lr
+}
+
+ARM_FUNC void OS_WaitVBlankIntr(void)
+{
+    SVC_WaitByLoop(0x1);
+    OS_WaitIrq(TRUE, OS_IE_V_BLANK);
+}