use std::time::Duration;
use embedded_hal::digital::v2;
use embedded_hal::Pwm;
use super::{Error, InputPin, IoPin, Level, OutputPin, Pin, Result};
const NANOS_PER_SEC: f64 = 1_000_000_000.0;
impl v2::InputPin for Pin {
type Error = Error;
fn is_high(&self) -> Result<bool> {
Ok(Pin::read(self) == Level::High)
}
fn is_low(&self) -> Result<bool> {
Ok(Pin::read(self) == Level::Low)
}
}
impl v2::InputPin for InputPin {
type Error = Error;
fn is_high(&self) -> Result<bool> {
Ok(InputPin::is_high(self))
}
fn is_low(&self) -> Result<bool> {
Ok(InputPin::is_low(self))
}
}
impl v2::InputPin for IoPin {
type Error = Error;
fn is_high(&self) -> Result<bool> {
Ok(IoPin::is_high(self))
}
fn is_low(&self) -> Result<bool> {
Ok(IoPin::is_low(self))
}
}
impl v2::InputPin for OutputPin {
type Error = Error;
fn is_high(&self) -> Result<bool> {
Ok(OutputPin::is_set_high(self))
}
fn is_low(&self) -> Result<bool> {
Ok(OutputPin::is_set_low(self))
}
}
impl v2::StatefulOutputPin for IoPin {
fn is_set_high(&self) -> Result<bool> {
Ok(IoPin::is_high(self))
}
fn is_set_low(&self) -> Result<bool> {
Ok(IoPin::is_low(self))
}
}
impl v2::StatefulOutputPin for OutputPin {
fn is_set_high(&self) -> Result<bool> {
Ok(OutputPin::is_set_high(self))
}
fn is_set_low(&self) -> Result<bool> {
Ok(OutputPin::is_set_low(self))
}
}
impl v2::ToggleableOutputPin for IoPin {
type Error = Error;
fn toggle(&mut self) -> Result<()> {
IoPin::toggle(self);
Ok(())
}
}
impl v2::ToggleableOutputPin for OutputPin {
type Error = Error;
fn toggle(&mut self) -> Result<()> {
OutputPin::toggle(self);
Ok(())
}
}
impl Pwm for OutputPin {
type Duty = f64;
type Channel = ();
type Time = Duration;
fn disable(&mut self, _channel: Self::Channel) {
let _ = self.clear_pwm();
}
fn enable(&mut self, _channel: Self::Channel) {
let _ = self.set_pwm_frequency(self.frequency, self.duty_cycle);
}
fn get_period(&self) -> Self::Time {
Duration::from_nanos(if self.frequency == 0.0 {
0
} else {
((1.0 / self.frequency) * NANOS_PER_SEC) as u64
})
}
fn get_duty(&self, _channel: Self::Channel) -> Self::Duty {
self.duty_cycle
}
fn get_max_duty(&self) -> Self::Duty {
1.0
}
fn set_duty(&mut self, _channel: Self::Channel, duty: Self::Duty) {
self.duty_cycle = duty.max(0.0).min(1.0);
if self.soft_pwm.is_some() {
let _ = self.set_pwm_frequency(self.frequency, self.duty_cycle);
}
}
fn set_period<P>(&mut self, period: P)
where
P: Into<Self::Time>,
{
let period = period.into();
self.frequency =
1.0 / (period.as_secs() as f64 + (f64::from(period.subsec_nanos()) / NANOS_PER_SEC));
if self.soft_pwm.is_some() {
let _ = self.set_pwm_frequency(self.frequency, self.duty_cycle);
}
}
}
impl Pwm for IoPin {
type Duty = f64;
type Channel = ();
type Time = Duration;
fn disable(&mut self, _channel: Self::Channel) {
let _ = self.clear_pwm();
}
fn enable(&mut self, _channel: Self::Channel) {
let _ = self.set_pwm_frequency(self.frequency, self.duty_cycle);
}
fn get_period(&self) -> Self::Time {
Duration::from_nanos(if self.frequency == 0.0 {
0
} else {
((1.0 / self.frequency) * NANOS_PER_SEC) as u64
})
}
fn get_duty(&self, _channel: Self::Channel) -> Self::Duty {
self.duty_cycle
}
fn get_max_duty(&self) -> Self::Duty {
1.0
}
fn set_duty(&mut self, _channel: Self::Channel, duty: Self::Duty) {
self.duty_cycle = duty.max(0.0).min(1.0);
if self.soft_pwm.is_some() {
let _ = self.set_pwm_frequency(self.frequency, self.duty_cycle);
}
}
fn set_period<P>(&mut self, period: P)
where
P: Into<Self::Time>,
{
let period = period.into();
self.frequency =
1.0 / (period.as_secs() as f64 + (f64::from(period.subsec_nanos()) / NANOS_PER_SEC));
if self.soft_pwm.is_some() {
let _ = self.set_pwm_frequency(self.frequency, self.duty_cycle);
}
}
}