use core::convert::Infallible;
use std::time::{Duration, Instant};
pub trait Periodic {}
pub trait CountDown {
type Error: core::fmt::Debug;
type Time;
fn start<T>(&mut self, count: T) -> Result<(), Self::Error>
where
T: Into<Self::Time>;
fn wait(&mut self) -> nb::Result<(), Self::Error>;
}
impl<T: CountDown> CountDown for &mut T {
type Error = T::Error;
type Time = T::Time;
fn start<TIME>(&mut self, count: TIME) -> Result<(), Self::Error>
where
TIME: Into<Self::Time>,
{
T::start(self, count)
}
fn wait(&mut self) -> nb::Result<(), Self::Error> {
T::wait(self)
}
}
pub struct SysTimer {
start: Instant,
duration: Duration,
}
impl SysTimer {
pub fn new() -> SysTimer {
SysTimer {
start: Instant::now(),
duration: Duration::from_millis(0),
}
}
}
impl Default for SysTimer {
fn default() -> SysTimer {
SysTimer::new()
}
}
impl CountDown for SysTimer {
type Error = Infallible;
type Time = Duration;
fn start<T>(&mut self, count: T) -> Result<(), Self::Error>
where
T: Into<Self::Time>,
{
self.start = Instant::now();
self.duration = count.into();
Ok(())
}
fn wait(&mut self) -> nb::Result<(), Self::Error> {
if (Instant::now() - self.start) >= self.duration {
self.start = Instant::now();
Ok(())
} else {
Err(nb::Error::WouldBlock)
}
}
}
impl Periodic for SysTimer {}
#[cfg(test)]
mod tests {
use super::*;
#[test]
fn test_delay() {
let mut timer = SysTimer::new();
let before = Instant::now();
timer.start(Duration::from_millis(100)).unwrap();
nb::block!(timer.wait()).unwrap();
let after = Instant::now();
let duration_ms = (after - before).as_millis();
assert!(duration_ms >= 100);
assert!(duration_ms < 500);
}
#[test]
fn test_periodic() {
let mut timer = SysTimer::new();
let before = Instant::now();
timer.start(Duration::from_millis(100)).unwrap();
nb::block!(timer.wait()).unwrap();
let after1 = Instant::now();
let duration_ms_1 = (after1 - before).as_millis();
assert!(duration_ms_1 >= 100);
assert!(duration_ms_1 < 500);
nb::block!(timer.wait()).unwrap();
let after2 = Instant::now();
let duration_ms_2 = (after2 - after1).as_millis();
assert!(duration_ms_2 >= 100);
assert!(duration_ms_2 < 500);
}
}