mirror of
https://github.com/sanni/cartreader.git
synced 2024-11-24 05:29:17 +01:00
Add WonderSwan support
This commit is contained in:
splash5
parent
0712e8e5ae
commit
1771104fe5
951
Cart_Reader/WS.ino
Normal file
951
Cart_Reader/WS.ino
Normal file
@ -0,0 +1,951 @@
|
||||
//******************************************
|
||||
// WonderSwan MODULE
|
||||
//******************************************
|
||||
// WonderSwan cartridge pinout
|
||||
// C40: /RST : PH0
|
||||
// C45: /CART? : PH3 (L when accessing cartridge (ROM/SRAM/PORT))
|
||||
// C42: /MMC : PH4 (access port on cartridge when both /CART and /MMC = L)
|
||||
// C44: /WE : PH5
|
||||
// C43: /OE : PH6
|
||||
// C47: CLK : PE3 (384KHz in real device)
|
||||
// C41: /IO? : PE4
|
||||
// C46: INT : PG5 (for RTC alarm interrupt)
|
||||
|
||||
/******************************************
|
||||
Menu
|
||||
*****************************************/
|
||||
static const char wsMenuItem1[] PROGMEM = "Read Rom";
|
||||
static const char wsMenuItem2[] PROGMEM = "Read Save";
|
||||
static const char wsMenuItem3[] PROGMEM = "Write Save";
|
||||
static const char wsMenuItem4[] PROGMEM = "Reset";
|
||||
static const char* const menuOptionsWS[] PROGMEM = {wsMenuItem1, wsMenuItem2, wsMenuItem3, wsMenuItem4};
|
||||
|
||||
static uint8_t wsGameOrientation = 0;
|
||||
static uint8_t wsGameHasRTC = 0;
|
||||
static uint16_t wsGameChecksum = 0;
|
||||
static uint8_t wsEepromShiftReg[5];
|
||||
|
||||
void setup_WS()
|
||||
{
|
||||
// A0 - A7
|
||||
DDRF = 0xff;
|
||||
// A8 - A15
|
||||
DDRK = 0xff;
|
||||
// A16 - A23
|
||||
DDRL = 0xff;
|
||||
|
||||
// D0 - D15
|
||||
DDRC = 0x00;
|
||||
DDRA = 0x00;
|
||||
|
||||
// controls
|
||||
DDRH |= ((1 << 0) | (1 << 3) | (1 << 4) | (1 << 5) | (1 << 6));
|
||||
PORTH |= ((1 << 0) | (1 << 3) | (1 << 4) | (1 << 5) | (1 << 6));
|
||||
|
||||
DDRE |= ((1 << 3) | (1 << 4));
|
||||
PORTE |= (1 << 4);
|
||||
PORTE &= ~(1 << 3);
|
||||
|
||||
// interrupt pin with internal pull-up
|
||||
DDRG &= ~(1 << 5);
|
||||
PORTG |= (1 << 5);
|
||||
|
||||
display_Clear();
|
||||
|
||||
// unlock MMC
|
||||
if (!unlockBandai2003_WS())
|
||||
print_Error(F("Can't initial MMC"), true);
|
||||
|
||||
if (getCartInfo_WS() != 0xea)
|
||||
print_Error(F("Rom header read error"), true);
|
||||
|
||||
showCartInfo_WS();
|
||||
mode = mode_WS;
|
||||
}
|
||||
|
||||
void wsMenu()
|
||||
{
|
||||
uint8_t mainMenu;
|
||||
|
||||
convertPgm(menuOptionsWS, 4);
|
||||
mainMenu = question_box(F("WonderSwan Menu"), menuOptions, 4, 0);
|
||||
|
||||
switch (mainMenu)
|
||||
{
|
||||
case 0:
|
||||
{
|
||||
// Read Rom
|
||||
sd.chdir("/");
|
||||
readROM_WS(filePath, FILEPATH_LENGTH);
|
||||
sd.chdir("/");
|
||||
compareChecksum_WS(filePath);
|
||||
break;
|
||||
}
|
||||
case 1:
|
||||
{
|
||||
// Read Save
|
||||
sd.chdir("/");
|
||||
switch (saveType)
|
||||
{
|
||||
case 0: println_Msg(F("No save for this game")); break;
|
||||
case 1: readSRAM_WS(); break;
|
||||
case 2: readEEPROM_WS(); break;
|
||||
default: println_Msg(F("Unknow save type")); break;
|
||||
}
|
||||
|
||||
break;
|
||||
}
|
||||
case 2:
|
||||
{
|
||||
// Write Save
|
||||
sd.chdir("/");
|
||||
switch (saveType)
|
||||
{
|
||||
case 0: println_Msg(F("No save for this game")); break;
|
||||
case 1:
|
||||
{
|
||||
writeSRAM_WS();
|
||||
verifySRAM_WS();
|
||||
break;
|
||||
}
|
||||
case 2:
|
||||
{
|
||||
writeEEPROM_WS();
|
||||
verifyEEPROM_WS();
|
||||
break;
|
||||
}
|
||||
default: println_Msg(F("Unknow save type")); break;
|
||||
}
|
||||
|
||||
break;
|
||||
}
|
||||
default:
|
||||
{
|
||||
asm volatile (" jmp 0");
|
||||
break;
|
||||
}
|
||||
}
|
||||
|
||||
println_Msg(F(""));
|
||||
println_Msg(F("Press Button..."));
|
||||
|
||||
display_Update();
|
||||
wait();
|
||||
}
|
||||
|
||||
uint8_t getCartInfo_WS()
|
||||
{
|
||||
dataIn_WS();
|
||||
|
||||
for (uint32_t i = 0; i < 16; i += 2)
|
||||
*((uint16_t*)(sdBuffer + i)) = readWord_WS(0xffff0 + i);
|
||||
|
||||
// developer and cartID
|
||||
snprintf(cartID, 5, "%02X%02X", sdBuffer[6], sdBuffer[8]);
|
||||
romType = sdBuffer[7]; // wsc only = 1
|
||||
romVersion = sdBuffer[9];
|
||||
romSize = sdBuffer[10];
|
||||
sramSize = sdBuffer[11];
|
||||
wsGameOrientation = (sdBuffer[12] & 0x01);
|
||||
wsGameHasRTC = (sdBuffer[13] & 0x01);
|
||||
wsGameChecksum = *(uint16_t*)(sdBuffer + 14);
|
||||
snprintf(checksumStr, 5, "%04X", wsGameChecksum);
|
||||
|
||||
strncpy(romName, cartID, sizeof(romName) - 1);
|
||||
|
||||
switch (romSize)
|
||||
{
|
||||
case 0x01: cartSize = 131072 * 2; break;
|
||||
case 0x02: cartSize = 131072 * 4; break;
|
||||
case 0x03: cartSize = 131072 * 8; break;
|
||||
case 0x04: cartSize = 131072 * 16; break;
|
||||
// case 0x05: cartSize = 131072 * 24; break;
|
||||
case 0x06: cartSize = 131072 * 32; break;
|
||||
// case 0x07: cartSize = 131072 * 48; break;
|
||||
case 0x08: cartSize = 131072 * 64; break;
|
||||
case 0x09: cartSize = 131072 * 128; break;
|
||||
default: cartSize = 0; break;
|
||||
}
|
||||
|
||||
switch (sramSize)
|
||||
{
|
||||
case 0x00: saveType = 0; sramSize = 0; break;
|
||||
case 0x01: saveType = 1; sramSize = 64; break;
|
||||
case 0x02: saveType = 1; sramSize = 256; break;
|
||||
case 0x03: saveType = 1; sramSize = 1024; break;
|
||||
case 0x04: saveType = 1; sramSize = 2048; break;
|
||||
case 0x10: saveType = 2; sramSize = 1; break;
|
||||
case 0x20: saveType = 2; sramSize = 16; break;
|
||||
case 0x50: saveType = 2; sramSize = 8; break;
|
||||
default: saveType = 0xff; break;
|
||||
}
|
||||
|
||||
if (saveType == 2)
|
||||
unprotectEEPROM();
|
||||
|
||||
// should be 0xea (JMPF instruction)
|
||||
return sdBuffer[0];
|
||||
}
|
||||
|
||||
void showCartInfo_WS()
|
||||
{
|
||||
display_Clear();
|
||||
|
||||
println_Msg(F("WonderSwan Cart Info"));
|
||||
|
||||
print_Msg(F("Game: "));
|
||||
println_Msg(cartID);
|
||||
|
||||
print_Msg(F("Rom Size: "));
|
||||
if (cartSize == 0x00)
|
||||
println_Msg(romSize, HEX);
|
||||
else
|
||||
{
|
||||
print_Msg(cartSize / 131072);
|
||||
println_Msg(F(" Mb"));
|
||||
}
|
||||
|
||||
print_Msg(F("Save: "));
|
||||
switch (saveType)
|
||||
{
|
||||
case 0: println_Msg(F("None")); break;
|
||||
case 1: print_Msg(F("Sram ")); print_Msg(sramSize); println_Msg(F("Kb")); break;
|
||||
case 2: print_Msg(F("Eeprom ")); print_Msg(sramSize); println_Msg(F("Kb")); break;
|
||||
default: println_Msg(sramSize, HEX); break;
|
||||
}
|
||||
|
||||
print_Msg(F("Vesion: 1."));
|
||||
println_Msg(romVersion, HEX);
|
||||
|
||||
print_Msg(F("Checksum: "));
|
||||
println_Msg(checksumStr);
|
||||
|
||||
println_Msg(F("Press Button..."));
|
||||
display_Update();
|
||||
wait();
|
||||
}
|
||||
|
||||
void readROM_WS(char *outPathBuf, size_t bufferSize)
|
||||
{
|
||||
// generate fullname of rom file
|
||||
snprintf(fileName, FILENAME_LENGTH, "%s.ws", romName);
|
||||
|
||||
// create a new folder for storing rom file
|
||||
EEPROM_readAnything(0, foldern);
|
||||
snprintf(folder, sizeof(folder), "WS/ROM/%s/%d", romName, foldern);
|
||||
sd.mkdir(folder, true);
|
||||
sd.chdir(folder);
|
||||
|
||||
// filling output file path to buffer
|
||||
if (outPathBuf != NULL && bufferSize > 0)
|
||||
snprintf(outPathBuf, bufferSize, "%s/%s", folder, fileName);
|
||||
|
||||
display_Clear();
|
||||
print_Msg(F("Saving to "));
|
||||
print_Msg(folder);
|
||||
println_Msg(F("/..."));
|
||||
display_Update();
|
||||
|
||||
// open file on sdcard
|
||||
if (!myFile.open(fileName, O_RDWR | O_CREAT))
|
||||
print_Error(F("Can't create file on SD"), true);
|
||||
|
||||
// write new folder number back to EEPROM
|
||||
foldern++;
|
||||
EEPROM_writeAnything(0, foldern);
|
||||
|
||||
// get correct starting rom bank
|
||||
uint16_t bank = (256 - (cartSize >> 16));
|
||||
|
||||
// start reading rom
|
||||
for (; bank <= 0xff; bank++)
|
||||
{
|
||||
// switch bank on segment 0x2
|
||||
dataOut_WS();
|
||||
writeByte_WSPort(0xc2, bank);
|
||||
|
||||
dataIn_WS();
|
||||
for (uint32_t addr = 0; addr < 0x10000; addr += 512)
|
||||
{
|
||||
if ((addr & ((1 << 14) - 1)) == 0)
|
||||
PORTB ^= (1 << 4);
|
||||
|
||||
for (uint32_t w = 0; w < 512; w += 2)
|
||||
*((uint16_t*)(sdBuffer + w)) = readWord_WS(0x20000 + addr + w);
|
||||
|
||||
myFile.write(sdBuffer, 512);
|
||||
}
|
||||
}
|
||||
|
||||
myFile.close();
|
||||
}
|
||||
|
||||
void readSRAM_WS()
|
||||
{
|
||||
// generate fullname of rom file
|
||||
snprintf(fileName, FILENAME_LENGTH, "%s.sav", romName);
|
||||
|
||||
// create a new folder for storing rom file
|
||||
EEPROM_readAnything(0, foldern);
|
||||
snprintf(folder, sizeof(folder), "WS/SAVE/%s/%d", romName, foldern);
|
||||
sd.mkdir(folder, true);
|
||||
sd.chdir(folder);
|
||||
|
||||
display_Clear();
|
||||
print_Msg(F("Saving to "));
|
||||
print_Msg(folder);
|
||||
println_Msg(F("/.."));
|
||||
display_Update();
|
||||
|
||||
foldern++;
|
||||
EEPROM_writeAnything(0, foldern);
|
||||
|
||||
if (!myFile.open(fileName, O_RDWR | O_CREAT))
|
||||
print_Error(F("Can't create file on SD"), true);
|
||||
|
||||
uint32_t bank_size = (sramSize << 7);
|
||||
uint16_t end_bank = (bank_size >> 16); // 64KB per bank
|
||||
|
||||
if (end_bank > 0)
|
||||
bank_size = 0x10000;
|
||||
|
||||
uint16_t bank = 0;
|
||||
|
||||
do
|
||||
{
|
||||
dataOut_WS();
|
||||
writeByte_WSPort(0xc1, bank);
|
||||
|
||||
dataIn_WS();
|
||||
for (uint32_t addr = 0; addr < bank_size; addr += 512)
|
||||
{
|
||||
if ((addr & ((1 << 14) - 1)) == 0)
|
||||
PORTB ^= (1 << 4);
|
||||
|
||||
// SRAM data on D0-D7, with A-1 to select high/low byte
|
||||
for (uint32_t w = 0; w < 512; w++)
|
||||
sdBuffer[w] = readWord_WS(0x10000 + addr + w);
|
||||
|
||||
myFile.write(sdBuffer, 512);
|
||||
}
|
||||
} while (++bank < end_bank);
|
||||
|
||||
myFile.close();
|
||||
|
||||
println_Msg(F("Done"));
|
||||
display_Update();
|
||||
}
|
||||
|
||||
void verifySRAM_WS()
|
||||
{
|
||||
print_Msg(F("Verifying... "));
|
||||
|
||||
if (myFile.open(filePath, O_READ))
|
||||
{
|
||||
uint32_t bank_size = (sramSize << 7);
|
||||
uint16_t end_bank = (bank_size >> 16); // 64KB per bank
|
||||
uint16_t bank = 0;
|
||||
uint32_t write_errors = 0;
|
||||
|
||||
if (end_bank > 0)
|
||||
bank_size = 0x10000;
|
||||
|
||||
do
|
||||
{
|
||||
dataOut_WS();
|
||||
writeByte_WSPort(0xc1, bank);
|
||||
|
||||
dataIn_WS();
|
||||
for (uint32_t addr = 0; addr < bank_size && myFile.available(); addr += 512)
|
||||
{
|
||||
myFile.read(sdBuffer, 512);
|
||||
|
||||
// SRAM data on D0-D7, with A-1 to select high/low byte
|
||||
for (uint32_t w = 0; w < 512; w++)
|
||||
{
|
||||
if ((readWord_WS(0x10000 + addr + w) & 0x00ff) != sdBuffer[w])
|
||||
write_errors++;
|
||||
}
|
||||
}
|
||||
} while (++bank < end_bank);
|
||||
|
||||
myFile.close();
|
||||
|
||||
if (write_errors == 0)
|
||||
{
|
||||
println_Msg(F("passed"));
|
||||
}
|
||||
else
|
||||
{
|
||||
println_Msg(F("failed"));
|
||||
print_Msg(F("Error: "));
|
||||
print_Msg(write_errors);
|
||||
println_Msg(F(" bytes "));
|
||||
print_Error(F("did not verify."), false);
|
||||
}
|
||||
}
|
||||
else
|
||||
{
|
||||
print_Error(F("File doesn't exist"), false);
|
||||
}
|
||||
}
|
||||
|
||||
void writeSRAM_WS()
|
||||
{
|
||||
filePath[0] = 0;
|
||||
sd.chdir("/");
|
||||
fileBrowser(F("Select sav file"));
|
||||
snprintf(filePath, FILEPATH_LENGTH, "%s/%s", filePath, fileName);
|
||||
|
||||
display_Clear();
|
||||
print_Msg(F("Writing from "));
|
||||
print_Msg(filePath);
|
||||
println_Msg(F(".."));
|
||||
display_Update();
|
||||
|
||||
if (myFile.open(filePath, O_READ))
|
||||
{
|
||||
uint32_t bank_size = (sramSize << 7);
|
||||
uint16_t end_bank = (bank_size >> 16); // 64KB per bank
|
||||
|
||||
if (end_bank > 0)
|
||||
bank_size = 0x10000;
|
||||
|
||||
uint16_t bank = 0;
|
||||
dataOut_WS();
|
||||
do
|
||||
{
|
||||
writeByte_WSPort(0xc1, bank);
|
||||
|
||||
for (uint32_t addr = 0; addr < bank_size && myFile.available(); addr += 512)
|
||||
{
|
||||
if ((addr & ((1 << 14) - 1)) == 0)
|
||||
PORTB ^= (1 << 4);
|
||||
|
||||
myFile.read(sdBuffer, 512);
|
||||
|
||||
// SRAM data on D0-D7, with A-1 to select high/low byte
|
||||
for (uint32_t w = 0; w < 512; w++)
|
||||
writeWord_WS(0x10000 + addr + w, sdBuffer[w]);
|
||||
}
|
||||
} while (++bank < end_bank);
|
||||
|
||||
myFile.close();
|
||||
|
||||
println_Msg(F("Writing finished"));
|
||||
display_Update();
|
||||
}
|
||||
else
|
||||
{
|
||||
print_Error(F("File doesn't exist"), false);
|
||||
}
|
||||
}
|
||||
|
||||
void readEEPROM_WS()
|
||||
{
|
||||
// generate fullname of eep file
|
||||
snprintf(fileName, FILENAME_LENGTH, "%s.eep", romName);
|
||||
|
||||
// create a new folder for storing eep file
|
||||
EEPROM_readAnything(0, foldern);
|
||||
snprintf(folder, sizeof(folder), "WS/SAVE/%s/%d", romName, foldern);
|
||||
sd.mkdir(folder, true);
|
||||
sd.chdir(folder);
|
||||
|
||||
display_Clear();
|
||||
print_Msg(F("Saving to "));
|
||||
print_Msg(folder);
|
||||
println_Msg(F("/.."));
|
||||
display_Update();
|
||||
|
||||
foldern++;
|
||||
EEPROM_writeAnything(0, foldern);
|
||||
|
||||
if (!myFile.open(fileName, O_RDWR | O_CREAT))
|
||||
print_Error(F("Can't create file on SD"), true);
|
||||
|
||||
uint32_t eepromSize = (sramSize << 7);
|
||||
uint32_t bufSize = (eepromSize < 512 ? eepromSize : 512);
|
||||
|
||||
for (uint32_t i = 0; i < eepromSize; i += bufSize)
|
||||
{
|
||||
for (uint32_t j = 0; j < bufSize; j += 2)
|
||||
{
|
||||
if ((j & 0x1f) == 0x00)
|
||||
PORTB ^= (1 << 4);
|
||||
|
||||
generateEepromInstruction_WS(wsEepromShiftReg, 0x2, ((i + j) >> 1), 0x00, 0x00);
|
||||
|
||||
dataOut_WS();
|
||||
writeByte_WSPort(0xc6, wsEepromShiftReg[2]);
|
||||
writeByte_WSPort(0xc7, wsEepromShiftReg[3]);
|
||||
writeByte_WSPort(0xc8, wsEepromShiftReg[4]);
|
||||
|
||||
// MMC will shift out from port 0xc7 to 0xc6
|
||||
// and shift in 16bits into port 0xc5 to 0xc4
|
||||
pulseCLK_WS(1 + 32 + 3);
|
||||
|
||||
dataIn_WS();
|
||||
sdBuffer[j] = readByte_WSPort(0xc4);
|
||||
sdBuffer[j + 1] = readByte_WSPort(0xc5);
|
||||
}
|
||||
|
||||
myFile.write(sdBuffer, bufSize);
|
||||
}
|
||||
|
||||
myFile.close();
|
||||
|
||||
println_Msg(F("Done"));
|
||||
}
|
||||
|
||||
void verifyEEPROM_WS()
|
||||
{
|
||||
print_Msg(F("Verifying... "));
|
||||
|
||||
if (myFile.open(filePath, O_READ))
|
||||
{
|
||||
uint32_t write_errors = 0;
|
||||
uint32_t eepromSize = (sramSize << 7);
|
||||
uint32_t bufSize = (eepromSize < 512 ? eepromSize : 512);
|
||||
|
||||
for (uint32_t i = 0; i < eepromSize; i += bufSize)
|
||||
{
|
||||
myFile.read(sdBuffer, bufSize);
|
||||
|
||||
for (uint32_t j = 0; j < bufSize; j += 2)
|
||||
{
|
||||
if ((j & 0x1f) == 0x00)
|
||||
PORTB ^= (1 << 4);
|
||||
|
||||
generateEepromInstruction_WS(wsEepromShiftReg, 0x2, ((i + j) >> 1), 0x00, 0x00);
|
||||
|
||||
dataOut_WS();
|
||||
writeByte_WSPort(0xc6, wsEepromShiftReg[2]);
|
||||
writeByte_WSPort(0xc7, wsEepromShiftReg[3]);
|
||||
writeByte_WSPort(0xc8, wsEepromShiftReg[4]);
|
||||
|
||||
// MMC will shift out from port 0xc7 to 0xc6
|
||||
// and shift in 16bits into port 0xc5 to 0xc4
|
||||
pulseCLK_WS(1 + 32 + 3);
|
||||
|
||||
dataIn_WS();
|
||||
if (readByte_WSPort(0xc4) != sdBuffer[j])
|
||||
write_errors++;
|
||||
|
||||
if (readByte_WSPort(0xc5) != sdBuffer[j + 1])
|
||||
write_errors++;
|
||||
}
|
||||
}
|
||||
|
||||
myFile.close();
|
||||
|
||||
if (write_errors == 0)
|
||||
{
|
||||
println_Msg(F("passed"));
|
||||
}
|
||||
else
|
||||
{
|
||||
println_Msg(F("failed"));
|
||||
print_Msg(F("Error: "));
|
||||
print_Msg(write_errors);
|
||||
println_Msg(F(" bytes "));
|
||||
print_Error(F("did not verify."), false);
|
||||
}
|
||||
}
|
||||
else
|
||||
{
|
||||
print_Error(F("File doesn't exist"), false);
|
||||
}
|
||||
}
|
||||
|
||||
void writeEEPROM_WS()
|
||||
{
|
||||
filePath[0] = 0;
|
||||
sd.chdir("/");
|
||||
fileBrowser(F("Select eep file"));
|
||||
snprintf(filePath, FILEPATH_LENGTH, "%s/%s", filePath, fileName);
|
||||
|
||||
display_Clear();
|
||||
print_Msg(F("Writing from "));
|
||||
print_Msg(filePath);
|
||||
println_Msg(F(".."));
|
||||
display_Update();
|
||||
|
||||
if (myFile.open(filePath, O_READ))
|
||||
{
|
||||
uint32_t eepromSize = (sramSize << 7);
|
||||
uint32_t bufSize = (eepromSize < 512 ? eepromSize : 512);
|
||||
|
||||
for (uint32_t i = 0; i < eepromSize; i += bufSize)
|
||||
{
|
||||
myFile.read(sdBuffer, bufSize);
|
||||
|
||||
for (uint32_t j = 0; j < bufSize; j += 2)
|
||||
{
|
||||
if ((j & 0x1f) == 0x00)
|
||||
PORTB ^= (1 << 4);
|
||||
|
||||
generateEepromInstruction_WS(wsEepromShiftReg, 0x1, ((i + j) >> 1), sdBuffer[j], sdBuffer[j + 1]);
|
||||
|
||||
dataOut_WS();
|
||||
writeByte_WSPort(0xc6, wsEepromShiftReg[2]);
|
||||
writeByte_WSPort(0xc7, wsEepromShiftReg[3]);
|
||||
writeByte_WSPort(0xc4, wsEepromShiftReg[0]);
|
||||
writeByte_WSPort(0xc5, wsEepromShiftReg[1]);
|
||||
writeByte_WSPort(0xc8, wsEepromShiftReg[4]);
|
||||
|
||||
// MMC will shift out from port 0xc7 to 0xc4
|
||||
pulseCLK_WS(1 + 32 + 3);
|
||||
|
||||
dataIn_WS();
|
||||
do { pulseCLK_WS(128); }
|
||||
while ((readByte_WSPort(0xc8) & 0x02) == 0x00);
|
||||
}
|
||||
}
|
||||
|
||||
myFile.close();
|
||||
|
||||
println_Msg(F("Done"));
|
||||
}
|
||||
else
|
||||
{
|
||||
print_Error(F("File doesn't exist"), false);
|
||||
}
|
||||
}
|
||||
|
||||
boolean compareChecksum_WS(const char *wsFilePath)
|
||||
{
|
||||
if (wsFilePath == NULL)
|
||||
return 0;
|
||||
|
||||
println_Msg(F("Calculating Checksum"));
|
||||
display_Update();
|
||||
|
||||
if (!myFile.open(wsFilePath, O_READ))
|
||||
{
|
||||
print_Error(F("Failed to open file"), false);
|
||||
return 0;
|
||||
}
|
||||
|
||||
uint32_t calLength = myFile.fileSize() - 512;
|
||||
uint32_t checksum = 0;
|
||||
for (uint32_t i = 0; i < calLength; i += 512)
|
||||
{
|
||||
myFile.read(sdBuffer, 512);
|
||||
for (uint32_t j = 0; j < 512; j++)
|
||||
checksum += sdBuffer[j];
|
||||
}
|
||||
|
||||
// last 512 bytes
|
||||
myFile.read(sdBuffer, 512);
|
||||
// skip last 2 bytes (checksum value)
|
||||
for (uint32_t j = 0; j < 510; j++)
|
||||
checksum += sdBuffer[j];
|
||||
|
||||
myFile.close();
|
||||
|
||||
checksum &= 0x0000ffff;
|
||||
calLength = *((uint16_t*)(sdBuffer + 512 - 2));
|
||||
|
||||
// don't know why formating string "%04X(%04X)" always output "xxxx(0000)"
|
||||
// so split into two snprintf
|
||||
char result[11];
|
||||
snprintf(result, 5, "%04X", calLength);
|
||||
snprintf(result + 4, 11 - 4, "(%04X)", checksum);
|
||||
print_Msg(F("Result: "));
|
||||
println_Msg(result);
|
||||
|
||||
if (checksum == calLength)
|
||||
{
|
||||
println_Msg(F("Checksum matches"));
|
||||
display_Update();
|
||||
return 1;
|
||||
}
|
||||
else
|
||||
{
|
||||
print_Error(F("Checksum Error"), false);
|
||||
return 0;
|
||||
}
|
||||
}
|
||||
|
||||
void writeByte_WSPort(uint8_t port, uint8_t data)
|
||||
{
|
||||
PORTF = (port & 0x0f);
|
||||
PORTL = (port >> 4);
|
||||
|
||||
// switch CART(PH3), MMC(PH4) to LOW
|
||||
PORTH &= ~((1 << 3) | (1 << 4));
|
||||
|
||||
// set data
|
||||
PORTC = data;
|
||||
|
||||
// switch WE(PH5) to LOW
|
||||
PORTH &= ~(1 << 5);
|
||||
NOP;
|
||||
|
||||
// switch WE(PH5) to HIGH
|
||||
PORTH |= (1 << 5);
|
||||
NOP; NOP;
|
||||
|
||||
// switch CART(PH3), MMC(PH4) to HIGH
|
||||
PORTH |= ((1 << 3) | (1 << 4));
|
||||
}
|
||||
|
||||
uint8_t readByte_WSPort(uint8_t port)
|
||||
{
|
||||
PORTF = (port & 0x0f);
|
||||
PORTL = (port >> 4);
|
||||
|
||||
// switch CART(PH3), MMC(PH4) to LOW
|
||||
PORTH &= ~((1 << 3) | (1 << 4));
|
||||
|
||||
// switch OE(PH6) to LOW
|
||||
PORTH &= ~(1 << 6);
|
||||
NOP; NOP; NOP;
|
||||
|
||||
uint8_t ret = PINC;
|
||||
|
||||
// switch OE(PH6) to HIGH
|
||||
PORTH |= (1 << 6);
|
||||
|
||||
// switch CART(PH3), MMC(PH4) to HIGH
|
||||
PORTH |= ((1 << 3) | (1 << 4));
|
||||
|
||||
return ret;
|
||||
}
|
||||
|
||||
void writeWord_WS(uint32_t addr, uint16_t data)
|
||||
{
|
||||
PORTF = addr & 0xff;
|
||||
PORTK = (addr >> 8) & 0xff;
|
||||
PORTL = (addr >> 16) & 0x0f;
|
||||
|
||||
PORTC = data & 0xff;
|
||||
PORTA = (data >> 8);
|
||||
|
||||
// switch CART(PH3) and WE(PH5) to LOW
|
||||
PORTH &= ~((1 << 3) | (1 << 5));
|
||||
NOP;
|
||||
|
||||
// switch CART(PH3) and WE(PH5) to HIGH
|
||||
PORTH |= (1 << 3) | (1 << 5);
|
||||
NOP; NOP;
|
||||
}
|
||||
|
||||
uint16_t readWord_WS(uint32_t addr)
|
||||
{
|
||||
PORTF = addr & 0xff;
|
||||
PORTK = (addr >> 8) & 0xff;
|
||||
PORTL = (addr >> 16) & 0x0f;
|
||||
|
||||
// switch CART(PH3) and OE(PH6) to LOW
|
||||
PORTH &= ~((1 << 3) | (1 << 6));
|
||||
NOP; NOP; NOP;
|
||||
|
||||
uint16_t ret = ((PINA << 8) | PINC);
|
||||
|
||||
// switch CART(PH3) and OE(PH6) to HIGH
|
||||
PORTH |= (1 << 3) | (1 << 6);
|
||||
|
||||
return ret;
|
||||
}
|
||||
|
||||
void unprotectEEPROM()
|
||||
{
|
||||
generateEepromInstruction_WS(wsEepromShiftReg, 0x0, 0x3, 0x00, 0x00);
|
||||
|
||||
dataOut_WS();
|
||||
writeByte_WSPort(0xc6, wsEepromShiftReg[2]);
|
||||
writeByte_WSPort(0xc7, wsEepromShiftReg[3]);
|
||||
writeByte_WSPort(0xc8, wsEepromShiftReg[4]);
|
||||
|
||||
// MMC will shift out port 0xc7 to 0xc6 to EEPROM
|
||||
pulseCLK_WS(1 + 16 + 3);
|
||||
}
|
||||
|
||||
// generate data for port 0xc4 to 0xc8
|
||||
// return value is number of CLKs need to pulse
|
||||
void generateEepromInstruction_WS(uint8_t *instruction, uint8_t opcode, uint16_t addr, uint8_t l_data, uint8_t h_data)
|
||||
{
|
||||
uint32_t *ptr = (uint32_t*)instruction;
|
||||
uint8_t addr_bits = (sramSize > 1 ? 10 : 6);
|
||||
*ptr = 0x00000001; // initial with a start bit
|
||||
|
||||
switch (opcode)
|
||||
{
|
||||
case 0x00:
|
||||
{
|
||||
addr &= 0x0003;
|
||||
*ptr <<= 2; // opcode = 0x0
|
||||
*ptr = ((*ptr << 2) | addr);
|
||||
*ptr <<= (addr_bits - 2);
|
||||
*ptr <<= 16;
|
||||
|
||||
if (addr == 0x01)
|
||||
{
|
||||
// WRAL: fill every byte in eeprom with same data
|
||||
instruction[0] = l_data;
|
||||
instruction[1] = h_data;
|
||||
instruction[4] = 0x20;
|
||||
}
|
||||
else
|
||||
{
|
||||
instruction[4] = 0x40;
|
||||
}
|
||||
|
||||
break;
|
||||
}
|
||||
case 1: // WRITE
|
||||
{
|
||||
*ptr = ((*ptr << 2) | opcode); // 2bits opcode
|
||||
*ptr = ((*ptr << addr_bits) | addr); // address bits
|
||||
*ptr <<= 16;
|
||||
instruction[0] = l_data;
|
||||
instruction[1] = h_data;
|
||||
instruction[4] = 0x20;
|
||||
break;
|
||||
}
|
||||
case 2: // READ
|
||||
case 3: // ERASE
|
||||
{
|
||||
*ptr = ((*ptr << 2) | opcode); // 2bits opcode
|
||||
*ptr = ((*ptr << addr_bits) | addr); // address bits
|
||||
*ptr <<= 16;
|
||||
instruction[4] = (opcode == 2 ? 0x10 : 0x20);
|
||||
break;
|
||||
}
|
||||
}
|
||||
}
|
||||
|
||||
// 2003 MMC need to be unlock,
|
||||
// or it will reject all reading and bank switching
|
||||
boolean unlockBandai2003_WS()
|
||||
{
|
||||
dataOut_WS();
|
||||
|
||||
// initialize all control pin state
|
||||
// RST(PH0) and CLK(PE3) to LOW
|
||||
// CART(PH3) MMC(PH4) WE(PH5) OE(PH6) IO(PE4) to HIGH
|
||||
PORTH &= ~(1 << 0);
|
||||
PORTE &= ~(1 << 3);
|
||||
PORTH |= ((1 << 3) | (1 << 4) | (1 << 5) | (1 << 6));
|
||||
PORTE |= (1 << 4);
|
||||
|
||||
// switch RST(PH0) to HIGH
|
||||
PORTH |= (1 << 0);
|
||||
|
||||
// data = 0x00ff
|
||||
PORTC = 0xff;
|
||||
PORTA = 0x00;
|
||||
|
||||
// port = 0x5a?
|
||||
PORTF = 0x0a;
|
||||
PORTL = 0x05;
|
||||
pulseCLK_WS(5);
|
||||
|
||||
// port = 0xa5?
|
||||
PORTF = 0x05;
|
||||
PORTL = 0x0a;
|
||||
pulseCLK_WS(4);
|
||||
|
||||
// IO(PE4) to LOW
|
||||
PORTE &= ~(1 << 4);
|
||||
pulseCLK_WS(6);
|
||||
|
||||
// IO(PE4) to HIGH
|
||||
PORTE |= (1 << 4);
|
||||
pulseCLK_WS(1);
|
||||
|
||||
// IO(PE4) to LOW
|
||||
PORTE &= ~(1 << 4);
|
||||
pulseCLK_WS(1);
|
||||
|
||||
// IO(PE4) to HIGH
|
||||
PORTE |= (1 << 4);
|
||||
pulseCLK_WS(1);
|
||||
|
||||
// IO(PE4) to LOW
|
||||
PORTE &= ~(1 << 4);
|
||||
pulseCLK_WS(3);
|
||||
|
||||
// IO(PE4) to HIGH
|
||||
PORTE |= (1 << 4);
|
||||
pulseCLK_WS(1);
|
||||
|
||||
// IO(PE4) to LOW
|
||||
PORTE &= ~(1 << 4);
|
||||
pulseCLK_WS(1);
|
||||
|
||||
// IO(PE4) to HIGH
|
||||
PORTE |= (1 << 4);
|
||||
pulseCLK_WS(1);
|
||||
|
||||
// IO(PE4) to LOW
|
||||
PORTE &= ~(1 << 4);
|
||||
pulseCLK_WS(3);
|
||||
|
||||
// IO(PE4) to HIGH
|
||||
PORTE |= (1 << 4);
|
||||
|
||||
// pulse CLK once
|
||||
pulseCLK_WS(1);
|
||||
|
||||
// unlock procedure finished
|
||||
// see if we can set bank number to MMC
|
||||
writeByte_WSPort(0xc2, 0xaa);
|
||||
writeByte_WSPort(0xc3, 0x55);
|
||||
|
||||
dataIn_WS();
|
||||
if (readByte_WSPort(0xc2) == 0xaa && readByte_WSPort(0xc3) == 0x55)
|
||||
{
|
||||
// now set initial bank number to MMC
|
||||
dataOut_WS();
|
||||
writeByte_WSPort(0xc0, 0x2f);
|
||||
writeByte_WSPort(0xc1, 0x3f);
|
||||
writeByte_WSPort(0xc2, 0xff);
|
||||
writeByte_WSPort(0xc3, 0xff);
|
||||
return true;
|
||||
}
|
||||
|
||||
return false;
|
||||
}
|
||||
|
||||
// doing a L->H on CLK(PE3) pin
|
||||
void pulseCLK_WS(uint8_t count)
|
||||
{
|
||||
register uint8_t tic;
|
||||
|
||||
// about 384KHz, 50% duty cycle
|
||||
asm volatile
|
||||
("L0_%=:\n\t"
|
||||
"cpi %[count], 0\n\t"
|
||||
"breq L3_%=\n\t"
|
||||
"dec %[count]\n\t"
|
||||
"cbi %[porte], 3\n\t"
|
||||
"ldi %[tic], 6\n\t"
|
||||
"L1_%=:\n\t"
|
||||
"dec %[tic]\n\t"
|
||||
"brne L1_%=\n\t"
|
||||
"sbi %[porte], 3\n\t"
|
||||
"ldi %[tic], 5\n\t"
|
||||
"L2_%=:\n\t"
|
||||
"dec %[tic]\n\t"
|
||||
"brne L2_%=\n\t"
|
||||
"rjmp L0_%=\n\t"
|
||||
"L3_%=:\n\t"
|
||||
: [tic] "=a" (tic)
|
||||
: [count] "a" (count), [porte] "I" (_SFR_IO_ADDR(PORTE))
|
||||
);
|
||||
}
|
||||
|
||||
void dataIn_WS()
|
||||
{
|
||||
DDRC = 0x00;
|
||||
DDRA = 0x00;
|
||||
}
|
||||
|
||||
void dataOut_WS()
|
||||
{
|
||||
DDRC = 0xff;
|
||||
DDRA = 0xff;
|
||||
}
|
||||
Loading…
Reference in New Issue
Block a user