Mirrors/cartreader
2
0
Fork 0
mirror of https://github.com/sanni/cartreader.git synced 2024-11-14 08:55:06 +01:00
Code Issues Projects Releases Wiki Activity

V21 Updated GB code to insidegadgets newest version

Browse Source 
Known bug: When writing a 4MB Game Boy flashcart you can't write anything to offset 0x2A8000. So you get one byte error at the end.
I don't know why.
This commit is contained in:
sanni 2017-01-30 15:49:04 +01:00 committed by GitHub
parent 6bcdc9526c
commit 6a9099be8c
2 changed files with 294 additions and 332 deletions
Show Stats Download Patch File Download Diff File Expand all files Collapse all files

6
Cart_Reader/Cart_Reader.ino
View File

@ -2,8 +2,8 @@
Cartridge Reader for Arduino Mega2560 Cartridge Reader for Arduino Mega2560
Author: sanni Author: sanni
Date: 2017-01-29 Date: 2017-01-30
Version: V20 Version: V21
SD lib: https://github.com/greiman/SdFat SD lib: https://github.com/greiman/SdFat
LCD lib: https://github.com/adafruit/Adafruit_SSD1306 LCD lib: https://github.com/adafruit/Adafruit_SSD1306
@ -34,7 +34,7 @@
YamaArashi - GBA flashrom bank switch command YamaArashi - GBA flashrom bank switch command
**********************************************************************************/ **********************************************************************************/
char ver[5] = "V20"; char ver[5] = "V21";
/****************************************** /******************************************
Define Output Define Output

438
Cart_Reader/GB.ino
View File

@ -7,6 +7,8 @@
*****************************************/ *****************************************/
// Game Boy // Game Boy
int sramBanks; int sramBanks;
int romBanks;
uint16_t sramEndAddress = 0;
/****************************************** /******************************************
Menu Menu
@ -15,14 +17,11 @@ int sramBanks;
const char GBMenuItem1[] PROGMEM = "Read Rom"; const char GBMenuItem1[] PROGMEM = "Read Rom";
const char GBMenuItem2[] PROGMEM = "Read Save"; const char GBMenuItem2[] PROGMEM = "Read Save";
const char GBMenuItem3[] PROGMEM = "Write Save"; const char GBMenuItem3[] PROGMEM = "Write Save";
const char GBMenuItem4[] PROGMEM = "Write Flash"; const char GBMenuItem4[] PROGMEM = "Write Flashcart";
const char GBMenuItem5[] PROGMEM = "Reset"; const char GBMenuItem5[] PROGMEM = "Reset";
const char* const menuOptionsGB[] PROGMEM = {GBMenuItem1, GBMenuItem2, GBMenuItem3, GBMenuItem4, GBMenuItem5}; const char* const menuOptionsGB[] PROGMEM = {GBMenuItem1, GBMenuItem2, GBMenuItem3, GBMenuItem4, GBMenuItem5};
void gbMenu() { void gbMenu() {
// Output a high signal on CS(PH3) WR(PH5) RD(PH6)
PORTH |= (1 << 3) | (1 << 5) | (1 << 6);
// create menu with title and 5 options to choose from // create menu with title and 5 options to choose from
unsigned char mainMenu; unsigned char mainMenu;
// Copy menuOptions out of progmem // Copy menuOptions out of progmem
@ -42,13 +41,21 @@ void gbMenu() {
case 1: case 1:
display_Clear(); display_Clear();
// Does cartridge have SRAM
if (sramEndAddress > 0) {
// Change working dir to root // Change working dir to root
sd.chdir("/"); sd.chdir("/");
readSRAM_GB(); readSRAM_GB();
}
else {
print_Error(F("Cart has no Sram"), false);
}
break; break;
case 2: case 2:
display_Clear(); display_Clear();
// Does cartridge have SRAM
if (sramEndAddress > 0) {
// Change working dir to root // Change working dir to root
sd.chdir("/"); sd.chdir("/");
writeSRAM_GB(); writeSRAM_GB();
@ -64,12 +71,19 @@ void gbMenu() {
println_Msg(F(" bytes ")); println_Msg(F(" bytes "));
print_Error(F("did not verify."), false); print_Error(F("did not verify."), false);
} }
}
else {
print_Error(F("Cart has no Sram"), false);
}
break; break;
case 3: case 3:
// Change working dir to root // Change working dir to root
sd.chdir("/"); sd.chdir("/");
writeFlash_GB(); writeFlash_GB();
// Reset
wait();
asm volatile (" jmp 0");
break; break;
case 4: case 4:
@ -105,7 +119,9 @@ void setup_GB() {
// Set Data Pins (D0-D7) to Input // Set Data Pins (D0-D7) to Input
DDRC = 0x00; DDRC = 0x00;
// Disable Internal Pullups // Disable Internal Pullups
PORTC = 0x00; //PORTC = 0x00;
delay(400);
// Print start page // Print start page
getCartInfo_GB(); getCartInfo_GB();
@ -147,80 +163,52 @@ void setup_GB() {
println_Msg(F(" ")); println_Msg(F(" "));
print_Msg(F("Rom Size: ")); print_Msg(F("Rom Size: "));
switch (romSize) { switch (romSize) {
case 0: case 0: print_Msg(F("32KB")); break;
print_Msg(F("32KByte")); case 1: print_Msg(F("64KB")); break;
break; case 2: print_Msg(F("128KB")); break;
case 1: case 3: print_Msg(F("256KB")); break;
print_Msg(F("64KByte")); case 4: print_Msg(F("512KB")); break;
break;
case 2:
print_Msg(F("128KByte"));
break;
case 3:
print_Msg(F("256KByte"));
break;
case 4:
print_Msg(F("512KByte"));
break;
case 5: case 5:
if (romType == 1 || romType == 2 || romType == 3) { if (romType == 1 || romType == 2 || romType == 3) {
print_Msg(F("1MByte")); print_Msg(F("1MB"));
} }
else { else {
print_Msg(F("1MByte")); print_Msg(F("1MB"));
} }
break; break;
case 6: case 6:
if (romType == 1 || romType == 2 || romType == 3) { if (romType == 1 || romType == 2 || romType == 3) {
print_Msg(F("2MByte")); print_Msg(F("2MB"));
} }
else { else {
print_Msg(F("2MByte")); print_Msg(F("2MB"));
} }
break; break;
case 7: case 7: print_Msg(F("4MB")); break;
print_Msg(F("4MByte")); case 82: print_Msg(F("1.1MB")); break;
break; case 83: print_Msg(F("1.2MB")); break;
case 82: case 84: print_Msg(F("1.5MB)")); break;
print_Msg(F("1.1MByten")); default: print_Msg(F("Not found"));
break;
case 83:
print_Msg(F("1.2MByte"));
break;
case 84:
print_Msg(F("1.5MByte"));
break;
default:
print_Msg(F("Not found"));
} }
println_Msg(F("")); println_Msg(F(""));
print_Msg(F("Banks: ")); print_Msg(F("Banks: "));
println_Msg(numBanks); println_Msg(romBanks);
print_Msg(F("Sram Size: ")); print_Msg(F("Sram Size: "));
switch (sramSize) { switch (sramSize) {
case 0: case 0:
if (romType == 6) { if (romType == 6) {
print_Msg(F("512 bytes")); print_Msg(F("512B"));
} }
else { else {
print_Msg(F("None")); print_Msg(F("None"));
} }
break; break;
case 1: case 1: print_Msg(F("2KB")); break;
print_Msg(F("2 KBytes")); case 2: print_Msg(F("8KB")); break;
break; case 3: print_Msg(F("32KB")); break;
case 2: case 4: print_Msg(F("128KB")); break;
print_Msg(F("8 KBytes")); default: print_Msg(F("Not found"));
break;
case 3:
print_Msg(F("32 KBytes"));
break;
case 4:
print_Msg(F("128 KBytes"));
break;
default:
print_Msg(F("Not found"));
} }
println_Msg(F("")); println_Msg(F(""));
print_Msg(F("Checksum: ")); print_Msg(F("Checksum: "));
@ -299,6 +287,48 @@ void writeByte_GB(int myAddress, uint8_t myData) {
*****************************************/ *****************************************/
// Read Cartridge Header // Read Cartridge Header
void getCartInfo_GB() { void getCartInfo_GB() {
romType = readByte_GB(0x0147);
romSize = readByte_GB(0x0148);
sramSize = readByte_GB(0x0149);
// ROM banks
romBanks = 2; // Default 32K
if (romSize >= 1) { // Calculate rom size
romBanks = 2 << romSize;
}
// RAM banks
sramBanks = 0; // Default 0K RAM
if (romType == 6) {
sramBanks = 1;
}
if (sramSize == 2) {
sramBanks = 1;
}
if (sramSize == 3) {
sramBanks = 4;
}
if (sramSize == 4) {
sramBanks = 16;
}
if (sramSize == 5) {
sramBanks = 8;
}
// RAM end address
if (romType == 6) {
sramEndAddress = 0xA1FF; // MBC2 512bytes (nibbles)
}
if (sramSize == 1) {
sramEndAddress = 0xA7FF; // 2K RAM
}
if (sramSize > 1) {
sramEndAddress = 0xBFFF; // 8K RAM
}
// Get Checksum as string
sprintf(checksumStr, "%02X%02X", readByte_GB(0x014E), readByte_GB(0x014F));
// Dump name into 8.3 compatible format // Dump name into 8.3 compatible format
byte myByte = 0; byte myByte = 0;
byte myLength = 0; byte myLength = 0;
@ -310,55 +340,6 @@ void getCartInfo_GB() {
myLength++; myLength++;
} }
} }
// Get Checksum as string
sprintf(checksumStr, "%02X%02X", readByte_GB(0x014E), readByte_GB(0x014F));
romType = readByte_GB(0x0147);
romSize = readByte_GB(0x0148);
sramSize = readByte_GB(0x0149);
numBanks = 2; // Default 32K
if (romSize == 1) {
numBanks = 4;
}
if (romSize == 2) {
numBanks = 8;
}
if (romSize == 3) {
numBanks = 16;
}
if (romSize == 4) {
numBanks = 32;
}
if (romSize == 5 && (romType == 1 || romType == 2 || romType == 3)) {
numBanks = 63;
}
else if (romSize == 5) {
numBanks = 64;
}
if (romSize == 6 && (romType == 1 || romType == 2 || romType == 3)) {
numBanks = 125;
}
else if (romSize == 6) {
numBanks = 128;
}
if (romSize == 7) {
numBanks = 255;
}
if (romSize == 82) {
numBanks = 72;
}
if (romSize == 83) {
numBanks = 80;
}
if (romSize == 84) {
numBanks = 96;
}
sramBanks = 1; // Default 8K RAM
if (sramSize == 3) {
sramBanks = 4;
}
if (sramSize == 4) {
sramBanks = 16; // GB Camera
}
} }
// Dump ROM // Dump ROM
@ -389,25 +370,40 @@ void readROM_GB() {
print_Error(F("Can't create file on SD"), true); print_Error(F("Can't create file on SD"), true);
} }
unsigned int addr = 0; uint16_t romAddress = 0;
// Read x number of banks // Read number of banks and switch banks
for (int y = 1; y < numBanks; y++) { for (uint16_t bank = 1; bank < romBanks; bank++) {
// Switch data pins to output
dataOut(); dataOut();
// Set ROM bank
writeByte_GB(0x2100, y); if (romType >= 5) { // MBC2 and above
dataIn_GB(); writeByte_GB(0x2100, bank); // Set ROM bank
if (y > 1) {
addr = 0x4000;
} }
for (; addr <= 0x7FFF; addr = addr + 512) { else { // MBC1
writeByte_GB(0x6000, 0); // Set ROM Mode
writeByte_GB(0x4000, bank >> 5); // Set bits 5 & 6 (01100000) of ROM bank
writeByte_GB(0x2000, bank & 0x1F); // Set bits 0 & 4 (00011111) of ROM bank
}
// Switch data pins to intput
dataIn_GB();
if (bank > 1) {
romAddress = 0x4000;
}
// Read up to 7FFF per bank
while (romAddress <= 0x7FFF) {
uint8_t readData[512]; uint8_t readData[512];
for (int i = 0; i < 512; i++) { for (int i = 0; i < 512; i++) {
readData[i] = readByte_GB(addr + i); readData[i] = readByte_GB(romAddress + i);
} }
myFile.write(readData, 512); myFile.write(readData, 512);
romAddress += 512;
} }
} }
// Close the file: // Close the file:
myFile.close(); myFile.close();
@ -483,6 +479,8 @@ boolean compare_checksum_GB() {
// Read RAM // Read RAM
void readSRAM_GB() { void readSRAM_GB() {
// Does cartridge have RAM
if (sramEndAddress > 0) {
// Get name, add extension and convert to char array for sd lib // Get name, add extension and convert to char array for sd lib
char fileName[26]; char fileName[26];
@ -504,50 +502,40 @@ void readSRAM_GB() {
print_Error(F("SD Error"), true); print_Error(F("SD Error"), true);
} }
dataIn_GB();
// MBC2 Fix (unknown why this fixes it, maybe has to read ROM before RAM?) // MBC2 Fix (unknown why this fixes it, maybe has to read ROM before RAM?)
readByte_GB(0x0134); readByte_GB(0x0134);
unsigned int addr = 0; dataOut();
unsigned int endaddr = 0; if (romType <= 4) { // MBC1
if (romType == 6 && sramSize == 0) { writeByte_GB(0x6000, 1); // Set RAM Mode
endaddr = 0xA1FF; // MBC2 512bytes (nibbles)
}
if (sramSize == 1) {
endaddr = 0xA7FF; // 2K RAM
}
if (sramSize > 1) {
endaddr = 0xBFFF; // 8K RAM
} }
// Does cartridge have RAM
if (endaddr > 0) {
dataOut();
// Initialise MBC // Initialise MBC
writeByte_GB(0x0000, 0x0A); writeByte_GB(0x0000, 0x0A);
// Switch RAM banks // Switch SRAM banks
for (int bank = 0; bank < sramBanks; bank++) { for (uint8_t bank = 0; bank < sramBanks; bank++) {
dataOut(); dataOut();
writeByte_GB(0x4000, bank); writeByte_GB(0x4000, bank);
// Read RAM // Read SRAM
dataIn_GB(); dataIn_GB();
for (addr = 0xA000; addr <= endaddr; addr = addr + 64) { for (uint16_t sramAddress = 0xA000; sramAddress <= sramEndAddress; sramAddress += 64) {
uint8_t readData[64]; uint8_t readData[64];
for (int i = 0; i < 64; i++) { for (uint8_t i = 0; i < 64; i++) {
readData[i] = readByte_GB(addr + i); readData[i] = readByte_GB(sramAddress + i);
} }
myFile.write(readData, 64); myFile.write(readData, 64);
} }
} }
// Disable SRAM
dataOut(); dataOut();
// Disable RAM
writeByte_GB(0x0000, 0x00); writeByte_GB(0x0000, 0x00);
dataIn_GB(); dataIn_GB();
}
else {
print_Error(F("Cart has no SRAM"), false);
}
// Close the file: // Close the file:
myFile.close(); myFile.close();
@ -560,9 +548,15 @@ void readSRAM_GB() {
println_Msg(fileName); println_Msg(fileName);
display_Update(); display_Update();
} }
else {
print_Error(F("Cart has no SRAM"), false);
}
}
// Write RAM // Write RAM
void writeSRAM_GB() { void writeSRAM_GB() {
// Does cartridge have SRAM
if (sramEndAddress > 0) {
filePath[0] = '\0'; filePath[0] = '\0';
sd.chdir("/"); sd.chdir("/");
@ -572,39 +566,31 @@ void writeSRAM_GB() {
//open file on sd card //open file on sd card
if (myFile.open(filePath, O_READ)) { if (myFile.open(filePath, O_READ)) {
// Set pins to input
dataIn_GB();
// MBC2 Fix (unknown why this fixes it, maybe has to read ROM before RAM?) // MBC2 Fix (unknown why this fixes it, maybe has to read ROM before RAM?)
readByte_GB(0x0134); readByte_GB(0x0134);
unsigned int addr = 0;
unsigned int endaddr = 0; dataOut();
if (romType == 6 && sramSize == 0) {
endaddr = 0xA1FF; // MBC2 512bytes (nibbles) if (romType <= 4) { // MBC1
} writeByte_GB(0x6000, 1); // Set RAM Mode
if (sramSize == 1) {
endaddr = 0xA7FF; // 2K RAM
}
if (sramSize > 1) {
endaddr = 0xBFFF; // 8K RAM
} }
// Does cartridge have RAM
if (endaddr > 0) {
dataOut();
// Initialise MBC // Initialise MBC
writeByte_GB(0x0000, 0x0A); writeByte_GB(0x0000, 0x0A);
// Switch RAM banks // Switch RAM banks
for (int bank = 0; bank < sramBanks; bank++) { for (uint8_t bank = 0; bank < sramBanks; bank++) {
writeByte_GB(0x4000, bank); writeByte_GB(0x4000, bank);
// Write RAM // Write RAM
for (addr = 0xA000; addr <= endaddr; addr = addr + 64) { for (uint16_t sramAddress = 0xA000; sramAddress <= sramEndAddress; sramAddress++) {
// Wait for serial input
for (uint8_t i = 0; i < 64; i++) {
// Pull CS(PH3) LOW // Pull CS(PH3) LOW
PORTH &= ~(1 << 3); PORTH &= ~(1 << 3);
// Write to RAM // Write to RAM
writeByte_GB(addr + i, myFile.read()); writeByte_GB(sramAddress, myFile.read());
asm volatile("nop"); asm volatile("nop");
asm volatile("nop"); asm volatile("nop");
asm volatile("nop"); asm volatile("nop");
@ -612,15 +598,9 @@ void writeSRAM_GB() {
PORTH |= (1 << 3) ; PORTH |= (1 << 3) ;
} }
} }
}
// Disable RAM // Disable RAM
writeByte_GB(0x0000, 0x00); writeByte_GB(0x0000, 0x00);
Serial.flush(); // Flush any serial data that wasn't processed
}
else {
print_Error(F("Cart has no SRAM"), false);
}
// Set pins to input // Set pins to input
dataIn_GB(); dataIn_GB();
@ -629,11 +609,16 @@ void writeSRAM_GB() {
display_Clear(); display_Clear();
println_Msg(F("SRAM writing finished")); println_Msg(F("SRAM writing finished"));
display_Update(); display_Update();
} }
else { else {
print_Error(F("File doesnt exist"), false); print_Error(F("File doesnt exist"), false);
} }
} }
else {
print_Error(F("Cart has no SRAM"), false);
}
}
// Check if the SRAM was written without any error // Check if the SRAM was written without any error
unsigned long verifySRAM_GB() { unsigned long verifySRAM_GB() {
@ -644,39 +629,33 @@ unsigned long verifySRAM_GB() {
// Variable for errors // Variable for errors
writeErrors = 0; writeErrors = 0;
dataIn_GB();
// MBC2 Fix (unknown why this fixes it, maybe has to read ROM before RAM?) // MBC2 Fix (unknown why this fixes it, maybe has to read ROM before RAM?)
readByte_GB(0x0134); readByte_GB(0x0134);
unsigned int addr = 0; // Does cartridge have RAM
unsigned int endaddr = 0; if (sramEndAddress > 0) {
if (romType == 6 && sramSize == 0) { dataOut();
endaddr = 0xA1FF; // MBC2 512bytes (nibbles) if (romType <= 4) { // MBC1
} writeByte_GB(0x6000, 1); // Set RAM Mode
if (sramSize == 1) {
endaddr = 0xA7FF; // 2K RAM
}
if (sramSize > 1) {
endaddr = 0xBFFF; // 8K RAM
} }
// Does cartridge have RAM
if (endaddr > 0) {
dataOut();
// Initialise MBC // Initialise MBC
writeByte_GB(0x0000, 0x0A); writeByte_GB(0x0000, 0x0A);
// Switch RAM banks // Switch SRAM banks
for (int bank = 0; bank < sramBanks; bank++) { for (uint8_t bank = 0; bank < sramBanks; bank++) {
dataOut(); dataOut();
writeByte_GB(0x4000, bank); writeByte_GB(0x4000, bank);
// Read RAM // Read SRAM
dataIn_GB(); dataIn_GB();
for (addr = 0xA000; addr <= endaddr; addr = addr + 64) { for (uint16_t sramAddress = 0xA000; sramAddress <= sramEndAddress; sramAddress += 64) {
//fill sdBuffer //fill sdBuffer
myFile.read(sdBuffer, 64); myFile.read(sdBuffer, 64);
for (int c = 0; c < 64; c++) { for (int c = 0; c < 64; c++) {
if (readByte_GB(addr + c) != sdBuffer[c]) { if (readByte_GB(sramAddress + c) != sdBuffer[c]) {
writeErrors++; writeErrors++;
} }
} }
@ -696,12 +675,6 @@ unsigned long verifySRAM_GB() {
} }
} }
/* Switch rom bank
void switchRomBank(word romBank) {
writeByte_GB(0x3000, romBank >> 8);
writeByte_GB(0x2000, romBank & 0xFFu);
}*/
// Write 29F032 flashrom // Write 29F032 flashrom
// A0-A13 directly connected to cart edge -> 16384(0x0-0x3FFF) bytes per bank -> 256(0x0-0xFF) banks // A0-A13 directly connected to cart edge -> 16384(0x0-0x3FFF) bytes per bank -> 256(0x0-0xFF) banks
// A14-A21 connected to MBC5 // A14-A21 connected to MBC5
@ -724,42 +697,10 @@ void writeFlash_GB() {
// Go back to file beginning // Go back to file beginning
myFile.seekSet(0); myFile.seekSet(0);
numBanks = 2; // Default 32K // ROM banks
if (romSize == 1) { romBanks = 2; // Default 32K
numBanks = 4; if (romSize >= 1) { // Calculate rom size
} romBanks = 2 << romSize;
if (romSize == 2) {
numBanks = 8;
}
if (romSize == 3) {
numBanks = 16;
}
if (romSize == 4) {
numBanks = 32;
}
if (romSize == 5 && (romType == 1 || romType == 2 || romType == 3)) {
numBanks = 63;
}
else if (romSize == 5) {
numBanks = 64;
}
if (romSize == 6 && (romType == 1 || romType == 2 || romType == 3)) {
numBanks = 125;
}
else if (romSize == 6) {
numBanks = 128;
}
if (romSize == 7) {
numBanks = 255;
}
if (romSize == 82) {
numBanks = 72;
}
if (romSize == 83) {
numBanks = 80;
}
if (romSize == 84) {
numBanks = 96;
} }
// Set data pins to output // Set data pins to output
@ -788,21 +729,21 @@ void writeFlash_GB() {
if (strcmp(flashid, "04D4") == 0) { if (strcmp(flashid, "04D4") == 0) {
println_Msg(F("MBM29F033C")); println_Msg(F("MBM29F033C"));
print_Msg(F("Banks: ")); print_Msg(F("Banks: "));
print_Msg(numBanks); print_Msg(romBanks);
println_Msg(F("/255")); println_Msg(F("/256"));
display_Update(); display_Update();
} }
else if (strcmp(flashid, "0141") == 0) { else if (strcmp(flashid, "0141") == 0) {
println_Msg(F("AM29F032B")); println_Msg(F("AM29F032B"));
print_Msg(F("Banks: ")); print_Msg(F("Banks: "));
print_Msg(numBanks); print_Msg(romBanks);
println_Msg(F("/256")); println_Msg(F("/256"));
display_Update(); display_Update();
} }
else if (strcmp(flashid, "01AD") == 0) { else if (strcmp(flashid, "01AD") == 0) {
println_Msg(F("AM29F016B")); println_Msg(F("AM29F016B"));
print_Msg(F("Banks: ")); print_Msg(F("Banks: "));
print_Msg(numBanks); print_Msg(romBanks);
println_Msg(F("/128")); println_Msg(F("/128"));
display_Update(); display_Update();
} }
@ -848,7 +789,7 @@ void writeFlash_GB() {
display_Update(); display_Update();
// Read x number of banks // Read x number of banks
for (int currBank = 0; currBank < numBanks; currBank++) { for (int currBank = 0; currBank < romBanks; currBank++) {
// Blink led // Blink led
PORTB ^= (1 << 4); PORTB ^= (1 << 4);
@ -878,7 +819,7 @@ void writeFlash_GB() {
// Write flash // Write flash
dataOut(); dataOut();
for (int currBank = 0; currBank < numBanks; currBank++) { for (int currBank = 0; currBank < romBanks; currBank++) {
// Blink led // Blink led
PORTB ^= (1 << 4); PORTB ^= (1 << 4);
@ -903,7 +844,14 @@ void writeFlash_GB() {
PORTH &= ~((1 << 3) | (1 << 6)); PORTH &= ~((1 << 3) | (1 << 6));
// Busy check // Busy check
int timeout = 0;
while ((PINC & 0x80) != (sdBuffer[currByte] & 0x80)) { while ((PINC & 0x80) != (sdBuffer[currByte] & 0x80)) {
__asm__("nop\n\t");
// Writing to 0x2A8000 fails for some unknown reason so a timeout is needed
timeout++;
if (timeout > 32760) {
break;
}
} }
// Switch CS(PH3) and OE/RD(PH6) to HIGH // Switch CS(PH3) and OE/RD(PH6) to HIGH
@ -927,28 +875,42 @@ void writeFlash_GB() {
writeErrors = 0; writeErrors = 0;
// Verify flashrom // Verify flashrom
for (int y = 1; y < numBanks; y++) { uint16_t romAddress = 0;
// Set ROM bank
// Read number of banks and switch banks
for (uint16_t bank = 1; bank < romBanks; bank++) {
// Switch data pins to output
dataOut(); dataOut();
writeByte_GB(0x2100, y);
if (romType >= 5) { // MBC2 and above
writeByte_GB(0x2100, bank); // Set ROM bank
}
else { // MBC1
writeByte_GB(0x6000, 0); // Set ROM Mode
writeByte_GB(0x4000, bank >> 5); // Set bits 5 & 6 (01100000) of ROM bank
writeByte_GB(0x2000, bank & 0x1F); // Set bits 0 & 4 (00011111) of ROM bank
}
// Switch data pins to intput
dataIn_GB(); dataIn_GB();
if (bank > 1) {
romAddress = 0x4000;
}
// Blink led // Blink led
PORTB ^= (1 << 4); PORTB ^= (1 << 4);
if (y > 1) { // Read up to 7FFF per bank
addr = 0x4000; while (romAddress <= 0x7FFF) {
}
for (; addr <= 0x7FFF; addr = addr + 512) {
// Fill sdBuffer // Fill sdBuffer
myFile.read(sdBuffer, 512); myFile.read(sdBuffer, 512);
// Compare // Compare
for (int i = 0; i < 512; i++) { for (int i = 0; i < 512; i++) {
if (readByte_GB(addr + i) != sdBuffer[i]) { if (readByte_GB(romAddress + i) != sdBuffer[i]) {
writeErrors++; writeErrors++;
} }
} }
romAddress += 512;
} }
} }
// Close the file: // Close the file: