fix(cpu): reimplement instruction handling
continuous-integration/drone/push Build is passing
Details
continuous-integration/drone/push Build is passing
Details
This commit is contained in:
parent
7e65d82fef
commit
5d6df46a2d
150
src/cpu.rs
150
src/cpu.rs
|
@ -15,7 +15,7 @@ pub struct Cpu {
|
||||||
flags: Flags,
|
flags: Flags,
|
||||||
ime: ImeState,
|
ime: ImeState,
|
||||||
// TODO: Merge halted and state properties
|
// TODO: Merge halted and state properties
|
||||||
halted: Option<HaltState>,
|
halted: Option<HaltKind>,
|
||||||
state: State,
|
state: State,
|
||||||
}
|
}
|
||||||
|
|
||||||
|
@ -53,7 +53,7 @@ impl Cpu {
|
||||||
self.ime = state;
|
self.ime = state;
|
||||||
}
|
}
|
||||||
|
|
||||||
pub(crate) fn halt(&mut self, state: HaltState) {
|
pub(crate) fn halt(&mut self, state: HaltKind) {
|
||||||
self.halted = Some(state);
|
self.halted = Some(state);
|
||||||
}
|
}
|
||||||
|
|
||||||
|
@ -61,8 +61,8 @@ impl Cpu {
|
||||||
self.halted = None;
|
self.halted = None;
|
||||||
}
|
}
|
||||||
|
|
||||||
pub(crate) fn halted(&self) -> Option<&HaltState> {
|
pub(crate) fn halted(&self) -> Option<HaltKind> {
|
||||||
self.halted.as_ref()
|
self.halted
|
||||||
}
|
}
|
||||||
|
|
||||||
pub fn load_cartridge(&mut self, path: &str) -> std::io::Result<()> {
|
pub fn load_cartridge(&mut self, path: &str) -> std::io::Result<()> {
|
||||||
|
@ -109,33 +109,33 @@ impl Cpu {
|
||||||
///
|
///
|
||||||
/// Handle HALT state and interrupts.
|
/// Handle HALT state and interrupts.
|
||||||
pub fn step(&mut self) -> Cycle {
|
pub fn step(&mut self) -> Cycle {
|
||||||
// // Log instructions
|
// Log instructions
|
||||||
// if self.reg.pc > 0xFF {
|
// if self.reg.pc > 0xFF {
|
||||||
// let out = std::io::stdout();
|
// let out = std::io::stdout();
|
||||||
// let _ = self._print_debug(out.lock());
|
// let _ = self._print_logs(out.lock());
|
||||||
// }
|
// }
|
||||||
|
|
||||||
// FIXME: The Halt instruction takes more cycles than it should in Blargg's 2nd cpu_instrs test
|
if let Some(elapsed) = self.handle_interrupt() {
|
||||||
let elapsed = match self.halted() {
|
return elapsed;
|
||||||
Some(state) => {
|
}
|
||||||
use HaltState::*;
|
|
||||||
|
|
||||||
match state {
|
if let Some(kind) = self.halted() {
|
||||||
ImeEnabled | NonePending => {
|
use HaltKind::*;
|
||||||
self.bus.clock();
|
|
||||||
Cycle::new(4)
|
self.bus.clock();
|
||||||
}
|
|
||||||
SomePending => todo!("Implement HALT bug"),
|
let elapsed = match kind {
|
||||||
}
|
ImeEnabled | NonePending => Cycle::new(4),
|
||||||
}
|
SomePending => todo!("Implement HALT bug"),
|
||||||
None => {
|
};
|
||||||
let opcode = self.fetch();
|
|
||||||
let instr = self.decode(opcode);
|
return elapsed;
|
||||||
let elapsed = self.execute(instr);
|
}
|
||||||
self.handle_ei();
|
|
||||||
elapsed
|
let opcode = self.fetch();
|
||||||
}
|
let instr = self.decode(opcode);
|
||||||
};
|
let elapsed = self.execute(instr);
|
||||||
|
self.handle_ei();
|
||||||
|
|
||||||
// For use in Blargg's Test ROMs
|
// For use in Blargg's Test ROMs
|
||||||
if self.read_byte(0xFF02) == 0x81 {
|
if self.read_byte(0xFF02) == 0x81 {
|
||||||
|
@ -144,8 +144,6 @@ impl Cpu {
|
||||||
eprint!("{}", c);
|
eprint!("{}", c);
|
||||||
}
|
}
|
||||||
|
|
||||||
// TODO: Is this in the wrong place?
|
|
||||||
self.handle_interrupts();
|
|
||||||
elapsed
|
elapsed
|
||||||
}
|
}
|
||||||
}
|
}
|
||||||
|
@ -189,72 +187,76 @@ impl Cpu {
|
||||||
self.read_byte(0xFFFF)
|
self.read_byte(0xFFFF)
|
||||||
}
|
}
|
||||||
|
|
||||||
fn handle_interrupts(&mut self) {
|
fn handle_interrupt(&mut self) -> Option<Cycle> {
|
||||||
let req = self.int_request();
|
let irq = self.int_request();
|
||||||
let enabled = self.int_enable();
|
let enable = self.int_enable();
|
||||||
|
|
||||||
|
// TODO: Ensure that this behaviour is correct
|
||||||
if self.halted.is_some() {
|
if self.halted.is_some() {
|
||||||
// When we're here either a HALT with IME set or
|
// When we're here either a HALT with IME set or
|
||||||
// a HALT with IME not set and No pending Interrupts was called
|
// a HALT with IME not set and No pending Interrupts was called
|
||||||
|
|
||||||
if req & enabled != 0 {
|
if irq & enable != 0 {
|
||||||
// The if self.ime() below correctly follows the "resuming from HALT" behaviour so
|
// The if self.ime() below correctly follows the "resuming from HALT" behaviour so
|
||||||
// nothing actually needs to be added here. This is just documentation
|
// nothing actually needs to be added here. This is just documentation
|
||||||
// since it's a bit weird why nothing is being done
|
// since it's a bit weird why nothing is being done
|
||||||
|
|
||||||
self.resume()
|
self.resume();
|
||||||
}
|
}
|
||||||
}
|
}
|
||||||
|
|
||||||
if let ImeState::Enabled = self.ime() {
|
match self.ime() {
|
||||||
let mut req: InterruptFlag = req.into();
|
ImeState::Enabled => {
|
||||||
let enabled: InterruptEnable = enabled.into();
|
let mut irq: InterruptFlag = irq.into();
|
||||||
|
let enable: InterruptEnable = enable.into();
|
||||||
|
|
||||||
let vector = if req.vblank() && enabled.vblank() {
|
let rst_vector = if irq.vblank() && enable.vblank() {
|
||||||
// Handle VBlank Interrupt
|
// Handle VBlank Interrupt
|
||||||
req.set_vblank(false);
|
irq.set_vblank(false);
|
||||||
|
|
||||||
// INT 40h
|
// INT 40h
|
||||||
Some(0x40)
|
Some(0x40)
|
||||||
} else if req.lcd_stat() && enabled.lcd_stat() {
|
} else if irq.lcd_stat() && enable.lcd_stat() {
|
||||||
// Handle LCD STAT Interrupt
|
// Handle LCD STAT Interrupt
|
||||||
req.set_lcd_stat(false);
|
irq.set_lcd_stat(false);
|
||||||
|
|
||||||
// INT 48h
|
// INT 48h
|
||||||
Some(0x48)
|
Some(0x48)
|
||||||
} else if req.timer() && enabled.timer() {
|
} else if irq.timer() && enable.timer() {
|
||||||
// Handle Timer Interrupt
|
// Handle Timer Interrupt
|
||||||
req.set_timer(false);
|
irq.set_timer(false);
|
||||||
|
|
||||||
// INT 50h
|
// INT 50h
|
||||||
Some(0x50)
|
Some(0x50)
|
||||||
} else if req.serial() && enabled.serial() {
|
} else if irq.serial() && enable.serial() {
|
||||||
// Handle Serial Interrupt
|
// Handle Serial Interrupt
|
||||||
req.set_serial(false);
|
irq.set_serial(false);
|
||||||
|
|
||||||
// INT 58h
|
// INT 58h
|
||||||
Some(0x58)
|
Some(0x58)
|
||||||
} else if req.joypad() && enabled.joypad() {
|
} else if irq.joypad() && enable.joypad() {
|
||||||
// Handle Joypad Interrupt
|
// Handle Joypad Interrupt
|
||||||
req.set_joypad(false);
|
irq.set_joypad(false);
|
||||||
|
|
||||||
// INT 60h
|
// INT 60h
|
||||||
Some(0x60)
|
Some(0x60)
|
||||||
} else {
|
} else {
|
||||||
None
|
None
|
||||||
};
|
};
|
||||||
|
|
||||||
let _ = match vector {
|
match rst_vector {
|
||||||
Some(address) => {
|
Some(vector) => {
|
||||||
// Write the Changes to 0xFF0F and 0xFFFF registers
|
// Write the Changes to 0xFF0F and 0xFFFF registers
|
||||||
self.write_byte(0xFF0F, req.into());
|
self.write_byte(0xFF0F, irq.into());
|
||||||
|
|
||||||
// Disable all future interrupts
|
// Disable all future interrupts
|
||||||
self.set_ime(ImeState::Disabled);
|
self.set_ime(ImeState::Disabled);
|
||||||
Instruction::reset(self, address)
|
Some(Instruction::reset(self, vector))
|
||||||
|
}
|
||||||
|
None => None,
|
||||||
}
|
}
|
||||||
None => Cycle::new(0), // NO Interrupts were enabled and / or requested
|
}
|
||||||
};
|
_ => None,
|
||||||
}
|
}
|
||||||
}
|
}
|
||||||
}
|
}
|
||||||
|
@ -512,7 +514,7 @@ impl From<u8> for Flags {
|
||||||
}
|
}
|
||||||
|
|
||||||
#[derive(Debug, Clone, Copy)]
|
#[derive(Debug, Clone, Copy)]
|
||||||
pub(crate) enum HaltState {
|
pub(crate) enum HaltKind {
|
||||||
ImeEnabled,
|
ImeEnabled,
|
||||||
NonePending,
|
NonePending,
|
||||||
SomePending,
|
SomePending,
|
||||||
|
|
|
@ -9,7 +9,7 @@ use self::table::{
|
||||||
};
|
};
|
||||||
use self::table::{Group1RegisterPair, Group2RegisterPair, Group3RegisterPair, Register};
|
use self::table::{Group1RegisterPair, Group2RegisterPair, Group3RegisterPair, Register};
|
||||||
use crate::bus::{Bus, BusIo};
|
use crate::bus::{Bus, BusIo};
|
||||||
use crate::cpu::{Cpu, Flags, HaltState, ImeState, Register as CpuRegister, RegisterPair};
|
use crate::cpu::{Cpu, Flags, HaltKind, ImeState, Register as CpuRegister, RegisterPair};
|
||||||
|
|
||||||
#[allow(clippy::upper_case_acronyms)]
|
#[allow(clippy::upper_case_acronyms)]
|
||||||
#[derive(Clone, Copy)]
|
#[derive(Clone, Copy)]
|
||||||
|
@ -588,14 +588,14 @@ impl Instruction {
|
||||||
}
|
}
|
||||||
Instruction::HALT => {
|
Instruction::HALT => {
|
||||||
// HALT | Enter CPU low power consumption mode until interrupt occurs
|
// HALT | Enter CPU low power consumption mode until interrupt occurs
|
||||||
use HaltState::*;
|
use HaltKind::*;
|
||||||
|
|
||||||
let halt_state = match *cpu.ime() {
|
let kind = match *cpu.ime() {
|
||||||
ImeState::Enabled => ImeEnabled,
|
ImeState::Enabled => ImeEnabled,
|
||||||
_ if cpu.int_request() & cpu.int_enable() != 0 => SomePending,
|
_ if cpu.int_request() & cpu.int_enable() != 0 => SomePending,
|
||||||
_ => NonePending,
|
_ => NonePending,
|
||||||
};
|
};
|
||||||
cpu.halt(halt_state);
|
cpu.halt(kind);
|
||||||
Cycle::new(4)
|
Cycle::new(4)
|
||||||
}
|
}
|
||||||
Instruction::ADC(source) => match source {
|
Instruction::ADC(source) => match source {
|
||||||
|
|
Loading…
Reference in New Issue