tunnel

[gbajam21] / src / dma.c

diff --git a/src/dma.c b/src/dma.c
index ba23ab7..9efade4 100644 (file)
--- a/src/dma.c
+++ b/src/dma.c
@@ -25,20 +25,30 @@
 
 static volatile uint32_t *reg_dma[4] = {(void*)0x040000b0, (void*)0x040000bc, (void*)0x040000c8, (void*)0x040000d4 };
 
+void AAS_DoDMA3(void*, void*, uint32_t);
+
 /* --- perform a copy of words or halfwords using DMA --- */
 
 void dma_copy32(int channel, void *dst, void *src, int words, unsigned int flags)
 {
-       reg_dma[channel][DMA_SRC] = (uint32_t)src;
-       reg_dma[channel][DMA_DST] = (uint32_t)dst;
-       reg_dma[channel][DMA_CTRL] = words | flags | DMA_32 | DMA_ENABLE;
+       if(channel == 3) {
+               AAS_DoDMA3(src, dst, words | flags | DMA_32 | DMA_ENABLE);
+       } else {
+               reg_dma[channel][DMA_SRC] = (uint32_t)src;
+               reg_dma[channel][DMA_DST] = (uint32_t)dst;
+               reg_dma[channel][DMA_CTRL] = words | flags | DMA_32 | DMA_ENABLE;
+       }
 }
 
 void dma_copy16(int channel, void *dst, void *src, int halfwords, unsigned int flags)
 {
-       reg_dma[channel][DMA_SRC] = (uint32_t)src;
-       reg_dma[channel][DMA_DST] = (uint32_t)dst;
-       reg_dma[channel][DMA_CTRL] = halfwords | flags | DMA_16 | DMA_ENABLE;
+       if(channel == 3) {
+               AAS_DoDMA3(src, dst, halfwords | flags | DMA_16 | DMA_ENABLE);
+       } else {
+               reg_dma[channel][DMA_SRC] = (uint32_t)src;
+               reg_dma[channel][DMA_DST] = (uint32_t)dst;
+               reg_dma[channel][DMA_CTRL] = halfwords | flags | DMA_16 | DMA_ENABLE;
+       }
 }
 
 /* --- fill a buffer with an ammount of words and halfwords using DMA --- */
@@ -48,15 +58,23 @@ static uint32_t fill[4];
 void dma_fill32(int channel, void *dst, uint32_t val, int words)
 {
        fill[channel] = val;
-       reg_dma[channel][DMA_SRC] = (uint32_t)(fill + channel);
-       reg_dma[channel][DMA_DST] = (uint32_t)dst;
-       reg_dma[channel][DMA_CTRL] = words | DMA_SRC_FIX | DMA_TIMING_IMMED | DMA_32 | DMA_ENABLE;
+       if(channel == 3) {
+               AAS_DoDMA3(fill + channel, dst, words | DMA_SRC_FIX | DMA_TIMING_IMMED | DMA_32 | DMA_ENABLE);
+       } else {
+               reg_dma[channel][DMA_SRC] = (uint32_t)(fill + channel);
+               reg_dma[channel][DMA_DST] = (uint32_t)dst;
+               reg_dma[channel][DMA_CTRL] = words | DMA_SRC_FIX | DMA_TIMING_IMMED | DMA_32 | DMA_ENABLE;
+       }
 }
 
 void dma_fill16(int channel, void *dst, uint16_t val, int halfwords)
 {
        fill[channel] = val;
-       reg_dma[channel][DMA_SRC] = (uint32_t)(fill + channel);
-       reg_dma[channel][DMA_DST] = (uint32_t)dst;
-       reg_dma[channel][DMA_CTRL] = halfwords | DMA_SRC_FIX | DMA_TIMING_IMMED | DMA_16 | DMA_ENABLE;
+       if(channel == 3) {
+               AAS_DoDMA3(fill + channel, dst, halfwords | DMA_SRC_FIX | DMA_TIMING_IMMED | DMA_16 | DMA_ENABLE);
+       } else {
+               reg_dma[channel][DMA_SRC] = (uint32_t)(fill + channel);
+               reg_dma[channel][DMA_DST] = (uint32_t)dst;
+               reg_dma[channel][DMA_CTRL] = halfwords | DMA_SRC_FIX | DMA_TIMING_IMMED | DMA_16 | DMA_ENABLE;
+       }
 }