#include #include "global.h" #include "platform/dma.h" struct DMATransfer { union { const void *src; const u16 *src16; const u32 *src32; }; union { void *dst; vu16 *dst16; vu32 *dst32; }; u32 size; u16 control; } DMAList[DMA_COUNT]; void RunDMAs(u32 type) { for (int32_t dmaNum = 0; dmaNum < DMA_COUNT; dmaNum++) { struct DMATransfer *dma = &DMAList[dmaNum]; u32 dmaCntReg = (®_DMA0CNT)[dmaNum * 3]; if (!((dmaCntReg >> 16) & DMA_ENABLE)) { dma->control &= ~DMA_ENABLE; } if ( (dma->control & DMA_ENABLE) && (((dma->control & DMA_START_MASK) >> 12) == type)) { //printf("DMA%d src=%p, dest=%p, control=%d\n", dmaNum, dma->src, dma->dest, dma->control); for (int32_t i = 0; i < (dma->size); i++) { if ((dma->control) & DMA_32BIT) *dma->dst32 = *dma->src32; else *dma->dst16 = *dma->src16; // process destination pointer changes if (((dma->control) & DMA_DEST_MASK) == DMA_DEST_INC) { if ((dma->control) & DMA_32BIT) dma->dst32++; else dma->dst16++; } else if (((dma->control) & DMA_DEST_MASK) == DMA_DEST_DEC) { if ((dma->control) & DMA_32BIT) dma->dst32--; else dma->dst16--; } else if (((dma->control) & DMA_DEST_MASK) == DMA_DEST_RELOAD) // TODO { if ((dma->control) & DMA_32BIT) dma->dst32++; else dma->dst16++; } // process source pointer changes if (((dma->control) & DMA_SRC_MASK) == DMA_SRC_INC) { if ((dma->control) & DMA_32BIT) dma->src32++; else dma->src16++; } else if (((dma->control) & DMA_SRC_MASK) == DMA_SRC_DEC) { if ((dma->control) & DMA_32BIT) dma->src32--; else dma->src16--; } } if (dma->control & DMA_REPEAT) { dma->size = ((®_DMA0CNT)[dmaNum * 3] & 0x1FFFF); if (((dma->control) & DMA_DEST_MASK) == DMA_DEST_RELOAD) { dma->dst = (void *)(uintptr_t)((®_DMA0DAD)[dmaNum * 3]); } } else { dma->control &= ~DMA_ENABLE; } } } } void DmaSet(int32_t dmaNum, const void *src, volatile void *dest, u32 control) { if (dmaNum >= DMA_COUNT) { DBGPRINTF("DmaSet with invalid DMA number: dmaNum=%d, src=%p, dest=%p, control=%d\n", dmaNum, src, dest, control); return; } (®_DMA0SAD)[dmaNum * 3] = (vu32)(uintptr_t)src; (®_DMA0DAD)[dmaNum * 3] = (vu32)(uintptr_t)dest; (®_DMA0CNT)[dmaNum * 3] = control; struct DMATransfer *dma = &DMAList[dmaNum]; dma->src = src; dma->dst = (void *)dest; // the I/O registers are plain memory here dma->size = control & 0x1ffff; dma->control = control >> 16; RunDMAs(DMA_NOW); }