mirror of https://github.com/PrimeDecomp/prime.git
parent
b1441a1bae
commit
c5ead9fe1b
src/Dolphin/card
|
@ -0,0 +1,158 @@
|
||||||
|
#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);
|
||||||
|
}
|
Loading…
Reference in New Issue