124 lines
3.6 KiB
C
124 lines
3.6 KiB
C
#include "gb.h"
|
|
#include <assert.h>
|
|
|
|
void GB_update_joyp(GB_gameboy_t *gb)
|
|
{
|
|
if (gb->model & GB_MODEL_NO_SFC_BIT) return;
|
|
|
|
uint8_t key_selection = 0;
|
|
uint8_t previous_state = 0;
|
|
|
|
/* Todo: add delay to key selection */
|
|
previous_state = gb->io_registers[GB_IO_JOYP] & 0xF;
|
|
key_selection = (gb->io_registers[GB_IO_JOYP] >> 4) & 3;
|
|
gb->io_registers[GB_IO_JOYP] &= 0xF0;
|
|
uint8_t current_player = gb->sgb? gb->sgb->current_player : 0;
|
|
switch (key_selection) {
|
|
case 3:
|
|
if (gb->sgb && gb->sgb->player_count > 1) {
|
|
gb->io_registers[GB_IO_JOYP] |= 0xF - current_player;
|
|
}
|
|
else {
|
|
/* Nothing is wired, all up */
|
|
gb->io_registers[GB_IO_JOYP] |= 0x0F;
|
|
}
|
|
break;
|
|
|
|
case 2:
|
|
/* Direction keys */
|
|
for (uint8_t i = 0; i < 4; i++) {
|
|
gb->io_registers[GB_IO_JOYP] |= (!gb->keys[current_player][i]) << i;
|
|
}
|
|
/* Forbid pressing two opposing keys, this breaks a lot of games; even if it's somewhat possible. */
|
|
if (!(gb->io_registers[GB_IO_JOYP] & 1)) {
|
|
gb->io_registers[GB_IO_JOYP] |= 2;
|
|
}
|
|
if (!(gb->io_registers[GB_IO_JOYP] & 4)) {
|
|
gb->io_registers[GB_IO_JOYP] |= 8;
|
|
}
|
|
break;
|
|
|
|
case 1:
|
|
/* Other keys */
|
|
for (uint8_t i = 0; i < 4; i++) {
|
|
gb->io_registers[GB_IO_JOYP] |= (!gb->keys[current_player][i + 4]) << i;
|
|
}
|
|
break;
|
|
|
|
case 0:
|
|
for (uint8_t i = 0; i < 4; i++) {
|
|
gb->io_registers[GB_IO_JOYP] |= (!(gb->keys[current_player][i] || gb->keys[current_player][i + 4])) << i;
|
|
}
|
|
break;
|
|
|
|
default:
|
|
__builtin_unreachable();
|
|
break;
|
|
}
|
|
|
|
/* Todo: This assumes the keys *always* bounce, which is incorrect when emulating an SGB */
|
|
if (previous_state != (gb->io_registers[GB_IO_JOYP] & 0xF)) {
|
|
/* The joypad interrupt DOES occur on CGB (Tested on CGB-E), unlike what some documents say. */
|
|
gb->io_registers[GB_IO_IF] |= 0x10;
|
|
}
|
|
|
|
gb->io_registers[GB_IO_JOYP] |= 0xC0;
|
|
}
|
|
|
|
void GB_icd_set_joyp(GB_gameboy_t *gb, uint8_t value)
|
|
{
|
|
uint8_t previous_state = gb->io_registers[GB_IO_JOYP] & 0xF;
|
|
gb->io_registers[GB_IO_JOYP] &= 0xF0;
|
|
gb->io_registers[GB_IO_JOYP] |= value & 0xF;
|
|
|
|
if (previous_state & ~(gb->io_registers[GB_IO_JOYP] & 0xF)) {
|
|
gb->io_registers[GB_IO_IF] |= 0x10;
|
|
}
|
|
gb->io_registers[GB_IO_JOYP] |= 0xC0;
|
|
}
|
|
|
|
void GB_set_key_state(GB_gameboy_t *gb, GB_key_t index, bool pressed)
|
|
{
|
|
assert(index >= 0 && index < GB_KEY_MAX);
|
|
gb->keys[0][index] = pressed;
|
|
GB_update_joyp(gb);
|
|
}
|
|
|
|
void GB_set_key_state_for_player(GB_gameboy_t *gb, GB_key_t index, unsigned player, bool pressed)
|
|
{
|
|
assert(index >= 0 && index < GB_KEY_MAX);
|
|
assert(player < 4);
|
|
gb->keys[player][index] = pressed;
|
|
GB_update_joyp(gb);
|
|
}
|
|
|
|
void GB_set_key_mask(GB_gameboy_t *gb, GB_key_mask_t mask)
|
|
{
|
|
memset(gb->keys, 0, sizeof(gb->keys));
|
|
bool *key = &gb->keys[0][0];
|
|
while (mask) {
|
|
if (mask & 1) {
|
|
*key = true;
|
|
}
|
|
mask >>= 1;
|
|
key++;
|
|
}
|
|
|
|
GB_update_joyp(gb);
|
|
}
|
|
|
|
void GB_set_key_mask_for_player(GB_gameboy_t *gb, GB_key_mask_t mask, unsigned player)
|
|
{
|
|
memset(gb->keys[player], 0, sizeof(gb->keys[player]));
|
|
bool *key = gb->keys[player];
|
|
while (mask) {
|
|
if (mask & 1) {
|
|
*key = true;
|
|
}
|
|
mask >>= 1;
|
|
key++;
|
|
}
|
|
|
|
GB_update_joyp(gb);
|
|
}
|