Compare commits
	
		
			84 Commits
		
	
	
		
			net-wiznet
			...
			static-cel
		
	
	| Author | SHA1 | Date | |
|---|---|---|---|
|  | 1f51367eb9 | ||
|  | d6f42eafad | ||
|  | dcce8945af | ||
|  | d98c064bfe | ||
|  | a904538555 | ||
|  | 4ef3dc5b90 | ||
|  | bab61f9665 | ||
|  | 2765f0978f | ||
|  | bc07539133 | ||
|  | b4a82b7ed4 | ||
|  | e2688dda22 | ||
|  | d0d8585e4c | ||
|  | 729d69246a | ||
|  | e78a6db151 | ||
|  | f8721c3786 | ||
|  | e519e00265 | ||
|  | 35bb20abe7 | ||
|  | dd6a29adb2 | ||
|  | 5f9602d28b | ||
|  | 74683c706b | ||
|  | 2795e1350d | ||
|  | aed3e5674f | ||
|  | d941882066 | ||
|  | 3f74ff7235 | ||
|  | 9cead47212 | ||
|  | 78739d4aa9 | ||
|  | e07e790613 | ||
|  | ca283eed0c | ||
|  | 57edf289ea | ||
|  | 3912f5d67b | ||
|  | c9b50e46a5 | ||
|  | ad07ea0290 | ||
|  | 573734008a | ||
|  | f4a78e00a7 | ||
|  | 0d6094c8b1 | ||
|  | 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 | 
							
								
								
									
										12
									
								
								ci.sh
									
									
									
									
									
								
							
							
						
						
									
										12
									
								
								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,16 @@ cargo batch  \ | ||||
