Compare commits
	
		
			89 Commits
		
	
	
		
			embassy-ex
			...
			cache-lock
		
	
	| Author | SHA1 | Date | |
|---|---|---|---|
|  | ba9cc102e2 | ||
|  | 32b59148a8 | ||
|  | bd2e6b0422 | ||
|  | 85059f693b | ||
|  | c211d51c06 | ||
|  | 7f1fd199bb | ||
|  | 5ddd2cf9a6 | ||
|  | 88f893da45 | ||
|  | aedd41eac4 | ||
|  | 19ba7da3fd | ||
|  | 06a83c0f89 | ||
|  | 766ec77ec5 | ||
|  | d1af696605 | ||
|  | 2386619f1f | ||
|  | 382949e1ff | ||
|  | 454828accb | ||
|  | cf82fa687c | ||
|  | 7f258cd3c4 | ||
|  | 3a939fb511 | ||
|  | b8e9e00b44 | ||
|  | ff2f1049b1 | ||
|  | be17e1b363 | ||
|  | f3c77e59c4 | ||
|  | 30424d83ff | ||
|  | e3be0b957a | ||
|  | 5221705495 | ||
|  | 814e096d22 | ||
|  | 5a60024af7 | ||
|  | f482a105b8 | ||
|  | 7589b5e13e | ||
|  | 2efa73f431 | ||
|  | 270ec324b0 | ||
|  | ca0d02933b | ||
|  | 5bc7557826 | ||
|  | 4947b13615 | ||
|  | 006260fedd | ||
|  | e3ee24017d | ||
|  | 467b53076c | ||
|  | 27e6634c9d | ||
|  | 1f9b649f80 | ||
|  | bef9b7a853 | ||
|  | 50a983fd9b | ||
|  | 7e5deae589 | ||
|  | a2c440ef8c | ||
|  | fd670a9ae5 | ||
|  | ef69f386ab | ||
|  | 872f1ec4c2 | ||
|  | 6ccd8c051e | ||
|  | c46418f123 | ||
|  | 19ff043acd | ||
|  | ea99671729 | ||
|  | 8eff749823 | ||
|  | cdcd3e26dd | ||
|  | 18c1f9dd56 | ||
|  | ac7134ed0d | ||
|  | ace5221080 | ||
|  | 2376b3bdfa | ||
|  | f00e97a5f1 | ||
|  | 066dc297ed | ||
|  | 4fe344ebc0 | ||
|  | 0f2208c0af | ||
|  | 6c42885d4a | ||
|  | 39c7371621 | ||
|  | 4647df14b1 | ||
|  | 3b33cc4691 | ||
|  | b3367be9c8 | ||
|  | da4feb3693 | ||
|  | 05a4bb3a4a | ||
|  | 4b4c28d875 | ||
|  | 1977acdb11 | ||
|  | 0b015bd727 | ||
|  | 79acb560ec | ||
|  | 94586576a0 | ||
|  | a3e200d011 | ||
|  | 3bccb67231 | ||
|  | 553f0158c0 | ||
|  | b44a5fcaf6 | ||
|  | 8effff3383 | ||
|  | 05f983c607 | ||
|  | d44383e9a7 | ||
|  | 37a773c037 | ||
|  | d1adc93614 | ||
|  | 78a7ee7ec4 | ||
|  | e3fe13e905 | ||
|  | 38bfa6916f | ||
|  | 50139752bc | ||
|  | db4cd73894 | ||
|  | 8369f7614a | ||
|  | 326bc98bd2 | 
							
								
								
									
										10
									
								
								.github/ci/build-stable.sh
									
									
									
									
										vendored
									
									
								
							
							
						
						
									
										10
									
								
								.github/ci/build-stable.sh
									
									
									
									
										vendored
									
									
								
							| @@ -12,9 +12,19 @@ export CARGO_TARGET_DIR=/ci/cache/target | |||||||
| # used when pointing stm32-metapac to a CI-built one. | # used when pointing stm32-metapac to a CI-built one. | ||||||
| export CARGO_NET_GIT_FETCH_WITH_CLI=true | export CARGO_NET_GIT_FETCH_WITH_CLI=true | ||||||
|  |  | ||||||
|  | # Restore lockfiles | ||||||
|  | if [ -f /ci/cache/lockfiles.tar ]; then | ||||||
|  |     echo Restoring lockfiles... | ||||||
|  |     tar xf /ci/cache/lockfiles.tar | ||||||
|  | fi | ||||||
|  |  | ||||||
| hashtime restore /ci/cache/filetime.json || true | hashtime restore /ci/cache/filetime.json || true | ||||||
| hashtime save /ci/cache/filetime.json | hashtime save /ci/cache/filetime.json | ||||||
|  |  | ||||||
| sed -i 's/channel.*/channel = "stable"/g' rust-toolchain.toml | sed -i 's/channel.*/channel = "stable"/g' rust-toolchain.toml | ||||||
|  |  | ||||||
| ./ci_stable.sh | ./ci_stable.sh | ||||||
|  |  | ||||||
|  | # Save lockfiles | ||||||
|  | echo Saving lockfiles... | ||||||
|  | find . -type f -name Cargo.lock -exec tar -cf /ci/cache/lockfiles.tar '{}' \+ | ||||||
							
								
								
									
										10
									
								
								.github/ci/build.sh
									
									
									
									
										vendored
									
									
								
							
							
						
						
									
										10
									
								
								.github/ci/build.sh
									
									
									
									
										vendored
									
									
								
							| @@ -18,7 +18,17 @@ fi | |||||||
| # used when pointing stm32-metapac to a CI-built one. | # used when pointing stm32-metapac to a CI-built one. | ||||||
| export CARGO_NET_GIT_FETCH_WITH_CLI=true | export CARGO_NET_GIT_FETCH_WITH_CLI=true | ||||||
|  |  | ||||||
|  | # Restore lockfiles | ||||||
|  | if [ -f /ci/cache/lockfiles.tar ]; then | ||||||
|  |     echo Restoring lockfiles... | ||||||
|  |     tar xf /ci/cache/lockfiles.tar | ||||||
|  | fi | ||||||
|  |  | ||||||
| hashtime restore /ci/cache/filetime.json || true | hashtime restore /ci/cache/filetime.json || true | ||||||
| hashtime save /ci/cache/filetime.json | hashtime save /ci/cache/filetime.json | ||||||
|  |  | ||||||
| ./ci.sh | ./ci.sh | ||||||
|  |  | ||||||
|  | # Save lockfiles | ||||||
|  | echo Saving lockfiles... | ||||||
|  | find . -type f -name Cargo.lock -exec tar -cf /ci/cache/lockfiles.tar '{}' \+ | ||||||
							
								
								
									
										2
									
								
								ci.sh
									
									
									
									
									
								
							
							
						
						
									
										2
									
								
								ci.sh
									
									
									
									
									
								
							| @@ -38,6 +38,7 @@ cargo batch  \ | |||||||
|     --- build --release --manifest-path embassy-sync/Cargo.toml --target thumbv6m-none-eabi --features nightly,defmt \ |     --- build --release --manifest-path embassy-sync/Cargo.toml --target thumbv6m-none-eabi --features nightly,defmt \ | ||||||
|     --- build --release --manifest-path embassy-time/Cargo.toml --target thumbv6m-none-eabi --features nightly,defmt,defmt-timestamp-uptime,tick-hz-32_768,generic-queue-8 \ |     --- build --release --manifest-path embassy-time/Cargo.toml --target thumbv6m-none-eabi --features nightly,defmt,defmt-timestamp-uptime,tick-hz-32_768,generic-queue-8 \ | ||||||
|     --- build --release --manifest-path embassy-net/Cargo.toml --target thumbv7em-none-eabi --features defmt,tcp,udp,dns,proto-ipv4,medium-ethernet \ |     --- build --release --manifest-path embassy-net/Cargo.toml --target thumbv7em-none-eabi --features defmt,tcp,udp,dns,proto-ipv4,medium-ethernet \ | ||||||
|  |     --- build --release --manifest-path embassy-net/Cargo.toml --target thumbv7em-none-eabi --features defmt,tcp,udp,dns,proto-ipv4,igmp,medium-ethernet \ | ||||||
|     --- build --release --manifest-path embassy-net/Cargo.toml --target thumbv7em-none-eabi --features defmt,tcp,udp,dns,dhcpv4,medium-ethernet \ |     --- build --release --manifest-path embassy-net/Cargo.toml --target thumbv7em-none-eabi --features defmt,tcp,udp,dns,dhcpv4,medium-ethernet \ | ||||||
|     --- build --release --manifest-path embassy-net/Cargo.toml --target thumbv7em-none-eabi --features defmt,tcp,udp,dns,dhcpv4,medium-ethernet,nightly,dhcpv4-hostname \ |     --- build --release --manifest-path embassy-net/Cargo.toml --target thumbv7em-none-eabi --features defmt,tcp,udp,dns,dhcpv4,medium-ethernet,nightly,dhcpv4-hostname \ | ||||||
|     --- build --release --manifest-path embassy-net/Cargo.toml --target thumbv7em-none-eabi --features defmt,tcp,udp,dns,proto-ipv6,medium-ethernet \ |     --- build --release --manifest-path embassy-net/Cargo.toml --target thumbv7em-none-eabi --features defmt,tcp,udp,dns,proto-ipv6,medium-ethernet \ | ||||||
| @@ -110,6 +111,7 @@ cargo batch  \ | |||||||
|     --- build --release --manifest-path embassy-stm32/Cargo.toml --target thumbv7em-none-eabi --features nightly,stm32h753zi,defmt,exti,time-driver-any,unstable-traits,time \ |     --- build --release --manifest-path embassy-stm32/Cargo.toml --target thumbv7em-none-eabi --features nightly,stm32h753zi,defmt,exti,time-driver-any,unstable-traits,time \ | ||||||
|     --- build --release --manifest-path embassy-stm32/Cargo.toml --target thumbv7em-none-eabi --features nightly,stm32h735zg,defmt,exti,time-driver-any,unstable-traits,time \ |     --- build --release --manifest-path embassy-stm32/Cargo.toml --target thumbv7em-none-eabi --features nightly,stm32h735zg,defmt,exti,time-driver-any,unstable-traits,time \ | ||||||
|     --- build --release --manifest-path embassy-stm32/Cargo.toml --target thumbv7em-none-eabi --features nightly,stm32h755zi-cm7,defmt,exti,time-driver-any,unstable-traits,time \ |     --- build --release --manifest-path embassy-stm32/Cargo.toml --target thumbv7em-none-eabi --features nightly,stm32h755zi-cm7,defmt,exti,time-driver-any,unstable-traits,time \ | ||||||
|  |     --- build --release --manifest-path embassy-stm32/Cargo.toml --target thumbv7em-none-eabi --features nightly,stm32h725re,defmt,exti,time-driver-any,unstable-traits,time \ | ||||||
|     --- build --release --manifest-path embassy-stm32/Cargo.toml --target thumbv7em-none-eabi --features nightly,stm32h7b3ai,defmt,exti,time-driver-any,unstable-traits,time \ |     --- build --release --manifest-path embassy-stm32/Cargo.toml --target thumbv7em-none-eabi --features nightly,stm32h7b3ai,defmt,exti,time-driver-any,unstable-traits,time \ | ||||||
|     --- build --release --manifest-path embassy-stm32/Cargo.toml --target thumbv7em-none-eabi --features nightly,stm32l476vg,defmt,exti,time-driver-any,unstable-traits,time \ |     --- build --release --manifest-path embassy-stm32/Cargo.toml --target thumbv7em-none-eabi --features nightly,stm32l476vg,defmt,exti,time-driver-any,unstable-traits,time \ | ||||||
|     --- build --release --manifest-path embassy-stm32/Cargo.toml --target thumbv7em-none-eabi --features nightly,stm32l422cb,defmt,exti,time-driver-any,unstable-traits,time \ |     --- build --release --manifest-path embassy-stm32/Cargo.toml --target thumbv7em-none-eabi --features nightly,stm32l422cb,defmt,exti,time-driver-any,unstable-traits,time \ | ||||||
|   | |||||||
| @@ -1,4 +1,5 @@ | |||||||
| use core::cmp::{max, min}; | use core::cmp::{max, min}; | ||||||
|  | use core::iter::zip; | ||||||
|  |  | ||||||
| use embassy_net_driver_channel as ch; | use embassy_net_driver_channel as ch; | ||||||
| use embassy_net_driver_channel::driver::{HardwareAddress, LinkState}; | use embassy_net_driver_channel::driver::{HardwareAddress, LinkState}; | ||||||
| @@ -16,6 +17,12 @@ pub struct Error { | |||||||
|     pub status: u32, |     pub status: u32, | ||||||
| } | } | ||||||
|  |  | ||||||
|  | #[derive(Debug)] | ||||||
|  | pub enum AddMulticastAddressError { | ||||||
|  |     NotMulticast, | ||||||
|  |     NoFreeSlots, | ||||||
|  | } | ||||||
|  |  | ||||||
| pub struct Control<'a> { | pub struct Control<'a> { | ||||||
|     state_ch: ch::StateRunner<'a>, |     state_ch: ch::StateRunner<'a>, | ||||||
|     events: &'a Events, |     events: &'a Events, | ||||||
| @@ -316,6 +323,54 @@ impl<'a> Control<'a> { | |||||||
|         self.set_iovar_u32x2("bss", 0, 1).await; // bss = BSS_UP |         self.set_iovar_u32x2("bss", 0, 1).await; // bss = BSS_UP | ||||||
|     } |     } | ||||||
|  |  | ||||||
|  |     /// Add specified address to the list of hardware addresses the device | ||||||
|  |     /// listens on. The address must be a Group address (I/G bit set). Up | ||||||
|  |     /// to 10 addresses are supported by the firmware. Returns the number of | ||||||
|  |     /// address slots filled after adding, or an error. | ||||||
|  |     pub async fn add_multicast_address(&mut self, address: [u8; 6]) -> Result<usize, AddMulticastAddressError> { | ||||||
|  |         // The firmware seems to ignore non-multicast addresses, so let's | ||||||
|  |         // prevent the user from adding them and wasting space. | ||||||
|  |         if address[0] & 0x01 != 1 { | ||||||
|  |             return Err(AddMulticastAddressError::NotMulticast); | ||||||
|  |         } | ||||||
|  |  | ||||||
|  |         let mut buf = [0; 64]; | ||||||
|  |         self.get_iovar("mcast_list", &mut buf).await; | ||||||
|  |  | ||||||
|  |         let n = u32::from_le_bytes(buf[..4].try_into().unwrap()) as usize; | ||||||
|  |         let (used, free) = buf[4..].split_at_mut(n * 6); | ||||||
|  |  | ||||||
|  |         if used.chunks(6).any(|a| a == address) { | ||||||
|  |             return Ok(n); | ||||||
|  |         } | ||||||
|  |  | ||||||
|  |         if free.len() < 6 { | ||||||
|  |             return Err(AddMulticastAddressError::NoFreeSlots); | ||||||
|  |         } | ||||||
|  |  | ||||||
|  |         free[..6].copy_from_slice(&address); | ||||||
|  |         let n = n + 1; | ||||||
|  |         buf[..4].copy_from_slice(&(n as u32).to_le_bytes()); | ||||||
|  |  | ||||||
|  |         self.set_iovar_v::<80>("mcast_list", &buf).await; | ||||||
|  |         Ok(n) | ||||||
|  |     } | ||||||
|  |  | ||||||
|  |     /// Retrieve the list of configured multicast hardware addresses. | ||||||
|  |     pub async fn list_mulistcast_addresses(&mut self, result: &mut [[u8; 6]; 10]) -> usize { | ||||||
|  |         let mut buf = [0; 64]; | ||||||
|  |         self.get_iovar("mcast_list", &mut buf).await; | ||||||
|  |  | ||||||
|  |         let n = u32::from_le_bytes(buf[..4].try_into().unwrap()) as usize; | ||||||
|  |         let used = &buf[4..][..n * 6]; | ||||||
|  |  | ||||||
|  |         for (addr, output) in zip(used.chunks(6), result.iter_mut()) { | ||||||
|  |             output.copy_from_slice(addr) | ||||||
|  |         } | ||||||
|  |  | ||||||
|  |         n | ||||||
|  |     } | ||||||
|  |  | ||||||
|     async fn set_iovar_u32x2(&mut self, name: &str, val1: u32, val2: u32) { |     async fn set_iovar_u32x2(&mut self, name: &str, val1: u32, val2: u32) { | ||||||
|         let mut buf = [0; 8]; |         let mut buf = [0; 8]; | ||||||
|         buf[0..4].copy_from_slice(&val1.to_le_bytes()); |         buf[0..4].copy_from_slice(&val1.to_le_bytes()); | ||||||
|   | |||||||
| @@ -27,7 +27,7 @@ use ioctl::IoctlState; | |||||||
|  |  | ||||||
| use crate::bus::Bus; | use crate::bus::Bus; | ||||||
| pub use crate::bus::SpiBusCyw43; | pub use crate::bus::SpiBusCyw43; | ||||||
| pub use crate::control::{Control, Error as ControlError, Scanner}; | pub use crate::control::{AddMulticastAddressError, Control, Error as ControlError, Scanner}; | ||||||
| pub use crate::runner::Runner; | pub use crate::runner::Runner; | ||||||
| pub use crate::structs::BssInfo; | pub use crate::structs::BssInfo; | ||||||
|  |  | ||||||
|   | |||||||
| @@ -10,3 +10,4 @@ | |||||||
| * xref:examples.adoc[Examples] | * xref:examples.adoc[Examples] | ||||||
| * xref:developer.adoc[Developer] | * xref:developer.adoc[Developer] | ||||||
| ** xref:developer_stm32.adoc[Developer: STM32] | ** xref:developer_stm32.adoc[Developer: STM32] | ||||||
|  | * xref:faq.adoc[Frequently Asked Questions] | ||||||
|   | |||||||
							
								
								
									
										25
									
								
								docs/modules/ROOT/pages/faq.adoc
									
									
									
									
									
										Normal file
									
								
							
							
						
						
									
										25
									
								
								docs/modules/ROOT/pages/faq.adoc
									
									
									
									
									
										Normal file
									
								
							| @@ -0,0 +1,25 @@ | |||||||
|  | = Frequently Asked Questions | ||||||
|  |  | ||||||
|  | These are a list of unsorted, commonly asked questions and answers. | ||||||
|  |  | ||||||
|  | Please feel free to add items to link:https://github.com/embassy-rs/embassy/edit/main/docs/modules/ROOT/pages/faq.adoc[this page], especially if someone in the chat answered a question for you! | ||||||
|  |  | ||||||
|  | == Missing main macro | ||||||
|  |  | ||||||
|  | If you see an error like this: | ||||||
|  |  | ||||||
|  | [source,rust] | ||||||
|  | ---- | ||||||
|  | #[embassy_executor::main] | ||||||
|  | |                   ^^^^ could not find `main` in `embassy_executor` | ||||||
|  | ---- | ||||||
|  |  | ||||||
|  | You are likely missing some features of the `embassy-executor` crate. | ||||||
|  |  | ||||||
|  | For Cortex-M targets, consider making sure that ALL of the following features are active in your `Cargo.toml` for the `embassy-executor` crate: | ||||||
|  |  | ||||||
|  | * `arch-cortex-m` | ||||||
|  | * `executor-thread` | ||||||
|  | * `nightly` | ||||||
|  |  | ||||||
|  | For Xtensa ESP32, consider using the executors and `#[main]` macro provided by your appropriate link:https://crates.io/crates/esp-hal-common[HAL crate]. | ||||||
| @@ -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/), | 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). | and this project adheres to [Semantic Versioning](https://semver.org/spec/v2.0.0.html). | ||||||
|  |  | ||||||
|  | ## 0.3.3 - 2023-11-15 | ||||||
|  |  | ||||||
|  | - Add `main` macro reexport for Xtensa arch. | ||||||
|  | - Remove use of `atomic-polyfill`. The executor now has multiple implementations of its internal data structures for cases where the target supports atomics or doesn't. | ||||||
|  |  | ||||||
| ## 0.3.2 - 2023-11-06 | ## 0.3.2 - 2023-11-06 | ||||||
|  |  | ||||||
| - Use `atomic-polyfill` for `riscv32` | - Use `atomic-polyfill` for `riscv32` | ||||||
|   | |||||||
| @@ -1,6 +1,6 @@ | |||||||
| [package] | [package] | ||||||
| name = "embassy-executor" | name = "embassy-executor" | ||||||
| version = "0.3.2" | version = "0.3.3" | ||||||
| edition = "2021" | edition = "2021" | ||||||
| license = "MIT OR Apache-2.0" | license = "MIT OR Apache-2.0" | ||||||
| description = "async/await executor designed for embedded usage" | description = "async/await executor designed for embedded usage" | ||||||
| @@ -34,7 +34,7 @@ _arch = [] # some arch was picked | |||||||
| arch-std = ["_arch", "critical-section/std"] | arch-std = ["_arch", "critical-section/std"] | ||||||
| arch-cortex-m = ["_arch", "dep:cortex-m"] | arch-cortex-m = ["_arch", "dep:cortex-m"] | ||||||
| arch-xtensa = ["_arch"] | arch-xtensa = ["_arch"] | ||||||
| arch-riscv32 = ["_arch"] | arch-riscv32 = ["_arch", "dep:portable-atomic"] | ||||||
| arch-wasm = ["_arch", "dep:wasm-bindgen", "dep:js-sys"] | arch-wasm = ["_arch", "dep:wasm-bindgen", "dep:js-sys"] | ||||||
|  |  | ||||||
| # Enable the thread-mode executor (using WFE/SEV in Cortex-M, WFI in other embedded archs) | # Enable the thread-mode executor (using WFE/SEV in Cortex-M, WFI in other embedded archs) | ||||||
| @@ -59,9 +59,12 @@ rtos-trace = { version = "0.1.2", optional = true } | |||||||
|  |  | ||||||
| embassy-macros = { version = "0.2.1", path = "../embassy-macros" } | embassy-macros = { version = "0.2.1", path = "../embassy-macros" } | ||||||
| embassy-time = { version = "0.1.5", path = "../embassy-time", optional = true} | embassy-time = { version = "0.1.5", path = "../embassy-time", optional = true} | ||||||
| atomic-polyfill = "1.0.1" |  | ||||||
| critical-section = "1.1" | critical-section = "1.1" | ||||||
|  |  | ||||||
|  | # needed for riscv | ||||||
|  | # remove when https://github.com/rust-lang/rust/pull/114499 is merged | ||||||
|  | portable-atomic = { version = "1.5", optional = true } | ||||||
|  |  | ||||||
| # arch-cortex-m dependencies | # arch-cortex-m dependencies | ||||||
| cortex-m = { version = "0.7.6", optional = true } | cortex-m = { version = "0.7.6", optional = true } | ||||||
|  |  | ||||||
|   | |||||||
| @@ -115,12 +115,12 @@ mod thread { | |||||||
| pub use interrupt::*; | pub use interrupt::*; | ||||||
| #[cfg(feature = "executor-interrupt")] | #[cfg(feature = "executor-interrupt")] | ||||||
| mod interrupt { | mod interrupt { | ||||||
|     use core::cell::UnsafeCell; |     use core::cell::{Cell, UnsafeCell}; | ||||||
|     use core::mem::MaybeUninit; |     use core::mem::MaybeUninit; | ||||||
|  |  | ||||||
|     use atomic_polyfill::{AtomicBool, Ordering}; |  | ||||||
|     use cortex_m::interrupt::InterruptNumber; |     use cortex_m::interrupt::InterruptNumber; | ||||||
|     use cortex_m::peripheral::NVIC; |     use cortex_m::peripheral::NVIC; | ||||||
|  |     use critical_section::Mutex; | ||||||
|  |  | ||||||
|     use crate::raw; |     use crate::raw; | ||||||
|  |  | ||||||
| @@ -146,7 +146,7 @@ mod interrupt { | |||||||
|     /// It is somewhat more complex to use, it's recommended to use the thread-mode |     /// It is somewhat more complex to use, it's recommended to use the thread-mode | ||||||
|     /// [`Executor`] instead, if it works for your use case. |     /// [`Executor`] instead, if it works for your use case. | ||||||
|     pub struct InterruptExecutor { |     pub struct InterruptExecutor { | ||||||
|         started: AtomicBool, |         started: Mutex<Cell<bool>>, | ||||||
|         executor: UnsafeCell<MaybeUninit<raw::Executor>>, |         executor: UnsafeCell<MaybeUninit<raw::Executor>>, | ||||||
|     } |     } | ||||||
|  |  | ||||||
| @@ -158,7 +158,7 @@ mod interrupt { | |||||||
|         #[inline] |         #[inline] | ||||||
|         pub const fn new() -> Self { |         pub const fn new() -> Self { | ||||||
|             Self { |             Self { | ||||||
|                 started: AtomicBool::new(false), |                 started: Mutex::new(Cell::new(false)), | ||||||
|                 executor: UnsafeCell::new(MaybeUninit::uninit()), |                 executor: UnsafeCell::new(MaybeUninit::uninit()), | ||||||
|             } |             } | ||||||
|         } |         } | ||||||
| @@ -167,7 +167,8 @@ mod interrupt { | |||||||
|         /// |         /// | ||||||
|         /// # Safety |         /// # Safety | ||||||
|         /// |         /// | ||||||
|         /// You MUST call this from the interrupt handler, and from nowhere else. |         /// - You MUST call this from the interrupt handler, and from nowhere else. | ||||||
|  |         /// - You must not call this before calling `start()`. | ||||||
|         pub unsafe fn on_interrupt(&'static self) { |         pub unsafe fn on_interrupt(&'static self) { | ||||||
|             let executor = unsafe { (&*self.executor.get()).assume_init_ref() }; |             let executor = unsafe { (&*self.executor.get()).assume_init_ref() }; | ||||||
|             executor.poll(); |             executor.poll(); | ||||||
| @@ -196,11 +197,7 @@ mod interrupt { | |||||||
|         /// do it after. |         /// do it after. | ||||||
|         /// |         /// | ||||||
|         pub fn start(&'static self, irq: impl InterruptNumber) -> crate::SendSpawner { |         pub fn start(&'static self, irq: impl InterruptNumber) -> crate::SendSpawner { | ||||||
|             if self |             if critical_section::with(|cs| self.started.borrow(cs).replace(true)) { | ||||||
|                 .started |  | ||||||
|                 .compare_exchange(false, true, Ordering::Acquire, Ordering::Relaxed) |  | ||||||
|                 .is_err() |  | ||||||
|             { |  | ||||||
|                 panic!("InterruptExecutor::start() called multiple times on the same executor."); |                 panic!("InterruptExecutor::start() called multiple times on the same executor."); | ||||||
|             } |             } | ||||||
|  |  | ||||||
| @@ -222,10 +219,10 @@ mod interrupt { | |||||||
|         /// This returns a [`SendSpawner`] you can use to spawn tasks on this |         /// This returns a [`SendSpawner`] you can use to spawn tasks on this | ||||||
|         /// executor. |         /// executor. | ||||||
|         /// |         /// | ||||||
|         /// This MUST only be called on an executor that has already been spawned. |         /// This MUST only be called on an executor that has already been started. | ||||||
|         /// The function will panic otherwise. |         /// The function will panic otherwise. | ||||||
|         pub fn spawner(&'static self) -> crate::SendSpawner { |         pub fn spawner(&'static self) -> crate::SendSpawner { | ||||||
|             if !self.started.load(Ordering::Acquire) { |             if !critical_section::with(|cs| self.started.borrow(cs).get()) { | ||||||
|                 panic!("InterruptExecutor::spawner() called on uninitialized executor."); |                 panic!("InterruptExecutor::spawner() called on uninitialized executor."); | ||||||
|             } |             } | ||||||
|             let executor = unsafe { (&*self.executor.get()).assume_init_ref() }; |             let executor = unsafe { (&*self.executor.get()).assume_init_ref() }; | ||||||
|   | |||||||
| @@ -7,9 +7,9 @@ pub use thread::*; | |||||||
| mod thread { | mod thread { | ||||||
|     use core::marker::PhantomData; |     use core::marker::PhantomData; | ||||||
|  |  | ||||||
|     use atomic_polyfill::{AtomicBool, Ordering}; |  | ||||||
|     #[cfg(feature = "nightly")] |     #[cfg(feature = "nightly")] | ||||||
|     pub use embassy_macros::main_riscv as main; |     pub use embassy_macros::main_riscv as main; | ||||||
|  |     use portable_atomic::{AtomicBool, Ordering}; | ||||||
|  |  | ||||||
|     use crate::{raw, Spawner}; |     use crate::{raw, Spawner}; | ||||||
|  |  | ||||||
|   | |||||||
| @@ -8,6 +8,9 @@ mod thread { | |||||||
|     use core::marker::PhantomData; |     use core::marker::PhantomData; | ||||||
|     use core::sync::atomic::{AtomicBool, Ordering}; |     use core::sync::atomic::{AtomicBool, Ordering}; | ||||||
|  |  | ||||||
|  |     #[cfg(feature = "nightly")] | ||||||
|  |     pub use embassy_macros::main_riscv as main; | ||||||
|  |  | ||||||
|     use crate::{raw, Spawner}; |     use crate::{raw, Spawner}; | ||||||
|  |  | ||||||
|     /// global atomic used to keep track of whether there is work to do since sev() is not available on Xtensa |     /// global atomic used to keep track of whether there is work to do since sev() is not available on Xtensa | ||||||
|   | |||||||
| @@ -7,7 +7,15 @@ | |||||||
| //! Using this module requires respecting subtle safety contracts. If you can, prefer using the safe | //! Using this module requires respecting subtle safety contracts. If you can, prefer using the safe | ||||||
| //! [executor wrappers](crate::Executor) and the [`embassy_executor::task`](embassy_macros::task) macro, which are fully safe. | //! [executor wrappers](crate::Executor) and the [`embassy_executor::task`](embassy_macros::task) macro, which are fully safe. | ||||||
|  |  | ||||||
|  | #[cfg_attr(target_has_atomic = "ptr", path = "run_queue_atomics.rs")] | ||||||
|  | #[cfg_attr(not(target_has_atomic = "ptr"), path = "run_queue_critical_section.rs")] | ||||||
| mod run_queue; | mod run_queue; | ||||||
|  |  | ||||||
|  | #[cfg_attr(all(cortex_m, target_has_atomic = "8"), path = "state_atomics_arm.rs")] | ||||||
|  | #[cfg_attr(all(not(cortex_m), target_has_atomic = "8"), path = "state_atomics.rs")] | ||||||
|  | #[cfg_attr(not(target_has_atomic = "8"), path = "state_critical_section.rs")] | ||||||
|  | mod state; | ||||||
|  |  | ||||||
| #[cfg(feature = "integrated-timers")] | #[cfg(feature = "integrated-timers")] | ||||||
| mod timer_queue; | mod timer_queue; | ||||||
| pub(crate) mod util; | pub(crate) mod util; | ||||||
| @@ -21,7 +29,6 @@ use core::pin::Pin; | |||||||
| use core::ptr::NonNull; | use core::ptr::NonNull; | ||||||
| use core::task::{Context, Poll}; | use core::task::{Context, Poll}; | ||||||
|  |  | ||||||
| use atomic_polyfill::{AtomicU32, Ordering}; |  | ||||||
| #[cfg(feature = "integrated-timers")] | #[cfg(feature = "integrated-timers")] | ||||||
| use embassy_time::driver::{self, AlarmHandle}; | use embassy_time::driver::{self, AlarmHandle}; | ||||||
| #[cfg(feature = "integrated-timers")] | #[cfg(feature = "integrated-timers")] | ||||||
| @@ -30,21 +37,14 @@ use embassy_time::Instant; | |||||||
| use rtos_trace::trace; | use rtos_trace::trace; | ||||||
|  |  | ||||||
| use self::run_queue::{RunQueue, RunQueueItem}; | use self::run_queue::{RunQueue, RunQueueItem}; | ||||||
|  | use self::state::State; | ||||||
| use self::util::{SyncUnsafeCell, UninitCell}; | use self::util::{SyncUnsafeCell, UninitCell}; | ||||||
| pub use self::waker::task_from_waker; | pub use self::waker::task_from_waker; | ||||||
| use super::SpawnToken; | use super::SpawnToken; | ||||||
|  |  | ||||||
| /// Task is spawned (has a future) |  | ||||||
| pub(crate) const STATE_SPAWNED: u32 = 1 << 0; |  | ||||||
| /// Task is in the executor run queue |  | ||||||
| pub(crate) const STATE_RUN_QUEUED: u32 = 1 << 1; |  | ||||||
| /// Task is in the executor timer queue |  | ||||||
| #[cfg(feature = "integrated-timers")] |  | ||||||
| pub(crate) const STATE_TIMER_QUEUED: u32 = 1 << 2; |  | ||||||
|  |  | ||||||
| /// Raw task header for use in task pointers. | /// Raw task header for use in task pointers. | ||||||
| pub(crate) struct TaskHeader { | pub(crate) struct TaskHeader { | ||||||
|     pub(crate) state: AtomicU32, |     pub(crate) state: State, | ||||||
|     pub(crate) run_queue_item: RunQueueItem, |     pub(crate) run_queue_item: RunQueueItem, | ||||||
|     pub(crate) executor: SyncUnsafeCell<Option<&'static SyncExecutor>>, |     pub(crate) executor: SyncUnsafeCell<Option<&'static SyncExecutor>>, | ||||||
|     poll_fn: SyncUnsafeCell<Option<unsafe fn(TaskRef)>>, |     poll_fn: SyncUnsafeCell<Option<unsafe fn(TaskRef)>>, | ||||||
| @@ -116,7 +116,7 @@ impl<F: Future + 'static> TaskStorage<F> { | |||||||
|     pub const fn new() -> Self { |     pub const fn new() -> Self { | ||||||
|         Self { |         Self { | ||||||
|             raw: TaskHeader { |             raw: TaskHeader { | ||||||
|                 state: AtomicU32::new(0), |                 state: State::new(), | ||||||
|                 run_queue_item: RunQueueItem::new(), |                 run_queue_item: RunQueueItem::new(), | ||||||
|                 executor: SyncUnsafeCell::new(None), |                 executor: SyncUnsafeCell::new(None), | ||||||
|                 // Note: this is lazily initialized so that a static `TaskStorage` will go in `.bss` |                 // Note: this is lazily initialized so that a static `TaskStorage` will go in `.bss` | ||||||
| @@ -161,7 +161,7 @@ impl<F: Future + 'static> TaskStorage<F> { | |||||||
|         match future.poll(&mut cx) { |         match future.poll(&mut cx) { | ||||||
|             Poll::Ready(_) => { |             Poll::Ready(_) => { | ||||||
|                 this.future.drop_in_place(); |                 this.future.drop_in_place(); | ||||||
|                 this.raw.state.fetch_and(!STATE_SPAWNED, Ordering::AcqRel); |                 this.raw.state.despawn(); | ||||||
|  |  | ||||||
|                 #[cfg(feature = "integrated-timers")] |                 #[cfg(feature = "integrated-timers")] | ||||||
|                 this.raw.expires_at.set(Instant::MAX); |                 this.raw.expires_at.set(Instant::MAX); | ||||||
| @@ -193,11 +193,7 @@ impl<F: Future + 'static> AvailableTask<F> { | |||||||
|     /// |     /// | ||||||
|     /// This function returns `None` if a task has already been spawned and has not finished running. |     /// This function returns `None` if a task has already been spawned and has not finished running. | ||||||
|     pub fn claim(task: &'static TaskStorage<F>) -> Option<Self> { |     pub fn claim(task: &'static TaskStorage<F>) -> Option<Self> { | ||||||
|         task.raw |         task.raw.state.spawn().then(|| Self { task }) | ||||||
|             .state |  | ||||||
|             .compare_exchange(0, STATE_SPAWNED | STATE_RUN_QUEUED, Ordering::AcqRel, Ordering::Acquire) |  | ||||||
|             .ok() |  | ||||||
|             .map(|_| Self { task }) |  | ||||||
|     } |     } | ||||||
|  |  | ||||||
|     fn initialize_impl<S>(self, future: impl FnOnce() -> F) -> SpawnToken<S> { |     fn initialize_impl<S>(self, future: impl FnOnce() -> F) -> SpawnToken<S> { | ||||||
| @@ -394,8 +390,7 @@ impl SyncExecutor { | |||||||
|                 #[cfg(feature = "integrated-timers")] |                 #[cfg(feature = "integrated-timers")] | ||||||
|                 task.expires_at.set(Instant::MAX); |                 task.expires_at.set(Instant::MAX); | ||||||
|  |  | ||||||
|                 let state = task.state.fetch_and(!STATE_RUN_QUEUED, Ordering::AcqRel); |                 if !task.state.run_dequeue() { | ||||||
|                 if state & STATE_SPAWNED == 0 { |  | ||||||
|                     // If task is not running, ignore it. This can happen in the following scenario: |                     // If task is not running, ignore it. This can happen in the following scenario: | ||||||
|                     //   - Task gets dequeued, poll starts |                     //   - Task gets dequeued, poll starts | ||||||
|                     //   - While task is being polled, it gets woken. It gets placed in the queue. |                     //   - While task is being polled, it gets woken. It gets placed in the queue. | ||||||
| @@ -546,18 +541,7 @@ impl Executor { | |||||||
| /// You can obtain a `TaskRef` from a `Waker` using [`task_from_waker`]. | /// You can obtain a `TaskRef` from a `Waker` using [`task_from_waker`]. | ||||||
| pub fn wake_task(task: TaskRef) { | pub fn wake_task(task: TaskRef) { | ||||||
|     let header = task.header(); |     let header = task.header(); | ||||||
|  |     if header.state.run_enqueue() { | ||||||
|     let res = header.state.fetch_update(Ordering::SeqCst, Ordering::SeqCst, |state| { |  | ||||||
|         // If already scheduled, or if not started, |  | ||||||
|         if (state & STATE_RUN_QUEUED != 0) || (state & STATE_SPAWNED == 0) { |  | ||||||
|             None |  | ||||||
|         } else { |  | ||||||
|             // Mark it as scheduled |  | ||||||
|             Some(state | STATE_RUN_QUEUED) |  | ||||||
|         } |  | ||||||
|     }); |  | ||||||
|  |  | ||||||
|     if res.is_ok() { |  | ||||||
|         // We have just marked the task as scheduled, so enqueue it. |         // We have just marked the task as scheduled, so enqueue it. | ||||||
|         unsafe { |         unsafe { | ||||||
|             let executor = header.executor.get().unwrap_unchecked(); |             let executor = header.executor.get().unwrap_unchecked(); | ||||||
| @@ -571,18 +555,7 @@ pub fn wake_task(task: TaskRef) { | |||||||
| /// You can obtain a `TaskRef` from a `Waker` using [`task_from_waker`]. | /// You can obtain a `TaskRef` from a `Waker` using [`task_from_waker`]. | ||||||
| pub fn wake_task_no_pend(task: TaskRef) { | pub fn wake_task_no_pend(task: TaskRef) { | ||||||
|     let header = task.header(); |     let header = task.header(); | ||||||
|  |     if header.state.run_enqueue() { | ||||||
|     let res = header.state.fetch_update(Ordering::SeqCst, Ordering::SeqCst, |state| { |  | ||||||
|         // If already scheduled, or if not started, |  | ||||||
|         if (state & STATE_RUN_QUEUED != 0) || (state & STATE_SPAWNED == 0) { |  | ||||||
|             None |  | ||||||
|         } else { |  | ||||||
|             // Mark it as scheduled |  | ||||||
|             Some(state | STATE_RUN_QUEUED) |  | ||||||
|         } |  | ||||||
|     }); |  | ||||||
|  |  | ||||||
|     if res.is_ok() { |  | ||||||
|         // We have just marked the task as scheduled, so enqueue it. |         // We have just marked the task as scheduled, so enqueue it. | ||||||
|         unsafe { |         unsafe { | ||||||
|             let executor = header.executor.get().unwrap_unchecked(); |             let executor = header.executor.get().unwrap_unchecked(); | ||||||
|   | |||||||
| @@ -1,7 +1,6 @@ | |||||||
| use core::ptr; | use core::ptr; | ||||||
| use core::ptr::NonNull; | use core::ptr::NonNull; | ||||||
| 
 | use core::sync::atomic::{AtomicPtr, Ordering}; | ||||||
| use atomic_polyfill::{AtomicPtr, Ordering}; |  | ||||||
| 
 | 
 | ||||||
| use super::{TaskHeader, TaskRef}; | use super::{TaskHeader, TaskRef}; | ||||||
| use crate::raw::util::SyncUnsafeCell; | use crate::raw::util::SyncUnsafeCell; | ||||||
							
								
								
									
										75
									
								
								embassy-executor/src/raw/run_queue_critical_section.rs
									
									
									
									
									
										Normal file
									
								
							
							
						
						
									
										75
									
								
								embassy-executor/src/raw/run_queue_critical_section.rs
									
									
									
									
									
										Normal file
									
								
							| @@ -0,0 +1,75 @@ | |||||||
|  | use core::cell::Cell; | ||||||
|  |  | ||||||
|  | use critical_section::{CriticalSection, Mutex}; | ||||||
|  |  | ||||||
|  | use super::TaskRef; | ||||||
|  |  | ||||||
|  | pub(crate) struct RunQueueItem { | ||||||
|  |     next: Mutex<Cell<Option<TaskRef>>>, | ||||||
|  | } | ||||||
|  |  | ||||||
|  | impl RunQueueItem { | ||||||
|  |     pub const fn new() -> Self { | ||||||
|  |         Self { | ||||||
|  |             next: Mutex::new(Cell::new(None)), | ||||||
|  |         } | ||||||
|  |     } | ||||||
|  | } | ||||||
|  |  | ||||||
|  | /// Atomic task queue using a very, very simple lock-free linked-list queue: | ||||||
|  | /// | ||||||
|  | /// To enqueue a task, task.next is set to the old head, and head is atomically set to task. | ||||||
|  | /// | ||||||
|  | /// Dequeuing is done in batches: the queue is emptied by atomically replacing head with | ||||||
|  | /// null. Then the batch is iterated following the next pointers until null is reached. | ||||||
|  | /// | ||||||
|  | /// Note that batches will be iterated in the reverse order as they were enqueued. This is OK | ||||||
|  | /// for our purposes: it can't create fairness problems since the next batch won't run until the | ||||||
|  | /// current batch is completely processed, so even if a task enqueues itself instantly (for example | ||||||
|  | /// by waking its own waker) can't prevent other tasks from running. | ||||||
|  | pub(crate) struct RunQueue { | ||||||
|  |     head: Mutex<Cell<Option<TaskRef>>>, | ||||||
|  | } | ||||||
|  |  | ||||||
|  | impl RunQueue { | ||||||
|  |     pub const fn new() -> Self { | ||||||
|  |         Self { | ||||||
|  |             head: Mutex::new(Cell::new(None)), | ||||||
|  |         } | ||||||
|  |     } | ||||||
|  |  | ||||||
|  |     /// Enqueues an item. Returns true if the queue was empty. | ||||||
|  |     /// | ||||||
|  |     /// # Safety | ||||||
|  |     /// | ||||||
|  |     /// `item` must NOT be already enqueued in any queue. | ||||||
|  |     #[inline(always)] | ||||||
|  |     pub(crate) unsafe fn enqueue(&self, task: TaskRef) -> bool { | ||||||
|  |         critical_section::with(|cs| { | ||||||
|  |             let prev = self.head.borrow(cs).replace(Some(task)); | ||||||
|  |             task.header().run_queue_item.next.borrow(cs).set(prev); | ||||||
|  |  | ||||||
|  |             prev.is_none() | ||||||
|  |         }) | ||||||
|  |     } | ||||||
|  |  | ||||||
|  |     /// Empty the queue, then call `on_task` for each task that was in the queue. | ||||||
|  |     /// NOTE: It is OK for `on_task` to enqueue more tasks. In this case they're left in the queue | ||||||
|  |     /// and will be processed by the *next* call to `dequeue_all`, *not* the current one. | ||||||
|  |     pub(crate) fn dequeue_all(&self, on_task: impl Fn(TaskRef)) { | ||||||
|  |         // Atomically empty the queue. | ||||||
|  |         let mut next = critical_section::with(|cs| self.head.borrow(cs).take()); | ||||||
|  |  | ||||||
|  |         // Iterate the linked list of tasks that were previously in the queue. | ||||||
|  |         while let Some(task) = next { | ||||||
|  |             // If the task re-enqueues itself, the `next` pointer will get overwritten. | ||||||
|  |             // Therefore, first read the next pointer, and only then process the task. | ||||||
|  |  | ||||||
|  |             // safety: we know if the task is enqueued, no one else will touch the `next` pointer. | ||||||
|  |             let cs = unsafe { CriticalSection::new() }; | ||||||
|  |             next = task.header().run_queue_item.next.borrow(cs).get(); | ||||||
|  |  | ||||||
|  |             on_task(task); | ||||||
|  |         } | ||||||
|  |     } | ||||||
|  | } | ||||||
							
								
								
									
										73
									
								
								embassy-executor/src/raw/state_atomics.rs
									
									
									
									
									
										Normal file
									
								
							
							
						
						
									
										73
									
								
								embassy-executor/src/raw/state_atomics.rs
									
									
									
									
									
										Normal file
									
								
							| @@ -0,0 +1,73 @@ | |||||||
|  | use core::sync::atomic::{AtomicU32, Ordering}; | ||||||
|  |  | ||||||
|  | /// Task is spawned (has a future) | ||||||
|  | pub(crate) const STATE_SPAWNED: u32 = 1 << 0; | ||||||
|  | /// Task is in the executor run queue | ||||||
|  | pub(crate) const STATE_RUN_QUEUED: u32 = 1 << 1; | ||||||
|  | /// Task is in the executor timer queue | ||||||
|  | #[cfg(feature = "integrated-timers")] | ||||||
|  | pub(crate) const STATE_TIMER_QUEUED: u32 = 1 << 2; | ||||||
|  |  | ||||||
|  | pub(crate) struct State { | ||||||
|  |     state: AtomicU32, | ||||||
|  | } | ||||||
|  |  | ||||||
|  | impl State { | ||||||
|  |     pub const fn new() -> State { | ||||||
|  |         Self { | ||||||
|  |             state: AtomicU32::new(0), | ||||||
|  |         } | ||||||
|  |     } | ||||||
|  |  | ||||||
|  |     /// If task is idle, mark it as spawned + run_queued and return true. | ||||||
|  |     #[inline(always)] | ||||||
|  |     pub fn spawn(&self) -> bool { | ||||||
|  |         self.state | ||||||
|  |             .compare_exchange(0, STATE_SPAWNED | STATE_RUN_QUEUED, Ordering::AcqRel, Ordering::Acquire) | ||||||
|  |             .is_ok() | ||||||
|  |     } | ||||||
|  |  | ||||||
|  |     /// Unmark the task as spawned. | ||||||
|  |     #[inline(always)] | ||||||
|  |     pub fn despawn(&self) { | ||||||
|  |         self.state.fetch_and(!STATE_SPAWNED, Ordering::AcqRel); | ||||||
|  |     } | ||||||
|  |  | ||||||
|  |     /// Mark the task as run-queued if it's spawned and isn't already run-queued. Return true on success. | ||||||
|  |     #[inline(always)] | ||||||
|  |     pub fn run_enqueue(&self) -> bool { | ||||||
|  |         self.state | ||||||
|  |             .fetch_update(Ordering::SeqCst, Ordering::SeqCst, |state| { | ||||||
|  |                 // If already scheduled, or if not started, | ||||||
|  |                 if (state & STATE_RUN_QUEUED != 0) || (state & STATE_SPAWNED == 0) { | ||||||
|  |                     None | ||||||
|  |                 } else { | ||||||
|  |                     // Mark it as scheduled | ||||||
|  |                     Some(state | STATE_RUN_QUEUED) | ||||||
|  |                 } | ||||||
|  |             }) | ||||||
|  |             .is_ok() | ||||||
|  |     } | ||||||
|  |  | ||||||
|  |     /// Unmark the task as run-queued. Return whether the task is spawned. | ||||||
|  |     #[inline(always)] | ||||||
|  |     pub fn run_dequeue(&self) -> bool { | ||||||
|  |         let state = self.state.fetch_and(!STATE_RUN_QUEUED, Ordering::AcqRel); | ||||||
|  |         state & STATE_SPAWNED != 0 | ||||||
|  |     } | ||||||
|  |  | ||||||
|  |     /// Mark the task as timer-queued. Return whether it was newly queued (i.e. not queued before) | ||||||
|  |     #[cfg(feature = "integrated-timers")] | ||||||
|  |     #[inline(always)] | ||||||
|  |     pub fn timer_enqueue(&self) -> bool { | ||||||
|  |         let old_state = self.state.fetch_or(STATE_TIMER_QUEUED, Ordering::AcqRel); | ||||||
|  |         old_state & STATE_TIMER_QUEUED == 0 | ||||||
|  |     } | ||||||
|  |  | ||||||
|  |     /// Unmark the task as timer-queued. | ||||||
|  |     #[cfg(feature = "integrated-timers")] | ||||||
|  |     #[inline(always)] | ||||||
|  |     pub fn timer_dequeue(&self) { | ||||||
|  |         self.state.fetch_and(!STATE_TIMER_QUEUED, Ordering::AcqRel); | ||||||
|  |     } | ||||||
|  | } | ||||||
							
								
								
									
										103
									
								
								embassy-executor/src/raw/state_atomics_arm.rs
									
									
									
									
									
										Normal file
									
								
							
							
						
						
									
										103
									
								
								embassy-executor/src/raw/state_atomics_arm.rs
									
									
									
									
									
										Normal file
									
								
							| @@ -0,0 +1,103 @@ | |||||||
|  | use core::arch::asm; | ||||||
|  | use core::sync::atomic::{compiler_fence, AtomicBool, AtomicU32, Ordering}; | ||||||
|  |  | ||||||
|  | // Must be kept in sync with the layout of `State`! | ||||||
|  | pub(crate) const STATE_SPAWNED: u32 = 1 << 0; | ||||||
|  | pub(crate) const STATE_RUN_QUEUED: u32 = 1 << 8; | ||||||
|  |  | ||||||
|  | #[repr(C, align(4))] | ||||||
|  | pub(crate) struct State { | ||||||
|  |     /// Task is spawned (has a future) | ||||||
|  |     spawned: AtomicBool, | ||||||
|  |     /// Task is in the executor run queue | ||||||
|  |     run_queued: AtomicBool, | ||||||
|  |     /// Task is in the executor timer queue | ||||||
|  |     timer_queued: AtomicBool, | ||||||
|  |     pad: AtomicBool, | ||||||
|  | } | ||||||
|  |  | ||||||
|  | impl State { | ||||||
|  |     pub const fn new() -> State { | ||||||
|  |         Self { | ||||||
|  |             spawned: AtomicBool::new(false), | ||||||
|  |             run_queued: AtomicBool::new(false), | ||||||
|  |             timer_queued: AtomicBool::new(false), | ||||||
|  |             pad: AtomicBool::new(false), | ||||||
|  |         } | ||||||
|  |     } | ||||||
|  |  | ||||||
|  |     fn as_u32(&self) -> &AtomicU32 { | ||||||
|  |         unsafe { &*(self as *const _ as *const AtomicU32) } | ||||||
|  |     } | ||||||
|  |  | ||||||
|  |     /// If task is idle, mark it as spawned + run_queued and return true. | ||||||
|  |     #[inline(always)] | ||||||
|  |     pub fn spawn(&self) -> bool { | ||||||
|  |         compiler_fence(Ordering::Release); | ||||||
|  |         let r = self | ||||||
|  |             .as_u32() | ||||||
|  |             .compare_exchange( | ||||||
|  |                 0, | ||||||
|  |                 STATE_SPAWNED | STATE_RUN_QUEUED, | ||||||
|  |                 Ordering::Relaxed, | ||||||
|  |                 Ordering::Relaxed, | ||||||
|  |             ) | ||||||
|  |             .is_ok(); | ||||||
|  |         compiler_fence(Ordering::Acquire); | ||||||
|  |         r | ||||||
|  |     } | ||||||
|  |  | ||||||
|  |     /// Unmark the task as spawned. | ||||||
|  |     #[inline(always)] | ||||||
|  |     pub fn despawn(&self) { | ||||||
|  |         compiler_fence(Ordering::Release); | ||||||
|  |         self.spawned.store(false, Ordering::Relaxed); | ||||||
|  |     } | ||||||
|  |  | ||||||
|  |     /// Mark the task as run-queued if it's spawned and isn't already run-queued. Return true on success. | ||||||
|  |     #[inline(always)] | ||||||
|  |     pub fn run_enqueue(&self) -> bool { | ||||||
|  |         unsafe { | ||||||
|  |             loop { | ||||||
|  |                 let state: u32; | ||||||
|  |                 asm!("ldrex {}, [{}]", out(reg) state, in(reg) self, options(nostack)); | ||||||
|  |  | ||||||
|  |                 if (state & STATE_RUN_QUEUED != 0) || (state & STATE_SPAWNED == 0) { | ||||||
|  |                     asm!("clrex", options(nomem, nostack)); | ||||||
|  |                     return false; | ||||||
|  |                 } | ||||||
|  |  | ||||||
|  |                 let outcome: usize; | ||||||
|  |                 let new_state = state | STATE_RUN_QUEUED; | ||||||
|  |                 asm!("strex {}, {}, [{}]", out(reg) outcome, in(reg) new_state, in(reg) self, options(nostack)); | ||||||
|  |                 if outcome == 0 { | ||||||
|  |                     return true; | ||||||
|  |                 } | ||||||
|  |             } | ||||||
|  |         } | ||||||
|  |     } | ||||||
|  |  | ||||||
|  |     /// Unmark the task as run-queued. Return whether the task is spawned. | ||||||
|  |     #[inline(always)] | ||||||
|  |     pub fn run_dequeue(&self) -> bool { | ||||||
|  |         compiler_fence(Ordering::Release); | ||||||
|  |  | ||||||
|  |         let r = self.spawned.load(Ordering::Relaxed); | ||||||
|  |         self.run_queued.store(false, Ordering::Relaxed); | ||||||
|  |         r | ||||||
|  |     } | ||||||
|  |  | ||||||
|  |     /// Mark the task as timer-queued. Return whether it was newly queued (i.e. not queued before) | ||||||
|  |     #[cfg(feature = "integrated-timers")] | ||||||
|  |     #[inline(always)] | ||||||
|  |     pub fn timer_enqueue(&self) -> bool { | ||||||
|  |         !self.timer_queued.swap(true, Ordering::Relaxed) | ||||||
|  |     } | ||||||
|  |  | ||||||
|  |     /// Unmark the task as timer-queued. | ||||||
|  |     #[cfg(feature = "integrated-timers")] | ||||||
|  |     #[inline(always)] | ||||||
|  |     pub fn timer_dequeue(&self) { | ||||||
|  |         self.timer_queued.store(false, Ordering::Relaxed); | ||||||
|  |     } | ||||||
|  | } | ||||||
							
								
								
									
										93
									
								
								embassy-executor/src/raw/state_critical_section.rs
									
									
									
									
									
										Normal file
									
								
							
							
						
						
									
										93
									
								
								embassy-executor/src/raw/state_critical_section.rs
									
									
									
									
									
										Normal file
									
								
							| @@ -0,0 +1,93 @@ | |||||||
|  | use core::cell::Cell; | ||||||
|  |  | ||||||
|  | use critical_section::Mutex; | ||||||
|  |  | ||||||
|  | /// Task is spawned (has a future) | ||||||
|  | pub(crate) const STATE_SPAWNED: u32 = 1 << 0; | ||||||
|  | /// Task is in the executor run queue | ||||||
|  | pub(crate) const STATE_RUN_QUEUED: u32 = 1 << 1; | ||||||
|  | /// Task is in the executor timer queue | ||||||
|  | #[cfg(feature = "integrated-timers")] | ||||||
|  | pub(crate) const STATE_TIMER_QUEUED: u32 = 1 << 2; | ||||||
|  |  | ||||||
|  | pub(crate) struct State { | ||||||
|  |     state: Mutex<Cell<u32>>, | ||||||
|  | } | ||||||
|  |  | ||||||
|  | impl State { | ||||||
|  |     pub const fn new() -> State { | ||||||
|  |         Self { | ||||||
|  |             state: Mutex::new(Cell::new(0)), | ||||||
|  |         } | ||||||
|  |     } | ||||||
|  |  | ||||||
|  |     fn update<R>(&self, f: impl FnOnce(&mut u32) -> R) -> R { | ||||||
|  |         critical_section::with(|cs| { | ||||||
|  |             let s = self.state.borrow(cs); | ||||||
|  |             let mut val = s.get(); | ||||||
|  |             let r = f(&mut val); | ||||||
|  |             s.set(val); | ||||||
|  |             r | ||||||
|  |         }) | ||||||
|  |     } | ||||||
|  |  | ||||||
|  |     /// If task is idle, mark it as spawned + run_queued and return true. | ||||||
|  |     #[inline(always)] | ||||||
|  |     pub fn spawn(&self) -> bool { | ||||||
|  |         self.update(|s| { | ||||||
|  |             if *s == 0 { | ||||||
|  |                 *s = STATE_SPAWNED | STATE_RUN_QUEUED; | ||||||
|  |                 true | ||||||
|  |             } else { | ||||||
|  |                 false | ||||||
|  |             } | ||||||
|  |         }) | ||||||
|  |     } | ||||||
|  |  | ||||||
|  |     /// Unmark the task as spawned. | ||||||
|  |     #[inline(always)] | ||||||
|  |     pub fn despawn(&self) { | ||||||
|  |         self.update(|s| *s &= !STATE_SPAWNED); | ||||||
|  |     } | ||||||
|  |  | ||||||
|  |     /// Mark the task as run-queued if it's spawned and isn't already run-queued. Return true on success. | ||||||
|  |     #[inline(always)] | ||||||
|  |     pub fn run_enqueue(&self) -> bool { | ||||||
|  |         self.update(|s| { | ||||||
|  |             if (*s & STATE_RUN_QUEUED != 0) || (*s & STATE_SPAWNED == 0) { | ||||||
|  |                 false | ||||||
|  |             } else { | ||||||
|  |                 *s |= STATE_RUN_QUEUED; | ||||||
|  |                 true | ||||||
|  |             } | ||||||
|  |         }) | ||||||
|  |     } | ||||||
|  |  | ||||||
|  |     /// Unmark the task as run-queued. Return whether the task is spawned. | ||||||
|  |     #[inline(always)] | ||||||
|  |     pub fn run_dequeue(&self) -> bool { | ||||||
|  |         self.update(|s| { | ||||||
|  |             let ok = *s & STATE_SPAWNED != 0; | ||||||
|  |             *s &= !STATE_RUN_QUEUED; | ||||||
|  |             ok | ||||||
|  |         }) | ||||||
|  |     } | ||||||
|  |  | ||||||
|  |     /// Mark the task as timer-queued. Return whether it was newly queued (i.e. not queued before) | ||||||
|  |     #[cfg(feature = "integrated-timers")] | ||||||
|  |     #[inline(always)] | ||||||
|  |     pub fn timer_enqueue(&self) -> bool { | ||||||
|  |         self.update(|s| { | ||||||
|  |             let ok = *s & STATE_TIMER_QUEUED == 0; | ||||||
|  |             *s |= STATE_TIMER_QUEUED; | ||||||
|  |             ok | ||||||
|  |         }) | ||||||
|  |     } | ||||||
|  |  | ||||||
|  |     /// Unmark the task as timer-queued. | ||||||
|  |     #[cfg(feature = "integrated-timers")] | ||||||
|  |     #[inline(always)] | ||||||
|  |     pub fn timer_dequeue(&self) { | ||||||
|  |         self.update(|s| *s &= !STATE_TIMER_QUEUED); | ||||||
|  |     } | ||||||
|  | } | ||||||
| @@ -1,9 +1,8 @@ | |||||||
| use core::cmp::min; | use core::cmp::min; | ||||||
|  |  | ||||||
| use atomic_polyfill::Ordering; |  | ||||||
| use embassy_time::Instant; | use embassy_time::Instant; | ||||||
|  |  | ||||||
| use super::{TaskRef, STATE_TIMER_QUEUED}; | use super::TaskRef; | ||||||
| use crate::raw::util::SyncUnsafeCell; | use crate::raw::util::SyncUnsafeCell; | ||||||
|  |  | ||||||
| pub(crate) struct TimerQueueItem { | pub(crate) struct TimerQueueItem { | ||||||
| @@ -32,10 +31,7 @@ impl TimerQueue { | |||||||
|     pub(crate) unsafe fn update(&self, p: TaskRef) { |     pub(crate) unsafe fn update(&self, p: TaskRef) { | ||||||
|         let task = p.header(); |         let task = p.header(); | ||||||
|         if task.expires_at.get() != Instant::MAX { |         if task.expires_at.get() != Instant::MAX { | ||||||
|             let old_state = task.state.fetch_or(STATE_TIMER_QUEUED, Ordering::AcqRel); |             if task.state.timer_enqueue() { | ||||||
|             let is_new = old_state & STATE_TIMER_QUEUED == 0; |  | ||||||
|  |  | ||||||
|             if is_new { |  | ||||||
|                 task.timer_queue_item.next.set(self.head.get()); |                 task.timer_queue_item.next.set(self.head.get()); | ||||||
|                 self.head.set(Some(p)); |                 self.head.set(Some(p)); | ||||||
|             } |             } | ||||||
| @@ -75,7 +71,7 @@ impl TimerQueue { | |||||||
|             } else { |             } else { | ||||||
|                 // Remove it |                 // Remove it | ||||||
|                 prev.set(task.timer_queue_item.next.get()); |                 prev.set(task.timer_queue_item.next.get()); | ||||||
|                 task.state.fetch_and(!STATE_TIMER_QUEUED, Ordering::AcqRel); |                 task.state.timer_dequeue(); | ||||||
|             } |             } | ||||||
|         } |         } | ||||||
|     } |     } | ||||||
|   | |||||||
| @@ -1,6 +1,6 @@ | |||||||
| [package] | [package] | ||||||
| name = "embassy-futures" | name = "embassy-futures" | ||||||
| version = "0.1.0" | version = "0.1.1" | ||||||
| edition = "2021" | edition = "2021" | ||||||
| description = "no-std, no-alloc utilities for working with futures" | description = "no-std, no-alloc utilities for working with futures" | ||||||
| repository = "https://github.com/embassy-rs/embassy" | repository = "https://github.com/embassy-rs/embassy" | ||||||
|   | |||||||
| @@ -10,7 +10,7 @@ edition = "2021" | |||||||
| # See more keys and their definitions at https://doc.rust-lang.org/cargo/reference/manifest.html | # See more keys and their definitions at https://doc.rust-lang.org/cargo/reference/manifest.html | ||||||
|  |  | ||||||
| [dependencies] | [dependencies] | ||||||
| heapless = "0.7.16" | heapless = "0.8" | ||||||
| defmt = { version = "0.3", optional = true } | defmt = { version = "0.3", optional = true } | ||||||
| log = { version = "0.4", default-features = false, optional = true } | log = { version = "0.4", default-features = false, optional = true } | ||||||
| embedded-hal-1 = { package = "embedded-hal", version = "=1.0.0-rc.1" } | embedded-hal-1 = { package = "embedded-hal", version = "=1.0.0-rc.1" } | ||||||
|   | |||||||
| @@ -15,9 +15,9 @@ embassy-net-driver-channel = { version = "0.2.0", path = "../embassy-net-driver- | |||||||
| embedded-hal = { version = "1.0.0-rc.1" } | embedded-hal = { version = "1.0.0-rc.1" } | ||||||
| embedded-hal-async = { version = "=1.0.0-rc.1" } | embedded-hal-async = { version = "=1.0.0-rc.1" } | ||||||
|  |  | ||||||
| noproto = { git="https://github.com/embassy-rs/noproto", default-features = false, features = ["derive"] } | noproto = { git="https://github.com/embassy-rs/noproto", rev = "f5e6d1f325b6ad4e344f60452b09576e24671f62", default-features = false, features = ["derive"] } | ||||||
| #noproto = { version = "0.1", path = "/home/dirbaio/noproto", default-features = false, features = ["derive"] } | #noproto = { version = "0.1", path = "/home/dirbaio/noproto", default-features = false, features = ["derive"] } | ||||||
| heapless = "0.7.16" | heapless = "0.8" | ||||||
|  |  | ||||||
| [package.metadata.embassy_docs] | [package.metadata.embassy_docs] | ||||||
| src_base = "https://github.com/embassy-rs/embassy/blob/embassy-net-esp-hosted-v$VERSION/embassy-net-esp-hosted/src/" | src_base = "https://github.com/embassy-rs/embassy/blob/embassy-net-esp-hosted-v$VERSION/embassy-net-esp-hosted/src/" | ||||||
|   | |||||||
| @@ -97,8 +97,8 @@ impl<'a> Control<'a> { | |||||||
|  |  | ||||||
|     pub async fn connect(&mut self, ssid: &str, password: &str) -> Result<(), Error> { |     pub async fn connect(&mut self, ssid: &str, password: &str) -> Result<(), Error> { | ||||||
|         let req = proto::CtrlMsgReqConnectAp { |         let req = proto::CtrlMsgReqConnectAp { | ||||||
|             ssid: String::from(ssid), |             ssid: unwrap!(String::try_from(ssid)), | ||||||
|             pwd: String::from(password), |             pwd: unwrap!(String::try_from(password)), | ||||||
|             bssid: String::new(), |             bssid: String::new(), | ||||||
|             listen_interval: 3, |             listen_interval: 3, | ||||||
|             is_wpa3_supported: false, |             is_wpa3_supported: false, | ||||||
|   | |||||||
| @@ -8,6 +8,8 @@ and this project adheres to [Semantic Versioning](https://semver.org/spec/v2.0.0 | |||||||
| ## Unreleased | ## Unreleased | ||||||
|  |  | ||||||
| - Avoid never resolving `TcpIo::read` when the output buffer is empty. | - Avoid never resolving `TcpIo::read` when the output buffer is empty. | ||||||
|  | - Update to `smoltcp` git. | ||||||
|  | - Forward constants from `smoltcp` in DNS query results so changing DNS result size in `smoltcp` properly propagates. | ||||||
|  |  | ||||||
| ## 0.2.1 - 2023-10-31 | ## 0.2.1 - 2023-10-31 | ||||||
|  |  | ||||||
|   | |||||||
| @@ -25,7 +25,7 @@ features = ["nightly", "defmt", "tcp", "udp", "dns", "dhcpv4", "proto-ipv6", "me | |||||||
| default = [] | default = [] | ||||||
| std = [] | std = [] | ||||||
|  |  | ||||||
| defmt = ["dep:defmt", "smoltcp/defmt", "embassy-net-driver/defmt"] | defmt = ["dep:defmt", "smoltcp/defmt", "embassy-net-driver/defmt", "heapless/defmt-03"] | ||||||
|  |  | ||||||
| nightly = ["dep:embedded-io-async", "dep:embedded-nal-async"] | nightly = ["dep:embedded-io-async", "dep:embedded-nal-async"] | ||||||
|  |  | ||||||
| @@ -46,7 +46,7 @@ igmp = ["smoltcp/proto-igmp"] | |||||||
| defmt = { version = "0.3", optional = true } | defmt = { version = "0.3", optional = true } | ||||||
| log = { version = "0.4.14", optional = true } | log = { version = "0.4.14", optional = true } | ||||||
|  |  | ||||||
| smoltcp = { version = "0.10.0", default-features = false, features = [ | smoltcp = { git = "https://github.com/smoltcp-rs/smoltcp.git", rev = "b57e2f9e70e82a13f31d5ea17e55232c11cc2b2d", default-features = false, features = [ | ||||||
|   "socket", |   "socket", | ||||||
|   "async", |   "async", | ||||||
| ] } | ] } | ||||||
| @@ -57,10 +57,10 @@ embassy-sync = { version = "0.4.0", path = "../embassy-sync" } | |||||||
| embedded-io-async = { version = "0.6.0", optional = true } | embedded-io-async = { version = "0.6.0", optional = true } | ||||||
|  |  | ||||||
| managed = { version = "0.8.0", default-features = false, features = [ "map" ] } | managed = { version = "0.8.0", default-features = false, features = [ "map" ] } | ||||||
| heapless = { version = "0.7.5", default-features = false } | heapless = { version = "0.8", default-features = false } | ||||||
| as-slice = "0.2.1" | as-slice = "0.2.1" | ||||||
| generic-array = { version = "0.14.4", default-features = false } | generic-array = { version = "0.14.4", default-features = false } | ||||||
| stable_deref_trait = { version = "1.2.0", default-features = false } | stable_deref_trait = { version = "1.2.0", default-features = false } | ||||||
| futures = { version = "0.3.17", default-features = false, features = [ "async-await" ] } | futures = { version = "0.3.17", default-features = false, features = [ "async-await" ] } | ||||||
| atomic-pool = "1.0" | atomic-pool = "1.0" | ||||||
| embedded-nal-async = { version = "0.6.0", optional = true } | embedded-nal-async = { version = "0.7", optional = true } | ||||||
|   | |||||||
| @@ -4,7 +4,7 @@ | |||||||
|  |  | ||||||
| It builds on [`smoltcp`](https://github.com/smoltcp-rs/smoltcp). It provides a higher-level and more opinionated | It builds on [`smoltcp`](https://github.com/smoltcp-rs/smoltcp). It provides a higher-level and more opinionated | ||||||
| API. It glues together the components provided by `smoltcp`, handling the low-level details with defaults and | API. It glues together the components provided by `smoltcp`, handling the low-level details with defaults and | ||||||
| memory management designed to work well for embedded systems, aiiming for a more "Just Works" experience. | memory management designed to work well for embedded systems, aiming for a more "Just Works" experience. | ||||||
|  |  | ||||||
| ## Features | ## Features | ||||||
|  |  | ||||||
|   | |||||||
| @@ -63,7 +63,11 @@ where | |||||||
|     } |     } | ||||||
|  |  | ||||||
|     /// Make a query for a given name and return the corresponding IP addresses. |     /// Make a query for a given name and return the corresponding IP addresses. | ||||||
|     pub async fn query(&self, name: &str, qtype: DnsQueryType) -> Result<Vec<IpAddress, 1>, Error> { |     pub async fn query( | ||||||
|  |         &self, | ||||||
|  |         name: &str, | ||||||
|  |         qtype: DnsQueryType, | ||||||
|  |     ) -> Result<Vec<IpAddress, { smoltcp::config::DNS_MAX_RESULT_COUNT }>, Error> { | ||||||
|         self.stack.dns_query(name, qtype).await |         self.stack.dns_query(name, qtype).await | ||||||
|     } |     } | ||||||
| } | } | ||||||
| @@ -101,7 +105,8 @@ where | |||||||
|     async fn get_host_by_address( |     async fn get_host_by_address( | ||||||
|         &self, |         &self, | ||||||
|         _addr: embedded_nal_async::IpAddr, |         _addr: embedded_nal_async::IpAddr, | ||||||
|     ) -> Result<heapless::String<256>, Self::Error> { |         _result: &mut [u8], | ||||||
|  |     ) -> Result<usize, Self::Error> { | ||||||
|         todo!() |         todo!() | ||||||
|     } |     } | ||||||
| } | } | ||||||
|   | |||||||
| @@ -494,7 +494,11 @@ impl<D: Driver> Stack<D> { | |||||||
|  |  | ||||||
|     /// Make a query for a given name and return the corresponding IP addresses. |     /// Make a query for a given name and return the corresponding IP addresses. | ||||||
|     #[cfg(feature = "dns")] |     #[cfg(feature = "dns")] | ||||||
|     pub async fn dns_query(&self, name: &str, qtype: dns::DnsQueryType) -> Result<Vec<IpAddress, 1>, dns::Error> { |     pub async fn dns_query( | ||||||
|  |         &self, | ||||||
|  |         name: &str, | ||||||
|  |         qtype: dns::DnsQueryType, | ||||||
|  |     ) -> Result<Vec<IpAddress, { smoltcp::config::DNS_MAX_RESULT_COUNT }>, dns::Error> { | ||||||
|         // For A and AAAA queries we try detect whether `name` is just an IP address |         // For A and AAAA queries we try detect whether `name` is just an IP address | ||||||
|         match qtype { |         match qtype { | ||||||
|             #[cfg(feature = "proto-ipv4")] |             #[cfg(feature = "proto-ipv4")] | ||||||
| @@ -612,9 +616,11 @@ impl<D: Driver> Stack<D> { | |||||||
|         let addr = addr.into(); |         let addr = addr.into(); | ||||||
|  |  | ||||||
|         self.with_mut(|s, i| { |         self.with_mut(|s, i| { | ||||||
|  |             let (_hardware_addr, medium) = to_smoltcp_hardware_address(i.device.hardware_address()); | ||||||
|             let mut smoldev = DriverAdapter { |             let mut smoldev = DriverAdapter { | ||||||
|                 cx: Some(cx), |                 cx: Some(cx), | ||||||
|                 inner: &mut i.device, |                 inner: &mut i.device, | ||||||
|  |                 medium, | ||||||
|             }; |             }; | ||||||
|  |  | ||||||
|             match s |             match s | ||||||
| @@ -649,9 +655,11 @@ impl<D: Driver> Stack<D> { | |||||||
|         let addr = addr.into(); |         let addr = addr.into(); | ||||||
|  |  | ||||||
|         self.with_mut(|s, i| { |         self.with_mut(|s, i| { | ||||||
|  |             let (_hardware_addr, medium) = to_smoltcp_hardware_address(i.device.hardware_address()); | ||||||
|             let mut smoldev = DriverAdapter { |             let mut smoldev = DriverAdapter { | ||||||
|                 cx: Some(cx), |                 cx: Some(cx), | ||||||
|                 inner: &mut i.device, |                 inner: &mut i.device, | ||||||
|  |                 medium, | ||||||
|             }; |             }; | ||||||
|  |  | ||||||
|             match s |             match s | ||||||
|   | |||||||
| @@ -618,10 +618,7 @@ pub mod client { | |||||||
|         async fn connect<'a>( |         async fn connect<'a>( | ||||||
|             &'a self, |             &'a self, | ||||||
|             remote: embedded_nal_async::SocketAddr, |             remote: embedded_nal_async::SocketAddr, | ||||||
|         ) -> Result<Self::Connection<'a>, Self::Error> |         ) -> Result<Self::Connection<'a>, Self::Error> { | ||||||
|         where |  | ||||||
|             Self: 'a, |  | ||||||
|         { |  | ||||||
|             let addr: crate::IpAddress = match remote.ip() { |             let addr: crate::IpAddress = match remote.ip() { | ||||||
|                 #[cfg(feature = "proto-ipv4")] |                 #[cfg(feature = "proto-ipv4")] | ||||||
|                 IpAddr::V4(addr) => crate::IpAddress::Ipv4(crate::Ipv4Address::from_bytes(&addr.octets())), |                 IpAddr::V4(addr) => crate::IpAddress::Ipv4(crate::Ipv4Address::from_bytes(&addr.octets())), | ||||||
|   | |||||||
| @@ -12,7 +12,7 @@ use core::cmp::min; | |||||||
| use core::future::poll_fn; | use core::future::poll_fn; | ||||||
| use core::marker::PhantomData; | use core::marker::PhantomData; | ||||||
| use core::slice; | use core::slice; | ||||||
| use core::sync::atomic::{compiler_fence, AtomicU8, AtomicUsize, Ordering}; | use core::sync::atomic::{compiler_fence, AtomicBool, AtomicU8, AtomicUsize, Ordering}; | ||||||
| use core::task::Poll; | use core::task::Poll; | ||||||
|  |  | ||||||
| use embassy_hal_internal::atomic_ring_buffer::RingBuffer; | use embassy_hal_internal::atomic_ring_buffer::RingBuffer; | ||||||
| @@ -41,7 +41,9 @@ mod sealed { | |||||||
|  |  | ||||||
|         pub rx_waker: AtomicWaker, |         pub rx_waker: AtomicWaker, | ||||||
|         pub rx_buf: RingBuffer, |         pub rx_buf: RingBuffer, | ||||||
|         pub rx_bufs: AtomicU8, |         pub rx_started: AtomicBool, | ||||||
|  |         pub rx_started_count: AtomicU8, | ||||||
|  |         pub rx_ended_count: AtomicU8, | ||||||
|         pub rx_ppi_ch: AtomicU8, |         pub rx_ppi_ch: AtomicU8, | ||||||
|     } |     } | ||||||
| } | } | ||||||
| @@ -65,7 +67,9 @@ impl State { | |||||||
|  |  | ||||||
|             rx_waker: AtomicWaker::new(), |             rx_waker: AtomicWaker::new(), | ||||||
|             rx_buf: RingBuffer::new(), |             rx_buf: RingBuffer::new(), | ||||||
|             rx_bufs: AtomicU8::new(0), |             rx_started: AtomicBool::new(false), | ||||||
|  |             rx_started_count: AtomicU8::new(0), | ||||||
|  |             rx_ended_count: AtomicU8::new(0), | ||||||
|             rx_ppi_ch: AtomicU8::new(0), |             rx_ppi_ch: AtomicU8::new(0), | ||||||
|         } |         } | ||||||
|     } |     } | ||||||
| @@ -104,28 +108,20 @@ impl<U: UarteInstance> interrupt::typelevel::Handler<U::Interrupt> for Interrupt | |||||||
|             s.rx_waker.wake(); |             s.rx_waker.wake(); | ||||||
|         } |         } | ||||||
|  |  | ||||||
|         // If not RXing, start. |         if r.events_endrx.read().bits() != 0 { | ||||||
|         if s.rx_bufs.load(Ordering::Relaxed) == 0 { |             //trace!("  irq_rx: endrx"); | ||||||
|             let (ptr, len) = rx.push_buf(); |             r.events_endrx.reset(); | ||||||
|             if len >= half_len { |  | ||||||
|                 //trace!("  irq_rx: starting {:?}", half_len); |  | ||||||
|                 s.rx_bufs.store(1, Ordering::Relaxed); |  | ||||||
|  |  | ||||||
|                 // Set up the DMA read |             let val = s.rx_ended_count.load(Ordering::Relaxed); | ||||||
|                 r.rxd.ptr.write(|w| unsafe { w.ptr().bits(ptr as u32) }); |             s.rx_ended_count.store(val.wrapping_add(1), Ordering::Relaxed); | ||||||
|                 r.rxd.maxcnt.write(|w| unsafe { w.maxcnt().bits(half_len as _) }); |  | ||||||
|  |  | ||||||
|                 // Start UARTE Receive transaction |  | ||||||
|                 r.tasks_startrx.write(|w| unsafe { w.bits(1) }); |  | ||||||
|                 rx.push_done(half_len); |  | ||||||
|                 r.intenset.write(|w| w.rxstarted().set()); |  | ||||||
|             } |  | ||||||
|         } |         } | ||||||
|  |  | ||||||
|         if r.events_rxstarted.read().bits() != 0 { |         if r.events_rxstarted.read().bits() != 0 || !s.rx_started.load(Ordering::Relaxed) { | ||||||
|             //trace!("  irq_rx: rxstarted"); |             //trace!("  irq_rx: rxstarted"); | ||||||
|             let (ptr, len) = rx.push_buf(); |             let (ptr, len) = rx.push_buf(); | ||||||
|             if len >= half_len { |             if len >= half_len { | ||||||
|  |                 r.events_rxstarted.reset(); | ||||||
|  |  | ||||||
|                 //trace!("  irq_rx: starting second {:?}", half_len); |                 //trace!("  irq_rx: starting second {:?}", half_len); | ||||||
|  |  | ||||||
|                 // Set up the DMA read |                 // Set up the DMA read | ||||||
| @@ -134,11 +130,50 @@ impl<U: UarteInstance> interrupt::typelevel::Handler<U::Interrupt> for Interrupt | |||||||
|  |  | ||||||
|                 let chn = s.rx_ppi_ch.load(Ordering::Relaxed); |                 let chn = s.rx_ppi_ch.load(Ordering::Relaxed); | ||||||
|  |  | ||||||
|  |                 // Enable endrx -> startrx PPI channel. | ||||||
|  |                 // From this point on, if endrx happens, startrx is automatically fired. | ||||||
|                 ppi::regs().chenset.write(|w| unsafe { w.bits(1 << chn) }); |                 ppi::regs().chenset.write(|w| unsafe { w.bits(1 << chn) }); | ||||||
|  |  | ||||||
|  |                 // It is possible that endrx happened BEFORE enabling the PPI. In this case | ||||||
|  |                 // the PPI channel doesn't trigger, and we'd hang. We have to detect this | ||||||
|  |                 // and manually start. | ||||||
|  |  | ||||||
|  |                 // check again in case endrx has happened between the last check and now. | ||||||
|  |                 if r.events_endrx.read().bits() != 0 { | ||||||
|  |                     //trace!("  irq_rx: endrx"); | ||||||
|  |                     r.events_endrx.reset(); | ||||||
|  |  | ||||||
|  |                     let val = s.rx_ended_count.load(Ordering::Relaxed); | ||||||
|  |                     s.rx_ended_count.store(val.wrapping_add(1), Ordering::Relaxed); | ||||||
|  |                 } | ||||||
|  |  | ||||||
|  |                 let rx_ended = s.rx_ended_count.load(Ordering::Relaxed); | ||||||
|  |                 let rx_started = s.rx_started_count.load(Ordering::Relaxed); | ||||||
|  |  | ||||||
|  |                 // If we started the same amount of transfers as ended, the last rxend has | ||||||
|  |                 // already occured. | ||||||
|  |                 let rxend_happened = rx_started == rx_ended; | ||||||
|  |  | ||||||
|  |                 // Check if the PPI channel is still enabled. The PPI channel disables itself | ||||||
|  |                 // when it fires, so if it's still enabled it hasn't fired. | ||||||
|  |                 let ppi_ch_enabled = ppi::regs().chen.read().bits() & (1 << chn) != 0; | ||||||
|  |  | ||||||
|  |                 // if rxend happened, and the ppi channel hasn't fired yet, the rxend got missed. | ||||||
|  |                 // this condition also naturally matches if `!started`, needed to kickstart the DMA. | ||||||
|  |                 if rxend_happened && ppi_ch_enabled { | ||||||
|  |                     //trace!("manually starting."); | ||||||
|  |  | ||||||
|  |                     // disable the ppi ch, it's of no use anymore. | ||||||
|  |                     ppi::regs().chenclr.write(|w| unsafe { w.bits(1 << chn) }); | ||||||
|  |  | ||||||
|  |                     // manually start | ||||||
|  |                     r.tasks_startrx.write(|w| unsafe { w.bits(1) }); | ||||||
|  |                 } | ||||||
|  |  | ||||||
|                 rx.push_done(half_len); |                 rx.push_done(half_len); | ||||||
|  |  | ||||||
|                 r.events_rxstarted.reset(); |                 s.rx_started_count.store(rx_started.wrapping_add(1), Ordering::Relaxed); | ||||||
|  |                 s.rx_started.store(true, Ordering::Relaxed); | ||||||
|             } else { |             } else { | ||||||
|                 //trace!("  irq_rx: rxstarted no buf"); |                 //trace!("  irq_rx: rxstarted no buf"); | ||||||
|                 r.intenclr.write(|w| w.rxstarted().clear()); |                 r.intenclr.write(|w| w.rxstarted().clear()); | ||||||
| @@ -282,6 +317,8 @@ impl<'d, U: UarteInstance, T: TimerInstance> BufferedUarte<'d, U, T> { | |||||||
|  |  | ||||||
|         let r = U::regs(); |         let r = U::regs(); | ||||||
|  |  | ||||||
|  |         let hwfc = cts.is_some(); | ||||||
|  |  | ||||||
|         rxd.conf().write(|w| w.input().connect().drive().h0h1()); |         rxd.conf().write(|w| w.input().connect().drive().h0h1()); | ||||||
|         r.psel.rxd.write(|w| unsafe { w.bits(rxd.psel_bits()) }); |         r.psel.rxd.write(|w| unsafe { w.bits(rxd.psel_bits()) }); | ||||||
|  |  | ||||||
| @@ -303,7 +340,8 @@ impl<'d, U: UarteInstance, T: TimerInstance> BufferedUarte<'d, U, T> { | |||||||
|         // Initialize state |         // Initialize state | ||||||
|         let s = U::buffered_state(); |         let s = U::buffered_state(); | ||||||
|         s.tx_count.store(0, Ordering::Relaxed); |         s.tx_count.store(0, Ordering::Relaxed); | ||||||
|         s.rx_bufs.store(0, Ordering::Relaxed); |         s.rx_started_count.store(0, Ordering::Relaxed); | ||||||
|  |         s.rx_ended_count.store(0, Ordering::Relaxed); | ||||||
|         let len = tx_buffer.len(); |         let len = tx_buffer.len(); | ||||||
|         unsafe { s.tx_buf.init(tx_buffer.as_mut_ptr(), len) }; |         unsafe { s.tx_buf.init(tx_buffer.as_mut_ptr(), len) }; | ||||||
|         let len = rx_buffer.len(); |         let len = rx_buffer.len(); | ||||||
| @@ -311,7 +349,7 @@ impl<'d, U: UarteInstance, T: TimerInstance> BufferedUarte<'d, U, T> { | |||||||
|  |  | ||||||
|         // Configure |         // Configure | ||||||
|         r.config.write(|w| { |         r.config.write(|w| { | ||||||
|             w.hwfc().bit(false); |             w.hwfc().bit(hwfc); | ||||||
|             w.parity().variant(config.parity); |             w.parity().variant(config.parity); | ||||||
|             w |             w | ||||||
|         }); |         }); | ||||||
| @@ -333,6 +371,7 @@ impl<'d, U: UarteInstance, T: TimerInstance> BufferedUarte<'d, U, T> { | |||||||
|             w.endtx().set(); |             w.endtx().set(); | ||||||
|             w.rxstarted().set(); |             w.rxstarted().set(); | ||||||
|             w.error().set(); |             w.error().set(); | ||||||
|  |             w.endrx().set(); | ||||||
|             w |             w | ||||||
|         }); |         }); | ||||||
|  |  | ||||||
|   | |||||||
| @@ -94,5 +94,5 @@ pio = {version= "0.2.1" } | |||||||
| rp2040-boot2 = "0.3" | rp2040-boot2 = "0.3" | ||||||
|  |  | ||||||
| [dev-dependencies] | [dev-dependencies] | ||||||
| embassy-executor = { version = "0.3.1", path = "../embassy-executor", features = ["nightly", "arch-std", "executor-thread"] } | embassy-executor = { version = "0.3.3", path = "../embassy-executor", features = ["nightly", "arch-std", "executor-thread"] } | ||||||
| static_cell = { version = "2" } | static_cell = { version = "2" } | ||||||
|   | |||||||
| @@ -21,7 +21,7 @@ embassy-net-driver = { version = "0.2.0", path = "../embassy-net-driver", option | |||||||
|  |  | ||||||
| defmt = { version = "0.3", optional = true } | defmt = { version = "0.3", optional = true } | ||||||
| cortex-m = "0.7.6" | cortex-m = "0.7.6" | ||||||
| heapless = "0.7.16" | heapless = "0.8" | ||||||
| aligned = "0.4.1" | aligned = "0.4.1" | ||||||
|  |  | ||||||
| bit_field = "0.10.2" | bit_field = "0.10.2" | ||||||
|   | |||||||
| @@ -18,7 +18,7 @@ flavors = [ | |||||||
|     { regex_feature = "stm32f7.*", target = "thumbv7em-none-eabi" }, |     { regex_feature = "stm32f7.*", target = "thumbv7em-none-eabi" }, | ||||||
|     { regex_feature = "stm32c0.*", target = "thumbv6m-none-eabi" }, |     { regex_feature = "stm32c0.*", target = "thumbv6m-none-eabi" }, | ||||||
|     { regex_feature = "stm32g0.*", target = "thumbv6m-none-eabi" }, |     { regex_feature = "stm32g0.*", target = "thumbv6m-none-eabi" }, | ||||||
|     { regex_feature = "stm32g4.*", target = "thumbv7em-none-eabi" }, |     { regex_feature = "stm32g4.*", target = "thumbv7em-none-eabi", features = ["low-power"] }, | ||||||
|     { regex_feature = "stm32h5.*", target = "thumbv8m.main-none-eabihf" }, |     { regex_feature = "stm32h5.*", target = "thumbv8m.main-none-eabihf" }, | ||||||
|     { regex_feature = "stm32h7.*", target = "thumbv7em-none-eabi" }, |     { regex_feature = "stm32h7.*", target = "thumbv7em-none-eabi" }, | ||||||
|     { regex_feature = "stm32l0.*", target = "thumbv6m-none-eabi", features = ["low-power"] }, |     { regex_feature = "stm32l0.*", target = "thumbv6m-none-eabi", features = ["low-power"] }, | ||||||
| @@ -39,7 +39,7 @@ embassy-hal-internal = {version = "0.1.0", path = "../embassy-hal-internal", fea | |||||||
| embassy-embedded-hal = {version = "0.1.0", path = "../embassy-embedded-hal" } | embassy-embedded-hal = {version = "0.1.0", path = "../embassy-embedded-hal" } | ||||||
| embassy-net-driver = { version = "0.2.0", path = "../embassy-net-driver" } | 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-usb-driver = {version = "0.1.0", path = "../embassy-usb-driver", optional = true } | ||||||
| embassy-executor = { version = "0.3.1", path = "../embassy-executor", optional = true } | embassy-executor = { version = "0.3.3", path = "../embassy-executor", optional = true } | ||||||
|  |  | ||||||
| embedded-hal-02 = { package = "embedded-hal", version = "0.2.6", features = ["unproven"] } | 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} | 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" | sdio-host = "0.5.0" | ||||||
| embedded-sdmmc = { git = "https://github.com/embassy-rs/embedded-sdmmc-rs", rev = "a4f293d3a6f72158385f79c98634cb8a14d0d2fc", optional = true } | embedded-sdmmc = { git = "https://github.com/embassy-rs/embedded-sdmmc-rs", rev = "a4f293d3a6f72158385f79c98634cb8a14d0d2fc", optional = true } | ||||||
| critical-section = "1.1" | critical-section = "1.1" | ||||||
| stm32-metapac = { git = "https://github.com/embassy-rs/stm32-data-generated", tag = "stm32-data-1374ed622714ef4702826699ca21cc1f741f4133" } | stm32-metapac = { git = "https://github.com/embassy-rs/stm32-data-generated", tag = "stm32-data-fbb8f77326dd066aa6c0d66b3b46e76a569dda8b" } | ||||||
| vcell = "0.1.3" | vcell = "0.1.3" | ||||||
| bxcan = "0.7.0" | bxcan = "0.7.0" | ||||||
| nb = "1.0.0" | nb = "1.0.0" | ||||||
| @@ -76,7 +76,7 @@ critical-section = { version = "1.1", features = ["std"] } | |||||||
| [build-dependencies] | [build-dependencies] | ||||||
| proc-macro2 = "1.0.36" | proc-macro2 = "1.0.36" | ||||||
| quote = "1.0.15" | quote = "1.0.15" | ||||||
| stm32-metapac = { git = "https://github.com/embassy-rs/stm32-data-generated", tag = "stm32-data-1374ed622714ef4702826699ca21cc1f741f4133", default-features = false, features = ["metadata"]} | stm32-metapac = { git = "https://github.com/embassy-rs/stm32-data-generated", tag = "stm32-data-fbb8f77326dd066aa6c0d66b3b46e76a569dda8b", default-features = false, features = ["metadata"]} | ||||||
|  |  | ||||||
|  |  | ||||||
| [features] | [features] | ||||||
|   | |||||||
| @@ -61,6 +61,7 @@ fn main() { | |||||||
|     let mut singletons: Vec<String> = Vec::new(); |     let mut singletons: Vec<String> = Vec::new(); | ||||||
|     for p in METADATA.peripherals { |     for p in METADATA.peripherals { | ||||||
|         if let Some(r) = &p.registers { |         if let Some(r) = &p.registers { | ||||||
|  |             println!("cargo:rustc-cfg=peri_{}", p.name.to_ascii_lowercase()); | ||||||
|             match r.kind { |             match r.kind { | ||||||
|                 // Generate singletons per pin, not per port |                 // Generate singletons per pin, not per port | ||||||
|                 "gpio" => { |                 "gpio" => { | ||||||
|   | |||||||
| @@ -1,4 +1,3 @@ | |||||||
| use core::cell::{RefCell, RefMut}; |  | ||||||
| use core::future::poll_fn; | use core::future::poll_fn; | ||||||
| use core::marker::PhantomData; | use core::marker::PhantomData; | ||||||
| use core::ops::{Deref, DerefMut}; | use core::ops::{Deref, DerefMut}; | ||||||
| @@ -84,7 +83,7 @@ impl<T: Instance> interrupt::typelevel::Handler<T::SCEInterrupt> for SceInterrup | |||||||
| } | } | ||||||
|  |  | ||||||
| pub struct Can<'d, T: Instance> { | pub struct Can<'d, T: Instance> { | ||||||
|     pub can: RefCell<bxcan::Can<BxcanInstance<'d, T>>>, |     pub can: bxcan::Can<BxcanInstance<'d, T>>, | ||||||
| } | } | ||||||
|  |  | ||||||
| #[derive(Debug)] | #[derive(Debug)] | ||||||
| @@ -175,17 +174,12 @@ impl<'d, T: Instance> Can<'d, T> { | |||||||
|         tx.set_as_af(tx.af_num(), AFType::OutputPushPull); |         tx.set_as_af(tx.af_num(), AFType::OutputPushPull); | ||||||
|  |  | ||||||
|         let can = bxcan::Can::builder(BxcanInstance(peri)).leave_disabled(); |         let can = bxcan::Can::builder(BxcanInstance(peri)).leave_disabled(); | ||||||
|         let can_ref_cell = RefCell::new(can); |         Self { can } | ||||||
|         Self { can: can_ref_cell } |  | ||||||
|     } |     } | ||||||
|  |  | ||||||
|     pub fn set_bitrate(&mut self, bitrate: u32) { |     pub fn set_bitrate(&mut self, bitrate: u32) { | ||||||
|         let bit_timing = Self::calc_bxcan_timings(T::frequency(), bitrate).unwrap(); |         let bit_timing = Self::calc_bxcan_timings(T::frequency(), bitrate).unwrap(); | ||||||
|         self.can |         self.can.modify_config().set_bit_timing(bit_timing).leave_disabled(); | ||||||
|             .borrow_mut() |  | ||||||
|             .modify_config() |  | ||||||
|             .set_bit_timing(bit_timing) |  | ||||||
|             .leave_disabled(); |  | ||||||
|     } |     } | ||||||
|  |  | ||||||
|     /// Enables the peripheral and synchronizes with the bus. |     /// Enables the peripheral and synchronizes with the bus. | ||||||
| @@ -193,7 +187,7 @@ impl<'d, T: Instance> Can<'d, T> { | |||||||
|     /// This will wait for 11 consecutive recessive bits (bus idle state). |     /// This will wait for 11 consecutive recessive bits (bus idle state). | ||||||
|     /// Contrary to enable method from bxcan library, this will not freeze the executor while waiting. |     /// Contrary to enable method from bxcan library, this will not freeze the executor while waiting. | ||||||
|     pub async fn enable(&mut self) { |     pub async fn enable(&mut self) { | ||||||
|         while self.borrow_mut().enable_non_blocking().is_err() { |         while self.enable_non_blocking().is_err() { | ||||||
|             // SCE interrupt is only generated for entering sleep mode, but not leaving. |             // SCE interrupt is only generated for entering sleep mode, but not leaving. | ||||||
|             // Yield to allow other tasks to execute while can bus is initializing. |             // Yield to allow other tasks to execute while can bus is initializing. | ||||||
|             embassy_futures::yield_now().await; |             embassy_futures::yield_now().await; | ||||||
| @@ -202,46 +196,46 @@ impl<'d, T: Instance> Can<'d, T> { | |||||||
|  |  | ||||||
|     /// Queues the message to be sent but exerts backpressure |     /// Queues the message to be sent but exerts backpressure | ||||||
|     pub async fn write(&mut self, frame: &Frame) -> bxcan::TransmitStatus { |     pub async fn write(&mut self, frame: &Frame) -> bxcan::TransmitStatus { | ||||||
|         CanTx { can: &self.can }.write(frame).await |         self.split().0.write(frame).await | ||||||
|     } |     } | ||||||
|  |  | ||||||
|     /// Attempts to transmit a frame without blocking. |     /// Attempts to transmit a frame without blocking. | ||||||
|     /// |     /// | ||||||
|     /// Returns [Err(TryWriteError::Full)] if all transmit mailboxes are full. |     /// Returns [Err(TryWriteError::Full)] if all transmit mailboxes are full. | ||||||
|     pub fn try_write(&mut self, frame: &Frame) -> Result<bxcan::TransmitStatus, TryWriteError> { |     pub fn try_write(&mut self, frame: &Frame) -> Result<bxcan::TransmitStatus, TryWriteError> { | ||||||
|         CanTx { can: &self.can }.try_write(frame) |         self.split().0.try_write(frame) | ||||||
|     } |     } | ||||||
|  |  | ||||||
|     /// Waits for a specific transmit mailbox to become empty |     /// Waits for a specific transmit mailbox to become empty | ||||||
|     pub async fn flush(&self, mb: bxcan::Mailbox) { |     pub async fn flush(&self, mb: bxcan::Mailbox) { | ||||||
|         CanTx { can: &self.can }.flush(mb).await |         CanTx::<T>::flush_inner(mb).await | ||||||
|     } |     } | ||||||
|  |  | ||||||
|     /// Waits until any of the transmit mailboxes become empty |     /// Waits until any of the transmit mailboxes become empty | ||||||
|     pub async fn flush_any(&self) { |     pub async fn flush_any(&self) { | ||||||
|         CanTx { can: &self.can }.flush_any().await |         CanTx::<T>::flush_any_inner().await | ||||||
|     } |     } | ||||||
|  |  | ||||||
|     /// Waits until all of the transmit mailboxes become empty |     /// Waits until all of the transmit mailboxes become empty | ||||||
|     pub async fn flush_all(&self) { |     pub async fn flush_all(&self) { | ||||||
|         CanTx { can: &self.can }.flush_all().await |         CanTx::<T>::flush_all_inner().await | ||||||
|     } |     } | ||||||
|  |  | ||||||
|     /// Returns a tuple of the time the message was received and the message frame |     /// Returns a tuple of the time the message was received and the message frame | ||||||
|     pub async fn read(&mut self) -> Result<Envelope, BusError> { |     pub async fn read(&mut self) -> Result<Envelope, BusError> { | ||||||
|         CanRx { can: &self.can }.read().await |         self.split().1.read().await | ||||||
|     } |     } | ||||||
|  |  | ||||||
|     /// Attempts to read a can frame without blocking. |     /// Attempts to read a can frame without blocking. | ||||||
|     /// |     /// | ||||||
|     /// Returns [Err(TryReadError::Empty)] if there are no frames in the rx queue. |     /// Returns [Err(TryReadError::Empty)] if there are no frames in the rx queue. | ||||||
|     pub fn try_read(&mut self) -> Result<Envelope, TryReadError> { |     pub fn try_read(&mut self) -> Result<Envelope, TryReadError> { | ||||||
|         CanRx { can: &self.can }.try_read() |         self.split().1.try_read() | ||||||
|     } |     } | ||||||
|  |  | ||||||
|     /// Waits while receive queue is empty. |     /// Waits while receive queue is empty. | ||||||
|     pub async fn wait_not_empty(&mut self) { |     pub async fn wait_not_empty(&mut self) { | ||||||
|         CanRx { can: &self.can }.wait_not_empty().await |         self.split().1.wait_not_empty().await | ||||||
|     } |     } | ||||||
|  |  | ||||||
|     unsafe fn receive_fifo(fifo: RxFifo) { |     unsafe fn receive_fifo(fifo: RxFifo) { | ||||||
| @@ -385,24 +379,25 @@ impl<'d, T: Instance> Can<'d, T> { | |||||||
|         Some((sjw - 1) << 24 | (bs1 as u32 - 1) << 16 | (bs2 as u32 - 1) << 20 | (prescaler - 1)) |         Some((sjw - 1) << 24 | (bs1 as u32 - 1) << 16 | (bs2 as u32 - 1) << 20 | (prescaler - 1)) | ||||||
|     } |     } | ||||||
|  |  | ||||||
|     pub fn split<'c>(&'c self) -> (CanTx<'c, 'd, T>, CanRx<'c, 'd, T>) { |     pub fn split<'c>(&'c mut self) -> (CanTx<'c, 'd, T>, CanRx<'c, 'd, T>) { | ||||||
|         (CanTx { can: &self.can }, CanRx { can: &self.can }) |         let (tx, rx0, rx1) = self.can.split_by_ref(); | ||||||
|  |         (CanTx { tx }, CanRx { rx0, rx1 }) | ||||||
|     } |     } | ||||||
|  |  | ||||||
|     pub fn as_mut(&self) -> RefMut<'_, bxcan::Can<BxcanInstance<'d, T>>> { |     pub fn as_mut(&mut self) -> &mut bxcan::Can<BxcanInstance<'d, T>> { | ||||||
|         self.can.borrow_mut() |         &mut self.can | ||||||
|     } |     } | ||||||
| } | } | ||||||
|  |  | ||||||
| pub struct CanTx<'c, 'd, T: Instance> { | pub struct CanTx<'c, 'd, T: Instance> { | ||||||
|     can: &'c RefCell<bxcan::Can<BxcanInstance<'d, T>>>, |     tx: &'c mut bxcan::Tx<BxcanInstance<'d, T>>, | ||||||
| } | } | ||||||
|  |  | ||||||
| impl<'c, 'd, T: Instance> CanTx<'c, 'd, T> { | impl<'c, 'd, T: Instance> CanTx<'c, 'd, T> { | ||||||
|     pub async fn write(&mut self, frame: &Frame) -> bxcan::TransmitStatus { |     pub async fn write(&mut self, frame: &Frame) -> bxcan::TransmitStatus { | ||||||
|         poll_fn(|cx| { |         poll_fn(|cx| { | ||||||
|             T::state().tx_waker.register(cx.waker()); |             T::state().tx_waker.register(cx.waker()); | ||||||
|             if let Ok(status) = self.can.borrow_mut().transmit(frame) { |             if let Ok(status) = self.tx.transmit(frame) { | ||||||
|                 return Poll::Ready(status); |                 return Poll::Ready(status); | ||||||
|             } |             } | ||||||
|  |  | ||||||
| @@ -415,11 +410,10 @@ impl<'c, 'd, T: Instance> CanTx<'c, 'd, T> { | |||||||
|     /// |     /// | ||||||
|     /// Returns [Err(TryWriteError::Full)] if all transmit mailboxes are full. |     /// Returns [Err(TryWriteError::Full)] if all transmit mailboxes are full. | ||||||
|     pub fn try_write(&mut self, frame: &Frame) -> Result<bxcan::TransmitStatus, TryWriteError> { |     pub fn try_write(&mut self, frame: &Frame) -> Result<bxcan::TransmitStatus, TryWriteError> { | ||||||
|         self.can.borrow_mut().transmit(frame).map_err(|_| TryWriteError::Full) |         self.tx.transmit(frame).map_err(|_| TryWriteError::Full) | ||||||
|     } |     } | ||||||
|  |  | ||||||
|     /// Waits for a specific transmit mailbox to become empty |     async fn flush_inner(mb: bxcan::Mailbox) { | ||||||
|     pub async fn flush(&self, mb: bxcan::Mailbox) { |  | ||||||
|         poll_fn(|cx| { |         poll_fn(|cx| { | ||||||
|             T::state().tx_waker.register(cx.waker()); |             T::state().tx_waker.register(cx.waker()); | ||||||
|             if T::regs().tsr().read().tme(mb.index()) { |             if T::regs().tsr().read().tme(mb.index()) { | ||||||
| @@ -431,8 +425,12 @@ impl<'c, 'd, T: Instance> CanTx<'c, 'd, T> { | |||||||
|         .await; |         .await; | ||||||
|     } |     } | ||||||
|  |  | ||||||
|     /// Waits until any of the transmit mailboxes become empty |     /// Waits for a specific transmit mailbox to become empty | ||||||
|     pub async fn flush_any(&self) { |     pub async fn flush(&self, mb: bxcan::Mailbox) { | ||||||
|  |         Self::flush_inner(mb).await | ||||||
|  |     } | ||||||
|  |  | ||||||
|  |     async fn flush_any_inner() { | ||||||
|         poll_fn(|cx| { |         poll_fn(|cx| { | ||||||
|             T::state().tx_waker.register(cx.waker()); |             T::state().tx_waker.register(cx.waker()); | ||||||
|  |  | ||||||
| @@ -449,8 +447,12 @@ impl<'c, 'd, T: Instance> CanTx<'c, 'd, T> { | |||||||
|         .await; |         .await; | ||||||
|     } |     } | ||||||
|  |  | ||||||
|     /// Waits until all of the transmit mailboxes become empty |     /// Waits until any of the transmit mailboxes become empty | ||||||
|     pub async fn flush_all(&self) { |     pub async fn flush_any(&self) { | ||||||
|  |         Self::flush_any_inner().await | ||||||
|  |     } | ||||||
|  |  | ||||||
|  |     async fn flush_all_inner() { | ||||||
|         poll_fn(|cx| { |         poll_fn(|cx| { | ||||||
|             T::state().tx_waker.register(cx.waker()); |             T::state().tx_waker.register(cx.waker()); | ||||||
|  |  | ||||||
| @@ -466,11 +468,17 @@ impl<'c, 'd, T: Instance> CanTx<'c, 'd, T> { | |||||||
|         }) |         }) | ||||||
|         .await; |         .await; | ||||||
|     } |     } | ||||||
|  |  | ||||||
|  |     /// Waits until all of the transmit mailboxes become empty | ||||||
|  |     pub async fn flush_all(&self) { | ||||||
|  |         Self::flush_all_inner().await | ||||||
|  |     } | ||||||
| } | } | ||||||
|  |  | ||||||
| #[allow(dead_code)] | #[allow(dead_code)] | ||||||
| pub struct CanRx<'c, 'd, T: Instance> { | pub struct CanRx<'c, 'd, T: Instance> { | ||||||
|     can: &'c RefCell<bxcan::Can<BxcanInstance<'d, T>>>, |     rx0: &'c mut bxcan::Rx0<BxcanInstance<'d, T>>, | ||||||
|  |     rx1: &'c mut bxcan::Rx1<BxcanInstance<'d, T>>, | ||||||
| } | } | ||||||
|  |  | ||||||
| impl<'c, 'd, T: Instance> CanRx<'c, 'd, T> { | impl<'c, 'd, T: Instance> CanRx<'c, 'd, T> { | ||||||
| @@ -538,7 +546,7 @@ impl<'d, T: Instance> Drop for Can<'d, T> { | |||||||
| } | } | ||||||
|  |  | ||||||
| impl<'d, T: Instance> Deref for Can<'d, T> { | impl<'d, T: Instance> Deref for Can<'d, T> { | ||||||
|     type Target = RefCell<bxcan::Can<BxcanInstance<'d, T>>>; |     type Target = bxcan::Can<BxcanInstance<'d, T>>; | ||||||
|  |  | ||||||
|     fn deref(&self) -> &Self::Target { |     fn deref(&self) -> &Self::Target { | ||||||
|         &self.can |         &self.can | ||||||
|   | |||||||
| @@ -299,19 +299,15 @@ impl<'a, C: Channel> Transfer<'a, C> { | |||||||
|  |  | ||||||
|     pub fn request_stop(&mut self) { |     pub fn request_stop(&mut self) { | ||||||
|         let ch = self.channel.regs().ch(self.channel.num()); |         let ch = self.channel.regs().ch(self.channel.num()); | ||||||
|  |         ch.cr().modify(|w| { | ||||||
|         // Disable the channel. Keep the IEs enabled so the irqs still fire. |             w.set_susp(true); | ||||||
|         ch.cr().write(|w| { |  | ||||||
|             w.set_tcie(true); |  | ||||||
|             w.set_useie(true); |  | ||||||
|             w.set_dteie(true); |  | ||||||
|             w.set_suspie(true); |  | ||||||
|         }) |         }) | ||||||
|     } |     } | ||||||
|  |  | ||||||
|     pub fn is_running(&mut self) -> bool { |     pub fn is_running(&mut self) -> bool { | ||||||
|         let ch = self.channel.regs().ch(self.channel.num()); |         let ch = self.channel.regs().ch(self.channel.num()); | ||||||
|         !ch.sr().read().tcf() |         let sr = ch.sr().read(); | ||||||
|  |         !sr.tcf() && !sr.suspf() | ||||||
|     } |     } | ||||||
|  |  | ||||||
|     /// Gets the total remaining transfers for the channel |     /// Gets the total remaining transfers for the channel | ||||||
|   | |||||||
| @@ -119,13 +119,11 @@ impl<'a> TDesRing<'a> { | |||||||
|         // "Preceding reads and writes cannot be moved past subsequent writes." |         // "Preceding reads and writes cannot be moved past subsequent writes." | ||||||
|         fence(Ordering::Release); |         fence(Ordering::Release); | ||||||
|  |  | ||||||
|         self.index = self.index + 1; |  | ||||||
|         if self.index == self.descriptors.len() { |  | ||||||
|             self.index = 0; |  | ||||||
|         } |  | ||||||
|  |  | ||||||
|         // signal DMA it can try again. |         // signal DMA it can try again. | ||||||
|         ETH.ethernet_dma().dmactx_dtpr().write(|w| w.0 = 0) |         // See issue #2129 | ||||||
|  |         ETH.ethernet_dma().dmactx_dtpr().write(|w| w.0 = &td as *const _ as u32); | ||||||
|  |  | ||||||
|  |         self.index = (self.index + 1) % self.descriptors.len(); | ||||||
|     } |     } | ||||||
| } | } | ||||||
|  |  | ||||||
| @@ -237,21 +235,19 @@ impl<'a> RDesRing<'a> { | |||||||
|  |  | ||||||
|     /// Pop the packet previously returned by `available`. |     /// Pop the packet previously returned by `available`. | ||||||
|     pub(crate) fn pop_packet(&mut self) { |     pub(crate) fn pop_packet(&mut self) { | ||||||
|         let descriptor = &mut self.descriptors[self.index]; |         let rd = &mut self.descriptors[self.index]; | ||||||
|         assert!(descriptor.available()); |         assert!(rd.available()); | ||||||
|  |  | ||||||
|         self.descriptors[self.index].set_ready(self.buffers[self.index].0.as_mut_ptr()); |         rd.set_ready(self.buffers[self.index].0.as_mut_ptr()); | ||||||
|  |  | ||||||
|         // "Preceding reads and writes cannot be moved past subsequent writes." |         // "Preceding reads and writes cannot be moved past subsequent writes." | ||||||
|         fence(Ordering::Release); |         fence(Ordering::Release); | ||||||
|  |  | ||||||
|         // signal DMA it can try again. |         // signal DMA it can try again. | ||||||
|         ETH.ethernet_dma().dmacrx_dtpr().write(|w| w.0 = 0); |         // See issue #2129 | ||||||
|  |         ETH.ethernet_dma().dmacrx_dtpr().write(|w| w.0 = &rd as *const _ as u32); | ||||||
|  |  | ||||||
|         // Increment index. |         // Increment index. | ||||||
|         self.index += 1; |         self.index = (self.index + 1) % self.descriptors.len(); | ||||||
|         if self.index == self.descriptors.len() { |  | ||||||
|             self.index = 0 |  | ||||||
|         } |  | ||||||
|     } |     } | ||||||
| } | } | ||||||
|   | |||||||
| @@ -1,21 +1,16 @@ | |||||||
| use core::cmp; | use core::cmp; | ||||||
| #[cfg(feature = "time")] |  | ||||||
| use core::future::poll_fn; | use core::future::poll_fn; | ||||||
| use core::marker::PhantomData; | use core::marker::PhantomData; | ||||||
| #[cfg(feature = "time")] |  | ||||||
| use core::task::Poll; | use core::task::Poll; | ||||||
|  |  | ||||||
| use embassy_embedded_hal::SetConfig; | use embassy_embedded_hal::SetConfig; | ||||||
| #[cfg(feature = "time")] |  | ||||||
| use embassy_hal_internal::drop::OnDrop; | use embassy_hal_internal::drop::OnDrop; | ||||||
| use embassy_hal_internal::{into_ref, PeripheralRef}; | use embassy_hal_internal::{into_ref, PeripheralRef}; | ||||||
| use embassy_sync::waitqueue::AtomicWaker; | use embassy_sync::waitqueue::AtomicWaker; | ||||||
| #[cfg(feature = "time")] | #[cfg(feature = "time")] | ||||||
| use embassy_time::{Duration, Instant}; | use embassy_time::{Duration, Instant}; | ||||||
|  |  | ||||||
| use crate::dma::NoDma; | use crate::dma::{NoDma, Transfer}; | ||||||
| #[cfg(feature = "time")] |  | ||||||
| use crate::dma::Transfer; |  | ||||||
| use crate::gpio::sealed::AFType; | use crate::gpio::sealed::AFType; | ||||||
| use crate::gpio::Pull; | use crate::gpio::Pull; | ||||||
| use crate::i2c::{Error, Instance, SclPin, SdaPin}; | use crate::i2c::{Error, Instance, SclPin, SdaPin}; | ||||||
| @@ -24,6 +19,23 @@ use crate::pac::i2c; | |||||||
| use crate::time::Hertz; | use crate::time::Hertz; | ||||||
| use crate::{interrupt, Peripheral}; | use crate::{interrupt, Peripheral}; | ||||||
|  |  | ||||||
|  | #[cfg(feature = "time")] | ||||||
|  | fn timeout_fn(timeout: Duration) -> impl Fn() -> Result<(), Error> { | ||||||
|  |     let deadline = Instant::now() + timeout; | ||||||
|  |     move || { | ||||||
|  |         if Instant::now() > deadline { | ||||||
|  |             Err(Error::Timeout) | ||||||
|  |         } else { | ||||||
|  |             Ok(()) | ||||||
|  |         } | ||||||
|  |     } | ||||||
|  | } | ||||||
|  |  | ||||||
|  | #[cfg(not(feature = "time"))] | ||||||
|  | pub fn no_timeout_fn() -> impl Fn() -> Result<(), Error> { | ||||||
|  |     move || Ok(()) | ||||||
|  | } | ||||||
|  |  | ||||||
| /// Interrupt handler. | /// Interrupt handler. | ||||||
| pub struct InterruptHandler<T: Instance> { | pub struct InterruptHandler<T: Instance> { | ||||||
|     _phantom: PhantomData<T>, |     _phantom: PhantomData<T>, | ||||||
| @@ -260,21 +272,12 @@ impl<'d, T: Instance, TXDMA, RXDMA> I2c<'d, T, TXDMA, RXDMA> { | |||||||
|     } |     } | ||||||
|  |  | ||||||
|     fn flush_txdr(&self) { |     fn flush_txdr(&self) { | ||||||
|         //if $i2c.isr.read().txis().bit_is_set() { |  | ||||||
|         //$i2c.txdr.write(|w| w.txdata().bits(0)); |  | ||||||
|         //} |  | ||||||
|  |  | ||||||
|         if T::regs().isr().read().txis() { |         if T::regs().isr().read().txis() { | ||||||
|             T::regs().txdr().write(|w| w.set_txdata(0)); |             T::regs().txdr().write(|w| w.set_txdata(0)); | ||||||
|         } |         } | ||||||
|         if !T::regs().isr().read().txe() { |         if !T::regs().isr().read().txe() { | ||||||
|             T::regs().isr().modify(|w| w.set_txe(true)) |             T::regs().isr().modify(|w| w.set_txe(true)) | ||||||
|         } |         } | ||||||
|  |  | ||||||
|         // If TXDR is not flagged as empty, write 1 to flush it |  | ||||||
|         //if $i2c.isr.read().txe().is_not_empty() { |  | ||||||
|         //$i2c.isr.write(|w| w.txe().set_bit()); |  | ||||||
|         //} |  | ||||||
|     } |     } | ||||||
|  |  | ||||||
|     fn wait_txe(&self, check_timeout: impl Fn() -> Result<(), Error>) -> Result<(), Error> { |     fn wait_txe(&self, check_timeout: impl Fn() -> Result<(), Error>) -> Result<(), Error> { | ||||||
| @@ -437,7 +440,6 @@ impl<'d, T: Instance, TXDMA, RXDMA> I2c<'d, T, TXDMA, RXDMA> { | |||||||
|         result |         result | ||||||
|     } |     } | ||||||
|  |  | ||||||
|     #[cfg(feature = "time")] |  | ||||||
|     async fn write_dma_internal( |     async fn write_dma_internal( | ||||||
|         &mut self, |         &mut self, | ||||||
|         address: u8, |         address: u8, | ||||||
| @@ -528,7 +530,6 @@ impl<'d, T: Instance, TXDMA, RXDMA> I2c<'d, T, TXDMA, RXDMA> { | |||||||
|         Ok(()) |         Ok(()) | ||||||
|     } |     } | ||||||
|  |  | ||||||
|     #[cfg(feature = "time")] |  | ||||||
|     async fn read_dma_internal( |     async fn read_dma_internal( | ||||||
|         &mut self, |         &mut self, | ||||||
|         address: u8, |         address: u8, | ||||||
| @@ -610,42 +611,38 @@ impl<'d, T: Instance, TXDMA, RXDMA> I2c<'d, T, TXDMA, RXDMA> { | |||||||
|  |  | ||||||
|     // ========================= |     // ========================= | ||||||
|     //  Async public API |     //  Async public API | ||||||
|  |  | ||||||
|     #[cfg(feature = "time")] |     #[cfg(feature = "time")] | ||||||
|     pub async fn write(&mut self, address: u8, write: &[u8]) -> Result<(), Error> |     pub async fn write(&mut self, address: u8, write: &[u8]) -> Result<(), Error> | ||||||
|     where |  | ||||||
|         TXDMA: crate::i2c::TxDma<T>, |  | ||||||
|     { |  | ||||||
|         self.write_timeout(address, write, self.timeout).await |  | ||||||
|     } |  | ||||||
|  |  | ||||||
|     #[cfg(feature = "time")] |  | ||||||
|     pub async fn write_timeout(&mut self, address: u8, write: &[u8], timeout: Duration) -> Result<(), Error> |  | ||||||
|     where |     where | ||||||
|         TXDMA: crate::i2c::TxDma<T>, |         TXDMA: crate::i2c::TxDma<T>, | ||||||
|     { |     { | ||||||
|         if write.is_empty() { |         if write.is_empty() { | ||||||
|             self.write_internal(address, write, true, timeout_fn(timeout)) |             self.write_internal(address, write, true, timeout_fn(self.timeout)) | ||||||
|         } else { |         } else { | ||||||
|             embassy_time::with_timeout( |             embassy_time::with_timeout( | ||||||
|                 timeout, |                 self.timeout, | ||||||
|                 self.write_dma_internal(address, write, true, true, timeout_fn(timeout)), |                 self.write_dma_internal(address, write, true, true, timeout_fn(self.timeout)), | ||||||
|             ) |             ) | ||||||
|             .await |             .await | ||||||
|             .unwrap_or(Err(Error::Timeout)) |             .unwrap_or(Err(Error::Timeout)) | ||||||
|         } |         } | ||||||
|     } |     } | ||||||
|  |  | ||||||
|     #[cfg(feature = "time")] |     #[cfg(not(feature = "time"))] | ||||||
|     pub async fn write_vectored(&mut self, address: u8, write: &[&[u8]]) -> Result<(), Error> |     pub async fn write(&mut self, address: u8, write: &[u8]) -> Result<(), Error> | ||||||
|     where |     where | ||||||
|         TXDMA: crate::i2c::TxDma<T>, |         TXDMA: crate::i2c::TxDma<T>, | ||||||
|     { |     { | ||||||
|         self.write_vectored_timeout(address, write, self.timeout).await |         if write.is_empty() { | ||||||
|  |             self.write_internal(address, write, true, no_timeout_fn()) | ||||||
|  |         } else { | ||||||
|  |             self.write_dma_internal(address, write, true, true, no_timeout_fn()) | ||||||
|  |                 .await | ||||||
|  |         } | ||||||
|     } |     } | ||||||
|  |  | ||||||
|     #[cfg(feature = "time")] |     #[cfg(feature = "time")] | ||||||
|     pub async fn write_vectored_timeout(&mut self, address: u8, write: &[&[u8]], timeout: Duration) -> Result<(), Error> |     pub async fn write_vectored(&mut self, address: u8, write: &[&[u8]]) -> Result<(), Error> | ||||||
|     where |     where | ||||||
|         TXDMA: crate::i2c::TxDma<T>, |         TXDMA: crate::i2c::TxDma<T>, | ||||||
|     { |     { | ||||||
| @@ -661,8 +658,8 @@ impl<'d, T: Instance, TXDMA, RXDMA> I2c<'d, T, TXDMA, RXDMA> { | |||||||
|             let is_last = next.is_none(); |             let is_last = next.is_none(); | ||||||
|  |  | ||||||
|             embassy_time::with_timeout( |             embassy_time::with_timeout( | ||||||
|                 timeout, |                 self.timeout, | ||||||
|                 self.write_dma_internal(address, c, first, is_last, timeout_fn(timeout)), |                 self.write_dma_internal(address, c, first, is_last, timeout_fn(self.timeout)), | ||||||
|             ) |             ) | ||||||
|             .await |             .await | ||||||
|             .unwrap_or(Err(Error::Timeout))?; |             .unwrap_or(Err(Error::Timeout))?; | ||||||
| @@ -672,66 +669,79 @@ impl<'d, T: Instance, TXDMA, RXDMA> I2c<'d, T, TXDMA, RXDMA> { | |||||||
|         Ok(()) |         Ok(()) | ||||||
|     } |     } | ||||||
|  |  | ||||||
|  |     #[cfg(not(feature = "time"))] | ||||||
|  |     pub async fn write_vectored(&mut self, address: u8, write: &[&[u8]]) -> Result<(), Error> | ||||||
|  |     where | ||||||
|  |         TXDMA: crate::i2c::TxDma<T>, | ||||||
|  |     { | ||||||
|  |         if write.is_empty() { | ||||||
|  |             return Err(Error::ZeroLengthTransfer); | ||||||
|  |         } | ||||||
|  |         let mut iter = write.iter(); | ||||||
|  |  | ||||||
|  |         let mut first = true; | ||||||
|  |         let mut current = iter.next(); | ||||||
|  |         while let Some(c) = current { | ||||||
|  |             let next = iter.next(); | ||||||
|  |             let is_last = next.is_none(); | ||||||
|  |  | ||||||
|  |             self.write_dma_internal(address, c, first, is_last, no_timeout_fn()) | ||||||
|  |                 .await?; | ||||||
|  |             first = false; | ||||||
|  |             current = next; | ||||||
|  |         } | ||||||
|  |         Ok(()) | ||||||
|  |     } | ||||||
|  |  | ||||||
|     #[cfg(feature = "time")] |     #[cfg(feature = "time")] | ||||||
|     pub async fn read(&mut self, address: u8, buffer: &mut [u8]) -> Result<(), Error> |     pub async fn read(&mut self, address: u8, buffer: &mut [u8]) -> Result<(), Error> | ||||||
|     where |     where | ||||||
|         RXDMA: crate::i2c::RxDma<T>, |         RXDMA: crate::i2c::RxDma<T>, | ||||||
|     { |     { | ||||||
|         self.read_timeout(address, buffer, self.timeout).await |         if buffer.is_empty() { | ||||||
|  |             self.read_internal(address, buffer, false, timeout_fn(self.timeout)) | ||||||
|  |         } else { | ||||||
|  |             embassy_time::with_timeout( | ||||||
|  |                 self.timeout, | ||||||
|  |                 self.read_dma_internal(address, buffer, false, timeout_fn(self.timeout)), | ||||||
|  |             ) | ||||||
|  |             .await | ||||||
|  |             .unwrap_or(Err(Error::Timeout)) | ||||||
|  |         } | ||||||
|     } |     } | ||||||
|  |  | ||||||
|     #[cfg(feature = "time")] |     #[cfg(not(feature = "time"))] | ||||||
|     pub async fn read_timeout(&mut self, address: u8, buffer: &mut [u8], timeout: Duration) -> Result<(), Error> |     pub async fn read(&mut self, address: u8, buffer: &mut [u8]) -> Result<(), Error> | ||||||
|     where |     where | ||||||
|         RXDMA: crate::i2c::RxDma<T>, |         RXDMA: crate::i2c::RxDma<T>, | ||||||
|     { |     { | ||||||
|         if buffer.is_empty() { |         if buffer.is_empty() { | ||||||
|             self.read_internal(address, buffer, false, timeout_fn(timeout)) |             self.read_internal(address, buffer, false, no_timeout_fn()) | ||||||
|         } else { |         } else { | ||||||
|             embassy_time::with_timeout( |             self.read_dma_internal(address, buffer, false, no_timeout_fn()).await | ||||||
|                 timeout, |  | ||||||
|                 self.read_dma_internal(address, buffer, false, timeout_fn(timeout)), |  | ||||||
|             ) |  | ||||||
|             .await |  | ||||||
|             .unwrap_or(Err(Error::Timeout)) |  | ||||||
|         } |         } | ||||||
|     } |     } | ||||||
|  |  | ||||||
|     #[cfg(feature = "time")] |     #[cfg(feature = "time")] | ||||||
|     pub async fn write_read(&mut self, address: u8, write: &[u8], read: &mut [u8]) -> Result<(), Error> |     pub async fn write_read(&mut self, address: u8, write: &[u8], read: &mut [u8]) -> Result<(), Error> | ||||||
|     where |  | ||||||
|         TXDMA: super::TxDma<T>, |  | ||||||
|         RXDMA: super::RxDma<T>, |  | ||||||
|     { |  | ||||||
|         self.write_read_timeout(address, write, read, self.timeout).await |  | ||||||
|     } |  | ||||||
|  |  | ||||||
|     #[cfg(feature = "time")] |  | ||||||
|     pub async fn write_read_timeout( |  | ||||||
|         &mut self, |  | ||||||
|         address: u8, |  | ||||||
|         write: &[u8], |  | ||||||
|         read: &mut [u8], |  | ||||||
|         timeout: Duration, |  | ||||||
|     ) -> Result<(), Error> |  | ||||||
|     where |     where | ||||||
|         TXDMA: super::TxDma<T>, |         TXDMA: super::TxDma<T>, | ||||||
|         RXDMA: super::RxDma<T>, |         RXDMA: super::RxDma<T>, | ||||||
|     { |     { | ||||||
|         let start_instant = Instant::now(); |         let start_instant = Instant::now(); | ||||||
|         let check_timeout = timeout_fn(timeout); |         let check_timeout = timeout_fn(self.timeout); | ||||||
|         if write.is_empty() { |         if write.is_empty() { | ||||||
|             self.write_internal(address, write, false, &check_timeout)?; |             self.write_internal(address, write, false, &check_timeout)?; | ||||||
|         } else { |         } else { | ||||||
|             embassy_time::with_timeout( |             embassy_time::with_timeout( | ||||||
|                 timeout, |                 self.timeout, | ||||||
|                 self.write_dma_internal(address, write, true, true, &check_timeout), |                 self.write_dma_internal(address, write, true, true, &check_timeout), | ||||||
|             ) |             ) | ||||||
|             .await |             .await | ||||||
|             .unwrap_or(Err(Error::Timeout))?; |             .unwrap_or(Err(Error::Timeout))?; | ||||||
|         } |         } | ||||||
|  |  | ||||||
|         let time_left_until_timeout = timeout - Instant::now().duration_since(start_instant); |         let time_left_until_timeout = self.timeout - Instant::now().duration_since(start_instant); | ||||||
|  |  | ||||||
|         if read.is_empty() { |         if read.is_empty() { | ||||||
|             self.read_internal(address, read, true, &check_timeout)?; |             self.read_internal(address, read, true, &check_timeout)?; | ||||||
| @@ -747,6 +757,28 @@ impl<'d, T: Instance, TXDMA, RXDMA> I2c<'d, T, TXDMA, RXDMA> { | |||||||
|         Ok(()) |         Ok(()) | ||||||
|     } |     } | ||||||
|  |  | ||||||
|  |     #[cfg(not(feature = "time"))] | ||||||
|  |     pub async fn write_read(&mut self, address: u8, write: &[u8], read: &mut [u8]) -> Result<(), Error> | ||||||
|  |     where | ||||||
|  |         TXDMA: super::TxDma<T>, | ||||||
|  |         RXDMA: super::RxDma<T>, | ||||||
|  |     { | ||||||
|  |         let no_timeout = no_timeout_fn(); | ||||||
|  |         if write.is_empty() { | ||||||
|  |             self.write_internal(address, write, false, &no_timeout)?; | ||||||
|  |         } else { | ||||||
|  |             self.write_dma_internal(address, write, true, true, &no_timeout).await?; | ||||||
|  |         } | ||||||
|  |  | ||||||
|  |         if read.is_empty() { | ||||||
|  |             self.read_internal(address, read, true, &no_timeout)?; | ||||||
|  |         } else { | ||||||
|  |             self.read_dma_internal(address, read, true, &no_timeout).await?; | ||||||
|  |         } | ||||||
|  |  | ||||||
|  |         Ok(()) | ||||||
|  |     } | ||||||
|  |  | ||||||
|     // ========================= |     // ========================= | ||||||
|     //  Blocking public API |     //  Blocking public API | ||||||
|  |  | ||||||
| @@ -1201,15 +1233,3 @@ impl<'d, T: Instance> SetConfig for I2c<'d, T> { | |||||||
|         Ok(()) |         Ok(()) | ||||||
|     } |     } | ||||||
| } | } | ||||||
|  |  | ||||||
| #[cfg(feature = "time")] |  | ||||||
| fn timeout_fn(timeout: Duration) -> impl Fn() -> Result<(), Error> { |  | ||||||
|     let deadline = Instant::now() + timeout; |  | ||||||
|     move || { |  | ||||||
|         if Instant::now() > deadline { |  | ||||||
|             Err(Error::Timeout) |  | ||||||
|         } else { |  | ||||||
|             Ok(()) |  | ||||||
|         } |  | ||||||
|     } |  | ||||||
| } |  | ||||||
|   | |||||||
| @@ -31,12 +31,9 @@ impl From<OpAmpSpeed> for crate::pac::opamp::vals::OpampCsrOpahsm { | |||||||
|  |  | ||||||
| /// OpAmp external outputs, wired to a GPIO pad. | /// OpAmp external outputs, wired to a GPIO pad. | ||||||
| /// | /// | ||||||
| /// The GPIO output pad is held by this struct to ensure it cannot be used elsewhere. |  | ||||||
| /// |  | ||||||
| /// This struct can also be used as an ADC input. | /// This struct can also be used as an ADC input. | ||||||
| pub struct OpAmpOutput<'d, 'p, T: Instance, P: OutputPin<T>> { | pub struct OpAmpOutput<'d, T: Instance> { | ||||||
|     _inner: &'d OpAmp<'d, T>, |     _inner: &'d OpAmp<'d, T>, | ||||||
|     _output: &'p mut P, |  | ||||||
| } | } | ||||||
|  |  | ||||||
| /// OpAmp internal outputs, wired directly to ADC inputs. | /// OpAmp internal outputs, wired directly to ADC inputs. | ||||||
| @@ -54,19 +51,12 @@ pub struct OpAmp<'d, T: Instance> { | |||||||
| impl<'d, T: Instance> OpAmp<'d, T> { | impl<'d, T: Instance> OpAmp<'d, T> { | ||||||
|     /// Create a new driver instance. |     /// Create a new driver instance. | ||||||
|     /// |     /// | ||||||
|     /// Enables the OpAmp and configures the speed, but |     /// Does not enable the opamp, but does set the speed mode on some families. | ||||||
|     /// does not set any other configuration. |  | ||||||
|     pub fn new(opamp: impl Peripheral<P = T> + 'd, #[cfg(opamp_g4)] speed: OpAmpSpeed) -> Self { |     pub fn new(opamp: impl Peripheral<P = T> + 'd, #[cfg(opamp_g4)] speed: OpAmpSpeed) -> Self { | ||||||
|         into_ref!(opamp); |         into_ref!(opamp); | ||||||
|  |  | ||||||
|         #[cfg(opamp_f3)] |  | ||||||
|         T::regs().opampcsr().modify(|w| { |  | ||||||
|             w.set_opampen(true); |  | ||||||
|         }); |  | ||||||
|  |  | ||||||
|         #[cfg(opamp_g4)] |         #[cfg(opamp_g4)] | ||||||
|         T::regs().opamp_csr().modify(|w| { |         T::regs().opamp_csr().modify(|w| { | ||||||
|             w.set_opaen(true); |  | ||||||
|             w.set_opahsm(speed.into()); |             w.set_opahsm(speed.into()); | ||||||
|         }); |         }); | ||||||
|  |  | ||||||
| @@ -74,24 +64,23 @@ impl<'d, T: Instance> OpAmp<'d, T> { | |||||||
|     } |     } | ||||||
|  |  | ||||||
|     /// Configure the OpAmp as a buffer for the provided input pin, |     /// Configure the OpAmp as a buffer for the provided input pin, | ||||||
|     /// outputting to the provided output pin. |     /// outputting to the provided output pin, and enable the opamp. | ||||||
|     /// |     /// | ||||||
|     /// The input pin is configured for analogue mode but not consumed, |     /// The input pin is configured for analogue mode but not consumed, | ||||||
|     /// so it may subsequently be used for ADC or comparator inputs. |     /// so it may subsequently be used for ADC or comparator inputs. | ||||||
|     /// |     /// | ||||||
|     /// The output pin is held within the returned [`OpAmpOutput`] struct, |     /// The output pin is held within the returned [`OpAmpOutput`] struct, | ||||||
|     /// preventing it being used elsewhere. The `OpAmpOutput` can then be |     /// preventing it being used elsewhere. The `OpAmpOutput` can then be | ||||||
|     /// directly used as an ADC input. |     /// directly used as an ADC input. The opamp will be disabled when the | ||||||
|     pub fn buffer_ext<'a, 'b, IP, OP>( |     /// [`OpAmpOutput`] is dropped. | ||||||
|         &'a mut self, |     pub fn buffer_ext( | ||||||
|         in_pin: &IP, |         &'d mut self, | ||||||
|         out_pin: &'b mut OP, |         in_pin: impl Peripheral<P = impl NonInvertingPin<T> + crate::gpio::sealed::Pin>, | ||||||
|  |         out_pin: impl Peripheral<P = impl OutputPin<T> + crate::gpio::sealed::Pin> + 'd, | ||||||
|         gain: OpAmpGain, |         gain: OpAmpGain, | ||||||
|     ) -> OpAmpOutput<'a, 'b, T, OP> |     ) -> OpAmpOutput<'d, T> { | ||||||
|     where |         into_ref!(in_pin); | ||||||
|         IP: NonInvertingPin<T> + crate::gpio::sealed::Pin, |         into_ref!(out_pin); | ||||||
|         OP: OutputPin<T> + crate::gpio::sealed::Pin, |  | ||||||
|     { |  | ||||||
|         in_pin.set_as_analog(); |         in_pin.set_as_analog(); | ||||||
|         out_pin.set_as_analog(); |         out_pin.set_as_analog(); | ||||||
|  |  | ||||||
| @@ -122,24 +111,24 @@ impl<'d, T: Instance> OpAmp<'d, T> { | |||||||
|             w.set_opaen(true); |             w.set_opaen(true); | ||||||
|         }); |         }); | ||||||
|  |  | ||||||
|         OpAmpOutput { |         OpAmpOutput { _inner: self } | ||||||
|             _inner: self, |  | ||||||
|             _output: out_pin, |  | ||||||
|         } |  | ||||||
|     } |     } | ||||||
|  |  | ||||||
|     /// Configure the OpAmp as a buffer for the provided input pin, |     /// Configure the OpAmp as a buffer for the provided input pin, | ||||||
|     /// with the output only used internally. |     /// with the output only used internally, and enable the opamp. | ||||||
|     /// |     /// | ||||||
|     /// The input pin is configured for analogue mode but not consumed, |     /// The input pin is configured for analogue mode but not consumed, | ||||||
|     /// so it may be subsequently used for ADC or comparator inputs. |     /// so it may be subsequently used for ADC or comparator inputs. | ||||||
|     /// |     /// | ||||||
|     /// The returned `OpAmpInternalOutput` struct may be used as an ADC input. |     /// The returned `OpAmpInternalOutput` struct may be used as an ADC input. | ||||||
|  |     /// The opamp output will be disabled when it is dropped. | ||||||
|     #[cfg(opamp_g4)] |     #[cfg(opamp_g4)] | ||||||
|     pub fn buffer_int<'a, P>(&'a mut self, pin: &P, gain: OpAmpGain) -> OpAmpInternalOutput<'a, T> |     pub fn buffer_int( | ||||||
|     where |         &'d mut self, | ||||||
|         P: NonInvertingPin<T> + crate::gpio::sealed::Pin, |         pin: impl Peripheral<P = impl NonInvertingPin<T> + crate::gpio::sealed::Pin>, | ||||||
|     { |         gain: OpAmpGain, | ||||||
|  |     ) -> OpAmpInternalOutput<'d, T> { | ||||||
|  |         into_ref!(pin); | ||||||
|         pin.set_as_analog(); |         pin.set_as_analog(); | ||||||
|  |  | ||||||
|         let (vm_sel, pga_gain) = match gain { |         let (vm_sel, pga_gain) = match gain { | ||||||
| @@ -163,7 +152,21 @@ impl<'d, T: Instance> OpAmp<'d, T> { | |||||||
|     } |     } | ||||||
| } | } | ||||||
|  |  | ||||||
| impl<'d, T: Instance> Drop for OpAmp<'d, T> { | impl<'d, T: Instance> Drop for OpAmpOutput<'d, T> { | ||||||
|  |     fn drop(&mut self) { | ||||||
|  |         #[cfg(opamp_f3)] | ||||||
|  |         T::regs().opampcsr().modify(|w| { | ||||||
|  |             w.set_opampen(false); | ||||||
|  |         }); | ||||||
|  |  | ||||||
|  |         #[cfg(opamp_g4)] | ||||||
|  |         T::regs().opamp_csr().modify(|w| { | ||||||
|  |             w.set_opaen(false); | ||||||
|  |         }); | ||||||
|  |     } | ||||||
|  | } | ||||||
|  |  | ||||||
|  | impl<'d, T: Instance> Drop for OpAmpInternalOutput<'d, T> { | ||||||
|     fn drop(&mut self) { |     fn drop(&mut self) { | ||||||
|         #[cfg(opamp_f3)] |         #[cfg(opamp_f3)] | ||||||
|         T::regs().opampcsr().modify(|w| { |         T::regs().opampcsr().modify(|w| { | ||||||
| @@ -203,16 +206,16 @@ macro_rules! impl_opamp_external_output { | |||||||
|     ($inst:ident, $adc:ident, $ch:expr) => { |     ($inst:ident, $adc:ident, $ch:expr) => { | ||||||
|         foreach_adc!( |         foreach_adc!( | ||||||
|             ($adc, $common_inst:ident, $adc_clock:ident) => { |             ($adc, $common_inst:ident, $adc_clock:ident) => { | ||||||
|                 impl<'d, 'p, P: OutputPin<crate::peripherals::$inst>> crate::adc::sealed::AdcPin<crate::peripherals::$adc> |                 impl<'d> crate::adc::sealed::AdcPin<crate::peripherals::$adc> | ||||||
|                     for OpAmpOutput<'d, 'p, crate::peripherals::$inst, P> |                     for OpAmpOutput<'d, crate::peripherals::$inst> | ||||||
|                 { |                 { | ||||||
|                     fn channel(&self) -> u8 { |                     fn channel(&self) -> u8 { | ||||||
|                         $ch |                         $ch | ||||||
|                     } |                     } | ||||||
|                 } |                 } | ||||||
|  |  | ||||||
|                 impl<'d, 'p, P: OutputPin<crate::peripherals::$inst>> crate::adc::AdcPin<crate::peripherals::$adc> |                 impl<'d> crate::adc::AdcPin<crate::peripherals::$adc> | ||||||
|                     for OpAmpOutput<'d, 'p, crate::peripherals::$inst, P> |                     for OpAmpOutput<'d, crate::peripherals::$inst> | ||||||
|                 { |                 { | ||||||
|                 } |                 } | ||||||
|             }; |             }; | ||||||
|   | |||||||
| @@ -1,9 +1,12 @@ | |||||||
| use crate::pac::pwr::vals::Vos; | use stm32_metapac::flash::vals::Latency; | ||||||
|  | 
 | ||||||
| pub use crate::pac::rcc::vals::{ | pub use crate::pac::rcc::vals::{ | ||||||
|     Hpre as AHBPrescaler, Pllm as PllPreDiv, Plln as PllMul, Pllp, Pllq, Pllr, Pllsrc as PllSource, |     Hpre as AHBPrescaler, Pllm as PllPreDiv, Plln as PllMul, Pllp as PllPDiv, Pllq as PllQDiv, Pllr as PllRDiv, | ||||||
|     Ppre as APBPrescaler, Sw as Sysclk, |     Pllsrc as PllSource, Ppre as APBPrescaler, Sw as Sysclk, | ||||||
| }; | }; | ||||||
| use crate::pac::{FLASH, PWR, RCC}; | #[cfg(any(stm32f4, stm32f7))] | ||||||
|  | use crate::pac::PWR; | ||||||
|  | use crate::pac::{FLASH, RCC}; | ||||||
| use crate::rcc::{set_freqs, Clocks}; | use crate::rcc::{set_freqs, Clocks}; | ||||||
| use crate::time::Hertz; | use crate::time::Hertz; | ||||||
| 
 | 
 | ||||||
| @@ -49,11 +52,27 @@ pub struct Pll { | |||||||
|     pub mul: PllMul, |     pub mul: PllMul, | ||||||
| 
 | 
 | ||||||
|     /// PLL P division factor. If None, PLL P output is disabled.
 |     /// PLL P division factor. If None, PLL P output is disabled.
 | ||||||
|     pub divp: Option<Pllp>, |     pub divp: Option<PllPDiv>, | ||||||
|     /// PLL Q division factor. If None, PLL Q output is disabled.
 |     /// PLL Q division factor. If None, PLL Q output is disabled.
 | ||||||
|     pub divq: Option<Pllq>, |     pub divq: Option<PllQDiv>, | ||||||
|     /// PLL R division factor. If None, PLL R output is disabled.
 |     /// PLL R division factor. If None, PLL R output is disabled.
 | ||||||
|     pub divr: Option<Pllr>, |     pub divr: Option<PllRDiv>, | ||||||
|  | } | ||||||
|  | 
 | ||||||
|  | /// Voltage range of the power supply used.
 | ||||||
|  | ///
 | ||||||
|  | /// Used to calculate flash waitstates. See
 | ||||||
|  | /// RM0033 - Table 3. Number of wait states according to Cortex®-M3 clock frequency
 | ||||||
|  | #[cfg(stm32f2)] | ||||||
|  | pub enum VoltageScale { | ||||||
|  |     /// 2.7 to 3.6 V
 | ||||||
|  |     Range0, | ||||||
|  |     /// 2.4 to 2.7 V
 | ||||||
|  |     Range1, | ||||||
|  |     /// 2.1 to 2.4 V
 | ||||||
|  |     Range2, | ||||||
|  |     /// 1.8 to 2.1 V
 | ||||||
|  |     Range3, | ||||||
| } | } | ||||||
| 
 | 
 | ||||||
| /// Configuration of the core clocks
 | /// Configuration of the core clocks
 | ||||||
| @@ -66,7 +85,7 @@ pub struct Config { | |||||||
|     pub pll_src: PllSource, |     pub pll_src: PllSource, | ||||||
| 
 | 
 | ||||||
|     pub pll: Option<Pll>, |     pub pll: Option<Pll>, | ||||||
|     #[cfg(any(all(stm32f4, not(stm32f410)), stm32f7))] |     #[cfg(any(stm32f2, all(stm32f4, not(stm32f410)), stm32f7))] | ||||||
|     pub plli2s: Option<Pll>, |     pub plli2s: Option<Pll>, | ||||||
|     #[cfg(any(stm32f446, stm32f427, stm32f437, stm32f4x9, stm32f7))] |     #[cfg(any(stm32f446, stm32f427, stm32f437, stm32f4x9, stm32f7))] | ||||||
|     pub pllsai: Option<Pll>, |     pub pllsai: Option<Pll>, | ||||||
| @@ -76,6 +95,9 @@ pub struct Config { | |||||||
|     pub apb2_pre: APBPrescaler, |     pub apb2_pre: APBPrescaler, | ||||||
| 
 | 
 | ||||||
|     pub ls: super::LsConfig, |     pub ls: super::LsConfig, | ||||||
|  | 
 | ||||||
|  |     #[cfg(stm32f2)] | ||||||
|  |     pub voltage: VoltageScale, | ||||||
| } | } | ||||||
| 
 | 
 | ||||||
| impl Default for Config { | impl Default for Config { | ||||||
| @@ -86,7 +108,7 @@ impl Default for Config { | |||||||
|             sys: Sysclk::HSI, |             sys: Sysclk::HSI, | ||||||
|             pll_src: PllSource::HSI, |             pll_src: PllSource::HSI, | ||||||
|             pll: None, |             pll: None, | ||||||
|             #[cfg(any(all(stm32f4, not(stm32f410)), stm32f7))] |             #[cfg(any(stm32f2, all(stm32f4, not(stm32f410)), stm32f7))] | ||||||
|             plli2s: None, |             plli2s: None, | ||||||
|             #[cfg(any(stm32f446, stm32f427, stm32f437, stm32f4x9, stm32f7))] |             #[cfg(any(stm32f446, stm32f427, stm32f437, stm32f4x9, stm32f7))] | ||||||
|             pllsai: None, |             pllsai: None, | ||||||
| @@ -96,6 +118,9 @@ impl Default for Config { | |||||||
|             apb2_pre: APBPrescaler::DIV1, |             apb2_pre: APBPrescaler::DIV1, | ||||||
| 
 | 
 | ||||||
|             ls: Default::default(), |             ls: Default::default(), | ||||||
|  | 
 | ||||||
|  |             #[cfg(stm32f2)] | ||||||
|  |             voltage: VoltageScale::Range3, | ||||||
|         } |         } | ||||||
|     } |     } | ||||||
| } | } | ||||||
| @@ -103,14 +128,13 @@ impl Default for Config { | |||||||
| pub(crate) unsafe fn init(config: Config) { | pub(crate) unsafe fn init(config: Config) { | ||||||
|     // set VOS to SCALE1, if use PLL
 |     // set VOS to SCALE1, if use PLL
 | ||||||
|     // TODO: check real clock speed before set VOS
 |     // TODO: check real clock speed before set VOS
 | ||||||
|  |     #[cfg(any(stm32f4, stm32f7))] | ||||||
|     if config.pll.is_some() { |     if config.pll.is_some() { | ||||||
|         PWR.cr1().modify(|w| w.set_vos(Vos::SCALE1)); |         PWR.cr1().modify(|w| w.set_vos(crate::pac::pwr::vals::Vos::SCALE1)); | ||||||
|     } |     } | ||||||
| 
 | 
 | ||||||
|     // always enable overdrive for now. Make it configurable in the future.
 |     // always enable overdrive for now. Make it configurable in the future.
 | ||||||
|     #[cfg(not(any(
 |     #[cfg(any(stm32f446, stm32f4x9, stm32f427, stm32f437, stm32f7))] | ||||||
|         stm32f401, stm32f410, stm32f411, stm32f412, stm32f413, stm32f423, stm32f405, stm32f407, stm32f415, stm32f417 |  | ||||||
|     )))] |  | ||||||
|     { |     { | ||||||
|         PWR.cr1().modify(|w| w.set_oden(true)); |         PWR.cr1().modify(|w| w.set_oden(true)); | ||||||
|         while !PWR.csr1().read().odrdy() {} |         while !PWR.csr1().read().odrdy() {} | ||||||
| @@ -158,7 +182,7 @@ pub(crate) unsafe fn init(config: Config) { | |||||||
|         source: config.pll_src, |         source: config.pll_src, | ||||||
|     }; |     }; | ||||||
|     let pll = init_pll(PllInstance::Pll, config.pll, &pll_input); |     let pll = init_pll(PllInstance::Pll, config.pll, &pll_input); | ||||||
|     #[cfg(any(all(stm32f4, not(stm32f410)), stm32f7))] |     #[cfg(any(stm32f2, all(stm32f4, not(stm32f410)), stm32f7))] | ||||||
|     let _plli2s = init_pll(PllInstance::Plli2s, config.plli2s, &pll_input); |     let _plli2s = init_pll(PllInstance::Plli2s, config.plli2s, &pll_input); | ||||||
|     #[cfg(any(stm32f446, stm32f427, stm32f437, stm32f4x9, stm32f7))] |     #[cfg(any(stm32f446, stm32f427, stm32f437, stm32f4x9, stm32f7))] | ||||||
|     let _pllsai = init_pll(PllInstance::Pllsai, config.pllsai, &pll_input); |     let _pllsai = init_pll(PllInstance::Pllsai, config.pllsai, &pll_input); | ||||||
| @@ -182,7 +206,48 @@ pub(crate) unsafe fn init(config: Config) { | |||||||
| 
 | 
 | ||||||
|     let rtc = config.ls.init(); |     let rtc = config.ls.init(); | ||||||
| 
 | 
 | ||||||
|     flash_setup(hclk); |     #[cfg(stm32f2)] | ||||||
|  |     let latency = match (config.voltage, hclk.0) { | ||||||
|  |         (VoltageScale::Range3, ..=16_000_000) => Latency::WS0, | ||||||
|  |         (VoltageScale::Range3, ..=32_000_000) => Latency::WS1, | ||||||
|  |         (VoltageScale::Range3, ..=48_000_000) => Latency::WS2, | ||||||
|  |         (VoltageScale::Range3, ..=64_000_000) => Latency::WS3, | ||||||
|  |         (VoltageScale::Range3, ..=80_000_000) => Latency::WS4, | ||||||
|  |         (VoltageScale::Range3, ..=96_000_000) => Latency::WS5, | ||||||
|  |         (VoltageScale::Range3, ..=112_000_000) => Latency::WS6, | ||||||
|  |         (VoltageScale::Range3, ..=120_000_000) => Latency::WS7, | ||||||
|  |         (VoltageScale::Range2, ..=18_000_000) => Latency::WS0, | ||||||
|  |         (VoltageScale::Range2, ..=36_000_000) => Latency::WS1, | ||||||
|  |         (VoltageScale::Range2, ..=54_000_000) => Latency::WS2, | ||||||
|  |         (VoltageScale::Range2, ..=72_000_000) => Latency::WS3, | ||||||
|  |         (VoltageScale::Range2, ..=90_000_000) => Latency::WS4, | ||||||
|  |         (VoltageScale::Range2, ..=108_000_000) => Latency::WS5, | ||||||
|  |         (VoltageScale::Range2, ..=120_000_000) => Latency::WS6, | ||||||
|  |         (VoltageScale::Range1, ..=24_000_000) => Latency::WS0, | ||||||
|  |         (VoltageScale::Range1, ..=48_000_000) => Latency::WS1, | ||||||
|  |         (VoltageScale::Range1, ..=72_000_000) => Latency::WS2, | ||||||
|  |         (VoltageScale::Range1, ..=96_000_000) => Latency::WS3, | ||||||
|  |         (VoltageScale::Range1, ..=120_000_000) => Latency::WS4, | ||||||
|  |         (VoltageScale::Range0, ..=30_000_000) => Latency::WS0, | ||||||
|  |         (VoltageScale::Range0, ..=60_000_000) => Latency::WS1, | ||||||
|  |         (VoltageScale::Range0, ..=90_000_000) => Latency::WS2, | ||||||
|  |         (VoltageScale::Range0, ..=120_000_000) => Latency::WS3, | ||||||
|  |         _ => unreachable!(), | ||||||
|  |     }; | ||||||
|  | 
 | ||||||
|  |     #[cfg(any(stm32f4, stm32f7))] | ||||||
|  |     let latency = { | ||||||
|  |         // Be conservative with voltage ranges
 | ||||||
|  |         const FLASH_LATENCY_STEP: u32 = 30_000_000; | ||||||
|  | 
 | ||||||
|  |         let latency = (hclk.0 - 1) / FLASH_LATENCY_STEP; | ||||||
|  |         debug!("flash: latency={}", latency); | ||||||
|  | 
 | ||||||
|  |         Latency::from_bits(latency as u8) | ||||||
|  |     }; | ||||||
|  | 
 | ||||||
|  |     FLASH.acr().write(|w| w.set_latency(latency)); | ||||||
|  |     while FLASH.acr().read().latency() != latency {} | ||||||
| 
 | 
 | ||||||
|     RCC.cfgr().modify(|w| { |     RCC.cfgr().modify(|w| { | ||||||
|         w.set_sw(config.sys); |         w.set_sw(config.sys); | ||||||
| @@ -232,7 +297,7 @@ struct PllOutput { | |||||||
| #[derive(PartialEq, Eq, Clone, Copy)] | #[derive(PartialEq, Eq, Clone, Copy)] | ||||||
| enum PllInstance { | enum PllInstance { | ||||||
|     Pll, |     Pll, | ||||||
|     #[cfg(any(all(stm32f4, not(stm32f410)), stm32f7))] |     #[cfg(any(stm32f2, all(stm32f4, not(stm32f410)), stm32f7))] | ||||||
|     Plli2s, |     Plli2s, | ||||||
|     #[cfg(any(stm32f446, stm32f427, stm32f437, stm32f4x9, stm32f7))] |     #[cfg(any(stm32f446, stm32f427, stm32f437, stm32f4x9, stm32f7))] | ||||||
|     Pllsai, |     Pllsai, | ||||||
| @@ -244,7 +309,7 @@ fn pll_enable(instance: PllInstance, enabled: bool) { | |||||||
|             RCC.cr().modify(|w| w.set_pllon(enabled)); |             RCC.cr().modify(|w| w.set_pllon(enabled)); | ||||||
|             while RCC.cr().read().pllrdy() != enabled {} |             while RCC.cr().read().pllrdy() != enabled {} | ||||||
|         } |         } | ||||||
|         #[cfg(any(all(stm32f4, not(stm32f410)), stm32f7))] |         #[cfg(any(stm32f2, all(stm32f4, not(stm32f410)), stm32f7))] | ||||||
|         PllInstance::Plli2s => { |         PllInstance::Plli2s => { | ||||||
|             RCC.cr().modify(|w| w.set_plli2son(enabled)); |             RCC.cr().modify(|w| w.set_plli2son(enabled)); | ||||||
|             while RCC.cr().read().plli2srdy() != enabled {} |             while RCC.cr().read().plli2srdy() != enabled {} | ||||||
| @@ -275,6 +340,18 @@ fn init_pll(instance: PllInstance, config: Option<Pll>, input: &PllInput) -> Pll | |||||||
|     let vco_freq = in_freq * pll.mul; |     let vco_freq = in_freq * pll.mul; | ||||||
|     assert!(max::PLL_VCO.contains(&vco_freq)); |     assert!(max::PLL_VCO.contains(&vco_freq)); | ||||||
| 
 | 
 | ||||||
|  |     // stm32f2 plls are like swiss cheese
 | ||||||
|  |     #[cfg(stm32f2)] | ||||||
|  |     match instance { | ||||||
|  |         PllInstance::Pll => { | ||||||
|  |             assert!(pll.divr.is_none()); | ||||||
|  |         } | ||||||
|  |         PllInstance::Plli2s => { | ||||||
|  |             assert!(pll.divp.is_none()); | ||||||
|  |             assert!(pll.divq.is_none()); | ||||||
|  |         } | ||||||
|  |     } | ||||||
|  | 
 | ||||||
|     let p = pll.divp.map(|div| vco_freq / div); |     let p = pll.divp.map(|div| vco_freq / div); | ||||||
|     let q = pll.divq.map(|div| vco_freq / div); |     let q = pll.divq.map(|div| vco_freq / div); | ||||||
|     let r = pll.divr.map(|div| vco_freq / div); |     let r = pll.divr.map(|div| vco_freq / div); | ||||||
| @@ -288,6 +365,7 @@ fn init_pll(instance: PllInstance, config: Option<Pll>, input: &PllInput) -> Pll | |||||||
|             if let Some(divq) = pll.divq { |             if let Some(divq) = pll.divq { | ||||||
|                 $w.set_pllq(divq); |                 $w.set_pllq(divq); | ||||||
|             } |             } | ||||||
|  |             #[cfg(any(stm32f4, stm32f7))] | ||||||
|             if let Some(divr) = pll.divr { |             if let Some(divr) = pll.divr { | ||||||
|                 $w.set_pllr(divr); |                 $w.set_pllr(divr); | ||||||
|             } |             } | ||||||
| @@ -304,6 +382,12 @@ fn init_pll(instance: PllInstance, config: Option<Pll>, input: &PllInput) -> Pll | |||||||
|         PllInstance::Plli2s => RCC.plli2scfgr().write(|w| { |         PllInstance::Plli2s => RCC.plli2scfgr().write(|w| { | ||||||
|             write_fields!(w); |             write_fields!(w); | ||||||
|         }), |         }), | ||||||
|  |         #[cfg(stm32f2)] | ||||||
|  |         PllInstance::Plli2s => RCC.plli2scfgr().write(|w| { | ||||||
|  |             if let Some(divr) = pll.divr { | ||||||
|  |                 w.set_pllr(divr); | ||||||
|  |             } | ||||||
|  |         }), | ||||||
|         #[cfg(any(stm32f446, stm32f427, stm32f437, stm32f4x9, stm32f7))] |         #[cfg(any(stm32f446, stm32f427, stm32f437, stm32f4x9, stm32f7))] | ||||||
|         PllInstance::Pllsai => RCC.pllsaicfgr().write(|w| { |         PllInstance::Pllsai => RCC.pllsaicfgr().write(|w| { | ||||||
|             write_fields!(w); |             write_fields!(w); | ||||||
| @@ -316,22 +400,6 @@ fn init_pll(instance: PllInstance, config: Option<Pll>, input: &PllInput) -> Pll | |||||||
|     PllOutput { p, q, r } |     PllOutput { p, q, r } | ||||||
| } | } | ||||||
| 
 | 
 | ||||||
| fn flash_setup(clk: Hertz) { |  | ||||||
|     use crate::pac::flash::vals::Latency; |  | ||||||
| 
 |  | ||||||
|     // Be conservative with voltage ranges
 |  | ||||||
|     const FLASH_LATENCY_STEP: u32 = 30_000_000; |  | ||||||
| 
 |  | ||||||
|     let latency = (clk.0 - 1) / FLASH_LATENCY_STEP; |  | ||||||
|     debug!("flash: latency={}", latency); |  | ||||||
| 
 |  | ||||||
|     let latency = Latency::from_bits(latency as u8); |  | ||||||
|     FLASH.acr().write(|w| { |  | ||||||
|         w.set_latency(latency); |  | ||||||
|     }); |  | ||||||
|     while FLASH.acr().read().latency() != latency {} |  | ||||||
| } |  | ||||||
| 
 |  | ||||||
| #[cfg(stm32f7)] | #[cfg(stm32f7)] | ||||||
| mod max { | mod max { | ||||||
|     use core::ops::RangeInclusive; |     use core::ops::RangeInclusive; | ||||||
| @@ -380,3 +448,22 @@ mod max { | |||||||
|     pub(crate) const PLL_IN: RangeInclusive<Hertz> = Hertz(1_000_000)..=Hertz(2_100_000); |     pub(crate) const PLL_IN: RangeInclusive<Hertz> = Hertz(1_000_000)..=Hertz(2_100_000); | ||||||
|     pub(crate) const PLL_VCO: RangeInclusive<Hertz> = Hertz(100_000_000)..=Hertz(432_000_000); |     pub(crate) const PLL_VCO: RangeInclusive<Hertz> = Hertz(100_000_000)..=Hertz(432_000_000); | ||||||
| } | } | ||||||
|  | 
 | ||||||
|  | #[cfg(stm32f2)] | ||||||
|  | mod max { | ||||||
|  |     use core::ops::RangeInclusive; | ||||||
|  | 
 | ||||||
|  |     use crate::time::Hertz; | ||||||
|  | 
 | ||||||
|  |     pub(crate) const HSE_OSC: RangeInclusive<Hertz> = Hertz(4_000_000)..=Hertz(26_000_000); | ||||||
|  |     pub(crate) const HSE_BYP: RangeInclusive<Hertz> = Hertz(1_000_000)..=Hertz(26_000_000); | ||||||
|  | 
 | ||||||
|  |     pub(crate) const SYSCLK: RangeInclusive<Hertz> = Hertz(0)..=Hertz(120_000_000); | ||||||
|  | 
 | ||||||
|  |     pub(crate) const HCLK: RangeInclusive<Hertz> = Hertz(0)..=Hertz(SYSCLK.end().0); | ||||||
|  |     pub(crate) const PCLK1: RangeInclusive<Hertz> = Hertz(0)..=Hertz(SYSCLK.end().0 / 4); | ||||||
|  |     pub(crate) const PCLK2: RangeInclusive<Hertz> = Hertz(0)..=Hertz(SYSCLK.end().0 / 2); | ||||||
|  | 
 | ||||||
|  |     pub(crate) const PLL_IN: RangeInclusive<Hertz> = Hertz(0_950_000)..=Hertz(2_100_000); | ||||||
|  |     pub(crate) const PLL_VCO: RangeInclusive<Hertz> = Hertz(192_000_000)..=Hertz(432_000_000); | ||||||
|  | } | ||||||
| @@ -1,320 +0,0 @@ | |||||||
| use crate::pac::flash::vals::Latency; |  | ||||||
| use crate::pac::rcc::vals::Sw; |  | ||||||
| pub use crate::pac::rcc::vals::{ |  | ||||||
|     Hpre as AHBPrescaler, Pllm as PLLPreDiv, Plln as PLLMul, Pllp as PLLPDiv, Pllq as PLLQDiv, Pllsrc as PLLSrc, |  | ||||||
|     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); |  | ||||||
|  |  | ||||||
| #[derive(Clone, Copy)] |  | ||||||
| pub struct HSEConfig { |  | ||||||
|     pub frequency: Hertz, |  | ||||||
|     pub source: HSESrc, |  | ||||||
| } |  | ||||||
|  |  | ||||||
| /// System clock mux source |  | ||||||
| #[derive(Clone, Copy)] |  | ||||||
| pub enum ClockSrc { |  | ||||||
|     HSE, |  | ||||||
|     HSI, |  | ||||||
|     PLL, |  | ||||||
| } |  | ||||||
|  |  | ||||||
| /// HSE clock source |  | ||||||
| #[derive(Clone, Copy)] |  | ||||||
| pub enum HSESrc { |  | ||||||
|     /// Crystal/ceramic resonator |  | ||||||
|     Crystal, |  | ||||||
|     /// External clock source, HSE bypassed |  | ||||||
|     Bypass, |  | ||||||
| } |  | ||||||
|  |  | ||||||
| #[derive(Clone, Copy)] |  | ||||||
| pub struct PLLConfig { |  | ||||||
|     pub pre_div: PLLPreDiv, |  | ||||||
|     pub mul: PLLMul, |  | ||||||
|     pub p_div: PLLPDiv, |  | ||||||
|     pub q_div: PLLQDiv, |  | ||||||
| } |  | ||||||
|  |  | ||||||
| impl Default for PLLConfig { |  | ||||||
|     fn default() -> Self { |  | ||||||
|         PLLConfig { |  | ||||||
|             pre_div: PLLPreDiv::DIV16, |  | ||||||
|             mul: PLLMul::MUL192, |  | ||||||
|             p_div: PLLPDiv::DIV2, |  | ||||||
|             q_div: PLLQDiv::DIV4, |  | ||||||
|         } |  | ||||||
|     } |  | ||||||
| } |  | ||||||
|  |  | ||||||
| impl PLLConfig { |  | ||||||
|     pub fn clocks(&self, src_freq: Hertz) -> PLLClocks { |  | ||||||
|         let in_freq = src_freq / self.pre_div; |  | ||||||
|         let vco_freq = src_freq / self.pre_div * self.mul; |  | ||||||
|         let main_freq = vco_freq / self.p_div; |  | ||||||
|         let pll48_freq = vco_freq / self.q_div; |  | ||||||
|         PLLClocks { |  | ||||||
|             in_freq, |  | ||||||
|             vco_freq, |  | ||||||
|             main_freq, |  | ||||||
|             pll48_freq, |  | ||||||
|         } |  | ||||||
|     } |  | ||||||
| } |  | ||||||
| #[derive(Clone, Copy, PartialEq)] |  | ||||||
| pub struct PLLClocks { |  | ||||||
|     pub in_freq: Hertz, |  | ||||||
|     pub vco_freq: Hertz, |  | ||||||
|     pub main_freq: Hertz, |  | ||||||
|     pub pll48_freq: Hertz, |  | ||||||
| } |  | ||||||
|  |  | ||||||
| /// Voltage range of the power supply used. |  | ||||||
| /// |  | ||||||
| /// Used to calculate flash waitstates. See |  | ||||||
| /// RM0033 - Table 3. Number of wait states according to Cortex®-M3 clock frequency |  | ||||||
| pub enum VoltageScale { |  | ||||||
|     /// 2.7 to 3.6 V |  | ||||||
|     Range0, |  | ||||||
|     /// 2.4 to 2.7 V |  | ||||||
|     Range1, |  | ||||||
|     /// 2.1 to 2.4 V |  | ||||||
|     Range2, |  | ||||||
|     /// 1.8 to 2.1 V |  | ||||||
|     Range3, |  | ||||||
| } |  | ||||||
|  |  | ||||||
| impl VoltageScale { |  | ||||||
|     const fn wait_states(&self, ahb_freq: Hertz) -> Option<Latency> { |  | ||||||
|         let ahb_freq = ahb_freq.0; |  | ||||||
|         // Reference: RM0033 - Table 3. Number of wait states according to Cortex®-M3 clock |  | ||||||
|         // frequency |  | ||||||
|         match self { |  | ||||||
|             VoltageScale::Range3 => { |  | ||||||
|                 if ahb_freq <= 16_000_000 { |  | ||||||
|                     Some(Latency::WS0) |  | ||||||
|                 } else if ahb_freq <= 32_000_000 { |  | ||||||
|                     Some(Latency::WS1) |  | ||||||
|                 } else if ahb_freq <= 48_000_000 { |  | ||||||
|                     Some(Latency::WS2) |  | ||||||
|                 } else if ahb_freq <= 64_000_000 { |  | ||||||
|                     Some(Latency::WS3) |  | ||||||
|                 } else if ahb_freq <= 80_000_000 { |  | ||||||
|                     Some(Latency::WS4) |  | ||||||
|                 } else if ahb_freq <= 96_000_000 { |  | ||||||
|                     Some(Latency::WS5) |  | ||||||
|                 } else if ahb_freq <= 112_000_000 { |  | ||||||
|                     Some(Latency::WS6) |  | ||||||
|                 } else if ahb_freq <= 120_000_000 { |  | ||||||
|                     Some(Latency::WS7) |  | ||||||
|                 } else { |  | ||||||
|                     None |  | ||||||
|                 } |  | ||||||
|             } |  | ||||||
|             VoltageScale::Range2 => { |  | ||||||
|                 if ahb_freq <= 18_000_000 { |  | ||||||
|                     Some(Latency::WS0) |  | ||||||
|                 } else if ahb_freq <= 36_000_000 { |  | ||||||
|                     Some(Latency::WS1) |  | ||||||
|                 } else if ahb_freq <= 54_000_000 { |  | ||||||
|                     Some(Latency::WS2) |  | ||||||
|                 } else if ahb_freq <= 72_000_000 { |  | ||||||
|                     Some(Latency::WS3) |  | ||||||
|                 } else if ahb_freq <= 90_000_000 { |  | ||||||
|                     Some(Latency::WS4) |  | ||||||
|                 } else if ahb_freq <= 108_000_000 { |  | ||||||
|                     Some(Latency::WS5) |  | ||||||
|                 } else if ahb_freq <= 120_000_000 { |  | ||||||
|                     Some(Latency::WS6) |  | ||||||
|                 } else { |  | ||||||
|                     None |  | ||||||
|                 } |  | ||||||
|             } |  | ||||||
|             VoltageScale::Range1 => { |  | ||||||
|                 if ahb_freq <= 24_000_000 { |  | ||||||
|                     Some(Latency::WS0) |  | ||||||
|                 } else if ahb_freq <= 48_000_000 { |  | ||||||
|                     Some(Latency::WS1) |  | ||||||
|                 } else if ahb_freq <= 72_000_000 { |  | ||||||
|                     Some(Latency::WS2) |  | ||||||
|                 } else if ahb_freq <= 96_000_000 { |  | ||||||
|                     Some(Latency::WS3) |  | ||||||
|                 } else if ahb_freq <= 120_000_000 { |  | ||||||
|                     Some(Latency::WS4) |  | ||||||
|                 } else { |  | ||||||
|                     None |  | ||||||
|                 } |  | ||||||
|             } |  | ||||||
|             VoltageScale::Range0 => { |  | ||||||
|                 if ahb_freq <= 30_000_000 { |  | ||||||
|                     Some(Latency::WS0) |  | ||||||
|                 } else if ahb_freq <= 60_000_000 { |  | ||||||
|                     Some(Latency::WS1) |  | ||||||
|                 } else if ahb_freq <= 90_000_000 { |  | ||||||
|                     Some(Latency::WS2) |  | ||||||
|                 } else if ahb_freq <= 120_000_000 { |  | ||||||
|                     Some(Latency::WS3) |  | ||||||
|                 } else { |  | ||||||
|                     None |  | ||||||
|                 } |  | ||||||
|             } |  | ||||||
|         } |  | ||||||
|     } |  | ||||||
| } |  | ||||||
|  |  | ||||||
| /// Clocks configuration |  | ||||||
| pub struct Config { |  | ||||||
|     pub hse: Option<HSEConfig>, |  | ||||||
|     pub hsi: bool, |  | ||||||
|     pub pll_mux: PLLSrc, |  | ||||||
|     pub pll: PLLConfig, |  | ||||||
|     pub mux: ClockSrc, |  | ||||||
|     pub voltage: VoltageScale, |  | ||||||
|     pub ahb_pre: AHBPrescaler, |  | ||||||
|     pub apb1_pre: APBPrescaler, |  | ||||||
|     pub apb2_pre: APBPrescaler, |  | ||||||
|     pub ls: super::LsConfig, |  | ||||||
| } |  | ||||||
|  |  | ||||||
| impl Default for Config { |  | ||||||
|     #[inline] |  | ||||||
|     fn default() -> Config { |  | ||||||
|         Config { |  | ||||||
|             hse: None, |  | ||||||
|             hsi: true, |  | ||||||
|             pll_mux: PLLSrc::HSI, |  | ||||||
|             pll: PLLConfig::default(), |  | ||||||
|             voltage: VoltageScale::Range3, |  | ||||||
|             mux: ClockSrc::HSI, |  | ||||||
|             ahb_pre: AHBPrescaler::DIV1, |  | ||||||
|             apb1_pre: APBPrescaler::DIV1, |  | ||||||
|             apb2_pre: APBPrescaler::DIV1, |  | ||||||
|             ls: Default::default(), |  | ||||||
|         } |  | ||||||
|     } |  | ||||||
| } |  | ||||||
|  |  | ||||||
| pub(crate) unsafe fn init(config: Config) { |  | ||||||
|     // Make sure HSI is enabled |  | ||||||
|     RCC.cr().write(|w| w.set_hsion(true)); |  | ||||||
|     while !RCC.cr().read().hsirdy() {} |  | ||||||
|  |  | ||||||
|     if let Some(hse_config) = config.hse { |  | ||||||
|         RCC.cr().modify(|w| { |  | ||||||
|             w.set_hsebyp(match hse_config.source { |  | ||||||
|                 HSESrc::Bypass => true, |  | ||||||
|                 HSESrc::Crystal => false, |  | ||||||
|             }); |  | ||||||
|             w.set_hseon(true) |  | ||||||
|         }); |  | ||||||
|         while !RCC.cr().read().hserdy() {} |  | ||||||
|     } |  | ||||||
|  |  | ||||||
|     let pll_src_freq = match config.pll_mux { |  | ||||||
|         PLLSrc::HSE => { |  | ||||||
|             let hse_config = config |  | ||||||
|                 .hse |  | ||||||
|                 .unwrap_or_else(|| panic!("HSE must be configured to be used as PLL input")); |  | ||||||
|             hse_config.frequency |  | ||||||
|         } |  | ||||||
|         PLLSrc::HSI => HSI_FREQ, |  | ||||||
|     }; |  | ||||||
|  |  | ||||||
|     // Reference: STM32F215xx/217xx datasheet Table 33. Main PLL characteristics |  | ||||||
|     let pll_clocks = config.pll.clocks(pll_src_freq); |  | ||||||
|     assert!(Hertz(950_000) <= pll_clocks.in_freq && pll_clocks.in_freq <= Hertz(2_100_000)); |  | ||||||
|     assert!(Hertz(192_000_000) <= pll_clocks.vco_freq && pll_clocks.vco_freq <= Hertz(432_000_000)); |  | ||||||
|     assert!(Hertz(24_000_000) <= pll_clocks.main_freq && pll_clocks.main_freq <= Hertz(120_000_000)); |  | ||||||
|     // USB actually requires == 48 MHz, but other PLL48 peripherals are fine with <= 48MHz |  | ||||||
|     assert!(pll_clocks.pll48_freq <= Hertz(48_000_000)); |  | ||||||
|  |  | ||||||
|     RCC.pllcfgr().write(|w| { |  | ||||||
|         w.set_pllsrc(config.pll_mux); |  | ||||||
|         w.set_pllm(config.pll.pre_div); |  | ||||||
|         w.set_plln(config.pll.mul); |  | ||||||
|         w.set_pllp(config.pll.p_div); |  | ||||||
|         w.set_pllq(config.pll.q_div); |  | ||||||
|     }); |  | ||||||
|  |  | ||||||
|     let (sys_clk, sw) = match config.mux { |  | ||||||
|         ClockSrc::HSI => { |  | ||||||
|             assert!(config.hsi, "HSI must be enabled to be used as system clock"); |  | ||||||
|             (HSI_FREQ, Sw::HSI) |  | ||||||
|         } |  | ||||||
|         ClockSrc::HSE => { |  | ||||||
|             let hse_config = config |  | ||||||
|                 .hse |  | ||||||
|                 .unwrap_or_else(|| panic!("HSE must be configured to be used as PLL input")); |  | ||||||
|             (hse_config.frequency, Sw::HSE) |  | ||||||
|         } |  | ||||||
|         ClockSrc::PLL => { |  | ||||||
|             RCC.cr().modify(|w| w.set_pllon(true)); |  | ||||||
|             while !RCC.cr().read().pllrdy() {} |  | ||||||
|             (pll_clocks.main_freq, Sw::PLL1_P) |  | ||||||
|         } |  | ||||||
|     }; |  | ||||||
|     // RM0033 Figure 9. Clock tree suggests max SYSCLK/HCLK is 168 MHz, but datasheet specifies PLL |  | ||||||
|     // max output to be 120 MHz, so there's no way to get higher frequencies |  | ||||||
|     assert!(sys_clk <= Hertz(120_000_000)); |  | ||||||
|  |  | ||||||
|     let ahb_freq = sys_clk / config.ahb_pre; |  | ||||||
|     // Reference: STM32F215xx/217xx datasheet Table 13. General operating conditions |  | ||||||
|     assert!(ahb_freq <= Hertz(120_000_000)); |  | ||||||
|  |  | ||||||
|     let (apb1_freq, apb1_tim_freq) = match config.apb1_pre { |  | ||||||
|         APBPrescaler::DIV1 => (ahb_freq, ahb_freq), |  | ||||||
|         pre => { |  | ||||||
|             let freq = ahb_freq / pre; |  | ||||||
|             (freq, Hertz(freq.0 * 2)) |  | ||||||
|         } |  | ||||||
|     }; |  | ||||||
|     // Reference: STM32F215xx/217xx datasheet Table 13. General operating conditions |  | ||||||
|     assert!(apb1_freq <= Hertz(30_000_000)); |  | ||||||
|  |  | ||||||
|     let (apb2_freq, apb2_tim_freq) = match config.apb2_pre { |  | ||||||
|         APBPrescaler::DIV1 => (ahb_freq, ahb_freq), |  | ||||||
|         pre => { |  | ||||||
|             let freq = ahb_freq / pre; |  | ||||||
|             (freq, Hertz(freq.0 * 2)) |  | ||||||
|         } |  | ||||||
|     }; |  | ||||||
|     // Reference: STM32F215xx/217xx datasheet Table 13. General operating conditions |  | ||||||
|     assert!(apb2_freq <= Hertz(60_000_000)); |  | ||||||
|  |  | ||||||
|     let flash_ws = unwrap!(config.voltage.wait_states(ahb_freq)); |  | ||||||
|     FLASH.acr().modify(|w| w.set_latency(flash_ws)); |  | ||||||
|  |  | ||||||
|     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); |  | ||||||
|     }); |  | ||||||
|     while RCC.cfgr().read().sws().to_bits() != sw.to_bits() {} |  | ||||||
|  |  | ||||||
|     // Turn off HSI to save power if we don't need it |  | ||||||
|     if !config.hsi { |  | ||||||
|         RCC.cr().modify(|w| w.set_hsion(false)); |  | ||||||
|     } |  | ||||||
|  |  | ||||||
|     let rtc = config.ls.init(); |  | ||||||
|  |  | ||||||
|     set_freqs(Clocks { |  | ||||||
|         sys: sys_clk, |  | ||||||
|         hclk1: ahb_freq, |  | ||||||
|         hclk2: ahb_freq, |  | ||||||
|         hclk3: ahb_freq, |  | ||||||
|         pclk1: apb1_freq, |  | ||||||
|         pclk1_tim: apb1_tim_freq, |  | ||||||
|         pclk2: apb2_freq, |  | ||||||
|         pclk2_tim: apb2_tim_freq, |  | ||||||
|         pll1_q: Some(pll_clocks.pll48_freq), |  | ||||||
|         rtc, |  | ||||||
|     }); |  | ||||||
| } |  | ||||||
| @@ -28,7 +28,7 @@ pub enum ClockSrc { | |||||||
| #[derive(Clone, Copy)] | #[derive(Clone, Copy)] | ||||||
| pub struct PllConfig { | pub struct PllConfig { | ||||||
|     /// The source from which the PLL receives a clock signal |     /// The source from which the PLL receives a clock signal | ||||||
|     pub source: PllSrc, |     pub source: PllSource, | ||||||
|     /// The initial divisor of that clock signal |     /// The initial divisor of that clock signal | ||||||
|     pub m: Pllm, |     pub m: Pllm, | ||||||
|     /// The PLL VCO multiplier, which must be in the range `8..=86`. |     /// The PLL VCO multiplier, which must be in the range `8..=86`. | ||||||
| @@ -48,7 +48,7 @@ impl Default for PllConfig { | |||||||
|     fn default() -> PllConfig { |     fn default() -> PllConfig { | ||||||
|         // HSI / 1 * 8 / 2 = 64 MHz |         // HSI / 1 * 8 / 2 = 64 MHz | ||||||
|         PllConfig { |         PllConfig { | ||||||
|             source: PllSrc::HSI, |             source: PllSource::HSI, | ||||||
|             m: Pllm::DIV1, |             m: Pllm::DIV1, | ||||||
|             n: Plln::MUL8, |             n: Plln::MUL8, | ||||||
|             r: Pllr::DIV2, |             r: Pllr::DIV2, | ||||||
| @@ -59,7 +59,7 @@ impl Default for PllConfig { | |||||||
| } | } | ||||||
|  |  | ||||||
| #[derive(Clone, Copy, Eq, PartialEq)] | #[derive(Clone, Copy, Eq, PartialEq)] | ||||||
| pub enum PllSrc { | pub enum PllSource { | ||||||
|     HSI, |     HSI, | ||||||
|     HSE(Hertz), |     HSE(Hertz), | ||||||
| } | } | ||||||
| @@ -89,8 +89,8 @@ impl Default for Config { | |||||||
| impl PllConfig { | impl PllConfig { | ||||||
|     pub(crate) fn init(self) -> Hertz { |     pub(crate) fn init(self) -> Hertz { | ||||||
|         let (src, input_freq) = match self.source { |         let (src, input_freq) = match self.source { | ||||||
|             PllSrc::HSI => (vals::Pllsrc::HSI, HSI_FREQ), |             PllSource::HSI => (vals::Pllsrc::HSI, HSI_FREQ), | ||||||
|             PllSrc::HSE(freq) => (vals::Pllsrc::HSE, freq), |             PllSource::HSE(freq) => (vals::Pllsrc::HSE, freq), | ||||||
|         }; |         }; | ||||||
|  |  | ||||||
|         let m_freq = input_freq / self.m; |         let m_freq = input_freq / self.m; | ||||||
| @@ -121,11 +121,11 @@ impl PllConfig { | |||||||
|         // > 3. Change the desired parameter. |         // > 3. Change the desired parameter. | ||||||
|         // Enable whichever clock source we're using, and wait for it to become ready |         // Enable whichever clock source we're using, and wait for it to become ready | ||||||
|         match self.source { |         match self.source { | ||||||
|             PllSrc::HSI => { |             PllSource::HSI => { | ||||||
|                 RCC.cr().write(|w| w.set_hsion(true)); |                 RCC.cr().write(|w| w.set_hsion(true)); | ||||||
|                 while !RCC.cr().read().hsirdy() {} |                 while !RCC.cr().read().hsirdy() {} | ||||||
|             } |             } | ||||||
|             PllSrc::HSE(_) => { |             PllSource::HSE(_) => { | ||||||
|                 RCC.cr().write(|w| w.set_hseon(true)); |                 RCC.cr().write(|w| w.set_hseon(true)); | ||||||
|                 while !RCC.cr().read().hserdy() {} |                 while !RCC.cr().read().hserdy() {} | ||||||
|             } |             } | ||||||
|   | |||||||
| @@ -23,16 +23,16 @@ pub enum ClockSrc { | |||||||
|  |  | ||||||
| /// PLL clock input source | /// PLL clock input source | ||||||
| #[derive(Clone, Copy, Debug)] | #[derive(Clone, Copy, Debug)] | ||||||
| pub enum PllSrc { | pub enum PllSource { | ||||||
|     HSI, |     HSI, | ||||||
|     HSE(Hertz), |     HSE(Hertz), | ||||||
| } | } | ||||||
|  |  | ||||||
| impl Into<Pllsrc> for PllSrc { | impl Into<Pllsrc> for PllSource { | ||||||
|     fn into(self) -> Pllsrc { |     fn into(self) -> Pllsrc { | ||||||
|         match self { |         match self { | ||||||
|             PllSrc::HSE(..) => Pllsrc::HSE, |             PllSource::HSE(..) => Pllsrc::HSE, | ||||||
|             PllSrc::HSI => Pllsrc::HSI, |             PllSource::HSI => Pllsrc::HSI, | ||||||
|         } |         } | ||||||
|     } |     } | ||||||
| } | } | ||||||
| @@ -44,7 +44,7 @@ impl Into<Pllsrc> for PllSrc { | |||||||
| /// frequency ranges for each of these settings. | /// frequency ranges for each of these settings. | ||||||
| pub struct Pll { | pub struct Pll { | ||||||
|     /// PLL Source clock selection. |     /// PLL Source clock selection. | ||||||
|     pub source: PllSrc, |     pub source: PllSource, | ||||||
|  |  | ||||||
|     /// PLL pre-divider |     /// PLL pre-divider | ||||||
|     pub prediv_m: PllM, |     pub prediv_m: PllM, | ||||||
| @@ -118,13 +118,13 @@ pub struct PllFreq { | |||||||
| pub(crate) unsafe fn init(config: Config) { | pub(crate) unsafe fn init(config: Config) { | ||||||
|     let pll_freq = config.pll.map(|pll_config| { |     let pll_freq = config.pll.map(|pll_config| { | ||||||
|         let src_freq = match pll_config.source { |         let src_freq = match pll_config.source { | ||||||
|             PllSrc::HSI => { |             PllSource::HSI => { | ||||||
|                 RCC.cr().write(|w| w.set_hsion(true)); |                 RCC.cr().write(|w| w.set_hsion(true)); | ||||||
|                 while !RCC.cr().read().hsirdy() {} |                 while !RCC.cr().read().hsirdy() {} | ||||||
|  |  | ||||||
|                 HSI_FREQ |                 HSI_FREQ | ||||||
|             } |             } | ||||||
|             PllSrc::HSE(freq) => { |             PllSource::HSE(freq) => { | ||||||
|                 RCC.cr().write(|w| w.set_hseon(true)); |                 RCC.cr().write(|w| w.set_hseon(true)); | ||||||
|                 while !RCC.cr().read().hserdy() {} |                 while !RCC.cr().read().hserdy() {} | ||||||
|                 freq |                 freq | ||||||
|   | |||||||
| @@ -168,7 +168,12 @@ impl Default for Config { | |||||||
|             apb4_pre: APBPrescaler::DIV1, |             apb4_pre: APBPrescaler::DIV1, | ||||||
|  |  | ||||||
|             per_clock_source: PerClockSource::HSI, |             per_clock_source: PerClockSource::HSI, | ||||||
|             adc_clock_source: AdcClockSource::from_bits(0), // PLL2_P on H7, HCLK on H5 |  | ||||||
|  |             #[cfg(stm32h5)] | ||||||
|  |             adc_clock_source: AdcClockSource::HCLK1, | ||||||
|  |             #[cfg(stm32h7)] | ||||||
|  |             adc_clock_source: AdcClockSource::PER, | ||||||
|  |  | ||||||
|             timer_prescaler: TimerPrescaler::DefaultX2, |             timer_prescaler: TimerPrescaler::DefaultX2, | ||||||
|             voltage_scale: VoltageScale::Scale0, |             voltage_scale: VoltageScale::Scale0, | ||||||
|             ls: Default::default(), |             ls: Default::default(), | ||||||
|   | |||||||
| @@ -1,12 +1,13 @@ | |||||||
|  | #[cfg(any(stm32l0, stm32l1))] | ||||||
|  | pub use crate::pac::pwr::vals::Vos as VoltageScale; | ||||||
| use crate::pac::rcc::regs::Cfgr; | use crate::pac::rcc::regs::Cfgr; | ||||||
| #[cfg(any(stm32l4, stm32l5, stm32wb))] | #[cfg(any(stm32l4, stm32l5, stm32wb, stm32wl))] | ||||||
|  | pub use crate::pac::rcc::vals::Adcsel as AdcClockSource; | ||||||
|  | #[cfg(any(rcc_l0_v2, stm32l4, stm32l5, stm32wb))] | ||||||
| pub use crate::pac::rcc::vals::Clk48sel as Clk48Src; | pub use crate::pac::rcc::vals::Clk48sel as Clk48Src; | ||||||
| #[cfg(any(stm32wb, stm32wl))] | #[cfg(any(stm32wb, stm32wl))] | ||||||
| pub use crate::pac::rcc::vals::Hsepre as HsePrescaler; | pub use crate::pac::rcc::vals::Hsepre as HsePrescaler; | ||||||
| pub use crate::pac::rcc::vals::{ | pub use crate::pac::rcc::vals::{Hpre as AHBPrescaler, Msirange as MSIRange, Ppre as APBPrescaler, Sw as ClockSrc}; | ||||||
|     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}; | use crate::pac::{FLASH, RCC}; | ||||||
| use crate::rcc::{set_freqs, Clocks}; | use crate::rcc::{set_freqs, Clocks}; | ||||||
| use crate::time::Hertz; | use crate::time::Hertz; | ||||||
| @@ -33,25 +34,6 @@ pub struct Hse { | |||||||
|     pub prescaler: HsePrescaler, |     pub prescaler: HsePrescaler, | ||||||
| } | } | ||||||
| 
 | 
 | ||||||
| #[derive(Clone, Copy)] |  | ||||||
| pub struct Pll { |  | ||||||
|     /// PLL source
 |  | ||||||
|     pub source: PLLSource, |  | ||||||
| 
 |  | ||||||
|     /// PLL pre-divider (DIVM).
 |  | ||||||
|     pub prediv: PllPreDiv, |  | ||||||
| 
 |  | ||||||
|     /// PLL multiplication factor.
 |  | ||||||
|     pub mul: PllMul, |  | ||||||
| 
 |  | ||||||
|     /// PLL P division factor. If None, PLL P output is disabled.
 |  | ||||||
|     pub divp: Option<PllPDiv>, |  | ||||||
|     /// PLL Q division factor. If None, PLL Q output is disabled.
 |  | ||||||
|     pub divq: Option<PllQDiv>, |  | ||||||
|     /// PLL R division factor. If None, PLL R output is disabled.
 |  | ||||||
|     pub divr: Option<PllRDiv>, |  | ||||||
| } |  | ||||||
| 
 |  | ||||||
| /// Clocks configuration
 | /// Clocks configuration
 | ||||||
| pub struct Config { | pub struct Config { | ||||||
|     // base clock sources
 |     // base clock sources
 | ||||||
| @@ -79,13 +61,17 @@ pub struct Config { | |||||||
|     pub shared_ahb_pre: AHBPrescaler, |     pub shared_ahb_pre: AHBPrescaler, | ||||||
| 
 | 
 | ||||||
|     // muxes
 |     // muxes
 | ||||||
|     #[cfg(any(stm32l4, stm32l5, stm32wb))] |     #[cfg(any(rcc_l0_v2, stm32l4, stm32l5, stm32wb))] | ||||||
|     pub clk48_src: Clk48Src, |     pub clk48_src: Clk48Src, | ||||||
| 
 | 
 | ||||||
|     // low speed LSI/LSE/RTC
 |     // low speed LSI/LSE/RTC
 | ||||||
|     pub ls: super::LsConfig, |     pub ls: super::LsConfig, | ||||||
| 
 | 
 | ||||||
|  |     #[cfg(any(stm32l4, stm32l5, stm32wb, stm32wl))] | ||||||
|     pub adc_clock_source: AdcClockSource, |     pub adc_clock_source: AdcClockSource, | ||||||
|  | 
 | ||||||
|  |     #[cfg(any(stm32l0, stm32l1))] | ||||||
|  |     pub voltage_scale: VoltageScale, | ||||||
| } | } | ||||||
| 
 | 
 | ||||||
| impl Default for Config { | impl Default for Config { | ||||||
| @@ -110,10 +96,13 @@ impl Default for Config { | |||||||
|             pllsai2: None, |             pllsai2: None, | ||||||
|             #[cfg(crs)] |             #[cfg(crs)] | ||||||
|             hsi48: Some(Default::default()), |             hsi48: Some(Default::default()), | ||||||
|             #[cfg(any(stm32l4, stm32l5, stm32wb))] |             #[cfg(any(rcc_l0_v2, stm32l4, stm32l5, stm32wb))] | ||||||
|             clk48_src: Clk48Src::HSI48, |             clk48_src: Clk48Src::HSI48, | ||||||
|             ls: Default::default(), |             ls: Default::default(), | ||||||
|  |             #[cfg(any(stm32l4, stm32l5, stm32wb, stm32wl))] | ||||||
|             adc_clock_source: AdcClockSource::SYS, |             adc_clock_source: AdcClockSource::SYS, | ||||||
|  |             #[cfg(any(stm32l0, stm32l1))] | ||||||
|  |             voltage_scale: VoltageScale::RANGE1, | ||||||
|         } |         } | ||||||
|     } |     } | ||||||
| } | } | ||||||
| @@ -135,7 +124,7 @@ pub const WPAN_DEFAULT: Config = Config { | |||||||
|     ls: super::LsConfig::default_lse(), |     ls: super::LsConfig::default_lse(), | ||||||
| 
 | 
 | ||||||
|     pll: Some(Pll { |     pll: Some(Pll { | ||||||
|         source: PLLSource::HSE, |         source: PllSource::HSE, | ||||||
|         prediv: PllPreDiv::DIV2, |         prediv: PllPreDiv::DIV2, | ||||||
|         mul: PllMul::MUL12, |         mul: PllMul::MUL12, | ||||||
|         divp: Some(PllPDiv::DIV3), // 32 / 2 * 12 / 3 = 64Mhz
 |         divp: Some(PllPDiv::DIV3), // 32 / 2 * 12 / 3 = 64Mhz
 | ||||||
| @@ -152,20 +141,26 @@ pub const WPAN_DEFAULT: Config = Config { | |||||||
|     adc_clock_source: AdcClockSource::SYS, |     adc_clock_source: AdcClockSource::SYS, | ||||||
| }; | }; | ||||||
| 
 | 
 | ||||||
|  | fn msi_enable(range: MSIRange) { | ||||||
|  |     #[cfg(any(stm32l4, stm32l5, stm32wb, stm32wl))] | ||||||
|  |     RCC.cr().modify(|w| { | ||||||
|  |         #[cfg(not(stm32wb))] | ||||||
|  |         w.set_msirgsel(crate::pac::rcc::vals::Msirgsel::CR); | ||||||
|  |         w.set_msirange(range); | ||||||
|  |         w.set_msipllen(false); | ||||||
|  |     }); | ||||||
|  |     #[cfg(any(stm32l0, stm32l1))] | ||||||
|  |     RCC.icscr().modify(|w| w.set_msirange(range)); | ||||||
|  | 
 | ||||||
|  |     RCC.cr().modify(|w| w.set_msion(true)); | ||||||
|  |     while !RCC.cr().read().msirdy() {} | ||||||
|  | } | ||||||
|  | 
 | ||||||
| pub(crate) unsafe fn init(config: Config) { | pub(crate) unsafe fn init(config: Config) { | ||||||
|     // Switch to MSI to prevent problems with PLL configuration.
 |     // Switch to MSI to prevent problems with PLL configuration.
 | ||||||
|     if !RCC.cr().read().msion() { |     if !RCC.cr().read().msion() { | ||||||
|         // Turn on MSI and configure it to 4MHz.
 |         // Turn on MSI and configure it to 4MHz.
 | ||||||
|         RCC.cr().modify(|w| { |         msi_enable(MSIRange::RANGE4M) | ||||||
|             #[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) |  | ||||||
|         }); |  | ||||||
| 
 |  | ||||||
|         // Wait until MSI is running
 |  | ||||||
|         while !RCC.cr().read().msirdy() {} |  | ||||||
|     } |     } | ||||||
|     if RCC.cfgr().read().sws() != ClockSrc::MSI { |     if RCC.cfgr().read().sws() != ClockSrc::MSI { | ||||||
|         // Set MSI as a clock source, reset prescalers.
 |         // Set MSI as a clock source, reset prescalers.
 | ||||||
| @@ -174,6 +169,14 @@ pub(crate) unsafe fn init(config: Config) { | |||||||
|         while RCC.cfgr().read().sws() != ClockSrc::MSI {} |         while RCC.cfgr().read().sws() != ClockSrc::MSI {} | ||||||
|     } |     } | ||||||
| 
 | 
 | ||||||
|  |     // Set voltage scale
 | ||||||
|  |     #[cfg(any(stm32l0, stm32l1))] | ||||||
|  |     { | ||||||
|  |         while crate::pac::PWR.csr().read().vosf() {} | ||||||
|  |         crate::pac::PWR.cr().write(|w| w.set_vos(config.voltage_scale)); | ||||||
|  |         while crate::pac::PWR.csr().read().vosf() {} | ||||||
|  |     } | ||||||
|  | 
 | ||||||
|     #[cfg(stm32l5)] |     #[cfg(stm32l5)] | ||||||
|     crate::pac::PWR.cr1().modify(|w| { |     crate::pac::PWR.cr1().modify(|w| { | ||||||
|         w.set_vos(crate::pac::pwr::vals::Vos::RANGE0); |         w.set_vos(crate::pac::pwr::vals::Vos::RANGE0); | ||||||
| @@ -182,21 +185,16 @@ pub(crate) unsafe fn init(config: Config) { | |||||||
|     let rtc = config.ls.init(); |     let rtc = config.ls.init(); | ||||||
| 
 | 
 | ||||||
|     let msi = config.msi.map(|range| { |     let msi = config.msi.map(|range| { | ||||||
|         // Enable MSI
 |         msi_enable(range); | ||||||
|         RCC.cr().modify(|w| { |  | ||||||
|             #[cfg(not(stm32wb))] |  | ||||||
|             w.set_msirgsel(crate::pac::rcc::vals::Msirgsel::CR); |  | ||||||
|             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() {} |  | ||||||
| 
 |  | ||||||
|         msirange_to_hertz(range) |         msirange_to_hertz(range) | ||||||
|     }); |     }); | ||||||
| 
 | 
 | ||||||
|  |     // If LSE is enabled and the right freq, enable calibration of MSI
 | ||||||
|  |     #[cfg(any(stm32l4, stm32l5, stm32wb, stm32wl))] | ||||||
|  |     if config.ls.lse.map(|x| x.frequency) == Some(Hertz(32_768)) { | ||||||
|  |         RCC.cr().modify(|w| w.set_msipllen(true)); | ||||||
|  |     } | ||||||
|  | 
 | ||||||
|     let hsi = config.hsi.then(|| { |     let hsi = config.hsi.then(|| { | ||||||
|         RCC.cr().modify(|w| w.set_hsion(true)); |         RCC.cr().modify(|w| w.set_hsion(true)); | ||||||
|         while !RCC.cr().read().hsirdy() {} |         while !RCC.cr().read().hsirdy() {} | ||||||
| @@ -218,7 +216,10 @@ pub(crate) unsafe fn init(config: Config) { | |||||||
|     }); |     }); | ||||||
| 
 | 
 | ||||||
|     #[cfg(crs)] |     #[cfg(crs)] | ||||||
|     let _hsi48 = config.hsi48.map(super::init_hsi48); |     let _hsi48 = config.hsi48.map(|config| { | ||||||
|  |         //
 | ||||||
|  |         super::init_hsi48(config) | ||||||
|  |     }); | ||||||
|     #[cfg(not(crs))] |     #[cfg(not(crs))] | ||||||
|     let _hsi48: Option<Hertz> = None; |     let _hsi48: Option<Hertz> = None; | ||||||
| 
 | 
 | ||||||
| @@ -251,7 +252,12 @@ pub(crate) unsafe fn init(config: Config) { | |||||||
|         }), |         }), | ||||||
|     }; |     }; | ||||||
| 
 | 
 | ||||||
|     let pll_input = PllInput { hse, hsi, msi }; |     let pll_input = PllInput { | ||||||
|  |         hse, | ||||||
|  |         hsi, | ||||||
|  |         #[cfg(any(stm32l4, stm32l5, stm32wb, stm32wl))] | ||||||
|  |         msi, | ||||||
|  |     }; | ||||||
|     let pll = init_pll(PllInstance::Pll, config.pll, &pll_input); |     let pll = init_pll(PllInstance::Pll, config.pll, &pll_input); | ||||||
|     #[cfg(any(stm32l4, stm32l5, stm32wb))] |     #[cfg(any(stm32l4, stm32l5, stm32wb))] | ||||||
|     let pllsai1 = init_pll(PllInstance::Pllsai1, config.pllsai1, &pll_input); |     let pllsai1 = init_pll(PllInstance::Pllsai1, config.pllsai1, &pll_input); | ||||||
| @@ -265,10 +271,13 @@ pub(crate) unsafe fn init(config: Config) { | |||||||
|         ClockSrc::PLL1_R => pll.r.unwrap(), |         ClockSrc::PLL1_R => pll.r.unwrap(), | ||||||
|     }; |     }; | ||||||
| 
 | 
 | ||||||
|     #[cfg(stm32l4)] |     #[cfg(any(rcc_l0_v2, stm32l4, stm32l5, stm32wb))] | ||||||
|     RCC.ccipr().modify(|w| w.set_clk48sel(config.clk48_src)); |     RCC.ccipr().modify(|w| w.set_clk48sel(config.clk48_src)); | ||||||
|     #[cfg(stm32l5)] |     #[cfg(any(rcc_l0_v2))] | ||||||
|     RCC.ccipr1().modify(|w| w.set_clk48sel(config.clk48_src)); |     let _clk48 = match config.clk48_src { | ||||||
|  |         Clk48Src::HSI48 => _hsi48, | ||||||
|  |         Clk48Src::PLL1_VCO_DIV_2 => pll.clk48, | ||||||
|  |     }; | ||||||
|     #[cfg(any(stm32l4, stm32l5, stm32wb))] |     #[cfg(any(stm32l4, stm32l5, stm32wb))] | ||||||
|     let _clk48 = match config.clk48_src { |     let _clk48 = match config.clk48_src { | ||||||
|         Clk48Src::HSI48 => _hsi48, |         Clk48Src::HSI48 => _hsi48, | ||||||
| @@ -285,16 +294,23 @@ pub(crate) unsafe fn init(config: Config) { | |||||||
|     let hclk1 = sys_clk / config.ahb_pre; |     let hclk1 = sys_clk / config.ahb_pre; | ||||||
|     let (pclk1, pclk1_tim) = super::util::calc_pclk(hclk1, config.apb1_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); |     let (pclk2, pclk2_tim) = super::util::calc_pclk(hclk1, config.apb2_pre); | ||||||
|     #[cfg(not(any(stm32wl5x, stm32wb)))] |     #[cfg(any(stm32l4, stm32l5, stm32wlex))] | ||||||
|     let hclk2 = hclk1; |     let hclk2 = hclk1; | ||||||
|     #[cfg(any(stm32wl5x, stm32wb))] |     #[cfg(any(stm32wl5x, stm32wb))] | ||||||
|     let hclk2 = sys_clk / config.core2_ahb_pre; |     let hclk2 = sys_clk / config.core2_ahb_pre; | ||||||
|     #[cfg(not(any(stm32wl, stm32wb)))] |     #[cfg(any(stm32l4, stm32l5, stm32wlex))] | ||||||
|     let hclk3 = hclk1; |     let hclk3 = hclk1; | ||||||
|     #[cfg(any(stm32wl, stm32wb))] |     #[cfg(any(stm32wl5x, stm32wb))] | ||||||
|     let hclk3 = sys_clk / config.shared_ahb_pre; |     let hclk3 = sys_clk / config.shared_ahb_pre; | ||||||
| 
 | 
 | ||||||
|     // Set flash wait states
 |     // Set flash wait states
 | ||||||
|  |     #[cfg(any(stm32l0, stm32l1))] | ||||||
|  |     let latency = match (config.voltage_scale, sys_clk.0) { | ||||||
|  |         (VoltageScale::RANGE1, ..=16_000_000) => false, | ||||||
|  |         (VoltageScale::RANGE2, ..=8_000_000) => false, | ||||||
|  |         (VoltageScale::RANGE3, ..=4_200_000) => false, | ||||||
|  |         _ => true, | ||||||
|  |     }; | ||||||
|     #[cfg(stm32l4)] |     #[cfg(stm32l4)] | ||||||
|     let latency = match hclk1.0 { |     let latency = match hclk1.0 { | ||||||
|         0..=16_000_000 => 0, |         0..=16_000_000 => 0, | ||||||
| @@ -330,6 +346,10 @@ pub(crate) unsafe fn init(config: Config) { | |||||||
|         _ => 4, |         _ => 4, | ||||||
|     }; |     }; | ||||||
| 
 | 
 | ||||||
|  |     #[cfg(stm32l1)] | ||||||
|  |     FLASH.acr().write(|w| w.set_acc64(true)); | ||||||
|  |     #[cfg(not(stm32l5))] | ||||||
|  |     FLASH.acr().modify(|w| w.set_prften(true)); | ||||||
|     FLASH.acr().modify(|w| w.set_latency(latency)); |     FLASH.acr().modify(|w| w.set_latency(latency)); | ||||||
|     while FLASH.acr().read().latency() != latency {} |     while FLASH.acr().read().latency() != latency {} | ||||||
| 
 | 
 | ||||||
| @@ -341,9 +361,7 @@ pub(crate) unsafe fn init(config: Config) { | |||||||
|     }); |     }); | ||||||
|     while RCC.cfgr().read().sws() != config.mux {} |     while RCC.cfgr().read().sws() != config.mux {} | ||||||
| 
 | 
 | ||||||
|     #[cfg(stm32l5)] |     #[cfg(any(stm32l4, stm32l5, stm32wb, stm32wl))] | ||||||
|     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)); |     RCC.ccipr().modify(|w| w.set_adcsel(config.adc_clock_source)); | ||||||
| 
 | 
 | ||||||
|     #[cfg(any(stm32wl, stm32wb))] |     #[cfg(any(stm32wl, stm32wb))] | ||||||
| @@ -361,7 +379,9 @@ pub(crate) unsafe fn init(config: Config) { | |||||||
|     set_freqs(Clocks { |     set_freqs(Clocks { | ||||||
|         sys: sys_clk, |         sys: sys_clk, | ||||||
|         hclk1, |         hclk1, | ||||||
|  |         #[cfg(any(stm32l4, stm32l5, stm32wb, stm32wl))] | ||||||
|         hclk2, |         hclk2, | ||||||
|  |         #[cfg(any(stm32l4, stm32l5, stm32wb, stm32wl))] | ||||||
|         hclk3, |         hclk3, | ||||||
|         pclk1, |         pclk1, | ||||||
|         pclk2, |         pclk2, | ||||||
| @@ -389,6 +409,12 @@ pub(crate) unsafe fn init(config: Config) { | |||||||
|     }); |     }); | ||||||
| } | } | ||||||
| 
 | 
 | ||||||
|  | #[cfg(any(stm32l0, stm32l1))] | ||||||
|  | fn msirange_to_hertz(range: MSIRange) -> Hertz { | ||||||
|  |     Hertz(32_768 * (1 << (range as u8 + 1))) | ||||||
|  | } | ||||||
|  | 
 | ||||||
|  | #[cfg(any(stm32l4, stm32l5, stm32wb, stm32wl))] | ||||||
| fn msirange_to_hertz(range: MSIRange) -> Hertz { | fn msirange_to_hertz(range: MSIRange) -> Hertz { | ||||||
|     match range { |     match range { | ||||||
|         MSIRange::RANGE100K => Hertz(100_000), |         MSIRange::RANGE100K => Hertz(100_000), | ||||||
| @@ -407,20 +433,6 @@ fn msirange_to_hertz(range: MSIRange) -> Hertz { | |||||||
|     } |     } | ||||||
| } | } | ||||||
| 
 | 
 | ||||||
| struct PllInput { |  | ||||||
|     hsi: Option<Hertz>, |  | ||||||
|     hse: Option<Hertz>, |  | ||||||
|     msi: Option<Hertz>, |  | ||||||
| } |  | ||||||
| 
 |  | ||||||
| #[allow(unused)] |  | ||||||
| #[derive(Default)] |  | ||||||
| struct PllOutput { |  | ||||||
|     p: Option<Hertz>, |  | ||||||
|     q: Option<Hertz>, |  | ||||||
|     r: Option<Hertz>, |  | ||||||
| } |  | ||||||
| 
 |  | ||||||
| #[derive(PartialEq, Eq, Clone, Copy)] | #[derive(PartialEq, Eq, Clone, Copy)] | ||||||
| enum PllInstance { | enum PllInstance { | ||||||
|     Pll, |     Pll, | ||||||
| @@ -449,20 +461,124 @@ fn pll_enable(instance: PllInstance, enabled: bool) { | |||||||
|     } |     } | ||||||
| } | } | ||||||
| 
 | 
 | ||||||
| fn init_pll(instance: PllInstance, config: Option<Pll>, input: &PllInput) -> PllOutput { | pub use pll::*; | ||||||
|  | 
 | ||||||
|  | #[cfg(any(stm32l0, stm32l1))] | ||||||
|  | mod pll { | ||||||
|  |     use super::{pll_enable, PllInstance}; | ||||||
|  |     pub use crate::pac::rcc::vals::{Plldiv as PllDiv, Pllmul as PllMul, Pllsrc as PllSource}; | ||||||
|  |     use crate::pac::RCC; | ||||||
|  |     use crate::time::Hertz; | ||||||
|  | 
 | ||||||
|  |     #[derive(Clone, Copy)] | ||||||
|  |     pub struct Pll { | ||||||
|  |         /// PLL source
 | ||||||
|  |         pub source: PllSource, | ||||||
|  | 
 | ||||||
|  |         /// PLL multiplication factor.
 | ||||||
|  |         pub mul: PllMul, | ||||||
|  | 
 | ||||||
|  |         /// PLL main output division factor.
 | ||||||
|  |         pub div: PllDiv, | ||||||
|  |     } | ||||||
|  | 
 | ||||||
|  |     pub(super) struct PllInput { | ||||||
|  |         pub hsi: Option<Hertz>, | ||||||
|  |         pub hse: Option<Hertz>, | ||||||
|  |     } | ||||||
|  | 
 | ||||||
|  |     #[allow(unused)] | ||||||
|  |     #[derive(Default)] | ||||||
|  |     pub(super) struct PllOutput { | ||||||
|  |         pub r: Option<Hertz>, | ||||||
|  |         pub clk48: Option<Hertz>, | ||||||
|  |     } | ||||||
|  | 
 | ||||||
|  |     pub(super) fn init_pll(instance: PllInstance, config: Option<Pll>, input: &PllInput) -> PllOutput { | ||||||
|         // Disable PLL
 |         // Disable PLL
 | ||||||
|         pll_enable(instance, false); |         pll_enable(instance, false); | ||||||
| 
 | 
 | ||||||
|         let Some(pll) = config else { return PllOutput::default() }; |         let Some(pll) = config else { return PllOutput::default() }; | ||||||
| 
 | 
 | ||||||
|         let pll_src = match pll.source { |         let pll_src = match pll.source { | ||||||
|         PLLSource::DISABLE => panic!("must not select PLL source as DISABLE"), |             PllSource::HSE => unwrap!(input.hse), | ||||||
|         PLLSource::HSE => input.hse, |             PllSource::HSI => unwrap!(input.hsi), | ||||||
|         PLLSource::HSI => input.hsi, |  | ||||||
|         PLLSource::MSI => input.msi, |  | ||||||
|         }; |         }; | ||||||
| 
 | 
 | ||||||
|     let pll_src = pll_src.unwrap(); |         let vco_freq = pll_src * pll.mul; | ||||||
|  | 
 | ||||||
|  |         let r = vco_freq / pll.div; | ||||||
|  |         let clk48 = (vco_freq == Hertz(96_000_000)).then_some(Hertz(48_000_000)); | ||||||
|  | 
 | ||||||
|  |         assert!(r <= Hertz(32_000_000)); | ||||||
|  | 
 | ||||||
|  |         RCC.cfgr().write(move |w| { | ||||||
|  |             w.set_pllmul(pll.mul); | ||||||
|  |             w.set_plldiv(pll.div); | ||||||
|  |             w.set_pllsrc(pll.source); | ||||||
|  |         }); | ||||||
|  | 
 | ||||||
|  |         // Enable PLL
 | ||||||
|  |         pll_enable(instance, true); | ||||||
|  | 
 | ||||||
|  |         PllOutput { r: Some(r), clk48 } | ||||||
|  |     } | ||||||
|  | } | ||||||
|  | 
 | ||||||
|  | #[cfg(any(stm32l4, stm32l5, stm32wb, stm32wl))] | ||||||
|  | mod pll { | ||||||
|  |     use super::{pll_enable, PllInstance}; | ||||||
|  |     pub use crate::pac::rcc::vals::{ | ||||||
|  |         Pllm as PllPreDiv, Plln as PllMul, Pllp as PllPDiv, Pllq as PllQDiv, Pllr as PllRDiv, Pllsrc as PllSource, | ||||||
|  |     }; | ||||||
|  |     use crate::pac::RCC; | ||||||
|  |     use crate::time::Hertz; | ||||||
|  | 
 | ||||||
|  |     #[derive(Clone, Copy)] | ||||||
|  |     pub struct Pll { | ||||||
|  |         /// PLL source
 | ||||||
|  |         pub source: PllSource, | ||||||
|  | 
 | ||||||
|  |         /// PLL pre-divider (DIVM).
 | ||||||
|  |         pub prediv: PllPreDiv, | ||||||
|  | 
 | ||||||
|  |         /// PLL multiplication factor.
 | ||||||
|  |         pub mul: PllMul, | ||||||
|  | 
 | ||||||
|  |         /// PLL P division factor. If None, PLL P output is disabled.
 | ||||||
|  |         pub divp: Option<PllPDiv>, | ||||||
|  |         /// PLL Q division factor. If None, PLL Q output is disabled.
 | ||||||
|  |         pub divq: Option<PllQDiv>, | ||||||
|  |         /// PLL R division factor. If None, PLL R output is disabled.
 | ||||||
|  |         pub divr: Option<PllRDiv>, | ||||||
|  |     } | ||||||
|  | 
 | ||||||
|  |     pub(super) struct PllInput { | ||||||
|  |         pub hsi: Option<Hertz>, | ||||||
|  |         pub hse: Option<Hertz>, | ||||||
|  |         pub msi: Option<Hertz>, | ||||||
|  |     } | ||||||
|  | 
 | ||||||
|  |     #[allow(unused)] | ||||||
|  |     #[derive(Default)] | ||||||
|  |     pub(super) struct PllOutput { | ||||||
|  |         pub p: Option<Hertz>, | ||||||
|  |         pub q: Option<Hertz>, | ||||||
|  |         pub r: Option<Hertz>, | ||||||
|  |     } | ||||||
|  | 
 | ||||||
|  |     pub(super) 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::DISABLE => panic!("must not select PLL source as DISABLE"), | ||||||
|  |             PllSource::HSE => unwrap!(input.hse), | ||||||
|  |             PllSource::HSI => unwrap!(input.hsi), | ||||||
|  |             PllSource::MSI => unwrap!(input.msi), | ||||||
|  |         }; | ||||||
| 
 | 
 | ||||||
|         let vco_freq = pll_src / pll.prediv * pll.mul; |         let vco_freq = pll_src / pll.prediv * pll.mul; | ||||||
| 
 | 
 | ||||||
| @@ -522,4 +638,5 @@ fn init_pll(instance: PllInstance, config: Option<Pll>, input: &PllInput) -> Pll | |||||||
|         pll_enable(instance, true); |         pll_enable(instance, true); | ||||||
| 
 | 
 | ||||||
|         PllOutput { p, q, r } |         PllOutput { p, q, r } | ||||||
|  |     } | ||||||
| } | } | ||||||
| @@ -1,190 +0,0 @@ | |||||||
| pub use crate::pac::pwr::vals::Vos as VoltageScale; |  | ||||||
| pub use crate::pac::rcc::vals::{ |  | ||||||
|     Hpre as AHBPrescaler, Msirange as MSIRange, Plldiv as PLLDiv, Plldiv as PllDiv, Pllmul as PLLMul, Pllmul as PllMul, |  | ||||||
|     Pllsrc as PLLSource, Ppre as APBPrescaler, Sw as ClockSrc, |  | ||||||
| }; |  | ||||||
| use crate::pac::{FLASH, PWR, RCC}; |  | ||||||
| use crate::rcc::{set_freqs, Clocks}; |  | ||||||
| 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, |  | ||||||
| } |  | ||||||
|  |  | ||||||
| #[derive(Clone, Copy)] |  | ||||||
| pub struct Pll { |  | ||||||
|     /// PLL source |  | ||||||
|     pub source: PLLSource, |  | ||||||
|  |  | ||||||
|     /// PLL multiplication factor. |  | ||||||
|     pub mul: PllMul, |  | ||||||
|  |  | ||||||
|     /// PLL main output division factor. |  | ||||||
|     pub div: PllDiv, |  | ||||||
| } |  | ||||||
|  |  | ||||||
| /// Clocks configutation |  | ||||||
| pub struct Config { |  | ||||||
|     // base clock sources |  | ||||||
|     pub msi: Option<MSIRange>, |  | ||||||
|     pub hsi: bool, |  | ||||||
|     pub hse: Option<Hse>, |  | ||||||
|     #[cfg(crs)] |  | ||||||
|     pub hsi48: Option<super::Hsi48Config>, |  | ||||||
|  |  | ||||||
|     pub pll: Option<Pll>, |  | ||||||
|  |  | ||||||
|     pub mux: ClockSrc, |  | ||||||
|     pub ahb_pre: AHBPrescaler, |  | ||||||
|     pub apb1_pre: APBPrescaler, |  | ||||||
|     pub apb2_pre: APBPrescaler, |  | ||||||
|  |  | ||||||
|     pub ls: super::LsConfig, |  | ||||||
|     pub voltage_scale: VoltageScale, |  | ||||||
| } |  | ||||||
|  |  | ||||||
| impl Default for Config { |  | ||||||
|     #[inline] |  | ||||||
|     fn default() -> Config { |  | ||||||
|         Config { |  | ||||||
|             msi: Some(MSIRange::RANGE5), |  | ||||||
|             hse: None, |  | ||||||
|             hsi: false, |  | ||||||
|             #[cfg(crs)] |  | ||||||
|             hsi48: Some(Default::default()), |  | ||||||
|  |  | ||||||
|             pll: None, |  | ||||||
|  |  | ||||||
|             mux: ClockSrc::MSI, |  | ||||||
|             ahb_pre: AHBPrescaler::DIV1, |  | ||||||
|             apb1_pre: APBPrescaler::DIV1, |  | ||||||
|             apb2_pre: APBPrescaler::DIV1, |  | ||||||
|             voltage_scale: VoltageScale::RANGE1, |  | ||||||
|             ls: Default::default(), |  | ||||||
|         } |  | ||||||
|     } |  | ||||||
| } |  | ||||||
|  |  | ||||||
| pub(crate) unsafe fn init(config: Config) { |  | ||||||
|     // Set voltage scale |  | ||||||
|     while PWR.csr().read().vosf() {} |  | ||||||
|     PWR.cr().write(|w| w.set_vos(config.voltage_scale)); |  | ||||||
|     while PWR.csr().read().vosf() {} |  | ||||||
|  |  | ||||||
|     let rtc = config.ls.init(); |  | ||||||
|  |  | ||||||
|     let msi = config.msi.map(|range| { |  | ||||||
|         RCC.icscr().modify(|w| w.set_msirange(range)); |  | ||||||
|  |  | ||||||
|         RCC.cr().modify(|w| w.set_msion(true)); |  | ||||||
|         while !RCC.cr().read().msirdy() {} |  | ||||||
|  |  | ||||||
|         Hertz(32_768 * (1 << (range as u8 + 1))) |  | ||||||
|     }); |  | ||||||
|  |  | ||||||
|     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(|hse| { |  | ||||||
|         RCC.cr().modify(|w| { |  | ||||||
|             w.set_hsebyp(hse.mode == HseMode::Bypass); |  | ||||||
|             w.set_hseon(true); |  | ||||||
|         }); |  | ||||||
|         while !RCC.cr().read().hserdy() {} |  | ||||||
|  |  | ||||||
|         hse.freq |  | ||||||
|     }); |  | ||||||
|  |  | ||||||
|     let pll = config.pll.map(|pll| { |  | ||||||
|         let freq = match pll.source { |  | ||||||
|             PLLSource::HSE => hse.unwrap(), |  | ||||||
|             PLLSource::HSI => hsi.unwrap(), |  | ||||||
|         }; |  | ||||||
|  |  | ||||||
|         // Disable PLL |  | ||||||
|         RCC.cr().modify(|w| w.set_pllon(false)); |  | ||||||
|         while RCC.cr().read().pllrdy() {} |  | ||||||
|  |  | ||||||
|         let freq = freq * pll.mul / pll.div; |  | ||||||
|  |  | ||||||
|         assert!(freq <= Hertz(32_000_000)); |  | ||||||
|  |  | ||||||
|         RCC.cfgr().write(move |w| { |  | ||||||
|             w.set_pllmul(pll.mul); |  | ||||||
|             w.set_plldiv(pll.div); |  | ||||||
|             w.set_pllsrc(pll.source); |  | ||||||
|         }); |  | ||||||
|  |  | ||||||
|         // Enable PLL |  | ||||||
|         RCC.cr().modify(|w| w.set_pllon(true)); |  | ||||||
|         while !RCC.cr().read().pllrdy() {} |  | ||||||
|  |  | ||||||
|         freq |  | ||||||
|     }); |  | ||||||
|  |  | ||||||
|     let sys_clk = match config.mux { |  | ||||||
|         ClockSrc::HSE => hse.unwrap(), |  | ||||||
|         ClockSrc::HSI => hsi.unwrap(), |  | ||||||
|         ClockSrc::MSI => msi.unwrap(), |  | ||||||
|         ClockSrc::PLL1_P => pll.unwrap(), |  | ||||||
|     }; |  | ||||||
|  |  | ||||||
|     let wait_states = match (config.voltage_scale, sys_clk.0) { |  | ||||||
|         (VoltageScale::RANGE1, ..=16_000_000) => 0, |  | ||||||
|         (VoltageScale::RANGE2, ..=8_000_000) => 0, |  | ||||||
|         (VoltageScale::RANGE3, ..=4_200_000) => 0, |  | ||||||
|         _ => 1, |  | ||||||
|     }; |  | ||||||
|  |  | ||||||
|     #[cfg(stm32l1)] |  | ||||||
|     FLASH.acr().write(|w| w.set_acc64(true)); |  | ||||||
|     FLASH.acr().modify(|w| w.set_prften(true)); |  | ||||||
|     FLASH.acr().modify(|w| w.set_latency(wait_states != 0)); |  | ||||||
|  |  | ||||||
|     RCC.cfgr().modify(|w| { |  | ||||||
|         w.set_sw(config.mux); |  | ||||||
|         w.set_hpre(config.ahb_pre); |  | ||||||
|         w.set_ppre1(config.apb1_pre); |  | ||||||
|         w.set_ppre2(config.apb2_pre); |  | ||||||
|     }); |  | ||||||
|  |  | ||||||
|     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)] |  | ||||||
|     let _hsi48 = config.hsi48.map(|config| { |  | ||||||
|         // Select HSI48 as USB clock |  | ||||||
|         RCC.ccipr().modify(|w| w.set_hsi48msel(true)); |  | ||||||
|         super::init_hsi48(config) |  | ||||||
|     }); |  | ||||||
|  |  | ||||||
|     set_freqs(Clocks { |  | ||||||
|         sys: sys_clk, |  | ||||||
|         hclk1, |  | ||||||
|         pclk1, |  | ||||||
|         pclk2, |  | ||||||
|         pclk1_tim, |  | ||||||
|         pclk2_tim, |  | ||||||
|         rtc, |  | ||||||
|     }); |  | ||||||
| } |  | ||||||
| @@ -15,16 +15,14 @@ mod hsi48; | |||||||
| pub use hsi48::*; | pub use hsi48::*; | ||||||
|  |  | ||||||
| #[cfg_attr(rcc_f0, path = "f0.rs")] | #[cfg_attr(rcc_f0, path = "f0.rs")] | ||||||
| #[cfg_attr(any(rcc_f1, rcc_f100, rcc_f1cl), path = "f1.rs")] | #[cfg_attr(any(stm32f1), path = "f1.rs")] | ||||||
| #[cfg_attr(rcc_f2, path = "f2.rs")] | #[cfg_attr(any(stm32f3), path = "f3.rs")] | ||||||
| #[cfg_attr(any(rcc_f3, rcc_f3_v2), path = "f3.rs")] | #[cfg_attr(any(stm32f2, stm32f4, stm32f7), path = "f.rs")] | ||||||
| #[cfg_attr(any(rcc_f4, rcc_f410, rcc_f7), path = "f4f7.rs")] |  | ||||||
| #[cfg_attr(rcc_c0, path = "c0.rs")] | #[cfg_attr(rcc_c0, path = "c0.rs")] | ||||||
| #[cfg_attr(rcc_g0, path = "g0.rs")] | #[cfg_attr(rcc_g0, path = "g0.rs")] | ||||||
| #[cfg_attr(rcc_g4, path = "g4.rs")] | #[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(stm32h5, stm32h7), path = "h.rs")] | ||||||
| #[cfg_attr(any(rcc_l0, rcc_l0_v2, rcc_l1), path = "l0l1.rs")] | #[cfg_attr(any(stm32l0, stm32l1, stm32l4, stm32l5, stm32wb, stm32wl), path = "l.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_u5, path = "u5.rs")] | ||||||
| #[cfg_attr(rcc_wba, path = "wba.rs")] | #[cfg_attr(rcc_wba, path = "wba.rs")] | ||||||
| mod _version; | mod _version; | ||||||
|   | |||||||
| @@ -35,7 +35,7 @@ impl Default for ClockSrc { | |||||||
| #[derive(Clone, Copy)] | #[derive(Clone, Copy)] | ||||||
| pub struct PllConfig { | pub struct PllConfig { | ||||||
|     /// The clock source for the PLL. |     /// The clock source for the PLL. | ||||||
|     pub source: PllSrc, |     pub source: PllSource, | ||||||
|     /// The PLL prescaler. |     /// The PLL prescaler. | ||||||
|     /// |     /// | ||||||
|     /// The clock speed of the `source` divided by `m` must be between 4 and 16 MHz. |     /// The clock speed of the `source` divided by `m` must be between 4 and 16 MHz. | ||||||
| @@ -57,7 +57,7 @@ impl PllConfig { | |||||||
|     /// A configuration for HSI / 1 * 10 / 1 = 160 MHz |     /// A configuration for HSI / 1 * 10 / 1 = 160 MHz | ||||||
|     pub const fn hsi_160mhz() -> Self { |     pub const fn hsi_160mhz() -> Self { | ||||||
|         PllConfig { |         PllConfig { | ||||||
|             source: PllSrc::HSI, |             source: PllSource::HSI, | ||||||
|             m: Pllm::DIV1, |             m: Pllm::DIV1, | ||||||
|             n: Plln::MUL10, |             n: Plln::MUL10, | ||||||
|             r: Plldiv::DIV1, |             r: Plldiv::DIV1, | ||||||
| @@ -67,7 +67,7 @@ impl PllConfig { | |||||||
|     /// A configuration for MSIS @ 48 MHz / 3 * 10 / 1 = 160 MHz |     /// A configuration for MSIS @ 48 MHz / 3 * 10 / 1 = 160 MHz | ||||||
|     pub const fn msis_160mhz() -> Self { |     pub const fn msis_160mhz() -> Self { | ||||||
|         PllConfig { |         PllConfig { | ||||||
|             source: PllSrc::MSIS(Msirange::RANGE_48MHZ), |             source: PllSource::MSIS(Msirange::RANGE_48MHZ), | ||||||
|             m: Pllm::DIV3, |             m: Pllm::DIV3, | ||||||
|             n: Plln::MUL10, |             n: Plln::MUL10, | ||||||
|             r: Plldiv::DIV1, |             r: Plldiv::DIV1, | ||||||
| @@ -76,7 +76,7 @@ impl PllConfig { | |||||||
| } | } | ||||||
|  |  | ||||||
| #[derive(Clone, Copy)] | #[derive(Clone, Copy)] | ||||||
| pub enum PllSrc { | pub enum PllSource { | ||||||
|     /// Use an internal medium speed oscillator as the PLL source. |     /// Use an internal medium speed oscillator as the PLL source. | ||||||
|     MSIS(Msirange), |     MSIS(Msirange), | ||||||
|     /// Use the external high speed clock as the system PLL source. |     /// Use the external high speed clock as the system PLL source. | ||||||
| @@ -88,12 +88,12 @@ pub enum PllSrc { | |||||||
|     HSI, |     HSI, | ||||||
| } | } | ||||||
|  |  | ||||||
| impl Into<Pllsrc> for PllSrc { | impl Into<Pllsrc> for PllSource { | ||||||
|     fn into(self) -> Pllsrc { |     fn into(self) -> Pllsrc { | ||||||
|         match self { |         match self { | ||||||
|             PllSrc::MSIS(..) => Pllsrc::MSIS, |             PllSource::MSIS(..) => Pllsrc::MSIS, | ||||||
|             PllSrc::HSE(..) => Pllsrc::HSE, |             PllSource::HSE(..) => Pllsrc::HSE, | ||||||
|             PllSrc::HSI => Pllsrc::HSI, |             PllSource::HSI => Pllsrc::HSI, | ||||||
|         } |         } | ||||||
|     } |     } | ||||||
| } | } | ||||||
| @@ -216,9 +216,9 @@ pub(crate) unsafe fn init(config: Config) { | |||||||
|         ClockSrc::PLL1_R(pll) => { |         ClockSrc::PLL1_R(pll) => { | ||||||
|             // Configure the PLL source |             // Configure the PLL source | ||||||
|             let source_clk = match pll.source { |             let source_clk = match pll.source { | ||||||
|                 PllSrc::MSIS(range) => config.init_msis(range), |                 PllSource::MSIS(range) => config.init_msis(range), | ||||||
|                 PllSrc::HSE(hertz) => config.init_hse(hertz), |                 PllSource::HSE(hertz) => config.init_hse(hertz), | ||||||
|                 PllSrc::HSI => config.init_hsi(), |                 PllSource::HSI => config.init_hsi(), | ||||||
|             }; |             }; | ||||||
|  |  | ||||||
|             // Calculate the reference clock, which is the source divided by m |             // Calculate the reference clock, which is the source divided by m | ||||||
|   | |||||||
| @@ -17,16 +17,16 @@ pub enum ClockSrc { | |||||||
| } | } | ||||||
|  |  | ||||||
| #[derive(Clone, Copy, Debug)] | #[derive(Clone, Copy, Debug)] | ||||||
| pub enum PllSrc { | pub enum PllSource { | ||||||
|     HSE(Hertz), |     HSE(Hertz), | ||||||
|     HSI, |     HSI, | ||||||
| } | } | ||||||
|  |  | ||||||
| impl Into<Pllsrc> for PllSrc { | impl Into<Pllsrc> for PllSource { | ||||||
|     fn into(self) -> Pllsrc { |     fn into(self) -> Pllsrc { | ||||||
|         match self { |         match self { | ||||||
|             PllSrc::HSE(..) => Pllsrc::HSE, |             PllSource::HSE(..) => Pllsrc::HSE, | ||||||
|             PllSrc::HSI => Pllsrc::HSI, |             PllSource::HSI => Pllsrc::HSI, | ||||||
|         } |         } | ||||||
|     } |     } | ||||||
| } | } | ||||||
|   | |||||||
| @@ -33,6 +33,61 @@ use embassy_hal_internal::Peripheral; | |||||||
| use crate::peripherals::RTC; | use crate::peripherals::RTC; | ||||||
| use crate::rtc::sealed::Instance; | use crate::rtc::sealed::Instance; | ||||||
|  |  | ||||||
|  | #[allow(dead_code)] | ||||||
|  | #[repr(u8)] | ||||||
|  | #[derive(Clone, Copy, Debug)] | ||||||
|  | pub(crate) enum WakeupPrescaler { | ||||||
|  |     Div2 = 2, | ||||||
|  |     Div4 = 4, | ||||||
|  |     Div8 = 8, | ||||||
|  |     Div16 = 16, | ||||||
|  | } | ||||||
|  |  | ||||||
|  | #[cfg(any(stm32wb, stm32f4, stm32l0, stm32g4))] | ||||||
|  | impl From<WakeupPrescaler> for crate::pac::rtc::vals::Wucksel { | ||||||
|  |     fn from(val: WakeupPrescaler) -> Self { | ||||||
|  |         use crate::pac::rtc::vals::Wucksel; | ||||||
|  |  | ||||||
|  |         match val { | ||||||
|  |             WakeupPrescaler::Div2 => Wucksel::DIV2, | ||||||
|  |             WakeupPrescaler::Div4 => Wucksel::DIV4, | ||||||
|  |             WakeupPrescaler::Div8 => Wucksel::DIV8, | ||||||
|  |             WakeupPrescaler::Div16 => Wucksel::DIV16, | ||||||
|  |         } | ||||||
|  |     } | ||||||
|  | } | ||||||
|  |  | ||||||
|  | #[cfg(any(stm32wb, stm32f4, stm32l0, stm32g4))] | ||||||
|  | impl From<crate::pac::rtc::vals::Wucksel> for WakeupPrescaler { | ||||||
|  |     fn from(val: crate::pac::rtc::vals::Wucksel) -> Self { | ||||||
|  |         use crate::pac::rtc::vals::Wucksel; | ||||||
|  |  | ||||||
|  |         match val { | ||||||
|  |             Wucksel::DIV2 => WakeupPrescaler::Div2, | ||||||
|  |             Wucksel::DIV4 => WakeupPrescaler::Div4, | ||||||
|  |             Wucksel::DIV8 => WakeupPrescaler::Div8, | ||||||
|  |             Wucksel::DIV16 => WakeupPrescaler::Div16, | ||||||
|  |             _ => unreachable!(), | ||||||
|  |         } | ||||||
|  |     } | ||||||
|  | } | ||||||
|  |  | ||||||
|  | #[cfg(feature = "low-power")] | ||||||
|  | impl WakeupPrescaler { | ||||||
|  |     pub fn compute_min(val: u32) -> Self { | ||||||
|  |         *[ | ||||||
|  |             WakeupPrescaler::Div2, | ||||||
|  |             WakeupPrescaler::Div4, | ||||||
|  |             WakeupPrescaler::Div8, | ||||||
|  |             WakeupPrescaler::Div16, | ||||||
|  |         ] | ||||||
|  |         .iter() | ||||||
|  |         .skip_while(|psc| **psc as u32 <= val) | ||||||
|  |         .next() | ||||||
|  |         .unwrap_or(&WakeupPrescaler::Div16) | ||||||
|  |     } | ||||||
|  | } | ||||||
|  |  | ||||||
| /// Errors that can occur on methods on [RtcClock] | /// Errors that can occur on methods on [RtcClock] | ||||||
| #[non_exhaustive] | #[non_exhaustive] | ||||||
| #[derive(Clone, Debug, PartialEq, Eq)] | #[derive(Clone, Debug, PartialEq, Eq)] | ||||||
| @@ -277,6 +332,114 @@ impl Rtc { | |||||||
|     pub fn write_backup_register(&self, register: usize, value: u32) { |     pub fn write_backup_register(&self, register: usize, value: u32) { | ||||||
|         RTC::write_backup_register(&RTC::regs(), register, value) |         RTC::write_backup_register(&RTC::regs(), register, value) | ||||||
|     } |     } | ||||||
|  |  | ||||||
|  |     #[cfg(feature = "low-power")] | ||||||
|  |     /// start the wakeup alarm and wtih a duration that is as close to but less than | ||||||
|  |     /// the requested duration, and record the instant the wakeup alarm was started | ||||||
|  |     pub(crate) fn start_wakeup_alarm( | ||||||
|  |         &self, | ||||||
|  |         requested_duration: embassy_time::Duration, | ||||||
|  |         cs: critical_section::CriticalSection, | ||||||
|  |     ) { | ||||||
|  |         use embassy_time::{Duration, TICK_HZ}; | ||||||
|  |  | ||||||
|  |         #[cfg(any(rtc_v3, rtc_v3u5))] | ||||||
|  |         use crate::pac::rtc::vals::Calrf; | ||||||
|  |  | ||||||
|  |         // Panic if the rcc mod knows we're not using low-power rtc | ||||||
|  |         #[cfg(any(rcc_wb, rcc_f4, rcc_f410))] | ||||||
|  |         unsafe { crate::rcc::get_freqs() }.rtc.unwrap(); | ||||||
|  |  | ||||||
|  |         let requested_duration = requested_duration.as_ticks().clamp(0, u32::MAX as u64); | ||||||
|  |         let rtc_hz = Self::frequency().0 as u64; | ||||||
|  |         let rtc_ticks = requested_duration * rtc_hz / TICK_HZ; | ||||||
|  |         let prescaler = WakeupPrescaler::compute_min((rtc_ticks / u16::MAX as u64) as u32); | ||||||
|  |  | ||||||
|  |         // adjust the rtc ticks to the prescaler and subtract one rtc tick | ||||||
|  |         let rtc_ticks = rtc_ticks / prescaler as u64; | ||||||
|  |         let rtc_ticks = rtc_ticks.clamp(0, (u16::MAX - 1) as u64).saturating_sub(1) as u16; | ||||||
|  |  | ||||||
|  |         self.write(false, |regs| { | ||||||
|  |             regs.cr().modify(|w| w.set_wute(false)); | ||||||
|  |  | ||||||
|  |             #[cfg(any( | ||||||
|  |                 rtc_v2f0, rtc_v2f2, rtc_v2f3, rtc_v2f4, rtc_v2f7, rtc_v2h7, rtc_v2l0, rtc_v2l1, rtc_v2l4, rtc_v2wb | ||||||
|  |             ))] | ||||||
|  |             { | ||||||
|  |                 regs.isr().modify(|w| w.set_wutf(false)); | ||||||
|  |                 while !regs.isr().read().wutwf() {} | ||||||
|  |             } | ||||||
|  |  | ||||||
|  |             #[cfg(any(rtc_v3, rtc_v3u5))] | ||||||
|  |             { | ||||||
|  |                 regs.scr().write(|w| w.set_cwutf(Calrf::CLEAR)); | ||||||
|  |                 while !regs.icsr().read().wutwf() {} | ||||||
|  |             } | ||||||
|  |  | ||||||
|  |             regs.cr().modify(|w| w.set_wucksel(prescaler.into())); | ||||||
|  |             regs.wutr().write(|w| w.set_wut(rtc_ticks)); | ||||||
|  |             regs.cr().modify(|w| w.set_wute(true)); | ||||||
|  |             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, | ||||||
|  |             instant, | ||||||
|  |         ); | ||||||
|  |  | ||||||
|  |         assert!(self.stop_time.borrow(cs).replace(Some(instant)).is_none()) | ||||||
|  |     } | ||||||
|  |  | ||||||
|  |     #[cfg(feature = "low-power")] | ||||||
|  |     /// stop the wakeup alarm and return the time elapsed since `start_wakeup_alarm` | ||||||
|  |     /// was called, otherwise none | ||||||
|  |     pub(crate) fn stop_wakeup_alarm(&self, cs: critical_section::CriticalSection) -> Option<embassy_time::Duration> { | ||||||
|  |         use crate::interrupt::typelevel::Interrupt; | ||||||
|  |         #[cfg(any(rtc_v3, rtc_v3u5))] | ||||||
|  |         use crate::pac::rtc::vals::Calrf; | ||||||
|  |  | ||||||
|  |         let instant = self.instant().unwrap(); | ||||||
|  |         if RTC::regs().cr().read().wute() { | ||||||
|  |             trace!("rtc: stop wakeup alarm at {}", instant); | ||||||
|  |  | ||||||
|  |             self.write(false, |regs| { | ||||||
|  |                 regs.cr().modify(|w| w.set_wutie(false)); | ||||||
|  |                 regs.cr().modify(|w| w.set_wute(false)); | ||||||
|  |  | ||||||
|  |                 #[cfg(any( | ||||||
|  |                     rtc_v2f0, rtc_v2f2, rtc_v2f3, rtc_v2f4, rtc_v2f7, rtc_v2h7, rtc_v2l0, rtc_v2l1, rtc_v2l4, rtc_v2wb | ||||||
|  |                 ))] | ||||||
|  |                 regs.isr().modify(|w| w.set_wutf(false)); | ||||||
|  |  | ||||||
|  |                 #[cfg(any(rtc_v3, rtc_v3u5))] | ||||||
|  |                 regs.scr().write(|w| w.set_cwutf(Calrf::CLEAR)); | ||||||
|  |  | ||||||
|  |                 crate::pac::EXTI | ||||||
|  |                     .pr(0) | ||||||
|  |                     .modify(|w| w.set_line(RTC::EXTI_WAKEUP_LINE, true)); | ||||||
|  |  | ||||||
|  |                 <RTC as crate::rtc::sealed::Instance>::WakeupInterrupt::unpend(); | ||||||
|  |             }); | ||||||
|  |         } | ||||||
|  |  | ||||||
|  |         self.stop_time.borrow(cs).take().map(|stop_time| instant - stop_time) | ||||||
|  |     } | ||||||
|  |  | ||||||
|  |     #[cfg(feature = "low-power")] | ||||||
|  |     pub(crate) fn enable_wakeup_line(&self) { | ||||||
|  |         use crate::interrupt::typelevel::Interrupt; | ||||||
|  |         use crate::pac::EXTI; | ||||||
|  |  | ||||||
|  |         <RTC as crate::rtc::sealed::Instance>::WakeupInterrupt::unpend(); | ||||||
|  |         unsafe { <RTC as crate::rtc::sealed::Instance>::WakeupInterrupt::enable() }; | ||||||
|  |  | ||||||
|  |         EXTI.rtsr(0).modify(|w| w.set_line(RTC::EXTI_WAKEUP_LINE, true)); | ||||||
|  |         EXTI.imr(0).modify(|w| w.set_line(RTC::EXTI_WAKEUP_LINE, true)); | ||||||
|  |     } | ||||||
| } | } | ||||||
|  |  | ||||||
| pub(crate) fn byte_to_bcd2(byte: u8) -> (u8, u8) { | pub(crate) fn byte_to_bcd2(byte: u8) -> (u8, u8) { | ||||||
|   | |||||||
| @@ -6,145 +6,7 @@ use crate::peripherals::RTC; | |||||||
| use crate::rtc::sealed::Instance; | use crate::rtc::sealed::Instance; | ||||||
|  |  | ||||||
| #[allow(dead_code)] | #[allow(dead_code)] | ||||||
| #[repr(u8)] |  | ||||||
| #[derive(Clone, Copy, Debug)] |  | ||||||
| pub(crate) enum WakeupPrescaler { |  | ||||||
|     Div2 = 2, |  | ||||||
|     Div4 = 4, |  | ||||||
|     Div8 = 8, |  | ||||||
|     Div16 = 16, |  | ||||||
| } |  | ||||||
|  |  | ||||||
| #[cfg(any(stm32wb, stm32f4, stm32l0))] |  | ||||||
| impl From<WakeupPrescaler> for crate::pac::rtc::vals::Wucksel { |  | ||||||
|     fn from(val: WakeupPrescaler) -> Self { |  | ||||||
|         use crate::pac::rtc::vals::Wucksel; |  | ||||||
|  |  | ||||||
|         match val { |  | ||||||
|             WakeupPrescaler::Div2 => Wucksel::DIV2, |  | ||||||
|             WakeupPrescaler::Div4 => Wucksel::DIV4, |  | ||||||
|             WakeupPrescaler::Div8 => Wucksel::DIV8, |  | ||||||
|             WakeupPrescaler::Div16 => Wucksel::DIV16, |  | ||||||
|         } |  | ||||||
|     } |  | ||||||
| } |  | ||||||
|  |  | ||||||
| #[cfg(any(stm32wb, stm32f4, stm32l0))] |  | ||||||
| impl From<crate::pac::rtc::vals::Wucksel> for WakeupPrescaler { |  | ||||||
|     fn from(val: crate::pac::rtc::vals::Wucksel) -> Self { |  | ||||||
|         use crate::pac::rtc::vals::Wucksel; |  | ||||||
|  |  | ||||||
|         match val { |  | ||||||
|             Wucksel::DIV2 => WakeupPrescaler::Div2, |  | ||||||
|             Wucksel::DIV4 => WakeupPrescaler::Div4, |  | ||||||
|             Wucksel::DIV8 => WakeupPrescaler::Div8, |  | ||||||
|             Wucksel::DIV16 => WakeupPrescaler::Div16, |  | ||||||
|             _ => unreachable!(), |  | ||||||
|         } |  | ||||||
|     } |  | ||||||
| } |  | ||||||
|  |  | ||||||
| #[allow(dead_code)] |  | ||||||
| impl WakeupPrescaler { |  | ||||||
|     pub fn compute_min(val: u32) -> Self { |  | ||||||
|         *[ |  | ||||||
|             WakeupPrescaler::Div2, |  | ||||||
|             WakeupPrescaler::Div4, |  | ||||||
|             WakeupPrescaler::Div8, |  | ||||||
|             WakeupPrescaler::Div16, |  | ||||||
|         ] |  | ||||||
|         .iter() |  | ||||||
|         .skip_while(|psc| **psc as u32 <= val) |  | ||||||
|         .next() |  | ||||||
|         .unwrap_or(&WakeupPrescaler::Div16) |  | ||||||
|     } |  | ||||||
| } |  | ||||||
|  |  | ||||||
| impl super::Rtc { | impl super::Rtc { | ||||||
|     #[cfg(feature = "low-power")] |  | ||||||
|     /// start the wakeup alarm and wtih a duration that is as close to but less than |  | ||||||
|     /// the requested duration, and record the instant the wakeup alarm was started |  | ||||||
|     pub(crate) fn start_wakeup_alarm( |  | ||||||
|         &self, |  | ||||||
|         requested_duration: embassy_time::Duration, |  | ||||||
|         cs: critical_section::CriticalSection, |  | ||||||
|     ) { |  | ||||||
|         use embassy_time::{Duration, TICK_HZ}; |  | ||||||
|  |  | ||||||
|         // Panic if the rcc mod knows we're not using low-power rtc |  | ||||||
|         #[cfg(any(rcc_wb, rcc_f4, rcc_f410))] |  | ||||||
|         unsafe { crate::rcc::get_freqs() }.rtc.unwrap(); |  | ||||||
|  |  | ||||||
|         let requested_duration = requested_duration.as_ticks().clamp(0, u32::MAX as u64); |  | ||||||
|         let rtc_hz = Self::frequency().0 as u64; |  | ||||||
|         let rtc_ticks = requested_duration * rtc_hz / TICK_HZ; |  | ||||||
|         let prescaler = WakeupPrescaler::compute_min((rtc_ticks / u16::MAX as u64) as u32); |  | ||||||
|  |  | ||||||
|         // adjust the rtc ticks to the prescaler and subtract one rtc tick |  | ||||||
|         let rtc_ticks = rtc_ticks / prescaler as u64; |  | ||||||
|         let rtc_ticks = rtc_ticks.clamp(0, (u16::MAX - 1) as u64).saturating_sub(1) as u16; |  | ||||||
|  |  | ||||||
|         self.write(false, |regs| { |  | ||||||
|             regs.cr().modify(|w| w.set_wute(false)); |  | ||||||
|             regs.isr().modify(|w| w.set_wutf(false)); |  | ||||||
|             while !regs.isr().read().wutwf() {} |  | ||||||
|  |  | ||||||
|             regs.cr().modify(|w| w.set_wucksel(prescaler.into())); |  | ||||||
|             regs.wutr().write(|w| w.set_wut(rtc_ticks)); |  | ||||||
|             regs.cr().modify(|w| w.set_wute(true)); |  | ||||||
|             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, |  | ||||||
|             instant, |  | ||||||
|         ); |  | ||||||
|  |  | ||||||
|         assert!(self.stop_time.borrow(cs).replace(Some(instant)).is_none()) |  | ||||||
|     } |  | ||||||
|  |  | ||||||
|     #[cfg(feature = "low-power")] |  | ||||||
|     /// stop the wakeup alarm and return the time elapsed since `start_wakeup_alarm` |  | ||||||
|     /// was called, otherwise none |  | ||||||
|     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 {}", instant); |  | ||||||
|  |  | ||||||
|             self.write(false, |regs| { |  | ||||||
|                 regs.cr().modify(|w| w.set_wutie(false)); |  | ||||||
|                 regs.cr().modify(|w| w.set_wute(false)); |  | ||||||
|                 regs.isr().modify(|w| w.set_wutf(false)); |  | ||||||
|  |  | ||||||
|                 crate::pac::EXTI |  | ||||||
|                     .pr(0) |  | ||||||
|                     .modify(|w| w.set_line(RTC::EXTI_WAKEUP_LINE, true)); |  | ||||||
|  |  | ||||||
|                 <RTC as crate::rtc::sealed::Instance>::WakeupInterrupt::unpend(); |  | ||||||
|             }); |  | ||||||
|         } |  | ||||||
|  |  | ||||||
|         self.stop_time.borrow(cs).take().map(|stop_time| instant - stop_time) |  | ||||||
|     } |  | ||||||
|  |  | ||||||
|     #[cfg(feature = "low-power")] |  | ||||||
|     pub(crate) fn enable_wakeup_line(&self) { |  | ||||||
|         use crate::interrupt::typelevel::Interrupt; |  | ||||||
|         use crate::pac::EXTI; |  | ||||||
|  |  | ||||||
|         <RTC as crate::rtc::sealed::Instance>::WakeupInterrupt::unpend(); |  | ||||||
|         unsafe { <RTC as crate::rtc::sealed::Instance>::WakeupInterrupt::enable() }; |  | ||||||
|  |  | ||||||
|         EXTI.rtsr(0).modify(|w| w.set_line(RTC::EXTI_WAKEUP_LINE, true)); |  | ||||||
|         EXTI.imr(0).modify(|w| w.set_line(RTC::EXTI_WAKEUP_LINE, true)); |  | ||||||
|     } |  | ||||||
|  |  | ||||||
|     /// Applies the RTC config |     /// Applies the RTC config | ||||||
|     /// It this changes the RTC clock source the time will be reset |     /// It this changes the RTC clock source the time will be reset | ||||||
|     pub(super) fn configure(&mut self, async_psc: u8, sync_psc: u16) { |     pub(super) fn configure(&mut self, async_psc: u8, sync_psc: u16) { | ||||||
|   | |||||||
| @@ -95,7 +95,7 @@ impl super::Rtc { | |||||||
|         }) |         }) | ||||||
|     } |     } | ||||||
|  |  | ||||||
|     pub(super) fn write<F, R>(&mut self, init_mode: bool, f: F) -> R |     pub(super) fn write<F, R>(&self, init_mode: bool, f: F) -> R | ||||||
|     where |     where | ||||||
|         F: FnOnce(&crate::pac::rtc::Rtc) -> R, |         F: FnOnce(&crate::pac::rtc::Rtc) -> R, | ||||||
|     { |     { | ||||||
| @@ -129,6 +129,12 @@ impl super::Rtc { | |||||||
| impl sealed::Instance for crate::peripherals::RTC { | impl sealed::Instance for crate::peripherals::RTC { | ||||||
|     const BACKUP_REGISTER_COUNT: usize = 32; |     const BACKUP_REGISTER_COUNT: usize = 32; | ||||||
|  |  | ||||||
|  |     #[cfg(all(feature = "low-power", stm32g4))] | ||||||
|  |     const EXTI_WAKEUP_LINE: usize = 20; | ||||||
|  |  | ||||||
|  |     #[cfg(all(feature = "low-power", stm32g4))] | ||||||
|  |     type WakeupInterrupt = crate::interrupt::typelevel::RTC_WKUP; | ||||||
|  |  | ||||||
|     fn read_backup_register(_rtc: &Rtc, register: usize) -> Option<u32> { |     fn read_backup_register(_rtc: &Rtc, register: usize) -> Option<u32> { | ||||||
|         #[allow(clippy::if_same_then_else)] |         #[allow(clippy::if_same_then_else)] | ||||||
|         if register < Self::BACKUP_REGISTER_COUNT { |         if register < Self::BACKUP_REGISTER_COUNT { | ||||||
|   | |||||||
| @@ -207,27 +207,40 @@ impl Protocol { | |||||||
| } | } | ||||||
|  |  | ||||||
| #[derive(Copy, Clone, PartialEq)] | #[derive(Copy, Clone, PartialEq)] | ||||||
| pub enum SyncEnable { | pub enum SyncInput { | ||||||
|     Asynchronous, |     /// Not synced to any other SAI unit. | ||||||
|  |     None, | ||||||
|     /// Syncs with the other A/B sub-block within the SAI unit |     /// Syncs with the other A/B sub-block within the SAI unit | ||||||
|     Internal, |     Internal, | ||||||
|     /// Syncs with a sub-block in the other SAI unit - use set_sync_output() and set_sync_input() |     /// Syncs with a sub-block in the other SAI unit | ||||||
|     #[cfg(any(sai_v4))] |     #[cfg(sai_v4)] | ||||||
|     External, |     External(SyncInputInstance), | ||||||
| } | } | ||||||
|  |  | ||||||
| impl SyncEnable { | impl SyncInput { | ||||||
|     #[cfg(any(sai_v1, sai_v2, sai_v3, sai_v4))] |  | ||||||
|     pub const fn syncen(&self) -> vals::Syncen { |     pub const fn syncen(&self) -> vals::Syncen { | ||||||
|         match self { |         match self { | ||||||
|             SyncEnable::Asynchronous => vals::Syncen::ASYNCHRONOUS, |             SyncInput::None => vals::Syncen::ASYNCHRONOUS, | ||||||
|             SyncEnable::Internal => vals::Syncen::INTERNAL, |             SyncInput::Internal => vals::Syncen::INTERNAL, | ||||||
|             #[cfg(any(sai_v4))] |             #[cfg(any(sai_v4))] | ||||||
|             SyncEnable::External => vals::Syncen::EXTERNAL, |             SyncInput::External(_) => vals::Syncen::EXTERNAL, | ||||||
|         } |         } | ||||||
|     } |     } | ||||||
| } | } | ||||||
|  |  | ||||||
|  | #[cfg(sai_v4)] | ||||||
|  | #[derive(Copy, Clone, PartialEq)] | ||||||
|  | pub enum SyncInputInstance { | ||||||
|  |     #[cfg(peri_sai1)] | ||||||
|  |     Sai1 = 0, | ||||||
|  |     #[cfg(peri_sai2)] | ||||||
|  |     Sai2 = 1, | ||||||
|  |     #[cfg(peri_sai3)] | ||||||
|  |     Sai3 = 2, | ||||||
|  |     #[cfg(peri_sai4)] | ||||||
|  |     Sai4 = 3, | ||||||
|  | } | ||||||
|  |  | ||||||
| #[derive(Copy, Clone, PartialEq)] | #[derive(Copy, Clone, PartialEq)] | ||||||
| pub enum StereoMono { | pub enum StereoMono { | ||||||
|     Stereo, |     Stereo, | ||||||
| @@ -428,8 +441,8 @@ impl MasterClockDivider { | |||||||
| pub struct Config { | pub struct Config { | ||||||
|     pub mode: Mode, |     pub mode: Mode, | ||||||
|     pub tx_rx: TxRx, |     pub tx_rx: TxRx, | ||||||
|     pub sync_enable: SyncEnable, |     pub sync_input: SyncInput, | ||||||
|     pub is_sync_output: bool, |     pub sync_output: bool, | ||||||
|     pub protocol: Protocol, |     pub protocol: Protocol, | ||||||
|     pub slot_size: SlotSize, |     pub slot_size: SlotSize, | ||||||
|     pub slot_count: word::U4, |     pub slot_count: word::U4, | ||||||
| @@ -459,8 +472,8 @@ impl Default for Config { | |||||||
|         Self { |         Self { | ||||||
|             mode: Mode::Master, |             mode: Mode::Master, | ||||||
|             tx_rx: TxRx::Transmitter, |             tx_rx: TxRx::Transmitter, | ||||||
|             is_sync_output: false, |             sync_output: false, | ||||||
|             sync_enable: SyncEnable::Asynchronous, |             sync_input: SyncInput::None, | ||||||
|             protocol: Protocol::Free, |             protocol: Protocol::Free, | ||||||
|             slot_size: SlotSize::DataSize, |             slot_size: SlotSize::DataSize, | ||||||
|             slot_count: word::U4(2), |             slot_count: word::U4(2), | ||||||
| @@ -608,18 +621,18 @@ impl<'d, T: Instance> Sai<'d, T> { | |||||||
|  |  | ||||||
| fn update_synchronous_config(config: &mut Config) { | fn update_synchronous_config(config: &mut Config) { | ||||||
|     config.mode = Mode::Slave; |     config.mode = Mode::Slave; | ||||||
|     config.is_sync_output = false; |     config.sync_output = false; | ||||||
|  |  | ||||||
|     #[cfg(any(sai_v1, sai_v2, sai_v3))] |     #[cfg(any(sai_v1, sai_v2, sai_v3))] | ||||||
|     { |     { | ||||||
|         config.sync_enable = SyncEnable::Internal; |         config.sync_input = SyncInput::Internal; | ||||||
|     } |     } | ||||||
|  |  | ||||||
|     #[cfg(any(sai_v4))] |     #[cfg(any(sai_v4))] | ||||||
|     { |     { | ||||||
|         //this must either be Internal or External |         //this must either be Internal or External | ||||||
|         //The asynchronous sub-block on the same SAI needs to enable is_sync_output |         //The asynchronous sub-block on the same SAI needs to enable sync_output | ||||||
|         assert!(config.sync_enable != SyncEnable::Asynchronous); |         assert!(config.sync_input != SyncInput::None); | ||||||
|     } |     } | ||||||
| } | } | ||||||
|  |  | ||||||
| @@ -866,20 +879,13 @@ impl<'d, T: Instance, C: Channel, W: word::Word> SubBlock<'d, T, C, W> { | |||||||
|  |  | ||||||
|         #[cfg(any(sai_v4))] |         #[cfg(any(sai_v4))] | ||||||
|         { |         { | ||||||
|             // Not totally clear from the datasheet if this is right |             if let SyncInput::External(i) = config.sync_input { | ||||||
|             // This is only used if using SyncEnable::External on the other SAI unit |  | ||||||
|             // Syncing from SAIX subblock A to subblock B does not require this |  | ||||||
|             // Only syncing from SAI1 subblock A/B to SAI2 subblock A/B |  | ||||||
|             let value: u8 = if T::REGS.as_ptr() == stm32_metapac::SAI1.as_ptr() { |  | ||||||
|                 1 //this is SAI1, so sync with SAI2 |  | ||||||
|             } else { |  | ||||||
|                 0 //this is SAI2, so sync with SAI1 |  | ||||||
|             }; |  | ||||||
|                 T::REGS.gcr().modify(|w| { |                 T::REGS.gcr().modify(|w| { | ||||||
|                 w.set_syncin(value); |                     w.set_syncin(i as u8); | ||||||
|                 }); |                 }); | ||||||
|  |             } | ||||||
|  |  | ||||||
|             if config.is_sync_output { |             if config.sync_output { | ||||||
|                 let syncout: u8 = match sub_block { |                 let syncout: u8 = match sub_block { | ||||||
|                     WhichSubBlock::A => 0b01, |                     WhichSubBlock::A => 0b01, | ||||||
|                     WhichSubBlock::B => 0b10, |                     WhichSubBlock::B => 0b10, | ||||||
| @@ -903,7 +909,7 @@ impl<'d, T: Instance, C: Channel, W: word::Word> SubBlock<'d, T, C, W> { | |||||||
|                 w.set_ds(config.data_size.ds()); |                 w.set_ds(config.data_size.ds()); | ||||||
|                 w.set_lsbfirst(config.bit_order.lsbfirst()); |                 w.set_lsbfirst(config.bit_order.lsbfirst()); | ||||||
|                 w.set_ckstr(config.clock_strobe.ckstr()); |                 w.set_ckstr(config.clock_strobe.ckstr()); | ||||||
|                 w.set_syncen(config.sync_enable.syncen()); |                 w.set_syncen(config.sync_input.syncen()); | ||||||
|                 w.set_mono(config.stereo_mono.mono()); |                 w.set_mono(config.stereo_mono.mono()); | ||||||
|                 w.set_outdriv(config.output_drive.outdriv()); |                 w.set_outdriv(config.output_drive.outdriv()); | ||||||
|                 w.set_mckdiv(config.master_clock_divider.mckdiv()); |                 w.set_mckdiv(config.master_clock_divider.mckdiv()); | ||||||
|   | |||||||
| @@ -33,7 +33,7 @@ log = { version = "0.4.14", optional = true } | |||||||
|  |  | ||||||
| futures-util = { version = "0.3.17", default-features = false } | futures-util = { version = "0.3.17", default-features = false } | ||||||
| critical-section = "1.1" | critical-section = "1.1" | ||||||
| heapless = "0.7.5" | heapless = "0.8" | ||||||
| cfg-if = "1.0.0" | cfg-if = "1.0.0" | ||||||
| embedded-io-async = { version = "0.6.0", optional = true } | embedded-io-async = { version = "0.6.0", optional = true } | ||||||
|  |  | ||||||
|   | |||||||
| @@ -5,6 +5,7 @@ An [Embassy](https://embassy.dev) project. | |||||||
| Synchronization primitives and data structures with async support: | Synchronization primitives and data structures with async support: | ||||||
|  |  | ||||||
| - [`Channel`](channel::Channel) - A Multiple Producer Multiple Consumer (MPMC) channel. Each message is only received by a single consumer. | - [`Channel`](channel::Channel) - A Multiple Producer Multiple Consumer (MPMC) channel. Each message is only received by a single consumer. | ||||||
|  | - [`PriorityChannel`](channel::priority::PriorityChannel) - A Multiple Producer Multiple Consumer (MPMC) channel. Each message is only received by a single consumer. Higher priority items are sifted to the front of the channel. | ||||||
| - [`PubSubChannel`](pubsub::PubSubChannel) - A broadcast channel (publish-subscribe) channel. Each message is received by all consumers. | - [`PubSubChannel`](pubsub::PubSubChannel) - A broadcast channel (publish-subscribe) channel. Each message is received by all consumers. | ||||||
| - [`Signal`](signal::Signal) - Signalling latest value to a single consumer. | - [`Signal`](signal::Signal) - Signalling latest value to a single consumer. | ||||||
| - [`Mutex`](mutex::Mutex) - Mutex for synchronizing state between asynchronous tasks. | - [`Mutex`](mutex::Mutex) - Mutex for synchronizing state between asynchronous tasks. | ||||||
|   | |||||||
| @@ -76,7 +76,7 @@ where | |||||||
|  |  | ||||||
| /// Send-only access to a [`Channel`] without knowing channel size. | /// Send-only access to a [`Channel`] without knowing channel size. | ||||||
| pub struct DynamicSender<'ch, T> { | pub struct DynamicSender<'ch, T> { | ||||||
|     channel: &'ch dyn DynamicChannel<T>, |     pub(crate) channel: &'ch dyn DynamicChannel<T>, | ||||||
| } | } | ||||||
|  |  | ||||||
| impl<'ch, T> Clone for DynamicSender<'ch, T> { | impl<'ch, T> Clone for DynamicSender<'ch, T> { | ||||||
| @@ -176,7 +176,7 @@ where | |||||||
|  |  | ||||||
| /// Receive-only access to a [`Channel`] without knowing channel size. | /// Receive-only access to a [`Channel`] without knowing channel size. | ||||||
| pub struct DynamicReceiver<'ch, T> { | pub struct DynamicReceiver<'ch, T> { | ||||||
|     channel: &'ch dyn DynamicChannel<T>, |     pub(crate) channel: &'ch dyn DynamicChannel<T>, | ||||||
| } | } | ||||||
|  |  | ||||||
| impl<'ch, T> Clone for DynamicReceiver<'ch, T> { | impl<'ch, T> Clone for DynamicReceiver<'ch, T> { | ||||||
| @@ -321,7 +321,7 @@ impl<'ch, T> Future for DynamicSendFuture<'ch, T> { | |||||||
|  |  | ||||||
| impl<'ch, T> Unpin for DynamicSendFuture<'ch, T> {} | impl<'ch, T> Unpin for DynamicSendFuture<'ch, T> {} | ||||||
|  |  | ||||||
| trait DynamicChannel<T> { | pub(crate) trait DynamicChannel<T> { | ||||||
|     fn try_send_with_context(&self, message: T, cx: Option<&mut Context<'_>>) -> Result<(), TrySendError<T>>; |     fn try_send_with_context(&self, message: T, cx: Option<&mut Context<'_>>) -> Result<(), TrySendError<T>>; | ||||||
|  |  | ||||||
|     fn try_receive_with_context(&self, cx: Option<&mut Context<'_>>) -> Result<T, TryReceiveError>; |     fn try_receive_with_context(&self, cx: Option<&mut Context<'_>>) -> Result<T, TryReceiveError>; | ||||||
|   | |||||||
| @@ -15,6 +15,7 @@ pub mod blocking_mutex; | |||||||
| pub mod channel; | pub mod channel; | ||||||
| pub mod mutex; | pub mod mutex; | ||||||
| pub mod pipe; | pub mod pipe; | ||||||
|  | pub mod priority_channel; | ||||||
| pub mod pubsub; | pub mod pubsub; | ||||||
| pub mod signal; | pub mod signal; | ||||||
| pub mod waitqueue; | pub mod waitqueue; | ||||||
|   | |||||||
							
								
								
									
										613
									
								
								embassy-sync/src/priority_channel.rs
									
									
									
									
									
										Normal file
									
								
							
							
						
						
									
										613
									
								
								embassy-sync/src/priority_channel.rs
									
									
									
									
									
										Normal file
									
								
							| @@ -0,0 +1,613 @@ | |||||||
|  | //! A queue for sending values between asynchronous tasks. | ||||||
|  | //! | ||||||
|  | //! Similar to a [`Channel`](crate::channel::Channel), however [`PriorityChannel`] sifts higher priority items to the front of the queue. | ||||||
|  | //! Priority is determined by the `Ord` trait. Priority behavior is determined by the [`Kind`](heapless::binary_heap::Kind) parameter of the channel. | ||||||
|  |  | ||||||
|  | use core::cell::RefCell; | ||||||
|  | use core::future::Future; | ||||||
|  | use core::pin::Pin; | ||||||
|  | use core::task::{Context, Poll}; | ||||||
|  |  | ||||||
|  | pub use heapless::binary_heap::{Kind, Max, Min}; | ||||||
|  | use heapless::BinaryHeap; | ||||||
|  |  | ||||||
|  | use crate::blocking_mutex::raw::RawMutex; | ||||||
|  | use crate::blocking_mutex::Mutex; | ||||||
|  | use crate::channel::{DynamicChannel, DynamicReceiver, DynamicSender, TryReceiveError, TrySendError}; | ||||||
|  | use crate::waitqueue::WakerRegistration; | ||||||
|  |  | ||||||
|  | /// Send-only access to a [`PriorityChannel`]. | ||||||
|  | pub struct Sender<'ch, M, T, K, const N: usize> | ||||||
|  | where | ||||||
|  |     T: Ord, | ||||||
|  |     K: Kind, | ||||||
|  |     M: RawMutex, | ||||||
|  | { | ||||||
|  |     channel: &'ch PriorityChannel<M, T, K, N>, | ||||||
|  | } | ||||||
|  |  | ||||||
|  | impl<'ch, M, T, K, const N: usize> Clone for Sender<'ch, M, T, K, N> | ||||||
|  | where | ||||||
|  |     T: Ord, | ||||||
|  |     K: Kind, | ||||||
|  |     M: RawMutex, | ||||||
|  | { | ||||||
|  |     fn clone(&self) -> Self { | ||||||
|  |         Sender { channel: self.channel } | ||||||
|  |     } | ||||||
|  | } | ||||||
|  |  | ||||||
|  | impl<'ch, M, T, K, const N: usize> Copy for Sender<'ch, M, T, K, N> | ||||||
|  | where | ||||||
|  |     T: Ord, | ||||||
|  |     K: Kind, | ||||||
|  |     M: RawMutex, | ||||||
|  | { | ||||||
|  | } | ||||||
|  |  | ||||||
|  | impl<'ch, M, T, K, const N: usize> Sender<'ch, M, T, K, N> | ||||||
|  | where | ||||||
|  |     T: Ord, | ||||||
|  |     K: Kind, | ||||||
|  |     M: RawMutex, | ||||||
|  | { | ||||||
|  |     /// Sends a value. | ||||||
|  |     /// | ||||||
|  |     /// See [`PriorityChannel::send()`] | ||||||
|  |     pub fn send(&self, message: T) -> SendFuture<'ch, M, T, K, N> { | ||||||
|  |         self.channel.send(message) | ||||||
|  |     } | ||||||
|  |  | ||||||
|  |     /// Attempt to immediately send a message. | ||||||
|  |     /// | ||||||
|  |     /// See [`PriorityChannel::send()`] | ||||||
|  |     pub fn try_send(&self, message: T) -> Result<(), TrySendError<T>> { | ||||||
|  |         self.channel.try_send(message) | ||||||
|  |     } | ||||||
|  |  | ||||||
|  |     /// Allows a poll_fn to poll until the channel is ready to send | ||||||
|  |     /// | ||||||
|  |     /// See [`PriorityChannel::poll_ready_to_send()`] | ||||||
|  |     pub fn poll_ready_to_send(&self, cx: &mut Context<'_>) -> Poll<()> { | ||||||
|  |         self.channel.poll_ready_to_send(cx) | ||||||
|  |     } | ||||||
|  | } | ||||||
|  |  | ||||||
|  | impl<'ch, M, T, K, const N: usize> From<Sender<'ch, M, T, K, N>> for DynamicSender<'ch, T> | ||||||
|  | where | ||||||
|  |     T: Ord, | ||||||
|  |     K: Kind, | ||||||
|  |     M: RawMutex, | ||||||
|  | { | ||||||
|  |     fn from(s: Sender<'ch, M, T, K, N>) -> Self { | ||||||
|  |         Self { channel: s.channel } | ||||||
|  |     } | ||||||
|  | } | ||||||
|  |  | ||||||
|  | /// Receive-only access to a [`PriorityChannel`]. | ||||||
|  | pub struct Receiver<'ch, M, T, K, const N: usize> | ||||||
|  | where | ||||||
|  |     T: Ord, | ||||||
|  |     K: Kind, | ||||||
|  |     M: RawMutex, | ||||||
|  | { | ||||||
|  |     channel: &'ch PriorityChannel<M, T, K, N>, | ||||||
|  | } | ||||||
|  |  | ||||||
|  | impl<'ch, M, T, K, const N: usize> Clone for Receiver<'ch, M, T, K, N> | ||||||
|  | where | ||||||
|  |     T: Ord, | ||||||
|  |     K: Kind, | ||||||
|  |     M: RawMutex, | ||||||
|  | { | ||||||
|  |     fn clone(&self) -> Self { | ||||||
|  |         Receiver { channel: self.channel } | ||||||
|  |     } | ||||||
|  | } | ||||||
|  |  | ||||||
|  | impl<'ch, M, T, K, const N: usize> Copy for Receiver<'ch, M, T, K, N> | ||||||
|  | where | ||||||
|  |     T: Ord, | ||||||
|  |     K: Kind, | ||||||
|  |     M: RawMutex, | ||||||
|  | { | ||||||
|  | } | ||||||
|  |  | ||||||
|  | impl<'ch, M, T, K, const N: usize> Receiver<'ch, M, T, K, N> | ||||||
|  | where | ||||||
|  |     T: Ord, | ||||||
|  |     K: Kind, | ||||||
|  |     M: RawMutex, | ||||||
|  | { | ||||||
|  |     /// Receive the next value. | ||||||
|  |     /// | ||||||
|  |     /// See [`PriorityChannel::receive()`]. | ||||||
|  |     pub fn receive(&self) -> ReceiveFuture<'_, M, T, K, N> { | ||||||
|  |         self.channel.receive() | ||||||
|  |     } | ||||||
|  |  | ||||||
|  |     /// Attempt to immediately receive the next value. | ||||||
|  |     /// | ||||||
|  |     /// See [`PriorityChannel::try_receive()`] | ||||||
|  |     pub fn try_receive(&self) -> Result<T, TryReceiveError> { | ||||||
|  |         self.channel.try_receive() | ||||||
|  |     } | ||||||
|  |  | ||||||
|  |     /// Allows a poll_fn to poll until the channel is ready to receive | ||||||
|  |     /// | ||||||
|  |     /// See [`PriorityChannel::poll_ready_to_receive()`] | ||||||
|  |     pub fn poll_ready_to_receive(&self, cx: &mut Context<'_>) -> Poll<()> { | ||||||
|  |         self.channel.poll_ready_to_receive(cx) | ||||||
|  |     } | ||||||
|  |  | ||||||
|  |     /// Poll the channel for the next item | ||||||
|  |     /// | ||||||
|  |     /// See [`PriorityChannel::poll_receive()`] | ||||||
|  |     pub fn poll_receive(&self, cx: &mut Context<'_>) -> Poll<T> { | ||||||
|  |         self.channel.poll_receive(cx) | ||||||
|  |     } | ||||||
|  | } | ||||||
|  |  | ||||||
|  | impl<'ch, M, T, K, const N: usize> From<Receiver<'ch, M, T, K, N>> for DynamicReceiver<'ch, T> | ||||||
|  | where | ||||||
|  |     T: Ord, | ||||||
|  |     K: Kind, | ||||||
|  |     M: RawMutex, | ||||||
|  | { | ||||||
|  |     fn from(s: Receiver<'ch, M, T, K, N>) -> Self { | ||||||
|  |         Self { channel: s.channel } | ||||||
|  |     } | ||||||
|  | } | ||||||
|  |  | ||||||
|  | /// Future returned by [`PriorityChannel::receive`] and  [`Receiver::receive`]. | ||||||
|  | #[must_use = "futures do nothing unless you `.await` or poll them"] | ||||||
|  | pub struct ReceiveFuture<'ch, M, T, K, const N: usize> | ||||||
|  | where | ||||||
|  |     T: Ord, | ||||||
|  |     K: Kind, | ||||||
|  |     M: RawMutex, | ||||||
|  | { | ||||||
|  |     channel: &'ch PriorityChannel<M, T, K, N>, | ||||||
|  | } | ||||||
|  |  | ||||||
|  | impl<'ch, M, T, K, const N: usize> Future for ReceiveFuture<'ch, M, T, K, N> | ||||||
|  | where | ||||||
|  |     T: Ord, | ||||||
|  |     K: Kind, | ||||||
|  |     M: RawMutex, | ||||||
|  | { | ||||||
|  |     type Output = T; | ||||||
|  |  | ||||||
|  |     fn poll(self: Pin<&mut Self>, cx: &mut Context<'_>) -> Poll<T> { | ||||||
|  |         self.channel.poll_receive(cx) | ||||||
|  |     } | ||||||
|  | } | ||||||
|  |  | ||||||
|  | /// Future returned by [`PriorityChannel::send`] and  [`Sender::send`]. | ||||||
|  | #[must_use = "futures do nothing unless you `.await` or poll them"] | ||||||
|  | pub struct SendFuture<'ch, M, T, K, const N: usize> | ||||||
|  | where | ||||||
|  |     T: Ord, | ||||||
|  |     K: Kind, | ||||||
|  |     M: RawMutex, | ||||||
|  | { | ||||||
|  |     channel: &'ch PriorityChannel<M, T, K, N>, | ||||||
|  |     message: Option<T>, | ||||||
|  | } | ||||||
|  |  | ||||||
|  | impl<'ch, M, T, K, const N: usize> Future for SendFuture<'ch, M, T, K, N> | ||||||
|  | where | ||||||
|  |     T: Ord, | ||||||
|  |     K: Kind, | ||||||
|  |     M: RawMutex, | ||||||
|  | { | ||||||
|  |     type Output = (); | ||||||
|  |  | ||||||
|  |     fn poll(mut self: Pin<&mut Self>, cx: &mut Context<'_>) -> Poll<Self::Output> { | ||||||
|  |         match self.message.take() { | ||||||
|  |             Some(m) => match self.channel.try_send_with_context(m, Some(cx)) { | ||||||
|  |                 Ok(..) => Poll::Ready(()), | ||||||
|  |                 Err(TrySendError::Full(m)) => { | ||||||
|  |                     self.message = Some(m); | ||||||
|  |                     Poll::Pending | ||||||
|  |                 } | ||||||
|  |             }, | ||||||
|  |             None => panic!("Message cannot be None"), | ||||||
|  |         } | ||||||
|  |     } | ||||||
|  | } | ||||||
|  |  | ||||||
|  | impl<'ch, M, T, K, const N: usize> Unpin for SendFuture<'ch, M, T, K, N> | ||||||
|  | where | ||||||
|  |     T: Ord, | ||||||
|  |     K: Kind, | ||||||
|  |     M: RawMutex, | ||||||
|  | { | ||||||
|  | } | ||||||
|  |  | ||||||
|  | struct ChannelState<T, K, const N: usize> { | ||||||
|  |     queue: BinaryHeap<T, K, N>, | ||||||
|  |     receiver_waker: WakerRegistration, | ||||||
|  |     senders_waker: WakerRegistration, | ||||||
|  | } | ||||||
|  |  | ||||||
|  | impl<T, K, const N: usize> ChannelState<T, K, N> | ||||||
|  | where | ||||||
|  |     T: Ord, | ||||||
|  |     K: Kind, | ||||||
|  | { | ||||||
|  |     const fn new() -> Self { | ||||||
|  |         ChannelState { | ||||||
|  |             queue: BinaryHeap::new(), | ||||||
|  |             receiver_waker: WakerRegistration::new(), | ||||||
|  |             senders_waker: WakerRegistration::new(), | ||||||
|  |         } | ||||||
|  |     } | ||||||
|  |  | ||||||
|  |     fn try_receive(&mut self) -> Result<T, TryReceiveError> { | ||||||
|  |         self.try_receive_with_context(None) | ||||||
|  |     } | ||||||
|  |  | ||||||
|  |     fn try_receive_with_context(&mut self, cx: Option<&mut Context<'_>>) -> Result<T, TryReceiveError> { | ||||||
|  |         if self.queue.len() == self.queue.capacity() { | ||||||
|  |             self.senders_waker.wake(); | ||||||
|  |         } | ||||||
|  |  | ||||||
|  |         if let Some(message) = self.queue.pop() { | ||||||
|  |             Ok(message) | ||||||
|  |         } else { | ||||||
|  |             if let Some(cx) = cx { | ||||||
|  |                 self.receiver_waker.register(cx.waker()); | ||||||
|  |             } | ||||||
|  |             Err(TryReceiveError::Empty) | ||||||
|  |         } | ||||||
|  |     } | ||||||
|  |  | ||||||
|  |     fn poll_receive(&mut self, cx: &mut Context<'_>) -> Poll<T> { | ||||||
|  |         if self.queue.len() == self.queue.capacity() { | ||||||
|  |             self.senders_waker.wake(); | ||||||
|  |         } | ||||||
|  |  | ||||||
|  |         if let Some(message) = self.queue.pop() { | ||||||
|  |             Poll::Ready(message) | ||||||
|  |         } else { | ||||||
|  |             self.receiver_waker.register(cx.waker()); | ||||||
|  |             Poll::Pending | ||||||
|  |         } | ||||||
|  |     } | ||||||
|  |  | ||||||
|  |     fn poll_ready_to_receive(&mut self, cx: &mut Context<'_>) -> Poll<()> { | ||||||
|  |         self.receiver_waker.register(cx.waker()); | ||||||
|  |  | ||||||
|  |         if !self.queue.is_empty() { | ||||||
|  |             Poll::Ready(()) | ||||||
|  |         } else { | ||||||
|  |             Poll::Pending | ||||||
|  |         } | ||||||
|  |     } | ||||||
|  |  | ||||||
|  |     fn try_send(&mut self, message: T) -> Result<(), TrySendError<T>> { | ||||||
|  |         self.try_send_with_context(message, None) | ||||||
|  |     } | ||||||
|  |  | ||||||
|  |     fn try_send_with_context(&mut self, message: T, cx: Option<&mut Context<'_>>) -> Result<(), TrySendError<T>> { | ||||||
|  |         match self.queue.push(message) { | ||||||
|  |             Ok(()) => { | ||||||
|  |                 self.receiver_waker.wake(); | ||||||
|  |                 Ok(()) | ||||||
|  |             } | ||||||
|  |             Err(message) => { | ||||||
|  |                 if let Some(cx) = cx { | ||||||
|  |                     self.senders_waker.register(cx.waker()); | ||||||
|  |                 } | ||||||
|  |                 Err(TrySendError::Full(message)) | ||||||
|  |             } | ||||||
|  |         } | ||||||
|  |     } | ||||||
|  |  | ||||||
|  |     fn poll_ready_to_send(&mut self, cx: &mut Context<'_>) -> Poll<()> { | ||||||
|  |         self.senders_waker.register(cx.waker()); | ||||||
|  |  | ||||||
|  |         if !self.queue.len() == self.queue.capacity() { | ||||||
|  |             Poll::Ready(()) | ||||||
|  |         } else { | ||||||
|  |             Poll::Pending | ||||||
|  |         } | ||||||
|  |     } | ||||||
|  | } | ||||||
|  |  | ||||||
|  | /// A bounded channel for communicating between asynchronous tasks | ||||||
|  | /// with backpressure. | ||||||
|  | /// | ||||||
|  | /// The channel will buffer up to the provided number of messages.  Once the | ||||||
|  | /// buffer is full, attempts to `send` new messages will wait until a message is | ||||||
|  | /// received from the channel. | ||||||
|  | /// | ||||||
|  | /// Sent data may be reordered based on their priorty within the channel. | ||||||
|  | /// For example, in a [`Max`](heapless::binary_heap::Max) [`PriorityChannel`] | ||||||
|  | /// containing `u32`'s, data sent in the following order `[1, 2, 3]` will be recieved as `[3, 2, 1]`. | ||||||
|  | pub struct PriorityChannel<M, T, K, const N: usize> | ||||||
|  | where | ||||||
|  |     T: Ord, | ||||||
|  |     K: Kind, | ||||||
|  |     M: RawMutex, | ||||||
|  | { | ||||||
|  |     inner: Mutex<M, RefCell<ChannelState<T, K, N>>>, | ||||||
|  | } | ||||||
|  |  | ||||||
|  | impl<M, T, K, const N: usize> PriorityChannel<M, T, K, N> | ||||||
|  | where | ||||||
|  |     T: Ord, | ||||||
|  |     K: Kind, | ||||||
|  |     M: RawMutex, | ||||||
|  | { | ||||||
|  |     /// Establish a new bounded channel. For example, to create one with a NoopMutex: | ||||||
|  |     /// | ||||||
|  |     /// ``` | ||||||
|  |     /// use embassy_sync::priority_channel::{PriorityChannel, Max}; | ||||||
|  |     /// use embassy_sync::blocking_mutex::raw::NoopRawMutex; | ||||||
|  |     /// | ||||||
|  |     /// // Declare a bounded channel of 3 u32s. | ||||||
|  |     /// let mut channel = PriorityChannel::<NoopRawMutex, u32, Max, 3>::new(); | ||||||
|  |     /// ``` | ||||||
|  |     pub const fn new() -> Self { | ||||||
|  |         Self { | ||||||
|  |             inner: Mutex::new(RefCell::new(ChannelState::new())), | ||||||
|  |         } | ||||||
|  |     } | ||||||
|  |  | ||||||
|  |     fn lock<R>(&self, f: impl FnOnce(&mut ChannelState<T, K, N>) -> R) -> R { | ||||||
|  |         self.inner.lock(|rc| f(&mut *unwrap!(rc.try_borrow_mut()))) | ||||||
|  |     } | ||||||
|  |  | ||||||
|  |     fn try_receive_with_context(&self, cx: Option<&mut Context<'_>>) -> Result<T, TryReceiveError> { | ||||||
|  |         self.lock(|c| c.try_receive_with_context(cx)) | ||||||
|  |     } | ||||||
|  |  | ||||||
|  |     /// Poll the channel for the next message | ||||||
|  |     pub fn poll_receive(&self, cx: &mut Context<'_>) -> Poll<T> { | ||||||
|  |         self.lock(|c| c.poll_receive(cx)) | ||||||
|  |     } | ||||||
|  |  | ||||||
|  |     fn try_send_with_context(&self, m: T, cx: Option<&mut Context<'_>>) -> Result<(), TrySendError<T>> { | ||||||
|  |         self.lock(|c| c.try_send_with_context(m, cx)) | ||||||
|  |     } | ||||||
|  |  | ||||||
|  |     /// Allows a poll_fn to poll until the channel is ready to receive | ||||||
|  |     pub fn poll_ready_to_receive(&self, cx: &mut Context<'_>) -> Poll<()> { | ||||||
|  |         self.lock(|c| c.poll_ready_to_receive(cx)) | ||||||
|  |     } | ||||||
|  |  | ||||||
|  |     /// Allows a poll_fn to poll until the channel is ready to send | ||||||
|  |     pub fn poll_ready_to_send(&self, cx: &mut Context<'_>) -> Poll<()> { | ||||||
|  |         self.lock(|c| c.poll_ready_to_send(cx)) | ||||||
|  |     } | ||||||
|  |  | ||||||
|  |     /// Get a sender for this channel. | ||||||
|  |     pub fn sender(&self) -> Sender<'_, M, T, K, N> { | ||||||
|  |         Sender { channel: self } | ||||||
|  |     } | ||||||
|  |  | ||||||
|  |     /// Get a receiver for this channel. | ||||||
|  |     pub fn receiver(&self) -> Receiver<'_, M, T, K, N> { | ||||||
|  |         Receiver { channel: self } | ||||||
|  |     } | ||||||
|  |  | ||||||
|  |     /// Send a value, waiting until there is capacity. | ||||||
|  |     /// | ||||||
|  |     /// Sending completes when the value has been pushed to the channel's queue. | ||||||
|  |     /// This doesn't mean the value has been received yet. | ||||||
|  |     pub fn send(&self, message: T) -> SendFuture<'_, M, T, K, N> { | ||||||
|  |         SendFuture { | ||||||
|  |             channel: self, | ||||||
|  |             message: Some(message), | ||||||
|  |         } | ||||||
|  |     } | ||||||
|  |  | ||||||
|  |     /// Attempt to immediately send a message. | ||||||
|  |     /// | ||||||
|  |     /// This method differs from [`send`](PriorityChannel::send) by returning immediately if the channel's | ||||||
|  |     /// buffer is full, instead of waiting. | ||||||
|  |     /// | ||||||
|  |     /// # Errors | ||||||
|  |     /// | ||||||
|  |     /// If the channel capacity has been reached, i.e., the channel has `n` | ||||||
|  |     /// buffered values where `n` is the argument passed to [`PriorityChannel`], then an | ||||||
|  |     /// error is returned. | ||||||
|  |     pub fn try_send(&self, message: T) -> Result<(), TrySendError<T>> { | ||||||
|  |         self.lock(|c| c.try_send(message)) | ||||||
|  |     } | ||||||
|  |  | ||||||
|  |     /// Receive the next value. | ||||||
|  |     /// | ||||||
|  |     /// If there are no messages in the channel's buffer, this method will | ||||||
|  |     /// wait until a message is sent. | ||||||
|  |     pub fn receive(&self) -> ReceiveFuture<'_, M, T, K, N> { | ||||||
|  |         ReceiveFuture { channel: self } | ||||||
|  |     } | ||||||
|  |  | ||||||
|  |     /// Attempt to immediately receive a message. | ||||||
|  |     /// | ||||||
|  |     /// This method will either receive a message from the channel immediately or return an error | ||||||
|  |     /// if the channel is empty. | ||||||
|  |     pub fn try_receive(&self) -> Result<T, TryReceiveError> { | ||||||
|  |         self.lock(|c| c.try_receive()) | ||||||
|  |     } | ||||||
|  | } | ||||||
|  |  | ||||||
|  | /// Implements the DynamicChannel to allow creating types that are unaware of the queue size with the | ||||||
|  | /// tradeoff cost of dynamic dispatch. | ||||||
|  | impl<M, T, K, const N: usize> DynamicChannel<T> for PriorityChannel<M, T, K, N> | ||||||
|  | where | ||||||
|  |     T: Ord, | ||||||
|  |     K: Kind, | ||||||
|  |     M: RawMutex, | ||||||
|  | { | ||||||
|  |     fn try_send_with_context(&self, m: T, cx: Option<&mut Context<'_>>) -> Result<(), TrySendError<T>> { | ||||||
|  |         PriorityChannel::try_send_with_context(self, m, cx) | ||||||
|  |     } | ||||||
|  |  | ||||||
|  |     fn try_receive_with_context(&self, cx: Option<&mut Context<'_>>) -> Result<T, TryReceiveError> { | ||||||
|  |         PriorityChannel::try_receive_with_context(self, cx) | ||||||
|  |     } | ||||||
|  |  | ||||||
|  |     fn poll_ready_to_send(&self, cx: &mut Context<'_>) -> Poll<()> { | ||||||
|  |         PriorityChannel::poll_ready_to_send(self, cx) | ||||||
|  |     } | ||||||
|  |  | ||||||
|  |     fn poll_ready_to_receive(&self, cx: &mut Context<'_>) -> Poll<()> { | ||||||
|  |         PriorityChannel::poll_ready_to_receive(self, cx) | ||||||
|  |     } | ||||||
|  |  | ||||||
|  |     fn poll_receive(&self, cx: &mut Context<'_>) -> Poll<T> { | ||||||
|  |         PriorityChannel::poll_receive(self, cx) | ||||||
|  |     } | ||||||
|  | } | ||||||
|  |  | ||||||
|  | #[cfg(test)] | ||||||
|  | mod tests { | ||||||
|  |     use core::time::Duration; | ||||||
|  |  | ||||||
|  |     use futures_executor::ThreadPool; | ||||||
|  |     use futures_timer::Delay; | ||||||
|  |     use futures_util::task::SpawnExt; | ||||||
|  |     use heapless::binary_heap::{Kind, Max}; | ||||||
|  |     use static_cell::StaticCell; | ||||||
|  |  | ||||||
|  |     use super::*; | ||||||
|  |     use crate::blocking_mutex::raw::{CriticalSectionRawMutex, NoopRawMutex}; | ||||||
|  |  | ||||||
|  |     fn capacity<T, K, const N: usize>(c: &ChannelState<T, K, N>) -> usize | ||||||
|  |     where | ||||||
|  |         T: Ord, | ||||||
|  |         K: Kind, | ||||||
|  |     { | ||||||
|  |         c.queue.capacity() - c.queue.len() | ||||||
|  |     } | ||||||
|  |  | ||||||
|  |     #[test] | ||||||
|  |     fn sending_once() { | ||||||
|  |         let mut c = ChannelState::<u32, Max, 3>::new(); | ||||||
|  |         assert!(c.try_send(1).is_ok()); | ||||||
|  |         assert_eq!(capacity(&c), 2); | ||||||
|  |     } | ||||||
|  |  | ||||||
|  |     #[test] | ||||||
|  |     fn sending_when_full() { | ||||||
|  |         let mut c = ChannelState::<u32, Max, 3>::new(); | ||||||
|  |         let _ = c.try_send(1); | ||||||
|  |         let _ = c.try_send(1); | ||||||
|  |         let _ = c.try_send(1); | ||||||
|  |         match c.try_send(2) { | ||||||
|  |             Err(TrySendError::Full(2)) => assert!(true), | ||||||
|  |             _ => assert!(false), | ||||||
|  |         } | ||||||
|  |         assert_eq!(capacity(&c), 0); | ||||||
|  |     } | ||||||
|  |  | ||||||
|  |     #[test] | ||||||
|  |     fn send_priority() { | ||||||
|  |         // Prio channel with kind `Max` sifts larger numbers to the front of the queue | ||||||
|  |         let mut c = ChannelState::<u32, Max, 3>::new(); | ||||||
|  |         assert!(c.try_send(1).is_ok()); | ||||||
|  |         assert!(c.try_send(2).is_ok()); | ||||||
|  |         assert!(c.try_send(3).is_ok()); | ||||||
|  |         assert_eq!(c.try_receive().unwrap(), 3); | ||||||
|  |         assert_eq!(c.try_receive().unwrap(), 2); | ||||||
|  |         assert_eq!(c.try_receive().unwrap(), 1); | ||||||
|  |     } | ||||||
|  |  | ||||||
|  |     #[test] | ||||||
|  |     fn receiving_once_with_one_send() { | ||||||
|  |         let mut c = ChannelState::<u32, Max, 3>::new(); | ||||||
|  |         assert!(c.try_send(1).is_ok()); | ||||||
|  |         assert_eq!(c.try_receive().unwrap(), 1); | ||||||
|  |         assert_eq!(capacity(&c), 3); | ||||||
|  |     } | ||||||
|  |  | ||||||
|  |     #[test] | ||||||
|  |     fn receiving_when_empty() { | ||||||
|  |         let mut c = ChannelState::<u32, Max, 3>::new(); | ||||||
|  |         match c.try_receive() { | ||||||
|  |             Err(TryReceiveError::Empty) => assert!(true), | ||||||
|  |             _ => assert!(false), | ||||||
|  |         } | ||||||
|  |         assert_eq!(capacity(&c), 3); | ||||||
|  |     } | ||||||
|  |  | ||||||
|  |     #[test] | ||||||
|  |     fn simple_send_and_receive() { | ||||||
|  |         let c = PriorityChannel::<NoopRawMutex, u32, Max, 3>::new(); | ||||||
|  |         assert!(c.try_send(1).is_ok()); | ||||||
|  |         assert_eq!(c.try_receive().unwrap(), 1); | ||||||
|  |     } | ||||||
|  |  | ||||||
|  |     #[test] | ||||||
|  |     fn cloning() { | ||||||
|  |         let c = PriorityChannel::<NoopRawMutex, u32, Max, 3>::new(); | ||||||
|  |         let r1 = c.receiver(); | ||||||
|  |         let s1 = c.sender(); | ||||||
|  |  | ||||||
|  |         let _ = r1.clone(); | ||||||
|  |         let _ = s1.clone(); | ||||||
|  |     } | ||||||
|  |  | ||||||
|  |     #[test] | ||||||
|  |     fn dynamic_dispatch() { | ||||||
|  |         let c = PriorityChannel::<NoopRawMutex, u32, Max, 3>::new(); | ||||||
|  |         let s: DynamicSender<'_, u32> = c.sender().into(); | ||||||
|  |         let r: DynamicReceiver<'_, u32> = c.receiver().into(); | ||||||
|  |  | ||||||
|  |         assert!(s.try_send(1).is_ok()); | ||||||
|  |         assert_eq!(r.try_receive().unwrap(), 1); | ||||||
|  |     } | ||||||
|  |  | ||||||
|  |     #[futures_test::test] | ||||||
|  |     async fn receiver_receives_given_try_send_async() { | ||||||
|  |         let executor = ThreadPool::new().unwrap(); | ||||||
|  |  | ||||||
|  |         static CHANNEL: StaticCell<PriorityChannel<CriticalSectionRawMutex, u32, Max, 3>> = StaticCell::new(); | ||||||
|  |         let c = &*CHANNEL.init(PriorityChannel::new()); | ||||||
|  |         let c2 = c; | ||||||
|  |         assert!(executor | ||||||
|  |             .spawn(async move { | ||||||
|  |                 assert!(c2.try_send(1).is_ok()); | ||||||
|  |             }) | ||||||
|  |             .is_ok()); | ||||||
|  |         assert_eq!(c.receive().await, 1); | ||||||
|  |     } | ||||||
|  |  | ||||||
|  |     #[futures_test::test] | ||||||
|  |     async fn sender_send_completes_if_capacity() { | ||||||
|  |         let c = PriorityChannel::<CriticalSectionRawMutex, u32, Max, 1>::new(); | ||||||
|  |         c.send(1).await; | ||||||
|  |         assert_eq!(c.receive().await, 1); | ||||||
|  |     } | ||||||
|  |  | ||||||
|  |     #[futures_test::test] | ||||||
|  |     async fn senders_sends_wait_until_capacity() { | ||||||
|  |         let executor = ThreadPool::new().unwrap(); | ||||||
|  |  | ||||||
|  |         static CHANNEL: StaticCell<PriorityChannel<CriticalSectionRawMutex, u32, Max, 1>> = StaticCell::new(); | ||||||
|  |         let c = &*CHANNEL.init(PriorityChannel::new()); | ||||||
|  |         assert!(c.try_send(1).is_ok()); | ||||||
|  |  | ||||||
|  |         let c2 = c; | ||||||
|  |         let send_task_1 = executor.spawn_with_handle(async move { c2.send(2).await }); | ||||||
|  |         let c2 = c; | ||||||
|  |         let send_task_2 = executor.spawn_with_handle(async move { c2.send(3).await }); | ||||||
|  |         // Wish I could think of a means of determining that the async send is waiting instead. | ||||||
|  |         // However, I've used the debugger to observe that the send does indeed wait. | ||||||
|  |         Delay::new(Duration::from_millis(500)).await; | ||||||
|  |         assert_eq!(c.receive().await, 1); | ||||||
|  |         assert!(executor | ||||||
|  |             .spawn(async move { | ||||||
|  |                 loop { | ||||||
|  |                     c.receive().await; | ||||||
|  |                 } | ||||||
|  |             }) | ||||||
|  |             .is_ok()); | ||||||
|  |         send_task_1.unwrap().await; | ||||||
|  |         send_task_2.unwrap().await; | ||||||
|  |     } | ||||||
|  | } | ||||||
| @@ -248,7 +248,7 @@ embedded-hal-async = { version = "=1.0.0-rc.1", optional = true} | |||||||
| futures-util = { version = "0.3.17", default-features = false } | futures-util = { version = "0.3.17", default-features = false } | ||||||
| critical-section = "1.1" | critical-section = "1.1" | ||||||
| cfg-if = "1.0.0" | cfg-if = "1.0.0" | ||||||
| heapless = "0.7" | heapless = "0.8" | ||||||
|  |  | ||||||
| # WASM dependencies | # WASM dependencies | ||||||
| wasm-bindgen = { version = "0.2.81", optional = true } | wasm-bindgen = { version = "0.2.81", optional = true } | ||||||
| @@ -258,4 +258,4 @@ wasm-timer = { version = "0.2.5", optional = true } | |||||||
| [dev-dependencies] | [dev-dependencies] | ||||||
| serial_test = "0.9" | serial_test = "0.9" | ||||||
| critical-section = { version = "1.1", features = ["std"] } | critical-section = { version = "1.1", features = ["std"] } | ||||||
| embassy-executor = { version = "0.3.1", path = "../embassy-executor", features = ["nightly"] } | embassy-executor = { version = "0.3.3", path = "../embassy-executor", features = ["nightly"] } | ||||||
|   | |||||||
| @@ -19,6 +19,7 @@ pub struct LoggerState<'d> { | |||||||
|     device_descriptor: [u8; 32], |     device_descriptor: [u8; 32], | ||||||
|     config_descriptor: [u8; 128], |     config_descriptor: [u8; 128], | ||||||
|     bos_descriptor: [u8; 16], |     bos_descriptor: [u8; 16], | ||||||
|  |     msos_descriptor: [u8; 256], | ||||||
|     control_buf: [u8; 64], |     control_buf: [u8; 64], | ||||||
| } | } | ||||||
|  |  | ||||||
| @@ -30,6 +31,7 @@ impl<'d> LoggerState<'d> { | |||||||
|             device_descriptor: [0; 32], |             device_descriptor: [0; 32], | ||||||
|             config_descriptor: [0; 128], |             config_descriptor: [0; 128], | ||||||
|             bos_descriptor: [0; 16], |             bos_descriptor: [0; 16], | ||||||
|  |             msos_descriptor: [0; 256], | ||||||
|             control_buf: [0; 64], |             control_buf: [0; 64], | ||||||
|         } |         } | ||||||
|     } |     } | ||||||
| @@ -73,6 +75,7 @@ impl<const N: usize> UsbLogger<N> { | |||||||
|             &mut state.device_descriptor, |             &mut state.device_descriptor, | ||||||
|             &mut state.config_descriptor, |             &mut state.config_descriptor, | ||||||
|             &mut state.bos_descriptor, |             &mut state.bos_descriptor, | ||||||
|  |             &mut state.msos_descriptor, | ||||||
|             &mut state.control_buf, |             &mut state.control_buf, | ||||||
|         ); |         ); | ||||||
|  |  | ||||||
|   | |||||||
| @@ -13,7 +13,6 @@ target = "thumbv7em-none-eabi" | |||||||
| [features] | [features] | ||||||
| defmt = ["dep:defmt", "embassy-usb-driver/defmt"] | defmt = ["dep:defmt", "embassy-usb-driver/defmt"] | ||||||
| usbd-hid = ["dep:usbd-hid", "dep:ssmarshal"] | usbd-hid = ["dep:usbd-hid", "dep:ssmarshal"] | ||||||
| msos-descriptor = [] |  | ||||||
| default = ["usbd-hid"] | default = ["usbd-hid"] | ||||||
|  |  | ||||||
| # BEGIN AUTOGENERATED CONFIG FEATURES | # BEGIN AUTOGENERATED CONFIG FEATURES | ||||||
| @@ -46,7 +45,7 @@ embassy-net-driver-channel = { version = "0.2.0", path = "../embassy-net-driver- | |||||||
|  |  | ||||||
| defmt = { version = "0.3", optional = true } | defmt = { version = "0.3", optional = true } | ||||||
| log = { version = "0.4.14", optional = true } | log = { version = "0.4.14", optional = true } | ||||||
| heapless = "0.7.10" | heapless = "0.8" | ||||||
|  |  | ||||||
| # for HID | # for HID | ||||||
| usbd-hid = { version = "0.6.0", optional = true } | usbd-hid = { version = "0.6.0", optional = true } | ||||||
|   | |||||||
| @@ -3,7 +3,6 @@ use heapless::Vec; | |||||||
| use crate::config::MAX_HANDLER_COUNT; | use crate::config::MAX_HANDLER_COUNT; | ||||||
| use crate::descriptor::{BosWriter, DescriptorWriter}; | use crate::descriptor::{BosWriter, DescriptorWriter}; | ||||||
| use crate::driver::{Driver, Endpoint, EndpointType}; | use crate::driver::{Driver, Endpoint, EndpointType}; | ||||||
| #[cfg(feature = "msos-descriptor")] |  | ||||||
| use crate::msos::{DeviceLevelDescriptor, FunctionLevelDescriptor, MsOsDescriptorWriter}; | use crate::msos::{DeviceLevelDescriptor, FunctionLevelDescriptor, MsOsDescriptorWriter}; | ||||||
| use crate::types::{InterfaceNumber, StringIndex}; | use crate::types::{InterfaceNumber, StringIndex}; | ||||||
| use crate::{Handler, Interface, UsbDevice, MAX_INTERFACE_COUNT, STRING_INDEX_CUSTOM_START}; | use crate::{Handler, Interface, UsbDevice, MAX_INTERFACE_COUNT, STRING_INDEX_CUSTOM_START}; | ||||||
| @@ -133,7 +132,6 @@ pub struct Builder<'d, D: Driver<'d>> { | |||||||
|     config_descriptor: DescriptorWriter<'d>, |     config_descriptor: DescriptorWriter<'d>, | ||||||
|     bos_descriptor: BosWriter<'d>, |     bos_descriptor: BosWriter<'d>, | ||||||
|  |  | ||||||
|     #[cfg(feature = "msos-descriptor")] |  | ||||||
|     msos_descriptor: MsOsDescriptorWriter<'d>, |     msos_descriptor: MsOsDescriptorWriter<'d>, | ||||||
| } | } | ||||||
|  |  | ||||||
| @@ -149,7 +147,7 @@ impl<'d, D: Driver<'d>> Builder<'d, D> { | |||||||
|         device_descriptor_buf: &'d mut [u8], |         device_descriptor_buf: &'d mut [u8], | ||||||
|         config_descriptor_buf: &'d mut [u8], |         config_descriptor_buf: &'d mut [u8], | ||||||
|         bos_descriptor_buf: &'d mut [u8], |         bos_descriptor_buf: &'d mut [u8], | ||||||
|         #[cfg(feature = "msos-descriptor")] msos_descriptor_buf: &'d mut [u8], |         msos_descriptor_buf: &'d mut [u8], | ||||||
|         control_buf: &'d mut [u8], |         control_buf: &'d mut [u8], | ||||||
|     ) -> Self { |     ) -> Self { | ||||||
|         // Magic values specified in USB-IF ECN on IADs. |         // Magic values specified in USB-IF ECN on IADs. | ||||||
| @@ -189,14 +187,12 @@ impl<'d, D: Driver<'d>> Builder<'d, D> { | |||||||
|             config_descriptor, |             config_descriptor, | ||||||
|             bos_descriptor, |             bos_descriptor, | ||||||
|  |  | ||||||
|             #[cfg(feature = "msos-descriptor")] |  | ||||||
|             msos_descriptor: MsOsDescriptorWriter::new(msos_descriptor_buf), |             msos_descriptor: MsOsDescriptorWriter::new(msos_descriptor_buf), | ||||||
|         } |         } | ||||||
|     } |     } | ||||||
|  |  | ||||||
|     /// Creates the [`UsbDevice`] instance with the configuration in this builder. |     /// Creates the [`UsbDevice`] instance with the configuration in this builder. | ||||||
|     pub fn build(mut self) -> UsbDevice<'d, D> { |     pub fn build(mut self) -> UsbDevice<'d, D> { | ||||||
|         #[cfg(feature = "msos-descriptor")] |  | ||||||
|         let msos_descriptor = self.msos_descriptor.build(&mut self.bos_descriptor); |         let msos_descriptor = self.msos_descriptor.build(&mut self.bos_descriptor); | ||||||
|  |  | ||||||
|         self.config_descriptor.end_configuration(); |         self.config_descriptor.end_configuration(); | ||||||
| @@ -206,7 +202,6 @@ impl<'d, D: Driver<'d>> Builder<'d, D> { | |||||||
|         info!("USB: device_descriptor used: {}", self.device_descriptor.position()); |         info!("USB: device_descriptor used: {}", self.device_descriptor.position()); | ||||||
|         info!("USB: config_descriptor used: {}", self.config_descriptor.position()); |         info!("USB: config_descriptor used: {}", self.config_descriptor.position()); | ||||||
|         info!("USB: bos_descriptor used: {}", self.bos_descriptor.writer.position()); |         info!("USB: bos_descriptor used: {}", self.bos_descriptor.writer.position()); | ||||||
|         #[cfg(feature = "msos-descriptor")] |  | ||||||
|         info!("USB: msos_descriptor used: {}", msos_descriptor.len()); |         info!("USB: msos_descriptor used: {}", msos_descriptor.len()); | ||||||
|         info!("USB: control_buf size: {}", self.control_buf.len()); |         info!("USB: control_buf size: {}", self.control_buf.len()); | ||||||
|  |  | ||||||
| @@ -217,10 +212,9 @@ impl<'d, D: Driver<'d>> Builder<'d, D> { | |||||||
|             self.device_descriptor.into_buf(), |             self.device_descriptor.into_buf(), | ||||||
|             self.config_descriptor.into_buf(), |             self.config_descriptor.into_buf(), | ||||||
|             self.bos_descriptor.writer.into_buf(), |             self.bos_descriptor.writer.into_buf(), | ||||||
|  |             msos_descriptor, | ||||||
|             self.interfaces, |             self.interfaces, | ||||||
|             self.control_buf, |             self.control_buf, | ||||||
|             #[cfg(feature = "msos-descriptor")] |  | ||||||
|             msos_descriptor, |  | ||||||
|         ) |         ) | ||||||
|     } |     } | ||||||
|  |  | ||||||
| @@ -251,7 +245,6 @@ impl<'d, D: Driver<'d>> Builder<'d, D> { | |||||||
|             builder: self, |             builder: self, | ||||||
|             iface_count_index, |             iface_count_index, | ||||||
|  |  | ||||||
|             #[cfg(feature = "msos-descriptor")] |  | ||||||
|             first_interface, |             first_interface, | ||||||
|         } |         } | ||||||
|     } |     } | ||||||
| @@ -275,7 +268,6 @@ impl<'d, D: Driver<'d>> Builder<'d, D> { | |||||||
|         StringIndex::new(index) |         StringIndex::new(index) | ||||||
|     } |     } | ||||||
|  |  | ||||||
|     #[cfg(feature = "msos-descriptor")] |  | ||||||
|     /// Add an MS OS 2.0 Descriptor Set. |     /// Add an MS OS 2.0 Descriptor Set. | ||||||
|     /// |     /// | ||||||
|     /// Panics if called more than once. |     /// Panics if called more than once. | ||||||
| @@ -283,13 +275,11 @@ impl<'d, D: Driver<'d>> Builder<'d, D> { | |||||||
|         self.msos_descriptor.header(windows_version, vendor_code); |         self.msos_descriptor.header(windows_version, vendor_code); | ||||||
|     } |     } | ||||||
|  |  | ||||||
|     #[cfg(feature = "msos-descriptor")] |  | ||||||
|     /// Add an MS OS 2.0 Device Level Feature Descriptor. |     /// Add an MS OS 2.0 Device Level Feature Descriptor. | ||||||
|     pub fn msos_feature<T: DeviceLevelDescriptor>(&mut self, desc: T) { |     pub fn msos_feature<T: DeviceLevelDescriptor>(&mut self, desc: T) { | ||||||
|         self.msos_descriptor.device_feature(desc); |         self.msos_descriptor.device_feature(desc); | ||||||
|     } |     } | ||||||
|  |  | ||||||
|     #[cfg(feature = "msos-descriptor")] |  | ||||||
|     /// Gets the underlying [`MsOsDescriptorWriter`] to allow adding subsets and features for classes that |     /// Gets the underlying [`MsOsDescriptorWriter`] to allow adding subsets and features for classes that | ||||||
|     /// do not add their own. |     /// do not add their own. | ||||||
|     pub fn msos_writer(&mut self) -> &mut MsOsDescriptorWriter<'d> { |     pub fn msos_writer(&mut self) -> &mut MsOsDescriptorWriter<'d> { | ||||||
| @@ -306,13 +296,11 @@ pub struct FunctionBuilder<'a, 'd, D: Driver<'d>> { | |||||||
|     builder: &'a mut Builder<'d, D>, |     builder: &'a mut Builder<'d, D>, | ||||||
|     iface_count_index: Option<usize>, |     iface_count_index: Option<usize>, | ||||||
|  |  | ||||||
|     #[cfg(feature = "msos-descriptor")] |  | ||||||
|     first_interface: InterfaceNumber, |     first_interface: InterfaceNumber, | ||||||
| } | } | ||||||
|  |  | ||||||
| impl<'a, 'd, D: Driver<'d>> Drop for FunctionBuilder<'a, 'd, D> { | impl<'a, 'd, D: Driver<'d>> Drop for FunctionBuilder<'a, 'd, D> { | ||||||
|     fn drop(&mut self) { |     fn drop(&mut self) { | ||||||
|         #[cfg(feature = "msos-descriptor")] |  | ||||||
|         self.builder.msos_descriptor.end_function(); |         self.builder.msos_descriptor.end_function(); | ||||||
|     } |     } | ||||||
| } | } | ||||||
| @@ -344,7 +332,6 @@ impl<'a, 'd, D: Driver<'d>> FunctionBuilder<'a, 'd, D> { | |||||||
|         } |         } | ||||||
|     } |     } | ||||||
|  |  | ||||||
|     #[cfg(feature = "msos-descriptor")] |  | ||||||
|     /// Add an MS OS 2.0 Function Level Feature Descriptor. |     /// Add an MS OS 2.0 Function Level Feature Descriptor. | ||||||
|     pub fn msos_feature<T: FunctionLevelDescriptor>(&mut self, desc: T) { |     pub fn msos_feature<T: FunctionLevelDescriptor>(&mut self, desc: T) { | ||||||
|         if !self.builder.msos_descriptor.is_in_config_subset() { |         if !self.builder.msos_descriptor.is_in_config_subset() { | ||||||
| @@ -355,7 +342,6 @@ impl<'a, 'd, D: Driver<'d>> FunctionBuilder<'a, 'd, D> { | |||||||
|             self.builder.msos_descriptor.function(self.first_interface); |             self.builder.msos_descriptor.function(self.first_interface); | ||||||
|         } |         } | ||||||
|  |  | ||||||
|         #[cfg(feature = "msos-descriptor")] |  | ||||||
|         self.builder.msos_descriptor.function_feature(desc); |         self.builder.msos_descriptor.function_feature(desc); | ||||||
|     } |     } | ||||||
| } | } | ||||||
|   | |||||||
| @@ -175,10 +175,7 @@ pub struct UsbBufferReport { | |||||||
|     /// Number of bos descriptor bytes used |     /// Number of bos descriptor bytes used | ||||||
|     pub bos_descriptor_used: usize, |     pub bos_descriptor_used: usize, | ||||||
|     /// Number of msos descriptor bytes used |     /// Number of msos descriptor bytes used | ||||||
|     /// |     pub msos_descriptor_used: usize, | ||||||
|     /// Will be `None` if the "msos-descriptor" feature is not active. |  | ||||||
|     /// Otherwise will return Some(bytes). |  | ||||||
|     pub msos_descriptor_used: Option<usize>, |  | ||||||
|     /// Size of the control buffer |     /// Size of the control buffer | ||||||
|     pub control_buffer_size: usize, |     pub control_buffer_size: usize, | ||||||
| } | } | ||||||
| @@ -197,6 +194,7 @@ struct Inner<'d, D: Driver<'d>> { | |||||||
|     device_descriptor: &'d [u8], |     device_descriptor: &'d [u8], | ||||||
|     config_descriptor: &'d [u8], |     config_descriptor: &'d [u8], | ||||||
|     bos_descriptor: &'d [u8], |     bos_descriptor: &'d [u8], | ||||||
|  |     msos_descriptor: crate::msos::MsOsDescriptorSet<'d>, | ||||||
|  |  | ||||||
|     device_state: UsbDeviceState, |     device_state: UsbDeviceState, | ||||||
|     suspended: bool, |     suspended: bool, | ||||||
| @@ -212,9 +210,6 @@ struct Inner<'d, D: Driver<'d>> { | |||||||
|  |  | ||||||
|     interfaces: Vec<Interface, MAX_INTERFACE_COUNT>, |     interfaces: Vec<Interface, MAX_INTERFACE_COUNT>, | ||||||
|     handlers: Vec<&'d mut dyn Handler, MAX_HANDLER_COUNT>, |     handlers: Vec<&'d mut dyn Handler, MAX_HANDLER_COUNT>, | ||||||
|  |  | ||||||
|     #[cfg(feature = "msos-descriptor")] |  | ||||||
|     msos_descriptor: crate::msos::MsOsDescriptorSet<'d>, |  | ||||||
| } | } | ||||||
|  |  | ||||||
| impl<'d, D: Driver<'d>> UsbDevice<'d, D> { | impl<'d, D: Driver<'d>> UsbDevice<'d, D> { | ||||||
| @@ -225,9 +220,9 @@ impl<'d, D: Driver<'d>> UsbDevice<'d, D> { | |||||||
|         device_descriptor: &'d [u8], |         device_descriptor: &'d [u8], | ||||||
|         config_descriptor: &'d [u8], |         config_descriptor: &'d [u8], | ||||||
|         bos_descriptor: &'d [u8], |         bos_descriptor: &'d [u8], | ||||||
|  |         msos_descriptor: crate::msos::MsOsDescriptorSet<'d>, | ||||||
|         interfaces: Vec<Interface, MAX_INTERFACE_COUNT>, |         interfaces: Vec<Interface, MAX_INTERFACE_COUNT>, | ||||||
|         control_buf: &'d mut [u8], |         control_buf: &'d mut [u8], | ||||||
|         #[cfg(feature = "msos-descriptor")] msos_descriptor: crate::msos::MsOsDescriptorSet<'d>, |  | ||||||
|     ) -> UsbDevice<'d, D> { |     ) -> UsbDevice<'d, D> { | ||||||
|         // Start the USB bus. |         // Start the USB bus. | ||||||
|         // This prevent further allocation by consuming the driver. |         // This prevent further allocation by consuming the driver. | ||||||
| @@ -242,6 +237,7 @@ impl<'d, D: Driver<'d>> UsbDevice<'d, D> { | |||||||
|                 device_descriptor, |                 device_descriptor, | ||||||
|                 config_descriptor, |                 config_descriptor, | ||||||
|                 bos_descriptor, |                 bos_descriptor, | ||||||
|  |                 msos_descriptor, | ||||||
|  |  | ||||||
|                 device_state: UsbDeviceState::Unpowered, |                 device_state: UsbDeviceState::Unpowered, | ||||||
|                 suspended: false, |                 suspended: false, | ||||||
| @@ -251,8 +247,6 @@ impl<'d, D: Driver<'d>> UsbDevice<'d, D> { | |||||||
|                 set_address_pending: false, |                 set_address_pending: false, | ||||||
|                 interfaces, |                 interfaces, | ||||||
|                 handlers, |                 handlers, | ||||||
|                 #[cfg(feature = "msos-descriptor")] |  | ||||||
|                 msos_descriptor, |  | ||||||
|             }, |             }, | ||||||
|         } |         } | ||||||
|     } |     } | ||||||
| @@ -261,16 +255,11 @@ impl<'d, D: Driver<'d>> UsbDevice<'d, D> { | |||||||
|     /// |     /// | ||||||
|     /// Useful for tuning buffer sizes for actual usage |     /// Useful for tuning buffer sizes for actual usage | ||||||
|     pub fn buffer_usage(&self) -> UsbBufferReport { |     pub fn buffer_usage(&self) -> UsbBufferReport { | ||||||
|         #[cfg(not(feature = "msos-descriptor"))] |  | ||||||
|         let mdu = None; |  | ||||||
|         #[cfg(feature = "msos-descriptor")] |  | ||||||
|         let mdu = Some(self.inner.msos_descriptor.len()); |  | ||||||
|  |  | ||||||
|         UsbBufferReport { |         UsbBufferReport { | ||||||
|             device_descriptor_used: self.inner.device_descriptor.len(), |             device_descriptor_used: self.inner.device_descriptor.len(), | ||||||
|             config_descriptor_used: self.inner.config_descriptor.len(), |             config_descriptor_used: self.inner.config_descriptor.len(), | ||||||
|             bos_descriptor_used: self.inner.bos_descriptor.len(), |             bos_descriptor_used: self.inner.bos_descriptor.len(), | ||||||
|             msos_descriptor_used: mdu, |             msos_descriptor_used: self.inner.msos_descriptor.len(), | ||||||
|             control_buffer_size: self.control_buf.len(), |             control_buffer_size: self.control_buf.len(), | ||||||
|         } |         } | ||||||
|     } |     } | ||||||
| @@ -684,7 +673,7 @@ impl<'d, D: Driver<'d>> Inner<'d, D> { | |||||||
|                 } |                 } | ||||||
|                 _ => InResponse::Rejected, |                 _ => InResponse::Rejected, | ||||||
|             }, |             }, | ||||||
|             #[cfg(feature = "msos-descriptor")] |  | ||||||
|             (RequestType::Vendor, Recipient::Device) => { |             (RequestType::Vendor, Recipient::Device) => { | ||||||
|                 if !self.msos_descriptor.is_empty() |                 if !self.msos_descriptor.is_empty() | ||||||
|                     && req.request == self.msos_descriptor.vendor_code() |                     && req.request == self.msos_descriptor.vendor_code() | ||||||
|   | |||||||
| @@ -1,5 +1,3 @@ | |||||||
| #![cfg(feature = "msos-descriptor")] |  | ||||||
|  |  | ||||||
| //! Microsoft OS Descriptors | //! Microsoft OS Descriptors | ||||||
| //! | //! | ||||||
| //! <https://docs.microsoft.com/en-us/windows-hardware/drivers/usbcon/microsoft-os-2-0-descriptors-specification> | //! <https://docs.microsoft.com/en-us/windows-hardware/drivers/usbcon/microsoft-os-2-0-descriptors-specification> | ||||||
|   | |||||||
| @@ -6,7 +6,7 @@ license = "MIT OR Apache-2.0" | |||||||
|  |  | ||||||
| [dependencies] | [dependencies] | ||||||
| embassy-sync = { version = "0.4.0", path = "../../../../embassy-sync" } | 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-executor = { version = "0.3.3", 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-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-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"] } | embassy-boot = { version = "0.1.0", path = "../../../../embassy-boot/boot", features = ["nightly"] } | ||||||
|   | |||||||
| @@ -6,7 +6,7 @@ license = "MIT OR Apache-2.0" | |||||||
|  |  | ||||||
| [dependencies] | [dependencies] | ||||||
| embassy-sync = { version = "0.4.0", path = "../../../../embassy-sync" } | 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-executor = { version = "0.3.3", 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-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-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"] } | embassy-boot-rp = { version = "0.1.0", path = "../../../../embassy-boot/rp", features = ["nightly"] } | ||||||
|   | |||||||
| @@ -5,7 +5,19 @@ MEMORY | |||||||
|   BOOTLOADER_STATE                  : ORIGIN = 0x10006000, LENGTH = 4K |   BOOTLOADER_STATE                  : ORIGIN = 0x10006000, LENGTH = 4K | ||||||
|   FLASH                             : ORIGIN = 0x10007000, LENGTH = 512K |   FLASH                             : ORIGIN = 0x10007000, LENGTH = 512K | ||||||
|   DFU                               : ORIGIN = 0x10087000, LENGTH = 516K |   DFU                               : ORIGIN = 0x10087000, LENGTH = 516K | ||||||
|   RAM                               : ORIGIN = 0x20000000, LENGTH = 256K |  | ||||||
|  |   /* Pick one of the two options for RAM layout     */ | ||||||
|  |  | ||||||
|  |   /* OPTION A: Use all RAM banks as one big block   */ | ||||||
|  |   /* Reasonable, unless you are doing something     */ | ||||||
|  |   /* really particular with DMA or other concurrent */ | ||||||
|  |   /* access that would benefit from striping        */ | ||||||
|  |   RAM   : ORIGIN = 0x20000000, LENGTH = 264K | ||||||
|  |  | ||||||
|  |   /* OPTION B: Keep the unstriped sections separate */ | ||||||
|  |   /* RAM: ORIGIN = 0x20000000, LENGTH = 256K        */ | ||||||
|  |   /* SCRATCH_A: ORIGIN = 0x20040000, LENGTH = 4K    */ | ||||||
|  |   /* SCRATCH_B: ORIGIN = 0x20041000, LENGTH = 4K    */ | ||||||
| } | } | ||||||
|  |  | ||||||
| __bootloader_state_start = ORIGIN(BOOTLOADER_STATE) - ORIGIN(BOOT2); | __bootloader_state_start = ORIGIN(BOOTLOADER_STATE) - ORIGIN(BOOT2); | ||||||
|   | |||||||
| @@ -6,7 +6,7 @@ license = "MIT OR Apache-2.0" | |||||||
|  |  | ||||||
| [dependencies] | [dependencies] | ||||||
| embassy-sync = { version = "0.4.0", path = "../../../../embassy-sync" } | 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-executor = { version = "0.3.3", 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-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-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"] } | embassy-boot-stm32 = { version = "0.1.0", path = "../../../../embassy-boot/stm32", features = ["nightly"] } | ||||||
|   | |||||||
| @@ -6,7 +6,7 @@ license = "MIT OR Apache-2.0" | |||||||
|  |  | ||||||
| [dependencies] | [dependencies] | ||||||
| embassy-sync = { version = "0.4.0", path = "../../../../embassy-sync" } | 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-executor = { version = "0.3.3", 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-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-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"] } | embassy-boot-stm32 = { version = "0.1.0", path = "../../../../embassy-boot/stm32", features = ["nightly"] } | ||||||
|   | |||||||
| @@ -6,7 +6,7 @@ license = "MIT OR Apache-2.0" | |||||||
|  |  | ||||||
| [dependencies] | [dependencies] | ||||||
| embassy-sync = { version = "0.4.0", path = "../../../../embassy-sync" } | 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-executor = { version = "0.3.3", 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-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-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"] } | embassy-boot-stm32 = { version = "0.1.0", path = "../../../../embassy-boot/stm32", features = ["nightly"] } | ||||||
|   | |||||||
| @@ -6,7 +6,7 @@ license = "MIT OR Apache-2.0" | |||||||
|  |  | ||||||
| [dependencies] | [dependencies] | ||||||
| embassy-sync = { version = "0.4.0", path = "../../../../embassy-sync" } | 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-executor = { version = "0.3.3", 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-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-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"] } | embassy-boot-stm32 = { version = "0.1.0", path = "../../../../embassy-boot/stm32", features = ["nightly"] } | ||||||
|   | |||||||
| @@ -6,7 +6,7 @@ license = "MIT OR Apache-2.0" | |||||||
|  |  | ||||||
| [dependencies] | [dependencies] | ||||||
| embassy-sync = { version = "0.4.0", path = "../../../../embassy-sync" } | 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-executor = { version = "0.3.3", 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-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-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"] } | embassy-boot-stm32 = { version = "0.1.0", path = "../../../../embassy-boot/stm32", features = ["nightly"] } | ||||||
|   | |||||||
| @@ -6,7 +6,7 @@ license = "MIT OR Apache-2.0" | |||||||
|  |  | ||||||
| [dependencies] | [dependencies] | ||||||
| embassy-sync = { version = "0.4.0", path = "../../../../embassy-sync" } | 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-executor = { version = "0.3.3", 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-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-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"] } | embassy-boot-stm32 = { version = "0.1.0", path = "../../../../embassy-boot/stm32", features = ["nightly"] } | ||||||
|   | |||||||
| @@ -6,7 +6,7 @@ license = "MIT OR Apache-2.0" | |||||||
|  |  | ||||||
| [dependencies] | [dependencies] | ||||||
| embassy-sync = { version = "0.4.0", path = "../../../../embassy-sync" } | 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-executor = { version = "0.3.3", 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-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-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"] } | embassy-boot-stm32 = { version = "0.1.0", path = "../../../../embassy-boot/stm32", features = ["nightly"] } | ||||||
|   | |||||||
| @@ -6,7 +6,19 @@ MEMORY | |||||||
|   BOOTLOADER_STATE                  : ORIGIN = 0x10006000, LENGTH = 4K |   BOOTLOADER_STATE                  : ORIGIN = 0x10006000, LENGTH = 4K | ||||||
|   ACTIVE                            : ORIGIN = 0x10007000, LENGTH = 512K |   ACTIVE                            : ORIGIN = 0x10007000, LENGTH = 512K | ||||||
|   DFU                               : ORIGIN = 0x10087000, LENGTH = 516K |   DFU                               : ORIGIN = 0x10087000, LENGTH = 516K | ||||||
|   RAM                               : ORIGIN = 0x20000000, LENGTH = 256K |  | ||||||
|  |   /* Pick one of the two options for RAM layout     */ | ||||||
|  |  | ||||||
|  |   /* OPTION A: Use all RAM banks as one big block   */ | ||||||
|  |   /* Reasonable, unless you are doing something     */ | ||||||
|  |   /* really particular with DMA or other concurrent */ | ||||||
|  |   /* access that would benefit from striping        */ | ||||||
|  |   RAM   : ORIGIN = 0x20000000, LENGTH = 264K | ||||||
|  |  | ||||||
|  |   /* OPTION B: Keep the unstriped sections separate */ | ||||||
|  |   /* RAM: ORIGIN = 0x20000000, LENGTH = 256K        */ | ||||||
|  |   /* SCRATCH_A: ORIGIN = 0x20040000, LENGTH = 4K    */ | ||||||
|  |   /* SCRATCH_B: ORIGIN = 0x20041000, LENGTH = 4K    */ | ||||||
| } | } | ||||||
|  |  | ||||||
| __bootloader_state_start = ORIGIN(BOOTLOADER_STATE) - ORIGIN(BOOT2); | __bootloader_state_start = ORIGIN(BOOTLOADER_STATE) - ORIGIN(BOOT2); | ||||||
|   | |||||||
| @@ -17,7 +17,7 @@ log = [ | |||||||
|  |  | ||||||
| [dependencies] | [dependencies] | ||||||
| embassy-sync = { version = "0.4.0", path = "../../embassy-sync" } | 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-executor = { version = "0.3.3", 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-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"] } | embassy-nrf = { version = "0.1.0", path = "../../embassy-nrf", features = ["nrf52840", "time-driver-rtc1", "gpiote", "unstable-pac"] } | ||||||
|  |  | ||||||
|   | |||||||
| @@ -30,11 +30,11 @@ nightly = [ | |||||||
| [dependencies] | [dependencies] | ||||||
| embassy-futures = { version = "0.1.0", path = "../../embassy-futures" } | embassy-futures = { version = "0.1.0", path = "../../embassy-futures" } | ||||||
| embassy-sync = { version = "0.4.0", path = "../../embassy-sync", features = ["defmt"] } | 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-executor = { version = "0.3.3", 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-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-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 } | embassy-net = { version = "0.2.0", path = "../../embassy-net", features = ["defmt", "tcp", "dhcpv4", "medium-ethernet"], optional = true } | ||||||
| embassy-usb = { version = "0.1.0", path = "../../embassy-usb", features = ["defmt", "msos-descriptor",], optional = true } | embassy-usb = { version = "0.1.0", path = "../../embassy-usb", features = ["defmt"], optional = true } | ||||||
| embedded-io = { version = "0.6.0", features = ["defmt-03"]  } | embedded-io = { version = "0.6.0", features = ["defmt-03"]  } | ||||||
| embedded-io-async = { version = "0.6.0", optional = true, features = ["defmt-03"] } | embedded-io-async = { version = "0.6.0", optional = true, features = ["defmt-03"] } | ||||||
| embassy-lora = { version = "0.1.0", path = "../../embassy-lora", features = ["time", "defmt"], optional = true } | embassy-lora = { version = "0.1.0", path = "../../embassy-lora", features = ["time", "defmt"], optional = true } | ||||||
|   | |||||||
| @@ -9,7 +9,7 @@ embassy-futures = { version = "0.1.0", path = "../../embassy-futures" } | |||||||
| embassy-sync = { version = "0.4.0", path = "../../embassy-sync", features = [ | embassy-sync = { version = "0.4.0", path = "../../embassy-sync", features = [ | ||||||
|     "defmt", |     "defmt", | ||||||
| ] } | ] } | ||||||
| embassy-executor = { version = "0.3.1", path = "../../embassy-executor", features = ["arch-cortex-m", "executor-thread",  | embassy-executor = { version = "0.3.3", path = "../../embassy-executor", features = ["arch-cortex-m", "executor-thread",  | ||||||
|     "nightly", |     "nightly", | ||||||
|     "defmt", |     "defmt", | ||||||
|     "integrated-timers", |     "integrated-timers", | ||||||
|   | |||||||
| @@ -8,7 +8,7 @@ license = "MIT OR Apache-2.0" | |||||||
| [dependencies] | [dependencies] | ||||||
| embassy-embedded-hal = { version = "0.1.0", path = "../../embassy-embedded-hal", features = ["defmt"] } | embassy-embedded-hal = { version = "0.1.0", path = "../../embassy-embedded-hal", features = ["defmt"] } | ||||||
| embassy-sync = { version = "0.4.0", path = "../../embassy-sync", features = ["defmt"] } | 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-executor = { version = "0.3.3", 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-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-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"] } | embassy-usb = { version = "0.1.0", path = "../../embassy-usb", features = ["defmt"] } | ||||||
| @@ -39,7 +39,7 @@ st7789 = "0.6.1" | |||||||
| display-interface = "0.4.1" | display-interface = "0.4.1" | ||||||
| byte-slice-cast = { version = "1.2.0", default-features = false } | byte-slice-cast = { version = "1.2.0", default-features = false } | ||||||
| smart-leds = "0.3.0" | smart-leds = "0.3.0" | ||||||
| heapless = "0.7.15" | heapless = "0.8" | ||||||
| usbd-hid = "0.6.1" | usbd-hid = "0.6.1" | ||||||
|  |  | ||||||
| embedded-hal-1 = { package = "embedded-hal", version = "=1.0.0-rc.1" } | embedded-hal-1 = { package = "embedded-hal", version = "=1.0.0-rc.1" } | ||||||
|   | |||||||
| @@ -1,5 +1,17 @@ | |||||||
| MEMORY { | MEMORY { | ||||||
|     BOOT2 : ORIGIN = 0x10000000, LENGTH = 0x100 |     BOOT2 : ORIGIN = 0x10000000, LENGTH = 0x100 | ||||||
|     FLASH : ORIGIN = 0x10000100, LENGTH = 2048K - 0x100 |     FLASH : ORIGIN = 0x10000100, LENGTH = 2048K - 0x100 | ||||||
|     RAM   : ORIGIN = 0x20000000, LENGTH = 256K |  | ||||||
|  |     /* Pick one of the two options for RAM layout     */ | ||||||
|  |  | ||||||
|  |     /* OPTION A: Use all RAM banks as one big block   */ | ||||||
|  |     /* Reasonable, unless you are doing something     */ | ||||||
|  |     /* really particular with DMA or other concurrent */ | ||||||
|  |     /* access that would benefit from striping        */ | ||||||
|  |     RAM   : ORIGIN = 0x20000000, LENGTH = 264K | ||||||
|  |  | ||||||
|  |     /* OPTION B: Keep the unstriped sections separate */ | ||||||
|  |     /* RAM: ORIGIN = 0x20000000, LENGTH = 256K        */ | ||||||
|  |     /* SCRATCH_A: ORIGIN = 0x20040000, LENGTH = 4K    */ | ||||||
|  |     /* SCRATCH_B: ORIGIN = 0x20041000, LENGTH = 4K    */ | ||||||
| } | } | ||||||
| @@ -75,6 +75,7 @@ async fn main(_spawner: Spawner) { | |||||||
|         &mut device_descriptor, |         &mut device_descriptor, | ||||||
|         &mut config_descriptor, |         &mut config_descriptor, | ||||||
|         &mut bos_descriptor, |         &mut bos_descriptor, | ||||||
|  |         &mut [], // no msos descriptors | ||||||
|         &mut control_buf, |         &mut control_buf, | ||||||
|     ); |     ); | ||||||
|  |  | ||||||
|   | |||||||
| @@ -71,6 +71,7 @@ async fn main(spawner: Spawner) { | |||||||
|         &mut make_static!([0; 256])[..], |         &mut make_static!([0; 256])[..], | ||||||
|         &mut make_static!([0; 256])[..], |         &mut make_static!([0; 256])[..], | ||||||
|         &mut make_static!([0; 256])[..], |         &mut make_static!([0; 256])[..], | ||||||
|  |         &mut [], // no msos descriptors | ||||||
|         &mut make_static!([0; 128])[..], |         &mut make_static!([0; 128])[..], | ||||||
|     ); |     ); | ||||||
|  |  | ||||||
|   | |||||||
| @@ -41,7 +41,7 @@ async fn main(_spawner: Spawner) { | |||||||
|     let mut config_descriptor = [0; 256]; |     let mut config_descriptor = [0; 256]; | ||||||
|     let mut bos_descriptor = [0; 256]; |     let mut bos_descriptor = [0; 256]; | ||||||
|     // You can also add a Microsoft OS descriptor. |     // You can also add a Microsoft OS descriptor. | ||||||
|     // let mut msos_descriptor = [0; 256]; |     let mut msos_descriptor = [0; 256]; | ||||||
|     let mut control_buf = [0; 64]; |     let mut control_buf = [0; 64]; | ||||||
|     let request_handler = MyRequestHandler {}; |     let request_handler = MyRequestHandler {}; | ||||||
|     let mut device_handler = MyDeviceHandler::new(); |     let mut device_handler = MyDeviceHandler::new(); | ||||||
| @@ -54,7 +54,7 @@ async fn main(_spawner: Spawner) { | |||||||
|         &mut device_descriptor, |         &mut device_descriptor, | ||||||
|         &mut config_descriptor, |         &mut config_descriptor, | ||||||
|         &mut bos_descriptor, |         &mut bos_descriptor, | ||||||
|         // &mut msos_descriptor, |         &mut msos_descriptor, | ||||||
|         &mut control_buf, |         &mut control_buf, | ||||||
|     ); |     ); | ||||||
|  |  | ||||||
|   | |||||||
| @@ -58,6 +58,7 @@ async fn main(_spawner: Spawner) { | |||||||
|         &mut device_descriptor, |         &mut device_descriptor, | ||||||
|         &mut config_descriptor, |         &mut config_descriptor, | ||||||
|         &mut bos_descriptor, |         &mut bos_descriptor, | ||||||
|  |         &mut [], // no msos descriptors | ||||||
|         &mut control_buf, |         &mut control_buf, | ||||||
|     ); |     ); | ||||||
|  |  | ||||||
|   | |||||||
							
								
								
									
										199
									
								
								examples/rp/src/bin/usb_raw.rs
									
									
									
									
									
										Normal file
									
								
							
							
						
						
									
										199
									
								
								examples/rp/src/bin/usb_raw.rs
									
									
									
									
									
										Normal file
									
								
							| @@ -0,0 +1,199 @@ | |||||||
|  | //! Example of using USB without a pre-defined class, but instead responding to | ||||||
|  | //! raw USB control requests. | ||||||
|  | //! | ||||||
|  | //! The host computer can either: | ||||||
|  | //! * send a command, with a 16-bit request ID, a 16-bit value, and an optional data buffer | ||||||
|  | //! * request some data, with a 16-bit request ID, a 16-bit value, and a length of data to receive | ||||||
|  | //! | ||||||
|  | //! For higher throughput data, you can add some bulk endpoints after creating the alternate, | ||||||
|  | //! but for low rate command/response, plain control transfers can be very simple and effective. | ||||||
|  | //! | ||||||
|  | //! Example code to send/receive data using `nusb`: | ||||||
|  | //! | ||||||
|  | //! ```ignore | ||||||
|  | //! use futures_lite::future::block_on; | ||||||
|  | //! use nusb::transfer::{ControlIn, ControlOut, ControlType, Recipient}; | ||||||
|  | //! | ||||||
|  | //! fn main() { | ||||||
|  | //!     let di = nusb::list_devices() | ||||||
|  | //!         .unwrap() | ||||||
|  | //!         .find(|d| d.vendor_id() == 0xc0de && d.product_id() == 0xcafe) | ||||||
|  | //!         .expect("no device found"); | ||||||
|  | //!     let device = di.open().expect("error opening device"); | ||||||
|  | //!     let interface = device.claim_interface(0).expect("error claiming interface"); | ||||||
|  | //! | ||||||
|  | //!     // Send "hello world" to device | ||||||
|  | //!     let result = block_on(interface.control_out(ControlOut { | ||||||
|  | //!         control_type: ControlType::Vendor, | ||||||
|  | //!         recipient: Recipient::Interface, | ||||||
|  | //!         request: 100, | ||||||
|  | //!         value: 200, | ||||||
|  | //!         index: 0, | ||||||
|  | //!         data: b"hello world", | ||||||
|  | //!     })); | ||||||
|  | //!     println!("{result:?}"); | ||||||
|  | //! | ||||||
|  | //!     // Receive "hello" from device | ||||||
|  | //!     let result = block_on(interface.control_in(ControlIn { | ||||||
|  | //!         control_type: ControlType::Vendor, | ||||||
|  | //!         recipient: Recipient::Interface, | ||||||
|  | //!         request: 101, | ||||||
|  | //!         value: 201, | ||||||
|  | //!         index: 0, | ||||||
|  | //!         length: 5, | ||||||
|  | //!     })); | ||||||
|  | //!     println!("{result:?}"); | ||||||
|  | //! } | ||||||
|  | //! ``` | ||||||
|  |  | ||||||
|  | #![no_std] | ||||||
|  | #![no_main] | ||||||
|  | #![feature(type_alias_impl_trait)] | ||||||
|  |  | ||||||
|  | use defmt::info; | ||||||
|  | use embassy_executor::Spawner; | ||||||
|  | use embassy_rp::bind_interrupts; | ||||||
|  | use embassy_rp::peripherals::USB; | ||||||
|  | use embassy_rp::usb::{Driver, InterruptHandler}; | ||||||
|  | use embassy_usb::control::{InResponse, OutResponse, Recipient, Request, RequestType}; | ||||||
|  | use embassy_usb::msos::{self, windows_version}; | ||||||
|  | use embassy_usb::types::InterfaceNumber; | ||||||
|  | use embassy_usb::{Builder, Config, Handler}; | ||||||
|  | use {defmt_rtt as _, panic_probe as _}; | ||||||
|  |  | ||||||
|  | // This is a randomly generated GUID to allow clients on Windows to find our device | ||||||
|  | const DEVICE_INTERFACE_GUIDS: &[&str] = &["{AFB9A6FB-30BA-44BC-9232-806CFC875321}"]; | ||||||
|  |  | ||||||
|  | bind_interrupts!(struct Irqs { | ||||||
|  |     USBCTRL_IRQ => InterruptHandler<USB>; | ||||||
|  | }); | ||||||
|  |  | ||||||
|  | #[embassy_executor::main] | ||||||
|  | async fn main(_spawner: Spawner) { | ||||||
|  |     info!("Hello there!"); | ||||||
|  |  | ||||||
|  |     let p = embassy_rp::init(Default::default()); | ||||||
|  |  | ||||||
|  |     // Create the driver, from the HAL. | ||||||
|  |     let driver = Driver::new(p.USB, Irqs); | ||||||
|  |  | ||||||
|  |     // Create embassy-usb Config | ||||||
|  |     let mut config = Config::new(0xc0de, 0xcafe); | ||||||
|  |     config.manufacturer = Some("Embassy"); | ||||||
|  |     config.product = Some("USB raw example"); | ||||||
|  |     config.serial_number = Some("12345678"); | ||||||
|  |     config.max_power = 100; | ||||||
|  |     config.max_packet_size_0 = 64; | ||||||
|  |  | ||||||
|  |     // // Required for windows compatibility. | ||||||
|  |     // // https://developer.nordicsemi.com/nRF_Connect_SDK/doc/1.9.1/kconfig/CONFIG_CDC_ACM_IAD.html#help | ||||||
|  |     config.device_class = 0xEF; | ||||||
|  |     config.device_sub_class = 0x02; | ||||||
|  |     config.device_protocol = 0x01; | ||||||
|  |     config.composite_with_iads = true; | ||||||
|  |  | ||||||
|  |     // Create embassy-usb DeviceBuilder using the driver and config. | ||||||
|  |     // It needs some buffers for building the descriptors. | ||||||
|  |     let mut device_descriptor = [0; 256]; | ||||||
|  |     let mut config_descriptor = [0; 256]; | ||||||
|  |     let mut bos_descriptor = [0; 256]; | ||||||
|  |     let mut msos_descriptor = [0; 256]; | ||||||
|  |     let mut control_buf = [0; 64]; | ||||||
|  |  | ||||||
|  |     let mut handler = ControlHandler { | ||||||
|  |         if_num: InterfaceNumber(0), | ||||||
|  |     }; | ||||||
|  |  | ||||||
|  |     let mut builder = Builder::new( | ||||||
|  |         driver, | ||||||
|  |         config, | ||||||
|  |         &mut device_descriptor, | ||||||
|  |         &mut config_descriptor, | ||||||
|  |         &mut bos_descriptor, | ||||||
|  |         &mut msos_descriptor, | ||||||
|  |         &mut control_buf, | ||||||
|  |     ); | ||||||
|  |  | ||||||
|  |     // Add the Microsoft OS Descriptor (MSOS/MOD) descriptor. | ||||||
|  |     // We tell Windows that this entire device is compatible with the "WINUSB" feature, | ||||||
|  |     // which causes it to use the built-in WinUSB driver automatically, which in turn | ||||||
|  |     // can be used by libusb/rusb software without needing a custom driver or INF file. | ||||||
|  |     // In principle you might want to call msos_feature() just on a specific function, | ||||||
|  |     // if your device also has other functions that still use standard class drivers. | ||||||
|  |     builder.msos_descriptor(windows_version::WIN8_1, 0); | ||||||
|  |     builder.msos_feature(msos::CompatibleIdFeatureDescriptor::new("WINUSB", "")); | ||||||
|  |     builder.msos_feature(msos::RegistryPropertyFeatureDescriptor::new( | ||||||
|  |         "DeviceInterfaceGUIDs", | ||||||
|  |         msos::PropertyData::RegMultiSz(DEVICE_INTERFACE_GUIDS), | ||||||
|  |     )); | ||||||
|  |  | ||||||
|  |     // Add a vendor-specific function (class 0xFF), and corresponding interface, | ||||||
|  |     // that uses our custom handler. | ||||||
|  |     let mut function = builder.function(0xFF, 0, 0); | ||||||
|  |     let mut interface = function.interface(); | ||||||
|  |     let _alt = interface.alt_setting(0xFF, 0, 0, None); | ||||||
|  |     handler.if_num = interface.interface_number(); | ||||||
|  |     drop(function); | ||||||
|  |     builder.handler(&mut handler); | ||||||
|  |  | ||||||
|  |     // Build the builder. | ||||||
|  |     let mut usb = builder.build(); | ||||||
|  |  | ||||||
|  |     // Run the USB device. | ||||||
|  |     usb.run().await; | ||||||
|  | } | ||||||
|  |  | ||||||
|  | /// Handle CONTROL endpoint requests and responses. For many simple requests and responses | ||||||
|  | /// you can get away with only using the control endpoint. | ||||||
|  | struct ControlHandler { | ||||||
|  |     if_num: InterfaceNumber, | ||||||
|  | } | ||||||
|  |  | ||||||
|  | impl Handler for ControlHandler { | ||||||
|  |     /// Respond to HostToDevice control messages, where the host sends us a command and | ||||||
|  |     /// optionally some data, and we can only acknowledge or reject it. | ||||||
|  |     fn control_out<'a>(&'a mut self, req: Request, buf: &'a [u8]) -> Option<OutResponse> { | ||||||
|  |         // Log the request before filtering to help with debugging. | ||||||
|  |         info!("Got control_out, request={}, buf={:a}", req, buf); | ||||||
|  |  | ||||||
|  |         // Only handle Vendor request types to an Interface. | ||||||
|  |         if req.request_type != RequestType::Vendor || req.recipient != Recipient::Interface { | ||||||
|  |             return None; | ||||||
|  |         } | ||||||
|  |  | ||||||
|  |         // Ignore requests to other interfaces. | ||||||
|  |         if req.index != self.if_num.0 as u16 { | ||||||
|  |             return None; | ||||||
|  |         } | ||||||
|  |  | ||||||
|  |         // Accept request 100, value 200, reject others. | ||||||
|  |         if req.request == 100 && req.value == 200 { | ||||||
|  |             Some(OutResponse::Accepted) | ||||||
|  |         } else { | ||||||
|  |             Some(OutResponse::Rejected) | ||||||
|  |         } | ||||||
|  |     } | ||||||
|  |  | ||||||
|  |     /// Respond to DeviceToHost control messages, where the host requests some data from us. | ||||||
|  |     fn control_in<'a>(&'a mut self, req: Request, buf: &'a mut [u8]) -> Option<InResponse<'a>> { | ||||||
|  |         info!("Got control_in, request={}", req); | ||||||
|  |  | ||||||
|  |         // Only handle Vendor request types to an Interface. | ||||||
|  |         if req.request_type != RequestType::Vendor || req.recipient != Recipient::Interface { | ||||||
|  |             return None; | ||||||
|  |         } | ||||||
|  |  | ||||||
|  |         // Ignore requests to other interfaces. | ||||||
|  |         if req.index != self.if_num.0 as u16 { | ||||||
|  |             return None; | ||||||
|  |         } | ||||||
|  |  | ||||||
|  |         // Respond "hello" to request 101, value 201, when asked for 5 bytes, otherwise reject. | ||||||
|  |         if req.request == 101 && req.value == 201 && req.length == 5 { | ||||||
|  |             buf[..5].copy_from_slice(b"hello"); | ||||||
|  |             Some(InResponse::Accepted(&buf[..5])) | ||||||
|  |         } else { | ||||||
|  |             Some(InResponse::Rejected) | ||||||
|  |         } | ||||||
|  |     } | ||||||
|  | } | ||||||
							
								
								
									
										142
									
								
								examples/rp/src/bin/usb_raw_bulk.rs
									
									
									
									
									
										Normal file
									
								
							
							
						
						
									
										142
									
								
								examples/rp/src/bin/usb_raw_bulk.rs
									
									
									
									
									
										Normal file
									
								
							| @@ -0,0 +1,142 @@ | |||||||
|  | //! Example of using USB without a pre-defined class, but instead using raw USB bulk transfers. | ||||||
|  | //! | ||||||
|  | //! Example code to send/receive data using `nusb`: | ||||||
|  | //! | ||||||
|  | //! ```ignore | ||||||
|  | //! use futures_lite::future::block_on; | ||||||
|  | //! use nusb::transfer::RequestBuffer; | ||||||
|  | //! | ||||||
|  | //! const BULK_OUT_EP: u8 = 0x01; | ||||||
|  | //! const BULK_IN_EP: u8 = 0x81; | ||||||
|  | //! | ||||||
|  | //! fn main() { | ||||||
|  | //!     let di = nusb::list_devices() | ||||||
|  | //!         .unwrap() | ||||||
|  | //!         .find(|d| d.vendor_id() == 0xc0de && d.product_id() == 0xcafe) | ||||||
|  | //!         .expect("no device found"); | ||||||
|  | //!     let device = di.open().expect("error opening device"); | ||||||
|  | //!     let interface = device.claim_interface(0).expect("error claiming interface"); | ||||||
|  | //! | ||||||
|  | //!     let result = block_on(interface.bulk_out(BULK_OUT_EP, b"hello world".into())); | ||||||
|  | //!     println!("{result:?}"); | ||||||
|  | //!     let result = block_on(interface.bulk_in(BULK_IN_EP, RequestBuffer::new(64))); | ||||||
|  | //!     println!("{result:?}"); | ||||||
|  | //! } | ||||||
|  | //! ``` | ||||||
|  |  | ||||||
|  | #![no_std] | ||||||
|  | #![no_main] | ||||||
|  | #![feature(type_alias_impl_trait)] | ||||||
|  |  | ||||||
|  | use defmt::info; | ||||||
|  | use embassy_executor::Spawner; | ||||||
|  | use embassy_futures::join::join; | ||||||
|  | use embassy_rp::bind_interrupts; | ||||||
|  | use embassy_rp::peripherals::USB; | ||||||
|  | use embassy_rp::usb::{Driver, InterruptHandler}; | ||||||
|  | use embassy_usb::driver::{Endpoint, EndpointIn, EndpointOut}; | ||||||
|  | use embassy_usb::msos::{self, windows_version}; | ||||||
|  | use embassy_usb::{Builder, Config}; | ||||||
|  | use {defmt_rtt as _, panic_probe as _}; | ||||||
|  |  | ||||||
|  | // This is a randomly generated GUID to allow clients on Windows to find our device | ||||||
|  | const DEVICE_INTERFACE_GUIDS: &[&str] = &["{AFB9A6FB-30BA-44BC-9232-806CFC875321}"]; | ||||||
|  |  | ||||||
|  | bind_interrupts!(struct Irqs { | ||||||
|  |     USBCTRL_IRQ => InterruptHandler<USB>; | ||||||
|  | }); | ||||||
|  |  | ||||||
|  | #[embassy_executor::main] | ||||||
|  | async fn main(_spawner: Spawner) { | ||||||
|  |     info!("Hello there!"); | ||||||
|  |  | ||||||
|  |     let p = embassy_rp::init(Default::default()); | ||||||
|  |  | ||||||
|  |     // Create the driver, from the HAL. | ||||||
|  |     let driver = Driver::new(p.USB, Irqs); | ||||||
|  |  | ||||||
|  |     // Create embassy-usb Config | ||||||
|  |     let mut config = Config::new(0xc0de, 0xcafe); | ||||||
|  |     config.manufacturer = Some("Embassy"); | ||||||
|  |     config.product = Some("USB raw example"); | ||||||
|  |     config.serial_number = Some("12345678"); | ||||||
|  |     config.max_power = 100; | ||||||
|  |     config.max_packet_size_0 = 64; | ||||||
|  |  | ||||||
|  |     // // Required for windows compatibility. | ||||||
|  |     // // https://developer.nordicsemi.com/nRF_Connect_SDK/doc/1.9.1/kconfig/CONFIG_CDC_ACM_IAD.html#help | ||||||
|  |     config.device_class = 0xEF; | ||||||
|  |     config.device_sub_class = 0x02; | ||||||
|  |     config.device_protocol = 0x01; | ||||||
|  |     config.composite_with_iads = true; | ||||||
|  |  | ||||||
|  |     // Create embassy-usb DeviceBuilder using the driver and config. | ||||||
|  |     // It needs some buffers for building the descriptors. | ||||||
|  |     let mut device_descriptor = [0; 256]; | ||||||
|  |     let mut config_descriptor = [0; 256]; | ||||||
|  |     let mut bos_descriptor = [0; 256]; | ||||||
|  |     let mut msos_descriptor = [0; 256]; | ||||||
|  |     let mut control_buf = [0; 64]; | ||||||
|  |  | ||||||
|  |     let mut builder = Builder::new( | ||||||
|  |         driver, | ||||||
|  |         config, | ||||||
|  |         &mut device_descriptor, | ||||||
|  |         &mut config_descriptor, | ||||||
|  |         &mut bos_descriptor, | ||||||
|  |         &mut msos_descriptor, | ||||||
|  |         &mut control_buf, | ||||||
|  |     ); | ||||||
|  |  | ||||||
|  |     // Add the Microsoft OS Descriptor (MSOS/MOD) descriptor. | ||||||
|  |     // We tell Windows that this entire device is compatible with the "WINUSB" feature, | ||||||
|  |     // which causes it to use the built-in WinUSB driver automatically, which in turn | ||||||
|  |     // can be used by libusb/rusb software without needing a custom driver or INF file. | ||||||
|  |     // In principle you might want to call msos_feature() just on a specific function, | ||||||
|  |     // if your device also has other functions that still use standard class drivers. | ||||||
|  |     builder.msos_descriptor(windows_version::WIN8_1, 0); | ||||||
|  |     builder.msos_feature(msos::CompatibleIdFeatureDescriptor::new("WINUSB", "")); | ||||||
|  |     builder.msos_feature(msos::RegistryPropertyFeatureDescriptor::new( | ||||||
|  |         "DeviceInterfaceGUIDs", | ||||||
|  |         msos::PropertyData::RegMultiSz(DEVICE_INTERFACE_GUIDS), | ||||||
|  |     )); | ||||||
|  |  | ||||||
|  |     // Add a vendor-specific function (class 0xFF), and corresponding interface, | ||||||
|  |     // that uses our custom handler. | ||||||
|  |     let mut function = builder.function(0xFF, 0, 0); | ||||||
|  |     let mut interface = function.interface(); | ||||||
|  |     let mut alt = interface.alt_setting(0xFF, 0, 0, None); | ||||||
|  |     let mut read_ep = alt.endpoint_bulk_out(64); | ||||||
|  |     let mut write_ep = alt.endpoint_bulk_in(64); | ||||||
|  |     drop(function); | ||||||
|  |  | ||||||
|  |     // Build the builder. | ||||||
|  |     let mut usb = builder.build(); | ||||||
|  |  | ||||||
|  |     // Run the USB device. | ||||||
|  |     let usb_fut = usb.run(); | ||||||
|  |  | ||||||
|  |     // Do stuff with the class! | ||||||
|  |     let echo_fut = async { | ||||||
|  |         loop { | ||||||
|  |             read_ep.wait_enabled().await; | ||||||
|  |             info!("Connected"); | ||||||
|  |             loop { | ||||||
|  |                 let mut data = [0; 64]; | ||||||
|  |                 match read_ep.read(&mut data).await { | ||||||
|  |                     Ok(n) => { | ||||||
|  |                         info!("Got bulk: {:a}", data[..n]); | ||||||
|  |                         // Echo back to the host: | ||||||
|  |                         write_ep.write(&data[..n]).await.ok(); | ||||||
|  |                     } | ||||||
|  |                     Err(_) => break, | ||||||
|  |                 } | ||||||
|  |             } | ||||||
|  |             info!("Disconnected"); | ||||||
|  |         } | ||||||
|  |     }; | ||||||
|  |  | ||||||
|  |     // Run everything concurrently. | ||||||
|  |     // If we had made everything `'static` above instead, we could do this using separate tasks instead. | ||||||
|  |     join(usb_fut, echo_fut).await; | ||||||
|  | } | ||||||
| @@ -60,6 +60,7 @@ async fn main(_spawner: Spawner) { | |||||||
|         &mut device_descriptor, |         &mut device_descriptor, | ||||||
|         &mut config_descriptor, |         &mut config_descriptor, | ||||||
|         &mut bos_descriptor, |         &mut bos_descriptor, | ||||||
|  |         &mut [], // no msos descriptors | ||||||
|         &mut control_buf, |         &mut control_buf, | ||||||
|     ); |     ); | ||||||
|  |  | ||||||
|   | |||||||
| @@ -6,7 +6,7 @@ license = "MIT OR Apache-2.0" | |||||||
|  |  | ||||||
| [dependencies] | [dependencies] | ||||||
| embassy-sync = { version = "0.4.0", path = "../../embassy-sync", features = ["log"] } | embassy-sync = { version = "0.4.0", path = "../../embassy-sync", features = ["log"] } | ||||||
| embassy-executor = { version = "0.3.1", path = "../../embassy-executor", features = ["arch-std", "executor-thread", "log", "nightly", "integrated-timers"] } | embassy-executor = { version = "0.3.3", path = "../../embassy-executor", features = ["arch-std", "executor-thread", "log", "nightly", "integrated-timers"] } | ||||||
| embassy-time = { version = "0.1.5", path = "../../embassy-time", features = ["log", "std", "nightly"] } | embassy-time = { version = "0.1.5", path = "../../embassy-time", features = ["log", "std", "nightly"] } | ||||||
| embassy-net = { version = "0.2.0", path = "../../embassy-net", features=[ "std", "nightly", "log", "medium-ethernet", "medium-ip", "tcp", "udp", "dns", "dhcpv4", "proto-ipv6"] } | embassy-net = { version = "0.2.0", path = "../../embassy-net", features=[ "std", "nightly", "log", "medium-ethernet", "medium-ip", "tcp", "udp", "dns", "dhcpv4", "proto-ipv6"] } | ||||||
| embassy-net-tuntap = { version = "0.1.0", path = "../../embassy-net-tuntap" } | embassy-net-tuntap = { version = "0.1.0", path = "../../embassy-net-tuntap" } | ||||||
| @@ -14,7 +14,6 @@ embassy-net-ppp = { version = "0.1.0", path = "../../embassy-net-ppp", features | |||||||
| embedded-io-async = { version = "0.6.0" } | embedded-io-async = { version = "0.6.0" } | ||||||
| embedded-io-adapters = { version = "0.6.0", features = ["futures-03"] } | embedded-io-adapters = { version = "0.6.0", features = ["futures-03"] } | ||||||
| critical-section = { version = "1.1", features = ["std"] } | critical-section = { version = "1.1", features = ["std"] } | ||||||
| smoltcp = { version = "0.10.0", features = ["dns-max-server-count-4"] } |  | ||||||
|  |  | ||||||
| async-io = "1.6.0" | async-io = "1.6.0" | ||||||
| env_logger = "0.9.0" | env_logger = "0.9.0" | ||||||
| @@ -23,7 +22,7 @@ log = "0.4.14" | |||||||
| nix = "0.26.2" | nix = "0.26.2" | ||||||
| clap = { version = "3.0.0-beta.5", features = ["derive"] } | clap = { version = "3.0.0-beta.5", features = ["derive"] } | ||||||
| rand_core = { version = "0.6.3", features = ["std"] } | rand_core = { version = "0.6.3", features = ["std"] } | ||||||
| heapless = { version = "0.7.5", default-features = false } | heapless = { version = "0.8", default-features = false } | ||||||
| static_cell = { version = "2", features = ["nightly"]} | static_cell = { version = "2", features = ["nightly"]} | ||||||
|  |  | ||||||
| [profile.release] | [profile.release] | ||||||
|   | |||||||
| @@ -8,7 +8,7 @@ license = "MIT OR Apache-2.0" | |||||||
| # Change stm32c031c6 to your chip name, if necessary. | # Change stm32c031c6 to your chip name, if necessary. | ||||||
| embassy-stm32 = { version = "0.1.0", path = "../../embassy-stm32", features = ["nightly", "defmt", "time-driver-any", "stm32c031c6", "memory-x", "unstable-pac", "exti"]  } | embassy-stm32 = { version = "0.1.0", path = "../../embassy-stm32", features = ["nightly", "defmt", "time-driver-any", "stm32c031c6", "memory-x", "unstable-pac", "exti"]  } | ||||||
| embassy-sync = { version = "0.4.0", path = "../../embassy-sync", features = ["defmt"] } | 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", "defmt", "integrated-timers"] } | embassy-executor = { version = "0.3.3", path = "../../embassy-executor", features = ["nightly", "arch-cortex-m", "executor-thread", "defmt", "integrated-timers"] } | ||||||
| embassy-time = { version = "0.1.5", path = "../../embassy-time", features = ["defmt", "defmt-timestamp-uptime", "tick-hz-32_768"] } | embassy-time = { version = "0.1.5", path = "../../embassy-time", features = ["defmt", "defmt-timestamp-uptime", "tick-hz-32_768"] } | ||||||
|  |  | ||||||
| defmt = "0.3" | defmt = "0.3" | ||||||
| @@ -19,7 +19,7 @@ cortex-m-rt = "0.7.0" | |||||||
| embedded-hal = "0.2.6" | embedded-hal = "0.2.6" | ||||||
| panic-probe = { version = "0.3", features = ["print-defmt"] } | panic-probe = { version = "0.3", features = ["print-defmt"] } | ||||||
| futures = { version = "0.3.17", default-features = false, features = ["async-await"] } | futures = { version = "0.3.17", default-features = false, features = ["async-await"] } | ||||||
| heapless = { version = "0.7.5", default-features = false } | heapless = { version = "0.8", default-features = false } | ||||||
|  |  | ||||||
| [profile.release] | [profile.release] | ||||||
| debug = 2 | debug = 2 | ||||||
|   | |||||||
| @@ -15,7 +15,7 @@ defmt = "0.3" | |||||||
| defmt-rtt = "0.4" | defmt-rtt = "0.4" | ||||||
| panic-probe = "0.3" | panic-probe = "0.3" | ||||||
| embassy-sync = { version = "0.4.0", path = "../../embassy-sync", features = ["defmt"] } | 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-executor = { version = "0.3.3", 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 = ["defmt", "defmt-timestamp-uptime", "tick-hz-32_768"] } | embassy-time = { version = "0.1.5", path = "../../embassy-time", features = ["defmt", "defmt-timestamp-uptime", "tick-hz-32_768"] } | ||||||
| static_cell = { version = "2", features = ["nightly"]} | static_cell = { version = "2", features = ["nightly"]} | ||||||
| portable-atomic = { version = "1.5", features = ["unsafe-assume-single-core"] } | portable-atomic = { version = "1.5", features = ["unsafe-assume-single-core"] } | ||||||
|   | |||||||
| @@ -8,7 +8,7 @@ license = "MIT OR Apache-2.0" | |||||||
| # Change stm32f103c8 to your chip name, if necessary. | # Change stm32f103c8 to your chip name, if necessary. | ||||||
| embassy-stm32 = { version = "0.1.0", path = "../../embassy-stm32", features = ["nightly", "defmt", "stm32f103c8", "unstable-pac", "memory-x", "time-driver-any", "unstable-traits" ]  } | embassy-stm32 = { version = "0.1.0", path = "../../embassy-stm32", features = ["nightly", "defmt", "stm32f103c8", "unstable-pac", "memory-x", "time-driver-any", "unstable-traits" ]  } | ||||||
| embassy-sync = { version = "0.4.0", path = "../../embassy-sync", features = ["defmt"] } | 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", "defmt", "integrated-timers"] } | embassy-executor = { version = "0.3.3", path = "../../embassy-executor", features = ["nightly", "arch-cortex-m", "executor-thread", "defmt", "integrated-timers"] } | ||||||
| embassy-time = { version = "0.1.5", path = "../../embassy-time", features = ["defmt", "defmt-timestamp-uptime", "tick-hz-32_768"] } | embassy-time = { version = "0.1.5", path = "../../embassy-time", features = ["defmt", "defmt-timestamp-uptime", "tick-hz-32_768"] } | ||||||
| embassy-usb = { version = "0.1.0", path = "../../embassy-usb", features = ["defmt"] } | embassy-usb = { version = "0.1.0", path = "../../embassy-usb", features = ["defmt"] } | ||||||
| embassy-futures = { version = "0.1.0", path = "../../embassy-futures" } | embassy-futures = { version = "0.1.0", path = "../../embassy-futures" } | ||||||
| @@ -21,7 +21,7 @@ cortex-m-rt = "0.7.0" | |||||||
| embedded-hal = "0.2.6" | embedded-hal = "0.2.6" | ||||||
| panic-probe = { version = "0.3", features = ["print-defmt"] } | panic-probe = { version = "0.3", features = ["print-defmt"] } | ||||||
| futures = { version = "0.3.17", default-features = false, features = ["async-await"] } | futures = { version = "0.3.17", default-features = false, features = ["async-await"] } | ||||||
| heapless = { version = "0.7.5", default-features = false } | heapless = { version = "0.8", default-features = false } | ||||||
| nb = "1.0.0" | nb = "1.0.0" | ||||||
|  |  | ||||||
| [profile.dev] | [profile.dev] | ||||||
|   | |||||||
| @@ -60,6 +60,7 @@ async fn main(_spawner: Spawner) { | |||||||
|         &mut device_descriptor, |         &mut device_descriptor, | ||||||
|         &mut config_descriptor, |         &mut config_descriptor, | ||||||
|         &mut bos_descriptor, |         &mut bos_descriptor, | ||||||
|  |         &mut [], // no msos descriptors | ||||||
|         &mut control_buf, |         &mut control_buf, | ||||||
|     ); |     ); | ||||||
|  |  | ||||||
|   | |||||||
| @@ -8,7 +8,7 @@ license = "MIT OR Apache-2.0" | |||||||
| # Change stm32f207zg to your chip name, if necessary. | # Change stm32f207zg to your chip name, if necessary. | ||||||
| embassy-stm32 = { version = "0.1.0", path = "../../embassy-stm32", features = ["nightly", "defmt", "stm32f207zg", "unstable-pac", "memory-x", "time-driver-any", "exti"]  } | embassy-stm32 = { version = "0.1.0", path = "../../embassy-stm32", features = ["nightly", "defmt", "stm32f207zg", "unstable-pac", "memory-x", "time-driver-any", "exti"]  } | ||||||
| embassy-sync = { version = "0.4.0", path = "../../embassy-sync", features = ["defmt"] } | 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", "defmt", "integrated-timers"] } | embassy-executor = { version = "0.3.3", path = "../../embassy-executor", features = ["nightly", "arch-cortex-m", "executor-thread", "defmt", "integrated-timers"] } | ||||||
| embassy-time = { version = "0.1.5", path = "../../embassy-time", features = ["defmt", "defmt-timestamp-uptime", "tick-hz-32_768"] } | embassy-time = { version = "0.1.5", path = "../../embassy-time", features = ["defmt", "defmt-timestamp-uptime", "tick-hz-32_768"] } | ||||||
|  |  | ||||||
| defmt = "0.3" | defmt = "0.3" | ||||||
| @@ -19,7 +19,7 @@ cortex-m-rt = "0.7.0" | |||||||
| embedded-hal = "0.2.6" | embedded-hal = "0.2.6" | ||||||
| panic-probe = { version = "0.3", features = ["print-defmt"] } | panic-probe = { version = "0.3", features = ["print-defmt"] } | ||||||
| futures = { version = "0.3.17", default-features = false, features = ["async-await"] } | futures = { version = "0.3.17", default-features = false, features = ["async-await"] } | ||||||
| heapless = { version = "0.7.5", default-features = false } | heapless = { version = "0.8", default-features = false } | ||||||
| nb = "1.0.0" | nb = "1.0.0" | ||||||
|  |  | ||||||
| [profile.release] | [profile.release] | ||||||
|   | |||||||
| @@ -6,9 +6,6 @@ use core::convert::TryFrom; | |||||||
|  |  | ||||||
| use defmt::*; | use defmt::*; | ||||||
| use embassy_executor::Spawner; | use embassy_executor::Spawner; | ||||||
| use embassy_stm32::rcc::{ |  | ||||||
|     APBPrescaler, ClockSrc, HSEConfig, HSESrc, PLLConfig, PLLMul, PLLPDiv, PLLPreDiv, PLLQDiv, PLLSrc, |  | ||||||
| }; |  | ||||||
| use embassy_stm32::time::Hertz; | use embassy_stm32::time::Hertz; | ||||||
| use embassy_stm32::Config; | use embassy_stm32::Config; | ||||||
| use embassy_time::Timer; | use embassy_time::Timer; | ||||||
| @@ -19,29 +16,35 @@ async fn main(_spawner: Spawner) { | |||||||
|     // Example config for maximum performance on a NUCLEO-F207ZG board |     // Example config for maximum performance on a NUCLEO-F207ZG board | ||||||
|  |  | ||||||
|     let mut config = Config::default(); |     let mut config = Config::default(); | ||||||
|  |  | ||||||
|  |     { | ||||||
|  |         use embassy_stm32::rcc::*; | ||||||
|  |  | ||||||
|         // By default, HSE on the board comes from a 8 MHz clock signal (not a crystal) |         // By default, HSE on the board comes from a 8 MHz clock signal (not a crystal) | ||||||
|     config.rcc.hse = Some(HSEConfig { |         config.rcc.hse = Some(Hse { | ||||||
|         frequency: Hertz(8_000_000), |             freq: Hertz(8_000_000), | ||||||
|         source: HSESrc::Bypass, |             mode: HseMode::Bypass, | ||||||
|         }); |         }); | ||||||
|         // PLL uses HSE as the clock source |         // PLL uses HSE as the clock source | ||||||
|     config.rcc.pll_mux = PLLSrc::HSE; |         config.rcc.pll_src = PllSource::HSE; | ||||||
|     config.rcc.pll = PLLConfig { |         config.rcc.pll = Some(Pll { | ||||||
|             // 8 MHz clock source / 8 = 1 MHz PLL input |             // 8 MHz clock source / 8 = 1 MHz PLL input | ||||||
|         pre_div: unwrap!(PLLPreDiv::try_from(8)), |             prediv: unwrap!(PllPreDiv::try_from(8)), | ||||||
|             // 1 MHz PLL input * 240 = 240 MHz PLL VCO |             // 1 MHz PLL input * 240 = 240 MHz PLL VCO | ||||||
|         mul: unwrap!(PLLMul::try_from(240)), |             mul: unwrap!(PllMul::try_from(240)), | ||||||
|             // 240 MHz PLL VCO / 2 = 120 MHz main PLL output |             // 240 MHz PLL VCO / 2 = 120 MHz main PLL output | ||||||
|         p_div: PLLPDiv::DIV2, |             divp: Some(PllPDiv::DIV2), | ||||||
|             // 240 MHz PLL VCO / 5 = 48 MHz PLL48 output |             // 240 MHz PLL VCO / 5 = 48 MHz PLL48 output | ||||||
|         q_div: PLLQDiv::DIV5, |             divq: Some(PllQDiv::DIV5), | ||||||
|     }; |             divr: None, | ||||||
|  |         }); | ||||||
|         // System clock comes from PLL (= the 120 MHz main PLL output) |         // System clock comes from PLL (= the 120 MHz main PLL output) | ||||||
|     config.rcc.mux = ClockSrc::PLL; |         config.rcc.sys = Sysclk::PLL1_P; | ||||||
|         // 120 MHz / 4 = 30 MHz APB1 frequency |         // 120 MHz / 4 = 30 MHz APB1 frequency | ||||||
|         config.rcc.apb1_pre = APBPrescaler::DIV4; |         config.rcc.apb1_pre = APBPrescaler::DIV4; | ||||||
|         // 120 MHz / 2 = 60 MHz APB2 frequency |         // 120 MHz / 2 = 60 MHz APB2 frequency | ||||||
|         config.rcc.apb2_pre = APBPrescaler::DIV2; |         config.rcc.apb2_pre = APBPrescaler::DIV2; | ||||||
|  |     } | ||||||
|  |  | ||||||
|     let _p = embassy_stm32::init(config); |     let _p = embassy_stm32::init(config); | ||||||
|  |  | ||||||
|   | |||||||
| @@ -8,7 +8,7 @@ license = "MIT OR Apache-2.0" | |||||||
| # Change stm32f303ze to your chip name, if necessary. | # Change stm32f303ze to your chip name, if necessary. | ||||||
| embassy-stm32 = { version = "0.1.0", path = "../../embassy-stm32", features = ["nightly", "defmt", "stm32f303ze", "unstable-pac", "memory-x", "time-driver-any", "exti"]  } | embassy-stm32 = { version = "0.1.0", path = "../../embassy-stm32", features = ["nightly", "defmt", "stm32f303ze", "unstable-pac", "memory-x", "time-driver-any", "exti"]  } | ||||||
| embassy-sync = { version = "0.4.0", path = "../../embassy-sync", features = ["defmt"] } | 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-executor = { version = "0.3.3", 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 = ["defmt", "defmt-timestamp-uptime", "tick-hz-32_768"] } | embassy-time = { version = "0.1.5", path = "../../embassy-time", features = ["defmt", "defmt-timestamp-uptime", "tick-hz-32_768"] } | ||||||
| embassy-usb = { version = "0.1.0", path = "../../embassy-usb", features = ["defmt"] } | embassy-usb = { version = "0.1.0", path = "../../embassy-usb", features = ["defmt"] } | ||||||
| embassy-futures = { version = "0.1.0", path = "../../embassy-futures" } | embassy-futures = { version = "0.1.0", path = "../../embassy-futures" } | ||||||
| @@ -21,7 +21,7 @@ cortex-m-rt = "0.7.0" | |||||||
| embedded-hal = "0.2.6" | embedded-hal = "0.2.6" | ||||||
| panic-probe = { version = "0.3", features = ["print-defmt"] } | panic-probe = { version = "0.3", features = ["print-defmt"] } | ||||||
| futures = { version = "0.3.17", default-features = false, features = ["async-await"] } | futures = { version = "0.3.17", default-features = false, features = ["async-await"] } | ||||||
| heapless = { version = "0.7.5", default-features = false } | heapless = { version = "0.8", default-features = false } | ||||||
| nb = "1.0.0" | nb = "1.0.0" | ||||||
| embedded-storage = "0.3.0" | embedded-storage = "0.3.0" | ||||||
| static_cell = { version = "2", features = ["nightly"]} | static_cell = { version = "2", features = ["nightly"]} | ||||||
|   | |||||||
| @@ -57,6 +57,7 @@ async fn main(_spawner: Spawner) { | |||||||
|         &mut device_descriptor, |         &mut device_descriptor, | ||||||
|         &mut config_descriptor, |         &mut config_descriptor, | ||||||
|         &mut bos_descriptor, |         &mut bos_descriptor, | ||||||
|  |         &mut [], // no msos descriptors | ||||||
|         &mut control_buf, |         &mut control_buf, | ||||||
|     ); |     ); | ||||||
|  |  | ||||||
|   | |||||||
| @@ -6,7 +6,7 @@ license = "MIT OR Apache-2.0" | |||||||
|  |  | ||||||
| [dependencies] | [dependencies] | ||||||
| embassy-sync = { version = "0.4.0", path = "../../embassy-sync", features = ["defmt"] } | 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-executor = { version = "0.3.3", path = "../../embassy-executor", features = ["nightly", "arch-cortex-m", "executor-thread", "executor-interrupt", "defmt", "integrated-timers"] } | ||||||
| embassy-time = { version = "0.1.0", path = "../../embassy-time", features = ["defmt", "defmt-timestamp-uptime", "tick-hz-32_768"] } | embassy-time = { version = "0.1.0", path = "../../embassy-time", features = ["defmt", "defmt-timestamp-uptime", "tick-hz-32_768"] } | ||||||
| embassy-stm32 = { version = "0.1.0", path = "../../embassy-stm32", features = ["nightly", "defmt", "stm32f334r8", "unstable-pac", "memory-x", "time-driver-any", "exti"]  } | embassy-stm32 = { version = "0.1.0", path = "../../embassy-stm32", features = ["nightly", "defmt", "stm32f334r8", "unstable-pac", "memory-x", "time-driver-any", "exti"]  } | ||||||
| embassy-usb = { version = "0.1.0", path = "../../embassy-usb", features = ["defmt"] } | embassy-usb = { version = "0.1.0", path = "../../embassy-usb", features = ["defmt"] } | ||||||
| @@ -20,7 +20,7 @@ cortex-m-rt = "0.7.0" | |||||||
| embedded-hal = "0.2.6" | embedded-hal = "0.2.6" | ||||||
| panic-probe = { version = "0.3", features = ["print-defmt"] } | panic-probe = { version = "0.3", features = ["print-defmt"] } | ||||||
| futures = { version = "0.3.17", default-features = false, features = ["async-await"] } | futures = { version = "0.3.17", default-features = false, features = ["async-await"] } | ||||||
| heapless = { version = "0.7.5", default-features = false } | heapless = { version = "0.8", default-features = false } | ||||||
| nb = "1.0.0" | nb = "1.0.0" | ||||||
| embedded-storage = "0.3.0" | embedded-storage = "0.3.0" | ||||||
| static_cell = { version = "2", features = ["nightly"]} | static_cell = { version = "2", features = ["nightly"]} | ||||||
|   | |||||||
| @@ -39,7 +39,7 @@ async fn main(_spawner: Spawner) -> ! { | |||||||
|  |  | ||||||
|     let mut vrefint = adc.enable_vref(&mut Delay); |     let mut vrefint = adc.enable_vref(&mut Delay); | ||||||
|     let mut temperature = adc.enable_temperature(); |     let mut temperature = adc.enable_temperature(); | ||||||
|     let mut buffer = opamp.buffer_ext(&p.PA7, &mut p.PA6, OpAmpGain::Mul1); |     let mut buffer = opamp.buffer_ext(&mut p.PA7, &mut p.PA6, OpAmpGain::Mul1); | ||||||
|  |  | ||||||
|     loop { |     loop { | ||||||
|         let vref = adc.read(&mut vrefint).await; |         let vref = adc.read(&mut vrefint).await; | ||||||
|   | |||||||
| @@ -8,9 +8,9 @@ license = "MIT OR Apache-2.0" | |||||||
| # Change stm32f429zi to your chip name, if necessary. | # Change stm32f429zi to your chip name, if necessary. | ||||||
| embassy-stm32 = { version = "0.1.0", path = "../../embassy-stm32", features = ["nightly", "unstable-traits", "defmt", "stm32f429zi", "unstable-pac", "memory-x", "time-driver-any", "exti", "embedded-sdmmc", "chrono"]  } | embassy-stm32 = { version = "0.1.0", path = "../../embassy-stm32", features = ["nightly", "unstable-traits", "defmt", "stm32f429zi", "unstable-pac", "memory-x", "time-driver-any", "exti", "embedded-sdmmc", "chrono"]  } | ||||||
| embassy-sync = { version = "0.4.0", path = "../../embassy-sync", features = ["defmt"] } | 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-executor = { version = "0.3.3", 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 = ["defmt", "defmt-timestamp-uptime", "unstable-traits", "tick-hz-32_768"] } | embassy-time = { version = "0.1.5", path = "../../embassy-time", features = ["defmt", "defmt-timestamp-uptime", "unstable-traits", "tick-hz-32_768"] } | ||||||
| embassy-usb = { version = "0.1.0", path = "../../embassy-usb", features = ["defmt"] } | embassy-usb = { version = "0.1.0", path = "../../embassy-usb", features = ["defmt" ] } | ||||||
| embassy-net = { version = "0.2.0", path = "../../embassy-net", features = ["defmt", "tcp", "dhcpv4", "medium-ethernet", "nightly"] } | embassy-net = { version = "0.2.0", path = "../../embassy-net", features = ["defmt", "tcp", "dhcpv4", "medium-ethernet", "nightly"] } | ||||||
|  |  | ||||||
| defmt = "0.3" | defmt = "0.3" | ||||||
| @@ -23,7 +23,7 @@ embedded-io = { version = "0.6.0" } | |||||||
| embedded-io-async = { version = "0.6.0" } | embedded-io-async = { version = "0.6.0" } | ||||||
| panic-probe = { version = "0.3", features = ["print-defmt"] } | panic-probe = { version = "0.3", features = ["print-defmt"] } | ||||||
| futures = { version = "0.3.17", default-features = false, features = ["async-await"] } | futures = { version = "0.3.17", default-features = false, features = ["async-await"] } | ||||||
| heapless = { version = "0.7.5", default-features = false } | heapless = { version = "0.8", default-features = false } | ||||||
| nb = "1.0.0" | nb = "1.0.0" | ||||||
| embedded-storage = "0.3.0" | embedded-storage = "0.3.0" | ||||||
| micromath = "2.0.0" | micromath = "2.0.0" | ||||||
|   | |||||||
| @@ -42,7 +42,7 @@ async fn main(spawner: Spawner) -> ! { | |||||||
|         config.rcc.pll = Some(Pll { |         config.rcc.pll = Some(Pll { | ||||||
|             prediv: PllPreDiv::DIV4, |             prediv: PllPreDiv::DIV4, | ||||||
|             mul: PllMul::MUL180, |             mul: PllMul::MUL180, | ||||||
|             divp: Some(Pllp::DIV2), // 8mhz / 4 * 180 / 2 = 180Mhz. |             divp: Some(PllPDiv::DIV2), // 8mhz / 4 * 180 / 2 = 180Mhz. | ||||||
|             divq: None, |             divq: None, | ||||||
|             divr: None, |             divr: None, | ||||||
|         }); |         }); | ||||||
|   | |||||||
Some files were not shown because too many files have changed in this diff Show More
		Reference in New Issue
	
	Block a user