Merge branch 'spis' of github.com:kalkyl/embassy into spis

This commit is contained in:
Henrik Alsér 2022-11-22 00:55:46 +01:00
commit 33ee48b9e8
3 changed files with 31 additions and 39 deletions

View file

@ -268,5 +268,12 @@ pub fn init(config: config::Config) -> Peripherals {
#[cfg(feature = "_time-driver")] #[cfg(feature = "_time-driver")]
time_driver::init(config.time_interrupt_priority); time_driver::init(config.time_interrupt_priority);
// Disable UARTE (enabled by default for some reason)
#[cfg(feature = "_nrf9160")]
unsafe {
(*pac::UARTE0::ptr()).enable.write(|w| w.enable().disabled());
(*pac::UARTE1::ptr()).enable.write(|w| w.enable().disabled());
}
peripherals peripherals
} }

View file

@ -1,5 +1,4 @@
#![macro_use] #![macro_use]
use core::future::poll_fn; use core::future::poll_fn;
use core::sync::atomic::{compiler_fence, Ordering}; use core::sync::atomic::{compiler_fence, Ordering};
use core::task::Poll; use core::task::Poll;
@ -10,7 +9,7 @@ pub use embedded_hal_02::spi::{Mode, Phase, Polarity, MODE_0, MODE_1, MODE_2, MO
use crate::chip::FORCE_COPY_BUFFER_SIZE; use crate::chip::FORCE_COPY_BUFFER_SIZE;
use crate::gpio::sealed::Pin as _; use crate::gpio::sealed::Pin as _;
use crate::gpio::{self, AnyPin, Pin as GpioPin, PselBits}; use crate::gpio::{self, AnyPin, Pin as GpioPin};
use crate::interrupt::{Interrupt, InterruptExt}; use crate::interrupt::{Interrupt, InterruptExt};
use crate::util::{slice_in_ram_or, slice_ptr_parts, slice_ptr_parts_mut}; use crate::util::{slice_in_ram_or, slice_ptr_parts, slice_ptr_parts_mut};
use crate::{pac, Peripheral}; use crate::{pac, Peripheral};
@ -122,40 +121,25 @@ impl<'d, T: Instance> Spis<'d, T> {
mosi: Option<PeripheralRef<'d, AnyPin>>, mosi: Option<PeripheralRef<'d, AnyPin>>,
config: Config, config: Config,
) -> Self { ) -> Self {
into_ref!(cs, spis, irq); compiler_fence(Ordering::SeqCst);
into_ref!(spis, irq, cs, sck);
let r = T::regs(); let r = T::regs();
// Configure pins. // Configure pins.
sck.conf().write(|w| w.input().connect().drive().h0h1()); sck.conf().write(|w| w.input().connect().drive().h0h1());
r.psel.sck.write(|w| unsafe { w.bits(sck.psel_bits()) });
cs.conf().write(|w| w.input().connect().drive().h0h1()); cs.conf().write(|w| w.input().connect().drive().h0h1());
r.psel.csn.write(|w| unsafe { w.bits(cs.psel_bits()) });
if let Some(mosi) = &mosi { if let Some(mosi) = &mosi {
mosi.conf().write(|w| w.input().connect().drive().h0h1()); mosi.conf().write(|w| w.input().connect().drive().h0h1());
r.psel.mosi.write(|w| unsafe { w.bits(mosi.psel_bits()) });
} }
if let Some(miso) = &miso { if let Some(miso) = &miso {
miso.conf().write(|w| w.dir().output().drive().h0h1()); miso.conf().write(|w| w.dir().output().drive().h0h1());
}
match config.mode.polarity {
Polarity::IdleHigh => {
sck.set_high();
if let Some(mosi) = &mosi {
mosi.set_high();
}
}
Polarity::IdleLow => {
sck.set_low();
if let Some(mosi) = &mosi {
mosi.set_low();
}
}
}
// Select pins.
r.psel.sck.write(|w| unsafe { w.bits(sck.psel_bits()) });
r.psel.csn.write(|w| unsafe { w.bits(cs.psel_bits()) });
r.psel.mosi.write(|w| unsafe { w.bits(mosi.psel_bits()) });
r.psel.miso.write(|w| unsafe { w.bits(miso.psel_bits()) }); r.psel.miso.write(|w| unsafe { w.bits(miso.psel_bits()) });
}
// Enable SPIS instance. // Enable SPIS instance.
r.enable.write(|w| w.enable().enabled()); r.enable.write(|w| w.enable().enabled());
@ -217,12 +201,12 @@ impl<'d, T: Instance> Spis<'d, T> {
let s = T::state(); let s = T::state();
if r.events_end.read().bits() != 0 { if r.events_end.read().bits() != 0 {
s.end_waker.wake(); s.waker.wake();
r.intenclr.write(|w| w.end().clear()); r.intenclr.write(|w| w.end().clear());
} }
if r.events_acquired.read().bits() != 0 { if r.events_acquired.read().bits() != 0 {
s.acquire_waker.wake(); s.waker.wake();
r.intenclr.write(|w| w.acquired().clear()); r.intenclr.write(|w| w.acquired().clear());
} }
} }
@ -246,9 +230,8 @@ impl<'d, T: Instance> Spis<'d, T> {
r.rxd.ptr.write(|w| unsafe { w.ptr().bits(ptr as _) }); r.rxd.ptr.write(|w| unsafe { w.ptr().bits(ptr as _) });
r.rxd.maxcnt.write(|w| unsafe { w.maxcnt().bits(len as _) }); r.rxd.maxcnt.write(|w| unsafe { w.maxcnt().bits(len as _) });
// Reset and enable the end event. // Reset end event.
r.events_end.reset(); r.events_end.reset();
r.intenset.write(|w| w.end().set());
// Release the semaphore. // Release the semaphore.
r.tasks_release.write(|w| unsafe { w.bits(1) }); r.tasks_release.write(|w| unsafe { w.bits(1) });
@ -312,8 +295,9 @@ impl<'d, T: Instance> Spis<'d, T> {
// Wait until CPU has acquired the semaphore. // Wait until CPU has acquired the semaphore.
poll_fn(|cx| { poll_fn(|cx| {
s.acquire_waker.register(cx.waker()); s.waker.register(cx.waker());
if r.semstat.read().bits() == 1 { if r.events_acquired.read().bits() == 1 {
r.events_acquired.reset();
return Poll::Ready(()); return Poll::Ready(());
} }
Poll::Pending Poll::Pending
@ -324,12 +308,13 @@ impl<'d, T: Instance> Spis<'d, T> {
self.prepare(rx, tx)?; self.prepare(rx, tx)?;
// Wait for 'end' event. // Wait for 'end' event.
r.intenset.write(|w| w.end().set());
poll_fn(|cx| { poll_fn(|cx| {
s.end_waker.register(cx.waker()); s.waker.register(cx.waker());
if r.events_end.read().bits() != 0 { if r.events_end.read().bits() != 0 {
r.events_end.reset();
return Poll::Ready(()); return Poll::Ready(());
} }
Poll::Pending Poll::Pending
}) })
.await; .await;
@ -466,15 +451,13 @@ pub(crate) mod sealed {
use super::*; use super::*;
pub struct State { pub struct State {
pub end_waker: AtomicWaker, pub waker: AtomicWaker,
pub acquire_waker: AtomicWaker,
} }
impl State { impl State {
pub const fn new() -> Self { pub const fn new() -> Self {
Self { Self {
end_waker: AtomicWaker::new(), waker: AtomicWaker::new(),
acquire_waker: AtomicWaker::new(),
} }
} }
} }

View file

@ -17,9 +17,11 @@ async fn main(_spawner: Spawner) {
let mut spis = Spis::new(p.SPI2, irq, p.P0_31, p.P0_29, p.P0_28, p.P0_30, Config::default()); let mut spis = Spis::new(p.SPI2, irq, p.P0_31, p.P0_29, p.P0_28, p.P0_30, Config::default());
loop { loop {
let mut buf = [0_u8; 64]; let mut rx_buf = [0_u8; 64];
if let Ok(n) = spis.read(&mut buf).await { let tx_buf = [1_u8, 2, 3, 4, 5, 6, 7, 8];
info!("RX: {:?}", buf[..n]); if let Ok((n_rx, n_tx)) = spis.transfer(&mut rx_buf, &tx_buf).await {
info!("RX: {:?}", rx_buf[..n_rx]);
info!("TX: {:?}", tx_buf[..n_tx]);
} }
} }
} }