Draft for partial review. Do not merge.

This commit is contained in:
Bob McWhirter 2021-05-10 16:17:58 -04:00
parent 0470abb353
commit 8a79e2cbbf

View File

@ -1,59 +1,127 @@
#![macro_use]
pub use embedded_hal::spi::{Mode, Phase, Polarity, MODE_0, MODE_1, MODE_2, MODE_3}; pub use embedded_hal::spi::{Mode, Phase, Polarity, MODE_0, MODE_1, MODE_2, MODE_3};
use core::marker::PhantomData; use core::marker::PhantomData;
use embassy::interrupt::Interrupt; use embassy::interrupt::Interrupt;
use embedded_hal::blocking::spi::Write; use embedded_hal::blocking::spi::{Write, Transfer};
use crate::pac::spi //use crate::pac::spi;
pub struct Spi<'d, T: Instance> { pub struct Spi<'d, T: Instance> {
peri: T, peri: T,
irq: T::Interrupt, //irq: T::Interrupt,
phantom: PhantomData<&'d mut T>, phantom: PhantomData<&'d mut T>,
} }
pub enum Error { pub enum Error {
Framing,
Crc,
Overrun,
} }
impl<'d, T: Instance> embedded_hal::blocking::spi::Write<u8> for Spim<'d, T> { impl<'d, T: Instance> embedded_hal::blocking::spi::Write<u8> for Spi<'d, T> {
type Error = Error; type Error = Error;
fn write(&mut self, words: &[u8]) -> Result<(), Self::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<u8> 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 super::*;
use embassy::util::AtomicWaker; use embassy::util::AtomicWaker;
pub struct State { //pub struct State {
pub end_waker: AtomicWaker, //pub end_waker: AtomicWaker,
} //}
impl State { //impl State {
pub const fn new() -> Self { //pub const fn new() -> Self {
Self { //Self {
end_waker: AtomicWaker::new(), //end_waker: AtomicWaker::new(),
} //}
} //}
} //}
pub trait Instance { pub trait Instance {
fn regs() -> &'static crate::pac::spi::Spi; fn regs() -> &'static crate::pac::spi::Spi;
fn state() -> &'static State; //fn state() -> &'static State;
} }
} }
pub trait Instance: sealed::Instance + 'static { pub trait Instance: sealed::Instance + 'static {
type Interrupt: Interrupt; //type Interrupt: Interrupt;
} }
macro_rules! impl_spi { macro_rules! impl_spi {
($inst:ident) => { ($inst:ident) => {
impl crate::spi::sealed::Instance for peripherals::$inst { impl crate::spi::sealed::Instance for peripherals::$inst {
fn regs() -> crate::pac::spi::Spi { fn regs() -> &'static crate::pac::spi::Spi {
crate::pac::$inst &crate::pac::$inst
} }
} }