|  | ||||
| rm out/tests/stm32wb55rg/wpan_mac | ||||
| rm out/tests/stm32wb55rg/wpan_ble | ||||
|  | ||||
| # unstable | ||||
| rm out/tests/stm32f429zi/stop | ||||
|  | ||||
| # 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 | ||||
|   | ||||
| @@ -1,6 +1,6 @@ | ||||
| #![no_std] | ||||
| #![allow(incomplete_features)] | ||||
| #![feature(async_fn_in_trait)] | ||||
| #![allow(stable_features, unknown_lints, async_fn_in_trait)] | ||||
|  | ||||
| use core::slice; | ||||
|  | ||||
|   | ||||
| @@ -12,7 +12,7 @@ firmware-logs = [] | ||||
|  | ||||
| [dependencies] | ||||
| embassy-time = { version = "0.1.5", path = "../embassy-time"} | ||||
| embassy-sync = { version = "0.3.0", path = "../embassy-sync"} | ||||
| embassy-sync = { version = "0.4.0", path = "../embassy-sync"} | ||||
| embassy-futures = { version = "0.1.0", path = "../embassy-futures"} | ||||
| embassy-net-driver-channel = { version = "0.2.0", path = "../embassy-net-driver-channel"} | ||||
|  | ||||
|   | ||||
| @@ -4,7 +4,6 @@ use embassy_net_driver_channel as ch; | ||||
| use embassy_net_driver_channel::driver::{HardwareAddress, LinkState}; | ||||
| use embassy_time::Timer; | ||||
|  | ||||
| pub use crate::bus::SpiBusCyw43; | ||||
| use crate::consts::*; | ||||
| use crate::events::{Event, EventSubscriber, Events}; | ||||
| use crate::fmt::Bytes; | ||||
|   | ||||
| @@ -1,7 +1,7 @@ | ||||
| #![no_std] | ||||
| #![no_main] | ||||
| #![allow(incomplete_features)] | ||||
| #![feature(async_fn_in_trait, type_alias_impl_trait, concat_bytes)] | ||||
| #![allow(stable_features, unknown_lints, async_fn_in_trait)] | ||||
| #![deny(unused_must_use)] | ||||
|  | ||||
| // This mod MUST go first, so that the others see its macros. | ||||
|   | ||||
| @@ -28,7 +28,7 @@ digest = "0.10" | ||||
| log = { version = "0.4", optional = true  } | ||||
| ed25519-dalek = { version = "1.0.1", default_features = false, features = ["u32_backend"], optional = true } | ||||
| embassy-embedded-hal = { version = "0.1.0", path = "../../embassy-embedded-hal" } | ||||
| embassy-sync = { version = "0.3.0", path = "../../embassy-sync" } | ||||
| embassy-sync = { version = "0.4.0", path = "../../embassy-sync" } | ||||
| embedded-storage = "0.3.0" | ||||
| embedded-storage-async = { version = "0.4.0", optional = true } | ||||
| salty = { git = "https://github.com/ycrypto/salty.git", rev = "a9f17911a5024698406b75c0fac56ab5ccf6a8c7", optional = true } | ||||
|   | ||||
| @@ -1,4 +1,5 @@ | ||||
| #![cfg_attr(feature = "nightly", feature(async_fn_in_trait))] | ||||
| #![cfg_attr(feature = "nightly", allow(stable_features, unknown_lints, async_fn_in_trait))] | ||||
| #![no_std] | ||||
| #![warn(missing_docs)] | ||||
| #![doc = include_str!("../README.md")] | ||||
|   | ||||
| @@ -16,7 +16,7 @@ target = "thumbv7em-none-eabi" | ||||
| [dependencies] | ||||
| defmt = { version = "0.3", optional = true } | ||||
|  | ||||
| embassy-sync = { path = "../../embassy-sync" } | ||||
| embassy-sync = { version = "0.4.0", path = "../../embassy-sync" } | ||||
| embassy-nrf = { path = "../../embassy-nrf" } | ||||
| embassy-boot = { path = "../boot", default-features = false } | ||||
| cortex-m = { version = "0.7.6" } | ||||
|   | ||||
| @@ -17,7 +17,7 @@ defmt = { version = "0.3", optional = true } | ||||
| defmt-rtt = { version = "0.4", optional = true } | ||||
| log = { version = "0.4", optional = true } | ||||
|  | ||||
| embassy-sync = { path = "../../embassy-sync" } | ||||
| embassy-sync = { version = "0.4.0", path = "../../embassy-sync" } | ||||
| embassy-rp = { path = "../../embassy-rp", default-features = false } | ||||
| embassy-boot = { path = "../boot", default-features = false } | ||||
| embassy-time = { path = "../../embassy-time" } | ||||
|   | ||||
| @@ -18,7 +18,7 @@ defmt = { version = "0.3", optional = true } | ||||
| defmt-rtt = { version = "0.4", optional = true } | ||||
| log = { version = "0.4", optional = true } | ||||
|  | ||||
| embassy-sync = { path = "../../embassy-sync" } | ||||
| embassy-sync = { version = "0.4.0", path = "../../embassy-sync" } | ||||
| embassy-stm32 = { path = "../../embassy-stm32", default-features = false } | ||||
| embassy-boot = { path = "../boot", default-features = false } | ||||
| cortex-m = { version = "0.7.6" } | ||||
|   | ||||
| @@ -20,7 +20,7 @@ default = ["time"] | ||||
|  | ||||
| [dependencies] | ||||
| embassy-futures = { version = "0.1.0", path = "../embassy-futures", optional = true } | ||||
| embassy-sync = { version = "0.3.0", path = "../embassy-sync" } | ||||
| embassy-sync = { version = "0.4.0", path = "../embassy-sync" } | ||||
| embassy-time = { version = "0.1.5", path = "../embassy-time", optional = true } | ||||
| embedded-hal-02 = { package = "embedded-hal", version = "0.2.6", features = [ | ||||
|     "unproven", | ||||
|   | ||||
| @@ -1,5 +1,6 @@ | ||||
| #![cfg_attr(not(feature = "std"), no_std)] | ||||
| #![cfg_attr(feature = "nightly", feature(async_fn_in_trait, try_blocks))] | ||||
| #![cfg_attr(feature = "nightly", feature(async_fn_in_trait, impl_trait_projections, try_blocks))] | ||||
| #![cfg_attr(feature = "nightly", allow(stable_features, unknown_lints, async_fn_in_trait))] | ||||
| #![warn(missing_docs)] | ||||
|  | ||||
| //! Utilities to use `embedded-hal` traits with Embassy. | ||||
|   | ||||
| @@ -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.3.1 - 2023-11-01 | ||||
|  | ||||
| - Fix spurious "Found waker not created by the Embassy executor" error in recent nightlies. | ||||
|  | ||||
| ## 0.3.0 - 2023-08-25 | ||||
|  | ||||
| - Replaced Pender. Implementations now must define an extern function called `__pender`. | ||||
|   | ||||
| @@ -1,6 +1,6 @@ | ||||
| [package] | ||||
| name = "embassy-executor" | ||||
| version = "0.3.0" | ||||
| version = "0.3.1" | ||||
| edition = "2021" | ||||
| license = "MIT OR Apache-2.0" | ||||
| description = "async/await executor designed for embedded usage" | ||||
| @@ -62,7 +62,6 @@ embassy-macros = { version = "0.2.1", path = "../embassy-macros" } | ||||
| embassy-time = { version = "0.1.5", path = "../embassy-time", optional = true} | ||||
| atomic-polyfill = "1.0.1" | ||||
| critical-section = "1.1" | ||||
| static_cell = "1.1" | ||||
|  | ||||
| # arch-cortex-m dependencies | ||||
| cortex-m = { version = "0.7.6", optional = true } | ||||
|   | ||||
| @@ -33,6 +33,7 @@ check_at_most_one!("arch-cortex-m", "arch-riscv32", "arch-xtensa", "arch-std", " | ||||
| mod arch; | ||||
|  | ||||
| #[cfg(feature = "_arch")] | ||||
| #[allow(unused_imports)] // don't warn if the module is empty. | ||||
| pub use arch::*; | ||||
|  | ||||
| pub mod raw; | ||||
| @@ -46,7 +47,6 @@ pub use spawner::*; | ||||
| pub mod _export { | ||||
|     #[cfg(feature = "rtos-trace")] | ||||
|     pub use rtos_trace::trace; | ||||
|     pub use static_cell::StaticCell; | ||||
|  | ||||
|     /// Expands the given block of code when `embassy-executor` is compiled with | ||||
|     /// the `rtos-trace-interrupt` feature. | ||||
|   | ||||
| @@ -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) | ||||
|   | ||||
| @@ -21,7 +21,7 @@ defmt = { version = "0.3", optional = true } | ||||
| log = { version = "0.4.14", optional = true } | ||||
|  | ||||
| embassy-time = { version = "0.1.5", path = "../embassy-time", optional = true } | ||||
| embassy-sync = { version = "0.3.0", path = "../embassy-sync" } | ||||
| embassy-sync = { version = "0.4.0", path = "../embassy-sync" } | ||||
| embassy-stm32 = { version = "0.1.0", path = "../embassy-stm32", default-features = false, optional = true } | ||||
| embedded-hal-async = { version = "=1.0.0-rc.1" } | ||||
| embedded-hal = { version = "0.2", features = ["unproven"] } | ||||
|   | ||||
| @@ -1,5 +1,6 @@ | ||||
| #![no_std] | ||||
| #![feature(async_fn_in_trait)] | ||||
| #![feature(async_fn_in_trait, impl_trait_projections)] | ||||
| #![allow(stable_features, unknown_lints, async_fn_in_trait)] | ||||
| //! embassy-lora holds LoRa-specific functionality. | ||||
|  | ||||
| pub(crate) mod fmt; | ||||
|   | ||||
| @@ -53,8 +53,7 @@ pub fn wasm() -> TokenStream { | ||||
|     quote! { | ||||
|         #[wasm_bindgen::prelude::wasm_bindgen(start)] | ||||
|         pub fn main() -> Result<(), wasm_bindgen::JsValue> { | ||||
|             static EXECUTOR: ::embassy_executor::_export::StaticCell<::embassy_executor::Executor> = ::embassy_executor::_export::StaticCell::new(); | ||||
|             let executor = EXECUTOR.init(::embassy_executor::Executor::new()); | ||||
|             let executor = ::std::boxed::Box::leak(::std::boxed::Box::new(::embassy_executor::Executor::new())); | ||||
|  | ||||
|             executor.start(|spawner| { | ||||
|                 spawner.spawn(__embassy_main(spawner)).unwrap(); | ||||
|   | ||||
| @@ -22,9 +22,7 @@ embassy-futures = { version = "0.1.0", path = "../embassy-futures" } | ||||
| bitfield = "0.14.0" | ||||
|  | ||||
| [dev-dependencies] | ||||
| # reenable when https://github.com/dbrgn/embedded-hal-mock/pull/86 is merged. | ||||
| #embedded-hal-mock = { git = "https://github.com/dbrgn/embedded-hal-mock", branch = "1-alpha", features = ["embedded-hal-async", "eh1"] }] } | ||||
| embedded-hal-mock = { git = "https://github.com/newAM/embedded-hal-mock", branch = "eh1-rc.1", features = ["embedded-hal-async", "eh1"] } | ||||
| embedded-hal-mock = { version = "=0.10.0-rc.1", features = ["embedded-hal-async", "eh1"] } | ||||
| crc = "3.0.1" | ||||
| env_logger = "0.10" | ||||
| critical-section = { version = "1.1.2", features = ["std"] } | ||||
|   | ||||
| @@ -1,5 +1,6 @@ | ||||
| #![deny(clippy::pedantic)] | ||||
| #![feature(async_fn_in_trait)] | ||||
| #![allow(stable_features, unknown_lints, async_fn_in_trait)] | ||||
| #![cfg_attr(not(any(test, feature = "std")), no_std)] | ||||
| #![allow(clippy::module_name_repetitions)] | ||||
| #![allow(clippy::missing_errors_doc)] | ||||
|   | ||||
| @@ -24,6 +24,6 @@ features = ["defmt"] | ||||
| defmt = { version = "0.3", optional = true } | ||||
| log = { version = "0.4.14", optional = true } | ||||
|  | ||||
| embassy-sync = { version = "0.3.0", path = "../embassy-sync" } | ||||
| embassy-sync = { version = "0.4.0", path = "../embassy-sync" } | ||||
| embassy-futures = { version = "0.1.0", path = "../embassy-futures" } | ||||
| embassy-net-driver = { version = "0.2.0", path = "../embassy-net-driver" } | ||||
|   | ||||
| @@ -8,7 +8,7 @@ defmt = { version = "0.3", optional = true } | ||||
| log = { version = "0.4.14", optional = true } | ||||
|  | ||||
| embassy-time = { version = "0.1.5", path = "../embassy-time" } | ||||
| embassy-sync = { version = "0.3.0", path = "../embassy-sync"} | ||||
| embassy-sync = { version = "0.4.0", path = "../embassy-sync"} | ||||
| embassy-futures = { version = "0.1.0", path = "../embassy-futures"} | ||||
| embassy-net-driver-channel = { version = "0.2.0", path = "../embassy-net-driver-channel"} | ||||
|  | ||||
|   | ||||
| @@ -19,7 +19,7 @@ embedded-io-async = { version = "0.6.0" } | ||||
| embassy-net-driver-channel = { version = "0.2.0", path = "../embassy-net-driver-channel" } | ||||
| embassy-futures = { version = "0.1.0", path = "../embassy-futures" } | ||||
| ppproto = { version = "0.1.2"} | ||||
| embassy-sync = { version = "0.3.0", path = "../embassy-sync" } | ||||
| embassy-sync = { version = "0.4.0", path = "../embassy-sync" } | ||||
|  | ||||
| [package.metadata.embassy_docs] | ||||
| src_base = "https://github.com/embassy-rs/embassy/blob/embassy-net-ppp-v$VERSION/embassy-net-ppp/src/" | ||||
|   | ||||
| @@ -1,5 +1,6 @@ | ||||
| #![no_std] | ||||
| #![feature(async_fn_in_trait)] | ||||
| #![allow(stable_features, unknown_lints, async_fn_in_trait)] | ||||
| #![doc = include_str!("../README.md")] | ||||
|  | ||||
| pub mod chip; | ||||
|   | ||||
| @@ -5,6 +5,11 @@ 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.2.1 - 2023-10-31 | ||||
|  | ||||
| - Re-add impl_trait_projections | ||||
| - Fix: Reset DHCP socket when the link up is detected  | ||||
|  | ||||
| ## 0.2.0 - 2023-10-18 | ||||
|  | ||||
| - Re-export `smoltcp::wire::IpEndpoint` | ||||
|   | ||||
| @@ -1,6 +1,6 @@ | ||||
| [package] | ||||
| name = "embassy-net" | ||||
| version = "0.2.0" | ||||
| version = "0.2.1" | ||||
| edition = "2021" | ||||
| license = "MIT OR Apache-2.0" | ||||
| description = "Async TCP/IP network stack for embedded systems" | ||||
| @@ -53,7 +53,7 @@ smoltcp = { version = "0.10.0", default-features = false, features = [ | ||||
|  | ||||
| embassy-net-driver = { version = "0.2.0", path = "../embassy-net-driver" } | ||||
| embassy-time = { version = "0.1.5", path = "../embassy-time" } | ||||
| embassy-sync = { version = "0.3.0", path = "../embassy-sync" } | ||||
| embassy-sync = { version = "0.4.0", path = "../embassy-sync" } | ||||
| embedded-io-async = { version = "0.6.0", optional = true } | ||||
|  | ||||
| managed = { version = "0.8.0", default-features = false, features = [ "map" ] } | ||||
|   | ||||
| @@ -1,5 +1,6 @@ | ||||
| #![cfg_attr(not(feature = "std"), no_std)] | ||||
| #![cfg_attr(feature = "nightly", feature(async_fn_in_trait))] | ||||
| #![cfg_attr(feature = "nightly", feature(async_fn_in_trait, impl_trait_projections))] | ||||
| #![cfg_attr(feature = "nightly", allow(stable_features, unknown_lints, async_fn_in_trait))] | ||||
| #![warn(missing_docs)] | ||||
| #![doc = include_str!("../README.md")] | ||||
|  | ||||
| @@ -860,6 +861,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) => { | ||||
|   | ||||
| @@ -95,7 +95,7 @@ _nrf52832_anomaly_109 = [] | ||||
|  | ||||
| [dependencies] | ||||
| embassy-time = { version = "0.1.5", path = "../embassy-time", optional = true } | ||||
| embassy-sync = { version = "0.3.0", path = "../embassy-sync" } | ||||
| embassy-sync = { version = "0.4.0", path = "../embassy-sync" } | ||||
| embassy-hal-internal = {version = "0.1.0", path = "../embassy-hal-internal", features = ["cortex-m", "prio-bits-3"] } | ||||
| embassy-embedded-hal = {version = "0.1.0", path = "../embassy-embedded-hal" } | ||||
| embassy-usb-driver = {version = "0.1.0", path = "../embassy-usb-driver", optional=true } | ||||
| @@ -110,7 +110,6 @@ defmt = { version = "0.3", optional = true } | ||||
| log = { version = "0.4.14", optional = true } | ||||
| cortex-m-rt = ">=0.6.15,<0.8" | ||||
| cortex-m = "0.7.6" | ||||
| futures = { version = "0.3.17", default-features = false } | ||||
| critical-section = "1.1" | ||||
| rand_core = "0.6.3" | ||||
| fixed = "1.10.0" | ||||
|   | ||||
| @@ -1,5 +1,6 @@ | ||||
| #![no_std] | ||||
| #![cfg_attr(feature = "nightly", feature(async_fn_in_trait))] | ||||
| #![cfg_attr(feature = "nightly", feature(async_fn_in_trait, impl_trait_projections))] | ||||
| #![cfg_attr(feature = "nightly", allow(stable_features, unknown_lints, async_fn_in_trait))] | ||||
| #![doc = include_str!("../README.md")] | ||||
| #![warn(missing_docs)] | ||||
|  | ||||
|   | ||||
| @@ -2,6 +2,7 @@ | ||||
|  | ||||
| #![macro_use] | ||||
|  | ||||
| use core::future::poll_fn; | ||||
| use core::marker::PhantomData; | ||||
| use core::sync::atomic::{compiler_fence, Ordering}; | ||||
| use core::task::Poll; | ||||
| @@ -9,7 +10,6 @@ use core::task::Poll; | ||||
| use embassy_hal_internal::drop::OnDrop; | ||||
| use embassy_hal_internal::{into_ref, PeripheralRef}; | ||||
| use fixed::types::I7F1; | ||||
| use futures::future::poll_fn; | ||||
|  | ||||
| use crate::chip::EASY_DMA_SIZE; | ||||
| use crate::gpio::sealed::Pin; | ||||
|   | ||||
| @@ -59,7 +59,7 @@ nightly = ["embedded-hal-1", "embedded-hal-async", "embedded-storage-async", "em | ||||
| unstable-traits = ["embedded-hal-1", "embedded-hal-nb"] | ||||
|  | ||||
| [dependencies] | ||||
| embassy-sync = { version = "0.3.0", path = "../embassy-sync" } | ||||
| embassy-sync = { version = "0.4.0", path = "../embassy-sync" } | ||||
| embassy-time = { version = "0.1.5", path = "../embassy-time", features = [ "tick-hz-1_000_000" ] } | ||||
| embassy-futures = { version = "0.1.0", path = "../embassy-futures" } | ||||
| embassy-hal-internal = {version = "0.1.0", path = "../embassy-hal-internal", features = ["cortex-m", "prio-bits-2"] } | ||||
| @@ -94,5 +94,5 @@ pio = {version= "0.2.1" } | ||||
| rp2040-boot2 = "0.3" | ||||
|  | ||||
| [dev-dependencies] | ||||
| embassy-executor = { version = "0.3.0", path = "../embassy-executor", features = ["nightly", "arch-std", "executor-thread"] } | ||||
| static_cell = "1.1" | ||||
| embassy-executor = { version = "0.3.1", path = "../embassy-executor", features = ["nightly", "arch-std", "executor-thread"] } | ||||
| static_cell = { version = "2" } | ||||
|   | ||||
| @@ -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; | ||||
|     } | ||||
| } | ||||
|   | ||||
| @@ -1,5 +1,6 @@ | ||||
| #![no_std] | ||||
| #![cfg_attr(feature = "nightly", feature(async_fn_in_trait))] | ||||
| #![cfg_attr(feature = "nightly", feature(async_fn_in_trait, impl_trait_projections))] | ||||
| #![cfg_attr(feature = "nightly", allow(stable_features, unknown_lints, async_fn_in_trait))] | ||||
|  | ||||
| // This mod MUST go first, so that the others see its macros. | ||||
| pub(crate) mod fmt; | ||||
|   | ||||
| @@ -12,7 +12,7 @@ features = ["stm32wb55rg"] | ||||
|  | ||||
| [dependencies] | ||||
| embassy-stm32 = { version = "0.1.0", path = "../embassy-stm32" } | ||||
| embassy-sync = { version = "0.3.0", path = "../embassy-sync" } | ||||
| embassy-sync = { version = "0.4.0", path = "../embassy-sync" } | ||||
| embassy-time = { version = "0.1.5", path = "../embassy-time", optional = true } | ||||
| embassy-futures = { version = "0.1.0", path = "../embassy-futures" } | ||||
| embassy-hal-internal = { version = "0.1.0", path = "../embassy-hal-internal" } | ||||
|   | ||||
| @@ -1,5 +1,9 @@ | ||||
| #![no_std] | ||||
| #![cfg_attr(any(feature = "ble", feature = "mac"), feature(async_fn_in_trait))] | ||||
| #![cfg_attr( | ||||
|     any(feature = "ble", feature = "mac"), | ||||
|     allow(stable_features, unknown_lints, async_fn_in_trait) | ||||
| )] | ||||
| #![cfg_attr(feature = "mac", feature(type_alias_impl_trait, concat_bytes))] | ||||
|  | ||||
| // This must go FIRST so that all the other modules see its macros. | ||||
|   | ||||
| @@ -1,4 +1,3 @@ | ||||
| #![allow(incomplete_features)] | ||||
| #![deny(unused_must_use)] | ||||
|  | ||||
| use core::task::Context; | ||||
|   | ||||
| @@ -32,14 +32,14 @@ flavors = [ | ||||
| ] | ||||
|  | ||||
| [dependencies] | ||||
| embassy-sync = { version = "0.3.0", path = "../embassy-sync" } | ||||
| embassy-sync = { version = "0.4.0", path = "../embassy-sync" } | ||||
| embassy-time = { version = "0.1.5", path = "../embassy-time", optional = true } | ||||
| embassy-futures = { version = "0.1.0", path = "../embassy-futures" } | ||||
| embassy-hal-internal = {version = "0.1.0", path = "../embassy-hal-internal", features = ["cortex-m", "prio-bits-4"] } | ||||
| embassy-embedded-hal = {version = "0.1.0", path = "../embassy-embedded-hal" } | ||||
| embassy-net-driver = { version = "0.2.0", path = "../embassy-net-driver" } | ||||
| embassy-usb-driver = {version = "0.1.0", path = "../embassy-usb-driver", optional = true } | ||||
| embassy-executor = { version = "0.3.0", path = "../embassy-executor", optional = true } | ||||
| embassy-executor = { version = "0.3.1", path = "../embassy-executor", optional = true } | ||||
|  | ||||
| embedded-hal-02 = { package = "embedded-hal", version = "0.2.6", features = ["unproven"] } | ||||
| embedded-hal-1 = { package = "embedded-hal", version = "=1.0.0-rc.1", optional = true} | ||||
| @@ -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-73b8c37ae74fc28b247188c989fd99400611bd6b" } | ||||
| 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-73b8c37ae74fc28b247188c989fd99400611bd6b", 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 }; | ||||
|                     } | ||||
|                 } | ||||
|  | ||||
|   | ||||
| @@ -47,6 +47,9 @@ pub unsafe fn on_irq() { | ||||
|     #[cfg(any(exti_c0, exti_g0, exti_l5, exti_u5, exti_h5, exti_h50))] | ||||
|     let bits = EXTI.rpr(0).read().0 | EXTI.fpr(0).read().0; | ||||
|  | ||||
|     // We don't handle or change any EXTI lines above 16. | ||||
|     let bits = bits & 0x0000FFFF; | ||||
|  | ||||
|     // Mask all the channels that fired. | ||||
|     cpu_regs().imr(0).modify(|w| w.0 &= !bits); | ||||
|  | ||||
|   | ||||
| @@ -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); | ||||
|     }); | ||||
| } | ||||
|   | ||||
| @@ -1,5 +1,6 @@ | ||||
| #![cfg_attr(not(test), no_std)] | ||||
| #![cfg_attr(feature = "nightly", feature(async_fn_in_trait))] | ||||
| #![cfg_attr(feature = "nightly", feature(async_fn_in_trait, impl_trait_projections))] | ||||
| #![cfg_attr(feature = "nightly", allow(stable_features, unknown_lints, async_fn_in_trait))] | ||||
|  | ||||
| //! ## Feature flags | ||||
| #![doc = document_features::document_features!(feature_label = r#"<span class="stab portability"><code>{feature}</code></span>"#)] | ||||
| @@ -226,9 +227,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 | ||||
| @@ -53,7 +61,7 @@ pub struct Executor { | ||||
| impl Executor { | ||||
|     /// Create a new Executor. | ||||
|     pub fn take() -> &'static mut Self { | ||||
|         unsafe { | ||||
|         critical_section::with(|_| unsafe { | ||||
|             assert!(EXECUTOR.is_none()); | ||||
|  | ||||
|             EXECUTOR = Some(Self { | ||||
| @@ -64,7 +72,7 @@ impl Executor { | ||||
|             }); | ||||
|  | ||||
|             EXECUTOR.as_mut().unwrap() | ||||
|         } | ||||
|         }) | ||||
|     } | ||||
|  | ||||
|     unsafe fn on_wakeup_irq(&mut self) { | ||||
| @@ -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 { | ||||
|   | ||||
| @@ -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)); | ||||
| @@ -326,15 +326,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,7 +1,10 @@ | ||||
| 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, | ||||
|     Adcsel as AdcClockSource, 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}; | ||||
| @@ -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 | ||||
| @@ -30,17 +52,18 @@ pub struct Pll { | ||||
|     pub divr: Option<PllRDiv>, | ||||
| } | ||||
|  | ||||
| /// Clocks configutation | ||||
| /// Clocks configuration | ||||
| 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,12 +73,19 @@ 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 | ||||
|     pub ls: super::LsConfig, | ||||
|  | ||||
|     pub adc_clock_source: AdcClockSource, | ||||
| } | ||||
|  | ||||
| impl Default for Config { | ||||
| @@ -63,30 +93,71 @@ 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(), | ||||
|             adc_clock_source: AdcClockSource::SYS, | ||||
|         } | ||||
|     } | ||||
| } | ||||
|  | ||||
| #[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, | ||||
|     adc_clock_source: AdcClockSource::SYS, | ||||
| }; | ||||
|  | ||||
| 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 +182,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 +199,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 +231,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 +239,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 +248,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 +258,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 +289,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 +348,34 @@ pub(crate) unsafe fn init(config: Config) { | ||||
|     }); | ||||
|     while RCC.cfgr().read().sws() != config.mux {} | ||||
|  | ||||
|     let ahb_freq = sys_clk / config.ahb_pre; | ||||
|     #[cfg(stm32l5)] | ||||
|     RCC.ccipr1().modify(|w| w.set_adcsel(config.adc_clock_source)); | ||||
|     #[cfg(not(stm32l5))] | ||||
|     RCC.ccipr().modify(|w| w.set_adcsel(config.adc_clock_source)); | ||||
|  | ||||
|     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 +414,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 +507,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 +526,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,64 @@ 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 { | ||||
|     #[cfg(not(rtc_v2f2))] | ||||
|     pub(super) const fn from(second: u8, subsecond: u16) -> Result<Self, Error> { | ||||
|         if second > 59 { | ||||
|             Err(Error::InvalidSecond) | ||||
|         } else { | ||||
|             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 +88,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")] | ||||
| @@ -77,13 +199,13 @@ impl From<DateTime> for chrono::NaiveDateTime { | ||||
| #[derive(Copy, Clone, Debug, PartialEq, Eq, Ord, PartialOrd, Hash)] | ||||
| #[allow(missing_docs)] | ||||
| pub enum DayOfWeek { | ||||
|     Monday = 0, | ||||
|     Tuesday = 1, | ||||
|     Wednesday = 2, | ||||
|     Thursday = 3, | ||||
|     Friday = 4, | ||||
|     Saturday = 5, | ||||
|     Sunday = 6, | ||||
|     Monday = 1, | ||||
|     Tuesday = 2, | ||||
|     Wednesday = 3, | ||||
|     Thursday = 4, | ||||
|     Friday = 5, | ||||
|     Saturday = 6, | ||||
|     Sunday = 7, | ||||
| } | ||||
|  | ||||
| #[cfg(feature = "chrono")] | ||||
| @@ -108,92 +230,19 @@ impl From<DayOfWeek> for chrono::Weekday { | ||||
|     } | ||||
| } | ||||
|  | ||||
| fn day_of_week_from_u8(v: u8) -> Result<DayOfWeek, Error> { | ||||
| pub(super) const fn day_of_week_from_u8(v: u8) -> Result<DayOfWeek, Error> { | ||||
|     Ok(match v { | ||||
|         0 => DayOfWeek::Monday, | ||||
|         1 => DayOfWeek::Tuesday, | ||||
|         2 => DayOfWeek::Wednesday, | ||||
|         3 => DayOfWeek::Thursday, | ||||
|         4 => DayOfWeek::Friday, | ||||
|         5 => DayOfWeek::Saturday, | ||||
|         6 => DayOfWeek::Sunday, | ||||
|         1 => DayOfWeek::Monday, | ||||
|         2 => DayOfWeek::Tuesday, | ||||
|         3 => DayOfWeek::Wednesday, | ||||
|         4 => DayOfWeek::Thursday, | ||||
|         5 => DayOfWeek::Friday, | ||||
|         6 => DayOfWeek::Saturday, | ||||
|         7 => DayOfWeek::Sunday, | ||||
|         x => return Err(Error::InvalidDayOfWeek(x)), | ||||
|     }) | ||||
| } | ||||
|  | ||||
| pub(super) fn day_of_week_to_u8(dotw: DayOfWeek) -> u8 { | ||||
| pub(super) const fn day_of_week_to_u8(dotw: DayOfWeek) -> u8 { | ||||
|     dotw as u8 | ||||
| } | ||||
|  | ||||
| pub(super) fn validate_datetime(dt: &DateTime) -> Result<(), Error> { | ||||
|     if dt.year > 4095 { | ||||
|         Err(Error::InvalidYear) | ||||
|     } else if dt.month < 1 || dt.month > 12 { | ||||
|         Err(Error::InvalidMonth) | ||||
|     } else if dt.day < 1 || dt.day > 31 { | ||||
|         Err(Error::InvalidDay) | ||||
|     } else if dt.hour > 23 { | ||||
|         Err(Error::InvalidHour) | ||||
|     } else if dt.minute > 59 { | ||||
|         Err(Error::InvalidMinute) | ||||
|     } else if dt.second > 59 { | ||||
|         Err(Error::InvalidSecond) | ||||
|     } else { | ||||
|         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,11 @@ use embassy_sync::blocking_mutex::raw::CriticalSectionRawMutex; | ||||
| #[cfg(feature = "low-power")] | ||||
| use embassy_sync::blocking_mutex::Mutex; | ||||
|  | ||||
| use self::datetime::day_of_week_to_u8; | ||||
| #[cfg(not(rtc_v2f2))] | ||||
| use self::datetime::RtcInstant; | ||||
| pub use self::datetime::{DateTime, DayOfWeek, Error as DateTimeError}; | ||||
| use crate::pac::rtc::regs::{Dr, Tr}; | ||||
| use crate::time::Hertz; | ||||
|  | ||||
| /// refer to AN4759 to compare features of RTC2 and RTC3 | ||||
| @@ -30,112 +34,77 @@ use crate::peripherals::RTC; | ||||
| use crate::rtc::sealed::Instance; | ||||
|  | ||||
| /// Errors that can occur on methods on [RtcClock] | ||||
| #[non_exhaustive] | ||||
| #[derive(Clone, Debug, PartialEq, Eq)] | ||||
| pub enum RtcError { | ||||
|     /// An invalid DateTime was given or stored on the hardware. | ||||
|     InvalidDateTime(DateTimeError), | ||||
|  | ||||
|     /// The current time could not be read | ||||
|     ReadFailure, | ||||
|  | ||||
|     /// The RTC clock is not running | ||||
|     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: (), | ||||
| } | ||||
|  | ||||
| impl RtcTimeProvider { | ||||
|     #[cfg(not(rtc_v2f2))] | ||||
|     pub(crate) fn instant(&self) -> Result<RtcInstant, RtcError> { | ||||
|         self.read(|_, tr, ss| { | ||||
|             let second = bcd2_to_byte((tr.st(), tr.su())); | ||||
|  | ||||
|             RtcInstant::from(second, ss).map_err(RtcError::InvalidDateTime) | ||||
|         }) | ||||
|     } | ||||
|  | ||||
|     /// Return the current datetime. | ||||
|     /// | ||||
|     /// # Errors | ||||
|     /// | ||||
|     /// Will return an `RtcError::InvalidDateTime` if the stored value in the system is not a valid [`DayOfWeek`]. | ||||
|     pub fn now(&self) -> Result<DateTime, RtcError> { | ||||
|         // For RM0433 we use BYPSHAD=1 to work around errata ES0392 2.19.1 | ||||
|         #[cfg(rcc_h7rm0433)] | ||||
|         loop { | ||||
|             let r = RTC::regs(); | ||||
|             let ss = r.ssr().read().ss(); | ||||
|             let dr = r.dr().read(); | ||||
|             let tr = r.tr().read(); | ||||
|  | ||||
|             // If an RTCCLK edge occurs during read we may see inconsistent values | ||||
|             // so read ssr again and see if it has changed. (see RM0433 Rev 7 46.3.9) | ||||
|             let ss_after = r.ssr().read().ss(); | ||||
|             if ss == ss_after { | ||||
|                 let second = bcd2_to_byte((tr.st(), tr.su())); | ||||
|                 let minute = bcd2_to_byte((tr.mnt(), tr.mnu())); | ||||
|                 let hour = bcd2_to_byte((tr.ht(), tr.hu())); | ||||
|  | ||||
|                 let weekday = dr.wdu(); | ||||
|                 let day = bcd2_to_byte((dr.dt(), dr.du())); | ||||
|                 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) | ||||
|                     .map_err(RtcError::InvalidDateTime); | ||||
|             } | ||||
|         } | ||||
|  | ||||
|         #[cfg(not(rcc_h7rm0433))] | ||||
|         { | ||||
|             let r = RTC::regs(); | ||||
|             let tr = r.tr().read(); | ||||
|         self.read(|dr, tr, _| { | ||||
|             let second = bcd2_to_byte((tr.st(), tr.su())); | ||||
|             let minute = bcd2_to_byte((tr.mnt(), tr.mnu())); | ||||
|             let hour = bcd2_to_byte((tr.ht(), tr.hu())); | ||||
|             // Reading either RTC_SSR or RTC_TR locks the values in the higher-order | ||||
|             // calendar shadow registers until RTC_DR is read. | ||||
|             let dr = r.dr().read(); | ||||
|  | ||||
|             let weekday = dr.wdu(); | ||||
|             let day = bcd2_to_byte((dr.dt(), dr.du())); | ||||
|             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) | ||||
|         }) | ||||
|     } | ||||
|  | ||||
|     fn read<R>(&self, mut f: impl FnMut(Dr, Tr, u16) -> Result<R, RtcError>) -> Result<R, RtcError> { | ||||
|         let r = RTC::regs(); | ||||
|  | ||||
|         #[cfg(not(rtc_v2f2))] | ||||
|         let read_ss = || r.ssr().read().ss(); | ||||
|         #[cfg(rtc_v2f2)] | ||||
|         let read_ss = || 0; | ||||
|  | ||||
|         let mut ss = read_ss(); | ||||
|         for _ in 0..5 { | ||||
|             let tr = r.tr().read(); | ||||
|             let dr = r.dr().read(); | ||||
|             let ss_after = read_ss(); | ||||
|  | ||||
|             // If an RTCCLK edge occurs during read we may see inconsistent values | ||||
|             // so read ssr again and see if it has changed. (see RM0433 Rev 7 46.3.9) | ||||
|             if ss == ss_after { | ||||
|                 return f(dr, tr, ss.try_into().unwrap()); | ||||
|             } else { | ||||
|                 ss = ss_after | ||||
|             } | ||||
|         } | ||||
|  | ||||
|         return Err(RtcError::ReadFailure); | ||||
|     } | ||||
| } | ||||
|  | ||||
| @@ -184,7 +153,14 @@ 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")] | ||||
| @@ -199,6 +175,14 @@ impl Rtc { | ||||
|  | ||||
|         this.configure(async_psc, sync_psc); | ||||
|  | ||||
|         // Wait for the clock to update after initialization | ||||
|         #[cfg(not(rtc_v2f2))] | ||||
|         { | ||||
|             let now = this.instant().unwrap(); | ||||
|  | ||||
|             while this.instant().unwrap().subsecond == now.subsecond {} | ||||
|         } | ||||
|  | ||||
|         this | ||||
|     } | ||||
|  | ||||
| @@ -218,24 +202,47 @@ 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 { | ||||
|         let r = RTC::regs(); | ||||
|         let tr = r.tr().read(); | ||||
|         let subsecond = r.ssr().read().ss(); | ||||
|         let second = bcd2_to_byte((tr.st(), tr.su())); | ||||
|  | ||||
|         // Unlock the registers | ||||
|         r.dr().read(); | ||||
|  | ||||
|         RtcInstant { second, subsecond } | ||||
|     fn instant(&self) -> Result<RtcInstant, RtcError> { | ||||
|         self.time_provider().instant() | ||||
|     } | ||||
|  | ||||
|     /// 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")] | ||||
| @@ -151,14 +150,14 @@ impl super::Rtc { | ||||
|     pub(super) fn configure(&mut self, async_psc: u8, sync_psc: u16) { | ||||
|         self.write(true, |rtc| { | ||||
|             rtc.cr().modify(|w| { | ||||
|                 #[cfg(not(rtc_v2f2))] | ||||
|                 w.set_bypshad(true); | ||||
|                 #[cfg(rtc_v2f2)] | ||||
|                 w.set_fmt(false); | ||||
|                 #[cfg(not(rtc_v2f2))] | ||||
|                 w.set_fmt(stm32_metapac::rtc::vals::Fmt::TWENTY_FOUR_HOUR); | ||||
|                 w.set_osel(Osel::DISABLED); | ||||
|                 w.set_pol(Pol::HIGH); | ||||
|                 #[cfg(rcc_h7rm0433)] | ||||
|                 w.set_bypshad(true); | ||||
|             }); | ||||
|  | ||||
|             rtc.prer().modify(|w| { | ||||
|   | ||||
| @@ -11,6 +11,7 @@ impl super::Rtc { | ||||
|     pub(super) fn configure(&mut self, async_psc: u8, sync_psc: u16) { | ||||
|         self.write(true, |rtc| { | ||||
|             rtc.cr().modify(|w| { | ||||
|                 w.set_bypshad(true); | ||||
|                 w.set_fmt(Fmt::TWENTYFOURHOUR); | ||||
|                 w.set_osel(Osel::DISABLED); | ||||
|                 w.set_pol(Pol::HIGH); | ||||
|   | ||||
| @@ -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,9 +5,14 @@ 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.4.0 - 2023-10-31 | ||||
|  | ||||
| - Re-add impl_trait_projections | ||||
| - switch to `embedded-io 0.6` | ||||
|  | ||||
| ## 0.3.0 - 2023-09-14 | ||||
|  | ||||
| - switch to embedded-io 0.5 | ||||
| - switch to `embedded-io 0.5` | ||||
| - add api for polling channels with context | ||||
| - standardise fn names on channels | ||||
| - add zero-copy channel | ||||
|   | ||||
| @@ -1,6 +1,6 @@ | ||||
| [package] | ||||
| name = "embassy-sync" | ||||
| version = "0.3.0" | ||||
| version = "0.4.0" | ||||
| edition = "2021" | ||||
| description = "no-std, no-alloc synchronization primitives with async support" | ||||
| repository = "https://github.com/embassy-rs/embassy" | ||||
| @@ -45,4 +45,4 @@ futures-util = { version = "0.3.17", features = [ "channel" ] } | ||||
|  | ||||
| # Enable critical-section implementation for std, for tests | ||||
| critical-section = { version = "1.1", features = ["std"] } | ||||
| static_cell = "1.1" | ||||
| static_cell = { version = "2" } | ||||
|   | ||||
| @@ -1,5 +1,6 @@ | ||||
| #![cfg_attr(not(any(feature = "std", feature = "wasm")), no_std)] | ||||
| #![cfg_attr(feature = "nightly", feature(async_fn_in_trait))] | ||||
| #![cfg_attr(feature = "nightly", feature(async_fn_in_trait, impl_trait_projections))] | ||||
| #![cfg_attr(feature = "nightly", allow(stable_features, unknown_lints, async_fn_in_trait))] | ||||
| #![allow(clippy::new_without_default)] | ||||
| #![doc = include_str!("../README.md")] | ||||
| #![warn(missing_docs)] | ||||
|   | ||||
| @@ -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. | ||||
|   | ||||
| @@ -59,6 +59,9 @@ generic-queue-32 = ["generic-queue"] | ||||
| generic-queue-64 = ["generic-queue"] | ||||
| generic-queue-128 = ["generic-queue"] | ||||
|  | ||||
| # Create a `MockDriver` that can be manually advanced for testing purposes. | ||||
| mock-driver = ["tick-hz-1_000_000"] | ||||
|  | ||||
| # Set the `embassy_time` tick rate. | ||||
| # | ||||
| # At most 1 `tick-*` feature can be enabled. If none is enabled, a default of 1MHz is used. | ||||
| @@ -126,6 +129,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 = [] | ||||
| @@ -236,4 +258,4 @@ wasm-timer = { version = "0.2.5", optional = true } | ||||
| [dev-dependencies] | ||||
| serial_test = "0.9" | ||||
| critical-section = { version = "1.1", features = ["std"] } | ||||
| embassy-executor = { version = "0.3.0", path = "../embassy-executor", features = ["nightly"] } | ||||
| embassy-executor = { version = "0.3.1", path = "../embassy-executor", features = ["nightly"] } | ||||
|   | ||||
| @@ -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) | ||||
|   | ||||
							
								
								
									
										68
									
								
								embassy-time/src/driver_mock.rs
									
									
									
									
									
										Normal file
									
								
							
							
						
						
									
										68
									
								
								embassy-time/src/driver_mock.rs
									
									
									
									
									
										Normal file
									
								
							| @@ -0,0 +1,68 @@ | ||||
| use core::cell::Cell; | ||||
|  | ||||
| use critical_section::Mutex as CsMutex; | ||||
|  | ||||
| use crate::driver::{AlarmHandle, Driver}; | ||||
| use crate::{Duration, Instant}; | ||||
|  | ||||
| /// A mock driver that can be manually advanced. | ||||
| /// This is useful for testing code that works with [`Instant`] and [`Duration`]. | ||||
| /// | ||||
| /// This driver cannot currently be used to test runtime functionality, such as | ||||
| /// timers, delays, etc. | ||||
| /// | ||||
| /// # Example | ||||
| /// | ||||
| /// ```ignore | ||||
| /// fn has_a_second_passed(reference: Instant) -> bool { | ||||
| ///     Instant::now().duration_since(reference) >= Duration::from_secs(1) | ||||
| /// } | ||||
| /// | ||||
| /// fn test_second_passed() { | ||||
| ///     let driver = embassy_time::MockDriver::get(); | ||||
| ///     let reference = Instant::now(); | ||||
| ///     assert_eq!(false, has_a_second_passed(reference)); | ||||
| ///     driver.advance(Duration::from_secs(1)); | ||||
| ///     assert_eq!(true, has_a_second_passed(reference)); | ||||
| /// } | ||||
| /// ``` | ||||
| pub struct MockDriver { | ||||
|     now: CsMutex<Cell<Instant>>, | ||||
| } | ||||
|  | ||||
| crate::time_driver_impl!(static DRIVER: MockDriver = MockDriver { | ||||
|     now: CsMutex::new(Cell::new(Instant::from_ticks(0))), | ||||
| }); | ||||
|  | ||||
| impl MockDriver { | ||||
|     /// Gets a reference to the global mock driver. | ||||
|     pub fn get() -> &'static MockDriver { | ||||
|         &DRIVER | ||||
|     } | ||||
|  | ||||
|     /// Advances the time by the specified [`Duration`]. | ||||
|     pub fn advance(&self, duration: Duration) { | ||||
|         critical_section::with(|cs| { | ||||
|             let now = self.now.borrow(cs).get().as_ticks(); | ||||
|             self.now.borrow(cs).set(Instant::from_ticks(now + duration.as_ticks())); | ||||
|         }); | ||||
|     } | ||||
| } | ||||
|  | ||||
| impl Driver for MockDriver { | ||||
|     fn now(&self) -> u64 { | ||||
|         critical_section::with(|cs| self.now.borrow(cs).get().as_ticks() as u64) | ||||
|     } | ||||
|  | ||||
|     unsafe fn allocate_alarm(&self) -> Option<AlarmHandle> { | ||||
|         unimplemented!("MockDriver does not support runtime features that require an executor"); | ||||
|     } | ||||
|  | ||||
|     fn set_alarm_callback(&self, _alarm: AlarmHandle, _callback: fn(*mut ()), _ctx: *mut ()) { | ||||
|         unimplemented!("MockDriver does not support runtime features that require an executor"); | ||||
|     } | ||||
|  | ||||
|     fn set_alarm(&self, _alarm: AlarmHandle, _timestamp: u64) -> bool { | ||||
|         unimplemented!("MockDriver does not support runtime features that require an executor"); | ||||
|     } | ||||
| } | ||||
| @@ -1,5 +1,6 @@ | ||||
| #![cfg_attr(not(any(feature = "std", feature = "wasm", test)), no_std)] | ||||
| #![cfg_attr(feature = "nightly", feature(async_fn_in_trait))] | ||||
| #![cfg_attr(feature = "nightly", allow(stable_features, unknown_lints, async_fn_in_trait))] | ||||
| #![doc = include_str!("../README.md")] | ||||
| #![allow(clippy::new_without_default)] | ||||
| #![warn(missing_docs)] | ||||
| @@ -15,6 +16,12 @@ pub mod queue; | ||||
| mod tick; | ||||
| mod timer; | ||||
|  | ||||
| #[cfg(feature = "mock-driver")] | ||||
| mod driver_mock; | ||||
|  | ||||
| #[cfg(feature = "mock-driver")] | ||||
| pub use driver_mock::MockDriver; | ||||
|  | ||||
| #[cfg(feature = "std")] | ||||
| mod driver_std; | ||||
| #[cfg(feature = "wasm")] | ||||
|   | ||||
| @@ -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", | ||||
|   | ||||
| @@ -1,5 +1,6 @@ | ||||
| #![no_std] | ||||
| #![feature(async_fn_in_trait)] | ||||
| #![allow(stable_features, unknown_lints, async_fn_in_trait)] | ||||
| #![doc = include_str!("../README.md")] | ||||
| #![warn(missing_docs)] | ||||
|  | ||||
|   | ||||
| @@ -10,9 +10,9 @@ target = "thumbv7em-none-eabi" | ||||
|  | ||||
| [dependencies] | ||||
| embassy-usb = { version = "0.1.0", path = "../embassy-usb" } | ||||
| embassy-sync = { version = "0.3.0", path = "../embassy-sync" } | ||||
| embassy-sync = { version = "0.4.0", path = "../embassy-sync" } | ||||
| embassy-futures = { version = "0.1.0", path = "../embassy-futures" } | ||||
| futures = { version = "0.3", default-features = false } | ||||
| static_cell = "1" | ||||
| static_cell = { version = "2" } | ||||
| usbd-hid = "0.6.0" | ||||
| log = "0.4" | ||||
|   | ||||
| @@ -41,7 +41,7 @@ max-handler-count-8 = [] | ||||
| [dependencies] | ||||
| embassy-futures = { version = "0.1.0", path = "../embassy-futures" } | ||||
| embassy-usb-driver = { version = "0.1.0", path = "../embassy-usb-driver" } | ||||
| embassy-sync = { version = "0.3.0", path = "../embassy-sync" } | ||||
| embassy-sync = { version = "0.4.0", path = "../embassy-sync" } | ||||
| embassy-net-driver-channel = { version = "0.2.0", path = "../embassy-net-driver-channel" } | ||||
|  | ||||
| defmt = { version = "0.3", optional = true } | ||||
|   | ||||
| @@ -5,8 +5,8 @@ version = "0.1.0" | ||||
| license = "MIT OR Apache-2.0" | ||||
|  | ||||
| [dependencies] | ||||
| embassy-sync = { version = "0.3.0", path = "../../../../embassy-sync" } | ||||
| embassy-executor = { version = "0.3.0", path = "../../../../embassy-executor", features = ["arch-cortex-m", "executor-thread", "nightly", "integrated-timers", "arch-cortex-m", "executor-thread"] } | ||||
| embassy-sync = { version = "0.4.0", path = "../../../../embassy-sync" } | ||||
| embassy-executor = { version = "0.3.1", path = "../../../../embassy-executor", features = ["arch-cortex-m", "executor-thread", "nightly", "integrated-timers", "arch-cortex-m", "executor-thread"] } | ||||
| embassy-time = { version = "0.1.5", path = "../../../../embassy-time", features = ["nightly"] } | ||||
| embassy-nrf = { version = "0.1.0", path = "../../../../embassy-nrf", features = ["time-driver-rtc1", "gpiote", "nightly"] } | ||||
| embassy-boot = { version = "0.1.0", path = "../../../../embassy-boot/boot", features = ["nightly"] } | ||||
|   | ||||
| @@ -5,8 +5,8 @@ version = "0.1.0" | ||||
| license = "MIT OR Apache-2.0" | ||||
|  | ||||
| [dependencies] | ||||
| embassy-sync = { version = "0.3.0", path = "../../../../embassy-sync" } | ||||
| embassy-executor = { version = "0.3.0", path = "../../../../embassy-executor", features = ["arch-cortex-m", "executor-thread", "nightly", "integrated-timers", "arch-cortex-m", "executor-thread"] } | ||||
| embassy-sync = { version = "0.4.0", path = "../../../../embassy-sync" } | ||||
| embassy-executor = { version = "0.3.1", path = "../../../../embassy-executor", features = ["arch-cortex-m", "executor-thread", "nightly", "integrated-timers", "arch-cortex-m", "executor-thread"] } | ||||
| embassy-time = { version = "0.1.5", path = "../../../../embassy-time", features = ["nightly"] } | ||||
| embassy-rp = { version = "0.1.0", path = "../../../../embassy-rp", features = ["time-driver", "unstable-traits", "nightly"] } | ||||
| embassy-boot-rp = { version = "0.1.0", path = "../../../../embassy-boot/rp", features = ["nightly"] } | ||||
|   | ||||
| @@ -5,8 +5,8 @@ version = "0.1.0" | ||||
| license = "MIT OR Apache-2.0" | ||||
|  | ||||
| [dependencies] | ||||
| embassy-sync = { version = "0.3.0", path = "../../../../embassy-sync" } | ||||
| embassy-executor = { version = "0.3.0", path = "../../../../embassy-executor", features = ["arch-cortex-m", "executor-thread", "nightly", "integrated-timers"] } | ||||
| embassy-sync = { version = "0.4.0", path = "../../../../embassy-sync" } | ||||
| embassy-executor = { version = "0.3.1", path = "../../../../embassy-executor", features = ["arch-cortex-m", "executor-thread", "nightly", "integrated-timers"] } | ||||
| embassy-time = { version = "0.1.5", path = "../../../../embassy-time", features = ["nightly", "tick-hz-32_768"] } | ||||
| embassy-stm32 = { version = "0.1.0", path = "../../../../embassy-stm32", features = ["unstable-traits", "nightly", "stm32f303re", "time-driver-any", "exti"]  } | ||||
| embassy-boot-stm32 = { version = "0.1.0", path = "../../../../embassy-boot/stm32", features = ["nightly"] } | ||||
|   | ||||
| @@ -5,8 +5,8 @@ version = "0.1.0" | ||||
| license = "MIT OR Apache-2.0" | ||||
|  | ||||
| [dependencies] | ||||
| embassy-sync = { version = "0.3.0", path = "../../../../embassy-sync" } | ||||
| embassy-executor = { version = "0.3.0", path = "../../../../embassy-executor", features = ["arch-cortex-m", "executor-thread", "nightly", "integrated-timers"] } | ||||
| embassy-sync = { version = "0.4.0", path = "../../../../embassy-sync" } | ||||
| embassy-executor = { version = "0.3.1", path = "../../../../embassy-executor", features = ["arch-cortex-m", "executor-thread", "nightly", "integrated-timers"] } | ||||
| embassy-time = { version = "0.1.5", path = "../../../../embassy-time", features = ["nightly", "tick-hz-32_768"] } | ||||
| embassy-stm32 = { version = "0.1.0", path = "../../../../embassy-stm32", features = ["unstable-traits", "nightly", "stm32f767zi", "time-driver-any", "exti"]  } | ||||
| embassy-boot-stm32 = { version = "0.1.0", path = "../../../../embassy-boot/stm32", features = ["nightly"] } | ||||
|   | ||||
| @@ -5,8 +5,8 @@ version = "0.1.0" | ||||
| license = "MIT OR Apache-2.0" | ||||
|  | ||||
| [dependencies] | ||||
| embassy-sync = { version = "0.3.0", path = "../../../../embassy-sync" } | ||||
| embassy-executor = { version = "0.3.0", path = "../../../../embassy-executor", features = ["arch-cortex-m", "executor-thread", "nightly", "integrated-timers"] } | ||||
| embassy-sync = { version = "0.4.0", path = "../../../../embassy-sync" } | ||||
| embassy-executor = { version = "0.3.1", path = "../../../../embassy-executor", features = ["arch-cortex-m", "executor-thread", "nightly", "integrated-timers"] } | ||||
| embassy-time = { version = "0.1.5", path = "../../../../embassy-time", features = ["nightly", "tick-hz-32_768"] } | ||||
| embassy-stm32 = { version = "0.1.0", path = "../../../../embassy-stm32", features = ["unstable-traits", "nightly", "stm32h743zi", "time-driver-any", "exti"]  } | ||||
| embassy-boot-stm32 = { version = "0.1.0", path = "../../../../embassy-boot/stm32", features = ["nightly"] } | ||||
|   | ||||
| @@ -5,8 +5,8 @@ version = "0.1.0" | ||||
| license = "MIT OR Apache-2.0" | ||||
|  | ||||
| [dependencies] | ||||
| embassy-sync = { version = "0.3.0", path = "../../../../embassy-sync" } | ||||
| embassy-executor = { version = "0.3.0", path = "../../../../embassy-executor", features = ["arch-cortex-m", "executor-thread", "nightly", "integrated-timers"] } | ||||
| embassy-sync = { version = "0.4.0", path = "../../../../embassy-sync" } | ||||
| embassy-executor = { version = "0.3.1", path = "../../../../embassy-executor", features = ["arch-cortex-m", "executor-thread", "nightly", "integrated-timers"] } | ||||
| embassy-time = { version = "0.1.5", path = "../../../../embassy-time", features = ["nightly", "tick-hz-32_768"] } | ||||
| embassy-stm32 = { version = "0.1.0", path = "../../../../embassy-stm32", features = ["unstable-traits", "nightly", "stm32l072cz", "time-driver-any", "exti", "memory-x"]  } | ||||
| embassy-boot-stm32 = { version = "0.1.0", path = "../../../../embassy-boot/stm32", features = ["nightly"] } | ||||
|   | ||||
| @@ -5,8 +5,8 @@ version = "0.1.0" | ||||
| license = "MIT OR Apache-2.0" | ||||
|  | ||||
| [dependencies] | ||||
| embassy-sync = { version = "0.3.0", path = "../../../../embassy-sync" } | ||||
| embassy-executor = { version = "0.3.0", path = "../../../../embassy-executor", features = ["arch-cortex-m", "executor-thread", "nightly", "integrated-timers"] } | ||||
| embassy-sync = { version = "0.4.0", path = "../../../../embassy-sync" } | ||||
| embassy-executor = { version = "0.3.1", path = "../../../../embassy-executor", features = ["arch-cortex-m", "executor-thread", "nightly", "integrated-timers"] } | ||||
| embassy-time = { version = "0.1.5", path = "../../../../embassy-time", features = ["nightly", "tick-hz-32_768"] } | ||||
| embassy-stm32 = { version = "0.1.0", path = "../../../../embassy-stm32", features = ["unstable-traits", "nightly", "stm32l151cb-a", "time-driver-any", "exti"]  } | ||||
| embassy-boot-stm32 = { version = "0.1.0", path = "../../../../embassy-boot/stm32", features = ["nightly"] } | ||||
|   | ||||
| @@ -5,8 +5,8 @@ version = "0.1.0" | ||||
| license = "MIT OR Apache-2.0" | ||||
|  | ||||
| [dependencies] | ||||
| embassy-sync = { version = "0.3.0", path = "../../../../embassy-sync" } | ||||
| embassy-executor = { version = "0.3.0", path = "../../../../embassy-executor", features = ["arch-cortex-m", "executor-thread", "nightly", "integrated-timers"] } | ||||
| embassy-sync = { version = "0.4.0", path = "../../../../embassy-sync" } | ||||
| embassy-executor = { version = "0.3.1", path = "../../../../embassy-executor", features = ["arch-cortex-m", "executor-thread", "nightly", "integrated-timers"] } | ||||
| embassy-time = { version = "0.1.5", path = "../../../../embassy-time", features = ["nightly", "tick-hz-32_768"] } | ||||
| embassy-stm32 = { version = "0.1.0", path = "../../../../embassy-stm32", features = ["unstable-traits", "nightly", "stm32l475vg", "time-driver-any", "exti"]  } | ||||
| embassy-boot-stm32 = { version = "0.1.0", path = "../../../../embassy-boot/stm32", features = ["nightly"] } | ||||
|   | ||||
| @@ -5,8 +5,8 @@ version = "0.1.0" | ||||
| license = "MIT OR Apache-2.0" | ||||
|  | ||||
| [dependencies] | ||||
| embassy-sync = { version = "0.3.0", path = "../../../../embassy-sync" } | ||||
| embassy-executor = { version = "0.3.0", path = "../../../../embassy-executor", features = ["arch-cortex-m", "executor-thread", "nightly", "integrated-timers"] } | ||||
| embassy-sync = { version = "0.4.0", path = "../../../../embassy-sync" } | ||||
| embassy-executor = { version = "0.3.1", path = "../../../../embassy-executor", features = ["arch-cortex-m", "executor-thread", "nightly", "integrated-timers"] } | ||||
| embassy-time = { version = "0.1.5", path = "../../../../embassy-time", features = ["nightly", "tick-hz-32_768"] } | ||||
| embassy-stm32 = { version = "0.1.0", path = "../../../../embassy-stm32", features = ["unstable-traits", "nightly", "stm32wl55jc-cm4", "time-driver-any", "exti"]  } | ||||
| embassy-boot-stm32 = { version = "0.1.0", path = "../../../../embassy-boot/stm32", features = ["nightly"] } | ||||
|   | ||||
| @@ -12,7 +12,7 @@ defmt-rtt = { version = "0.4", optional = true } | ||||
| embassy-nrf = { path = "../../../../embassy-nrf", features = ["nightly"] } | ||||
| embassy-boot-nrf = { path = "../../../../embassy-boot/nrf" } | ||||
| cortex-m = { version = "0.7.6", features = ["inline-asm", "critical-section-single-core"] } | ||||
| embassy-sync = { path = "../../../../embassy-sync" } | ||||
| embassy-sync = { version = "0.4.0", path = "../../../../embassy-sync" } | ||||
| cortex-m-rt = { version = "0.7" } | ||||
| cfg-if = "1.0.0" | ||||
|  | ||||
|   | ||||
| @@ -11,7 +11,7 @@ defmt-rtt = { version = "0.4", optional = true } | ||||
|  | ||||
| embassy-rp = { path = "../../../../embassy-rp", features = ["nightly"] } | ||||
| embassy-boot-rp = { path = "../../../../embassy-boot/rp" } | ||||
| embassy-sync = { path = "../../../../embassy-sync" } | ||||
| embassy-sync = { version = "0.4.0", path = "../../../../embassy-sync" } | ||||
| embassy-time = { path = "../../../../embassy-time", features = ["nightly"] } | ||||
|  | ||||
| cortex-m = { version = "0.7.6", features = ["inline-asm", "critical-section-single-core"] } | ||||
|   | ||||
| @@ -12,7 +12,7 @@ defmt-rtt = { version = "0.4", optional = true } | ||||
| embassy-stm32 = { path = "../../../../embassy-stm32", features = ["nightly"] } | ||||
| embassy-boot-stm32 = { path = "../../../../embassy-boot/stm32" } | ||||
| cortex-m = { version = "0.7.6", features = ["inline-asm", "critical-section-single-core"] } | ||||
| embassy-sync = { path = "../../../../embassy-sync" } | ||||
| embassy-sync = { version = "0.4.0", path = "../../../../embassy-sync" } | ||||
| cortex-m-rt = { version = "0.7" } | ||||
| embedded-storage = "0.3.0" | ||||
| embedded-storage-async = "0.4.0" | ||||
|   | ||||
| @@ -16,8 +16,8 @@ log = [ | ||||
| ] | ||||
|  | ||||
| [dependencies] | ||||
| embassy-sync = { version = "0.3.0", path = "../../embassy-sync" } | ||||
| embassy-executor = { version = "0.3.0", path = "../../embassy-executor", features = ["arch-cortex-m", "executor-thread", "rtos-trace", "rtos-trace-interrupt", "integrated-timers"] } | ||||
| embassy-sync = { version = "0.4.0", path = "../../embassy-sync" } | ||||
| embassy-executor = { version = "0.3.1", path = "../../embassy-executor", features = ["arch-cortex-m", "executor-thread", "rtos-trace", "rtos-trace-interrupt", "integrated-timers"] } | ||||
| embassy-time = { version = "0.1.5", path = "../../embassy-time" } | ||||
| embassy-nrf = { version = "0.1.0", path = "../../embassy-nrf", features = ["nrf52840", "time-driver-rtc1", "gpiote", "unstable-pac"] } | ||||
|  | ||||
|   | ||||
| @@ -8,7 +8,7 @@ license = "MIT OR Apache-2.0" | ||||
| rtic = { version = "2", features = ["thumbv7-backend"] } | ||||
|  | ||||
| embassy-futures = { version = "0.1.0", path = "../../embassy-futures" } | ||||
| embassy-sync = { version = "0.3.0", path = "../../embassy-sync", features = ["defmt"] } | ||||
| embassy-sync = { version = "0.4.0", path = "../../embassy-sync", features = ["defmt"] } | ||||
| embassy-time = { version = "0.1.5", path = "../../embassy-time", features = ["nightly", "unstable-traits", "defmt", "defmt-timestamp-uptime", "generic-queue"] } | ||||
| embassy-nrf = { version = "0.1.0", path = "../../embassy-nrf", features = ["nightly", "unstable-traits", "defmt", "nrf52840", "time-driver-rtc1", "gpiote", "unstable-pac", "time"] } | ||||
|  | ||||
|   | ||||
| @@ -29,8 +29,8 @@ nightly = [ | ||||
|  | ||||
| [dependencies] | ||||
| embassy-futures = { version = "0.1.0", path = "../../embassy-futures" } | ||||
| embassy-sync = { version = "0.3.0", path = "../../embassy-sync", features = ["defmt"] } | ||||
| embassy-executor = { version = "0.3.0", path = "../../embassy-executor", features = ["arch-cortex-m", "executor-thread", "executor-interrupt", "defmt", "integrated-timers"] } | ||||
| embassy-sync = { version = "0.4.0", path = "../../embassy-sync", features = ["defmt"] } | ||||
| embassy-executor = { version = "0.3.1", path = "../../embassy-executor", features = ["arch-cortex-m", "executor-thread", "executor-interrupt", "defmt", "integrated-timers"] } | ||||
| embassy-time = { version = "0.1.5", path = "../../embassy-time", features = ["defmt", "defmt-timestamp-uptime"] } | ||||
| embassy-nrf = { version = "0.1.0", path = "../../embassy-nrf", features = ["defmt", "nrf52840", "time-driver-rtc1", "gpiote", "unstable-pac", "time"] } | ||||
| embassy-net = { version = "0.2.0", path = "../../embassy-net", features = ["defmt", "tcp", "dhcpv4", "medium-ethernet"], optional = true } | ||||
| @@ -48,7 +48,7 @@ defmt = "0.3" | ||||
| defmt-rtt = "0.4" | ||||
|  | ||||
| fixed = "1.10.0" | ||||
| static_cell = "1.1" | ||||
| static_cell = { version = "2" } | ||||
| cortex-m = { version = "0.7.6", features = ["inline-asm", "critical-section-single-core"] } | ||||
| cortex-m-rt = "0.7.0" | ||||
| panic-probe = { version = "0.3", features = ["print-defmt"] } | ||||
|   | ||||
| @@ -6,10 +6,10 @@ license = "MIT OR Apache-2.0" | ||||
|  | ||||
| [dependencies] | ||||
| embassy-futures = { version = "0.1.0", path = "../../embassy-futures" } | ||||
| embassy-sync = { version = "0.3.0", path = "../../embassy-sync", features = [ | ||||
| embassy-sync = { version = "0.4.0", path = "../../embassy-sync", features = [ | ||||
|     "defmt", | ||||
| ] } | ||||
| embassy-executor = { version = "0.3.0", path = "../../embassy-executor", features = ["arch-cortex-m", "executor-thread",  | ||||
| embassy-executor = { version = "0.3.1", path = "../../embassy-executor", features = ["arch-cortex-m", "executor-thread",  | ||||
|     "nightly", | ||||
|     "defmt", | ||||
|     "integrated-timers", | ||||
| @@ -42,7 +42,7 @@ embedded-io-async = { version = "0.6.0" } | ||||
| defmt = "0.3" | ||||
| defmt-rtt = "0.4" | ||||
|  | ||||
| static_cell = { version = "1.1", features = ["nightly"]} | ||||
| static_cell = { version = "2", features = ["nightly"]} | ||||
| cortex-m = { version = "0.7.6", features = ["inline-asm", "critical-section-single-core"] } | ||||
| cortex-m-rt = "0.7.0" | ||||
| panic-probe = { version = "0.3", features = ["print-defmt"] } | ||||
|   | ||||
| @@ -7,8 +7,8 @@ license = "MIT OR Apache-2.0" | ||||
|  | ||||
| [dependencies] | ||||
| embassy-embedded-hal = { version = "0.1.0", path = "../../embassy-embedded-hal", features = ["defmt"] } | ||||
| embassy-sync = { version = "0.3.0", path = "../../embassy-sync", features = ["defmt"] } | ||||
| embassy-executor = { version = "0.3.0", path = "../../embassy-executor", features = ["nightly", "arch-cortex-m", "executor-thread", "executor-interrupt", "defmt", "integrated-timers"] } | ||||
| embassy-sync = { version = "0.4.0", path = "../../embassy-sync", features = ["defmt"] } | ||||
| embassy-executor = { version = "0.3.1", path = "../../embassy-executor", features = ["nightly", "arch-cortex-m", "executor-thread", "executor-interrupt", "defmt", "integrated-timers"] } | ||||
| embassy-time = { version = "0.1.5", path = "../../embassy-time", features = ["nightly", "unstable-traits", "defmt", "defmt-timestamp-uptime"] } | ||||
| embassy-rp = { version = "0.1.0", path = "../../embassy-rp", features = ["defmt", "unstable-traits", "nightly", "unstable-pac", "time-driver", "critical-section-impl"] } | ||||
| embassy-usb = { version = "0.1.0", path = "../../embassy-usb", features = ["defmt"] } | ||||
| @@ -47,7 +47,8 @@ embedded-hal-async = "1.0.0-rc.1" | ||||
| embedded-hal-bus = { version = "0.1.0-rc.1", features = ["async"] } | ||||
| embedded-io-async = { version = "0.6.0", features = ["defmt-03"] } | ||||
| embedded-storage = { version = "0.3" } | ||||
| static_cell = { version = "1.1", features = ["nightly"]} | ||||
| static_cell = { version = "2", features = ["nightly"]} | ||||
| portable-atomic = { version = "1.5", features = ["critical-section"] } | ||||
| log = "0.4" | ||||
| pio-proc = "0.2" | ||||
| pio = "0.2.1" | ||||
|   | ||||
							
								
								
									
										169
									
								
								examples/rp/src/bin/pio_stepper.rs
									
									
									
									
									
										Normal file
									
								
							
							
						
						
									
										169
									
								
								examples/rp/src/bin/pio_stepper.rs
									
									
									
									
									
										Normal file
									
								
							| @@ -0,0 +1,169 @@ | ||||
| //! This example shows how to use the PIO module in the RP2040 to implement a stepper motor driver | ||||
| //! for a 5-wire stepper such as the 28BYJ-48. You can halt an ongoing rotation by dropping the future. | ||||
|  | ||||
| #![no_std] | ||||
| #![no_main] | ||||
| #![feature(type_alias_impl_trait)] | ||||
| use core::mem::{self, MaybeUninit}; | ||||
|  | ||||
| use defmt::info; | ||||
| use embassy_executor::Spawner; | ||||
| use embassy_rp::bind_interrupts; | ||||
| use embassy_rp::peripherals::PIO0; | ||||
| use embassy_rp::pio::{Common, Config, Direction, Instance, InterruptHandler, Irq, Pio, PioPin, StateMachine}; | ||||
| use embassy_time::{with_timeout, Duration, Timer}; | ||||
| use fixed::traits::ToFixed; | ||||
| use fixed::types::extra::U8; | ||||
| use fixed::FixedU32; | ||||
| use {defmt_rtt as _, panic_probe as _}; | ||||
|  | ||||
| bind_interrupts!(struct Irqs { | ||||
|     PIO0_IRQ_0 => InterruptHandler<PIO0>; | ||||
| }); | ||||
|  | ||||
| pub struct PioStepper<'d, T: Instance, const SM: usize> { | ||||
|     irq: Irq<'d, T, SM>, | ||||
|     sm: StateMachine<'d, T, SM>, | ||||
| } | ||||
|  | ||||
| impl<'d, T: Instance, const SM: usize> PioStepper<'d, T, SM> { | ||||
|     pub fn new( | ||||
|         pio: &mut Common<'d, T>, | ||||
|         mut sm: StateMachine<'d, T, SM>, | ||||
|         irq: Irq<'d, T, SM>, | ||||
|         pin0: impl PioPin, | ||||
|         pin1: impl PioPin, | ||||
|         pin2: impl PioPin, | ||||
|         pin3: impl PioPin, | ||||
|     ) -> Self { | ||||
|         let prg = pio_proc::pio_asm!( | ||||
|             "pull block", | ||||
|             "mov x, osr", | ||||
|             "pull block", | ||||
|             "mov y, osr", | ||||
|             "jmp !x end", | ||||
|             "loop:", | ||||
|             "jmp !osre step", | ||||
|             "mov osr, y", | ||||
|             "step:", | ||||
|             "out pins, 4 [31]" | ||||
|             "jmp x-- loop", | ||||
|             "end:", | ||||
|             "irq 0 rel" | ||||
|         ); | ||||
|         let pin0 = pio.make_pio_pin(pin0); | ||||
|         let pin1 = pio.make_pio_pin(pin1); | ||||
|         let pin2 = pio.make_pio_pin(pin2); | ||||
|         let pin3 = pio.make_pio_pin(pin3); | ||||
|         sm.set_pin_dirs(Direction::Out, &[&pin0, &pin1, &pin2, &pin3]); | ||||
|         let mut cfg = Config::default(); | ||||
|         cfg.set_out_pins(&[&pin0, &pin1, &pin2, &pin3]); | ||||
|         cfg.clock_divider = (125_000_000 / (100 * 136)).to_fixed(); | ||||
|         cfg.use_program(&pio.load_program(&prg.program), &[]); | ||||
|         sm.set_config(&cfg); | ||||
|         sm.set_enable(true); | ||||
|         Self { irq, sm } | ||||
|     } | ||||
|  | ||||
|     // Set pulse frequency | ||||
|     pub fn set_frequency(&mut self, freq: u32) { | ||||
|         let clock_divider: FixedU32<U8> = (125_000_000 / (freq * 136)).to_fixed(); | ||||
|         assert!(clock_divider <= 65536, "clkdiv must be <= 65536"); | ||||
|         assert!(clock_divider >= 1, "clkdiv must be >= 1"); | ||||
|         T::PIO.sm(SM).clkdiv().write(|w| w.0 = clock_divider.to_bits() << 8); | ||||
|         self.sm.clkdiv_restart(); | ||||
|     } | ||||
|  | ||||
|     // Full step, one phase | ||||
|     pub async fn step(&mut self, steps: i32) { | ||||
|         if steps > 0 { | ||||
|             self.run(steps, 0b1000_0100_0010_0001_1000_0100_0010_0001).await | ||||
|         } else { | ||||
|             self.run(-steps, 0b0001_0010_0100_1000_0001_0010_0100_1000).await | ||||
|         } | ||||
|     } | ||||
|  | ||||
|     // Full step, two phase | ||||
|     pub async fn step2(&mut self, steps: i32) { | ||||
|         if steps > 0 { | ||||
|             self.run(steps, 0b1001_1100_0110_0011_1001_1100_0110_0011).await | ||||
|         } else { | ||||
|             self.run(-steps, 0b0011_0110_1100_1001_0011_0110_1100_1001).await | ||||
|         } | ||||
|     } | ||||
|  | ||||
|     // Half step | ||||
|     pub async fn step_half(&mut self, steps: i32) { | ||||
|         if steps > 0 { | ||||
|             self.run(steps, 0b1001_1000_1100_0100_0110_0010_0011_0001).await | ||||
|         } else { | ||||
|             self.run(-steps, 0b0001_0011_0010_0110_0100_1100_1000_1001).await | ||||
|         } | ||||
|     } | ||||
|  | ||||
|     async fn run(&mut self, steps: i32, pattern: u32) { | ||||
|         self.sm.tx().wait_push(steps as u32).await; | ||||
|         self.sm.tx().wait_push(pattern).await; | ||||
|         let drop = OnDrop::new(|| { | ||||
|             self.sm.clear_fifos(); | ||||
|             unsafe { | ||||
|                 self.sm.exec_instr( | ||||
|                     pio::InstructionOperands::JMP { | ||||
|                         address: 0, | ||||
|                         condition: pio::JmpCondition::Always, | ||||
|                     } | ||||
|                     .encode(), | ||||
|                 ); | ||||
|             } | ||||
|         }); | ||||
|         self.irq.wait().await; | ||||
|         drop.defuse(); | ||||
|     } | ||||
| } | ||||
|  | ||||
| struct OnDrop<F: FnOnce()> { | ||||
|     f: MaybeUninit<F>, | ||||
| } | ||||
|  | ||||
| impl<F: FnOnce()> OnDrop<F> { | ||||
|     pub fn new(f: F) -> Self { | ||||
|         Self { f: MaybeUninit::new(f) } | ||||
|     } | ||||
|  | ||||
|     pub fn defuse(self) { | ||||
|         mem::forget(self) | ||||
|     } | ||||
| } | ||||
|  | ||||
| impl<F: FnOnce()> Drop for OnDrop<F> { | ||||
|     fn drop(&mut self) { | ||||
|         unsafe { self.f.as_ptr().read()() } | ||||
|     } | ||||
| } | ||||
|  | ||||
| #[embassy_executor::main] | ||||
| async fn main(_spawner: Spawner) { | ||||
|     let p = embassy_rp::init(Default::default()); | ||||
|     let Pio { | ||||
|         mut common, irq0, sm0, .. | ||||
|     } = Pio::new(p.PIO0, Irqs); | ||||
|  | ||||
|     let mut stepper = PioStepper::new(&mut common, sm0, irq0, p.PIN_4, p.PIN_5, p.PIN_6, p.PIN_7); | ||||
|     stepper.set_frequency(120); | ||||
|     loop { | ||||
|         info!("CW full steps"); | ||||
|         stepper.step(1000).await; | ||||
|  | ||||
|         info!("CCW full steps, drop after 1 sec"); | ||||
|         if let Err(_) = with_timeout(Duration::from_secs(1), stepper.step(i32::MIN)).await { | ||||
|             info!("Time's up!"); | ||||
|             Timer::after(Duration::from_secs(1)).await; | ||||
|         } | ||||
|  | ||||
|         info!("CW half steps"); | ||||
|         stepper.step_half(1000).await; | ||||
|  | ||||
|         info!("CCW half steps"); | ||||
|         stepper.step_half(-1000).await; | ||||
|     } | ||||
| } | ||||
| @@ -10,6 +10,7 @@ | ||||
| #![no_main] | ||||
| #![feature(type_alias_impl_trait)] | ||||
| #![feature(async_fn_in_trait)] | ||||
| #![allow(stable_features, unknown_lints, async_fn_in_trait)] | ||||
|  | ||||
| use defmt::{info, panic, trace}; | ||||
| use embassy_executor::Spawner; | ||||
|   | ||||
Some files were not shown because too many files have changed in this diff Show More
		Reference in New Issue
	
	Block a user