use core::convert::Infallible;
use embedded_hal::timer;
use nb;
use void::Void;
use crate::{
peripherals::syscon,
raw,
typestates::{init_state, ClocksSupportUtickToken},
};
crate::wrap_stateful_peripheral!(Utick, UTICK0);
pub type EnabledUtick = Utick<init_state::Enabled>;
impl<State> Utick<State> {
pub fn enabled(
mut self,
syscon: &mut syscon::Syscon,
_clocktree_token: &ClocksSupportUtickToken,
) -> EnabledUtick {
syscon.enable_clock(&mut self.raw);
syscon.reset(&mut self.raw);
Utick {
raw: self.raw,
_state: init_state::Enabled(()),
}
}
pub fn disabled(mut self, syscon: &mut syscon::Syscon) -> Utick<init_state::Disabled> {
syscon.disable_clock(&mut self.raw);
Utick {
raw: self.raw,
_state: init_state::Disabled,
}
}
}
impl timer::Cancel for EnabledUtick {
type Error = Infallible;
fn cancel(&mut self) -> Result<(), Self::Error> {
self.raw.ctrl.write(|w| unsafe { w.delayval().bits(0) });
Ok(())
}
}
impl timer::CountDown for EnabledUtick {
type Time = u32;
fn start<T>(&mut self, timeout: T)
where
T: Into<Self::Time>,
{
let time = timeout.into();
assert!(time >= 2);
self.raw
.ctrl
.write(|w| unsafe { w.delayval().bits(time - 1) });
while self.raw.stat.read().active().bit_is_clear() {}
}
fn wait(&mut self) -> nb::Result<(), Void> {
if self.raw.stat.read().active().bit_is_clear() {
return Ok(());
}
Err(nb::Error::WouldBlock)
}
}
impl EnabledUtick {
pub fn blocking_wait(&mut self) {
while self.raw.stat.read().active().bit_is_set() {}
}
}