1 files changed, 159 insertions, 0 deletions
diff --git a/src/Dolphin/card/CARDBlock.c b/src/Dolphin/card/CARDBlock.c
new file mode 100644
index 0000000..b6305f1
--- /dev/null
+++ b/src/Dolphin/card/CARDBlock.c
@@ -0,0 +1,159 @@
+#include <dolphin/card.h>
+#include <dolphin/dsp.h>
+#include <dolphin/dvd.h>
+#include <dolphin/os.h>
+
+#include <dolphin/CARDPriv.h>
+
+u16* __CARDGetFatBlock(CARDControl* card) { return card->currentFat; }
+
+static void WriteCallback(s32 chan, s32 result) {
+  CARDControl* card;
+  CARDCallback callback;
+  u16* fat;
+  u16* fatBack;
+
+  card = &__CARDBlock[chan];
+
+  if (result >= 0) {
+    fat = (u16*)((u8*)card->workArea + 0x6000);
+    fatBack = (u16*)((u8*)card->workArea + 0x8000);
+
+    if (card->currentFat == fat) {
+      card->currentFat = fatBack;
+      memcpy(fatBack, fat, 0x2000);
+    } else {
+      card->currentFat = fat;
+      memcpy(fat, fatBack, 0x2000);
+    }
+  }
+
+  if (card->apiCallback == NULL) {
+    __CARDPutControlBlock(card, result);
+  }
+
+  callback = card->eraseCallback;
+  if (callback) {
+    card->eraseCallback = NULL;
+    callback(chan, result);
+  }
+}
+
+static void EraseCallback(s32 chan, s32 result) {
+  CARDControl* card;
+  CARDCallback callback;
+  u32 temp[2]; /* this compiler sucks */
+  u16* fat;
+  u32 addr;
+
+  card = &__CARDBlock[chan];
+  if (result < 0) {
+    goto error;
+  }
+
+  fat = __CARDGetFatBlock(card);
+  addr = ((u32)fat - (u32)card->workArea) / CARD_SYSTEM_BLOCK_SIZE * card->sectorSize;
+  result = __CARDWrite(chan, addr, CARD_SYSTEM_BLOCK_SIZE, fat, WriteCallback);
+  if (result < 0) {
+    goto error;
+  }
+
+  return;
+
+error:
+  if (card->apiCallback == NULL) {
+    __CARDPutControlBlock(card, result);
+  }
+  callback = card->eraseCallback;
+  if (callback) {
+    card->eraseCallback = NULL;
+    callback(chan, result);
+  }
+}
+
+s32 __CARDAllocBlock(s32 chan, u32 cBlock, CARDCallback callback) {
+  CARDControl* card;
+  u16* fat;
+  u16 iBlock;
+  u16 startBlock;
+  u16 prevBlock;
+  u16 count;
+
+  card = &__CARDBlock[chan];
+  if (!card->attached) {
+    return CARD_RESULT_NOCARD;
+  }
+
+  fat = __CARDGetFatBlock(card);
+  if (fat[3] < cBlock) {
+    return CARD_RESULT_INSSPACE;
+  }
+
+  fat[3] -= cBlock;
+  startBlock = 0xFFFF;
+  iBlock = fat[4];
+  count = 0;
+  while (0 < cBlock) {
+    if (card->cBlock - 5 < ++count) {
+      return CARD_RESULT_BROKEN;
+    }
+
+    iBlock++;
+    if (!CARDIsValidBlockNo(card, iBlock)) {
+      iBlock = 5;
+    }
+
+    if (fat[iBlock] == 0x0000u) {
+      if (startBlock == 0xFFFF) {
+        startBlock = iBlock;
+      } else {
+        fat[prevBlock] = iBlock;
+      }
+      prevBlock = iBlock;
+      fat[iBlock] = 0xFFFF;
+      --cBlock;
+    }
+  }
+  fat[4] = iBlock;
+  card->startBlock = startBlock;
+
+  return __CARDUpdateFatBlock(chan, fat, callback);
+}
+
+s32 __CARDFreeBlock(s32 chan, u16 nBlock, CARDCallback callback) {
+  CARDControl* card;
+  u16* fat;
+  u16 nextBlock;
+
+  card = card = &__CARDBlock[chan];
+  if (!card->attached) {
+    return CARD_RESULT_NOCARD;
+  }
+
+  fat = __CARDGetFatBlock(card);
+  while (nBlock != 0xFFFF) {
+    if (!CARDIsValidBlockNo(card, nBlock)) {
+      return CARD_RESULT_BROKEN;
+    }
+
+    nextBlock = fat[nBlock];
+    fat[nBlock] = 0;
+    nBlock = nextBlock;
+    ++fat[3];
+  }
+
+  return __CARDUpdateFatBlock(chan, fat, callback);
+}
+
+s32 __CARDUpdateFatBlock(s32 chan, u16* fat, CARDCallback callback) {
+  CARDControl* card;
+
+  card = &__CARDBlock[chan];
+  ++fat[2];
+  __CARDCheckSum(fat + 2, 0x1FFC, fat, fat + 1);
+  DCStoreRange(fat, 0x2000);
+  card->eraseCallback = callback;
+
+  return __CARDEraseSector(chan, (((u32)fat - (u32)card->workArea) / 8192u) * card->sectorSize,
+                           EraseCallback);
+}