gb/src/timer.rs

138 lines
3.0 KiB
Rust
Raw Normal View History

2021-03-27 17:10:18 +00:00
use crate::Cycle;
use bitfield::bitfield;
#[derive(Debug, Clone, Copy)]
pub(crate) struct Timer {
2021-06-09 18:43:46 +00:00
/// 0xFF07 | TAC - Timer Control
pub(crate) ctrl: TimerControl,
/// 0xFF05 | TIMA - Timer Counter
pub(crate) counter: u8,
2021-06-09 18:43:46 +00:00
/// 0xFF06 | TMA - Timer Modulo
pub(crate) modulo: u8,
2021-06-09 18:43:46 +00:00
/// 0xFF04 | DIV - Divider Register
pub(crate) divider: u16,
prev_and_result: Option<u8>,
2021-03-21 08:03:03 +00:00
interrupt: bool,
}
2021-01-19 04:54:38 +00:00
impl Timer {
pub(crate) fn step(&mut self, cycles: Cycle) {
use TimerSpeed::*;
2021-03-21 08:03:03 +00:00
for _ in 0..cycles.into() {
2021-03-21 08:03:03 +00:00
self.divider = self.divider.wrapping_add(1);
// Get Bit Position
2021-06-09 18:43:46 +00:00
let bit = match self.ctrl.speed() {
Hz4096 => 9,
Hz262144 => 3,
Hz65536 => 5,
Hz16384 => 7,
};
2021-03-21 08:03:03 +00:00
2021-04-04 06:31:31 +00:00
let bit = (self.divider >> bit) as u8 & 0x01;
2021-06-09 18:43:46 +00:00
let timer_enable = self.ctrl.enabled() as u8;
let and_result = bit & timer_enable;
if let Some(previous) = self.prev_and_result {
if previous == 0x01 && and_result == 0x00 {
2021-04-04 06:31:31 +00:00
// Falling Edge, increase TIMA Register
self.increment_tima();
}
2021-03-21 08:03:03 +00:00
}
2021-04-04 06:31:31 +00:00
self.prev_and_result = Some(and_result);
2021-03-21 08:03:03 +00:00
}
}
fn increment_tima(&mut self) {
let (result, did_overflow) = self.counter.overflowing_add(1);
2021-03-21 08:03:03 +00:00
self.counter = if did_overflow {
self.interrupt = true;
self.modulo
} else {
result
}
2021-03-21 08:03:03 +00:00
}
pub(crate) fn interrupt(&self) -> bool {
2021-03-21 08:03:03 +00:00
self.interrupt
}
pub(crate) fn set_interrupt(&mut self, value: bool) {
2021-03-21 08:03:03 +00:00
self.interrupt = value;
2021-01-19 04:54:38 +00:00
}
}
impl Default for Timer {
fn default() -> Self {
Self {
2021-06-09 18:43:46 +00:00
ctrl: Default::default(),
2021-03-21 07:01:19 +00:00
counter: 0,
2021-03-21 08:03:03 +00:00
modulo: 0,
divider: 0,
interrupt: false,
prev_and_result: None,
}
}
}
#[derive(Debug, Clone, Copy)]
pub enum TimerSpeed {
2021-03-21 08:03:03 +00:00
Hz4096 = 0,
Hz262144 = 1,
Hz65536 = 2,
Hz16384 = 3,
}
impl From<u8> for TimerSpeed {
fn from(byte: u8) -> Self {
match byte & 0b11 {
2021-03-21 08:03:03 +00:00
0b00 => Self::Hz4096,
0b01 => Self::Hz262144,
0b10 => Self::Hz65536,
0b11 => Self::Hz16384,
_ => unreachable!("{:#04X} is not a valid value for TimerSpeed", byte),
}
}
}
impl From<TimerSpeed> for u8 {
fn from(speed: TimerSpeed) -> Self {
speed as Self
}
}
bitfield! {
pub struct TimerControl(u8);
impl Debug;
pub enabled, set_enabled: 2;
pub from into TimerSpeed, speed, set_speed: 1, 0;
}
impl Copy for TimerControl {}
impl Clone for TimerControl {
fn clone(&self) -> Self {
*self
}
}
impl Default for TimerControl {
fn default() -> Self {
Self(0)
}
}
impl From<u8> for TimerControl {
fn from(byte: u8) -> Self {
Self(byte)
}
}
impl From<TimerControl> for u8 {
fn from(ctrl: TimerControl) -> Self {
ctrl.0
}
}