arm9 OS_cache

4 files changed, 129 insertions, 8 deletions

diff --git a/arm9/lib/src/OS_cache.c b/arm9/lib/src/OS_cache.c
new file mode 100644
index 00000000..8b202fda
--- /dev/null
+++ b/arm9/lib/src/OS_cache.c
@@ -0,0 +1,126 @@
+#include "OS_cache.h"
+#include "nitro/types.h"
+#include "function_target.h"
+
+ARM_FUNC asm void DC_InvalidateAll(void)
+{
+    mov r0, #0
+    mcr p15, 0, r0, c7, c6, 0 //Invalidate Entire Data Cache
+    bx lr
+}
+
+ARM_FUNC asm void DC_StoreAll(void)
+{
+    mov r1, #0
+
+_020CC0C8:
+    mov r0, #0
+
+_020CC0CC:
+    orr r2, r1, r0
+    mcr p15, 0, r2, c7, c10, 2 //Clean Data Cache Line Set/Index
+    add r0, r0, #32
+    cmp r0, #0x400
+    blt _020CC0CC
+
+    add r1, r1, #0x40000000
+    cmp r1, #0
+    bne _020CC0C8
+
+    bx lr
+}
+
+ARM_FUNC asm void DC_FlushAll(void)
+{
+    mov r12, #0
+    mov r1, #0
+
+_020CC0F8:
+    mov r0, #0
+
+_020CC0FC:
+    orr r2, r1, r0
+    mcr p15, 0, r12, c7, c10, 4 //Drain Write Buffer
+    mcr p15, 0, r2, c7, c14, 2 //Clean and Invalidate Data Cache Line Set/Index
+    add r0, r0, #32
+    cmp r0, #0x400
+    blt _020CC0FC
+
+    add r1, r1, #0x40000000
+    cmp r1, #0
+    bne _020CC0F8
+
+    bx lr
+}
+
+ARM_FUNC asm void DC_InvalidateRange(register void *startAddr, register u32 nBytes)
+{
+    add r1, r1, r0
+    bic r0, r0, #31
+
+_020CC12C:
+    mcr p15, 0, r0, c7, c6, 1 //Invalidated Data Cache Line Virtual Address
+    add r0, r0, #32
+    cmp r0, r1
+    blt _020CC12C
+
+    bx lr
+}
+
+ARM_FUNC asm void DC_StoreRange(register void *startAddr, register u32 nBytes)
+{
+    add r1, r1, r0
+    bic r0, r0, #31
+
+_020CC148:
+    mcr p15, 0, r0, c7, c10, 1 //Clean Data Cache Line Virtual Address
+    add r0, r0, #32
+    cmp r0, r1
+    blt _020CC148
+
+    bx lr
+}
+
+ARM_FUNC asm void DC_FlushRange(register const void *startAddr, register u32 nBytes)
+{
+    mov r12, #0
+    add r1, r1, r0
+    bic r0, r0, #31
+
+_020CC168:
+    mcr p15, 0, r12, c7, c10, 4 //Drain Write Buffer
+    mcr p15, 0, r0, c7, c14, 1 //Clean and Invalidate Data Cache Line Virtual Address
+    add r0, r0, #32
+    cmp r0, r1
+    blt _020CC168
+
+    bx lr
+}
+
+ARM_FUNC asm void DC_WaitWriteBufferEmpty(void)
+{
+    mov r0, #0
+    mcr p15, 0, r0, c7, c10, 4 //Drain Write Buffer
+    bx lr
+}
+
+ARM_FUNC asm void IC_InvalidateAll(void)
+{
+    mov r0, #0
+    mcr p15, 0, r0, c7, c5, 0 //Invalidate Entire Instruction Cache
+    bx lr
+}
+
+ARM_FUNC asm void IC_InvalidateRange(register void *startAddr, register u32 nBytes)
+{
+    add r1, r1, r0
+    bic r0, r0, #31
+
+_020CC1A0:
+    mcr p15, 0, r0, c7, c5, 1 //Invalidate Instruction Cache Line Virtual Address
+    add r0, r0, #32
+    cmp r0, r1
+    blt _020CC1A0
+
+    bx lr
+}
diff --git a/arm9/lib/src/OS_reset.c b/arm9/lib/src/OS_reset.c
index 95238f46..5994e643 100644
--- a/arm9/lib/src/OS_reset.c
+++ b/arm9/lib/src/OS_reset.c
@@ -5,6 +5,7 @@
 #include "OS_interrupt.h"
 #include "OS_system.h"
 #include "OS_spinLock.h"
+#include "OS_cache.h"
 #include "sections.h"
 
 static u16 OSi_IsInitReset = 0;
@@ -16,10 +17,6 @@ extern void PXI_SetFifoRecvCallback(u32 param1, void* callback);
 extern u32 PXI_SendWordByFifo(u32 param1, u32 data, u32 param2);
 extern void CARD_LockRom(u16 lockId);
 extern void MI_StopDma(u32 dma);
-extern void DC_StoreAll(void);
-extern void DC_InvalidateAll(void);
-extern void IC_InvalidateAll(void);
-extern void DC_WaitWriteBufferEmpty(void);
 
 ARM_FUNC void OS_InitReset(void) {
     if (OSi_IsInitReset) {
diff --git a/arm9/lib/src/SND_command.c b/arm9/lib/src/SND_command.c
index 11622761..130a4ebc 100644
--- a/arm9/lib/src/SND_command.c
+++ b/arm9/lib/src/SND_command.c
@@ -1,6 +1,7 @@
 #include "SND_command.h"
 #include "SND_work.h"
 #include "OS_system.h"
+#include "OS_cache.h"
 
 #define SND_CMD_WAIT_QUEUE_COUNT 8
 
@@ -21,7 +22,6 @@ static struct SNDCommand *sFreeList;
 extern s32 PXI_SendWordByFifo(u32, u32, u32);
 extern void PXI_SetFifoRecvCallback(u32, void (*)(s32, s32));
 extern BOOL PXI_IsCallbackReady(u32, u32);
-extern void DC_FlushRange(void*, u32);
 
 static void InitPXI(void);
 static void RequestCommandProc(void);
diff --git a/arm9/lib/src/SND_work.c b/arm9/lib/src/SND_work.c
index a0fb547d..ca9208d6 100644
--- a/arm9/lib/src/SND_work.c
+++ b/arm9/lib/src/SND_work.c
@@ -1,12 +1,10 @@
 #include "SND_work.h"
 #include "SND_alarm.h"
 #include "SND_main.h"
+#include "OS_cache.h"
 
 struct SNDSharedWork *SNDi_SharedWork;
 
-void DC_InvalidateRange(void *mem, u32 size);
-void DC_FlushRange(void *mem, u32 size);
-
 u32 SND_GetPlayerStatus(void) {
     DC_InvalidateRange(&SNDi_SharedWork->playerStatus, 4);
     return SNDi_SharedWork->playerStatus;