From d74a026c8207047693d6e13a18c64e9f05d9c385 Mon Sep 17 00:00:00 2001 From: Phillip Stephens Date: Mon, 27 Feb 2023 23:28:33 -0800 Subject: [PATCH] Match and link hw_aramdma Former-commit-id: 87bb2a9e7d4a90f775f90825d0108b0d307f2a36 --- configure.py | 2 +- include/dolphin/arq.h | 5 + src/musyx/runtime/hw_aramdma.c | 342 +++++++++++++++++++++++++++++++++ 3 files changed, 348 insertions(+), 1 deletion(-) create mode 100644 src/musyx/runtime/hw_aramdma.c diff --git a/configure.py b/configure.py index 4ecfbf89..78026289 100755 --- a/configure.py +++ b/configure.py @@ -946,7 +946,7 @@ LIBS = [ ["musyx/runtime/snd_midictrl", False], ["musyx/runtime/snd_service", True], ["musyx/runtime/hardware", True], - "musyx/runtime/hw_aramdma", + ["musyx/runtime/hw_aramdma", True], ["musyx/runtime/dsp_import", True], ["musyx/runtime/hw_dolphin", True], ["musyx/runtime/hw_memory", True], diff --git a/include/dolphin/arq.h b/include/dolphin/arq.h index c8974543..5b7a194c 100644 --- a/include/dolphin/arq.h +++ b/include/dolphin/arq.h @@ -39,7 +39,12 @@ void ARQInit(void); void ARQReset(void); void ARQPostRequest(ARQRequest* task, u32 owner, u32 type, u32 priority, u32 source, u32 dest, u32 length, ARQCallback callback); +void ARQRemoveRequest(ARQRequest* task); +void ARQRemoveOwnerRequest(u32 owner); +void ARQFlushQueue(void); +void ARQSetChunkSize(u32 size); u32 ARQGetChunkSize(void); +BOOL ARQCheckInit(void); #ifdef __cplusplus } diff --git a/src/musyx/runtime/hw_aramdma.c b/src/musyx/runtime/hw_aramdma.c new file mode 100644 index 00000000..c63e50d9 --- /dev/null +++ b/src/musyx/runtime/hw_aramdma.c @@ -0,0 +1,342 @@ +#include "musyx/musyx_priv.h" +#include +#include +#include + +typedef struct ARAMTransferJob { + // total size: 0x28 + ARQRequest arq; // offset 0x0, size 0x20 + void (*callback)(unsigned long); // offset 0x20, size 0x4 + unsigned long user; // offset 0x24, size 0x4 +} ARAMTransferJob; + +typedef struct ARAMTransferQueue { + // total size: 0x284 + ARAMTransferJob queue[16]; // offset 0x0, size 0x280 + vu8 write; // offset 0x280, size 0x1 + vu8 valid; // offset 0x281, size 0x1 +} ARAMTransferQueue; + +typedef struct STREAM_BUFFER { + // total size: 0x10 + struct STREAM_BUFFER* next; // offset 0x0, size 0x4 + unsigned long aram; // offset 0x4, size 0x4 + unsigned long length; // offset 0x8, size 0x4 + unsigned long allocLength; // offset 0xC, size 0x4 +} STREAM_BUFFER; + +static unsigned long aramTop; // size: 0x4 +static unsigned long aramWrite; // size: 0x4 +static unsigned long aramStream; // size: 0x4 +static void* (*aramUploadCallback)(unsigned long, unsigned long); // size: 0x4 +static unsigned long aramUploadChunkSize; // size: 0x4 + +static ARAMTransferQueue aramQueueLo; +static ARAMTransferQueue aramQueueHi; + +static STREAM_BUFFER aramStreamBuffers[64]; +static STREAM_BUFFER* aramUsedStreamBuffers; +static STREAM_BUFFER* aramFreeStreamBuffers; +static STREAM_BUFFER* aramIdleStreamBuffers; + +static void InitStreamBuffers(); + +static void aramQueueInit() { + aramQueueLo.write = aramQueueLo.valid = 0; + aramQueueHi.write = aramQueueHi.valid = 0; +} + +static void aramQueueCallback(unsigned long ptr) { + u32 i; // r31 + ARQRequest* arq; // r29 + ARAMTransferQueue* aramQueue; // r30 + + arq = (ARQRequest*)ptr; + if (arq->priority == 1) { + aramQueue = &aramQueueHi; + } else { + aramQueue = &aramQueueLo; + } + + for (i = 0; i < 16; ++i) { + if (arq == &aramQueue->queue[i].arq && aramQueue->queue[i].callback) { + aramQueue->queue[i].callback(aramQueue->queue[i].user); + } + } + + --aramQueue->valid; +} + +void aramUploadData(void* mram, unsigned long aram, unsigned long len, unsigned long highPrio, + void (*callback)(unsigned long), unsigned long user) { + ARAMTransferQueue* aramQueue; // r31 + int old; // r30 + + aramQueue = highPrio != 0 ? &aramQueueHi : &aramQueueLo; + + for (;;) { + old = OSDisableInterrupts(); + if (aramQueue->valid < 16) { + aramQueue->queue[aramQueue->write].arq.owner = 42; + aramQueue->queue[aramQueue->write].arq.type = 0; + aramQueue->queue[aramQueue->write].arq.priority = highPrio != 0 ? 1 : 0; + aramQueue->queue[aramQueue->write].arq.source = (u32)mram; + aramQueue->queue[aramQueue->write].arq.dest = aram; + aramQueue->queue[aramQueue->write].arq.length = len; + aramQueue->queue[aramQueue->write].arq.callback = aramQueueCallback; + aramQueue->queue[aramQueue->write].callback = callback; + aramQueue->queue[aramQueue->write].user = user; + ARQPostRequest(&aramQueue->queue[aramQueue->write].arq, + aramQueue->queue[aramQueue->write].arq.owner, + aramQueue->queue[aramQueue->write].arq.type, + aramQueue->queue[aramQueue->write].arq.priority, + aramQueue->queue[aramQueue->write].arq.source, + aramQueue->queue[aramQueue->write].arq.dest, + aramQueue->queue[aramQueue->write].arq.length, + aramQueue->queue[aramQueue->write].arq.callback); + ++aramQueue->valid; + aramQueue->write = (aramQueue->write + 1) % 16; + OSRestoreInterrupts(old); + return; + } + OSRestoreInterrupts(old); + } +} + +void aramSyncTransferQueue() { + while (aramQueueLo.valid != 0) { + } +} + +void aramInit(unsigned long length) { + signed short* tmpMem; // r30 + unsigned long i; // r29 + unsigned long aramBase; // r28 +#line 173 + MUSY_ASSERT_MSG(length > sizeof(s16) * 640, "ARAM size is too small"); + + aramBase = ARGetBaseAddress(); + + tmpMem = (s16*)salMalloc(sizeof(s16) * 640); +#line 182 + MUSY_ASSERT_MSG(tmpMem != NULL, "Could not allocate temporary storage"); + + for (i = 0; i < 640; ++i) { + tmpMem[i] = 0; + } + + DCFlushRange(tmpMem, sizeof(s16) * 640); + aramQueueInit(); + aramUploadData(tmpMem, aramBase, sizeof(s16) * 640, 0, NULL, 0); + aramSyncTransferQueue(); + salFree(tmpMem); + aramTop = aramBase + length; + if (aramTop > ARGetSize()) { + aramTop = ARGetSize(); + } + + aramWrite = aramBase + sizeof(s16) * 640; + aramUploadCallback = NULL; + InitStreamBuffers(); +#if _DEBUG + OSReport("MusyX ARAM handler initialized\n"); +#endif +} + +void aramExit() {} + +unsigned long aramGetZeroBuffer() { return ARGetBaseAddress(); } + +void aramSetUploadCallback(void* (*callback)(unsigned long, unsigned long), + unsigned long chunckSize) { + unsigned long acs; // r30 + + if (callback != NULL) { + chunckSize = (chunckSize + 31) & ~31; + acs = ARQGetChunkSize(); + aramUploadChunkSize = chunckSize < acs ? acs : chunckSize; + } + + aramUploadCallback = callback; +} + +void* aramStoreData(void* src, unsigned long len) { + unsigned long addr; // r26 + void* buffer; // r27 + unsigned long blkSize; // r30 + len = (len + 31) & ~31; +#line 266 + MUSY_ASSERT_MSG(aramWrite + len <= aramStream, "Data will not fit in remaining ARAM space"); + addr = aramWrite; + if (aramUploadCallback == NULL) { +#line 276 + MUSY_ASSERT_MSG(!((u32)src & 31), "MRAM address is not aligned properly"); + DCFlushRange(src, len); + aramUploadData(src, aramWrite, len, 0, NULL, 0); + aramWrite += len; + return (void*)addr; + } + + while (len != 0) { + blkSize = len >= aramUploadChunkSize ? aramUploadChunkSize : len; + buffer = (void*)aramUploadCallback((u32)src, blkSize); +#line 297 + MUSY_ASSERT_MSG(!((u32)buffer & 31), "MRAM address is not aligned properly"); + DCFlushRange(buffer, blkSize); + aramUploadData(buffer, aramWrite, blkSize, 0, NULL, 0); + len -= blkSize; + aramWrite += blkSize; + src = (void*)((u32)src + blkSize); + } + + return (void*)addr; +} + +void aramRemoveData(void* aram, unsigned long len) { + len = (len + 31) & ~31; + aramWrite -= len; +#line 328 + MUSY_ASSERT_MSG((u32)aram == aramWrite, + "Current ARAM address does not match originally allocated one"); +} + +static void InitStreamBuffers() { + unsigned long i; // r31 + aramUsedStreamBuffers = NULL; + aramFreeStreamBuffers = NULL; + aramIdleStreamBuffers = aramStreamBuffers; + for (i = 1; i < 64; ++i) { + aramStreamBuffers[i - 1].next = &aramStreamBuffers[i]; + } + aramStreamBuffers[i - 1].next = NULL; + aramStream = aramTop; +} + +unsigned char aramAllocateStreamBuffer(unsigned long len) { + STREAM_BUFFER* sb; // r30 + STREAM_BUFFER* oSb; // r31 + STREAM_BUFFER* lastSb; // r28 + u32 minLen; // r27 + + len = (len + 31) & ~31; + lastSb = oSb = NULL; + minLen = -1; + + for (sb = aramFreeStreamBuffers; sb != NULL; sb = sb->next) { + if (sb->allocLength == len) { + oSb = sb; + break; + } + + if (sb->allocLength > len && minLen > sb->allocLength) { + oSb = sb; + minLen = sb->allocLength; + } + lastSb = sb; + } + + if (oSb == NULL) { + if (aramIdleStreamBuffers != NULL && aramStream - len >= aramWrite) { + oSb = aramIdleStreamBuffers; + aramIdleStreamBuffers = oSb->next; + oSb->allocLength = len; + oSb->length = len; + aramStream -= len; + oSb->aram = aramStream; + oSb->next = aramUsedStreamBuffers; + aramUsedStreamBuffers = oSb; + } + } else { + if (lastSb != NULL) { + lastSb->next = oSb->next; + } else { + aramFreeStreamBuffers = oSb->next; + } + + oSb->length = len; + oSb->next = aramUsedStreamBuffers; + aramUsedStreamBuffers = oSb; + } + + if (oSb == NULL) { +#if _DEBUG + OSReport("No stream buffer slots available or ARAM.\n\n"); +#endif + return 0xFF; + } + + return (oSb - aramStreamBuffers); +} + +unsigned long aramGetStreamBufferAddress(unsigned char id, unsigned long* len) { +#line 467 + MUSY_ASSERT_MSG(id != 0xFF, "Stream buffer ID is invalid"); + + if (len != NULL) { + *len = aramStreamBuffers[id].length; + } + + return aramStreamBuffers[id].aram; +} + +void aramFreeStreamBuffer(unsigned char id) { + struct STREAM_BUFFER* fSb; // r30 + struct STREAM_BUFFER* sb; // r31 + struct STREAM_BUFFER* lastSb; // r29 + struct STREAM_BUFFER* nextSb; // r27 + unsigned long minAddr; // r28 + + MUSY_ASSERT_MSG(id != 0xFF, "Stream buffer ID is invalid"); + fSb = &aramStreamBuffers[id]; + lastSb = NULL; + sb = aramUsedStreamBuffers; + + while (sb != NULL) { + if (sb == fSb) { + if (lastSb != NULL) { + lastSb->next = fSb->next; + } else { + aramUsedStreamBuffers = fSb->next; + } + break; + } else { + lastSb = sb; + sb = sb->next; + } + } + + if (fSb->aram == aramStream) { + fSb->next = aramIdleStreamBuffers; + aramIdleStreamBuffers = fSb; + minAddr = -1; + sb = aramUsedStreamBuffers; + while (sb != NULL) { + if (sb->aram <= minAddr) { + minAddr = sb->aram; + } + sb = sb->next; + } + + lastSb = NULL; + sb = aramFreeStreamBuffers; + while (sb != NULL) { + nextSb = sb->next; + if (sb->aram < minAddr) { + if (lastSb != NULL) { + lastSb->next = sb->next; + } else { + aramFreeStreamBuffers = sb->next; + } + + sb->next = aramIdleStreamBuffers; + aramIdleStreamBuffers = sb; + } + sb = nextSb; + } + + aramStream = minAddr != -1 ? minAddr : aramTop; + return; + } + fSb->next = aramFreeStreamBuffers; + aramFreeStreamBuffers = fSb; +}