Add YieldingAsync adapter

This commit is contained in:
Rasmus Melchior Jacobsen 2023-05-22 16:48:31 +02:00
parent d54eb1107e
commit cd1bf31fed
4 changed files with 241 additions and 79 deletions

View File

@ -14,10 +14,10 @@ target = "x86_64-unknown-linux-gnu"
[features] [features]
std = [] std = []
# Enable nightly-only features # Enable nightly-only features
nightly = ["embedded-hal-async", "embedded-storage-async"] nightly = ["embassy-futures", "embedded-hal-async", "embedded-storage-async"]
[dependencies] [dependencies]
embassy-futures = { version = "0.1.0", path = "../embassy-futures" } embassy-futures = { version = "0.1.0", path = "../embassy-futures", optional = true }
embassy-sync = { version = "0.2.0", path = "../embassy-sync" } embassy-sync = { version = "0.2.0", path = "../embassy-sync" }
embedded-hal-02 = { package = "embedded-hal", version = "0.2.6", features = [ embedded-hal-02 = { package = "embedded-hal", version = "0.2.6", features = [
"unproven", "unproven",

View File

@ -1,6 +1,5 @@
//! Adapters between embedded-hal traits. //! Adapters between embedded-hal traits.
use embassy_futures::yield_now;
use embedded_hal_02::{blocking, serial}; use embedded_hal_02::{blocking, serial};
/// Wrapper that implements async traits using blocking implementations. /// Wrapper that implements async traits using blocking implementations.
@ -151,18 +150,11 @@ where
const ERASE_SIZE: usize = <T as NorFlash>::ERASE_SIZE; const ERASE_SIZE: usize = <T as NorFlash>::ERASE_SIZE;
async fn write(&mut self, offset: u32, data: &[u8]) -> Result<(), Self::Error> { async fn write(&mut self, offset: u32, data: &[u8]) -> Result<(), Self::Error> {
self.wrapped.write(offset, data)?; self.wrapped.write(offset, data)
yield_now().await;
Ok(())
} }
async fn erase(&mut self, from: u32, to: u32) -> Result<(), Self::Error> { async fn erase(&mut self, from: u32, to: u32) -> Result<(), Self::Error> {
for from in (from..to).step_by(T::ERASE_SIZE) { self.wrapped.erase(from, to)
let to = core::cmp::min(from + T::ERASE_SIZE as u32, to);
self.wrapped.erase(from, to)?;
yield_now().await;
}
Ok(())
} }
} }
@ -179,70 +171,3 @@ where
self.wrapped.capacity() self.wrapped.capacity()
} }
} }
#[cfg(test)]
mod tests {
use super::*;
extern crate std;
#[derive(Default)]
struct FakeFlash(Vec<(u32, u32)>);
impl embedded_storage::nor_flash::ErrorType for FakeFlash {
type Error = std::convert::Infallible;
}
impl embedded_storage::nor_flash::ReadNorFlash for FakeFlash {
const READ_SIZE: usize = 1;
fn read(&mut self, _offset: u32, _bytes: &mut [u8]) -> Result<(), Self::Error> {
unimplemented!()
}
fn capacity(&self) -> usize {
unimplemented!()
}
}
impl embedded_storage::nor_flash::NorFlash for FakeFlash {
const WRITE_SIZE: usize = 4;
const ERASE_SIZE: usize = 128;
fn write(&mut self, _offset: u32, _bytes: &[u8]) -> Result<(), Self::Error> {
unimplemented!()
}
fn erase(&mut self, from: u32, to: u32) -> Result<(), Self::Error> {
self.0.push((from, to));
Ok(())
}
}
#[futures_test::test]
async fn can_erase() {
let fake = FakeFlash::default();
let mut yielding = BlockingAsync::new(fake);
yielding.erase(0, 256).await.unwrap();
let fake = yielding.wrapped;
assert_eq!(2, fake.0.len());
assert_eq!((0, 128), fake.0[0]);
assert_eq!((128, 256), fake.0[1]);
}
#[futures_test::test]
async fn can_erase_wrong_erase_size() {
let fake = FakeFlash::default();
let mut yielding = BlockingAsync::new(fake);
yielding.erase(0, 257).await.unwrap();
let fake = yielding.wrapped;
assert_eq!(3, fake.0.len());
assert_eq!((0, 128), fake.0[0]);
assert_eq!((128, 256), fake.0[1]);
assert_eq!((256, 257), fake.0[2]);
}
}

