Implement BufRead for nrf BufferedUarte

This commit is contained in:
chemicstry 2022-05-26 23:15:06 +03:00
parent 667abe6d1d
commit c3b899c470
2 changed files with 47 additions and 15 deletions

View File

@ -236,6 +236,48 @@ impl<'d, U: UarteInstance, T: TimerInstance> embedded_io::asynch::Read for Buffe
} }
} }
impl<'d, U: UarteInstance, T: TimerInstance> embedded_io::asynch::BufRead
for BufferedUarte<'d, U, T>
{
type FillBufFuture<'a> = impl Future<Output = Result<&'a [u8], Self::Error>>
where
Self: 'a;
fn fill_buf<'a>(&'a mut self) -> Self::FillBufFuture<'a> {
poll_fn(move |cx| {
self.inner.with(|state| {
compiler_fence(Ordering::SeqCst);
trace!("fill_buf");
// We have data ready in buffer? Return it.
let buf = state.rx.pop_buf();
if !buf.is_empty() {
trace!(" got {:?} {:?}", buf.as_ptr() as u32, buf.len());
let buf: &[u8] = buf;
// Safety: buffer lives as long as uart
let buf: &[u8] = unsafe { core::mem::transmute(buf) };
return Poll::Ready(Ok(buf));
}
trace!(" empty");
state.rx_waker.register(cx.waker());
Poll::<Result<&[u8], Self::Error>>::Pending
})
})
}
fn consume(&mut self, amt: usize) {
let signal = self.inner.with(|state| {
let full = state.rx.is_full();
state.rx.pop(amt);
full
});
if signal {
self.inner.pend();
}
}
}
impl<'d, U: UarteInstance, T: TimerInstance> embedded_io::asynch::Write impl<'d, U: UarteInstance, T: TimerInstance> embedded_io::asynch::Write
for BufferedUarte<'d, U, T> for BufferedUarte<'d, U, T>
{ {

View File

@ -6,7 +6,7 @@ use defmt::*;
use embassy::executor::Spawner; use embassy::executor::Spawner;
use embassy_nrf::buffered_uarte::State; use embassy_nrf::buffered_uarte::State;
use embassy_nrf::{buffered_uarte::BufferedUarte, interrupt, uarte, Peripherals}; use embassy_nrf::{buffered_uarte::BufferedUarte, interrupt, uarte, Peripherals};
use embedded_io::asynch::{Read, Write}; use embedded_io::asynch::{BufRead, Write};
use futures::pin_mut; use futures::pin_mut;
use defmt_rtt as _; // global logger use defmt_rtt as _; // global logger
@ -46,23 +46,13 @@ async fn main(_spawner: Spawner, p: Peripherals) {
unwrap!(u.write_all(b"Hello!\r\n").await); unwrap!(u.write_all(b"Hello!\r\n").await);
info!("wrote hello in uart!"); info!("wrote hello in uart!");
// Simple demo, reading 8-char chunks and echoing them back reversed.
loop { loop {
info!("reading..."); info!("reading...");
let mut buf = [0u8; 8]; let buf = unwrap!(u.fill_buf().await);
unwrap!(u.read_exact(&mut buf).await);
info!("read done, got {}", buf); info!("read done, got {}", buf);
// Reverse buf // Read bytes have to be explicitly consumed, otherwise fill_buf() will return them again
for i in 0..4 { let n = buf.len();
buf.swap(i, 7 - i); u.consume(n);
}
info!("writing...");
unwrap!(u.write_all(&buf).await);
info!("write done");
// Wait until the bytes are actually finished being transmitted
unwrap!(u.flush().await);
} }
} }