Compare commits
	
		
			50 Commits
		
	
	
		
			net-wiznet
			...
			test-ci
		
	
	| Author | SHA1 | Date | |
|---|---|---|---|
|  | 0bae4629fd | ||
|  | b6fc682117 | ||
|  | 0beb84768e | ||
|  | b98a279367 | ||
|  | e8a3cfaed6 | ||
|  | 0cc3e18db6 | ||
|  | 6b19c0abd1 | ||
|  | f956d19e6e | ||
|  | ceb0d0bf08 | ||
|  | b3879ec223 | ||
|  | bda99e59ec | ||
|  | 25c2a9baaa | ||
|  | 1e362c750b | ||
|  | 1a51a84313 | ||
|  | 7f72dbdaf2 | ||
|  | e8c162ac03 | ||
|  | 1aaa19748a | ||
|  | 9e230b64a4 | ||
|  | 17b4cf8ce7 | ||
|  | df4aa0fe25 | ||
|  | 188ee59ba6 | ||
|  | 591612db7e | ||
|  | d673f8a865 | ||
|  | 82593bd404 | ||
|  | a39ae12edc | ||
|  | 0ef1cb29f7 | ||
|  | 64ab23d17d | ||
|  | 18c9bcd44a | ||
|  | e895ea2d8b | ||
|  | b9e13cb5d1 | ||
|  | 46ff2c82aa | ||
|  | a84ad741a4 | ||
|  | 412bcad2d1 | ||
|  | e70c531d3d | ||
|  | 7c5f963d1f | ||
|  | 62e1e1637c | ||
|  | 3d03c18d4f | ||
|  | 2157c5a4e3 | ||
|  | 0fb677aad7 | ||
|  | b1d0947a18 | ||
|  | 5b3f75dc72 | ||
|  | 6f2995cd4c | ||
|  | 88ada52146 | ||
|  | d622181205 | ||
|  | 0c97ce2fcc | ||
|  | 62d6bb6c8a | ||
|  | a9dc887060 | ||
|  | 137e47f98d | ||
|  | 05a9b11316 | ||
|  | 561126b0d6 | 
							
								
								
									
										1
									
								
								.github/ci/build.sh
									
									
									
									
										vendored
									
									
								
							
							
						
						
									
										1
									
								
								.github/ci/build.sh
									
									
									
									
										vendored
									
									
								
							| @@ -12,6 +12,7 @@ if [ -f /ci/secrets/teleprobe-token.txt ]; then | ||||
|     export TELEPROBE_HOST=https://teleprobe.embassy.dev | ||||
|     export TELEPROBE_TOKEN=$(cat /ci/secrets/teleprobe-token.txt) | ||||
|     export TELEPROBE_CACHE=/ci/cache/teleprobe_cache.json | ||||
|     rm -f $TELEPROBE_CACHE | ||||
| fi | ||||
|  | ||||
| # needed for "dumb HTTP" transport support | ||||
|   | ||||
							
								
								
									
										9
									
								
								ci.sh
									
									
									
									
									
								
							
							
						
						
									
										9
									
								
								ci.sh
									
									
									
									
									
								
							| @@ -192,9 +192,13 @@ cargo batch  \ | ||||