View File

@ -0,0 +1,5 @@
mod blocking_async;
mod yielding_async;
pub use blocking_async::BlockingAsync;
pub use yielding_async::YieldingAsync;

View File

@ -0,0 +1,232 @@
use embassy_futures::yield_now;
/// Wrapper that yields for each operation to the wrapped instance
///
/// This can be used in combination with BlockingAsync<T> to enforce yields
/// between long running blocking operations.
pub struct YieldingAsync<T> {
wrapped: T,
}
impl<T> YieldingAsync<T> {
/// Create a new instance of a wrapper that yields after each operation.
pub fn new(wrapped: T) -> Self {
Self { wrapped }
}
}
//
// I2C implementations
//
impl<T> embedded_hal_1::i2c::ErrorType for YieldingAsync<T>
where
T: embedded_hal_1::i2c::ErrorType,
{
type Error = T::Error;
}
impl<T> embedded_hal_async::i2c::I2c for YieldingAsync<T>
where
T: embedded_hal_async::i2c::I2c,
{
async fn read(&mut self, address: u8, read: &mut [u8]) -> Result<(), Self::Error> {
self.wrapped.read(address, read).await?;
yield_now().await;
Ok(())
}
async fn write(&mut self, address: u8, write: &[u8]) -> Result<(), Self::Error> {
self.wrapped.write(address, write).await?;
yield_now().await;
Ok(())
}
async fn write_read(&mut self, address: u8, write: &[u8], read: &mut [u8]) -> Result<(), Self::Error> {
self.wrapped.write_read(address, write, read).await?;
yield_now().await;
Ok(())
}
async fn transaction(
&mut self,
address: u8,
operations: &mut [embedded_hal_1::i2c::Operation<'_>],
) -> Result<(), Self::Error> {
self.wrapped.transaction(address, operations).await?;
yield_now().await;
Ok(())
}
}
//
// SPI implementations
//
impl<T> embedded_hal_async::spi::ErrorType for YieldingAsync<T>
where
T: embedded_hal_async::spi::ErrorType,
{
type Error = T::Error;
}
impl<T> embedded_hal_async::spi::SpiBus<u8> for YieldingAsync<T>
where
T: embedded_hal_async::spi::SpiBus,
{
async fn transfer<'a>(&'a mut self, read: &'a mut [u8], write: &'a [u8]) -> Result<(), Self::Error> {
self.wrapped.transfer(read, write).await?;
yield_now().await;
Ok(())
}
async fn transfer_in_place<'a>(&'a mut self, words: &'a mut [u8]) -> Result<(), Self::Error> {
self.wrapped.transfer_in_place(words).await?;
yield_now().await;
Ok(())
}
}
impl<T> embedded_hal_async::spi::SpiBusFlush for YieldingAsync<T>
where
T: embedded_hal_async::spi::SpiBusFlush,
{
async fn flush(&mut self) -> Result<(), Self::Error> {
self.wrapped.flush().await?;
yield_now().await;
Ok(())
}
}
impl<T> embedded_hal_async::spi::SpiBusWrite<u8> for YieldingAsync<T>
where
T: embedded_hal_async::spi::SpiBusWrite<u8>,
{
async fn write(&mut self, data: &[u8]) -> Result<(), Self::Error> {
self.wrapped.write(data).await?;
yield_now().await;
Ok(())
}
}
impl<T> embedded_hal_async::spi::SpiBusRead<u8> for YieldingAsync<T>
where
T: embedded_hal_async::spi::SpiBusRead<u8>,
{
async fn read(&mut self, data: &mut [u8]) -> Result<(), Self::Error> {
self.wrapped.read(data).await?;
yield_now().await;
Ok(())
}
}
///
/// NOR flash implementations
///
impl<T: embedded_storage::nor_flash::ErrorType> embedded_storage::nor_flash::ErrorType for YieldingAsync<T> {
type Error = T::Error;
}
impl<T: embedded_storage_async::nor_flash::ReadNorFlash> embedded_storage_async::nor_flash::ReadNorFlash
for YieldingAsync<T>
{
const READ_SIZE: usize = T::READ_SIZE;
async fn read(&mut self, offset: u32, bytes: &mut [u8]) -> Result<(), Self::Error> {
self.wrapped.read(offset, bytes).await?;
Ok(())
}
fn capacity(&self) -> usize {
self.wrapped.capacity()
}
}
impl<T: embedded_storage_async::nor_flash::NorFlash> embedded_storage_async::nor_flash::NorFlash for YieldingAsync<T> {
const WRITE_SIZE: usize = T::WRITE_SIZE;
const ERASE_SIZE: usize = T::ERASE_SIZE;
async fn write(&mut self, offset: u32, bytes: &[u8]) -> Result<(), Self::Error> {
self.wrapped.write(offset, bytes).await?;
yield_now().await;
Ok(())
}
async fn erase(&mut self, from: u32, to: u32) -> Result<(), Self::Error> {
// Yield between each actual erase
for from in (from..to).step_by(T::ERASE_SIZE) {
let to = core::cmp::min(from + T::ERASE_SIZE as u32, to);
self.wrapped.erase(from, to).await?;
yield_now().await;
}
Ok(())
}
}
#[cfg(test)]
mod tests {
use embedded_storage_async::nor_flash::NorFlash;
use super::*;
extern crate std;
#[derive(Default)]
struct FakeFlash(Vec<(u32, u32)>);
impl embedded_storage::nor_flash::ErrorType for FakeFlash {
type Error = std::convert::Infallible;
}
impl embedded_storage_async::nor_flash::ReadNorFlash for FakeFlash {
const READ_SIZE: usize = 1;
async fn read(&mut self, _offset: u32, _bytes: &mut [u8]) -> Result<(), Self::Error> {
unimplemented!()
}
fn capacity(&self) -> usize {
unimplemented!()
}
}
impl embedded_storage_async::nor_flash::NorFlash for FakeFlash {
const WRITE_SIZE: usize = 4;
const ERASE_SIZE: usize = 128;
async fn write(&mut self, _offset: u32, _bytes: &[u8]) -> Result<(), Self::Error> {
unimplemented!()
}
async fn erase(&mut self, from: u32, to: u32) -> Result<(), Self::Error> {
self.0.push((from, to));
Ok(())
}
}
#[futures_test::test]
async fn can_erase() {
let fake = FakeFlash::default();
let mut yielding = YieldingAsync::new(fake);
yielding.erase(0, 256).await.unwrap();
let fake = yielding.wrapped;
assert_eq!(2, fake.0.len());
assert_eq!((0, 128), fake.0[0]);
assert_eq!((128, 256), fake.0[1]);
}
#[futures_test::test]
async fn can_erase_wrong_erase_size() {
let fake = FakeFlash::default();
let mut yielding = YieldingAsync::new(fake);
yielding.erase(0, 257).await.unwrap();
let fake = yielding.wrapped;
assert_eq!(3, fake.0.len());
assert_eq!((0, 128), fake.0[0]);
assert_eq!((128, 256), fake.0[1]);
assert_eq!((256, 257), fake.0[2]);
}
}