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