arm9 OS_irqTable

4 files changed, 134 insertions, 163 deletions

diff --git a/arm9/asm/OS_irqTable.s b/arm9/asm/OS_irqTable.s
deleted file mode 100644
index e42d600b..00000000
--- a/arm9/asm/OS_irqTable.s
+++ /dev/null
@@ -1,163 +0,0 @@
-	.include "asm/macros.inc"
-	.include "global.inc"
-
-	; pragma section DTCM begin
-    .section .dtcm
-	.balign 16, 0
-	.global OS_IRQTable
-OS_IRQTable: ; 027E0000 ;10b6a0
-	.word OS_IrqDummy
-	.word OS_IrqDummy
-	.word OS_IrqDummy
-	.word OSi_IrqTimer0
-	.word OSi_IrqTimer1
-	.word OSi_IrqTimer2
-	.word OSi_IrqTimer3
-	.word OS_IrqDummy
-	.word OSi_IrqDma0
-	.word OSi_IrqDma1
-	.word OSi_IrqDma2
-	.word OSi_IrqDma3
-	.word OS_IrqDummy
-	.word OS_IrqDummy
-	.word OS_IrqDummy
-	.word OS_IrqDummy
-	.word OS_IrqDummy
-	.word OS_IrqDummy
-	.word OS_IrqDummy
-	.word OS_IrqDummy
-	.word OS_IrqDummy
-	.word OS_IrqDummy
-
-	; pragma section DTCM end
-
-	.section .bss
-	.global OSi_IrqCallbackInfo
-OSi_IrqCallbackInfo: ; 0x021D341C
-	.space 0x60
-
-	.section .data
-	.global OSi_IrqCallbackInfoIndex
-OSi_IrqCallbackInfoIndex: ; 0x02106818
-	.short  8
-	.short  9
-	.short 10
-	.short 11
-	.short  3
-	.short  4
-	.short  5
-	.short  6
-
-    .section .text
-
-	arm_func_start OSi_IrqTimer3
-OSi_IrqTimer3: ; 0x020C9C8C
-	ldr ip, _020C9C98 ; =OSi_IrqCallback
-	mov r0, #0x7
-	bx r12
-	.balign 4
-_020C9C98: .word OSi_IrqCallback
-
-	arm_func_start OSi_IrqTimer2
-OSi_IrqTimer2: ; 0x020C9C9C
-	ldr ip, _020C9CA8 ; =OSi_IrqCallback
-	mov r0, #0x6
-	bx r12
-	.balign 4
-_020C9CA8: .word OSi_IrqCallback
-
-	arm_func_start OSi_IrqTimer1
-OSi_IrqTimer1: ; 0x020C9CAC
-	ldr ip, _020C9CB8 ; =OSi_IrqCallback
-	mov r0, #0x5
-	bx r12
-	.balign 4
-_020C9CB8: .word OSi_IrqCallback
-
-	arm_func_start OSi_IrqTimer0
-OSi_IrqTimer0: ; 0x020C9CBC
-	ldr ip, _020C9CC8 ; =OSi_IrqCallback
-	mov r0, #0x4
-	bx r12
-	.balign 4
-_020C9CC8: .word OSi_IrqCallback
-
-	arm_func_start OSi_IrqDma3
-OSi_IrqDma3: ; 0x020C9CCC
-	ldr ip, _020C9CD8 ; =OSi_IrqCallback
-	mov r0, #0x3
-	bx r12
-	.balign 4
-_020C9CD8: .word OSi_IrqCallback
-
-	arm_func_start OSi_IrqDma2
-OSi_IrqDma2: ; 0x020C9CDC
-	ldr ip, _020C9CE8 ; =OSi_IrqCallback
-	mov r0, #0x2
-	bx r12
-	.balign 4
-_020C9CE8: .word OSi_IrqCallback
-
-	arm_func_start OSi_IrqDma1
-OSi_IrqDma1: ; 0x020C9CEC
-	ldr ip, _020C9CF8 ; =OSi_IrqCallback
-	mov r0, #0x1
-	bx r12
-	.balign 4
-_020C9CF8: .word OSi_IrqCallback
-
-	arm_func_start OSi_IrqDma0
-OSi_IrqDma0: ; 0x020C9CFC
-	ldr ip, _020C9D08 ; =OSi_IrqCallback
-	mov r0, #0x0
-	bx r12
-	.balign 4
-_020C9D08: .word OSi_IrqCallback
-
-	arm_func_start OSi_IrqCallback
-OSi_IrqCallback: ; 0x020C9D0C
-	stmdb sp!, {r4-r5,lr}
-	sub sp, sp, #0x4
-	mov r1, #0xc
-	mul r4, r0, r1
-	ldr r2, _020C9D94 ; =OSi_IrqCallbackInfo
-	ldr r3, _020C9D98 ; =OSi_IrqCallbackInfoIndex
-	mov r0, r0, lsl #0x1
-	ldr r1, [r2, r4]
-	ldrh r3, [r3, r0]
-	mov r5, #0x1
-	mov r0, #0x0
-	str r0, [r2, r4]
-	cmp r1, #0x0
-	mov r5, r5, lsl r3
-	beq _020C9D54
-	ldr r0, _020C9D9C ; =OSi_IrqCallbackInfo + 8
-	ldr r0, [r0, r4]
-	blx r1
-_020C9D54:
-	ldr r0, _020C9DA0 ; =SDK_AUTOLOAD_DTCM_START
-	ldr r1, _020C9DA4 ; =OSi_IrqCallbackInfo + 4
-	add r0, r0, #0x3000
-	ldr r2, [r0, #0xff8]
-	orr r2, r2, r5
-	str r2, [r0, #0xff8]
-	ldr r0, [r1, r4]
-	cmp r0, #0x0
-	addne sp, sp, #0x4
-	ldmneia sp!, {r4-r5,lr}
-	bxne lr
-	mov r0, r5
-	bl OS_DisableIrqMask
-	add sp, sp, #0x4
-	ldmia sp!, {r4-r5,lr}
-	bx lr
-	.balign 4
-_020C9D94: .word OSi_IrqCallbackInfo
-_020C9D98: .word OSi_IrqCallbackInfoIndex
-_020C9D9C: .word OSi_IrqCallbackInfo + 8
-_020C9DA0: .word SDK_AUTOLOAD_DTCM_START
-_020C9DA4: .word OSi_IrqCallbackInfo + 4
-
-	arm_func_start OS_IrqDummy
-OS_IrqDummy: ; 0x020C9DA8
-	bx lr
diff --git a/arm9/lib/include/OS_init.h b/arm9/lib/include/OS_init.h
index baa2f442..3c8aea24 100644
--- a/arm9/lib/include/OS_init.h
+++ b/arm9/lib/include/OS_init.h
@@ -19,6 +19,7 @@
 #include "OS_system.h"
 #include "OS_terminate_proc.h"
 #include "OS_irqHandler.h"
+#include "OS_irqTable.h"
 #include "OS_interrupt.h"
 #include "OS_reset.h"
 #include "OS_spinLock.h"
diff --git a/arm9/lib/include/OS_irqTable.h b/arm9/lib/include/OS_irqTable.h
new file mode 100644
index 00000000..8cd7b7b3
--- /dev/null
+++ b/arm9/lib/include/OS_irqTable.h
@@ -0,0 +1,23 @@
+#ifndef POKEDIAMOND_OS_IRQTABLE_H
+#define POKEDIAMOND_OS_IRQTABLE_H
+
+#include "consts.h"
+#include "OS_interrupt.h"
+
+void OS_IrqDummy(void);
+void OSi_IrqCallback(s32 index);
+void OSi_IrqDma0(void);
+void OSi_IrqDma1(void);
+void OSi_IrqDma2(void);
+void OSi_IrqDma3(void);
+void OSi_IrqTimer0(void);
+void OSi_IrqTimer1(void);
+void OSi_IrqTimer2(void);
+void OSi_IrqTimer3(void);
+
+static inline void OS_SetIrqCheckFlag(OSIrqMask intr)
+{
+    *(vu32 *)HW_INTR_CHECK_BUF |= (u32)intr;
+}
+
+#endif //POKEDIAMOND_OS_IRQTABLE_H
diff --git a/arm9/lib/src/OS_irqTable.c b/arm9/lib/src/OS_irqTable.c
new file mode 100644
index 00000000..cc2a3a55
--- /dev/null
+++ b/arm9/lib/src/OS_irqTable.c
@@ -0,0 +1,110 @@
+#include "function_target.h"
+#include "sections.h"
+#include "OS_irqTable.h"
+
+#pragma section DTCM begin
+OSIrqFunction OS_IRQTable[22] = {
+        OS_IrqDummy,
+        OS_IrqDummy,
+        OS_IrqDummy,
+        OSi_IrqTimer0,
+        OSi_IrqTimer1,
+        OSi_IrqTimer2,
+        OSi_IrqTimer3,
+        OS_IrqDummy,
+        OSi_IrqDma0,
+        OSi_IrqDma1,
+        OSi_IrqDma2,
+        OSi_IrqDma3,
+        OS_IrqDummy,
+        OS_IrqDummy,
+        OS_IrqDummy,
+        OS_IrqDummy,
+        OS_IrqDummy,
+        OS_IrqDummy,
+        OS_IrqDummy,
+        OS_IrqDummy,
+        OS_IrqDummy,
+        OS_IrqDummy
+};
+#pragma section DTCM end
+
+OSIrqCallbackInfo OSi_IrqCallbackInfo[8] = {
+        {NULL, 0, 0},
+        {NULL, 0, 0},
+        {NULL, 0, 0},
+        {NULL, 0, 0},
+        {NULL, 0, 0},
+        {NULL, 0, 0},
+        {NULL, 0, 0},
+        {NULL, 0, 0},
+};
+
+static u16 OSi_IrqCallbackInfoIndex[8] = {
+        8, 9, 10, 11, 3, 4, 5, 6
+};
+
+ARM_FUNC void OS_IrqDummy(void)
+{
+    //noop
+}
+
+ARM_FUNC void OSi_IrqCallback(s32 index)
+{
+    OSIrqMask mask = (1UL << OSi_IrqCallbackInfoIndex[index]);
+    void (*callback)(void *) = OSi_IrqCallbackInfo[index].func;
+
+    OSi_IrqCallbackInfo[index].func = NULL;
+
+    if (callback)
+    {
+        (callback)(OSi_IrqCallbackInfo[index].arg);
+    }
+
+    OS_SetIrqCheckFlag(mask);
+
+    if (!OSi_IrqCallbackInfo[index].enable)
+    {
+        (void)OS_DisableIrqMask(mask);
+    }
+}
+
+ARM_FUNC void OSi_IrqDma0(void)
+{
+    OSi_IrqCallback(0);
+}
+
+ARM_FUNC void OSi_IrqDma1(void)
+{
+    OSi_IrqCallback(1);
+}
+
+ARM_FUNC void OSi_IrqDma2(void)
+{
+    OSi_IrqCallback(2);
+}
+
+ARM_FUNC void OSi_IrqDma3(void)
+{
+    OSi_IrqCallback(3);
+}
+
+ARM_FUNC void OSi_IrqTimer0(void)
+{
+    OSi_IrqCallback(4);
+}
+
+ARM_FUNC void OSi_IrqTimer1(void)
+{
+    OSi_IrqCallback(5);
+}
+
+ARM_FUNC void OSi_IrqTimer2(void)
+{
+    OSi_IrqCallback(6);
+}
+
+ARM_FUNC void OSi_IrqTimer3(void)
+{
+    OSi_IrqCallback(7);
+}