|     --- build --release --manifest-path tests/stm32/Cargo.toml --target thumbv6m-none-eabi --features stm32g071rb --out-dir out/tests/stm32g071rb \ | ||||
|     --- build --release --manifest-path tests/stm32/Cargo.toml --target thumbv6m-none-eabi --features stm32c031c6 --out-dir out/tests/stm32c031c6 \ | ||||
|     --- build --release --manifest-path tests/stm32/Cargo.toml --target thumbv7em-none-eabi --features stm32h755zi --out-dir out/tests/stm32h755zi \ | ||||
|     --- build --release --manifest-path tests/stm32/Cargo.toml --target thumbv7em-none-eabi --features stm32h753zi --out-dir out/tests/stm32h753zi \ | ||||
|     --- build --release --manifest-path tests/stm32/Cargo.toml --target thumbv7em-none-eabi --features stm32h7a3zi --out-dir out/tests/stm32h7a3zi \ | ||||
|     --- build --release --manifest-path tests/stm32/Cargo.toml --target thumbv7em-none-eabi --features stm32wb55rg --out-dir out/tests/stm32wb55rg \ | ||||
|     --- build --release --manifest-path tests/stm32/Cargo.toml --target thumbv7em-none-eabi --features stm32h563zi --out-dir out/tests/stm32h563zi \ | ||||
|     --- build --release --manifest-path tests/stm32/Cargo.toml --target thumbv7em-none-eabi --features stm32u585ai --out-dir out/tests/stm32u585ai \ | ||||
|     --- build --release --manifest-path tests/stm32/Cargo.toml --target thumbv7em-none-eabi --features stm32u5a5zj --out-dir out/tests/stm32u5a5zj \ | ||||
|     --- build --release --manifest-path tests/stm32/Cargo.toml --target thumbv7em-none-eabi --features stm32wba52cg --out-dir out/tests/stm32wba52cg \ | ||||
|     --- build --release --manifest-path tests/stm32/Cargo.toml --target thumbv6m-none-eabi --features stm32l073rz --out-dir out/tests/stm32l073rz \ | ||||
|     --- build --release --manifest-path tests/stm32/Cargo.toml --target thumbv7m-none-eabi --features stm32l152re --out-dir out/tests/stm32l152re \ | ||||
|     --- build --release --manifest-path tests/stm32/Cargo.toml --target thumbv7em-none-eabi --features stm32l4a6zg --out-dir out/tests/stm32l4a6zg \ | ||||
| @@ -213,8 +217,13 @@ cargo batch  \ | ||||
|  | ||||
| rm out/tests/stm32wb55rg/wpan_mac | ||||
| rm out/tests/stm32wb55rg/wpan_ble | ||||
|  | ||||
| # unstable, I think it's running out of RAM? | ||||
| rm out/tests/stm32f207zg/eth | ||||
|  | ||||
| # doesn't work, gives "noise error", no idea why. usart_dma does pass. | ||||
| rm out/tests/stm32u5a5zj/usart | ||||
|  | ||||
| if [[ -z "${TELEPROBE_TOKEN-}" ]]; then | ||||
|     echo No teleprobe token found, skipping running HIL tests | ||||
|     exit | ||||
|   | ||||
| @@ -3,7 +3,7 @@ use core::task::{RawWaker, RawWakerVTable, Waker}; | ||||
|  | ||||
| use super::{wake_task, TaskHeader, TaskRef}; | ||||
|  | ||||
| const VTABLE: RawWakerVTable = RawWakerVTable::new(clone, wake, wake, drop); | ||||
| static VTABLE: RawWakerVTable = RawWakerVTable::new(clone, wake, wake, drop); | ||||
|  | ||||
| unsafe fn clone(p: *const ()) -> RawWaker { | ||||
|     RawWaker::new(p, &VTABLE) | ||||
|   | ||||
| @@ -860,6 +860,9 @@ impl<D: Driver> Inner<D> { | ||||
|             let socket = s.sockets.get_mut::<dhcpv4::Socket>(dhcp_handle); | ||||
|  | ||||
|             if self.link_up { | ||||
|                 if old_link_up != self.link_up { | ||||
|                     socket.reset(); | ||||
|                 } | ||||
|                 match socket.poll() { | ||||
|                     None => {} | ||||
|                     Some(dhcpv4::Event::Deconfigured) => { | ||||
|   | ||||
| @@ -213,6 +213,7 @@ impl<'d> Adc<'d, Async> { | ||||
|         ch: &mut Channel<'_>, | ||||
|         buf: &mut [W], | ||||
|         fcs_err: bool, | ||||
|         div: u16, | ||||
|         dma: impl Peripheral<P = impl dma::Channel>, | ||||
|     ) -> Result<(), Error> { | ||||
|         let r = Self::regs(); | ||||
| @@ -258,6 +259,7 @@ impl<'d> Adc<'d, Async> { | ||||
|         // start conversions and wait for dma to finish. we can't report errors early | ||||
|         // because there's no interrupt to signal them, and inspecting every element | ||||
|         // of the fifo is too costly to do here. | ||||
|         r.div().write_set(|w| w.set_int(div)); | ||||
|         r.cs().write_set(|w| w.set_start_many(true)); | ||||
|         dma.await; | ||||
|         mem::drop(auto_reset); | ||||
| @@ -275,9 +277,10 @@ impl<'d> Adc<'d, Async> { | ||||
|         &mut self, | ||||
|         ch: &mut Channel<'_>, | ||||
|         buf: &mut [S], | ||||
|         div: u16, | ||||
|         dma: impl Peripheral<P = impl dma::Channel>, | ||||
|     ) -> Result<(), Error> { | ||||
|         self.read_many_inner(ch, buf, false, dma).await | ||||
|         self.read_many_inner(ch, buf, false, div, dma).await | ||||
|     } | ||||
|  | ||||
|     #[inline] | ||||
| @@ -285,11 +288,12 @@ impl<'d> Adc<'d, Async> { | ||||
|         &mut self, | ||||
|         ch: &mut Channel<'_>, | ||||
|         buf: &mut [Sample], | ||||
|         div: u16, | ||||
|         dma: impl Peripheral<P = impl dma::Channel>, | ||||
|     ) { | ||||
|         // errors are reported in individual samples | ||||
|         let _ = self | ||||
|             .read_many_inner(ch, unsafe { mem::transmute::<_, &mut [u16]>(buf) }, true, dma) | ||||
|             .read_many_inner(ch, unsafe { mem::transmute::<_, &mut [u16]>(buf) }, true, div, dma) | ||||
|             .await; | ||||
|     } | ||||
| } | ||||
|   | ||||
| @@ -58,7 +58,7 @@ rand_core = "0.6.3" | ||||
| sdio-host = "0.5.0" | ||||
| embedded-sdmmc = { git = "https://github.com/embassy-rs/embedded-sdmmc-rs", rev = "a4f293d3a6f72158385f79c98634cb8a14d0d2fc", optional = true } | ||||
| critical-section = "1.1" | ||||
| stm32-metapac = { git = "https://github.com/embassy-rs/stm32-data-generated", tag = "stm32-data-5b04234fbe61ea875f1a904cd5f68795daaeb526" } | ||||
| stm32-metapac = { git = "https://github.com/embassy-rs/stm32-data-generated", tag = "stm32-data-bcc9b6bf9fa195e91625849efc4ba473d9ace4e9" } | ||||
| vcell = "0.1.3" | ||||
| bxcan = "0.7.0" | ||||
| nb = "1.0.0" | ||||
| @@ -76,7 +76,7 @@ critical-section = { version = "1.1", features = ["std"] } | ||||
| [build-dependencies] | ||||
| proc-macro2 = "1.0.36" | ||||
| quote = "1.0.15" | ||||
| stm32-metapac = { git = "https://github.com/embassy-rs/stm32-data-generated", tag = "stm32-data-5b04234fbe61ea875f1a904cd5f68795daaeb526", default-features = false, features = ["metadata"]} | ||||
| stm32-metapac = { git = "https://github.com/embassy-rs/stm32-data-generated", tag = "stm32-data-bcc9b6bf9fa195e91625849efc4ba473d9ace4e9", default-features = false, features = ["metadata"]} | ||||
|  | ||||
|  | ||||
| [features] | ||||
|   | ||||
| @@ -1,4 +1,4 @@ | ||||
| use std::collections::{HashMap, HashSet}; | ||||
| use std::collections::{BTreeMap, BTreeSet, HashMap, HashSet}; | ||||
| use std::fmt::Write as _; | ||||
| use std::path::PathBuf; | ||||
| use std::{env, fs}; | ||||
| @@ -352,7 +352,7 @@ fn main() { | ||||
|     // ======== | ||||
|     // Generate DMA IRQs. | ||||
|  | ||||
|     let mut dma_irqs: HashMap<&str, Vec<(&str, &str, &str)>> = HashMap::new(); | ||||
|     let mut dma_irqs: BTreeMap<&str, Vec<(&str, &str, &str)>> = BTreeMap::new(); | ||||
|  | ||||
|     for p in METADATA.peripherals { | ||||
|         if let Some(r) = &p.registers { | ||||
| @@ -371,22 +371,27 @@ fn main() { | ||||
|         } | ||||
|     } | ||||
|  | ||||
|     for (irq, channels) in dma_irqs { | ||||
|         let irq = format_ident!("{}", irq); | ||||
|     let dma_irqs: TokenStream = dma_irqs | ||||
|         .iter() | ||||
|         .map(|(irq, channels)| { | ||||
|             let irq = format_ident!("{}", irq); | ||||
|  | ||||
|         let xdma = format_ident!("{}", channels[0].0); | ||||
|         let channels = channels.iter().map(|(_, dma, ch)| format_ident!("{}_{}", dma, ch)); | ||||
|             let xdma = format_ident!("{}", channels[0].0); | ||||
|             let channels = channels.iter().map(|(_, dma, ch)| format_ident!("{}_{}", dma, ch)); | ||||
|  | ||||
|         g.extend(quote! { | ||||
|             #[cfg(feature = "rt")] | ||||
|             #[crate::interrupt] | ||||
|             unsafe fn #irq () { | ||||
|                 #( | ||||
|                     <crate::peripherals::#channels as crate::dma::#xdma::sealed::Channel>::on_irq(); | ||||
|                 )* | ||||
|             quote! { | ||||
|                 #[cfg(feature = "rt")] | ||||
|                 #[crate::interrupt] | ||||
|                 unsafe fn #irq () { | ||||
|                     #( | ||||
|                         <crate::peripherals::#channels as crate::dma::#xdma::sealed::Channel>::on_irq(); | ||||
|                     )* | ||||
|                 } | ||||
|             } | ||||
|         }); | ||||
|     } | ||||
|         }) | ||||
|         .collect(); | ||||
|  | ||||
|     g.extend(dma_irqs); | ||||
|  | ||||
|     // ======== | ||||
|     // Extract the rcc registers | ||||
| @@ -433,7 +438,7 @@ fn main() { | ||||
|     // Generate RccPeripheral impls | ||||
|  | ||||
|     let refcounted_peripherals = HashSet::from(["usart", "adc"]); | ||||
|     let mut refcount_statics = HashSet::new(); | ||||
|     let mut refcount_statics = BTreeSet::new(); | ||||
|  | ||||
|     for p in METADATA.peripherals { | ||||
|         if !singletons.contains(&p.name.to_string()) { | ||||
| @@ -559,7 +564,7 @@ fn main() { | ||||
|                     fn enable_and_reset_with_cs(_cs: critical_section::CriticalSection) { | ||||
|                         #before_enable | ||||
|                         #[cfg(feature = "low-power")] | ||||
|                         crate::rcc::clock_refcount_add(_cs); | ||||
|                         unsafe { crate::rcc::REFCOUNT_STOP2 += 1 }; | ||||
|                         crate::pac::RCC.#en_reg().modify(|w| w.#set_en_field(true)); | ||||
|                         #after_enable | ||||
|                         #rst | ||||
| @@ -568,7 +573,7 @@ fn main() { | ||||
|                         #before_disable | ||||
|                         crate::pac::RCC.#en_reg().modify(|w| w.#set_en_field(false)); | ||||
|                         #[cfg(feature = "low-power")] | ||||
|                         crate::rcc::clock_refcount_sub(_cs); | ||||
|                         unsafe { crate::rcc::REFCOUNT_STOP2 -= 1 }; | ||||
|                     } | ||||
|                 } | ||||
|  | ||||
|   | ||||
| @@ -465,7 +465,7 @@ pub(crate) fn assert_not_corrupted_read(end_address: u32) { | ||||
|         feature = "stm32f439vg", | ||||
|         feature = "stm32f439zg", | ||||
|     ))] | ||||
|     if second_bank_read && unsafe { pac::DBGMCU.idcode().read().rev_id() < REVISION_3 && !pa12_is_output_pull_low() } { | ||||
|     if second_bank_read && pac::DBGMCU.idcode().read().rev_id() < REVISION_3 && !pa12_is_output_pull_low() { | ||||
|         panic!("Read corruption for stm32f42xxG and stm32f43xxG in dual bank mode when PA12 is in use for chips below revision 3, see errata 2.2.11"); | ||||
|     } | ||||
| } | ||||
|   | ||||
| @@ -763,6 +763,13 @@ pub(crate) unsafe fn init(_cs: CriticalSection) { | ||||
|     <crate::peripherals::AFIO as crate::rcc::sealed::RccPeripheral>::enable_and_reset_with_cs(_cs); | ||||
|  | ||||
|     crate::_generated::init_gpio(); | ||||
|  | ||||
|     // Setting this bit is mandatory to use PG[15:2]. | ||||
|     #[cfg(stm32u5)] | ||||
|     crate::pac::PWR.svmcr().modify(|w| { | ||||
|         w.set_io2sv(true); | ||||
|         w.set_io2vmen(true); | ||||
|     }); | ||||
| } | ||||
|  | ||||
| mod eh02 { | ||||
|   | ||||
| @@ -5,6 +5,7 @@ use core::task::Poll; | ||||
| use self::sealed::Instance; | ||||
| use crate::interrupt; | ||||
| use crate::interrupt::typelevel::Interrupt; | ||||
| use crate::pac::rcc::vals::{Lptim1sel, Lptim2sel}; | ||||
| use crate::peripherals::IPCC; | ||||
| use crate::rcc::sealed::RccPeripheral; | ||||
|  | ||||
| @@ -273,7 +274,7 @@ fn _configure_pwr() { | ||||
|  | ||||
|     // set LPTIM1 & LPTIM2 clock source | ||||
|     rcc.ccipr().modify(|w| { | ||||
|         w.set_lptim1sel(0b00); // PCLK | ||||
|         w.set_lptim2sel(0b00); // PCLK | ||||
|         w.set_lptim1sel(Lptim1sel::PCLK1); | ||||
|         w.set_lptim2sel(Lptim2sel::PCLK1); | ||||
|     }); | ||||
| } | ||||
|   | ||||
| @@ -226,9 +226,9 @@ pub fn init(config: Config) -> Peripherals { | ||||
|             time_driver::init(cs); | ||||
|  | ||||
|             #[cfg(feature = "low-power")] | ||||
|             while !crate::rcc::low_power_ready() { | ||||
|                 crate::rcc::clock_refcount_sub(cs); | ||||
|             } | ||||
|             { | ||||
|                 crate::rcc::REFCOUNT_STOP2 = 0 | ||||
|             }; | ||||
|         } | ||||
|  | ||||
|         p | ||||
|   | ||||
| @@ -6,7 +6,6 @@ use cortex_m::peripheral::SCB; | ||||
| use embassy_executor::*; | ||||
|  | ||||
| use crate::interrupt; | ||||
| use crate::rcc::low_power_ready; | ||||
| use crate::time_driver::{get_driver, RtcDriver}; | ||||
|  | ||||
| const THREAD_PENDER: usize = usize::MAX; | ||||
| @@ -33,6 +32,15 @@ pub fn stop_with_rtc(rtc: &'static Rtc) { | ||||
|     unsafe { EXECUTOR.as_mut().unwrap() }.stop_with_rtc(rtc) | ||||
| } | ||||
|  | ||||
| pub fn stop_ready(stop_mode: StopMode) -> bool { | ||||
|     unsafe { EXECUTOR.as_mut().unwrap() }.stop_ready(stop_mode) | ||||
| } | ||||
|  | ||||
| #[non_exhaustive] | ||||
| pub enum StopMode { | ||||
|     Stop2, | ||||
| } | ||||
|  | ||||
| /// Thread mode executor, using WFE/SEV. | ||||
| /// | ||||
| /// This is the simplest and most common kind of executor. It runs on | ||||
| @@ -80,12 +88,18 @@ impl Executor { | ||||
|         trace!("low power: stop with rtc configured"); | ||||
|     } | ||||
|  | ||||
|     fn stop_ready(&self, stop_mode: StopMode) -> bool { | ||||
|         match stop_mode { | ||||
|             StopMode::Stop2 => unsafe { crate::rcc::REFCOUNT_STOP2 == 0 }, | ||||
|         } | ||||
|     } | ||||
|  | ||||
|     fn configure_pwr(&mut self) { | ||||
|         self.scb.clear_sleepdeep(); | ||||
|  | ||||
|         compiler_fence(Ordering::SeqCst); | ||||
|  | ||||
|         if !low_power_ready() { | ||||
|         if !self.stop_ready(StopMode::Stop2) { | ||||
|             trace!("low power: not ready to stop"); | ||||
|         } else if self.time_driver.pause_time().is_err() { | ||||
|             trace!("low power: failed to pause time"); | ||||
|   | ||||
| @@ -101,18 +101,22 @@ pub trait InvertingPin<T: Instance>: sealed::InvertingPin<T> {} | ||||
| #[cfg(opamp_f3)] | ||||
| macro_rules! impl_opamp_output { | ||||
|     ($inst:ident, $adc:ident, $ch:expr) => { | ||||
|         impl<'d, 'p, P: NonInvertingPin<crate::peripherals::$inst>> crate::adc::sealed::AdcPin<crate::peripherals::$adc> | ||||
|             for OpAmpOutput<'d, 'p, crate::peripherals::$inst, P> | ||||
|         { | ||||
|             fn channel(&self) -> u8 { | ||||
|                 $ch | ||||
|             } | ||||
|         } | ||||
|         foreach_adc!( | ||||
|             ($adc, $common_inst:ident, $adc_clock:ident) => { | ||||
|                 impl<'d, 'p, P: NonInvertingPin<crate::peripherals::$inst>> crate::adc::sealed::AdcPin<crate::peripherals::$adc> | ||||
|                     for OpAmpOutput<'d, 'p, crate::peripherals::$inst, P> | ||||
|                 { | ||||
|                     fn channel(&self) -> u8 { | ||||
|                         $ch | ||||
|                     } | ||||
|                 } | ||||
|  | ||||
|         impl<'d, 'p, P: NonInvertingPin<crate::peripherals::$inst>> crate::adc::AdcPin<crate::peripherals::$adc> | ||||
|             for OpAmpOutput<'d, 'p, crate::peripherals::$inst, P> | ||||
|         { | ||||
|         } | ||||
|                 impl<'d, 'p, P: NonInvertingPin<crate::peripherals::$inst>> crate::adc::AdcPin<crate::peripherals::$adc> | ||||
|                     for OpAmpOutput<'d, 'p, crate::peripherals::$inst, P> | ||||
|                 { | ||||
|                 } | ||||
|             }; | ||||
|         ); | ||||
|     }; | ||||
| } | ||||
|  | ||||
|   | ||||
| @@ -169,14 +169,7 @@ pub(crate) unsafe fn init(config: Config) { | ||||
|         #[cfg(not(rcc_f100))] | ||||
|         w.set_usbpre(Usbpre::from_bits(usbpre as u8)); | ||||
|         w.set_sw(if pllmul_bits.is_some() { | ||||
|             #[cfg(not(rcc_f1cl))] | ||||
|             { | ||||
|                 Sw::PLL1_P | ||||
|             } | ||||
|             #[cfg(rcc_f1cl)] | ||||
|             { | ||||
|                 Sw::PLL | ||||
|             } | ||||
|             Sw::PLL1_P | ||||
|         } else if config.hse.is_some() { | ||||
|             Sw::HSE | ||||
|         } else { | ||||
|   | ||||
| @@ -152,9 +152,9 @@ pub(crate) unsafe fn init(config: Config) { | ||||
|         source: config.pll_src, | ||||
|     }; | ||||
|     let pll = init_pll(PllInstance::Pll, config.pll, &pll_input); | ||||
|     #[cfg(any(all(stm32f4, not(stm32f410)), stm32f7))] | ||||
|     #[cfg(any(all(stm32f4, not(any(stm32f410, stm32f429))), stm32f7))] | ||||
|     let _plli2s = init_pll(PllInstance::Plli2s, config.plli2s, &pll_input); | ||||
|     #[cfg(any(stm32f446, stm32f427, stm32f437, stm32f4x9, stm32f7))] | ||||
|     #[cfg(all(any(stm32f446, stm32f427, stm32f437, stm32f4x9, stm32f7), not(stm32f429)))] | ||||
|     let _pllsai = init_pll(PllInstance::Pllsai, config.pllsai, &pll_input); | ||||
|  | ||||
|     // Configure sysclk | ||||
| @@ -166,8 +166,8 @@ pub(crate) unsafe fn init(config: Config) { | ||||
|     }; | ||||
|  | ||||
|     let hclk = sys / config.ahb_pre; | ||||
|     let (pclk1, pclk1_tim) = calc_pclk(hclk, config.apb1_pre); | ||||
|     let (pclk2, pclk2_tim) = calc_pclk(hclk, config.apb2_pre); | ||||
|     let (pclk1, pclk1_tim) = super::util::calc_pclk(hclk, config.apb1_pre); | ||||
|     let (pclk2, pclk2_tim) = super::util::calc_pclk(hclk, config.apb2_pre); | ||||
|  | ||||
|     assert!(max::SYSCLK.contains(&sys)); | ||||
|     assert!(max::HCLK.contains(&hclk)); | ||||
| @@ -197,15 +197,25 @@ pub(crate) unsafe fn init(config: Config) { | ||||
|         pclk2_tim, | ||||
|         rtc, | ||||
|         pll1_q: pll.q, | ||||
|         #[cfg(all(rcc_f4, not(stm32f410)))] | ||||
|         #[cfg(all(rcc_f4, not(any(stm32f410, stm32f429))))] | ||||
|         plli2s1_q: _plli2s.q, | ||||
|         #[cfg(all(rcc_f4, not(stm32f410)))] | ||||
|         #[cfg(all(rcc_f4, not(any(stm32f410, stm32f429))))] | ||||
|         plli2s1_r: _plli2s.r, | ||||
|  | ||||
|         #[cfg(any(stm32f427, stm32f429, stm32f437, stm32f439, stm32f446, stm32f469, stm32f479))] | ||||
|         #[cfg(stm32f429)] | ||||
|         plli2s1_q: None, | ||||
|         #[cfg(stm32f429)] | ||||
|         plli2s1_r: None, | ||||
|  | ||||
|         #[cfg(any(stm32f427, stm32f437, stm32f439, stm32f446, stm32f469, stm32f479))] | ||||
|         pllsai1_q: _pllsai.q, | ||||
|         #[cfg(any(stm32f427, stm32f429, stm32f437, stm32f439, stm32f446, stm32f469, stm32f479))] | ||||
|         #[cfg(any(stm32f427, stm32f437, stm32f439, stm32f446, stm32f469, stm32f479))] | ||||
|         pllsai1_r: _pllsai.r, | ||||
|  | ||||
|         #[cfg(stm32f429)] | ||||
|         pllsai1_q: None, | ||||
|         #[cfg(stm32f429)] | ||||
|         pllsai1_r: None, | ||||
|     }); | ||||
| } | ||||
|  | ||||
| @@ -223,6 +233,7 @@ struct PllOutput { | ||||
|     r: Option<Hertz>, | ||||
| } | ||||
|  | ||||
| #[allow(dead_code)] | ||||
| #[derive(PartialEq, Eq, Clone, Copy)] | ||||
| enum PllInstance { | ||||
|     Pll, | ||||
| @@ -326,15 +337,6 @@ fn flash_setup(clk: Hertz) { | ||||
|     while FLASH.acr().read().latency() != latency {} | ||||
| } | ||||
|  | ||||
| fn calc_pclk<D>(hclk: Hertz, ppre: D) -> (Hertz, Hertz) | ||||
| where | ||||
|     Hertz: core::ops::Div<D, Output = Hertz>, | ||||
| { | ||||
|     let pclk = hclk / ppre; | ||||
|     let pclk_tim = if hclk == pclk { pclk } else { pclk * 2u32 }; | ||||
|     (pclk, pclk_tim) | ||||
| } | ||||
|  | ||||
| #[cfg(stm32f7)] | ||||
| mod max { | ||||
|     use core::ops::RangeInclusive; | ||||
|   | ||||
| @@ -1,7 +1,7 @@ | ||||
| use crate::pac::flash::vals::Latency; | ||||
| use crate::pac::rcc::vals::{self, Sw}; | ||||
| pub use crate::pac::rcc::vals::{ | ||||
|     Hpre as AHBPrescaler, Hsidiv as HSI16Prescaler, Pllm, Plln, Pllp, Pllq, Pllr, Ppre as APBPrescaler, | ||||
|     Hpre as AHBPrescaler, Hsidiv as HSIPrescaler, Pllm, Plln, Pllp, Pllq, Pllr, Ppre as APBPrescaler, | ||||
| }; | ||||
| use crate::pac::{FLASH, PWR, RCC}; | ||||
| use crate::rcc::{set_freqs, Clocks}; | ||||
| @@ -14,7 +14,7 @@ pub const HSI_FREQ: Hertz = Hertz(16_000_000); | ||||
| #[derive(Clone, Copy)] | ||||
| pub enum ClockSrc { | ||||
|     HSE(Hertz), | ||||
|     HSI16(HSI16Prescaler), | ||||
|     HSI(HSIPrescaler), | ||||
|     PLL(PllConfig), | ||||
|     LSI, | ||||
| } | ||||
| @@ -46,9 +46,9 @@ pub struct PllConfig { | ||||
| impl Default for PllConfig { | ||||
|     #[inline] | ||||
|     fn default() -> PllConfig { | ||||
|         // HSI16 / 1 * 8 / 2 = 64 MHz | ||||
|         // HSI / 1 * 8 / 2 = 64 MHz | ||||
|         PllConfig { | ||||
|             source: PllSrc::HSI16, | ||||
|             source: PllSrc::HSI, | ||||
|             m: Pllm::DIV1, | ||||
|             n: Plln::MUL8, | ||||
|             r: Pllr::DIV2, | ||||
| @@ -60,7 +60,7 @@ impl Default for PllConfig { | ||||
|  | ||||
| #[derive(Clone, Copy, Eq, PartialEq)] | ||||
| pub enum PllSrc { | ||||
|     HSI16, | ||||
|     HSI, | ||||
|     HSE(Hertz), | ||||
| } | ||||
|  | ||||
| @@ -77,7 +77,7 @@ impl Default for Config { | ||||
|     #[inline] | ||||
|     fn default() -> Config { | ||||
|         Config { | ||||
|             mux: ClockSrc::HSI16(HSI16Prescaler::DIV1), | ||||
|             mux: ClockSrc::HSI(HSIPrescaler::DIV1), | ||||
|             ahb_pre: AHBPrescaler::DIV1, | ||||
|             apb_pre: APBPrescaler::DIV1, | ||||
|             low_power_run: false, | ||||
| @@ -89,7 +89,7 @@ impl Default for Config { | ||||
| impl PllConfig { | ||||
|     pub(crate) fn init(self) -> Hertz { | ||||
|         let (src, input_freq) = match self.source { | ||||
|             PllSrc::HSI16 => (vals::Pllsrc::HSI, HSI_FREQ), | ||||
|             PllSrc::HSI => (vals::Pllsrc::HSI, HSI_FREQ), | ||||
|             PllSrc::HSE(freq) => (vals::Pllsrc::HSE, freq), | ||||
|         }; | ||||
|  | ||||
| @@ -121,7 +121,7 @@ impl PllConfig { | ||||
|         // > 3. Change the desired parameter. | ||||
|         // Enable whichever clock source we're using, and wait for it to become ready | ||||
|         match self.source { | ||||
|             PllSrc::HSI16 => { | ||||
|             PllSrc::HSI => { | ||||
|                 RCC.cr().write(|w| w.set_hsion(true)); | ||||
|                 while !RCC.cr().read().hsirdy() {} | ||||
|             } | ||||
| @@ -167,8 +167,8 @@ impl PllConfig { | ||||
|  | ||||
| pub(crate) unsafe fn init(config: Config) { | ||||
|     let (sys_clk, sw) = match config.mux { | ||||
|         ClockSrc::HSI16(div) => { | ||||
|             // Enable HSI16 | ||||
|         ClockSrc::HSI(div) => { | ||||
|             // Enable HSI | ||||
|             RCC.cr().write(|w| { | ||||
|                 w.set_hsidiv(div); | ||||
|                 w.set_hsion(true) | ||||
|   | ||||
| @@ -18,14 +18,14 @@ pub const HSI_FREQ: Hertz = Hertz(16_000_000); | ||||
| #[derive(Clone, Copy)] | ||||
| pub enum ClockSrc { | ||||
|     HSE(Hertz), | ||||
|     HSI16, | ||||
|     HSI, | ||||
|     PLL, | ||||
| } | ||||
|  | ||||
| /// PLL clock input source | ||||
| #[derive(Clone, Copy, Debug)] | ||||
| pub enum PllSrc { | ||||
|     HSI16, | ||||
|     HSI, | ||||
|     HSE(Hertz), | ||||
| } | ||||
|  | ||||
| @@ -33,7 +33,7 @@ impl Into<Pllsrc> for PllSrc { | ||||
|     fn into(self) -> Pllsrc { | ||||
|         match self { | ||||
|             PllSrc::HSE(..) => Pllsrc::HSE, | ||||
|             PllSrc::HSI16 => Pllsrc::HSI, | ||||
|             PllSrc::HSI => Pllsrc::HSI, | ||||
|         } | ||||
|     } | ||||
| } | ||||
| @@ -112,7 +112,7 @@ impl Default for Config { | ||||
|     #[inline] | ||||
|     fn default() -> Config { | ||||
|         Config { | ||||
|             mux: ClockSrc::HSI16, | ||||
|             mux: ClockSrc::HSI, | ||||
|             ahb_pre: AHBPrescaler::DIV1, | ||||
|             apb1_pre: APBPrescaler::DIV1, | ||||
|             apb2_pre: APBPrescaler::DIV1, | ||||
| @@ -135,7 +135,7 @@ pub struct PllFreq { | ||||
| pub(crate) unsafe fn init(config: Config) { | ||||
|     let pll_freq = config.pll.map(|pll_config| { | ||||
|         let src_freq = match pll_config.source { | ||||
|             PllSrc::HSI16 => { | ||||
|             PllSrc::HSI => { | ||||
|                 RCC.cr().write(|w| w.set_hsion(true)); | ||||
|                 while !RCC.cr().read().hsirdy() {} | ||||
|  | ||||
| @@ -196,8 +196,8 @@ pub(crate) unsafe fn init(config: Config) { | ||||
|     }); | ||||
|  | ||||
|     let (sys_clk, sw) = match config.mux { | ||||
|         ClockSrc::HSI16 => { | ||||
|             // Enable HSI16 | ||||
|         ClockSrc::HSI => { | ||||
|             // Enable HSI | ||||
|             RCC.cr().write(|w| w.set_hsion(true)); | ||||
|             while !RCC.cr().read().hsirdy() {} | ||||
|  | ||||
|   | ||||
| @@ -6,8 +6,11 @@ use crate::pac::pwr::vals::Vos; | ||||
| pub use crate::pac::rcc::vals::Adcdacsel as AdcClockSource; | ||||
| #[cfg(stm32h7)] | ||||
| pub use crate::pac::rcc::vals::Adcsel as AdcClockSource; | ||||
| use crate::pac::rcc::vals::{Ckpersel, Hsidiv, Pllrge, Pllsrc, Pllvcosel, Sw, Timpre}; | ||||
| pub use crate::pac::rcc::vals::{Ckpersel as PerClockSource, Plldiv as PllDiv, Pllm as PllPreDiv, Plln as PllMul}; | ||||
| pub use crate::pac::rcc::vals::{ | ||||
|     Ckpersel as PerClockSource, Hsidiv as HSIPrescaler, Plldiv as PllDiv, Pllm as PllPreDiv, Plln as PllMul, | ||||
|     Pllsrc as PllSource, Sw as Sysclk, | ||||
| }; | ||||
| use crate::pac::rcc::vals::{Ckpersel, Pllrge, Pllvcosel, Timpre}; | ||||
| use crate::pac::{FLASH, PWR, RCC}; | ||||
| use crate::rcc::{set_freqs, Clocks}; | ||||
| use crate::time::Hertz; | ||||
| @@ -58,41 +61,9 @@ pub struct Hse { | ||||
|     pub mode: HseMode, | ||||
| } | ||||
|  | ||||
| #[derive(Clone, Copy, Eq, PartialEq)] | ||||
| pub enum Hsi { | ||||
|     /// 64Mhz | ||||
|     Mhz64, | ||||
|     /// 32Mhz (divided by 2) | ||||
|     Mhz32, | ||||
|     /// 16Mhz (divided by 4) | ||||
|     Mhz16, | ||||
|     /// 8Mhz (divided by 8) | ||||
|     Mhz8, | ||||
| } | ||||
|  | ||||
| #[derive(Clone, Copy, Eq, PartialEq)] | ||||
| pub enum Sysclk { | ||||
|     /// HSI selected as sysclk | ||||
|     HSI, | ||||
|     /// HSE selected as sysclk | ||||
|     HSE, | ||||
|     /// CSI selected as sysclk | ||||
|     CSI, | ||||
|     /// PLL1_P selected as sysclk | ||||
|     Pll1P, | ||||
| } | ||||
|  | ||||
| #[derive(Clone, Copy, Eq, PartialEq)] | ||||
| pub enum PllSource { | ||||
|     Hsi, | ||||
|     Csi, | ||||
|     Hse, | ||||
| } | ||||
|  | ||||
| #[derive(Clone, Copy)] | ||||
| pub struct Pll { | ||||
|     /// Source clock selection. | ||||
|     #[cfg(stm32h5)] | ||||
|     pub source: PllSource, | ||||
|  | ||||
|     /// PLL pre-divider (DIVM). | ||||
| @@ -152,15 +123,12 @@ impl From<TimerPrescaler> for Timpre { | ||||
| /// Configuration of the core clocks | ||||
| #[non_exhaustive] | ||||
| pub struct Config { | ||||
|     pub hsi: Option<Hsi>, | ||||
|     pub hsi: Option<HSIPrescaler>, | ||||
|     pub hse: Option<Hse>, | ||||
|     pub csi: bool, | ||||
|     pub hsi48: bool, | ||||
|     pub sys: Sysclk, | ||||
|  | ||||
|     #[cfg(stm32h7)] | ||||
|     pub pll_src: PllSource, | ||||
|  | ||||
|     pub pll1: Option<Pll>, | ||||
|     pub pll2: Option<Pll>, | ||||
|     #[cfg(any(rcc_h5, stm32h7))] | ||||
| @@ -184,13 +152,11 @@ pub struct Config { | ||||
| impl Default for Config { | ||||
|     fn default() -> Self { | ||||
|         Self { | ||||
|             hsi: Some(Hsi::Mhz64), | ||||
|             hsi: Some(HSIPrescaler::DIV1), | ||||
|             hse: None, | ||||
|             csi: false, | ||||
|             hsi48: false, | ||||
|             sys: Sysclk::HSI, | ||||
|             #[cfg(stm32h7)] | ||||
|             pll_src: PllSource::Hsi, | ||||
|             pll1: None, | ||||
|             pll2: None, | ||||
|             #[cfg(any(rcc_h5, stm32h7))] | ||||
| @@ -303,19 +269,13 @@ pub(crate) unsafe fn init(config: Config) { | ||||
|             RCC.cr().modify(|w| w.set_hsion(false)); | ||||
|             None | ||||
|         } | ||||
|         Some(hsi) => { | ||||
|             let (freq, hsidiv) = match hsi { | ||||
|                 Hsi::Mhz64 => (HSI_FREQ / 1u32, Hsidiv::DIV1), | ||||
|                 Hsi::Mhz32 => (HSI_FREQ / 2u32, Hsidiv::DIV2), | ||||
|                 Hsi::Mhz16 => (HSI_FREQ / 4u32, Hsidiv::DIV4), | ||||
|                 Hsi::Mhz8 => (HSI_FREQ / 8u32, Hsidiv::DIV8), | ||||
|             }; | ||||
|         Some(hsidiv) => { | ||||
|             RCC.cr().modify(|w| { | ||||
|                 w.set_hsidiv(hsidiv); | ||||
|                 w.set_hsion(true); | ||||
|             }); | ||||
|             while !RCC.cr().read().hsirdy() {} | ||||
|             Some(freq) | ||||
|             Some(HSI_FREQ / hsidiv) | ||||
|         } | ||||
|     }; | ||||
|  | ||||
| @@ -360,25 +320,29 @@ pub(crate) unsafe fn init(config: Config) { | ||||
|         } | ||||
|     }; | ||||
|  | ||||
|     // H7 has shared PLLSRC, check it's equal in all PLLs. | ||||
|     #[cfg(stm32h7)] | ||||
|     { | ||||
|         let plls = [&config.pll1, &config.pll2, &config.pll3]; | ||||
|         if !super::util::all_equal(plls.into_iter().flatten().map(|p| p.source)) { | ||||
|             panic!("Source must be equal across all enabled PLLs.") | ||||
|         }; | ||||
|     } | ||||
|  | ||||
|     // Configure PLLs. | ||||
|     let pll_input = PllInput { | ||||
|         csi, | ||||
|         hse, | ||||
|         hsi, | ||||
|         #[cfg(stm32h7)] | ||||
|         source: config.pll_src, | ||||
|     }; | ||||
|     let pll_input = PllInput { csi, hse, hsi }; | ||||
|     let pll1 = init_pll(0, config.pll1, &pll_input); | ||||
|     let pll2 = init_pll(1, config.pll2, &pll_input); | ||||
|     #[cfg(any(rcc_h5, stm32h7))] | ||||
|     let pll3 = init_pll(2, config.pll3, &pll_input); | ||||
|  | ||||
|     // Configure sysclk | ||||
|     let (sys, sw) = match config.sys { | ||||
|         Sysclk::HSI => (unwrap!(hsi), Sw::HSI), | ||||
|         Sysclk::HSE => (unwrap!(hse), Sw::HSE), | ||||
|         Sysclk::CSI => (unwrap!(csi), Sw::CSI), | ||||
|         Sysclk::Pll1P => (unwrap!(pll1.p), Sw::PLL1_P), | ||||
|     let sys = match config.sys { | ||||
|         Sysclk::HSI => unwrap!(hsi), | ||||
|         Sysclk::HSE => unwrap!(hse), | ||||
|         Sysclk::CSI => unwrap!(csi), | ||||
|         Sysclk::PLL1_P => unwrap!(pll1.p), | ||||
|         _ => unreachable!(), | ||||
|     }; | ||||
|  | ||||
|     // Check limits. | ||||
| @@ -389,7 +353,14 @@ pub(crate) unsafe fn init(config: Config) { | ||||
|         VoltageScale::Scale2 => (Hertz(150_000_000), Hertz(150_000_000)), | ||||
|         VoltageScale::Scale3 => (Hertz(100_000_000), Hertz(100_000_000)), | ||||
|     }; | ||||
|     #[cfg(stm32h7)] | ||||
|     #[cfg(pwr_h7rm0455)] | ||||
|     let (d1cpre_clk_max, hclk_max, pclk_max) = match config.voltage_scale { | ||||
|         VoltageScale::Scale0 => (Hertz(280_000_000), Hertz(280_000_000), Hertz(140_000_000)), | ||||
|         VoltageScale::Scale1 => (Hertz(225_000_000), Hertz(225_000_000), Hertz(112_500_000)), | ||||
|         VoltageScale::Scale2 => (Hertz(160_000_000), Hertz(160_000_000), Hertz(80_000_000)), | ||||
|         VoltageScale::Scale3 => (Hertz(88_000_000), Hertz(88_000_000), Hertz(44_000_000)), | ||||
|     }; | ||||
|     #[cfg(all(stm32h7, not(pwr_h7rm0455)))] | ||||
|     let (d1cpre_clk_max, hclk_max, pclk_max) = match config.voltage_scale { | ||||
|         VoltageScale::Scale0 => (Hertz(480_000_000), Hertz(240_000_000), Hertz(120_000_000)), | ||||
|         VoltageScale::Scale1 => (Hertz(400_000_000), Hertz(200_000_000), Hertz(100_000_000)), | ||||
| @@ -495,8 +466,8 @@ pub(crate) unsafe fn init(config: Config) { | ||||
|  | ||||
|     RCC.cfgr().modify(|w| w.set_timpre(config.timer_prescaler.into())); | ||||
|  | ||||
|     RCC.cfgr().modify(|w| w.set_sw(sw)); | ||||
|     while RCC.cfgr().read().sws() != sw {} | ||||
|     RCC.cfgr().modify(|w| w.set_sw(config.sys)); | ||||
|     while RCC.cfgr().read().sws() != config.sys {} | ||||
|  | ||||
|     // IO compensation cell - Requires CSI clock and SYSCFG | ||||
|     #[cfg(stm32h7)] // TODO h5 | ||||
| @@ -581,8 +552,6 @@ struct PllInput { | ||||
|     hsi: Option<Hertz>, | ||||
|     hse: Option<Hertz>, | ||||
|     csi: Option<Hertz>, | ||||
|     #[cfg(stm32h7)] | ||||
|     source: PllSource, | ||||
| } | ||||
|  | ||||
| struct PllOutput { | ||||
| @@ -612,15 +581,11 @@ fn init_pll(num: usize, config: Option<Pll>, input: &PllInput) -> PllOutput { | ||||
|         }; | ||||
|     }; | ||||
|  | ||||
|     #[cfg(stm32h5)] | ||||
|     let source = config.source; | ||||
|     #[cfg(stm32h7)] | ||||
|     let source = input.source; | ||||
|  | ||||
|     let (in_clk, src) = match source { | ||||
|         PllSource::Hsi => (unwrap!(input.hsi), Pllsrc::HSI), | ||||
|         PllSource::Hse => (unwrap!(input.hse), Pllsrc::HSE), | ||||
|         PllSource::Csi => (unwrap!(input.csi), Pllsrc::CSI), | ||||
|     let in_clk = match config.source { | ||||
|         PllSource::DISABLE => panic!("must not set PllSource::Disable"), | ||||
|         PllSource::HSI => unwrap!(input.hsi), | ||||
|         PllSource::HSE => unwrap!(input.hse), | ||||
|         PllSource::CSI => unwrap!(input.csi), | ||||
|     }; | ||||
|  | ||||
|     let ref_clk = in_clk / config.prediv as u32; | ||||
| @@ -660,7 +625,7 @@ fn init_pll(num: usize, config: Option<Pll>, input: &PllInput) -> PllOutput { | ||||
|  | ||||
|     #[cfg(stm32h5)] | ||||
|     RCC.pllcfgr(num).write(|w| { | ||||
|         w.set_pllsrc(src); | ||||
|         w.set_pllsrc(config.source); | ||||
|         w.set_divm(config.prediv); | ||||
|         w.set_pllvcosel(vco_range); | ||||
|         w.set_pllrge(ref_range); | ||||
| @@ -674,7 +639,7 @@ fn init_pll(num: usize, config: Option<Pll>, input: &PllInput) -> PllOutput { | ||||
|     { | ||||
|         RCC.pllckselr().modify(|w| { | ||||
|             w.set_divm(num, config.prediv); | ||||
|             w.set_pllsrc(src); | ||||
|             w.set_pllsrc(config.source); | ||||
|         }); | ||||
|         RCC.pllcfgr().modify(|w| { | ||||
|             w.set_pllvcosel(num, vco_range); | ||||
|   | ||||
| @@ -18,20 +18,20 @@ pub enum ClockSrc { | ||||
|     MSI(MSIRange), | ||||
|     PLL(PLLSource, PLLMul, PLLDiv), | ||||
|     HSE(Hertz), | ||||
|     HSI16, | ||||
|     HSI, | ||||
| } | ||||
|  | ||||
| /// PLL clock input source | ||||
| #[derive(Clone, Copy)] | ||||
| pub enum PLLSource { | ||||
|     HSI16, | ||||
|     HSI, | ||||
|     HSE(Hertz), | ||||
| } | ||||
|  | ||||
| impl From<PLLSource> for Pllsrc { | ||||
|     fn from(val: PLLSource) -> Pllsrc { | ||||
|         match val { | ||||
|             PLLSource::HSI16 => Pllsrc::HSI, | ||||
|             PLLSource::HSI => Pllsrc::HSI, | ||||
|             PLLSource::HSE(_) => Pllsrc::HSE, | ||||
|         } | ||||
|     } | ||||
| @@ -83,10 +83,10 @@ pub(crate) unsafe fn init(config: Config) { | ||||
|             let freq = 32_768 * (1 << (range as u8 + 1)); | ||||
|             (Hertz(freq), Sw::MSI) | ||||
|         } | ||||
|         ClockSrc::HSI16 => { | ||||
|             // Enable HSI16 | ||||
|             RCC.cr().write(|w| w.set_hsi16on(true)); | ||||
|             while !RCC.cr().read().hsi16rdy() {} | ||||
|         ClockSrc::HSI => { | ||||
|             // Enable HSI | ||||
|             RCC.cr().write(|w| w.set_hsion(true)); | ||||
|             while !RCC.cr().read().hsirdy() {} | ||||
|  | ||||
|             (HSI_FREQ, Sw::HSI) | ||||
|         } | ||||
| @@ -105,10 +105,10 @@ pub(crate) unsafe fn init(config: Config) { | ||||
|                     while !RCC.cr().read().hserdy() {} | ||||
|                     freq | ||||
|                 } | ||||
|                 PLLSource::HSI16 => { | ||||
|                 PLLSource::HSI => { | ||||
|                     // Enable HSI | ||||
|                     RCC.cr().write(|w| w.set_hsi16on(true)); | ||||
|                     while !RCC.cr().read().hsi16rdy() {} | ||||
|                     RCC.cr().write(|w| w.set_hsion(true)); | ||||
|                     while !RCC.cr().read().hsirdy() {} | ||||
|                     HSI_FREQ | ||||
|                 } | ||||
|             }; | ||||
| @@ -156,23 +156,9 @@ pub(crate) unsafe fn init(config: Config) { | ||||
|         w.set_ppre2(config.apb2_pre); | ||||
|     }); | ||||
|  | ||||
|     let ahb_freq = sys_clk / config.ahb_pre; | ||||
|  | ||||
|     let (apb1_freq, apb1_tim_freq) = match config.apb1_pre { | ||||
|         APBPrescaler::DIV1 => (ahb_freq, ahb_freq), | ||||
|         pre => { | ||||
|             let freq = ahb_freq / pre; | ||||
|             (freq, freq * 2u32) | ||||
|         } | ||||
|     }; | ||||
|  | ||||
|     let (apb2_freq, apb2_tim_freq) = match config.apb2_pre { | ||||
|         APBPrescaler::DIV1 => (ahb_freq, ahb_freq), | ||||
|         pre => { | ||||
|             let freq = ahb_freq / pre; | ||||
|             (freq, freq * 2u32) | ||||
|         } | ||||
|     }; | ||||
|     let hclk1 = sys_clk / config.ahb_pre; | ||||
|     let (pclk1, pclk1_tim) = super::util::calc_pclk(hclk1, config.apb1_pre); | ||||
|     let (pclk2, pclk2_tim) = super::util::calc_pclk(hclk1, config.apb2_pre); | ||||
|  | ||||
|     #[cfg(crs)] | ||||
|     if config.enable_hsi48 { | ||||
| @@ -209,11 +195,11 @@ pub(crate) unsafe fn init(config: Config) { | ||||
|  | ||||
|     set_freqs(Clocks { | ||||
|         sys: sys_clk, | ||||
|         hclk1: ahb_freq, | ||||
|         pclk1: apb1_freq, | ||||
|         pclk2: apb2_freq, | ||||
|         pclk1_tim: apb1_tim_freq, | ||||
|         pclk2_tim: apb2_tim_freq, | ||||
|         hclk1, | ||||
|         pclk1, | ||||
|         pclk2, | ||||
|         pclk1_tim, | ||||
|         pclk2_tim, | ||||
|         rtc, | ||||
|     }); | ||||
| } | ||||
|   | ||||
| @@ -1,8 +1,11 @@ | ||||
| use crate::pac::rcc::regs::Cfgr; | ||||
| use crate::pac::rcc::vals::Msirgsel; | ||||
| #[cfg(any(stm32l4, stm32l5, stm32wb))] | ||||
| pub use crate::pac::rcc::vals::Clk48sel as Clk48Src; | ||||
| #[cfg(any(stm32wb, stm32wl))] | ||||
| pub use crate::pac::rcc::vals::Hsepre as HsePrescaler; | ||||
| pub use crate::pac::rcc::vals::{ | ||||
|     Clk48sel as Clk48Src, Hpre as AHBPrescaler, Msirange as MSIRange, Pllm as PllPreDiv, Plln as PllMul, | ||||
|     Pllp as PllPDiv, Pllq as PllQDiv, Pllr as PllRDiv, Pllsrc as PLLSource, Ppre as APBPrescaler, Sw as ClockSrc, | ||||
|     Hpre as AHBPrescaler, Msirange as MSIRange, Pllm as PllPreDiv, Plln as PllMul, Pllp as PllPDiv, Pllq as PllQDiv, | ||||
|     Pllr as PllRDiv, Pllsrc as PLLSource, Ppre as APBPrescaler, Sw as ClockSrc, | ||||
| }; | ||||
| use crate::pac::{FLASH, RCC}; | ||||
| use crate::rcc::{set_freqs, Clocks}; | ||||
| @@ -11,6 +14,25 @@ use crate::time::Hertz; | ||||
| /// HSI speed | ||||
| pub const HSI_FREQ: Hertz = Hertz(16_000_000); | ||||
|  | ||||
| #[derive(Clone, Copy, Eq, PartialEq)] | ||||
| pub enum HseMode { | ||||
|     /// crystal/ceramic oscillator (HSEBYP=0) | ||||
|     Oscillator, | ||||
|     /// external analog clock (low swing) (HSEBYP=1) | ||||
|     Bypass, | ||||
| } | ||||
|  | ||||
| #[derive(Clone, Copy, Eq, PartialEq)] | ||||
| pub struct Hse { | ||||
|     /// HSE frequency. | ||||
|     pub freq: Hertz, | ||||
|     /// HSE mode. | ||||
|     pub mode: HseMode, | ||||
|     /// HSE prescaler | ||||
|     #[cfg(any(stm32wb, stm32wl))] | ||||
|     pub prescaler: HsePrescaler, | ||||
| } | ||||
|  | ||||
| #[derive(Clone, Copy)] | ||||
| pub struct Pll { | ||||
|     /// PLL source | ||||
| @@ -34,13 +56,14 @@ pub struct Pll { | ||||
| pub struct Config { | ||||
|     // base clock sources | ||||
|     pub msi: Option<MSIRange>, | ||||
|     pub hsi16: bool, | ||||
|     pub hse: Option<Hertz>, | ||||
|     #[cfg(not(any(stm32l47x, stm32l48x)))] | ||||
|     pub hsi: bool, | ||||
|     pub hse: Option<Hse>, | ||||
|     #[cfg(any(all(stm32l4, not(any(stm32l47x, stm32l48x))), stm32l5, stm32wb))] | ||||
|     pub hsi48: bool, | ||||
|  | ||||
|     // pll | ||||
|     pub pll: Option<Pll>, | ||||
|     #[cfg(any(stm32l4, stm32l5, stm32wb))] | ||||
|     pub pllsai1: Option<Pll>, | ||||
|     #[cfg(any(stm32l47x, stm32l48x, stm32l49x, stm32l4ax, rcc_l4plus, stm32l5))] | ||||
|     pub pllsai2: Option<Pll>, | ||||
| @@ -50,8 +73,13 @@ pub struct Config { | ||||
|     pub ahb_pre: AHBPrescaler, | ||||
|     pub apb1_pre: APBPrescaler, | ||||
|     pub apb2_pre: APBPrescaler, | ||||
|     #[cfg(any(stm32wl5x, stm32wb))] | ||||
|     pub core2_ahb_pre: AHBPrescaler, | ||||
|     #[cfg(any(stm32wl, stm32wb))] | ||||
|     pub shared_ahb_pre: AHBPrescaler, | ||||
|  | ||||
|     // muxes | ||||
|     #[cfg(any(stm32l4, stm32l5, stm32wb))] | ||||
|     pub clk48_src: Clk48Src, | ||||
|  | ||||
|     // low speed LSI/LSE/RTC | ||||
| @@ -63,30 +91,69 @@ impl Default for Config { | ||||
|     fn default() -> Config { | ||||
|         Config { | ||||
|             hse: None, | ||||
|             hsi16: false, | ||||
|             hsi: false, | ||||
|             msi: Some(MSIRange::RANGE4M), | ||||
|             mux: ClockSrc::MSI, | ||||
|             ahb_pre: AHBPrescaler::DIV1, | ||||
|             apb1_pre: APBPrescaler::DIV1, | ||||
|             apb2_pre: APBPrescaler::DIV1, | ||||
|             #[cfg(any(stm32wl5x, stm32wb))] | ||||
|             core2_ahb_pre: AHBPrescaler::DIV1, | ||||
|             #[cfg(any(stm32wl, stm32wb))] | ||||
|             shared_ahb_pre: AHBPrescaler::DIV1, | ||||
|             pll: None, | ||||
|             #[cfg(any(stm32l4, stm32l5, stm32wb))] | ||||
|             pllsai1: None, | ||||
|             #[cfg(any(stm32l47x, stm32l48x, stm32l49x, stm32l4ax, rcc_l4plus, stm32l5))] | ||||
|             pllsai2: None, | ||||
|             #[cfg(not(any(stm32l471, stm32l475, stm32l476, stm32l486)))] | ||||
|             #[cfg(any(all(stm32l4, not(any(stm32l47x, stm32l48x))), stm32l5, stm32wb))] | ||||
|             hsi48: true, | ||||
|             #[cfg(any(stm32l4, stm32l5, stm32wb))] | ||||
|             clk48_src: Clk48Src::HSI48, | ||||
|             ls: Default::default(), | ||||
|         } | ||||
|     } | ||||
| } | ||||
|  | ||||
| #[cfg(stm32wb)] | ||||
| pub const WPAN_DEFAULT: Config = Config { | ||||
|     hse: Some(Hse { | ||||
|         freq: Hertz(32_000_000), | ||||
|         mode: HseMode::Oscillator, | ||||
|         prescaler: HsePrescaler::DIV1, | ||||
|     }), | ||||
|     mux: ClockSrc::PLL1_R, | ||||
|     hsi48: true, | ||||
|     msi: None, | ||||
|     hsi: false, | ||||
|     clk48_src: Clk48Src::PLL1_Q, | ||||
|  | ||||
|     ls: super::LsConfig::default_lse(), | ||||
|  | ||||
|     pll: Some(Pll { | ||||
|         source: PLLSource::HSE, | ||||
|         prediv: PllPreDiv::DIV2, | ||||
|         mul: PllMul::MUL12, | ||||
|         divp: Some(PllPDiv::DIV3), // 32 / 2 * 12 / 3 = 64Mhz | ||||
|         divq: Some(PllQDiv::DIV4), // 32 / 2 * 12 / 4 = 48Mhz | ||||
|         divr: Some(PllRDiv::DIV3), // 32 / 2 * 12 / 3 = 64Mhz | ||||
|     }), | ||||
|     pllsai1: None, | ||||
|  | ||||
|     ahb_pre: AHBPrescaler::DIV1, | ||||
|     core2_ahb_pre: AHBPrescaler::DIV2, | ||||
|     shared_ahb_pre: AHBPrescaler::DIV1, | ||||
|     apb1_pre: APBPrescaler::DIV1, | ||||
|     apb2_pre: APBPrescaler::DIV1, | ||||
| }; | ||||
|  | ||||
| pub(crate) unsafe fn init(config: Config) { | ||||
|     // Switch to MSI to prevent problems with PLL configuration. | ||||
|     if !RCC.cr().read().msion() { | ||||
|         // Turn on MSI and configure it to 4MHz. | ||||
|         RCC.cr().modify(|w| { | ||||
|             w.set_msirgsel(Msirgsel::CR); | ||||
|             #[cfg(not(stm32wb))] | ||||
|             w.set_msirgsel(crate::pac::rcc::vals::Msirgsel::CR); | ||||
|             w.set_msirange(MSIRange::RANGE4M); | ||||
|             w.set_msipllen(false); | ||||
|             w.set_msion(true) | ||||
| @@ -111,9 +178,10 @@ pub(crate) unsafe fn init(config: Config) { | ||||
|  | ||||
|     let msi = config.msi.map(|range| { | ||||
|         // Enable MSI | ||||
|         RCC.cr().write(|w| { | ||||
|         RCC.cr().modify(|w| { | ||||
|             #[cfg(not(stm32wb))] | ||||
|             w.set_msirgsel(crate::pac::rcc::vals::Msirgsel::CR); | ||||
|             w.set_msirange(range); | ||||
|             w.set_msirgsel(Msirgsel::CR); | ||||
|             w.set_msion(true); | ||||
|  | ||||
|             // If LSE is enabled, enable calibration of MSI | ||||
| @@ -127,21 +195,27 @@ pub(crate) unsafe fn init(config: Config) { | ||||
|         msirange_to_hertz(range) | ||||
|     }); | ||||
|  | ||||
|     let hsi16 = config.hsi16.then(|| { | ||||
|         RCC.cr().write(|w| w.set_hsion(true)); | ||||
|     let hsi = config.hsi.then(|| { | ||||
|         RCC.cr().modify(|w| w.set_hsion(true)); | ||||
|         while !RCC.cr().read().hsirdy() {} | ||||
|  | ||||
|         HSI_FREQ | ||||
|     }); | ||||
|  | ||||
|     let hse = config.hse.map(|freq| { | ||||
|         RCC.cr().write(|w| w.set_hseon(true)); | ||||
|     let hse = config.hse.map(|hse| { | ||||
|         RCC.cr().modify(|w| { | ||||
|             #[cfg(stm32wl)] | ||||
|             w.set_hsebyppwr(hse.mode == HseMode::Bypass); | ||||
|             #[cfg(not(stm32wl))] | ||||
|             w.set_hsebyp(hse.mode == HseMode::Bypass); | ||||
|             w.set_hseon(true); | ||||
|         }); | ||||
|         while !RCC.cr().read().hserdy() {} | ||||
|  | ||||
|         freq | ||||
|         hse.freq | ||||
|     }); | ||||
|  | ||||
|     #[cfg(not(any(stm32l47x, stm32l48x)))] | ||||
|     #[cfg(any(all(stm32l4, not(any(stm32l47x, stm32l48x))), stm32l5, stm32wb))] | ||||
|     let hsi48 = config.hsi48.then(|| { | ||||
|         RCC.crrcr().modify(|w| w.set_hsi48on(true)); | ||||
|         while !RCC.crrcr().read().hsi48rdy() {} | ||||
| @@ -153,6 +227,7 @@ pub(crate) unsafe fn init(config: Config) { | ||||
|  | ||||
|     let _plls = [ | ||||
|         &config.pll, | ||||
|         #[cfg(any(stm32l4, stm32l5, stm32wb))] | ||||
|         &config.pllsai1, | ||||
|         #[cfg(any(stm32l47x, stm32l48x, stm32l49x, stm32l4ax, rcc_l4plus, stm32l5))] | ||||
|         &config.pllsai2, | ||||
| @@ -160,7 +235,7 @@ pub(crate) unsafe fn init(config: Config) { | ||||
|  | ||||
|     // L4 has shared PLLSRC, PLLM, check it's equal in all PLLs. | ||||
|     #[cfg(all(stm32l4, not(rcc_l4plus)))] | ||||
|     match get_equal(_plls.into_iter().flatten().map(|p| (p.source, p.prediv))) { | ||||
|     match super::util::get_equal(_plls.into_iter().flatten().map(|p| (p.source, p.prediv))) { | ||||
|         Err(()) => panic!("Source must be equal across all enabled PLLs."), | ||||
|         Ok(None) => {} | ||||
|         Ok(Some((source, prediv))) => RCC.pllcfgr().write(|w| { | ||||
| @@ -169,9 +244,9 @@ pub(crate) unsafe fn init(config: Config) { | ||||
|         }), | ||||
|     }; | ||||
|  | ||||
|     // L4+ has shared PLLSRC, check it's equal in all PLLs. | ||||
|     #[cfg(any(rcc_l4plus))] | ||||
|     match get_equal(_plls.into_iter().flatten().map(|p| p.source)) { | ||||
|     // L4+, WL has shared PLLSRC, check it's equal in all PLLs. | ||||
|     #[cfg(any(rcc_l4plus, stm32wl))] | ||||
|     match super::util::get_equal(_plls.into_iter().flatten().map(|p| p.source)) { | ||||
|         Err(()) => panic!("Source must be equal across all enabled PLLs."), | ||||
|         Ok(None) => {} | ||||
|         Ok(Some(source)) => RCC.pllcfgr().write(|w| { | ||||
| @@ -179,31 +254,30 @@ pub(crate) unsafe fn init(config: Config) { | ||||
|         }), | ||||
|     }; | ||||
|  | ||||
|     let pll_input = PllInput { hse, hsi16, msi }; | ||||
|     let pll_input = PllInput { hse, hsi, msi }; | ||||
|     let pll = init_pll(PllInstance::Pll, config.pll, &pll_input); | ||||
|     #[cfg(any(stm32l4, stm32l5, stm32wb))] | ||||
|     let pllsai1 = init_pll(PllInstance::Pllsai1, config.pllsai1, &pll_input); | ||||
|     #[cfg(any(stm32l47x, stm32l48x, stm32l49x, stm32l4ax, rcc_l4plus, stm32l5))] | ||||
|     let _pllsai2 = init_pll(PllInstance::Pllsai2, config.pllsai2, &pll_input); | ||||
|  | ||||
|     let sys_clk = match config.mux { | ||||
|         ClockSrc::HSE => hse.unwrap(), | ||||
|         ClockSrc::HSI => hsi16.unwrap(), | ||||
|         ClockSrc::HSI => hsi.unwrap(), | ||||
|         ClockSrc::MSI => msi.unwrap(), | ||||
|         #[cfg(rcc_l4)] | ||||
|         ClockSrc::PLL1_P => pll._r.unwrap(), | ||||
|         #[cfg(not(rcc_l4))] | ||||
|         ClockSrc::PLL1_R => pll._r.unwrap(), | ||||
|         ClockSrc::PLL1_R => pll.r.unwrap(), | ||||
|     }; | ||||
|  | ||||
|     #[cfg(stm32l4)] | ||||
|     RCC.ccipr().modify(|w| w.set_clk48sel(config.clk48_src)); | ||||
|     #[cfg(stm32l5)] | ||||
|     RCC.ccipr1().modify(|w| w.set_clk48sel(config.clk48_src)); | ||||
|     #[cfg(any(stm32l4, stm32l5, stm32wb))] | ||||
|     let _clk48 = match config.clk48_src { | ||||
|         Clk48Src::HSI48 => hsi48, | ||||
|         Clk48Src::MSI => msi, | ||||
|         Clk48Src::PLLSAI1_Q => pllsai1._q, | ||||
|         Clk48Src::PLL1_Q => pll._q, | ||||
|         Clk48Src::PLLSAI1_Q => pllsai1.q, | ||||
|         Clk48Src::PLL1_Q => pll.q, | ||||
|     }; | ||||
|  | ||||
|     #[cfg(rcc_l4plus)] | ||||
| @@ -211,29 +285,56 @@ pub(crate) unsafe fn init(config: Config) { | ||||
|     #[cfg(all(stm32l4, not(rcc_l4plus)))] | ||||
|     assert!(sys_clk.0 <= 80_000_000); | ||||
|  | ||||
|     let hclk1 = sys_clk / config.ahb_pre; | ||||
|     let (pclk1, pclk1_tim) = super::util::calc_pclk(hclk1, config.apb1_pre); | ||||
|     let (pclk2, pclk2_tim) = super::util::calc_pclk(hclk1, config.apb2_pre); | ||||
|     #[cfg(not(any(stm32wl5x, stm32wb)))] | ||||
|     let hclk2 = hclk1; | ||||
|     #[cfg(any(stm32wl5x, stm32wb))] | ||||
|     let hclk2 = sys_clk / config.core2_ahb_pre; | ||||
|     #[cfg(not(any(stm32wl, stm32wb)))] | ||||
|     let hclk3 = hclk1; | ||||
|     #[cfg(any(stm32wl, stm32wb))] | ||||
|     let hclk3 = sys_clk / config.shared_ahb_pre; | ||||
|  | ||||
|     // Set flash wait states | ||||
|     #[cfg(stm32l4)] | ||||
|     FLASH.acr().modify(|w| { | ||||
|         w.set_latency(match sys_clk.0 { | ||||
|             0..=16_000_000 => 0, | ||||
|             0..=32_000_000 => 1, | ||||
|             0..=48_000_000 => 2, | ||||
|             0..=64_000_000 => 3, | ||||
|             _ => 4, | ||||
|         }) | ||||
|     }); | ||||
|     // VCORE Range 0 (performance), others TODO | ||||
|     let latency = match hclk1.0 { | ||||
|         0..=16_000_000 => 0, | ||||
|         0..=32_000_000 => 1, | ||||
|         0..=48_000_000 => 2, | ||||
|         0..=64_000_000 => 3, | ||||
|         _ => 4, | ||||
|     }; | ||||
|     #[cfg(stm32l5)] | ||||
|     FLASH.acr().modify(|w| { | ||||
|         w.set_latency(match sys_clk.0 { | ||||
|             0..=20_000_000 => 0, | ||||
|             0..=40_000_000 => 1, | ||||
|             0..=60_000_000 => 2, | ||||
|             0..=80_000_000 => 3, | ||||
|             0..=100_000_000 => 4, | ||||
|             _ => 5, | ||||
|         }) | ||||
|     }); | ||||
|     let latency = match hclk1.0 { | ||||
|         // VCORE Range 0 (performance), others TODO | ||||
|         0..=20_000_000 => 0, | ||||
|         0..=40_000_000 => 1, | ||||
|         0..=60_000_000 => 2, | ||||
|         0..=80_000_000 => 3, | ||||
|         0..=100_000_000 => 4, | ||||
|         _ => 5, | ||||
|     }; | ||||
|     #[cfg(stm32wl)] | ||||
|     let latency = match hclk3.0 { | ||||
|         // VOS RANGE1, others TODO. | ||||
|         ..=18_000_000 => 0, | ||||
|         ..=36_000_000 => 1, | ||||
|         _ => 2, | ||||
|     }; | ||||
|     #[cfg(stm32wb)] | ||||
|     let latency = match hclk3.0 { | ||||
|         // VOS RANGE1, others TODO. | ||||
|         ..=18_000_000 => 0, | ||||
|         ..=36_000_000 => 1, | ||||
|         ..=54_000_000 => 2, | ||||
|         ..=64_000_000 => 3, | ||||
|         _ => 4, | ||||
|     }; | ||||
|  | ||||
|     FLASH.acr().modify(|w| w.set_latency(latency)); | ||||
|     while FLASH.acr().read().latency() != latency {} | ||||
|  | ||||
|     RCC.cfgr().modify(|w| { | ||||
|         w.set_sw(config.mux); | ||||
| @@ -243,33 +344,29 @@ pub(crate) unsafe fn init(config: Config) { | ||||
|     }); | ||||
|     while RCC.cfgr().read().sws() != config.mux {} | ||||
|  | ||||
|     let ahb_freq = sys_clk / config.ahb_pre; | ||||
|  | ||||
|     let (apb1_freq, apb1_tim_freq) = match config.apb1_pre { | ||||
|         APBPrescaler::DIV1 => (ahb_freq, ahb_freq), | ||||
|         pre => { | ||||
|             let freq = ahb_freq / pre; | ||||
|             (freq, freq * 2u32) | ||||
|         } | ||||
|     }; | ||||
|  | ||||
|     let (apb2_freq, apb2_tim_freq) = match config.apb2_pre { | ||||
|         APBPrescaler::DIV1 => (ahb_freq, ahb_freq), | ||||
|         pre => { | ||||
|             let freq = ahb_freq / pre; | ||||
|             (freq, freq * 2u32) | ||||
|         } | ||||
|     }; | ||||
|     #[cfg(any(stm32wl, stm32wb))] | ||||
|     { | ||||
|         RCC.extcfgr().modify(|w| { | ||||
|             w.set_shdhpre(config.shared_ahb_pre); | ||||
|             #[cfg(any(stm32wl5x, stm32wb))] | ||||
|             w.set_c2hpre(config.core2_ahb_pre); | ||||
|         }); | ||||
|         while !RCC.extcfgr().read().shdhpref() {} | ||||
|         #[cfg(any(stm32wl5x, stm32wb))] | ||||
|         while !RCC.extcfgr().read().c2hpref() {} | ||||
|     } | ||||
|  | ||||
|     set_freqs(Clocks { | ||||
|         sys: sys_clk, | ||||
|         hclk1: ahb_freq, | ||||
|         hclk2: ahb_freq, | ||||
|         hclk3: ahb_freq, | ||||
|         pclk1: apb1_freq, | ||||
|         pclk2: apb2_freq, | ||||
|         pclk1_tim: apb1_tim_freq, | ||||
|         pclk2_tim: apb2_tim_freq, | ||||
|         hclk1, | ||||
|         hclk2, | ||||
|         hclk3, | ||||
|         pclk1, | ||||
|         pclk2, | ||||
|         pclk1_tim, | ||||
|         pclk2_tim, | ||||
|         #[cfg(stm32wl)] | ||||
|         pclk3: hclk3, | ||||
|         #[cfg(rcc_l4)] | ||||
|         hsi: None, | ||||
|         #[cfg(rcc_l4)] | ||||
| @@ -308,60 +405,58 @@ fn msirange_to_hertz(range: MSIRange) -> Hertz { | ||||
|     } | ||||
| } | ||||
|  | ||||
| #[allow(unused)] | ||||
| fn get_equal<T: Eq>(mut iter: impl Iterator<Item = T>) -> Result<Option<T>, ()> { | ||||
|     let Some(x) = iter.next() else { return Ok(None) }; | ||||
|     if !iter.all(|y| y == x) { | ||||
|         return Err(()); | ||||
|     } | ||||
|     return Ok(Some(x)); | ||||
| } | ||||
|  | ||||
| struct PllInput { | ||||
|     hsi16: Option<Hertz>, | ||||
|     hsi: Option<Hertz>, | ||||
|     hse: Option<Hertz>, | ||||
|     msi: Option<Hertz>, | ||||
| } | ||||
|  | ||||
| #[allow(unused)] | ||||
| #[derive(Default)] | ||||
| struct PllOutput { | ||||
|     _p: Option<Hertz>, | ||||
|     _q: Option<Hertz>, | ||||
|     _r: Option<Hertz>, | ||||
|     p: Option<Hertz>, | ||||
|     q: Option<Hertz>, | ||||
|     r: Option<Hertz>, | ||||
| } | ||||
|  | ||||
| #[derive(PartialEq, Eq, Clone, Copy)] | ||||
| enum PllInstance { | ||||
|     Pll, | ||||
|     #[cfg(any(stm32l4, stm32l5, stm32wb))] | ||||
|     Pllsai1, | ||||
|     #[cfg(any(stm32l47x, stm32l48x, stm32l49x, stm32l4ax, rcc_l4plus, stm32l5))] | ||||
|     Pllsai2, | ||||
| } | ||||
|  | ||||
| fn init_pll(instance: PllInstance, config: Option<Pll>, input: &PllInput) -> PllOutput { | ||||
|     // Disable PLL | ||||
| fn pll_enable(instance: PllInstance, enabled: bool) { | ||||
|     match instance { | ||||
|         PllInstance::Pll => { | ||||
|             RCC.cr().modify(|w| w.set_pllon(false)); | ||||
|             while RCC.cr().read().pllrdy() {} | ||||
|             RCC.cr().modify(|w| w.set_pllon(enabled)); | ||||
|             while RCC.cr().read().pllrdy() != enabled {} | ||||
|         } | ||||
|         #[cfg(any(stm32l4, stm32l5, stm32wb))] | ||||
|         PllInstance::Pllsai1 => { | ||||
|             RCC.cr().modify(|w| w.set_pllsai1on(false)); | ||||
|             while RCC.cr().read().pllsai1rdy() {} | ||||
|             RCC.cr().modify(|w| w.set_pllsai1on(enabled)); | ||||
|             while RCC.cr().read().pllsai1rdy() != enabled {} | ||||
|         } | ||||
|         #[cfg(any(stm32l47x, stm32l48x, stm32l49x, stm32l4ax, rcc_l4plus, stm32l5))] | ||||
|         PllInstance::Pllsai2 => { | ||||
|             RCC.cr().modify(|w| w.set_pllsai2on(false)); | ||||
|             while RCC.cr().read().pllsai2rdy() {} | ||||
|             RCC.cr().modify(|w| w.set_pllsai2on(enabled)); | ||||
|             while RCC.cr().read().pllsai2rdy() != enabled {} | ||||
|         } | ||||
|     } | ||||
| } | ||||
|  | ||||
| fn init_pll(instance: PllInstance, config: Option<Pll>, input: &PllInput) -> PllOutput { | ||||
|     // Disable PLL | ||||
|     pll_enable(instance, false); | ||||
|  | ||||
|     let Some(pll) = config else { return PllOutput::default() }; | ||||
|  | ||||
|     let pll_src = match pll.source { | ||||
|         PLLSource::NONE => panic!("must not select PLL source as NONE"), | ||||
|         PLLSource::DISABLE => panic!("must not select PLL source as DISABLE"), | ||||
|         PLLSource::HSE => input.hse, | ||||
|         PLLSource::HSI => input.hsi16, | ||||
|         PLLSource::HSI => input.hsi, | ||||
|         PLLSource::MSI => input.msi, | ||||
|     }; | ||||
|  | ||||
| @@ -403,6 +498,7 @@ fn init_pll(instance: PllInstance, config: Option<Pll>, input: &PllInput) -> Pll | ||||
|             w.set_pllsrc(pll.source); | ||||
|             write_fields!(w); | ||||
|         }), | ||||
|         #[cfg(any(stm32l4, stm32l5, stm32wb))] | ||||
|         PllInstance::Pllsai1 => RCC.pllsai1cfgr().write(|w| { | ||||
|             #[cfg(any(rcc_l4plus, stm32l5))] | ||||
|             w.set_pllm(pll.prediv); | ||||
| @@ -421,21 +517,7 @@ fn init_pll(instance: PllInstance, config: Option<Pll>, input: &PllInput) -> Pll | ||||
|     } | ||||
|  | ||||
|     // Enable PLL | ||||
|     match instance { | ||||
|         PllInstance::Pll => { | ||||
|             RCC.cr().modify(|w| w.set_pllon(true)); | ||||
|             while !RCC.cr().read().pllrdy() {} | ||||
|         } | ||||
|         PllInstance::Pllsai1 => { | ||||
|             RCC.cr().modify(|w| w.set_pllsai1on(true)); | ||||
|             while !RCC.cr().read().pllsai1rdy() {} | ||||
|         } | ||||
|         #[cfg(any(stm32l47x, stm32l48x, stm32l49x, stm32l4ax, rcc_l4plus, stm32l5))] | ||||
|         PllInstance::Pllsai2 => { | ||||
|             RCC.cr().modify(|w| w.set_pllsai2on(true)); | ||||
|             while !RCC.cr().read().pllsai2rdy() {} | ||||
|         } | ||||
|     } | ||||
|     pll_enable(instance, true); | ||||
|  | ||||
|     PllOutput { _p: p, _q: q, _r: r } | ||||
|     PllOutput { p, q, r } | ||||
| } | ||||
|   | ||||
| @@ -19,14 +19,10 @@ pub use mco::*; | ||||
| #[cfg_attr(rcc_g4, path = "g4.rs")] | ||||
| #[cfg_attr(any(rcc_h5, rcc_h50, rcc_h7, rcc_h7rm0433, rcc_h7ab), path = "h.rs")] | ||||
| #[cfg_attr(any(rcc_l0, rcc_l0_v2, rcc_l1), path = "l0l1.rs")] | ||||
| #[cfg_attr(any(rcc_l4, rcc_l4plus, rcc_l5), path = "l4l5.rs")] | ||||
| #[cfg_attr(any(rcc_l4, rcc_l4plus, rcc_l5, rcc_wl5, rcc_wle, rcc_wb), path = "l4l5.rs")] | ||||
| #[cfg_attr(rcc_u5, path = "u5.rs")] | ||||
| #[cfg_attr(rcc_wb, path = "wb.rs")] | ||||
| #[cfg_attr(rcc_wba, path = "wba.rs")] | ||||
| #[cfg_attr(any(rcc_wl5, rcc_wle), path = "wl.rs")] | ||||
| mod _version; | ||||
| #[cfg(feature = "low-power")] | ||||
| use core::sync::atomic::{AtomicU32, Ordering}; | ||||
|  | ||||
| pub use _version::*; | ||||
|  | ||||
| @@ -185,27 +181,7 @@ pub struct Clocks { | ||||
| } | ||||
|  | ||||
| #[cfg(feature = "low-power")] | ||||
| static CLOCK_REFCOUNT: AtomicU32 = AtomicU32::new(0); | ||||
|  | ||||
| #[cfg(feature = "low-power")] | ||||
| pub fn low_power_ready() -> bool { | ||||
|     // trace!("clock refcount: {}", CLOCK_REFCOUNT.load(Ordering::SeqCst)); | ||||
|     CLOCK_REFCOUNT.load(Ordering::SeqCst) == 0 | ||||
| } | ||||
|  | ||||
| #[cfg(feature = "low-power")] | ||||
| pub(crate) fn clock_refcount_add(_cs: critical_section::CriticalSection) { | ||||
|     // We don't check for overflow because constructing more than u32 peripherals is unlikely | ||||
|     let n = CLOCK_REFCOUNT.load(Ordering::Relaxed); | ||||
|     CLOCK_REFCOUNT.store(n + 1, Ordering::Relaxed); | ||||
| } | ||||
|  | ||||
| #[cfg(feature = "low-power")] | ||||
| pub(crate) fn clock_refcount_sub(_cs: critical_section::CriticalSection) { | ||||
|     let n = CLOCK_REFCOUNT.load(Ordering::Relaxed); | ||||
|     assert!(n != 0); | ||||
|     CLOCK_REFCOUNT.store(n - 1, Ordering::Relaxed); | ||||
| } | ||||
| pub(crate) static mut REFCOUNT_STOP2: u32 = 0; | ||||
|  | ||||
| /// Frozen clock frequencies | ||||
| /// | ||||
| @@ -248,3 +224,33 @@ pub(crate) mod sealed { | ||||
| } | ||||
|  | ||||
| pub trait RccPeripheral: sealed::RccPeripheral + 'static {} | ||||
|  | ||||
| #[allow(unused)] | ||||
| mod util { | ||||
|     use crate::time::Hertz; | ||||
|  | ||||
|     pub fn calc_pclk<D>(hclk: Hertz, ppre: D) -> (Hertz, Hertz) | ||||
|     where | ||||
|         Hertz: core::ops::Div<D, Output = Hertz>, | ||||
|     { | ||||
|         let pclk = hclk / ppre; | ||||
|         let pclk_tim = if hclk == pclk { pclk } else { pclk * 2u32 }; | ||||
|         (pclk, pclk_tim) | ||||
|     } | ||||
|  | ||||
|     pub fn all_equal<T: Eq>(mut iter: impl Iterator<Item = T>) -> bool { | ||||
|         let Some(x) = iter.next() else { return true }; | ||||
|         if !iter.all(|y| y == x) { | ||||
|             return false; | ||||
|         } | ||||
|         true | ||||
|     } | ||||
|  | ||||
|     pub fn get_equal<T: Eq>(mut iter: impl Iterator<Item = T>) -> Result<Option<T>, ()> { | ||||
|         let Some(x) = iter.next() else { return Ok(None) }; | ||||
|         if !iter.all(|y| y == x) { | ||||
|             return Err(()); | ||||
|         } | ||||
|         Ok(Some(x)) | ||||
|     } | ||||
| } | ||||
|   | ||||
| @@ -10,6 +10,7 @@ pub const HSI_FREQ: Hertz = Hertz(16_000_000); | ||||
| pub use crate::pac::pwr::vals::Vos as VoltageScale; | ||||
|  | ||||
| #[derive(Copy, Clone)] | ||||
| #[allow(non_camel_case_types)] | ||||
| pub enum ClockSrc { | ||||
|     /// Use an internal medium speed oscillator (MSIS) as the system clock. | ||||
|     MSI(Msirange), | ||||
| @@ -19,9 +20,9 @@ pub enum ClockSrc { | ||||
|     /// never exceed 50 MHz. | ||||
|     HSE(Hertz), | ||||
|     /// Use the 16 MHz internal high speed oscillator as the system clock. | ||||
|     HSI16, | ||||
|     HSI, | ||||
|     /// Use PLL1 as the system clock. | ||||
|     PLL1R(PllConfig), | ||||
|     PLL1_R(PllConfig), | ||||
| } | ||||
|  | ||||
| impl Default for ClockSrc { | ||||
| @@ -53,10 +54,10 @@ pub struct PllConfig { | ||||
| } | ||||
|  | ||||
| impl PllConfig { | ||||
|     /// A configuration for HSI16 / 1 * 10 / 1 = 160 MHz | ||||
|     pub const fn hsi16_160mhz() -> Self { | ||||
|     /// A configuration for HSI / 1 * 10 / 1 = 160 MHz | ||||
|     pub const fn hsi_160mhz() -> Self { | ||||
|         PllConfig { | ||||
|             source: PllSrc::HSI16, | ||||
|             source: PllSrc::HSI, | ||||
|             m: Pllm::DIV1, | ||||
|             n: Plln::MUL10, | ||||
|             r: Plldiv::DIV1, | ||||
| @@ -84,7 +85,7 @@ pub enum PllSrc { | ||||
|     /// never exceed 50 MHz. | ||||
|     HSE(Hertz), | ||||
|     /// Use the 16 MHz internal high speed oscillator as the PLL source. | ||||
|     HSI16, | ||||
|     HSI, | ||||
| } | ||||
|  | ||||
| impl Into<Pllsrc> for PllSrc { | ||||
| @@ -92,7 +93,7 @@ impl Into<Pllsrc> for PllSrc { | ||||
|         match self { | ||||
|             PllSrc::MSIS(..) => Pllsrc::MSIS, | ||||
|             PllSrc::HSE(..) => Pllsrc::HSE, | ||||
|             PllSrc::HSI16 => Pllsrc::HSI16, | ||||
|             PllSrc::HSI => Pllsrc::HSI, | ||||
|         } | ||||
|     } | ||||
| } | ||||
| @@ -102,8 +103,8 @@ impl Into<Sw> for ClockSrc { | ||||
|         match self { | ||||
|             ClockSrc::MSI(..) => Sw::MSIS, | ||||
|             ClockSrc::HSE(..) => Sw::HSE, | ||||
|             ClockSrc::HSI16 => Sw::HSI16, | ||||
|             ClockSrc::PLL1R(..) => Sw::PLL1_R, | ||||
|             ClockSrc::HSI => Sw::HSI, | ||||
|             ClockSrc::PLL1_R(..) => Sw::PLL1_R, | ||||
|         } | ||||
|     } | ||||
| } | ||||
| @@ -125,7 +126,7 @@ pub struct Config { | ||||
| } | ||||
|  | ||||
| impl Config { | ||||
|     unsafe fn init_hsi16(&self) -> Hertz { | ||||
|     unsafe fn init_hsi(&self) -> Hertz { | ||||
|         RCC.cr().write(|w| w.set_hsion(true)); | ||||
|         while !RCC.cr().read().hsirdy() {} | ||||
|  | ||||
| @@ -169,7 +170,7 @@ impl Config { | ||||
|  | ||||
|         RCC.icscr1().modify(|w| { | ||||
|             w.set_msisrange(range); | ||||
|             w.set_msirgsel(Msirgsel::RCC_ICSCR1); | ||||
|             w.set_msirgsel(Msirgsel::ICSCR1); | ||||
|         }); | ||||
|         RCC.cr().write(|w| { | ||||
|             w.set_msipllen(false); | ||||
| @@ -211,13 +212,13 @@ pub(crate) unsafe fn init(config: Config) { | ||||
|     let sys_clk = match config.mux { | ||||
|         ClockSrc::MSI(range) => config.init_msis(range), | ||||
|         ClockSrc::HSE(freq) => config.init_hse(freq), | ||||
|         ClockSrc::HSI16 => config.init_hsi16(), | ||||
|         ClockSrc::PLL1R(pll) => { | ||||
|         ClockSrc::HSI => config.init_hsi(), | ||||
|         ClockSrc::PLL1_R(pll) => { | ||||
|             // Configure the PLL source | ||||
|             let source_clk = match pll.source { | ||||
|                 PllSrc::MSIS(range) => config.init_msis(range), | ||||
|                 PllSrc::HSE(hertz) => config.init_hse(hertz), | ||||
|                 PllSrc::HSI16 => config.init_hsi16(), | ||||
|                 PllSrc::HSI => config.init_hsi(), | ||||
|             }; | ||||
|  | ||||
|             // Calculate the reference clock, which is the source divided by m | ||||
| @@ -292,7 +293,7 @@ pub(crate) unsafe fn init(config: Config) { | ||||
|                 // Set the prescaler for PWR EPOD | ||||
|                 w.set_pllmboost(mboost); | ||||
|  | ||||
|                 // Enable PLL1R output | ||||
|                 // Enable PLL1_R output | ||||
|                 w.set_pllren(true); | ||||
|             }); | ||||
|  | ||||
|   | ||||
| @@ -1,258 +0,0 @@ | ||||
| pub use crate::pac::rcc::vals::{ | ||||
|     Hpre as AHBPrescaler, Hsepre as HsePrescaler, Pllm, Plln, Pllp, Pllq, Pllr, Pllsrc as PllSource, | ||||
|     Ppre as APBPrescaler, Sw as Sysclk, | ||||
| }; | ||||
| use crate::rcc::{set_freqs, Clocks}; | ||||
| use crate::time::{mhz, Hertz}; | ||||
|  | ||||
| /// HSI speed | ||||
| pub const HSI_FREQ: Hertz = Hertz(16_000_000); | ||||
|  | ||||
| pub struct Hse { | ||||
|     pub prediv: HsePrescaler, | ||||
|  | ||||
|     pub frequency: Hertz, | ||||
| } | ||||
|  | ||||
| pub struct PllMux { | ||||
|     /// Source clock selection. | ||||
|     pub source: PllSource, | ||||
|  | ||||
|     /// PLL pre-divider (DIVM). Must be between 1 and 63. | ||||
|     pub prediv: Pllm, | ||||
| } | ||||
|  | ||||
| pub struct Pll { | ||||
|     /// PLL multiplication factor. Must be between 4 and 512. | ||||
|     pub mul: Plln, | ||||
|  | ||||
|     /// PLL P division factor. If None, PLL P output is disabled. Must be between 1 and 128. | ||||
|     /// On PLL1, it must be even (in particular, it cannot be 1.) | ||||
|     pub divp: Option<Pllp>, | ||||
|     /// PLL Q division factor. If None, PLL Q output is disabled. Must be between 1 and 128. | ||||
|     pub divq: Option<Pllq>, | ||||
|     /// PLL R division factor. If None, PLL R output is disabled. Must be between 1 and 128. | ||||
|     pub divr: Option<Pllr>, | ||||
| } | ||||
|  | ||||
| /// Clocks configutation | ||||
| pub struct Config { | ||||
|     pub hse: Option<Hse>, | ||||
|     pub sys: Sysclk, | ||||
|     pub mux: Option<PllMux>, | ||||
|     pub hsi48: bool, | ||||
|  | ||||
|     pub pll: Option<Pll>, | ||||
|     pub pllsai: Option<Pll>, | ||||
|  | ||||
|     pub ahb1_pre: AHBPrescaler, | ||||
|     pub ahb2_pre: AHBPrescaler, | ||||
|     pub ahb3_pre: AHBPrescaler, | ||||
|     pub apb1_pre: APBPrescaler, | ||||
|     pub apb2_pre: APBPrescaler, | ||||
|  | ||||
|     pub ls: super::LsConfig, | ||||
| } | ||||
|  | ||||
| pub const WPAN_DEFAULT: Config = Config { | ||||
|     hse: Some(Hse { | ||||
|         frequency: mhz(32), | ||||
|         prediv: HsePrescaler::DIV1, | ||||
|     }), | ||||
|     sys: Sysclk::PLL, | ||||
|     mux: Some(PllMux { | ||||
|         source: PllSource::HSE, | ||||
|         prediv: Pllm::DIV2, | ||||
|     }), | ||||
|     hsi48: true, | ||||
|  | ||||
|     ls: super::LsConfig::default_lse(), | ||||
|  | ||||
|     pll: Some(Pll { | ||||
|         mul: Plln::MUL12, | ||||
|         divp: Some(Pllp::DIV3), | ||||
|         divq: Some(Pllq::DIV4), | ||||
|         divr: Some(Pllr::DIV3), | ||||
|     }), | ||||
|     pllsai: None, | ||||
|  | ||||
|     ahb1_pre: AHBPrescaler::DIV1, | ||||
|     ahb2_pre: AHBPrescaler::DIV2, | ||||
|     ahb3_pre: AHBPrescaler::DIV1, | ||||
|     apb1_pre: APBPrescaler::DIV1, | ||||
|     apb2_pre: APBPrescaler::DIV1, | ||||
| }; | ||||
|  | ||||
| impl Default for Config { | ||||
|     #[inline] | ||||
|     fn default() -> Config { | ||||
|         Config { | ||||
|             hse: None, | ||||
|             sys: Sysclk::HSI16, | ||||
|             mux: None, | ||||
|             pll: None, | ||||
|             pllsai: None, | ||||
|             hsi48: true, | ||||
|  | ||||
|             ls: Default::default(), | ||||
|  | ||||
|             ahb1_pre: AHBPrescaler::DIV1, | ||||
|             ahb2_pre: AHBPrescaler::DIV1, | ||||
|             ahb3_pre: AHBPrescaler::DIV1, | ||||
|             apb1_pre: APBPrescaler::DIV1, | ||||
|             apb2_pre: APBPrescaler::DIV1, | ||||
|         } | ||||
|     } | ||||
| } | ||||
|  | ||||
| #[cfg(stm32wb)] | ||||
| /// RCC initialization function | ||||
| pub(crate) unsafe fn init(config: Config) { | ||||
|     let hse_clk = config.hse.as_ref().map(|hse| hse.frequency / hse.prediv); | ||||
|  | ||||
|     let mux_clk = config.mux.as_ref().map(|pll_mux| { | ||||
|         (match pll_mux.source { | ||||
|             PllSource::HSE => hse_clk.unwrap(), | ||||
|             PllSource::HSI16 => HSI_FREQ, | ||||
|             _ => unreachable!(), | ||||
|         } / pll_mux.prediv) | ||||
|     }); | ||||
|  | ||||
|     let (pll_r, _pll_q, _pll_p) = match &config.pll { | ||||
|         Some(pll) => { | ||||
|             let pll_vco = mux_clk.unwrap() * pll.mul as u32; | ||||
|  | ||||
|             ( | ||||
|                 pll.divr.map(|divr| pll_vco / divr), | ||||
|                 pll.divq.map(|divq| pll_vco / divq), | ||||
|                 pll.divp.map(|divp| pll_vco / divp), | ||||
|             ) | ||||
|         } | ||||
|         None => (None, None, None), | ||||
|     }; | ||||
|  | ||||
|     let sys_clk = match config.sys { | ||||
|         Sysclk::HSE => hse_clk.unwrap(), | ||||
|         Sysclk::HSI16 => HSI_FREQ, | ||||
|         Sysclk::PLL => pll_r.unwrap(), | ||||
|         _ => unreachable!(), | ||||
|     }; | ||||
|  | ||||
|     let ahb1_clk = sys_clk / config.ahb1_pre; | ||||
|     let ahb2_clk = sys_clk / config.ahb2_pre; | ||||
|     let ahb3_clk = sys_clk / config.ahb3_pre; | ||||
|  | ||||
|     let (apb1_clk, apb1_tim_clk) = match config.apb1_pre { | ||||
|         APBPrescaler::DIV1 => (ahb1_clk, ahb1_clk), | ||||
|         pre => { | ||||
|             let freq = ahb1_clk / pre; | ||||
|             (freq, freq * 2u32) | ||||
|         } | ||||
|     }; | ||||
|  | ||||
|     let (apb2_clk, apb2_tim_clk) = match config.apb2_pre { | ||||
|         APBPrescaler::DIV1 => (ahb1_clk, ahb1_clk), | ||||
|         pre => { | ||||
|             let freq = ahb1_clk / pre; | ||||
|             (freq, freq * 2u32) | ||||
|         } | ||||
|     }; | ||||
|  | ||||
|     let rcc = crate::pac::RCC; | ||||
|  | ||||
|     let needs_hsi = if let Some(pll_mux) = &config.mux { | ||||
|         pll_mux.source == PllSource::HSI16 | ||||
|     } else { | ||||
|         false | ||||
|     }; | ||||
|  | ||||
|     if needs_hsi || config.sys == Sysclk::HSI16 { | ||||
|         rcc.cr().modify(|w| { | ||||
|             w.set_hsion(true); | ||||
|         }); | ||||
|  | ||||
|         while !rcc.cr().read().hsirdy() {} | ||||
|     } | ||||
|  | ||||
|     rcc.cfgr().modify(|w| w.set_stopwuck(true)); | ||||
|  | ||||
|     let rtc = config.ls.init(); | ||||
|  | ||||
|     match &config.hse { | ||||
|         Some(hse) => { | ||||
|             rcc.cr().modify(|w| { | ||||
|                 w.set_hsepre(hse.prediv); | ||||
|                 w.set_hseon(true); | ||||
|             }); | ||||
|  | ||||
|             while !rcc.cr().read().hserdy() {} | ||||
|         } | ||||
|         _ => {} | ||||
|     } | ||||
|  | ||||
|     match &config.mux { | ||||
|         Some(pll_mux) => { | ||||
|             rcc.pllcfgr().modify(|w| { | ||||
|                 w.set_pllm(pll_mux.prediv); | ||||
|                 w.set_pllsrc(pll_mux.source.into()); | ||||
|             }); | ||||
|         } | ||||
|         _ => {} | ||||
|     }; | ||||
|  | ||||
|     match &config.pll { | ||||
|         Some(pll) => { | ||||
|             rcc.pllcfgr().modify(|w| { | ||||
|                 w.set_plln(pll.mul); | ||||
|                 pll.divp.map(|divp| { | ||||
|                     w.set_pllpen(true); | ||||
|                     w.set_pllp(divp) | ||||
|                 }); | ||||
|                 pll.divq.map(|divq| { | ||||
|                     w.set_pllqen(true); | ||||
|                     w.set_pllq(divq) | ||||
|                 }); | ||||
|                 pll.divr.map(|divr| { | ||||
|                     w.set_pllren(true); | ||||
|                     w.set_pllr(divr); | ||||
|                 }); | ||||
|             }); | ||||
|  | ||||
|             rcc.cr().modify(|w| w.set_pllon(true)); | ||||
|  | ||||
|             while !rcc.cr().read().pllrdy() {} | ||||
|         } | ||||
|         _ => {} | ||||
|     } | ||||
|  | ||||
|     let _hsi48 = config.hsi48.then(|| { | ||||
|         rcc.crrcr().modify(|w| w.set_hsi48on(true)); | ||||
|         while !rcc.crrcr().read().hsi48rdy() {} | ||||
|  | ||||
|         Hertz(48_000_000) | ||||
|     }); | ||||
|  | ||||
|     rcc.cfgr().modify(|w| { | ||||
|         w.set_sw(config.sys.into()); | ||||
|         w.set_hpre(config.ahb1_pre); | ||||
|         w.set_ppre1(config.apb1_pre); | ||||
|         w.set_ppre2(config.apb2_pre); | ||||
|     }); | ||||
|  | ||||
|     rcc.extcfgr().modify(|w| { | ||||
|         w.set_c2hpre(config.ahb2_pre); | ||||
|         w.set_shdhpre(config.ahb3_pre); | ||||
|     }); | ||||
|  | ||||
|     set_freqs(Clocks { | ||||
|         sys: sys_clk, | ||||
|         hclk1: ahb1_clk, | ||||
|         hclk2: ahb2_clk, | ||||
|         hclk3: ahb3_clk, | ||||
|         pclk1: apb1_clk, | ||||
|         pclk2: apb2_clk, | ||||
|         pclk1_tim: apb1_tim_clk, | ||||
|         pclk2_tim: apb2_tim_clk, | ||||
|         rtc, | ||||
|     }) | ||||
| } | ||||
| @@ -13,20 +13,20 @@ pub use crate::pac::rcc::vals::{Hpre as AHBPrescaler, Ppre as APBPrescaler}; | ||||
| #[derive(Copy, Clone)] | ||||
| pub enum ClockSrc { | ||||
|     HSE(Hertz), | ||||
|     HSI16, | ||||
|     HSI, | ||||
| } | ||||
|  | ||||
| #[derive(Clone, Copy, Debug)] | ||||
| pub enum PllSrc { | ||||
|     HSE(Hertz), | ||||
|     HSI16, | ||||
|     HSI, | ||||
| } | ||||
|  | ||||
| impl Into<Pllsrc> for PllSrc { | ||||
|     fn into(self) -> Pllsrc { | ||||
|         match self { | ||||
|             PllSrc::HSE(..) => Pllsrc::HSE, | ||||
|             PllSrc::HSI16 => Pllsrc::HSI16, | ||||
|             PllSrc::HSI => Pllsrc::HSI, | ||||
|         } | ||||
|     } | ||||
| } | ||||
| @@ -35,7 +35,7 @@ impl Into<Sw> for ClockSrc { | ||||
|     fn into(self) -> Sw { | ||||
|         match self { | ||||
|             ClockSrc::HSE(..) => Sw::HSE, | ||||
|             ClockSrc::HSI16 => Sw::HSI16, | ||||
|             ClockSrc::HSI => Sw::HSI, | ||||
|         } | ||||
|     } | ||||
| } | ||||
| @@ -52,7 +52,7 @@ pub struct Config { | ||||
| impl Default for Config { | ||||
|     fn default() -> Self { | ||||
|         Self { | ||||
|             mux: ClockSrc::HSI16, | ||||
|             mux: ClockSrc::HSI, | ||||
|             ahb_pre: AHBPrescaler::DIV1, | ||||
|             apb1_pre: APBPrescaler::DIV1, | ||||
|             apb2_pre: APBPrescaler::DIV1, | ||||
| @@ -70,7 +70,7 @@ pub(crate) unsafe fn init(config: Config) { | ||||
|  | ||||
|             freq | ||||
|         } | ||||
|         ClockSrc::HSI16 => { | ||||
|         ClockSrc::HSI => { | ||||
|             RCC.cr().write(|w| w.set_hsion(true)); | ||||
|             while !RCC.cr().read().hsirdy() {} | ||||
|  | ||||
|   | ||||
| @@ -1,184 +0,0 @@ | ||||
| pub use crate::pac::pwr::vals::Vos as VoltageScale; | ||||
| use crate::pac::rcc::vals::Sw; | ||||
| pub use crate::pac::rcc::vals::{ | ||||
|     Adcsel as AdcClockSource, Hpre as AHBPrescaler, Msirange as MSIRange, Pllm, Plln, Pllp, Pllq, Pllr, | ||||
|     Pllsrc as PllSource, Ppre as APBPrescaler, | ||||
| }; | ||||
| use crate::pac::{FLASH, RCC}; | ||||
| use crate::rcc::{set_freqs, Clocks}; | ||||
| use crate::time::Hertz; | ||||
|  | ||||
| /// HSI speed | ||||
| pub const HSI_FREQ: Hertz = Hertz(16_000_000); | ||||
|  | ||||
| /// HSE speed | ||||
| pub const HSE_FREQ: Hertz = Hertz(32_000_000); | ||||
|  | ||||
| /// System clock mux source | ||||
| #[derive(Clone, Copy)] | ||||
| pub enum ClockSrc { | ||||
|     MSI(MSIRange), | ||||
|     HSE, | ||||
|     HSI16, | ||||
| } | ||||
|  | ||||
| /// Clocks configutation | ||||
| pub struct Config { | ||||
|     pub mux: ClockSrc, | ||||
|     pub ahb_pre: AHBPrescaler, | ||||
|     pub shd_ahb_pre: AHBPrescaler, | ||||
|     pub apb1_pre: APBPrescaler, | ||||
|     pub apb2_pre: APBPrescaler, | ||||
|     pub adc_clock_source: AdcClockSource, | ||||
|     pub ls: super::LsConfig, | ||||
| } | ||||
|  | ||||
| impl Default for Config { | ||||
|     #[inline] | ||||
|     fn default() -> Config { | ||||
|         Config { | ||||
|             mux: ClockSrc::MSI(MSIRange::RANGE4M), | ||||
|             ahb_pre: AHBPrescaler::DIV1, | ||||
|             shd_ahb_pre: AHBPrescaler::DIV1, | ||||
|             apb1_pre: APBPrescaler::DIV1, | ||||
|             apb2_pre: APBPrescaler::DIV1, | ||||
|             adc_clock_source: AdcClockSource::HSI16, | ||||
|             ls: Default::default(), | ||||
|         } | ||||
|     } | ||||
| } | ||||
|  | ||||
| pub(crate) unsafe fn init(config: Config) { | ||||
|     let (sys_clk, sw, vos) = match config.mux { | ||||
|         ClockSrc::HSI16 => (HSI_FREQ, Sw::HSI16, VoltageScale::RANGE2), | ||||
|         ClockSrc::HSE => (HSE_FREQ, Sw::HSE, VoltageScale::RANGE1), | ||||
|         ClockSrc::MSI(range) => (msirange_to_hertz(range), Sw::MSI, msirange_to_vos(range)), | ||||
|     }; | ||||
|  | ||||
|     let ahb_freq = sys_clk / config.ahb_pre; | ||||
|     let shd_ahb_freq = sys_clk / config.shd_ahb_pre; | ||||
|  | ||||
|     let (apb1_freq, apb1_tim_freq) = match config.apb1_pre { | ||||
|         APBPrescaler::DIV1 => (ahb_freq, ahb_freq), | ||||
|         pre => { | ||||
|             let freq = ahb_freq / pre; | ||||
|             (freq, freq * 2u32) | ||||
|         } | ||||
|     }; | ||||
|  | ||||
|     let (apb2_freq, apb2_tim_freq) = match config.apb2_pre { | ||||
|         APBPrescaler::DIV1 => (ahb_freq, ahb_freq), | ||||
|         pre => { | ||||
|             let freq = ahb_freq / pre; | ||||
|             (freq, freq * 2u32) | ||||
|         } | ||||
|     }; | ||||
|  | ||||
|     // Adjust flash latency | ||||
|     let flash_clk_src_freq = shd_ahb_freq; | ||||
|     let ws = match vos { | ||||
|         VoltageScale::RANGE1 => match flash_clk_src_freq.0 { | ||||
|             0..=18_000_000 => 0b000, | ||||
|             18_000_001..=36_000_000 => 0b001, | ||||
|             _ => 0b010, | ||||
|         }, | ||||
|         VoltageScale::RANGE2 => match flash_clk_src_freq.0 { | ||||
|             0..=6_000_000 => 0b000, | ||||
|             6_000_001..=12_000_000 => 0b001, | ||||
|             _ => 0b010, | ||||
|         }, | ||||
|         _ => unreachable!(), | ||||
|     }; | ||||
|  | ||||
|     FLASH.acr().modify(|w| { | ||||
|         w.set_latency(ws); | ||||
|     }); | ||||
|  | ||||
|     while FLASH.acr().read().latency() != ws {} | ||||
|  | ||||
|     match config.mux { | ||||
|         ClockSrc::HSI16 => { | ||||
|             // Enable HSI16 | ||||
|             RCC.cr().write(|w| w.set_hsion(true)); | ||||
|             while !RCC.cr().read().hsirdy() {} | ||||
|         } | ||||
|         ClockSrc::HSE => { | ||||
|             // Enable HSE | ||||
|             RCC.cr().write(|w| { | ||||
|                 w.set_hsebyppwr(true); | ||||
|                 w.set_hseon(true); | ||||
|             }); | ||||
|             while !RCC.cr().read().hserdy() {} | ||||
|         } | ||||
|         ClockSrc::MSI(range) => { | ||||
|             let cr = RCC.cr().read(); | ||||
|             assert!(!cr.msion() || cr.msirdy()); | ||||
|             RCC.cr().write(|w| { | ||||
|                 w.set_msirgsel(true); | ||||
|                 w.set_msirange(range); | ||||
|                 w.set_msion(true); | ||||
|  | ||||
|                 // If LSE is enabled, enable calibration of MSI | ||||
|                 w.set_msipllen(config.ls.lse.is_some()); | ||||
|             }); | ||||
|             while !RCC.cr().read().msirdy() {} | ||||
|         } | ||||
|     } | ||||
|  | ||||
|     RCC.extcfgr().modify(|w| { | ||||
|         w.set_shdhpre(config.shd_ahb_pre); | ||||
|     }); | ||||
|  | ||||
|     RCC.cfgr().modify(|w| { | ||||
|         w.set_sw(sw.into()); | ||||
|         w.set_hpre(config.ahb_pre); | ||||
|         w.set_ppre1(config.apb1_pre); | ||||
|         w.set_ppre2(config.apb2_pre); | ||||
|     }); | ||||
|  | ||||
|     // ADC clock MUX | ||||
|     RCC.ccipr().modify(|w| w.set_adcsel(config.adc_clock_source)); | ||||
|  | ||||
|     // TODO: switch voltage range | ||||
|  | ||||
|     let rtc = config.ls.init(); | ||||
|  | ||||
|     set_freqs(Clocks { | ||||
|         sys: sys_clk, | ||||
|         hclk1: ahb_freq, | ||||
|         hclk2: ahb_freq, | ||||
|         hclk3: shd_ahb_freq, | ||||
|         pclk1: apb1_freq, | ||||
|         pclk2: apb2_freq, | ||||
|         pclk3: shd_ahb_freq, | ||||
|         pclk1_tim: apb1_tim_freq, | ||||
|         pclk2_tim: apb2_tim_freq, | ||||
|         rtc, | ||||
|     }); | ||||
| } | ||||
|  | ||||
| fn msirange_to_hertz(range: MSIRange) -> Hertz { | ||||
|     match range { | ||||
|         MSIRange::RANGE100K => Hertz(100_000), | ||||
|         MSIRange::RANGE200K => Hertz(200_000), | ||||
|         MSIRange::RANGE400K => Hertz(400_000), | ||||
|         MSIRange::RANGE800K => Hertz(800_000), | ||||
|         MSIRange::RANGE1M => Hertz(1_000_000), | ||||
|         MSIRange::RANGE2M => Hertz(2_000_000), | ||||
|         MSIRange::RANGE4M => Hertz(4_000_000), | ||||
|         MSIRange::RANGE8M => Hertz(8_000_000), | ||||
|         MSIRange::RANGE16M => Hertz(16_000_000), | ||||
|         MSIRange::RANGE24M => Hertz(24_000_000), | ||||
|         MSIRange::RANGE32M => Hertz(32_000_000), | ||||
|         MSIRange::RANGE48M => Hertz(48_000_000), | ||||
|         _ => unreachable!(), | ||||
|     } | ||||
| } | ||||
|  | ||||
| fn msirange_to_vos(range: MSIRange) -> VoltageScale { | ||||
|     if range.to_bits() > MSIRange::RANGE16M.to_bits() { | ||||
|         VoltageScale::RANGE1 | ||||
|     } else { | ||||
|         VoltageScale::RANGE2 | ||||
|     } | ||||
| } | ||||
| @@ -4,8 +4,60 @@ use core::convert::From; | ||||
| #[cfg(feature = "chrono")] | ||||
| use chrono::{self, Datelike, NaiveDate, Timelike, Weekday}; | ||||
|  | ||||
| use super::byte_to_bcd2; | ||||
| use crate::pac::rtc::Rtc; | ||||
| #[cfg(any(feature = "defmt", feature = "time"))] | ||||
| use crate::peripherals::RTC; | ||||
| #[cfg(any(feature = "defmt", feature = "time"))] | ||||
| use crate::rtc::sealed::Instance; | ||||
|  | ||||
| /// Represents an instant in time that can be substracted to compute a duration | ||||
| pub struct RtcInstant { | ||||
|     /// 0..59 | ||||
|     pub second: u8, | ||||
|     /// 0..256 | ||||
|     pub subsecond: u16, | ||||
| } | ||||
|  | ||||
| impl RtcInstant { | ||||
|     #[allow(dead_code)] | ||||
|     pub(super) fn from(second: u8, subsecond: u16) -> Result<Self, super::RtcError> { | ||||
|         Ok(Self { second, subsecond }) | ||||
|     } | ||||
| } | ||||
|  | ||||
| #[cfg(feature = "defmt")] | ||||
| impl defmt::Format for RtcInstant { | ||||
|     fn format(&self, fmt: defmt::Formatter) { | ||||
|         defmt::write!( | ||||
|             fmt, | ||||
|             "{}:{}", | ||||
|             self.second, | ||||
|             RTC::regs().prer().read().prediv_s() - self.subsecond, | ||||
|         ) | ||||
|     } | ||||
| } | ||||
|  | ||||
| #[cfg(feature = "time")] | ||||
| impl core::ops::Sub for RtcInstant { | ||||
|     type Output = embassy_time::Duration; | ||||
|  | ||||
|     fn sub(self, rhs: Self) -> Self::Output { | ||||
|         use embassy_time::{Duration, TICK_HZ}; | ||||
|  | ||||
|         let second = if self.second < rhs.second { | ||||
|             self.second + 60 | ||||
|         } else { | ||||
|             self.second | ||||
|         }; | ||||
|  | ||||
|         let psc = RTC::regs().prer().read().prediv_s() as u32; | ||||
|  | ||||
|         let self_ticks = second as u32 * (psc + 1) + (psc - self.subsecond as u32); | ||||
|         let other_ticks = rhs.second as u32 * (psc + 1) + (psc - rhs.subsecond as u32); | ||||
|         let rtc_ticks = self_ticks - other_ticks; | ||||
|  | ||||
|         Duration::from_ticks(((rtc_ticks * TICK_HZ as u32) / (psc + 1)) as u64) | ||||
|     } | ||||
| } | ||||
|  | ||||
| /// Errors regarding the [`DateTime`] struct. | ||||
| #[derive(Clone, Debug, PartialEq, Eq)] | ||||
| @@ -32,19 +84,85 @@ pub enum Error { | ||||
| /// Structure containing date and time information | ||||
| pub struct DateTime { | ||||
|     /// 0..4095 | ||||
|     pub year: u16, | ||||
|     year: u16, | ||||
|     /// 1..12, 1 is January | ||||
|     pub month: u8, | ||||
|     month: u8, | ||||
|     /// 1..28,29,30,31 depending on month | ||||
|     pub day: u8, | ||||
|     day: u8, | ||||
|     /// | ||||
|     pub day_of_week: DayOfWeek, | ||||
|     day_of_week: DayOfWeek, | ||||
|     /// 0..23 | ||||
|     pub hour: u8, | ||||
|     hour: u8, | ||||
|     /// 0..59 | ||||
|     pub minute: u8, | ||||
|     minute: u8, | ||||
|     /// 0..59 | ||||
|     pub second: u8, | ||||
|     second: u8, | ||||
| } | ||||
|  | ||||
| impl DateTime { | ||||
|     pub const fn year(&self) -> u16 { | ||||
|         self.year | ||||
|     } | ||||
|  | ||||
|     pub const fn month(&self) -> u8 { | ||||
|         self.month | ||||
|     } | ||||
|  | ||||
|     pub const fn day(&self) -> u8 { | ||||
|         self.day | ||||
|     } | ||||
|  | ||||
|     pub const fn day_of_week(&self) -> DayOfWeek { | ||||
|         self.day_of_week | ||||
|     } | ||||
|  | ||||
|     pub const fn hour(&self) -> u8 { | ||||
|         self.hour | ||||
|     } | ||||
|  | ||||
|     pub const fn minute(&self) -> u8 { | ||||
|         self.minute | ||||
|     } | ||||
|  | ||||
|     pub const fn second(&self) -> u8 { | ||||
|         self.second | ||||
|     } | ||||
|  | ||||
|     pub fn from( | ||||
|         year: u16, | ||||
|         month: u8, | ||||
|         day: u8, | ||||
|         day_of_week: u8, | ||||
|         hour: u8, | ||||
|         minute: u8, | ||||
|         second: u8, | ||||
|     ) -> Result<Self, Error> { | ||||
|         let day_of_week = day_of_week_from_u8(day_of_week)?; | ||||
|  | ||||
|         if year > 4095 { | ||||
|             Err(Error::InvalidYear) | ||||
|         } else if month < 1 || month > 12 { | ||||
|             Err(Error::InvalidMonth) | ||||
|         } else if day < 1 || day > 31 { | ||||
|             Err(Error::InvalidDay) | ||||
|         } else if hour > 23 { | ||||
|             Err(Error::InvalidHour) | ||||
|         } else if minute > 59 { | ||||
|             Err(Error::InvalidMinute) | ||||
|         } else if second > 59 { | ||||
|             Err(Error::InvalidSecond) | ||||
|         } else { | ||||
|             Ok(Self { | ||||
|                 year, | ||||
|                 month, | ||||
|                 day, | ||||
|                 day_of_week, | ||||
|                 hour, | ||||
|                 minute, | ||||
|                 second, | ||||
|             }) | ||||
|         } | ||||
|     } | ||||
| } | ||||
|  | ||||
| #[cfg(feature = "chrono")] | ||||
| @@ -142,58 +260,3 @@ pub(super) fn validate_datetime(dt: &DateTime) -> Result<(), Error> { | ||||
|         Ok(()) | ||||
|     } | ||||
| } | ||||
|  | ||||
| pub(super) fn write_date_time(rtc: &Rtc, t: DateTime) { | ||||
|     let (ht, hu) = byte_to_bcd2(t.hour as u8); | ||||
|     let (mnt, mnu) = byte_to_bcd2(t.minute as u8); | ||||
|     let (st, su) = byte_to_bcd2(t.second as u8); | ||||
|  | ||||
|     let (dt, du) = byte_to_bcd2(t.day as u8); | ||||
|     let (mt, mu) = byte_to_bcd2(t.month as u8); | ||||
|     let yr = t.year as u16; | ||||
|     let yr_offset = (yr - 1970_u16) as u8; | ||||
|     let (yt, yu) = byte_to_bcd2(yr_offset); | ||||
|  | ||||
|     use crate::pac::rtc::vals::Ampm; | ||||
|  | ||||
|     rtc.tr().write(|w| { | ||||
|         w.set_ht(ht); | ||||
|         w.set_hu(hu); | ||||
|         w.set_mnt(mnt); | ||||
|         w.set_mnu(mnu); | ||||
|         w.set_st(st); | ||||
|         w.set_su(su); | ||||
|         w.set_pm(Ampm::AM); | ||||
|     }); | ||||
|  | ||||
|     rtc.dr().write(|w| { | ||||
|         w.set_dt(dt); | ||||
|         w.set_du(du); | ||||
|         w.set_mt(mt > 0); | ||||
|         w.set_mu(mu); | ||||
|         w.set_yt(yt); | ||||
|         w.set_yu(yu); | ||||
|         w.set_wdu(day_of_week_to_u8(t.day_of_week)); | ||||
|     }); | ||||
| } | ||||
|  | ||||
| pub(super) fn datetime( | ||||
|     year: u16, | ||||
|     month: u8, | ||||
|     day: u8, | ||||
|     day_of_week: u8, | ||||
|     hour: u8, | ||||
|     minute: u8, | ||||
|     second: u8, | ||||
| ) -> Result<DateTime, Error> { | ||||
|     let day_of_week = day_of_week_from_u8(day_of_week)?; | ||||
|     Ok(DateTime { | ||||
|         year, | ||||
|         month, | ||||
|         day, | ||||
|         day_of_week, | ||||
|         hour, | ||||
|         minute, | ||||
|         second, | ||||
|     }) | ||||
| } | ||||
|   | ||||
| @@ -9,7 +9,8 @@ use embassy_sync::blocking_mutex::raw::CriticalSectionRawMutex; | ||||
| #[cfg(feature = "low-power")] | ||||
| use embassy_sync::blocking_mutex::Mutex; | ||||
|  | ||||
| pub use self::datetime::{DateTime, DayOfWeek, Error as DateTimeError}; | ||||
| pub use self::datetime::{DateTime, DayOfWeek, Error as DateTimeError, RtcInstant}; | ||||
| use crate::rtc::datetime::day_of_week_to_u8; | ||||
| use crate::time::Hertz; | ||||
|  | ||||
| /// refer to AN4759 to compare features of RTC2 and RTC3 | ||||
| @@ -39,48 +40,6 @@ pub enum RtcError { | ||||
|     NotRunning, | ||||
| } | ||||
|  | ||||
| #[cfg(feature = "low-power")] | ||||
| /// Represents an instant in time that can be substracted to compute a duration | ||||
| struct RtcInstant { | ||||
|     second: u8, | ||||
|     subsecond: u16, | ||||
| } | ||||
|  | ||||
| #[cfg(all(feature = "low-power", feature = "defmt"))] | ||||
| impl defmt::Format for RtcInstant { | ||||
|     fn format(&self, fmt: defmt::Formatter) { | ||||
|         defmt::write!( | ||||
|             fmt, | ||||
|             "{}:{}", | ||||
|             self.second, | ||||
|             RTC::regs().prer().read().prediv_s() - self.subsecond, | ||||
|         ) | ||||
|     } | ||||
| } | ||||
|  | ||||
| #[cfg(feature = "low-power")] | ||||
| impl core::ops::Sub for RtcInstant { | ||||
|     type Output = embassy_time::Duration; | ||||
|  | ||||
|     fn sub(self, rhs: Self) -> Self::Output { | ||||
|         use embassy_time::{Duration, TICK_HZ}; | ||||
|  | ||||
|         let second = if self.second < rhs.second { | ||||
|             self.second + 60 | ||||
|         } else { | ||||
|             self.second | ||||
|         }; | ||||
|  | ||||
|         let psc = RTC::regs().prer().read().prediv_s() as u32; | ||||
|  | ||||
|         let self_ticks = second as u32 * (psc + 1) + (psc - self.subsecond as u32); | ||||
|         let other_ticks = rhs.second as u32 * (psc + 1) + (psc - rhs.subsecond as u32); | ||||
|         let rtc_ticks = self_ticks - other_ticks; | ||||
|  | ||||
|         Duration::from_ticks(((rtc_ticks * TICK_HZ as u32) / (psc + 1)) as u64) | ||||
|     } | ||||
| } | ||||
|  | ||||
| pub struct RtcTimeProvider { | ||||
|     _private: (), | ||||
| } | ||||
| @@ -113,7 +72,7 @@ impl RtcTimeProvider { | ||||
|                 let month = bcd2_to_byte((dr.mt() as u8, dr.mu())); | ||||
|                 let year = bcd2_to_byte((dr.yt(), dr.yu())) as u16 + 1970_u16; | ||||
|  | ||||
|                 return self::datetime::datetime(year, month, day, weekday, hour, minute, second) | ||||
|                 return DateTime::from(year, month, day, weekday, hour, minute, second) | ||||
|                     .map_err(RtcError::InvalidDateTime); | ||||
|             } | ||||
|         } | ||||
| @@ -134,7 +93,7 @@ impl RtcTimeProvider { | ||||
|             let month = bcd2_to_byte((dr.mt() as u8, dr.mu())); | ||||
|             let year = bcd2_to_byte((dr.yt(), dr.yu())) as u16 + 1970_u16; | ||||
|  | ||||
|             self::datetime::datetime(year, month, day, weekday, hour, minute, second).map_err(RtcError::InvalidDateTime) | ||||
|             DateTime::from(year, month, day, weekday, hour, minute, second).map_err(RtcError::InvalidDateTime) | ||||
|         } | ||||
|     } | ||||
| } | ||||
| @@ -184,7 +143,13 @@ impl Default for RtcCalibrationCyclePeriod { | ||||
| impl Rtc { | ||||
|     pub fn new(_rtc: impl Peripheral<P = RTC>, rtc_config: RtcConfig) -> Self { | ||||
|         #[cfg(not(any(stm32l0, stm32f3, stm32l1, stm32f0, stm32f2)))] | ||||
|         <RTC as crate::rcc::sealed::RccPeripheral>::enable_and_reset(); | ||||
|         critical_section::with(|cs| { | ||||
|             <RTC as crate::rcc::sealed::RccPeripheral>::enable_and_reset_with_cs(cs); | ||||
|             #[cfg(feature = "low-power")] | ||||
|             unsafe { | ||||
|                 crate::rcc::REFCOUNT_STOP2 -= 1 | ||||
|             }; | ||||
|         }); | ||||
|  | ||||
|         let mut this = Self { | ||||
|             #[cfg(feature = "low-power")] | ||||
| @@ -219,14 +184,46 @@ impl Rtc { | ||||
|     /// Will return `RtcError::InvalidDateTime` if the datetime is not a valid range. | ||||
|     pub fn set_datetime(&mut self, t: DateTime) -> Result<(), RtcError> { | ||||
|         self::datetime::validate_datetime(&t).map_err(RtcError::InvalidDateTime)?; | ||||
|         self.write(true, |rtc| self::datetime::write_date_time(rtc, t)); | ||||
|         self.write(true, |rtc| { | ||||
|             let (ht, hu) = byte_to_bcd2(t.hour() as u8); | ||||
|             let (mnt, mnu) = byte_to_bcd2(t.minute() as u8); | ||||
|             let (st, su) = byte_to_bcd2(t.second() as u8); | ||||
|  | ||||
|             let (dt, du) = byte_to_bcd2(t.day() as u8); | ||||
|             let (mt, mu) = byte_to_bcd2(t.month() as u8); | ||||
|             let yr = t.year() as u16; | ||||
|             let yr_offset = (yr - 1970_u16) as u8; | ||||
|             let (yt, yu) = byte_to_bcd2(yr_offset); | ||||
|  | ||||
|             use crate::pac::rtc::vals::Ampm; | ||||
|  | ||||
|             rtc.tr().write(|w| { | ||||
|                 w.set_ht(ht); | ||||
|                 w.set_hu(hu); | ||||
|                 w.set_mnt(mnt); | ||||
|                 w.set_mnu(mnu); | ||||
|                 w.set_st(st); | ||||
|                 w.set_su(su); | ||||
|                 w.set_pm(Ampm::AM); | ||||
|             }); | ||||
|  | ||||
|             rtc.dr().write(|w| { | ||||
|                 w.set_dt(dt); | ||||
|                 w.set_du(du); | ||||
|                 w.set_mt(mt > 0); | ||||
|                 w.set_mu(mu); | ||||
|                 w.set_yt(yt); | ||||
|                 w.set_yu(yu); | ||||
|                 w.set_wdu(day_of_week_to_u8(t.day_of_week())); | ||||
|             }); | ||||
|         }); | ||||
|  | ||||
|         Ok(()) | ||||
|     } | ||||
|  | ||||
|     #[cfg(feature = "low-power")] | ||||
|     #[cfg(not(rtc_v2f2))] | ||||
|     /// Return the current instant. | ||||
|     fn instant(&self) -> RtcInstant { | ||||
|     pub fn instant(&self) -> Result<RtcInstant, RtcError> { | ||||
|         let r = RTC::regs(); | ||||
|         let tr = r.tr().read(); | ||||
|         let subsecond = r.ssr().read().ss(); | ||||
| @@ -235,7 +232,7 @@ impl Rtc { | ||||
|         // Unlock the registers | ||||
|         r.dr().read(); | ||||
|  | ||||
|         RtcInstant { second, subsecond } | ||||
|         RtcInstant::from(second, subsecond.try_into().unwrap()) | ||||
|     } | ||||
|  | ||||
|     /// Return the current datetime. | ||||
|   | ||||
| @@ -95,15 +95,16 @@ impl super::Rtc { | ||||
|             regs.cr().modify(|w| w.set_wutie(true)); | ||||
|         }); | ||||
|  | ||||
|         let instant = self.instant().unwrap(); | ||||
|         trace!( | ||||
|             "rtc: start wakeup alarm for {} ms (psc: {}, ticks: {}) at {}", | ||||
|             Duration::from_ticks(rtc_ticks as u64 * TICK_HZ * prescaler as u64 / rtc_hz).as_millis(), | ||||
|             prescaler as u32, | ||||
|             rtc_ticks, | ||||
|             self.instant(), | ||||
|             instant, | ||||
|         ); | ||||
|  | ||||
|         assert!(self.stop_time.borrow(cs).replace(Some(self.instant())).is_none()) | ||||
|         assert!(self.stop_time.borrow(cs).replace(Some(instant)).is_none()) | ||||
|     } | ||||
|  | ||||
|     #[cfg(feature = "low-power")] | ||||
| @@ -112,8 +113,9 @@ impl super::Rtc { | ||||
|     pub(crate) fn stop_wakeup_alarm(&self, cs: critical_section::CriticalSection) -> Option<embassy_time::Duration> { | ||||
|         use crate::interrupt::typelevel::Interrupt; | ||||
|  | ||||
|         let instant = self.instant().unwrap(); | ||||
|         if RTC::regs().cr().read().wute() { | ||||
|             trace!("rtc: stop wakeup alarm at {}", self.instant()); | ||||
|             trace!("rtc: stop wakeup alarm at {}", instant); | ||||
|  | ||||
|             self.write(false, |regs| { | ||||
|                 regs.cr().modify(|w| w.set_wutie(false)); | ||||
| @@ -128,10 +130,7 @@ impl super::Rtc { | ||||
|             }); | ||||
|         } | ||||
|  | ||||
|         self.stop_time | ||||
|             .borrow(cs) | ||||
|             .take() | ||||
|             .map(|stop_time| self.instant() - stop_time) | ||||
|         self.stop_time.borrow(cs).take().map(|stop_time| instant - stop_time) | ||||
|     } | ||||
|  | ||||
|     #[cfg(feature = "low-power")] | ||||
|   | ||||
| @@ -1466,7 +1466,7 @@ cfg_if::cfg_if! { | ||||
|             (SDMMC1) => { | ||||
|                 critical_section::with(|_| unsafe { | ||||
|                     let sdmmcsel = crate::pac::RCC.dckcfgr2().read().sdmmc1sel(); | ||||
|                     if sdmmcsel == crate::pac::rcc::vals::Sdmmcsel::SYSCLK { | ||||
|                     if sdmmcsel == crate::pac::rcc::vals::Sdmmcsel::SYS { | ||||
|                         crate::rcc::get_freqs().sys | ||||
|                     } else { | ||||
|                         crate::rcc::get_freqs().pll1_q.expect("PLL48 is required for SDMMC") | ||||
| @@ -1476,7 +1476,7 @@ cfg_if::cfg_if! { | ||||
|             (SDMMC2) => { | ||||
|                 critical_section::with(|_| unsafe { | ||||
|                     let sdmmcsel = crate::pac::RCC.dckcfgr2().read().sdmmc2sel(); | ||||
|                     if sdmmcsel == crate::pac::rcc::vals::Sdmmcsel::SYSCLK { | ||||
|                     if sdmmcsel == crate::pac::rcc::vals::Sdmmcsel::SYS { | ||||
|                         crate::rcc::get_freqs().sys | ||||
|                     } else { | ||||
|                         crate::rcc::get_freqs().pll1_q.expect("PLL48 is required for SDMMC") | ||||
|   | ||||
| @@ -57,18 +57,20 @@ impl<'d, T: ComplementaryCaptureCompare16bitInstance> ComplementaryPwm<'d, T> { | ||||
|         _ch4: Option<PwmPin<'d, T, Ch4>>, | ||||
|         _ch4n: Option<ComplementaryPwmPin<'d, T, Ch4>>, | ||||
|         freq: Hertz, | ||||
|         counting_mode: CountingMode, | ||||
|     ) -> Self { | ||||
|         Self::new_inner(tim, freq) | ||||
|         Self::new_inner(tim, freq, counting_mode) | ||||
|     } | ||||
|  | ||||
|     fn new_inner(tim: impl Peripheral<P = T> + 'd, freq: Hertz) -> Self { | ||||
|     fn new_inner(tim: impl Peripheral<P = T> + 'd, freq: Hertz, counting_mode: CountingMode) -> Self { | ||||
|         into_ref!(tim); | ||||
|  | ||||
|         T::enable_and_reset(); | ||||
|  | ||||
|         let mut this = Self { inner: tim }; | ||||
|  | ||||
|         this.inner.set_frequency(freq); | ||||
|         this.inner.set_counting_mode(counting_mode); | ||||
|         this.set_freq(freq); | ||||
|         this.inner.start(); | ||||
|  | ||||
|         this.inner.enable_outputs(); | ||||
| @@ -95,7 +97,12 @@ impl<'d, T: ComplementaryCaptureCompare16bitInstance> ComplementaryPwm<'d, T> { | ||||
|     } | ||||
|  | ||||
|     pub fn set_freq(&mut self, freq: Hertz) { | ||||
|         self.inner.set_frequency(freq); | ||||
|         let multiplier = if self.inner.get_counting_mode().is_center_aligned() { | ||||
|             2u8 | ||||
|         } else { | ||||
|             1u8 | ||||
|         }; | ||||
|         self.inner.set_frequency(freq * multiplier); | ||||
|     } | ||||
|  | ||||
|     pub fn get_max_duty(&self) -> u16 { | ||||
|   | ||||
| @@ -29,10 +29,17 @@ pub(crate) mod sealed { | ||||
|             Self::regs().cr1().modify(|r| r.set_cen(false)); | ||||
|         } | ||||
|  | ||||
|         /// Reset the counter value to 0 | ||||
|         fn reset(&mut self) { | ||||
|             Self::regs().cnt().write(|r| r.set_cnt(0)); | ||||
|         } | ||||
|  | ||||
|         /// Set the frequency of how many times per second the timer counts up to the max value or down to 0. | ||||
|         /// | ||||
|         /// This means that in the default edge-aligned mode, | ||||
|         /// the timer counter will wrap around at the same frequency as is being set. | ||||
|         /// In center-aligned mode (which not all timers support), the wrap-around frequency is effectively halved | ||||
|         /// because it needs to count up and down. | ||||
|         fn set_frequency(&mut self, frequency: Hertz) { | ||||
|             let f = frequency.0; | ||||
|             let timer_f = Self::frequency().0; | ||||
| @@ -85,8 +92,21 @@ pub(crate) mod sealed { | ||||
|     pub trait GeneralPurpose16bitInstance: Basic16bitInstance { | ||||
|         fn regs_gp16() -> crate::pac::timer::TimGp16; | ||||
|  | ||||
|         fn set_count_direction(&mut self, direction: vals::Dir) { | ||||
|             Self::regs_gp16().cr1().modify(|r| r.set_dir(direction)); | ||||
|         fn set_counting_mode(&mut self, mode: CountingMode) { | ||||
|             let (cms, dir) = mode.into(); | ||||
|  | ||||
|             let timer_enabled = Self::regs().cr1().read().cen(); | ||||
|             // Changing from edge aligned to center aligned (and vice versa) is not allowed while the timer is running. | ||||
|             // Changing direction is discouraged while the timer is running. | ||||
|             assert!(!timer_enabled); | ||||
|  | ||||
|             Self::regs_gp16().cr1().modify(|r| r.set_dir(dir)); | ||||
|             Self::regs_gp16().cr1().modify(|r| r.set_cms(cms)) | ||||
|         } | ||||
|  | ||||
|         fn get_counting_mode(&self) -> CountingMode { | ||||
|             let cr1 = Self::regs_gp16().cr1().read(); | ||||
|             (cr1.cms(), cr1.dir()).into() | ||||
|         } | ||||
|  | ||||
|         fn set_clock_division(&mut self, ckd: vals::Ckd) { | ||||
| @@ -293,6 +313,73 @@ impl From<InputTISelection> for stm32_metapac::timer::vals::CcmrInputCcs { | ||||
|     } | ||||
| } | ||||
|  | ||||
| #[repr(u8)] | ||||
| #[derive(Debug, Clone, Copy, PartialEq, Eq, Default)] | ||||
| pub enum CountingMode { | ||||
|     #[default] | ||||
|     /// The timer counts up to the reload value and then resets back to 0. | ||||
|     EdgeAlignedUp, | ||||
|     /// The timer counts down to 0 and then resets back to the reload value. | ||||
|     EdgeAlignedDown, | ||||
|     /// The timer counts up to the reload value and then counts back to 0. | ||||
|     /// | ||||
|     /// The output compare interrupt flags of channels configured in output are | ||||
|     /// set when the counter is counting down. | ||||
|     CenterAlignedDownInterrupts, | ||||
|     /// The timer counts up to the reload value and then counts back to 0. | ||||
|     /// | ||||
|     /// The output compare interrupt flags of channels configured in output are | ||||
|     /// set when the counter is counting up. | ||||
|     CenterAlignedUpInterrupts, | ||||
|     /// The timer counts up to the reload value and then counts back to 0. | ||||
|     /// | ||||
|     /// The output compare interrupt flags of channels configured in output are | ||||
|     /// set when the counter is counting both up or down. | ||||
|     CenterAlignedBothInterrupts, | ||||
| } | ||||
|  | ||||
| impl CountingMode { | ||||
|     pub fn is_edge_aligned(&self) -> bool { | ||||
|         match self { | ||||
|             CountingMode::EdgeAlignedUp | CountingMode::EdgeAlignedDown => true, | ||||
|             _ => false, | ||||
|         } | ||||
|     } | ||||
|  | ||||
|     pub fn is_center_aligned(&self) -> bool { | ||||
|         match self { | ||||
|             CountingMode::CenterAlignedDownInterrupts | ||||
|             | CountingMode::CenterAlignedUpInterrupts | ||||
|             | CountingMode::CenterAlignedBothInterrupts => true, | ||||
|             _ => false, | ||||
|         } | ||||
|     } | ||||
| } | ||||
|  | ||||
| impl From<CountingMode> for (vals::Cms, vals::Dir) { | ||||
|     fn from(value: CountingMode) -> Self { | ||||
|         match value { | ||||
|             CountingMode::EdgeAlignedUp => (vals::Cms::EDGEALIGNED, vals::Dir::UP), | ||||
|             CountingMode::EdgeAlignedDown => (vals::Cms::EDGEALIGNED, vals::Dir::DOWN), | ||||
|             CountingMode::CenterAlignedDownInterrupts => (vals::Cms::CENTERALIGNED1, vals::Dir::UP), | ||||
|             CountingMode::CenterAlignedUpInterrupts => (vals::Cms::CENTERALIGNED2, vals::Dir::UP), | ||||
|             CountingMode::CenterAlignedBothInterrupts => (vals::Cms::CENTERALIGNED3, vals::Dir::UP), | ||||
|         } | ||||
|     } | ||||
| } | ||||
|  | ||||
| impl From<(vals::Cms, vals::Dir)> for CountingMode { | ||||
|     fn from(value: (vals::Cms, vals::Dir)) -> Self { | ||||
|         match value { | ||||
|             (vals::Cms::EDGEALIGNED, vals::Dir::UP) => CountingMode::EdgeAlignedUp, | ||||
|             (vals::Cms::EDGEALIGNED, vals::Dir::DOWN) => CountingMode::EdgeAlignedDown, | ||||
|             (vals::Cms::CENTERALIGNED1, _) => CountingMode::CenterAlignedDownInterrupts, | ||||
|             (vals::Cms::CENTERALIGNED2, _) => CountingMode::CenterAlignedUpInterrupts, | ||||
|             (vals::Cms::CENTERALIGNED3, _) => CountingMode::CenterAlignedBothInterrupts, | ||||
|         } | ||||
|     } | ||||
| } | ||||
|  | ||||
| #[derive(Clone, Copy)] | ||||
| pub enum OutputCompareMode { | ||||
|     Frozen, | ||||
| @@ -471,9 +558,5 @@ foreach_interrupt! { | ||||
|                 crate::pac::$inst | ||||
|             } | ||||
|         } | ||||
|  | ||||
|  | ||||
|  | ||||
|  | ||||
|     }; | ||||
| } | ||||
|   | ||||
| @@ -56,18 +56,20 @@ impl<'d, T: CaptureCompare16bitInstance> SimplePwm<'d, T> { | ||||
|         _ch3: Option<PwmPin<'d, T, Ch3>>, | ||||
|         _ch4: Option<PwmPin<'d, T, Ch4>>, | ||||
|         freq: Hertz, | ||||
|         counting_mode: CountingMode, | ||||
|     ) -> Self { | ||||
|         Self::new_inner(tim, freq) | ||||
|         Self::new_inner(tim, freq, counting_mode) | ||||
|     } | ||||
|  | ||||
|     fn new_inner(tim: impl Peripheral<P = T> + 'd, freq: Hertz) -> Self { | ||||
|     fn new_inner(tim: impl Peripheral<P = T> + 'd, freq: Hertz, counting_mode: CountingMode) -> Self { | ||||
|         into_ref!(tim); | ||||
|  | ||||
|         T::enable_and_reset(); | ||||
|  | ||||
|         let mut this = Self { inner: tim }; | ||||
|  | ||||
|         this.inner.set_frequency(freq); | ||||
|         this.inner.set_counting_mode(counting_mode); | ||||
|         this.set_freq(freq); | ||||
|         this.inner.start(); | ||||
|  | ||||
|         this.inner.enable_outputs(); | ||||
| @@ -92,7 +94,12 @@ impl<'d, T: CaptureCompare16bitInstance> SimplePwm<'d, T> { | ||||
|     } | ||||
|  | ||||
|     pub fn set_freq(&mut self, freq: Hertz) { | ||||
|         self.inner.set_frequency(freq); | ||||
|         let multiplier = if self.inner.get_counting_mode().is_center_aligned() { | ||||
|             2u8 | ||||
|         } else { | ||||
|             1u8 | ||||
|         }; | ||||
|         self.inner.set_frequency(freq * multiplier); | ||||
|     } | ||||
|  | ||||
|     pub fn get_max_duty(&self) -> u16 { | ||||
|   | ||||
| @@ -116,28 +116,28 @@ pub struct BufferedUartRx<'d, T: BasicInstance> { | ||||
|  | ||||
| impl<'d, T: BasicInstance> SetConfig for BufferedUart<'d, T> { | ||||
|     type Config = Config; | ||||
|     type ConfigError = (); | ||||
|     type ConfigError = ConfigError; | ||||
|  | ||||
|     fn set_config(&mut self, config: &Self::Config) -> Result<(), ()> { | ||||
|         self.set_config(config).map_err(|_| ()) | ||||
|     fn set_config(&mut self, config: &Self::Config) -> Result<(), Self::ConfigError> { | ||||
|         self.set_config(config) | ||||
|     } | ||||
| } | ||||
|  | ||||
| impl<'d, T: BasicInstance> SetConfig for BufferedUartRx<'d, T> { | ||||
|     type Config = Config; | ||||
|     type ConfigError = (); | ||||
|     type ConfigError = ConfigError; | ||||
|  | ||||
|     fn set_config(&mut self, config: &Self::Config) -> Result<(), ()> { | ||||
|         self.set_config(config).map_err(|_| ()) | ||||
|     fn set_config(&mut self, config: &Self::Config) -> Result<(), Self::ConfigError> { | ||||
|         self.set_config(config) | ||||
|     } | ||||
| } | ||||
|  | ||||
| impl<'d, T: BasicInstance> SetConfig for BufferedUartTx<'d, T> { | ||||
|     type Config = Config; | ||||
|     type ConfigError = (); | ||||
|     type ConfigError = ConfigError; | ||||
|  | ||||
|     fn set_config(&mut self, config: &Self::Config) -> Result<(), ()> { | ||||
|         self.set_config(config).map_err(|_| ()) | ||||
|     fn set_config(&mut self, config: &Self::Config) -> Result<(), Self::ConfigError> { | ||||
|         self.set_config(config) | ||||
|     } | ||||
| } | ||||
|  | ||||
| @@ -233,9 +233,6 @@ impl<'d, T: BasicInstance> BufferedUart<'d, T> { | ||||
|         configure(r, &config, T::frequency(), T::KIND, true, true)?; | ||||
|  | ||||
|         r.cr1().modify(|w| { | ||||
|             #[cfg(lpuart_v2)] | ||||
|             w.set_fifoen(true); | ||||
|  | ||||
|             w.set_rxneie(true); | ||||
|             w.set_idleie(true); | ||||
|         }); | ||||
| @@ -254,7 +251,14 @@ impl<'d, T: BasicInstance> BufferedUart<'d, T> { | ||||
|     } | ||||
|  | ||||
|     pub fn set_config(&mut self, config: &Config) -> Result<(), ConfigError> { | ||||
|         reconfigure::<T>(config) | ||||
|         reconfigure::<T>(config)?; | ||||
|  | ||||
|         T::regs().cr1().modify(|w| { | ||||
|             w.set_rxneie(true); | ||||
|             w.set_idleie(true); | ||||
|         }); | ||||
|  | ||||
|         Ok(()) | ||||
|     } | ||||
| } | ||||
|  | ||||
| @@ -334,7 +338,14 @@ impl<'d, T: BasicInstance> BufferedUartRx<'d, T> { | ||||
|     } | ||||
|  | ||||
|     pub fn set_config(&mut self, config: &Config) -> Result<(), ConfigError> { | ||||
|         reconfigure::<T>(config) | ||||
|         reconfigure::<T>(config)?; | ||||
|  | ||||
|         T::regs().cr1().modify(|w| { | ||||
|             w.set_rxneie(true); | ||||
|             w.set_idleie(true); | ||||
|         }); | ||||
|  | ||||
|         Ok(()) | ||||
|     } | ||||
| } | ||||
|  | ||||
| @@ -408,7 +419,14 @@ impl<'d, T: BasicInstance> BufferedUartTx<'d, T> { | ||||
|     } | ||||
|  | ||||
|     pub fn set_config(&mut self, config: &Config) -> Result<(), ConfigError> { | ||||
|         reconfigure::<T>(config) | ||||
|         reconfigure::<T>(config)?; | ||||
|  | ||||
|         T::regs().cr1().modify(|w| { | ||||
|             w.set_rxneie(true); | ||||
|             w.set_idleie(true); | ||||
|         }); | ||||
|  | ||||
|         Ok(()) | ||||
|     } | ||||
| } | ||||
|  | ||||
|   | ||||
| @@ -108,6 +108,7 @@ pub enum StopBits { | ||||
| pub enum ConfigError { | ||||
|     BaudrateTooLow, | ||||
|     BaudrateTooHigh, | ||||
|     RxOrTxNotEnabled, | ||||
| } | ||||
|  | ||||
| #[non_exhaustive] | ||||
| @@ -181,11 +182,11 @@ pub struct Uart<'d, T: BasicInstance, TxDma = NoDma, RxDma = NoDma> { | ||||
|  | ||||
| impl<'d, T: BasicInstance, TxDma, RxDma> SetConfig for Uart<'d, T, TxDma, RxDma> { | ||||
|     type Config = Config; | ||||
|     type ConfigError = (); | ||||
|     type ConfigError = ConfigError; | ||||
|  | ||||
|     fn set_config(&mut self, config: &Self::Config) -> Result<(), ()> { | ||||
|         self.tx.set_config(config).map_err(|_| ())?; | ||||
|         self.rx.set_config(config).map_err(|_| ()) | ||||
|     fn set_config(&mut self, config: &Self::Config) -> Result<(), Self::ConfigError> { | ||||
|         self.tx.set_config(config)?; | ||||
|         self.rx.set_config(config) | ||||
|     } | ||||
| } | ||||
|  | ||||
| @@ -196,10 +197,10 @@ pub struct UartTx<'d, T: BasicInstance, TxDma = NoDma> { | ||||
|  | ||||
| impl<'d, T: BasicInstance, TxDma> SetConfig for UartTx<'d, T, TxDma> { | ||||
|     type Config = Config; | ||||
|     type ConfigError = (); | ||||
|     type ConfigError = ConfigError; | ||||
|  | ||||
|     fn set_config(&mut self, config: &Self::Config) -> Result<(), ()> { | ||||
|         self.set_config(config).map_err(|_| ()) | ||||
|     fn set_config(&mut self, config: &Self::Config) -> Result<(), Self::ConfigError> { | ||||
|         self.set_config(config) | ||||
|     } | ||||
| } | ||||
|  | ||||
| @@ -213,10 +214,10 @@ pub struct UartRx<'d, T: BasicInstance, RxDma = NoDma> { | ||||
|  | ||||
| impl<'d, T: BasicInstance, RxDma> SetConfig for UartRx<'d, T, RxDma> { | ||||
|     type Config = Config; | ||||
|     type ConfigError = (); | ||||
|     type ConfigError = ConfigError; | ||||
|  | ||||
|     fn set_config(&mut self, config: &Self::Config) -> Result<(), ()> { | ||||
|         self.set_config(config).map_err(|_| ()) | ||||
|     fn set_config(&mut self, config: &Self::Config) -> Result<(), Self::ConfigError> { | ||||
|         self.set_config(config) | ||||
|     } | ||||
| } | ||||
|  | ||||
| @@ -866,7 +867,7 @@ fn configure( | ||||
|     enable_tx: bool, | ||||
| ) -> Result<(), ConfigError> { | ||||
|     if !enable_rx && !enable_tx { | ||||
|         panic!("USART: At least one of RX or TX should be enabled"); | ||||
|         return Err(ConfigError::RxOrTxNotEnabled); | ||||
|     } | ||||
|  | ||||
|     #[cfg(not(usart_v4))] | ||||
| @@ -909,6 +910,11 @@ fn configure( | ||||
|         brr + rounding | ||||
|     } | ||||
|  | ||||
|     // UART must be disabled during configuration. | ||||
|     r.cr1().modify(|w| { | ||||
|         w.set_ue(false); | ||||
|     }); | ||||
|  | ||||
|     #[cfg(not(usart_v1))] | ||||
|     let mut over8 = false; | ||||
|     let mut found_brr = None; | ||||
| @@ -968,6 +974,12 @@ fn configure( | ||||
|         #[cfg(any(usart_v3, usart_v4))] | ||||
|         w.set_swap(config.swap_rx_tx); | ||||
|     }); | ||||
|  | ||||
|     #[cfg(not(usart_v1))] | ||||
|     r.cr3().modify(|w| { | ||||
|         w.set_onebit(config.assume_noise_free); | ||||
|     }); | ||||
|  | ||||
|     r.cr1().write(|w| { | ||||
|         // enable uart | ||||
|         w.set_ue(true); | ||||
| @@ -976,6 +988,7 @@ fn configure( | ||||
|         // enable receiver | ||||
|         w.set_re(enable_rx); | ||||
|         // configure word size | ||||
|         // if using odd or even parity it must be configured to 9bits | ||||
|         w.set_m0(if config.parity != Parity::ParityNone { | ||||
|             vals::M0::BIT9 | ||||
|         } else { | ||||
| @@ -994,11 +1007,6 @@ fn configure( | ||||
|         w.set_fifoen(true); | ||||
|     }); | ||||
|  | ||||
|     #[cfg(not(usart_v1))] | ||||
|     r.cr3().modify(|w| { | ||||
|         w.set_onebit(config.assume_noise_free); | ||||
|     }); | ||||
|  | ||||
|     Ok(()) | ||||
| } | ||||
|  | ||||
|   | ||||
| @@ -18,10 +18,10 @@ pub struct RingBufferedUartRx<'d, T: BasicInstance, RxDma: super::RxDma<T>> { | ||||
|  | ||||
| impl<'d, T: BasicInstance, RxDma: super::RxDma<T>> SetConfig for RingBufferedUartRx<'d, T, RxDma> { | ||||
|     type Config = Config; | ||||
|     type ConfigError = (); | ||||
|     type ConfigError = ConfigError; | ||||
|  | ||||
|     fn set_config(&mut self, config: &Self::Config) -> Result<(), ()> { | ||||
|         self.set_config(config).map_err(|_| ()) | ||||
|     fn set_config(&mut self, config: &Self::Config) -> Result<(), Self::ConfigError> { | ||||
|         self.set_config(config) | ||||
|     } | ||||
| } | ||||
|  | ||||
|   | ||||
| @@ -5,6 +5,10 @@ All notable changes to this project will be documented in this file. | ||||
| The format is based on [Keep a Changelog](https://keepachangelog.com/en/1.0.0/), | ||||
| and this project adheres to [Semantic Versioning](https://semver.org/spec/v2.0.0.html). | ||||
|  | ||||
| ## 0.1.6 - ??? | ||||
|  | ||||
| - Added tick rates in multiples of 10 kHz | ||||
|  | ||||
| ## 0.1.5 - 2023-10-16 | ||||
|  | ||||
| - Added `links` key to Cargo.toml, to prevent multiple copies of this crate in the same binary. | ||||
|   | ||||
| @@ -126,6 +126,25 @@ tick-hz-65_536_000 = [] | ||||
| tick-hz-131_072_000 = [] | ||||
| tick-hz-262_144_000 = [] | ||||
| tick-hz-524_288_000 = [] | ||||
| tick-hz-20_000 = [] | ||||
| tick-hz-40_000 = [] | ||||
| tick-hz-80_000 = [] | ||||
| tick-hz-160_000 = [] | ||||
| tick-hz-320_000 = [] | ||||
| tick-hz-640_000 = [] | ||||
| tick-hz-1_280_000 = [] | ||||
| tick-hz-2_560_000 = [] | ||||
| tick-hz-5_120_000 = [] | ||||
| tick-hz-10_240_000 = [] | ||||
| tick-hz-20_480_000 = [] | ||||
| tick-hz-40_960_000 = [] | ||||
| tick-hz-81_920_000 = [] | ||||
| tick-hz-163_840_000 = [] | ||||
| tick-hz-327_680_000 = [] | ||||
| tick-hz-655_360_000 = [] | ||||
| tick-hz-1_310_720_000 = [] | ||||
| tick-hz-2_621_440_000 = [] | ||||
| tick-hz-5_242_880_000 = [] | ||||
| tick-hz-2_000_000 = [] | ||||
| tick-hz-3_000_000 = [] | ||||
| tick-hz-4_000_000 = [] | ||||
|   | ||||
| @@ -13,6 +13,8 @@ for i in range(1, 25): | ||||
|     ticks.append(2**i) | ||||
| for i in range(1, 20): | ||||
|     ticks.append(2**i * 1000) | ||||
| for i in range(1, 20): | ||||
|     ticks.append(2**i * 10000) | ||||
| for i in range(1, 10): | ||||
|     ticks.append(2**i * 1000000) | ||||
|     ticks.append(2**i * 9 // 8 * 1000000) | ||||
|   | ||||
| @@ -106,6 +106,44 @@ pub const TICK_HZ: u64 = 131_072_000; | ||||
| pub const TICK_HZ: u64 = 262_144_000; | ||||
| #[cfg(feature = "tick-hz-524_288_000")] | ||||
| pub const TICK_HZ: u64 = 524_288_000; | ||||
| #[cfg(feature = "tick-hz-20_000")] | ||||
| pub const TICK_HZ: u64 = 20_000; | ||||
| #[cfg(feature = "tick-hz-40_000")] | ||||
| pub const TICK_HZ: u64 = 40_000; | ||||
| #[cfg(feature = "tick-hz-80_000")] | ||||
| pub const TICK_HZ: u64 = 80_000; | ||||
| #[cfg(feature = "tick-hz-160_000")] | ||||
| pub const TICK_HZ: u64 = 160_000; | ||||
| #[cfg(feature = "tick-hz-320_000")] | ||||
| pub const TICK_HZ: u64 = 320_000; | ||||
| #[cfg(feature = "tick-hz-640_000")] | ||||
| pub const TICK_HZ: u64 = 640_000; | ||||
| #[cfg(feature = "tick-hz-1_280_000")] | ||||
| pub const TICK_HZ: u64 = 1_280_000; | ||||
| #[cfg(feature = "tick-hz-2_560_000")] | ||||
| pub const TICK_HZ: u64 = 2_560_000; | ||||
| #[cfg(feature = "tick-hz-5_120_000")] | ||||
| pub const TICK_HZ: u64 = 5_120_000; | ||||
| #[cfg(feature = "tick-hz-10_240_000")] | ||||
| pub const TICK_HZ: u64 = 10_240_000; | ||||
| #[cfg(feature = "tick-hz-20_480_000")] | ||||
| pub const TICK_HZ: u64 = 20_480_000; | ||||
| #[cfg(feature = "tick-hz-40_960_000")] | ||||
| pub const TICK_HZ: u64 = 40_960_000; | ||||
| #[cfg(feature = "tick-hz-81_920_000")] | ||||
| pub const TICK_HZ: u64 = 81_920_000; | ||||
| #[cfg(feature = "tick-hz-163_840_000")] | ||||
| pub const TICK_HZ: u64 = 163_840_000; | ||||
| #[cfg(feature = "tick-hz-327_680_000")] | ||||
| pub const TICK_HZ: u64 = 327_680_000; | ||||
| #[cfg(feature = "tick-hz-655_360_000")] | ||||
| pub const TICK_HZ: u64 = 655_360_000; | ||||
| #[cfg(feature = "tick-hz-1_310_720_000")] | ||||
| pub const TICK_HZ: u64 = 1_310_720_000; | ||||
| #[cfg(feature = "tick-hz-2_621_440_000")] | ||||
| pub const TICK_HZ: u64 = 2_621_440_000; | ||||
| #[cfg(feature = "tick-hz-5_242_880_000")] | ||||
| pub const TICK_HZ: u64 = 5_242_880_000; | ||||
| #[cfg(feature = "tick-hz-2_000_000")] | ||||
| pub const TICK_HZ: u64 = 2_000_000; | ||||
| #[cfg(feature = "tick-hz-3_000_000")] | ||||
| @@ -334,6 +372,25 @@ pub const TICK_HZ: u64 = 980_000_000; | ||||
|     feature = "tick-hz-131_072_000", | ||||
|     feature = "tick-hz-262_144_000", | ||||
|     feature = "tick-hz-524_288_000", | ||||
|     feature = "tick-hz-20_000", | ||||
|     feature = "tick-hz-40_000", | ||||
|     feature = "tick-hz-80_000", | ||||
|     feature = "tick-hz-160_000", | ||||
|     feature = "tick-hz-320_000", | ||||
|     feature = "tick-hz-640_000", | ||||
|     feature = "tick-hz-1_280_000", | ||||
|     feature = "tick-hz-2_560_000", | ||||
|     feature = "tick-hz-5_120_000", | ||||
|     feature = "tick-hz-10_240_000", | ||||
|     feature = "tick-hz-20_480_000", | ||||
|     feature = "tick-hz-40_960_000", | ||||
|     feature = "tick-hz-81_920_000", | ||||
|     feature = "tick-hz-163_840_000", | ||||
|     feature = "tick-hz-327_680_000", | ||||
|     feature = "tick-hz-655_360_000", | ||||
|     feature = "tick-hz-1_310_720_000", | ||||
|     feature = "tick-hz-2_621_440_000", | ||||
|     feature = "tick-hz-5_242_880_000", | ||||
|     feature = "tick-hz-2_000_000", | ||||
|     feature = "tick-hz-3_000_000", | ||||
|     feature = "tick-hz-4_000_000", | ||||
|   | ||||
| @@ -17,7 +17,7 @@ async fn main(_spawner: Spawner) { | ||||
|     info!("Hello World!"); | ||||
|  | ||||
|     let ch1 = PwmPin::new_ch1(p.PE9, OutputType::PushPull); | ||||
|     let mut pwm = SimplePwm::new(p.TIM1, Some(ch1), None, None, None, khz(10)); | ||||
|     let mut pwm = SimplePwm::new(p.TIM1, Some(ch1), None, None, None, khz(10), Default::default()); | ||||
|     let max = pwm.get_max_duty(); | ||||
|     pwm.enable(Channel::Ch1); | ||||
|  | ||||
|   | ||||
| @@ -30,6 +30,7 @@ async fn main(_spawner: Spawner) { | ||||
|         None, | ||||
|         None, | ||||
|         khz(10), | ||||
|         Default::default(), | ||||
|     ); | ||||
|  | ||||
|     let max = pwm.get_max_duty(); | ||||
|   | ||||
| @@ -15,7 +15,7 @@ async fn main(_spawner: Spawner) { | ||||
|     let mut config = Config::default(); | ||||
|  | ||||
|     config.rcc.pll = Some(Pll { | ||||
|         source: PllSrc::HSI16, | ||||
|         source: PllSrc::HSI, | ||||
|         prediv_m: PllM::DIV4, | ||||
|         mul_n: PllN::MUL85, | ||||
|         div_p: None, | ||||
|   | ||||
| @@ -14,7 +14,7 @@ async fn main(_spawner: Spawner) { | ||||
|     let mut config = Config::default(); | ||||
|  | ||||
|     config.rcc.pll = Some(Pll { | ||||
|         source: PllSrc::HSI16, | ||||
|         source: PllSrc::HSI, | ||||
|         prediv_m: PllM::DIV4, | ||||
|         mul_n: PllN::MUL85, | ||||
|         div_p: None, | ||||
|   | ||||
| @@ -17,7 +17,7 @@ async fn main(_spawner: Spawner) { | ||||
|     info!("Hello World!"); | ||||
|  | ||||
|     let ch1 = PwmPin::new_ch1(p.PC0, OutputType::PushPull); | ||||
|     let mut pwm = SimplePwm::new(p.TIM1, Some(ch1), None, None, None, khz(10)); | ||||
|     let mut pwm = SimplePwm::new(p.TIM1, Some(ch1), None, None, None, khz(10), Default::default()); | ||||
|     let max = pwm.get_max_duty(); | ||||
|     pwm.enable(Channel::Ch1); | ||||
|  | ||||
|   | ||||
| @@ -43,7 +43,7 @@ async fn main(spawner: Spawner) -> ! { | ||||
|         mode: HseMode::BypassDigital, | ||||
|     }); | ||||
|     config.rcc.pll1 = Some(Pll { | ||||
|         source: PllSource::Hse, | ||||
|         source: PllSource::HSE, | ||||
|         prediv: PllPreDiv::DIV2, | ||||
|         mul: PllMul::MUL125, | ||||
|         divp: Some(PllDiv::DIV2), | ||||
| @@ -54,7 +54,7 @@ async fn main(spawner: Spawner) -> ! { | ||||
|     config.rcc.apb1_pre = APBPrescaler::DIV1; | ||||
|     config.rcc.apb2_pre = APBPrescaler::DIV1; | ||||
|     config.rcc.apb3_pre = APBPrescaler::DIV1; | ||||
|     config.rcc.sys = Sysclk::Pll1P; | ||||
|     config.rcc.sys = Sysclk::PLL1_P; | ||||
|     config.rcc.voltage_scale = VoltageScale::Scale0; | ||||
|     let p = embassy_stm32::init(config); | ||||
|     info!("Hello World!"); | ||||
|   | ||||
| @@ -30,7 +30,7 @@ async fn main(_spawner: Spawner) { | ||||
|         mode: HseMode::BypassDigital, | ||||
|     }); | ||||
|     config.rcc.pll1 = Some(Pll { | ||||
|         source: PllSource::Hse, | ||||
|         source: PllSource::HSE, | ||||
|         prediv: PllPreDiv::DIV2, | ||||
|         mul: PllMul::MUL125, | ||||
|         divp: Some(PllDiv::DIV2), // 250mhz | ||||
| @@ -41,7 +41,7 @@ async fn main(_spawner: Spawner) { | ||||
|     config.rcc.apb1_pre = APBPrescaler::DIV4; | ||||
|     config.rcc.apb2_pre = APBPrescaler::DIV2; | ||||
|     config.rcc.apb3_pre = APBPrescaler::DIV4; | ||||
|     config.rcc.sys = Sysclk::Pll1P; | ||||
|     config.rcc.sys = Sysclk::PLL1_P; | ||||
|     config.rcc.voltage_scale = VoltageScale::Scale0; | ||||
|     let p = embassy_stm32::init(config); | ||||
|  | ||||
|   | ||||
| @@ -14,10 +14,10 @@ async fn main(_spawner: Spawner) { | ||||
|     let mut config = Config::default(); | ||||
|     { | ||||
|         use embassy_stm32::rcc::*; | ||||
|         config.rcc.hsi = Some(Hsi::Mhz64); | ||||
|         config.rcc.hsi = Some(HSIPrescaler::DIV1); | ||||
|         config.rcc.csi = true; | ||||
|         config.rcc.pll_src = PllSource::Hsi; | ||||
|         config.rcc.pll1 = Some(Pll { | ||||
|             source: PllSource::HSI, | ||||
|             prediv: PllPreDiv::DIV4, | ||||
|             mul: PllMul::MUL50, | ||||
|             divp: Some(PllDiv::DIV2), | ||||
| @@ -25,13 +25,14 @@ async fn main(_spawner: Spawner) { | ||||
|             divr: None, | ||||
|         }); | ||||
|         config.rcc.pll2 = Some(Pll { | ||||
|             source: PllSource::HSI, | ||||
|             prediv: PllPreDiv::DIV4, | ||||
|             mul: PllMul::MUL50, | ||||
|             divp: Some(PllDiv::DIV8), // 100mhz | ||||
|             divq: None, | ||||
|             divr: None, | ||||
|         }); | ||||
|         config.rcc.sys = Sysclk::Pll1P; // 400 Mhz | ||||
|         config.rcc.sys = Sysclk::PLL1_P; // 400 Mhz | ||||
|         config.rcc.ahb_pre = AHBPrescaler::DIV2; // 200 Mhz | ||||
|         config.rcc.apb1_pre = APBPrescaler::DIV2; // 100 Mhz | ||||
|         config.rcc.apb2_pre = APBPrescaler::DIV2; // 100 Mhz | ||||
|   | ||||
| @@ -28,17 +28,17 @@ async fn main(_spawner: Spawner) { | ||||
|     let mut config = Config::default(); | ||||
|     { | ||||
|         use embassy_stm32::rcc::*; | ||||
|         config.rcc.hsi = Some(Hsi::Mhz64); | ||||
|         config.rcc.hsi = Some(HSIPrescaler::DIV1); | ||||
|         config.rcc.csi = true; | ||||
|         config.rcc.pll_src = PllSource::Hsi; | ||||
|         config.rcc.pll1 = Some(Pll { | ||||
|             source: PllSource::HSI, | ||||
|             prediv: PllPreDiv::DIV4, | ||||
|             mul: PllMul::MUL50, | ||||
|             divp: Some(PllDiv::DIV2), | ||||
|             divq: Some(PllDiv::DIV8), // 100mhz | ||||
|             divr: None, | ||||
|         }); | ||||
|         config.rcc.sys = Sysclk::Pll1P; // 400 Mhz | ||||
|         config.rcc.sys = Sysclk::PLL1_P; // 400 Mhz | ||||
|         config.rcc.ahb_pre = AHBPrescaler::DIV2; // 200 Mhz | ||||
|         config.rcc.apb1_pre = APBPrescaler::DIV2; // 100 Mhz | ||||
|         config.rcc.apb2_pre = APBPrescaler::DIV2; // 100 Mhz | ||||
|   | ||||
| @@ -16,10 +16,10 @@ fn main() -> ! { | ||||
|     let mut config = Config::default(); | ||||
|     { | ||||
|         use embassy_stm32::rcc::*; | ||||
|         config.rcc.hsi = Some(Hsi::Mhz64); | ||||
|         config.rcc.hsi = Some(HSIPrescaler::DIV1); | ||||
|         config.rcc.csi = true; | ||||
|         config.rcc.pll_src = PllSource::Hsi; | ||||
|         config.rcc.pll1 = Some(Pll { | ||||
|             source: PllSource::HSI, | ||||
|             prediv: PllPreDiv::DIV4, | ||||
|             mul: PllMul::MUL50, | ||||
|             divp: Some(PllDiv::DIV2), | ||||
| @@ -27,13 +27,14 @@ fn main() -> ! { | ||||
|             divr: None, | ||||
|         }); | ||||
|         config.rcc.pll2 = Some(Pll { | ||||
|             source: PllSource::HSI, | ||||
|             prediv: PllPreDiv::DIV4, | ||||
|             mul: PllMul::MUL50, | ||||
|             divp: Some(PllDiv::DIV8), // 100mhz | ||||
|             divq: None, | ||||
|             divr: None, | ||||
|         }); | ||||
|         config.rcc.sys = Sysclk::Pll1P; // 400 Mhz | ||||
|         config.rcc.sys = Sysclk::PLL1_P; // 400 Mhz | ||||
|         config.rcc.ahb_pre = AHBPrescaler::DIV2; // 200 Mhz | ||||
|         config.rcc.apb1_pre = APBPrescaler::DIV2; // 100 Mhz | ||||
|         config.rcc.apb2_pre = APBPrescaler::DIV2; // 100 Mhz | ||||
|   | ||||
| @@ -24,10 +24,10 @@ async fn main(spawner: Spawner) { | ||||
|     let mut config = embassy_stm32::Config::default(); | ||||
|     { | ||||
|         use embassy_stm32::rcc::*; | ||||
|         config.rcc.hsi = Some(Hsi::Mhz64); | ||||
|         config.rcc.hsi = Some(HSIPrescaler::DIV1); | ||||
|         config.rcc.csi = true; | ||||
|         config.rcc.pll_src = PllSource::Hsi; | ||||
|         config.rcc.pll1 = Some(Pll { | ||||
|             source: PllSource::HSI, | ||||
|             prediv: PllPreDiv::DIV4, | ||||
|             mul: PllMul::MUL50, | ||||
|             divp: Some(PllDiv::DIV2), | ||||
| @@ -35,13 +35,14 @@ async fn main(spawner: Spawner) { | ||||
|             divr: None, | ||||
|         }); | ||||
|         config.rcc.pll2 = Some(Pll { | ||||
|             source: PllSource::HSI, | ||||
|             prediv: PllPreDiv::DIV4, | ||||
|             mul: PllMul::MUL50, | ||||
|             divp: Some(PllDiv::DIV8), // 100mhz | ||||
|             divq: None, | ||||
|             divr: None, | ||||
|         }); | ||||
|         config.rcc.sys = Sysclk::Pll1P; // 400 Mhz | ||||
|         config.rcc.sys = Sysclk::PLL1_P; // 400 Mhz | ||||
|         config.rcc.ahb_pre = AHBPrescaler::DIV2; // 200 Mhz | ||||
|         config.rcc.apb1_pre = APBPrescaler::DIV2; // 100 Mhz | ||||
|         config.rcc.apb2_pre = APBPrescaler::DIV2; // 100 Mhz | ||||
|   | ||||
| @@ -34,18 +34,18 @@ async fn main(spawner: Spawner) -> ! { | ||||
|     let mut config = Config::default(); | ||||
|     { | ||||
|         use embassy_stm32::rcc::*; | ||||
|         config.rcc.hsi = Some(Hsi::Mhz64); | ||||
|         config.rcc.hsi = Some(HSIPrescaler::DIV1); | ||||
|         config.rcc.csi = true; | ||||
|         config.rcc.hsi48 = true; // needed for RNG | ||||
|         config.rcc.pll_src = PllSource::Hsi; | ||||
|         config.rcc.pll1 = Some(Pll { | ||||
|             source: PllSource::HSI, | ||||
|             prediv: PllPreDiv::DIV4, | ||||
|             mul: PllMul::MUL50, | ||||
|             divp: Some(PllDiv::DIV2), | ||||
|             divq: None, | ||||
|             divr: None, | ||||
|         }); | ||||
|         config.rcc.sys = Sysclk::Pll1P; // 400 Mhz | ||||
|         config.rcc.sys = Sysclk::PLL1_P; // 400 Mhz | ||||
|         config.rcc.ahb_pre = AHBPrescaler::DIV2; // 200 Mhz | ||||
|         config.rcc.apb1_pre = APBPrescaler::DIV2; // 100 Mhz | ||||
|         config.rcc.apb2_pre = APBPrescaler::DIV2; // 100 Mhz | ||||
|   | ||||
| @@ -35,18 +35,18 @@ async fn main(spawner: Spawner) -> ! { | ||||
|     let mut config = Config::default(); | ||||
|     { | ||||
|         use embassy_stm32::rcc::*; | ||||
|         config.rcc.hsi = Some(Hsi::Mhz64); | ||||
|         config.rcc.hsi = Some(HSIPrescaler::DIV1); | ||||
|         config.rcc.csi = true; | ||||
|         config.rcc.hsi48 = true; // needed for RNG | ||||
|         config.rcc.pll_src = PllSource::Hsi; | ||||
|         config.rcc.pll1 = Some(Pll { | ||||
|             source: PllSource::HSI, | ||||
|             prediv: PllPreDiv::DIV4, | ||||
|             mul: PllMul::MUL50, | ||||
|             divp: Some(PllDiv::DIV2), | ||||
|             divq: None, | ||||
|             divr: None, | ||||
|         }); | ||||
|         config.rcc.sys = Sysclk::Pll1P; // 400 Mhz | ||||
|         config.rcc.sys = Sysclk::PLL1_P; // 400 Mhz | ||||
|         config.rcc.ahb_pre = AHBPrescaler::DIV2; // 200 Mhz | ||||
|         config.rcc.apb1_pre = APBPrescaler::DIV2; // 100 Mhz | ||||
|         config.rcc.apb2_pre = APBPrescaler::DIV2; // 100 Mhz | ||||
|   | ||||
| @@ -14,17 +14,17 @@ async fn main(_spawner: Spawner) { | ||||
|     let mut config = Config::default(); | ||||
|     { | ||||
|         use embassy_stm32::rcc::*; | ||||
|         config.rcc.hsi = Some(Hsi::Mhz64); | ||||
|         config.rcc.hsi = Some(HSIPrescaler::DIV1); | ||||
|         config.rcc.csi = true; | ||||
|         config.rcc.pll_src = PllSource::Hsi; | ||||
|         config.rcc.pll1 = Some(Pll { | ||||
|             source: PllSource::HSI, | ||||
|             prediv: PllPreDiv::DIV4, | ||||
|             mul: PllMul::MUL50, | ||||
|             divp: Some(PllDiv::DIV2), | ||||
|             divq: Some(PllDiv::DIV8), // 100mhz | ||||
|             divr: None, | ||||
|         }); | ||||
|         config.rcc.sys = Sysclk::Pll1P; // 400 Mhz | ||||
|         config.rcc.sys = Sysclk::PLL1_P; // 400 Mhz | ||||
|         config.rcc.ahb_pre = AHBPrescaler::DIV2; // 200 Mhz | ||||
|         config.rcc.apb1_pre = APBPrescaler::DIV2; // 100 Mhz | ||||
|         config.rcc.apb2_pre = APBPrescaler::DIV2; // 100 Mhz | ||||
|   | ||||
| @@ -17,18 +17,18 @@ async fn main(_spawner: Spawner) { | ||||
|     let mut config = Config::default(); | ||||
|     { | ||||
|         use embassy_stm32::rcc::*; | ||||
|         config.rcc.hsi = Some(Hsi::Mhz64); | ||||
|         config.rcc.hsi = Some(HSIPrescaler::DIV1); | ||||
|         config.rcc.csi = true; | ||||
|         config.rcc.hsi48 = true; // needed for RNG | ||||
|         config.rcc.pll_src = PllSource::Hsi; | ||||
|         config.rcc.pll1 = Some(Pll { | ||||
|             source: PllSource::HSI, | ||||
|             prediv: PllPreDiv::DIV4, | ||||
|             mul: PllMul::MUL50, | ||||
|             divp: Some(PllDiv::DIV2), | ||||
|             divq: Some(PllDiv::DIV8), // 100mhz | ||||
|             divr: None, | ||||
|         }); | ||||
|         config.rcc.sys = Sysclk::Pll1P; // 400 Mhz | ||||
|         config.rcc.sys = Sysclk::PLL1_P; // 400 Mhz | ||||
|         config.rcc.ahb_pre = AHBPrescaler::DIV2; // 200 Mhz | ||||
|         config.rcc.apb1_pre = APBPrescaler::DIV2; // 100 Mhz | ||||
|         config.rcc.apb2_pre = APBPrescaler::DIV2; // 100 Mhz | ||||
|   | ||||
| @@ -17,17 +17,17 @@ async fn main(_spawner: Spawner) { | ||||
|     let mut config = Config::default(); | ||||
|     { | ||||
|         use embassy_stm32::rcc::*; | ||||
|         config.rcc.hsi = Some(Hsi::Mhz64); | ||||
|         config.rcc.hsi = Some(HSIPrescaler::DIV1); | ||||
|         config.rcc.csi = true; | ||||
|         config.rcc.pll_src = PllSource::Hsi; | ||||
|         config.rcc.pll1 = Some(Pll { | ||||
|             source: PllSource::HSI, | ||||
|             prediv: PllPreDiv::DIV4, | ||||
|             mul: PllMul::MUL50, | ||||
|             divp: Some(PllDiv::DIV2), | ||||
|             divq: None, | ||||
|             divr: None, | ||||
|         }); | ||||
|         config.rcc.sys = Sysclk::Pll1P; // 400 Mhz | ||||
|         config.rcc.sys = Sysclk::PLL1_P; // 400 Mhz | ||||
|         config.rcc.ahb_pre = AHBPrescaler::DIV2; // 200 Mhz | ||||
|         config.rcc.apb1_pre = APBPrescaler::DIV2; // 100 Mhz | ||||
|         config.rcc.apb2_pre = APBPrescaler::DIV2; // 100 Mhz | ||||
| @@ -39,7 +39,7 @@ async fn main(_spawner: Spawner) { | ||||
|     info!("Hello World!"); | ||||
|  | ||||
|     let ch1 = PwmPin::new_ch1(p.PA6, OutputType::PushPull); | ||||
|     let mut pwm = SimplePwm::new(p.TIM3, Some(ch1), None, None, None, khz(10)); | ||||
|     let mut pwm = SimplePwm::new(p.TIM3, Some(ch1), None, None, None, khz(10), Default::default()); | ||||
|     let max = pwm.get_max_duty(); | ||||
|     pwm.enable(Channel::Ch1); | ||||
|  | ||||
|   | ||||
| @@ -18,17 +18,17 @@ async fn main(_spawner: Spawner) -> ! { | ||||
|     let mut config = Config::default(); | ||||
|     { | ||||
|         use embassy_stm32::rcc::*; | ||||
|         config.rcc.hsi = Some(Hsi::Mhz64); | ||||
|         config.rcc.hsi = Some(HSIPrescaler::DIV1); | ||||
|         config.rcc.csi = true; | ||||
|         config.rcc.pll_src = PllSource::Hsi; | ||||
|         config.rcc.pll1 = Some(Pll { | ||||
|             source: PllSource::HSI, | ||||
|             prediv: PllPreDiv::DIV4, | ||||
|             mul: PllMul::MUL50, | ||||
|             divp: Some(PllDiv::DIV2), | ||||
|             divq: Some(PllDiv::DIV4), // default clock chosen by SDMMCSEL. 200 Mhz | ||||
|             divr: None, | ||||
|         }); | ||||
|         config.rcc.sys = Sysclk::Pll1P; // 400 Mhz | ||||
|         config.rcc.sys = Sysclk::PLL1_P; // 400 Mhz | ||||
|         config.rcc.ahb_pre = AHBPrescaler::DIV2; // 200 Mhz | ||||
|         config.rcc.apb1_pre = APBPrescaler::DIV2; // 100 Mhz | ||||
|         config.rcc.apb2_pre = APBPrescaler::DIV2; // 100 Mhz | ||||
|   | ||||
| @@ -40,17 +40,17 @@ fn main() -> ! { | ||||
|     let mut config = Config::default(); | ||||
|     { | ||||
|         use embassy_stm32::rcc::*; | ||||
|         config.rcc.hsi = Some(Hsi::Mhz64); | ||||
|         config.rcc.hsi = Some(HSIPrescaler::DIV1); | ||||
|         config.rcc.csi = true; | ||||
|         config.rcc.pll_src = PllSource::Hsi; | ||||
|         config.rcc.pll1 = Some(Pll { | ||||
|             source: PllSource::HSI, | ||||
|             prediv: PllPreDiv::DIV4, | ||||
|             mul: PllMul::MUL50, | ||||
|             divp: Some(PllDiv::DIV2), | ||||
|             divq: Some(PllDiv::DIV8), // used by SPI3. 100Mhz. | ||||
|             divr: None, | ||||
|         }); | ||||
|         config.rcc.sys = Sysclk::Pll1P; // 400 Mhz | ||||
|         config.rcc.sys = Sysclk::PLL1_P; // 400 Mhz | ||||
|         config.rcc.ahb_pre = AHBPrescaler::DIV2; // 200 Mhz | ||||
|         config.rcc.apb1_pre = APBPrescaler::DIV2; // 100 Mhz | ||||
|         config.rcc.apb2_pre = APBPrescaler::DIV2; // 100 Mhz | ||||
|   | ||||
| @@ -36,17 +36,17 @@ fn main() -> ! { | ||||
|     let mut config = Config::default(); | ||||
|     { | ||||
|         use embassy_stm32::rcc::*; | ||||
|         config.rcc.hsi = Some(Hsi::Mhz64); | ||||
|         config.rcc.hsi = Some(HSIPrescaler::DIV1); | ||||
|         config.rcc.csi = true; | ||||
|         config.rcc.pll_src = PllSource::Hsi; | ||||
|         config.rcc.pll1 = Some(Pll { | ||||
|             source: PllSource::HSI, | ||||
|             prediv: PllPreDiv::DIV4, | ||||
|             mul: PllMul::MUL50, | ||||
|             divp: Some(PllDiv::DIV2), | ||||
|             divq: Some(PllDiv::DIV8), // used by SPI3. 100Mhz. | ||||
|             divr: None, | ||||
|         }); | ||||
|         config.rcc.sys = Sysclk::Pll1P; // 400 Mhz | ||||
|         config.rcc.sys = Sysclk::PLL1_P; // 400 Mhz | ||||
|         config.rcc.ahb_pre = AHBPrescaler::DIV2; // 200 Mhz | ||||
|         config.rcc.apb1_pre = APBPrescaler::DIV2; // 100 Mhz | ||||
|         config.rcc.apb2_pre = APBPrescaler::DIV2; // 100 Mhz | ||||
|   | ||||
| @@ -23,18 +23,18 @@ async fn main(_spawner: Spawner) { | ||||
|     let mut config = Config::default(); | ||||
|     { | ||||
|         use embassy_stm32::rcc::*; | ||||
|         config.rcc.hsi = Some(Hsi::Mhz64); | ||||
|         config.rcc.hsi = Some(HSIPrescaler::DIV1); | ||||
|         config.rcc.csi = true; | ||||
|         config.rcc.hsi48 = true; // needed for USB | ||||
|         config.rcc.pll_src = PllSource::Hsi; | ||||
|         config.rcc.pll1 = Some(Pll { | ||||
|             source: PllSource::HSI, | ||||
|             prediv: PllPreDiv::DIV4, | ||||
|             mul: PllMul::MUL50, | ||||
|             divp: Some(PllDiv::DIV2), | ||||
|             divq: None, | ||||
|             divr: None, | ||||
|         }); | ||||
|         config.rcc.sys = Sysclk::Pll1P; // 400 Mhz | ||||
|         config.rcc.sys = Sysclk::PLL1_P; // 400 Mhz | ||||
|         config.rcc.ahb_pre = AHBPrescaler::DIV2; // 200 Mhz | ||||
|         config.rcc.apb1_pre = APBPrescaler::DIV2; // 100 Mhz | ||||
|         config.rcc.apb2_pre = APBPrescaler::DIV2; // 100 Mhz | ||||
|   | ||||
| @@ -23,7 +23,7 @@ const LORA_FREQUENCY_IN_HZ: u32 = 903_900_000; // warning: set this appropriatel | ||||
| #[embassy_executor::main] | ||||
| async fn main(_spawner: Spawner) { | ||||
|     let mut config = embassy_stm32::Config::default(); | ||||
|     config.rcc.mux = embassy_stm32::rcc::ClockSrc::HSI16; | ||||
|     config.rcc.mux = embassy_stm32::rcc::ClockSrc::HSI; | ||||
|     config.rcc.enable_hsi48 = true; | ||||
|     let p = embassy_stm32::init(config); | ||||
|  | ||||
|   | ||||
| @@ -33,7 +33,7 @@ const LORAWAN_REGION: region::Region = region::Region::EU868; // warning: set th | ||||
| #[embassy_executor::main] | ||||
| async fn main(_spawner: Spawner) { | ||||
|     let mut config = embassy_stm32::Config::default(); | ||||
|     config.rcc.mux = embassy_stm32::rcc::ClockSrc::HSI16; | ||||
|     config.rcc.mux = embassy_stm32::rcc::ClockSrc::HSI; | ||||
|     config.rcc.enable_hsi48 = true; | ||||
|     let p = embassy_stm32::init(config); | ||||
|  | ||||
|   | ||||
| @@ -23,7 +23,7 @@ const LORA_FREQUENCY_IN_HZ: u32 = 903_900_000; // warning: set this appropriatel | ||||
| #[embassy_executor::main] | ||||
| async fn main(_spawner: Spawner) { | ||||
|     let mut config = embassy_stm32::Config::default(); | ||||
|     config.rcc.mux = embassy_stm32::rcc::ClockSrc::HSI16; | ||||
|     config.rcc.mux = embassy_stm32::rcc::ClockSrc::HSI; | ||||
|     config.rcc.enable_hsi48 = true; | ||||
|     let p = embassy_stm32::init(config); | ||||
|  | ||||
|   | ||||
| @@ -23,7 +23,7 @@ const LORA_FREQUENCY_IN_HZ: u32 = 903_900_000; // warning: set this appropriatel | ||||
| #[embassy_executor::main] | ||||
| async fn main(_spawner: Spawner) { | ||||
|     let mut config = embassy_stm32::Config::default(); | ||||
|     config.rcc.mux = embassy_stm32::rcc::ClockSrc::HSI16; | ||||
|     config.rcc.mux = embassy_stm32::rcc::ClockSrc::HSI; | ||||
|     config.rcc.enable_hsi48 = true; | ||||
|     let p = embassy_stm32::init(config); | ||||
|  | ||||
|   | ||||
| @@ -17,7 +17,7 @@ bind_interrupts!(struct Irqs { | ||||
| async fn main(_spawner: Spawner) { | ||||
|     let mut config = Config::default(); | ||||
|     config.rcc.mux = ClockSrc::PLL1_R; | ||||
|     config.rcc.hsi16 = true; | ||||
|     config.rcc.hsi = true; | ||||
|     config.rcc.pll = Some(Pll { | ||||
|         source: PLLSource::HSI, | ||||
|         prediv: PllPreDiv::DIV1, | ||||
|   | ||||
| @@ -5,7 +5,6 @@ | ||||
| use chrono::{NaiveDate, NaiveDateTime}; | ||||
| use defmt::*; | ||||
| use embassy_executor::Spawner; | ||||
| use embassy_stm32::rcc::{ClockSrc, LsConfig, PLLSource, Pll, PllMul, PllPreDiv, PllRDiv}; | ||||
| use embassy_stm32::rtc::{Rtc, RtcConfig}; | ||||
| use embassy_stm32::time::Hertz; | ||||
| use embassy_stm32::Config; | ||||
| @@ -15,17 +14,23 @@ use {defmt_rtt as _, panic_probe as _}; | ||||
| #[embassy_executor::main] | ||||
| async fn main(_spawner: Spawner) { | ||||
|     let mut config = Config::default(); | ||||
|     config.rcc.mux = ClockSrc::PLL1_R; | ||||
|     config.rcc.hse = Some(Hertz::mhz(8)); | ||||
|     config.rcc.pll = Some(Pll { | ||||
|         source: PLLSource::HSE, | ||||
|         prediv: PllPreDiv::DIV1, | ||||
|         mul: PllMul::MUL20, | ||||
|         divp: None, | ||||
|         divq: None, | ||||
|         divr: Some(PllRDiv::DIV2), // sysclk 80Mhz clock (8 / 1 * 20 / 2) | ||||
|     }); | ||||
|     config.rcc.ls = LsConfig::default_lse(); | ||||
|     { | ||||
|         use embassy_stm32::rcc::*; | ||||
|         config.rcc.mux = ClockSrc::PLL1_R; | ||||
|         config.rcc.hse = Some(Hse { | ||||
|             freq: Hertz::mhz(8), | ||||
|             mode: HseMode::Oscillator, | ||||
|         }); | ||||
|         config.rcc.pll = Some(Pll { | ||||
|             source: PLLSource::HSE, | ||||
|             prediv: PllPreDiv::DIV1, | ||||
|             mul: PllMul::MUL20, | ||||
|             divp: None, | ||||
|             divq: None, | ||||
|             divr: Some(PllRDiv::DIV2), // sysclk 80Mhz clock (8 / 1 * 20 / 2) | ||||
|         }); | ||||
|         config.rcc.ls = LsConfig::default_lse(); | ||||
|     } | ||||
|     let p = embassy_stm32::init(config); | ||||
|  | ||||
|     info!("Hello World!"); | ||||
|   | ||||
| @@ -48,7 +48,6 @@ use embassy_net_adin1110::{self, Device, Runner, ADIN1110}; | ||||
| use embedded_hal_bus::spi::ExclusiveDevice; | ||||
| use hal::gpio::Pull; | ||||
| use hal::i2c::Config as I2C_Config; | ||||
| use hal::rcc::{ClockSrc, PLLSource, Pll, PllMul, PllPreDiv, PllRDiv}; | ||||
| use hal::spi::{Config as SPI_Config, Spi}; | ||||
| use hal::time::Hertz; | ||||
|  | ||||
| @@ -74,20 +73,25 @@ async fn main(spawner: Spawner) { | ||||
|     defmt::println!("Start main()"); | ||||
|  | ||||
|     let mut config = embassy_stm32::Config::default(); | ||||
|  | ||||
|     // 80Mhz clock (Source: 8 / SrcDiv: 1 * PLLMul 20 / ClkDiv 2) | ||||
|     // 80MHz highest frequency for flash 0 wait. | ||||
|     config.rcc.mux = ClockSrc::PLL1_R; | ||||
|     config.rcc.hse = Some(Hertz::mhz(8)); | ||||
|     config.rcc.pll = Some(Pll { | ||||
|         source: PLLSource::HSE, | ||||
|         prediv: PllPreDiv::DIV1, | ||||
|         mul: PllMul::MUL20, | ||||
|         divp: None, | ||||
|         divq: None, | ||||
|         divr: Some(PllRDiv::DIV2), // sysclk 80Mhz clock (8 / 1 * 20 / 2) | ||||
|     }); | ||||
|     config.rcc.hsi48 = true; // needed for rng | ||||
|     { | ||||
|         use embassy_stm32::rcc::*; | ||||
|         // 80Mhz clock (Source: 8 / SrcDiv: 1 * PLLMul 20 / ClkDiv 2) | ||||
|         // 80MHz highest frequency for flash 0 wait. | ||||
|         config.rcc.mux = ClockSrc::PLL1_R; | ||||
|         config.rcc.hse = Some(Hse { | ||||
|             freq: Hertz::mhz(8), | ||||
|             mode: HseMode::Oscillator, | ||||
|         }); | ||||
|         config.rcc.pll = Some(Pll { | ||||
|             source: PLLSource::HSE, | ||||
|             prediv: PllPreDiv::DIV1, | ||||
|             mul: PllMul::MUL20, | ||||
|             divp: None, | ||||
|             divq: None, | ||||
|             divr: Some(PllRDiv::DIV2), // sysclk 80Mhz clock (8 / 1 * 20 / 2) | ||||
|         }); | ||||
|         config.rcc.hsi48 = true; // needed for rng | ||||
|     } | ||||
|  | ||||
|     let dp = embassy_stm32::init(config); | ||||
|  | ||||
|   | ||||
| @@ -25,7 +25,7 @@ async fn main(_spawner: Spawner) { | ||||
|     let mut config = Config::default(); | ||||
|     config.rcc.hsi48 = true; | ||||
|     config.rcc.mux = ClockSrc::PLL1_R; | ||||
|     config.rcc.hsi16 = true; | ||||
|     config.rcc.hsi = true; | ||||
|     config.rcc.pll = Some(Pll { | ||||
|         source: PLLSource::HSI, | ||||
|         prediv: PllPreDiv::DIV1, | ||||
|   | ||||
| @@ -16,7 +16,7 @@ bind_interrupts!(struct Irqs { | ||||
| #[embassy_executor::main] | ||||
| async fn main(_spawner: Spawner) { | ||||
|     let mut config = Config::default(); | ||||
|     config.rcc.hsi16 = true; | ||||
|     config.rcc.hsi = true; | ||||
|     config.rcc.mux = ClockSrc::PLL1_R; | ||||
|     config.rcc.pll = Some(Pll { | ||||
|         // 64Mhz clock (16 / 1 * 8 / 2) | ||||
|   | ||||
| @@ -45,7 +45,7 @@ async fn net_task(stack: &'static Stack<Device<'static, MTU>>) -> ! { | ||||
| #[embassy_executor::main] | ||||
| async fn main(spawner: Spawner) { | ||||
|     let mut config = Config::default(); | ||||
|     config.rcc.hsi16 = true; | ||||
|     config.rcc.hsi = true; | ||||
|     config.rcc.mux = ClockSrc::PLL1_R; | ||||
|     config.rcc.pll = Some(Pll { | ||||
|         // 80Mhz clock (16 / 1 * 10 / 2) | ||||
|   | ||||
| @@ -22,7 +22,7 @@ bind_interrupts!(struct Irqs { | ||||
| #[embassy_executor::main] | ||||
| async fn main(_spawner: Spawner) { | ||||
|     let mut config = Config::default(); | ||||
|     config.rcc.hsi16 = true; | ||||
|     config.rcc.hsi = true; | ||||
|     config.rcc.mux = ClockSrc::PLL1_R; | ||||
|     config.rcc.pll = Some(Pll { | ||||
|         // 80Mhz clock (16 / 1 * 10 / 2) | ||||
|   | ||||
| @@ -20,7 +20,7 @@ bind_interrupts!(struct Irqs { | ||||
| #[embassy_executor::main] | ||||
| async fn main(_spawner: Spawner) { | ||||
|     let mut config = Config::default(); | ||||
|     config.rcc.hsi16 = true; | ||||
|     config.rcc.hsi = true; | ||||
|     config.rcc.mux = ClockSrc::PLL1_R; | ||||
|     config.rcc.pll = Some(Pll { | ||||
|         // 80Mhz clock (16 / 1 * 10 / 2) | ||||
|   | ||||
| @@ -23,8 +23,8 @@ async fn main(_spawner: Spawner) { | ||||
|     info!("Hello World!"); | ||||
|  | ||||
|     let mut config = Config::default(); | ||||
|     config.rcc.mux = ClockSrc::PLL1R(PllConfig { | ||||
|         source: PllSrc::HSI16, | ||||
|     config.rcc.mux = ClockSrc::PLL1_R(PllConfig { | ||||
|         source: PllSrc::HSI, | ||||
|         m: Pllm::DIV2, | ||||
|         n: Plln::MUL10, | ||||
|         r: Plldiv::DIV1, | ||||
|   | ||||
| @@ -12,7 +12,8 @@ use embassy_lora::LoraTimer; | ||||
| use embassy_stm32::gpio::{Level, Output, Pin, Speed}; | ||||
| use embassy_stm32::rng::{self, Rng}; | ||||
| use embassy_stm32::spi::Spi; | ||||
| use embassy_stm32::{bind_interrupts, pac, peripherals}; | ||||
| use embassy_stm32::time::Hertz; | ||||
| use embassy_stm32::{bind_interrupts, peripherals}; | ||||
| use embassy_time::Delay; | ||||
| use lora_phy::mod_params::*; | ||||
| use lora_phy::sx1261_2::SX1261_2; | ||||
| @@ -33,11 +34,25 @@ bind_interrupts!(struct Irqs{ | ||||
| #[embassy_executor::main] | ||||
| async fn main(_spawner: Spawner) { | ||||
|     let mut config = embassy_stm32::Config::default(); | ||||
|     config.rcc.mux = embassy_stm32::rcc::ClockSrc::HSE; | ||||
|     { | ||||
|         use embassy_stm32::rcc::*; | ||||
|         config.rcc.hse = Some(Hse { | ||||
|             freq: Hertz(32_000_000), | ||||
|             mode: HseMode::Bypass, | ||||
|             prescaler: HsePrescaler::DIV1, | ||||
|         }); | ||||
|         config.rcc.mux = ClockSrc::PLL1_R; | ||||
|         config.rcc.pll = Some(Pll { | ||||
|             source: PLLSource::HSE, | ||||
|             prediv: PllPreDiv::DIV2, | ||||
|             mul: PllMul::MUL6, | ||||
|             divp: None, | ||||
|             divq: Some(PllQDiv::DIV2), // PLL1_Q clock (32 / 2 * 6 / 2), used for RNG | ||||
|             divr: Some(PllRDiv::DIV2), // sysclk 48Mhz clock (32 / 2 * 6 / 2) | ||||
|         }); | ||||
|     } | ||||
|     let p = embassy_stm32::init(config); | ||||
|  | ||||
|     pac::RCC.ccipr().modify(|w| w.set_rngsel(0b01)); | ||||
|  | ||||
|     let spi = Spi::new_subghz(p.SUBGHZSPI, p.DMA1_CH1, p.DMA1_CH2); | ||||
|  | ||||
|     // Set CTRL1 and CTRL3 for high-power transmission, while CTRL2 acts as an RF switch between tx and rx | ||||
|   | ||||
| @@ -11,6 +11,7 @@ use embassy_lora::iv::{InterruptHandler, Stm32wlInterfaceVariant}; | ||||
| use embassy_stm32::bind_interrupts; | ||||
| use embassy_stm32::gpio::{Level, Output, Pin, Speed}; | ||||
| use embassy_stm32::spi::Spi; | ||||
| use embassy_stm32::time::Hertz; | ||||
| use embassy_time::{Delay, Timer}; | ||||
| use lora_phy::mod_params::*; | ||||
| use lora_phy::sx1261_2::SX1261_2; | ||||
| @@ -26,7 +27,23 @@ bind_interrupts!(struct Irqs{ | ||||
| #[embassy_executor::main] | ||||
| async fn main(_spawner: Spawner) { | ||||
|     let mut config = embassy_stm32::Config::default(); | ||||
|     config.rcc.mux = embassy_stm32::rcc::ClockSrc::HSE; | ||||
|     { | ||||
|         use embassy_stm32::rcc::*; | ||||
|         config.rcc.hse = Some(Hse { | ||||
|             freq: Hertz(32_000_000), | ||||
|             mode: HseMode::Bypass, | ||||
|             prescaler: HsePrescaler::DIV1, | ||||
|         }); | ||||
|         config.rcc.mux = ClockSrc::PLL1_R; | ||||
|         config.rcc.pll = Some(Pll { | ||||
|             source: PLLSource::HSE, | ||||
|             prediv: PllPreDiv::DIV2, | ||||
|             mul: PllMul::MUL6, | ||||
|             divp: None, | ||||
|             divq: Some(PllQDiv::DIV2), // PLL1_Q clock (32 / 2 * 6 / 2), used for RNG | ||||
|             divr: Some(PllRDiv::DIV2), // sysclk 48Mhz clock (32 / 2 * 6 / 2) | ||||
|         }); | ||||
|     } | ||||
|     let p = embassy_stm32::init(config); | ||||
|  | ||||
|     let spi = Spi::new_subghz(p.SUBGHZSPI, p.DMA1_CH1, p.DMA1_CH2); | ||||
|   | ||||
| @@ -11,6 +11,7 @@ use embassy_lora::iv::{InterruptHandler, Stm32wlInterfaceVariant}; | ||||
| use embassy_stm32::bind_interrupts; | ||||
| use embassy_stm32::gpio::{Level, Output, Pin, Speed}; | ||||
| use embassy_stm32::spi::Spi; | ||||
| use embassy_stm32::time::Hertz; | ||||
| use embassy_time::Delay; | ||||
| use lora_phy::mod_params::*; | ||||
| use lora_phy::sx1261_2::SX1261_2; | ||||
| @@ -26,7 +27,23 @@ bind_interrupts!(struct Irqs{ | ||||
| #[embassy_executor::main] | ||||
| async fn main(_spawner: Spawner) { | ||||
|     let mut config = embassy_stm32::Config::default(); | ||||
|     config.rcc.mux = embassy_stm32::rcc::ClockSrc::HSE; | ||||
|     { | ||||
|         use embassy_stm32::rcc::*; | ||||
|         config.rcc.hse = Some(Hse { | ||||
|             freq: Hertz(32_000_000), | ||||
|             mode: HseMode::Bypass, | ||||
|             prescaler: HsePrescaler::DIV1, | ||||
|         }); | ||||
|         config.rcc.mux = ClockSrc::PLL1_R; | ||||
|         config.rcc.pll = Some(Pll { | ||||
|             source: PLLSource::HSE, | ||||
|             prediv: PllPreDiv::DIV2, | ||||
|             mul: PllMul::MUL6, | ||||
|             divp: None, | ||||
|             divq: Some(PllQDiv::DIV2), // PLL1_Q clock (32 / 2 * 6 / 2), used for RNG | ||||
|             divr: Some(PllRDiv::DIV2), // sysclk 48Mhz clock (32 / 2 * 6 / 2) | ||||
|         }); | ||||
|     } | ||||
|     let p = embassy_stm32::init(config); | ||||
|  | ||||
|     let spi = Spi::new_subghz(p.SUBGHZSPI, p.DMA1_CH1, p.DMA1_CH2); | ||||
|   | ||||
| @@ -4,9 +4,9 @@ | ||||
|  | ||||
| use defmt::*; | ||||
| use embassy_executor::Spawner; | ||||
| use embassy_stm32::rcc::{ClockSrc, MSIRange}; | ||||
| use embassy_stm32::rng::{self, Rng}; | ||||
| use embassy_stm32::{bind_interrupts, pac, peripherals}; | ||||
| use embassy_stm32::time::Hertz; | ||||
| use embassy_stm32::{bind_interrupts, peripherals}; | ||||
| use {defmt_rtt as _, panic_probe as _}; | ||||
|  | ||||
| bind_interrupts!(struct Irqs{ | ||||
| @@ -16,11 +16,25 @@ bind_interrupts!(struct Irqs{ | ||||
| #[embassy_executor::main] | ||||
| async fn main(_spawner: Spawner) { | ||||
|     let mut config = embassy_stm32::Config::default(); | ||||
|     config.rcc.mux = ClockSrc::MSI(MSIRange::RANGE32M); | ||||
|     { | ||||
|         use embassy_stm32::rcc::*; | ||||
|         config.rcc.hse = Some(Hse { | ||||
|             freq: Hertz(32_000_000), | ||||
|             mode: HseMode::Bypass, | ||||
|             prescaler: HsePrescaler::DIV1, | ||||
|         }); | ||||
|         config.rcc.mux = ClockSrc::PLL1_R; | ||||
|         config.rcc.pll = Some(Pll { | ||||
|             source: PLLSource::HSE, | ||||
|             prediv: PllPreDiv::DIV2, | ||||
|             mul: PllMul::MUL6, | ||||
|             divp: None, | ||||
|             divq: Some(PllQDiv::DIV2), // PLL1_Q clock (32 / 2 * 6 / 2), used for RNG | ||||
|             divr: Some(PllRDiv::DIV2), // sysclk 48Mhz clock (32 / 2 * 6 / 2) | ||||
|         }); | ||||
|     } | ||||
|     let p = embassy_stm32::init(config); | ||||
|  | ||||
|     pac::RCC.ccipr().modify(|w| w.set_rngsel(0b11)); // msi | ||||
|  | ||||
|     info!("Hello World!"); | ||||
|  | ||||
|     let mut rng = Rng::new(p.RNG, Irqs); | ||||
|   | ||||
| @@ -5,20 +5,34 @@ | ||||
| use chrono::{NaiveDate, NaiveDateTime}; | ||||
| use defmt::*; | ||||
| use embassy_executor::Spawner; | ||||
| use embassy_stm32::rcc::{ClockSrc, LsConfig}; | ||||
| use embassy_stm32::rtc::{Rtc, RtcConfig}; | ||||
| use embassy_stm32::time::Hertz; | ||||
| use embassy_stm32::Config; | ||||
| use embassy_time::Timer; | ||||
| use {defmt_rtt as _, panic_probe as _}; | ||||
|  | ||||
| #[embassy_executor::main] | ||||
| async fn main(_spawner: Spawner) { | ||||
|     let p = { | ||||
|         let mut config = Config::default(); | ||||
|         config.rcc.mux = ClockSrc::HSE; | ||||
|     let mut config = Config::default(); | ||||
|     { | ||||
|         use embassy_stm32::rcc::*; | ||||
|         config.rcc.ls = LsConfig::default_lse(); | ||||
|         embassy_stm32::init(config) | ||||
|     }; | ||||
|         config.rcc.hse = Some(Hse { | ||||
|             freq: Hertz(32_000_000), | ||||
|             mode: HseMode::Bypass, | ||||
|             prescaler: HsePrescaler::DIV1, | ||||
|         }); | ||||
|         config.rcc.mux = ClockSrc::PLL1_R; | ||||
|         config.rcc.pll = Some(Pll { | ||||
|             source: PLLSource::HSE, | ||||
|             prediv: PllPreDiv::DIV2, | ||||
|             mul: PllMul::MUL6, | ||||
|             divp: None, | ||||
|             divq: Some(PllQDiv::DIV2), // PLL1_Q clock (32 / 2 * 6 / 2), used for RNG | ||||
|             divr: Some(PllRDiv::DIV2), // sysclk 48Mhz clock (32 / 2 * 6 / 2) | ||||
|         }); | ||||
|     } | ||||
|     let p = embassy_stm32::init(config); | ||||
|     info!("Hello World!"); | ||||
|  | ||||
|     let now = NaiveDate::from_ymd_opt(2020, 5, 15) | ||||
|   | ||||
| @@ -93,6 +93,7 @@ async fn main(_spawner: Spawner) { | ||||
|         adc.read_many( | ||||
|             &mut Channel::new_pin(&mut p.PIN_29, Pull::Down), | ||||
|             &mut low, | ||||
|             1, | ||||
|             &mut p.DMA_CH0, | ||||
|         ) | ||||
|         .await | ||||
| @@ -100,12 +101,18 @@ async fn main(_spawner: Spawner) { | ||||
|         adc.read_many( | ||||
|             &mut Channel::new_pin(&mut p.PIN_29, Pull::None), | ||||
|             &mut none, | ||||
|             1, | ||||
|             &mut p.DMA_CH0, | ||||
|         ) | ||||
|         .await | ||||
|         .unwrap(); | ||||
|         adc.read_many_raw(&mut Channel::new_pin(&mut p.PIN_29, Pull::Up), &mut up, &mut p.DMA_CH0) | ||||
|             .await; | ||||
|         adc.read_many_raw( | ||||
|             &mut Channel::new_pin(&mut p.PIN_29, Pull::Up), | ||||
|             &mut up, | ||||
|             1, | ||||
|             &mut p.DMA_CH0, | ||||
|         ) | ||||
|         .await; | ||||
|         defmt::assert!(low.iter().zip(none.iter()).all(|(l, n)| *l >> 4 < *n as u16)); | ||||
|         defmt::assert!(up.iter().all(|s| s.good())); | ||||
|         defmt::assert!(none.iter().zip(up.iter()).all(|(n, u)| (*n as u16) < u.value())); | ||||
| @@ -115,6 +122,7 @@ async fn main(_spawner: Spawner) { | ||||
|         adc.read_many( | ||||
|             &mut Channel::new_temp_sensor(&mut p.ADC_TEMP_SENSOR), | ||||
|             &mut temp, | ||||
|             1, | ||||
|             &mut p.DMA_CH0, | ||||
|         ) | ||||
|         .await | ||||
|   | ||||
| @@ -12,9 +12,13 @@ stm32g071rb = ["embassy-stm32/stm32g071rb", "not-gpdma", "dac-adc-pin"] | ||||
| stm32c031c6 = ["embassy-stm32/stm32c031c6", "not-gpdma"] | ||||
| stm32g491re = ["embassy-stm32/stm32g491re", "chrono", "not-gpdma", "rng"] | ||||
| stm32h755zi = ["embassy-stm32/stm32h755zi-cm7", "chrono", "not-gpdma", "eth", "dac-adc-pin", "rng"] | ||||
| stm32h753zi = ["embassy-stm32/stm32h753zi", "chrono", "not-gpdma", "eth", "rng"] | ||||
| stm32h7a3zi = ["embassy-stm32/stm32h7a3zi", "not-gpdma", "rng"] | ||||
| stm32wb55rg = ["embassy-stm32/stm32wb55rg", "chrono", "not-gpdma", "ble", "mac" , "rng"] | ||||
| stm32h563zi = ["embassy-stm32/stm32h563zi", "chrono", "eth", "rng"] | ||||
| stm32u585ai = ["embassy-stm32/stm32u585ai", "chrono", "rng"] | ||||
| stm32u5a5zj = ["embassy-stm32/stm32u5a5zj", "chrono", "rng"] | ||||
| stm32wba52cg = ["embassy-stm32/stm32wba52cg", "chrono", "rng"] | ||||
| stm32l073rz = ["embassy-stm32/stm32l073rz", "not-gpdma", "rng"] | ||||
| stm32l152re = ["embassy-stm32/stm32l152re", "chrono", "not-gpdma"] | ||||
| stm32l4a6zg = ["embassy-stm32/stm32l4a6zg", "chrono", "not-gpdma", "rng"] | ||||
|   | ||||
| @@ -60,6 +60,8 @@ async fn main(spawner: Spawner) { | ||||
|     let n = 4; | ||||
|     #[cfg(feature = "stm32f207zg")] | ||||
|     let n = 5; | ||||
|     #[cfg(feature = "stm32h753zi")] | ||||
|     let n = 6; | ||||
|  | ||||
|     let mac_addr = [0x00, n, 0xDE, 0xAD, 0xBE, 0xEF]; | ||||
|  | ||||
|   | ||||
| @@ -217,8 +217,7 @@ async fn main(_spawner: Spawner) { | ||||
| } | ||||
|  | ||||
| fn delay() { | ||||
|     #[cfg(feature = "stm32h755zi")] | ||||
|     cortex_m::asm::delay(10000); | ||||
|     #[cfg(not(feature = "stm32h755zi"))] | ||||
|     #[cfg(any(feature = "stm32h755zi", feature = "stm32h753zi", feature = "stm32h7a3zi"))] | ||||
|     cortex_m::asm::delay(9000); | ||||
|     cortex_m::asm::delay(1000); | ||||
| } | ||||
|   | ||||
| @@ -11,7 +11,12 @@ use embassy_stm32::rng::Rng; | ||||
| use embassy_stm32::{bind_interrupts, peripherals, rng}; | ||||
| use {defmt_rtt as _, panic_probe as _}; | ||||
|  | ||||
| #[cfg(any(feature = "stm32l4a6zg", feature = "stm32h755zi", feature = "stm32f429zi"))] | ||||
| #[cfg(any( | ||||
|     feature = "stm32l4a6zg", | ||||
|     feature = "stm32h755zi", | ||||
|     feature = "stm32h753zi", | ||||
|     feature = "stm32f429zi" | ||||
| ))] | ||||
| bind_interrupts!(struct Irqs { | ||||
|    HASH_RNG => rng::InterruptHandler<peripherals::RNG>; | ||||
| }); | ||||
| @@ -23,6 +28,7 @@ bind_interrupts!(struct Irqs { | ||||
|     feature = "stm32l4a6zg", | ||||
|     feature = "stm32l073rz", | ||||
|     feature = "stm32h755zi", | ||||
|     feature = "stm32h753zi", | ||||
|     feature = "stm32f429zi" | ||||
| )))] | ||||
| bind_interrupts!(struct Irqs { | ||||
|   | ||||
| @@ -10,7 +10,7 @@ use chrono::NaiveDate; | ||||
| use common::*; | ||||
| use cortex_m_rt::entry; | ||||
| use embassy_executor::Spawner; | ||||
| use embassy_stm32::low_power::{stop_with_rtc, Executor}; | ||||
| use embassy_stm32::low_power::{stop_ready, stop_with_rtc, Executor, StopMode}; | ||||
| use embassy_stm32::rcc::LsConfig; | ||||
| use embassy_stm32::rtc::{Rtc, RtcConfig}; | ||||
| use embassy_stm32::Config; | ||||
| @@ -28,6 +28,7 @@ fn main() -> ! { | ||||
| async fn task_1() { | ||||
|     for _ in 0..9 { | ||||
|         info!("task 1: waiting for 500ms..."); | ||||
|         defmt::assert!(stop_ready(StopMode::Stop2)); | ||||
|         Timer::after_millis(500).await; | ||||
|     } | ||||
| } | ||||
| @@ -36,6 +37,7 @@ async fn task_1() { | ||||
| async fn task_2() { | ||||
|     for _ in 0..5 { | ||||
|         info!("task 2: waiting for 1000ms..."); | ||||
|         defmt::assert!(stop_ready(StopMode::Stop2)); | ||||
|         Timer::after_millis(1000).await; | ||||
|     } | ||||
|  | ||||
|   | ||||
| @@ -18,8 +18,14 @@ teleprobe_meta::target!(b"nucleo-stm32f429zi"); | ||||
| teleprobe_meta::target!(b"nucleo-stm32wb55rg"); | ||||
| #[cfg(feature = "stm32h755zi")] | ||||
| teleprobe_meta::target!(b"nucleo-stm32h755zi"); | ||||
| #[cfg(feature = "stm32h753zi")] | ||||
| teleprobe_meta::target!(b"nucleo-stm32h753zi"); | ||||
| #[cfg(feature = "stm32h7a3zi")] | ||||
| teleprobe_meta::target!(b"nucleo-stm32h7a3zi"); | ||||
| #[cfg(feature = "stm32u585ai")] | ||||
| teleprobe_meta::target!(b"iot-stm32u585ai"); | ||||
| #[cfg(feature = "stm32u5a5zj")] | ||||
| teleprobe_meta::target!(b"nucleo-stm32u5a5zj"); | ||||
| #[cfg(feature = "stm32h563zi")] | ||||
| teleprobe_meta::target!(b"nucleo-stm32h563zi"); | ||||
| #[cfg(feature = "stm32c031c6")] | ||||
| @@ -44,6 +50,8 @@ teleprobe_meta::target!(b"nucleo-stm32f303ze"); | ||||
| teleprobe_meta::target!(b"nucleo-stm32l496zg"); | ||||
| #[cfg(feature = "stm32wl55jc")] | ||||
| teleprobe_meta::target!(b"nucleo-stm32wl55jc"); | ||||
| #[cfg(feature = "stm32wba52cg")] | ||||
| teleprobe_meta::target!(b"nucleo-stm32wba52cg"); | ||||
|  | ||||
| macro_rules! define_peris { | ||||
|     ($($name:ident = $peri:ident,)* $(@irq $irq_name:ident = $irq_code:tt,)*) => { | ||||
| @@ -105,18 +113,30 @@ define_peris!( | ||||
|     SPI = SPI1, SPI_SCK = PA5, SPI_MOSI = PA7, SPI_MISO = PA6, SPI_TX_DMA = DMA1_CH1, SPI_RX_DMA = DMA1_CH2, | ||||
|     @irq UART = {LPUART1 => embassy_stm32::usart::InterruptHandler<embassy_stm32::peripherals::LPUART1>;}, | ||||
| ); | ||||
| #[cfg(feature = "stm32h755zi")] | ||||
| #[cfg(any(feature = "stm32h755zi", feature = "stm32h753zi"))] | ||||
| define_peris!( | ||||
|     UART = USART1, UART_TX = PB6, UART_RX = PB7, UART_TX_DMA = DMA1_CH0, UART_RX_DMA = DMA1_CH1, | ||||
|     SPI = SPI1, SPI_SCK = PA5, SPI_MOSI = PB5, SPI_MISO = PA6, SPI_TX_DMA = DMA1_CH0, SPI_RX_DMA = DMA1_CH1, | ||||
|     @irq UART = {USART1 => embassy_stm32::usart::InterruptHandler<embassy_stm32::peripherals::USART1>;}, | ||||
| ); | ||||
| #[cfg(feature = "stm32h7a3zi")] | ||||
| define_peris!( | ||||
|     UART = USART1, UART_TX = PB6, UART_RX = PB7, UART_TX_DMA = DMA1_CH0, UART_RX_DMA = DMA1_CH1, | ||||
|     SPI = SPI1, SPI_SCK = PA5, SPI_MOSI = PA7, SPI_MISO = PA6, SPI_TX_DMA = DMA1_CH0, SPI_RX_DMA = DMA1_CH1, | ||||
|     @irq UART = {USART1 => embassy_stm32::usart::InterruptHandler<embassy_stm32::peripherals::USART1>;}, | ||||
| ); | ||||
| #[cfg(feature = "stm32u585ai")] | ||||
| define_peris!( | ||||
|     UART = USART3, UART_TX = PD8, UART_RX = PD9, UART_TX_DMA = GPDMA1_CH0, UART_RX_DMA = GPDMA1_CH1, | ||||
|     SPI = SPI1, SPI_SCK = PE13, SPI_MOSI = PE15, SPI_MISO = PE14, SPI_TX_DMA = GPDMA1_CH0, SPI_RX_DMA = GPDMA1_CH1, | ||||
|     @irq UART = {USART3 => embassy_stm32::usart::InterruptHandler<embassy_stm32::peripherals::USART3>;}, | ||||
| ); | ||||
| #[cfg(feature = "stm32u5a5zj")] | ||||
| define_peris!( | ||||
|     UART = LPUART1, UART_TX = PG7, UART_RX = PG8, UART_TX_DMA = GPDMA1_CH0, UART_RX_DMA = GPDMA1_CH1, | ||||
|     SPI = SPI1, SPI_SCK = PA5, SPI_MOSI = PA7, SPI_MISO = PA6, SPI_TX_DMA = GPDMA1_CH0, SPI_RX_DMA = GPDMA1_CH1, | ||||
|     @irq UART = {LPUART1 => embassy_stm32::usart::InterruptHandler<embassy_stm32::peripherals::LPUART1>;}, | ||||
| ); | ||||
| #[cfg(feature = "stm32h563zi")] | ||||
| define_peris!( | ||||
|     UART = LPUART1, UART_TX = PB6, UART_RX = PB7, UART_TX_DMA = GPDMA1_CH0, UART_RX_DMA = GPDMA1_CH1, | ||||
| @@ -189,11 +209,29 @@ define_peris!( | ||||
|     SPI = SPI1, SPI_SCK = PA5, SPI_MOSI = PA7, SPI_MISO = PA6, SPI_TX_DMA = DMA1_CH3, SPI_RX_DMA = DMA1_CH2, | ||||
|     @irq UART = {USART1 => embassy_stm32::usart::InterruptHandler<embassy_stm32::peripherals::USART1>;}, | ||||
| ); | ||||
| #[cfg(feature = "stm32wba52cg")] | ||||
| define_peris!( | ||||
|     UART = LPUART1, UART_TX = PB5, UART_RX = PA10, UART_TX_DMA = GPDMA1_CH0, UART_RX_DMA = GPDMA1_CH1, | ||||
|     SPI = SPI1, SPI_SCK = PB4, SPI_MOSI = PA15, SPI_MISO = PB3, SPI_TX_DMA = GPDMA1_CH0, SPI_RX_DMA = GPDMA1_CH1, | ||||
|     @irq UART = {LPUART1 => embassy_stm32::usart::InterruptHandler<embassy_stm32::peripherals::LPUART1>;}, | ||||
| ); | ||||
|  | ||||
| pub fn config() -> Config { | ||||
|     // Setting this bit is mandatory to use PG[15:2]. | ||||
|     #[cfg(feature = "stm32u5a5zj")] | ||||
|     embassy_stm32::pac::PWR.svmcr().modify(|w| { | ||||
|         w.set_io2sv(true); | ||||
|         w.set_io2vmen(true); | ||||
|     }); | ||||
|  | ||||
|     #[allow(unused_mut)] | ||||
|     let mut config = Config::default(); | ||||
|  | ||||
|     #[cfg(feature = "stm32wb55rg")] | ||||
|     { | ||||
|         config.rcc = embassy_stm32::rcc::WPAN_DEFAULT; | ||||
|     } | ||||
|  | ||||
|     #[cfg(feature = "stm32f207zg")] | ||||
|     { | ||||
|         use embassy_stm32::rcc::*; | ||||
| @@ -274,7 +312,7 @@ pub fn config() -> Config { | ||||
|             mode: HseMode::BypassDigital, | ||||
|         }); | ||||
|         config.rcc.pll1 = Some(Pll { | ||||
|             source: PllSource::Hse, | ||||
|             source: PllSource::HSE, | ||||
|             prediv: PllPreDiv::DIV2, | ||||
|             mul: PllMul::MUL125, | ||||
|             divp: Some(PllDiv::DIV2), | ||||
| @@ -285,18 +323,18 @@ pub fn config() -> Config { | ||||
|         config.rcc.apb1_pre = APBPrescaler::DIV1; | ||||
|         config.rcc.apb2_pre = APBPrescaler::DIV1; | ||||
|         config.rcc.apb3_pre = APBPrescaler::DIV1; | ||||
|         config.rcc.sys = Sysclk::Pll1P; | ||||
|         config.rcc.sys = Sysclk::PLL1_P; | ||||
|         config.rcc.voltage_scale = VoltageScale::Scale0; | ||||
|     } | ||||
|  | ||||
|     #[cfg(feature = "stm32h755zi")] | ||||
|     #[cfg(any(feature = "stm32h755zi", feature = "stm32h753zi"))] | ||||
|     { | ||||
|         use embassy_stm32::rcc::*; | ||||
|         config.rcc.hsi = Some(Hsi::Mhz64); | ||||
|         config.rcc.hsi = Some(HSIPrescaler::DIV1); | ||||
|         config.rcc.csi = true; | ||||
|         config.rcc.hsi48 = true; // needed for RNG | ||||
|         config.rcc.pll_src = PllSource::Hsi; | ||||
|         config.rcc.pll1 = Some(Pll { | ||||
|             source: PllSource::HSI, | ||||
|             prediv: PllPreDiv::DIV4, | ||||
|             mul: PllMul::MUL50, | ||||
|             divp: Some(PllDiv::DIV2), | ||||
| @@ -304,13 +342,14 @@ pub fn config() -> Config { | ||||
|             divr: None, | ||||
|         }); | ||||
|         config.rcc.pll2 = Some(Pll { | ||||
|             source: PllSource::HSI, | ||||
|             prediv: PllPreDiv::DIV4, | ||||
|             mul: PllMul::MUL50, | ||||
|             divp: Some(PllDiv::DIV8), // 100mhz | ||||
|             divq: None, | ||||
|             divr: None, | ||||
|         }); | ||||
|         config.rcc.sys = Sysclk::Pll1P; // 400 Mhz | ||||
|         config.rcc.sys = Sysclk::PLL1_P; // 400 Mhz | ||||
|         config.rcc.ahb_pre = AHBPrescaler::DIV2; // 200 Mhz | ||||
|         config.rcc.apb1_pre = APBPrescaler::DIV2; // 100 Mhz | ||||
|         config.rcc.apb2_pre = APBPrescaler::DIV2; // 100 Mhz | ||||
| @@ -320,18 +359,43 @@ pub fn config() -> Config { | ||||
|         config.rcc.adc_clock_source = AdcClockSource::PLL2_P; | ||||
|     } | ||||
|  | ||||
|     #[cfg(any(feature = "stm32h7a3zi"))] | ||||
|     { | ||||
|         use embassy_stm32::rcc::*; | ||||
|         config.rcc.hsi = Some(HSIPrescaler::DIV1); | ||||
|         config.rcc.csi = true; | ||||
|         config.rcc.hsi48 = true; // needed for RNG | ||||
|         config.rcc.pll1 = Some(Pll { | ||||
|             source: PllSource::HSI, | ||||
|             prediv: PllPreDiv::DIV4, | ||||
|             mul: PllMul::MUL35, | ||||
|             divp: Some(PllDiv::DIV2), // 280 Mhz | ||||
|             divq: Some(PllDiv::DIV8), // SPI1 cksel defaults to pll1_q | ||||
|             divr: None, | ||||
|         }); | ||||
|         config.rcc.pll2 = Some(Pll { | ||||
|             source: PllSource::HSI, | ||||
|             prediv: PllPreDiv::DIV4, | ||||
|             mul: PllMul::MUL35, | ||||
|             divp: Some(PllDiv::DIV8), // 70 Mhz | ||||
|             divq: None, | ||||
|             divr: None, | ||||
|         }); | ||||
|         config.rcc.sys = Sysclk::PLL1_P; // 280 Mhz | ||||
|         config.rcc.ahb_pre = AHBPrescaler::DIV1; // 280 Mhz | ||||
|         config.rcc.apb1_pre = APBPrescaler::DIV2; // 140 Mhz | ||||
|         config.rcc.apb2_pre = APBPrescaler::DIV2; // 140 Mhz | ||||
|         config.rcc.apb3_pre = APBPrescaler::DIV2; // 140 Mhz | ||||
|         config.rcc.apb4_pre = APBPrescaler::DIV2; // 140 Mhz | ||||
|         config.rcc.voltage_scale = VoltageScale::Scale0; | ||||
|         config.rcc.adc_clock_source = AdcClockSource::PLL2_P; | ||||
|     } | ||||
|  | ||||
|     #[cfg(any(feature = "stm32l496zg", feature = "stm32l4a6zg", feature = "stm32l4r5zi"))] | ||||
|     { | ||||
|         use embassy_stm32::rcc::*; | ||||
|         #[cfg(feature = "stm32l4r5zi")] | ||||
|         { | ||||
|             config.rcc.mux = ClockSrc::PLL1_R; | ||||
|         } | ||||
|         #[cfg(not(feature = "stm32l4r5zi"))] | ||||
|         { | ||||
|             config.rcc.mux = ClockSrc::PLL1_P; | ||||
|         } | ||||
|         config.rcc.hsi16 = true; | ||||
|         config.rcc.mux = ClockSrc::PLL1_R; | ||||
|         config.rcc.hsi = true; | ||||
|         config.rcc.pll = Some(Pll { | ||||
|             source: PLLSource::HSI, | ||||
|             prediv: PllPreDiv::DIV1, | ||||
| @@ -345,16 +409,26 @@ pub fn config() -> Config { | ||||
|     #[cfg(feature = "stm32wl55jc")] | ||||
|     { | ||||
|         use embassy_stm32::rcc::*; | ||||
|         config.rcc.mux = ClockSrc::MSI(MSIRange::RANGE32M); | ||||
|         embassy_stm32::pac::RCC.ccipr().modify(|w| { | ||||
|             w.set_rngsel(0b11); // msi | ||||
|         config.rcc.hse = Some(Hse { | ||||
|             freq: Hertz(32_000_000), | ||||
|             mode: HseMode::Bypass, | ||||
|             prescaler: HsePrescaler::DIV1, | ||||
|         }); | ||||
|         config.rcc.mux = ClockSrc::PLL1_R; | ||||
|         config.rcc.pll = Some(Pll { | ||||
|             source: PLLSource::HSE, | ||||
|             prediv: PllPreDiv::DIV2, | ||||
|             mul: PllMul::MUL6, | ||||
|             divp: None, | ||||
|             divq: Some(PllQDiv::DIV2), // PLL1_Q clock (32 / 2 * 6 / 2), used for RNG | ||||
|             divr: Some(PllRDiv::DIV2), // sysclk 48Mhz clock (32 / 2 * 6 / 2) | ||||
|         }); | ||||
|     } | ||||
|  | ||||
|     #[cfg(any(feature = "stm32l552ze"))] | ||||
|     { | ||||
|         use embassy_stm32::rcc::*; | ||||
|         config.rcc.hsi16 = true; | ||||
|         config.rcc.hsi = true; | ||||
|         config.rcc.mux = ClockSrc::PLL1_R; | ||||
|         config.rcc.pll = Some(Pll { | ||||
|             // 110Mhz clock (16 / 4 * 55 / 2) | ||||
| @@ -367,18 +441,28 @@ pub fn config() -> Config { | ||||
|         }); | ||||
|     } | ||||
|  | ||||
|     #[cfg(feature = "stm32u585ai")] | ||||
|     #[cfg(any(feature = "stm32u585ai", feature = "stm32u5a5zj"))] | ||||
|     { | ||||
|         use embassy_stm32::rcc::*; | ||||
|         config.rcc.mux = ClockSrc::MSI(Msirange::RANGE_48MHZ); | ||||
|     } | ||||
|  | ||||
|     #[cfg(feature = "stm32wba52cg")] | ||||
|     { | ||||
|         use embassy_stm32::rcc::*; | ||||
|         config.rcc.mux = ClockSrc::HSI; | ||||
|  | ||||
|         embassy_stm32::pac::RCC.ccipr2().write(|w| { | ||||
|             w.set_rngsel(embassy_stm32::pac::rcc::vals::Rngsel::HSI); | ||||
|         }); | ||||
|     } | ||||
|  | ||||
|     #[cfg(feature = "stm32l073rz")] | ||||
|     { | ||||
|         use embassy_stm32::rcc::*; | ||||
|         config.rcc.mux = ClockSrc::PLL( | ||||
|             // 32Mhz clock (16 * 4 / 2) | ||||
|             PLLSource::HSI16, | ||||
|             PLLSource::HSI, | ||||
|             PLLMul::MUL4, | ||||
|             PLLDiv::DIV2, | ||||
|         ); | ||||
| @@ -389,7 +473,7 @@ pub fn config() -> Config { | ||||
|         use embassy_stm32::rcc::*; | ||||
|         config.rcc.mux = ClockSrc::PLL( | ||||
|             // 32Mhz clock (16 * 4 / 2) | ||||
|             PLLSource::HSI16, | ||||
|             PLLSource::HSI, | ||||
|             PLLMul::MUL4, | ||||
|             PLLDiv::DIV2, | ||||
|         ); | ||||
|   | ||||
		Reference in New Issue
	
	Block a user