1 files changed, 117 insertions, 0 deletions
diff --git a/src/Dolphin/card/CARDWrite.c b/src/Dolphin/card/CARDWrite.c
new file mode 100644
index 0000000..69a11b3
--- /dev/null
+++ b/src/Dolphin/card/CARDWrite.c
@@ -0,0 +1,117 @@
+#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;
+}