summaryrefslogtreecommitdiff
path: root/arm9/lib
diff options
context:
space:
mode:
Diffstat (limited to 'arm9/lib')
-rw-r--r--arm9/lib/include/GX_g3x.h15
-rw-r--r--arm9/lib/include/MI_dma_gxcommand.h37
-rw-r--r--arm9/lib/src/MI_dma_gxcommand.c153
3 files changed, 205 insertions, 0 deletions
diff --git a/arm9/lib/include/GX_g3x.h b/arm9/lib/include/GX_g3x.h
index 4bd55831..a0512b28 100644
--- a/arm9/lib/include/GX_g3x.h
+++ b/arm9/lib/include/GX_g3x.h
@@ -1,6 +1,8 @@
#ifndef GUARD_GX_G3X_H
#define GUARD_GX_G3X_H
+#include "fx.h"
+
void GXi_NopClearFifo128_(void *reg);
void G3X_Init();
void G3X_ResetMtxStack();
@@ -66,4 +68,17 @@ typedef enum
}
GXFifoStat;
+static inline void G3X_SetFifoIntrCond(GXFifoIntrCond cond)
+{
+ reg_G3X_GXSTAT = ((reg_G3X_GXSTAT & ~0xc0000000) |
+ (cond << 30));
+}
+
+static inline GXFifoStat G3X_GetCommandFifoStatus(void)
+{
+ return (GXFifoStat)((reg_G3X_GXSTAT & (0x01000000 |
+ 0x02000000 |
+ 0x04000000)) >> 24);
+}
+
#endif //GUARD_GX_G3X_H
diff --git a/arm9/lib/include/MI_dma_gxcommand.h b/arm9/lib/include/MI_dma_gxcommand.h
new file mode 100644
index 00000000..29aa9c72
--- /dev/null
+++ b/arm9/lib/include/MI_dma_gxcommand.h
@@ -0,0 +1,37 @@
+#ifndef POKEDIAMOND_MI_DMA_GXCOMMAND_H
+#define POKEDIAMOND_MI_DMA_GXCOMMAND_H
+
+#include "consts.h"
+#include "MI_dma.h"
+#include "GX_g3x.h"
+
+#define MIi_GX_LENGTH_ONCE (118 * sizeof(u32))
+#define REG_GXFIFO_ADDR 0x4000400
+#define MI_CNT_SEND32(size) (0x84400000 | (size/4))
+#define MI_CNT_SEND32_IF(size) (0xc4400000 | (size/4))
+#define MI_CNT_GXCOPY_IF(size) (0xfc400000 | (size/4))
+
+#define OS_IE_GXFIFO 0x200000
+
+typedef struct
+{
+ volatile BOOL isBusy;
+
+ u32 dmaNo;
+ u32 src;
+ u32 length;
+ MIDmaCallback callback;
+ void *arg;
+
+ GXFifoIntrCond fifoCond;
+ void (*fifoFunc) (void);
+} MIiGXDmaParams;
+
+void MI_SendGXCommand(u32 dmaNo, const void *src, u32 commandLength);
+void MI_SendGXCommandAsync(u32 dmaNo, const void *src, u32 commandLength, MIDmaCallback callback, void *arg);
+static void MIi_FIFOCallback(void);
+static void MIi_DMACallback(void *);
+void MI_SendGXCommandAsyncFast(u32 dmaNo, const void *src, u32 commandLength, MIDmaCallback callback, void *arg);
+static void MIi_DMAFastCallback(void *);
+
+#endif //POKEDIAMOND_MI_DMA_GXCOMMAND_H
diff --git a/arm9/lib/src/MI_dma_gxcommand.c b/arm9/lib/src/MI_dma_gxcommand.c
new file mode 100644
index 00000000..32f98f60
--- /dev/null
+++ b/arm9/lib/src/MI_dma_gxcommand.c
@@ -0,0 +1,153 @@
+#include "MI_dma_gxcommand.h"
+#include "function_target.h"
+#include "OS_interrupt.h"
+#include "OS_reset.h"
+#include "sections.h"
+
+static MIiGXDmaParams MIi_GXDmaParams = { FALSE };
+
+#pragma section ITCM begin
+ARM_FUNC void MI_SendGXCommand(u32 dmaNo, const void *src, u32 commandLength)
+{
+ vu32 *dmaCntp;
+ u32 leftLength = commandLength;
+ u32 currentSrc = (u32)src;
+ if (!leftLength)
+ {
+ return;
+ }
+
+ MIi_CheckDma0SourceAddress(dmaNo, (u32)src, commandLength, DMA_SRC_INC);
+
+ do
+ {
+ dmaCntp = &((vu32 *)REG_ADDR_DMA0SAD)[dmaNo * 3 + 2];
+ while (*dmaCntp & 0x80000000) {}
+ } while(0);
+
+ while (leftLength > 0)
+ {
+ u32 length = (leftLength > MIi_GX_LENGTH_ONCE) ? MIi_GX_LENGTH_ONCE : leftLength;
+ MIi_DmaSetParams(dmaNo, currentSrc, (u32)REG_GXFIFO_ADDR, MI_CNT_SEND32(length));
+ leftLength -= length;
+ currentSrc += length;
+ }
+
+ do
+ {
+ while (*dmaCntp & 0x80000000) {}
+ } while(0);
+}
+#pragma section ITCM end
+
+ARM_FUNC void MI_SendGXCommandAsync(u32 dmaNo, const void *src, u32 commandLength, MIDmaCallback callback, void *arg)
+{
+ vu32 *dmaCntp;
+ u32 leftLength = commandLength;
+ u32 currentSrc = (u32)src;
+
+ if (!commandLength)
+ {
+ MIi_CallCallback(callback, arg);
+ return;
+ }
+
+ while (MIi_GXDmaParams.isBusy) {}
+
+ while (!(G3X_GetCommandFifoStatus() & GX_FIFOSTAT_UNDERHALF)) {}
+
+ MIi_GXDmaParams.isBusy = TRUE;
+ MIi_GXDmaParams.dmaNo = dmaNo;
+ MIi_GXDmaParams.src = (u32)src;
+ MIi_GXDmaParams.length = commandLength;
+ MIi_GXDmaParams.callback = callback;
+ MIi_GXDmaParams.arg = arg;
+
+ MIi_CheckDma0SourceAddress(dmaNo, (u32)src, commandLength, DMA_SRC_INC);
+
+ MI_WaitDma(dmaNo);
+ {
+ OSIntrMode lastIntrMode = OS_DisableInterrupts();
+
+ MIi_GXDmaParams.fifoCond = (GXFifoIntrCond)((reg_G3X_GXSTAT & 0xc0000000) >> 30);
+ MIi_GXDmaParams.fifoFunc = OS_GetIrqFunction(OS_IE_GXFIFO);
+
+ G3X_SetFifoIntrCond(GX_FIFOINTR_COND_UNDERHALF);
+ OS_SetIrqFunction(OS_IE_GXFIFO, MIi_FIFOCallback);
+ (void)OS_EnableIrqMask(OS_IE_GXFIFO);
+
+ MIi_FIFOCallback();
+
+ (void)OS_RestoreInterrupts(lastIntrMode);
+ }
+}
+
+ARM_FUNC static void MIi_FIFOCallback(void)
+{
+ if (!MIi_GXDmaParams.length)
+ {
+ return;
+ }
+
+ u32 length = (MIi_GXDmaParams.length >= MIi_GX_LENGTH_ONCE) ? MIi_GX_LENGTH_ONCE : MIi_GXDmaParams.length;
+ u32 src = MIi_GXDmaParams.src;
+
+ MIi_GXDmaParams.length -= length;
+ MIi_GXDmaParams.src += length;
+
+ if (!MIi_GXDmaParams.length)
+ {
+ OSi_EnterDmaCallback(MIi_GXDmaParams.dmaNo, MIi_DMACallback, NULL);
+ MIi_DmaSetParams(MIi_GXDmaParams.dmaNo, src, (u32)REG_GXFIFO_ADDR, MI_CNT_SEND32_IF(length));
+ (void)OS_ResetRequestIrqMask(OS_IE_GXFIFO);
+ }
+ else
+ {
+ MIi_DmaSetParams(MIi_GXDmaParams.dmaNo, src, (u32)REG_GXFIFO_ADDR, MI_CNT_SEND32(length));
+ (void)OS_ResetRequestIrqMask(OS_IE_GXFIFO);
+ }
+}
+
+ARM_FUNC static void MIi_DMACallback(void *)
+{
+ (void)OS_DisableIrqMask(OS_IE_GXFIFO);
+
+ G3X_SetFifoIntrCond(MIi_GXDmaParams.fifoCond);
+ OS_SetIrqFunction(OS_IE_GXFIFO, MIi_GXDmaParams.fifoFunc);
+
+ MIi_GXDmaParams.isBusy = FALSE;
+
+ MIi_CallCallback(MIi_GXDmaParams.callback, MIi_GXDmaParams.arg);
+}
+
+ARM_FUNC void MI_SendGXCommandAsyncFast(u32 dmaNo, const void *src, u32 commandLength, MIDmaCallback callback, void *arg)
+{
+ if (!commandLength)
+ {
+ MIi_CallCallback(callback, arg);
+ return;
+ }
+
+ while (MIi_GXDmaParams.isBusy) {}
+
+ MIi_GXDmaParams.isBusy = TRUE;
+ MIi_GXDmaParams.dmaNo = dmaNo;
+ MIi_GXDmaParams.callback = callback;
+ MIi_GXDmaParams.arg = arg;
+
+ MIi_CheckAnotherAutoDMA(dmaNo, 0x38000000);
+
+ MIi_CheckDma0SourceAddress(dmaNo, (u32)src, commandLength, DMA_SRC_INC);
+
+ MI_WaitDma(dmaNo);
+
+ OSi_EnterDmaCallback(dmaNo, MIi_DMAFastCallback, NULL);
+ MIi_DmaSetParams(dmaNo, (u32)src, (u32)REG_GXFIFO_ADDR, MI_CNT_GXCOPY_IF(commandLength));
+}
+
+ARM_FUNC static void MIi_DMAFastCallback(void *)
+{
+ MIi_GXDmaParams.isBusy = FALSE;
+
+ MIi_CallCallback(MIi_GXDmaParams.callback, MIi_GXDmaParams.arg);
+}
generated by cgit v1.2.3 (git 2.25.1) at 2025-05-08 20:23:05 +0000