LailaTheElf/embassy
1
0
Fork 0
Code Issues Pull Requests Actions Packages Projects Releases Wiki Activity

Merge pull request #3549 from aurelj/stm32_pwm_32bits_timer

Browse Source 
stm32/timer: avoid max_compare_value >= u16::MAX
This commit is contained in:
Dario Nieuwenhuis 2024-12-02 22:50:09 +00:00 committed by GitHub
commit db9ad1c30c
No known key found for this signature in database
GPG Key ID: B5690EEEBB952194
3 changed files with 18 additions and 10 deletions
Show Stats Download Patch File Download Diff File Expand all files Collapse all files

2
embassy-stm32/src/timer/complementary_pwm.rs
View File

@ -116,7 +116,7 @@ impl<'d, T: AdvancedInstance4Channel> ComplementaryPwm<'d, T> {
} else {
1u8
};
self.inner.set_frequency(freq * multiplier);
self.inner.set_frequency_internal(freq * multiplier, 16);
}
/// Get max duty value.

24
embassy-stm32/src/timer/low_level.rs
View File

@ -242,16 +242,28 @@ impl<'d, T: CoreInstance> Timer<'d, T> {
/// In center-aligned mode (which not all timers support), the wrap-around frequency is effectively halved
/// because it needs to count up and down.
pub fn set_frequency(&self, frequency: Hertz) {
match T::BITS {
TimerBits::Bits16 => {
self.set_frequency_internal(frequency, 16);
}
#[cfg(not(stm32l0))]
TimerBits::Bits32 => {
self.set_frequency_internal(frequency, 32);
}
}
}
pub(crate) fn set_frequency_internal(&self, frequency: Hertz, max_divide_by_bits: u8) {
let f = frequency.0;
assert!(f > 0);
let timer_f = T::frequency().0;
let pclk_ticks_per_timer_period = (timer_f / f) as u64;
let psc: u16 = unwrap!(((pclk_ticks_per_timer_period - 1) / (1 << max_divide_by_bits)).try_into());
let divide_by = pclk_ticks_per_timer_period / (u64::from(psc) + 1);
match T::BITS {
TimerBits::Bits16 => {
let pclk_ticks_per_timer_period = timer_f / f;
let psc: u16 = unwrap!(((pclk_ticks_per_timer_period - 1) / (1 << 16)).try_into());
let divide_by = pclk_ticks_per_timer_period / (u32::from(psc) + 1);
// the timer counts `0..=arr`, we want it to count `0..divide_by`
let arr = unwrap!(u16::try_from(divide_by - 1));
@ -265,10 +277,6 @@ impl<'d, T: CoreInstance> Timer<'d, T> {
}
#[cfg(not(stm32l0))]
TimerBits::Bits32 => {
let pclk_ticks_per_timer_period = (timer_f / f) as u64;
let psc: u16 = unwrap!(((pclk_ticks_per_timer_period - 1) / (1 << 32)).try_into());
let divide_by = pclk_ticks_per_timer_period / (u64::from(psc) + 1);
// the timer counts `0..=arr`, we want it to count `0..divide_by`
let arr: u32 = unwrap!(u32::try_from(divide_by - 1));

2
embassy-stm32/src/timer/simple_pwm.rs
View File

@ -278,7 +278,7 @@ impl<'d, T: GeneralInstance4Channel> SimplePwm<'d, T> {
} else {
1u8
};
self.inner.set_frequency(freq * multiplier);
self.inner.set_frequency_internal(freq * multiplier, 16);
}
/// Get max duty value.