diff --git a/embassy-stm32/src/spi.rs b/embassy-stm32/src/spi.rs index b4b1d3d8..3eec7742 100644 --- a/embassy-stm32/src/spi.rs +++ b/embassy-stm32/src/spi.rs @@ -1,59 +1,127 @@ +#![macro_use] + pub use embedded_hal::spi::{Mode, Phase, Polarity, MODE_0, MODE_1, MODE_2, MODE_3}; use core::marker::PhantomData; use embassy::interrupt::Interrupt; -use embedded_hal::blocking::spi::Write; -use crate::pac::spi +use embedded_hal::blocking::spi::{Write, Transfer}; +//use crate::pac::spi; pub struct Spi<'d, T: Instance> { peri: T, - irq: T::Interrupt, + //irq: T::Interrupt, phantom: PhantomData<&'d mut T>, } pub enum Error { - + Framing, + Crc, + Overrun, } -impl<'d, T: Instance> embedded_hal::blocking::spi::Write for Spim<'d, T> { +impl<'d, T: Instance> embedded_hal::blocking::spi::Write for Spi<'d, T> { type Error = Error; fn write(&mut self, words: &[u8]) -> Result<(), Self::Error> { - let mut recv: &mut [u8] = &mut []; + let regs = T::regs(); + for word in words.iter() { + while unsafe { !regs.sr().read().txe() } { + // spin + } + unsafe { + regs.dr().write(|reg| reg.0 = *word as u32); + } + loop { + let sr = unsafe { regs.sr().read() }; + if sr.fre() { + return Err(Error::Framing); + } + if sr.ovr() { + return Err(Error::Overrun); + } + if sr.crcerr() { + return Err(Error::Crc); + } + if !sr.txe() { + // loop waiting for TXE + } + } + } + + Ok(()) } } -mod sealed { +impl<'d, T: Instance> embedded_hal::blocking::spi::Transfer for Spi<'d, T> { + type Error = Error; + + fn transfer<'w>(&mut self, words: &'w mut [u8]) -> Result<&'w [u8], Self::Error> { + let regs = T::regs(); + + for word in words.iter_mut() { + while unsafe { !regs.sr().read().txe() } { + // spin + } + unsafe { + regs.dr().write(|reg| reg.0 = *word as u32); + } + while unsafe { !regs.sr().read().rxne() } { + // spin waiting for inbound to shift in. + } + *word = unsafe { regs.dr().read().0 as u8 }; + loop { + let sr = unsafe { regs.sr().read() }; + if sr.fre() { + return Err(Error::Framing); + } + if sr.ovr() { + return Err(Error::Overrun); + } + if sr.crcerr() { + return Err(Error::Crc); + } + if !sr.txe() { + // loop waiting for TXE + } + } + } + + Ok(words) + } +} + + +pub(crate) mod sealed { use super::*; use embassy::util::AtomicWaker; - pub struct State { - pub end_waker: AtomicWaker, - } + //pub struct State { + //pub end_waker: AtomicWaker, + //} - impl State { - pub const fn new() -> Self { - Self { - end_waker: AtomicWaker::new(), - } - } - } + //impl State { + //pub const fn new() -> Self { + //Self { + //end_waker: AtomicWaker::new(), + //} + //} + //} pub trait Instance { fn regs() -> &'static crate::pac::spi::Spi; - fn state() -> &'static State; + //fn state() -> &'static State; } } pub trait Instance: sealed::Instance + 'static { - type Interrupt: Interrupt; + //type Interrupt: Interrupt; } macro_rules! impl_spi { ($inst:ident) => { impl crate::spi::sealed::Instance for peripherals::$inst { - fn regs() -> crate::pac::spi::Spi { - crate::pac::$inst + fn regs() -> &'static crate::pac::spi::Spi { + &crate::pac::$inst } }