84 lines
1.5 KiB
C
84 lines
1.5 KiB
C
#include <io.h>
|
|
#include <timer.h>
|
|
#include <cpu.h>
|
|
#include <dma.h>
|
|
#include <lcd.h>
|
|
#include <gamepad.h>
|
|
#include <audio.h>
|
|
|
|
static char serial_data[2];
|
|
|
|
u8 io_read(u16 address){
|
|
if(address == 0xFF00) {
|
|
return gamepad_get_output();
|
|
}
|
|
if(address == 0xFF01) {
|
|
return serial_data[0];
|
|
}
|
|
|
|
if(address == 0xFF02) {
|
|
return serial_data[1];
|
|
}
|
|
|
|
if(BETWEEN(address, 0xFF04, 0xFF07)){
|
|
return timer_read(address);
|
|
}
|
|
|
|
if(BETWEEN(address, 0xFF40, 0xFF4B)){
|
|
return lcd_read(address);
|
|
}
|
|
|
|
if(address == 0xFF0F) {
|
|
return cpu_get_int_flags();
|
|
}
|
|
|
|
if(BETWEEN(address, 0xFF10, 0xFF3F)) {
|
|
return audio_read(address);
|
|
}
|
|
|
|
printf("UNSUPPORTED io_read(%04X)\n", address);
|
|
return 0;
|
|
}
|
|
|
|
|
|
void io_write(u16 address, u8 value){
|
|
if(address == 0xFF00) {
|
|
gamepad_set_sel(value);
|
|
return;
|
|
}
|
|
if(address == 0xFF01) {
|
|
serial_data[0] = value;
|
|
//printf("%c", value);
|
|
return;
|
|
}
|
|
|
|
if(address == 0xFF02) {
|
|
serial_data[1] = value;
|
|
return;
|
|
}
|
|
|
|
if(BETWEEN(address, 0xFF04, 0xFF07)){
|
|
timer_write(address, value);
|
|
return;
|
|
}
|
|
|
|
if(address == 0xFF0F) {
|
|
cpu_set_int_flags(value);
|
|
return;
|
|
}
|
|
|
|
if(BETWEEN(address, 0xFF40, 0xFF4B)){
|
|
lcd_write(address, value);
|
|
return;
|
|
}
|
|
|
|
if(BETWEEN(address, 0xFF10, 0xFF3F)) {
|
|
audio_write(address, value);
|
|
return;
|
|
}
|
|
|
|
|
|
printf("UNSUPPORTED io_write(%04X)\n", address);
|
|
}
|
|
|