//! Simple PWM driver. use core::marker::PhantomData; use core::mem::ManuallyDrop; use super::low_level::{CountingMode, OutputCompareMode, OutputPolarity, Timer}; use super::ringbuffered::RingBufferedPwmChannel; use super::{Ch1, Ch2, Ch3, Ch4, Channel, GeneralInstance4Channel, TimerChannel, TimerPin}; use crate::Peri; use crate::dma::word::Word; #[cfg(gpio_v2)] use crate::gpio::Pull; use crate::gpio::{AfType, AnyPin, OutputType, Speed}; use crate::pac::timer::vals::Ccds; use crate::time::Hertz; /// PWM pin wrapper. /// /// This wraps a pin to make it usable with PWM. pub struct PwmPin<'d, T, C, #[cfg(afio)] A> { #[allow(unused)] pub(crate) pin: Peri<'d, AnyPin>, phantom: PhantomData, } /// PWM pin config /// /// This configures the pwm pin settings #[derive(Debug, Copy, Clone)] #[cfg_attr(feature = "defmt", derive(defmt::Format))] pub struct PwmPinConfig { /// PWM Pin output type pub output_type: OutputType, /// PWM Pin speed pub speed: Speed, /// PWM Pin pull type #[cfg(gpio_v2)] pub pull: Pull, } impl<'d, T: GeneralInstance4Channel, C: TimerChannel, #[cfg(afio)] A> if_afio!(PwmPin<'d, T, C, A>) { /// Create a new PWM pin instance. pub fn new(pin: Peri<'d, if_afio!(impl TimerPin)>, output_type: OutputType) -> Self { critical_section::with(|_| { pin.set_low(); set_as_af!(pin, AfType::output(output_type, Speed::VeryHigh)); }); PwmPin { pin: pin.into(), phantom: PhantomData, } } /// Create a new PWM pin instance with a specific configuration. pub fn new_with_config(pin: Peri<'d, if_afio!(impl TimerPin)>, pin_config: PwmPinConfig) -> Self { critical_section::with(|_| { pin.set_low(); #[cfg(gpio_v1)] set_as_af!(pin, AfType::output(pin_config.output_type, pin_config.speed)); #[cfg(gpio_v2)] set_as_af!( pin, AfType::output_pull(pin_config.output_type, pin_config.speed, pin_config.pull) ); }); PwmPin { pin: pin.into(), phantom: PhantomData, } } } /// A single channel of a pwm, obtained from [`SimplePwm::split`], /// [`SimplePwm::channel`], [`SimplePwm::ch1`], etc. /// /// It is not possible to change the pwm frequency because /// the frequency configuration is shared with all four channels. pub struct SimplePwmChannel<'d, T: GeneralInstance4Channel> { timer: ManuallyDrop>, channel: Channel, } // TODO: check for RMW races impl<'d, T: GeneralInstance4Channel> SimplePwmChannel<'d, T> { /// Enable the given channel. pub fn enable(&mut self) { self.timer.enable_channel(self.channel, true); } /// Disable the given channel. pub fn disable(&mut self) { self.timer.enable_channel(self.channel, false); } /// Check whether given channel is enabled pub fn is_enabled(&self) -> bool { self.timer.get_channel_enable_state(self.channel) } /// Get the frequency of the PWM channel. pub fn get_frequency(&self) -> Hertz { self.timer.get_frequency() } /// Get max duty value. /// /// This value depends on the configured frequency and the timer's clock rate from RCC. pub fn max_duty_cycle(&self) -> u32 { self.timer.get_max_compare_value().into() + 1 } /// Set the duty for a given channel. /// /// The value ranges from 0 for 0% duty, to [`max_duty_cycle`](Self::max_duty_cycle) for 100% duty, both included. pub fn set_duty_cycle(&mut self, duty: u32) { assert!(duty <= (*self).max_duty_cycle()); self.timer.set_compare_value(self.channel, unwrap!(duty.try_into())) } /// Set the duty cycle to 0%, or always inactive. pub fn set_duty_cycle_fully_off(&mut self) { self.set_duty_cycle(0); } /// Set the duty cycle to 100%, or always active. pub fn set_duty_cycle_fully_on(&mut self) { self.set_duty_cycle((*self).max_duty_cycle()); } /// Set the duty cycle to `num / denom`. /// /// The caller is responsible for ensuring that `num` is less than or equal to `denom`, /// and that `denom` is not zero. pub fn set_duty_cycle_fraction(&mut self, num: u32, denom: u32) { assert!(denom != 0); assert!(num <= denom); let duty = u32::from(num) * u32::from(self.max_duty_cycle()) / u32::from(denom); // This is safe because we know that `num <= denom`, so `duty <= self.max_duty_cycle()` (u16) #[allow(clippy::cast_possible_truncation)] self.set_duty_cycle(unwrap!(duty.try_into())); } /// Set the duty cycle to `percent / 100` /// /// The caller is responsible for ensuring that `percent` is less than or equal to 100. pub fn set_duty_cycle_percent(&mut self, percent: u8) { self.set_duty_cycle_fraction(percent as u32, 100) } /// Get the duty for a given channel. /// /// The value ranges from 0 for 0% duty, to [`max_duty_cycle`](Self::max_duty_cycle) for 100% duty, both included. pub fn current_duty_cycle(&self) -> u16 { unwrap!(self.timer.get_compare_value(self.channel).try_into()) } /// Set the output polarity for a given channel. pub fn set_polarity(&mut self, polarity: OutputPolarity) { self.timer.set_output_polarity(self.channel, polarity); } /// Set the output compare mode for a given channel. pub fn set_output_compare_mode(&mut self, mode: OutputCompareMode) { self.timer.set_output_compare_mode(self.channel, mode); } /// Convert this PWM channel into a ring-buffered PWM channel. /// /// This allows continuous PWM waveform generation using a DMA ring buffer. /// The ring buffer enables dynamic updates to the PWM duty cycle without blocking. /// /// # Arguments /// * `tx_dma` - The DMA channel to use for transferring duty cycle values /// * `dma_buf` - The buffer to use as a ring buffer (must be non-empty and <= 65535 elements) /// /// # Panics /// Panics if `dma_buf` is empty or longer than 65535 elements. pub fn into_ring_buffered_channel>( mut self, tx_dma: Peri<'d, impl super::UpDma>, dma_buf: &'d mut [W], ) -> RingBufferedPwmChannel<'d, T, W> { assert!(!dma_buf.is_empty() && dma_buf.len() <= 0xFFFF); self.timer.clamp_compare_value::(self.channel); self.timer.enable_update_dma(true); RingBufferedPwmChannel::new( unsafe { self.timer.clone_unchecked() }, self.channel, self.timer.setup_ring_buffer(tx_dma, self.channel, dma_buf), ) } } /// A group of four [`SimplePwmChannel`]s, obtained from [`SimplePwm::split`]. pub struct SimplePwmChannels<'d, T: GeneralInstance4Channel> { /// Channel 1 pub ch1: SimplePwmChannel<'d, T>, /// Channel 2 pub ch2: SimplePwmChannel<'d, T>, /// Channel 3 pub ch3: SimplePwmChannel<'d, T>, /// Channel 4 pub ch4: SimplePwmChannel<'d, T>, } /// Simple PWM driver. pub struct SimplePwm<'d, T: GeneralInstance4Channel> { inner: Timer<'d, T>, } impl<'d, T: GeneralInstance4Channel> SimplePwm<'d, T> { /// Create a new simple PWM driver. #[allow(unused)] pub fn new<#[cfg(afio)] A>( tim: Peri<'d, T>, ch1: Option)>, ch2: Option)>, ch3: Option)>, ch4: Option)>, freq: Hertz, counting_mode: CountingMode, ) -> Self { Self::new_inner(tim, freq, counting_mode) } fn new_inner(tim: Peri<'d, T>, freq: Hertz, counting_mode: CountingMode) -> Self { let mut this = Self { inner: Timer::new(tim) }; this.inner.set_counting_mode(counting_mode); this.set_frequency(freq); this.inner.enable_outputs(); // Required for advanced timers, see GeneralInstance4Channel for details [Channel::Ch1, Channel::Ch2, Channel::Ch3, Channel::Ch4] .iter() .for_each(|&channel| { this.inner.set_output_compare_mode(channel, OutputCompareMode::PwmMode1); this.inner.set_output_compare_preload(channel, true); }); this.inner.set_autoreload_preload(true); // Generate update event so pre-load registers are written to the shadow registers this.inner.generate_update_event(); this.inner.start(); this } /// Get a single channel /// /// If you need to use multiple channels, use [`Self::split`]. pub fn channel(&mut self, channel: Channel) -> SimplePwmChannel<'_, T> { SimplePwmChannel { timer: unsafe { self.inner.clone_unchecked() }, channel, } } /// Channel 1 /// /// This is just a convenience wrapper around [`Self::channel`]. /// /// If you need to use multiple channels, use [`Self::split`]. pub fn ch1(&mut self) -> SimplePwmChannel<'_, T> { self.channel(Channel::Ch1) } /// Channel 2 /// /// This is just a convenience wrapper around [`Self::channel`]. /// /// If you need to use multiple channels, use [`Self::split`]. pub fn ch2(&mut self) -> SimplePwmChannel<'_, T> { self.channel(Channel::Ch2) } /// Channel 3 /// /// This is just a convenience wrapper around [`Self::channel`]. /// /// If you need to use multiple channels, use [`Self::split`]. pub fn ch3(&mut self) -> SimplePwmChannel<'_, T> { self.channel(Channel::Ch3) } /// Channel 4 /// /// This is just a convenience wrapper around [`Self::channel`]. /// /// If you need to use multiple channels, use [`Self::split`]. pub fn ch4(&mut self) -> SimplePwmChannel<'_, T> { self.channel(Channel::Ch4) } /// Splits a [`SimplePwm`] into four pwm channels. /// /// This returns all four channels, including channels that /// aren't configured with a [`PwmPin`]. // TODO: I hate the name "split" pub fn split(self) -> SimplePwmChannels<'static, T> where // must be static because the timer will never be dropped/disabled 'd: 'static, { // without this, the timer would be disabled at the end of this function let timer = ManuallyDrop::new(self.inner); let ch = |channel| SimplePwmChannel { timer: unsafe { timer.clone_unchecked() }, channel, }; SimplePwmChannels { ch1: ch(Channel::Ch1), ch2: ch(Channel::Ch2), ch3: ch(Channel::Ch3), ch4: ch(Channel::Ch4), } } /// Set PWM frequency. /// /// Note: that the frequency will not be applied in the timer until an update event /// occurs. pub fn set_frequency(&mut self, freq: Hertz) { // TODO: prevent ARR = u16::MAX? let multiplier = if self.inner.get_counting_mode().is_center_aligned() { 2u8 } else { 1u8 }; self.inner.set_frequency_internal(freq * multiplier, 16); } /// Get the PWM driver frequency. pub fn get_frequency(&self) -> Hertz { self.inner.get_frequency() } /// Get max duty value. /// /// This value depends on the configured frequency and the timer's clock rate from RCC. pub fn max_duty_cycle(&self) -> u32 { self.inner.get_max_compare_value().into() + 1 } /// Generate a sequence of PWM waveform /// /// Note: /// The DMA channel provided does not need to correspond to the requested channel. pub async fn waveform>( &mut self, dma: Peri<'_, impl super::Dma>, channel: Channel, duty: &[W], ) { self.inner.enable_channel(channel, true); self.inner.enable_channel(C::CHANNEL, true); self.inner.clamp_compare_value::(channel); self.inner.set_cc_dma_selection(Ccds::ON_UPDATE); self.inner.set_cc_dma_enable_state(C::CHANNEL, true); self.inner.setup_channel_update_dma(dma, channel, duty).await; self.inner.set_cc_dma_enable_state(C::CHANNEL, false); } /// Generate a sequence of PWM waveform /// /// Note: /// You will need to provide corresponding `TIMx_UP` DMA channel to use this method. /// Also be aware that embassy timers use one of timers internally. It is possible to /// switch this timer by using `time-driver-timX` feature. pub async fn waveform_up>( &mut self, dma: Peri<'_, impl super::UpDma>, channel: Channel, duty: &[W], ) { self.inner.enable_channel(channel, true); self.inner.clamp_compare_value::(channel); self.inner.enable_update_dma(true); self.inner.setup_update_dma(dma, channel, duty).await; self.inner.enable_update_dma(false); } /// Generate a multichannel sequence of PWM waveforms using DMA triggered by timer update events. /// /// This method utilizes the timer's DMA burst transfer capability to update multiple CCRx registers /// in sequence on each update event (UEV). The data is written via the DMAR register using the /// DMA base address (DBA) and burst length (DBL) configured in the DCR register. /// /// The `duty` buffer must be structured as a flattened 2D array in row-major order, where each row /// represents a single update event and each column corresponds to a specific timer channel (starting /// from `starting_channel` up to and including `ending_channel`). /// /// For example, if using channels 1 through 4, a buffer of 4 update steps might look like: /// /// ```rust,ignore /// let dma_buf: [u16; 16] = [ /// ch1_duty_1, ch2_duty_1, ch3_duty_1, ch4_duty_1, // update 1 /// ch1_duty_2, ch2_duty_2, ch3_duty_2, ch4_duty_2, // update 2 /// ch1_duty_3, ch2_duty_3, ch3_duty_3, ch4_duty_3, // update 3 /// ch1_duty_4, ch2_duty_4, ch3_duty_4, ch4_duty_4, // update 4 /// ]; /// ``` /// /// Each group of `N` values (where `N` is number of channels) is transferred on one update event, /// updating the duty cycles of all selected channels simultaneously. /// /// Note: /// You will need to provide corresponding `TIMx_UP` DMA channel to use this method. /// Also be aware that embassy timers use one of timers internally. It is possible to /// switch this timer by using `time-driver-timX` feature. /// pub async fn waveform_up_multi_channel>( &mut self, dma: Peri<'_, impl super::UpDma>, starting_channel: Channel, ending_channel: Channel, duty: &[W], ) { [Channel::Ch1, Channel::Ch2, Channel::Ch3, Channel::Ch4] .iter() .filter(|ch| ch.index() >= starting_channel.index()) .filter(|ch| ch.index() <= ending_channel.index()) .for_each(|ch| { self.inner.enable_channel(*ch, true); self.inner.clamp_compare_value::(*ch); }); self.inner.enable_update_dma(true); self.inner .setup_update_dma_burst(dma, starting_channel, ending_channel, duty) .await; self.inner.enable_update_dma(false); } } impl<'d, T: GeneralInstance4Channel> embedded_hal_1::pwm::ErrorType for SimplePwmChannel<'d, T> { type Error = core::convert::Infallible; } impl<'d, T: GeneralInstance4Channel> embedded_hal_1::pwm::SetDutyCycle for SimplePwmChannel<'d, T> { fn max_duty_cycle(&self) -> u16 { unwrap!(self.max_duty_cycle().try_into()) } fn set_duty_cycle(&mut self, duty: u16) -> Result<(), Self::Error> { self.set_duty_cycle(duty.into()); Ok(()) } fn set_duty_cycle_fully_off(&mut self) -> Result<(), Self::Error> { self.set_duty_cycle_fully_off(); Ok(()) } fn set_duty_cycle_fully_on(&mut self) -> Result<(), Self::Error> { self.set_duty_cycle_fully_on(); Ok(()) } fn set_duty_cycle_fraction(&mut self, num: u16, denom: u16) -> Result<(), Self::Error> { self.set_duty_cycle_fraction(num.into(), denom.into()); Ok(()) } fn set_duty_cycle_percent(&mut self, percent: u8) -> Result<(), Self::Error> { self.set_duty_cycle_percent(percent); Ok(()) } } impl<'d, T: GeneralInstance4Channel> embedded_hal_02::Pwm for SimplePwm<'d, T> { type Channel = Channel; type Time = Hertz; type Duty = u32; fn disable(&mut self, channel: Self::Channel) { self.inner.enable_channel(channel, false); } fn enable(&mut self, channel: Self::Channel) { self.inner.enable_channel(channel, true); } fn get_period(&self) -> Self::Time { self.inner.get_frequency() } fn get_duty(&self, channel: Self::Channel) -> Self::Duty { self.inner.get_compare_value(channel).into() } fn get_max_duty(&self) -> Self::Duty { self.inner.get_max_compare_value().into() + 1 } fn set_duty(&mut self, channel: Self::Channel, duty: Self::Duty) { assert!(duty <= self.max_duty_cycle() as u32); self.inner.set_compare_value(channel, unwrap!(duty.try_into())) } fn set_period

(&mut self, period: P) where P: Into, { self.inner.set_frequency(period.into()); } }