mirror of
https://github.com/rodamaral/lsnes.git
synced 2025-04-02 10:42:15 -04:00
104 lines
2.4 KiB
C++
Executable file
104 lines
2.4 KiB
C++
Executable file
#ifdef ICD2_CPP
|
|
|
|
const unsigned dividers[4] = {4, 5, 7, 9};
|
|
|
|
//convert linear pixel data { 0x00, 0x55, 0xaa, 0xff } to 2bpp planar tiledata
|
|
void ICD2::render(const uint16 *source) {
|
|
memset(lcd.output, 0x00, 320 * sizeof(uint16));
|
|
|
|
for(unsigned y = 0; y < 8; y++) {
|
|
for(unsigned x = 0; x < 160; x++) {
|
|
unsigned pixel = *source++;
|
|
unsigned addr = y * 2 + (x / 8 * 16);
|
|
lcd.output[addr + 0] |= ((pixel & 1) >> 0) << (7 - (x & 7));
|
|
lcd.output[addr + 1] |= ((pixel & 2) >> 1) << (7 - (x & 7));
|
|
}
|
|
}
|
|
}
|
|
|
|
uint8 ICD2::read(unsigned addr) {
|
|
addr &= 0xffff;
|
|
|
|
//LY counter
|
|
if(addr == 0x6000) {
|
|
r6000_ly = gb_if->get_ly();
|
|
r6000_row = lcd.row;
|
|
return r6000_ly;
|
|
}
|
|
|
|
//command ready port
|
|
if(addr == 0x6002) {
|
|
bool data = packetsize > 0;
|
|
if(data) {
|
|
for(unsigned i = 0; i < 16; i++) r7000[i] = packet[0][i];
|
|
packetsize--;
|
|
for(unsigned i = 0; i < packetsize; i++) packet[i] = packet[i + 1];
|
|
}
|
|
return data;
|
|
}
|
|
|
|
//ICD2 revision
|
|
if(addr == 0x600f) {
|
|
return 0x21;
|
|
}
|
|
|
|
//command port
|
|
if((addr & 0xfff0) == 0x7000) {
|
|
return r7000[addr & 15];
|
|
}
|
|
|
|
//VRAM port
|
|
if(addr == 0x7800) {
|
|
uint8 data = lcd.output[r7800];
|
|
r7800 = (r7800 + 1) % 320;
|
|
return data;
|
|
}
|
|
|
|
return 0x00;
|
|
}
|
|
|
|
void ICD2::write(unsigned addr, uint8 data) {
|
|
addr &= 0xffff;
|
|
|
|
//VRAM port
|
|
if(addr == 0x6001) {
|
|
r6001 = data;
|
|
r7800 = 0;
|
|
|
|
unsigned offset = (r6000_row - (4 - (r6001 - (r6000_ly & 3)))) & 3;
|
|
render(lcd.buffer + offset * 160 * 8);
|
|
|
|
return;
|
|
}
|
|
|
|
//control port
|
|
//d7: 0 = halt, 1 = reset
|
|
//d5,d4: 0 = 1-player, 1 = 2-player, 2 = 4-player, 3 = ???
|
|
//d1,d0: 0 = frequency divider (clock rate adjust)
|
|
if(addr == 0x6003) {
|
|
unsigned new_mlt_req = ((data & 0x30) >> 4) + 1;
|
|
if(new_mlt_req == 3) new_mlt_req = 4;
|
|
if((r6003 & 0x80) == 0x00 && (data & 0x80) == 0x80) {
|
|
reset();
|
|
}
|
|
if(new_mlt_req != (mlt_req + 1)) {
|
|
//Change MLT mode and reset active joypad.
|
|
mlt_req = new_mlt_req - 1;
|
|
joyp_id = 0;
|
|
}
|
|
if(gb_if->default_rates) {
|
|
frequency = cpu.frequency / dividers[data & 3];
|
|
} else {
|
|
fdiv = 2 * dividers[data & 3];
|
|
}
|
|
r6003 = data;
|
|
return;
|
|
}
|
|
|
|
if(addr == 0x6004) { r6004 = data; return; } //joypad 1
|
|
if(addr == 0x6005) { r6005 = data; return; } //joypad 2
|
|
if(addr == 0x6006) { r6006 = data; return; } //joypad 3
|
|
if(addr == 0x6007) { r6007 = data; return; } //joypad 4
|
|
}
|
|
|
|
#endif
|