Imported dolphin/card

2024-11-12 03:38:42 +01:00 · 2024-11-12 03:38:42 +01:00 · b44fb658a1
commit b44fb658a1
parent 61676fc982
18 changed files with 3315 additions and 78 deletions
--- a/src/dolphin/card/CARDWrite.c
+++ b/src/dolphin/card/CARDWrite.c
@ -0,0 +1,128 @@
+#include <dolphin/card.h>
+#include <dolphin/dsp.h>
+#include <dolphin/dvd.h>
+#include <dolphin/os.h>
+
+#include <dolphin/CARDPriv.h>
+
+static void EraseCallback(s32 chan, s32 result);
+
+static void WriteCallback(s32 chan, s32 result)
+{
+    CARDControl *card;
+    CARDCallback callback;
+    u16 *fat;
+    CARDDir *dir;
+    CARDDir *ent;
+    CARDFileInfo *fileInfo;
+
+    card = &__CARDBlock[chan];
+    if (result < 0) {
+        goto error;
+    }
+
+    fileInfo = card->fileInfo;
+    if (fileInfo->length < 0) {
+        result = CARD_RESULT_CANCELED;
+        goto error;
+    }
+
+    fileInfo->length -= card->sectorSize;
+    if (fileInfo->length <= 0) {
+        dir = __CARDGetDirBlock(card);
+        ent = &dir[fileInfo->fileNo];
+        ent->time = (u32)OSTicksToSeconds(OSGetTime());
+        callback = card->apiCallback;
+        card->apiCallback = 0;
+        result = __CARDUpdateDir(chan, callback);
+    }
+    else {
+        fat = __CARDGetFatBlock(card);
+        fileInfo->offset += card->sectorSize;
+        fileInfo->iBlock = fat[fileInfo->iBlock];
+        if (!CARDIsValidBlockNo(card, fileInfo->iBlock)) {
+            result = CARD_RESULT_BROKEN;
+            goto error;
+        }
+        result = __CARDEraseSector(chan, card->sectorSize * (u32)fileInfo->iBlock, EraseCallback);
+    }
+
+    if (result < 0) {
+        goto error;
+    }
+    return;
+
+error:
+    callback = card->apiCallback;
+    card->apiCallback = 0;
+    __CARDPutControlBlock(card, result);
+    callback(chan, result);
+}
+
+static void EraseCallback(s32 chan, s32 result)
+{
+    CARDControl *card;
+    CARDCallback callback;
+    CARDFileInfo *fileInfo;
+
+    card = &__CARDBlock[chan];
+    if (result < 0) {
+        goto error;
+    }
+
+    fileInfo = card->fileInfo;
+    result = __CARDWrite(chan, card->sectorSize * (u32)fileInfo->iBlock, card->sectorSize, card->buffer, WriteCallback);
+    if (result < 0) {
+        goto error;
+    }
+    return;
+
+error:
+    callback = card->apiCallback;
+    card->apiCallback = 0;
+    __CARDPutControlBlock(card, result);
+    callback(chan, result);
+}
+
+s32 CARDWriteAsync(CARDFileInfo *fileInfo, const void *buf, s32 length, s32 offset, CARDCallback callback)
+{
+    CARDControl *card;
+    s32 result;
+    CARDDir *dir;
+    CARDDir *ent;
+
+    result = __CARDSeek(fileInfo, length, offset, &card);
+    if (result < 0) {
+        return result;
+    }
+
+    if (OFFSET(offset, card->sectorSize) != 0 || OFFSET(length, card->sectorSize) != 0) {
+        return __CARDPutControlBlock(card, CARD_RESULT_FATAL_ERROR);
+    }
+
+    dir = __CARDGetDirBlock(card);
+    ent = &dir[fileInfo->fileNo];
+    result = __CARDAccess(card, ent);
+    if (result < 0) {
+        return __CARDPutControlBlock(card, result);
+    }
+
+    DCStoreRange((void *)buf, (u32)length);
+    card->apiCallback = callback ? callback : __CARDDefaultApiCallback;
+    card->buffer = (void *)buf;
+    result = __CARDEraseSector(fileInfo->chan, card->sectorSize * (u32)fileInfo->iBlock, EraseCallback);
+    if (result < 0) {
+        __CARDPutControlBlock(card, result);
+    }
+    return result;
+}
+
+s32 CARDWrite(CARDFileInfo *fileInfo, const void *buf, s32 length, s32 offset)
+{
+    s32 result = CARDWriteAsync(fileInfo, buf, length, offset, __CARDSyncCallback);
+    if (result < 0) {
+        return result;
+    }
+
+    return __CARDSync(fileInfo->chan);
+}