From cbc7c88112865624e256bf70b8e34aaa224b1a76 Mon Sep 17 00:00:00 2001 From: Robin Mueller Date: Sat, 20 Nov 2021 23:57:08 +0100 Subject: [PATCH] Added SPI implementation - First SPI HAL implementation for blocking mode - Added example for SPI as well which uses loopback mode and regular mode --- CHANGELOG.md | 1 + examples/spi.rs | 175 +++++++++++ examples/tests.rs | 2 +- src/lib.rs | 4 +- src/spi.rs | 716 ++++++++++++++++++++++++++++++++++++++++++++++ src/uart.rs | 26 +- 6 files changed, 908 insertions(+), 16 deletions(-) create mode 100644 examples/spi.rs create mode 100644 src/spi.rs diff --git a/CHANGELOG.md b/CHANGELOG.md index 8ebf0c4..492d498 100644 --- a/CHANGELOG.md +++ b/CHANGELOG.md @@ -11,6 +11,7 @@ and this project adheres to [Semantic Versioning](http://semver.org/). ### Added - DelayUs and DelayMs trait implementations for timer +- SPI implementation for blocking API ## [0.2.1] diff --git a/examples/spi.rs b/examples/spi.rs new file mode 100644 index 0000000..e714a6e --- /dev/null +++ b/examples/spi.rs @@ -0,0 +1,175 @@ +//! SPI example application +#![no_main] +#![no_std] + +use core::cell::RefCell; + +use cortex_m_rt::entry; +use embedded_hal::spi::{Mode, MODE_0}; +use panic_rtt_target as _; +use rtt_target::{rprintln, rtt_init_print}; +use va108xx_hal::{ + gpio::{PinsA, PinsB}, + pac::{self, SPIA, SPIB}, + prelude::*, + spi::{self, NoneT, Spi, SpiBase, TransferConfig}, + timer::CountDownTimer, +}; + +#[derive(PartialEq, Debug)] +pub enum ExampleSelect { + // Enter loopback mode. It is not necessary to tie MOSI/MISO together for this + Loopback, + // Send a test buffer and print everything received + TestBuffer, +} + +#[derive(PartialEq, Debug)] +pub enum SpiBusSelect { + SpiAPortA, + SpiAPortB, + SpiBPortB, +} + +const EXAMPLE_SEL: ExampleSelect = ExampleSelect::Loopback; +const SPI_BUS_SEL: SpiBusSelect = SpiBusSelect::SpiBPortB; +const SPI_SPEED_KHZ: u32 = 1000; +const SPI_MODE: Mode = MODE_0; +const BLOCKMODE: bool = false; + +#[entry] +fn main() -> ! { + rtt_init_print!(); + rprintln!("-- VA108xx SPI example application--"); + let mut dp = pac::Peripherals::take().unwrap(); + + let spia_ref: RefCell>> = RefCell::new(None); + let spib_ref: RefCell>> = RefCell::new(None); + let mut spi_cfg = spi::SpiConfig::default(); + if EXAMPLE_SEL == ExampleSelect::Loopback { + spi_cfg = spi_cfg.loopback(true) + } + + match SPI_BUS_SEL { + SpiBusSelect::SpiAPortA => { + let pinsa = PinsA::new(&mut dp.SYSCONFIG, None, dp.PORTA); + let (sck, mosi, miso) = ( + pinsa.pa31.into_funsel_1(), + pinsa.pa30.into_funsel_1(), + pinsa.pa29.into_funsel_1(), + ); + spia_ref.borrow_mut().replace( + Spi::spia::( + dp.SPIA, + (sck, miso, mosi), + 50.mhz().into(), + spi_cfg, + Some(&mut dp.SYSCONFIG), + None, + ) + .downgrade(), + ); + } + SpiBusSelect::SpiAPortB => { + let pinsb = PinsB::new(&mut dp.SYSCONFIG, Some(dp.IOCONFIG), dp.PORTB); + let (sck, mosi, miso) = ( + pinsb.pb9.into_funsel_2(), + pinsb.pb8.into_funsel_2(), + pinsb.pb7.into_funsel_2(), + ); + spia_ref.borrow_mut().replace( + Spi::spia::( + dp.SPIA, + (sck, miso, mosi), + 50.mhz().into(), + spi_cfg, + Some(&mut dp.SYSCONFIG), + None, + ) + .downgrade(), + ); + } + SpiBusSelect::SpiBPortB => { + let pinsb = PinsB::new(&mut dp.SYSCONFIG, Some(dp.IOCONFIG), dp.PORTB); + let (sck, mosi, miso) = ( + pinsb.pb5.into_funsel_1(), + pinsb.pb4.into_funsel_1(), + pinsb.pb3.into_funsel_1(), + ); + spib_ref.borrow_mut().replace( + Spi::spib::( + dp.SPIB, + (sck, miso, mosi), + 50.mhz().into(), + spi_cfg, + Some(&mut dp.SYSCONFIG), + None, + ) + .downgrade(), + ); + } + } + let mut delay_tim = CountDownTimer::tim1(&mut dp.SYSCONFIG, 50.mhz().into(), dp.TIM1); + loop { + match SPI_BUS_SEL { + SpiBusSelect::SpiAPortA | SpiBusSelect::SpiAPortB => { + if let Some(ref mut spi) = *spia_ref.borrow_mut() { + let transfer_cfg: TransferConfig = TransferConfig { + spi_clk: SPI_SPEED_KHZ.khz().into(), + blockmode: BLOCKMODE, + hw_cs: None, + mode: SPI_MODE, + sod: false, + }; + spi.cfg_transfer(&transfer_cfg); + if EXAMPLE_SEL == ExampleSelect::Loopback { + nb::block!(spi.send(0x42_u8)).unwrap(); + let word = nb::block!(spi.read()).unwrap(); + assert_eq!(word, 0x42); + delay_tim.delay_ms(500_u32); + + let mut send_buf: [u8; 3] = [0x03, 0x02, 0x01]; + let reply = spi.transfer(&mut send_buf).unwrap(); + rprintln!("Received reply: {}, {}, {}", reply[0], reply[1], reply[2]); + assert_eq!(reply, &[0x03, 0x02, 0x01]); + delay_tim.delay_ms(500_u32); + } else { + let mut send_buf: [u8; 3] = [0x00, 0x01, 0x02]; + let reply = spi.transfer(&mut send_buf).unwrap(); + rprintln!("Received reply: {}, {}, {}", reply[0], reply[1], reply[2]); + delay_tim.delay_ms(1000_u32); + } + } + } + SpiBusSelect::SpiBPortB => { + if let Some(ref mut spi) = *spib_ref.borrow_mut() { + let transfer_cfg: TransferConfig = TransferConfig { + spi_clk: SPI_SPEED_KHZ.khz().into(), + blockmode: BLOCKMODE, + hw_cs: None, + mode: SPI_MODE, + sod: false, + }; + spi.cfg_transfer(&transfer_cfg); + if EXAMPLE_SEL == ExampleSelect::Loopback { + nb::block!(spi.send(0x42_u8)).unwrap(); + let word = nb::block!(spi.read()).unwrap(); + assert_eq!(word, 0x42); + delay_tim.delay_ms(500_u32); + + let mut send_buf: [u8; 3] = [0x03, 0x02, 0x01]; + let reply = spi.transfer(&mut send_buf).unwrap(); + rprintln!("Received reply: {}, {}, {}", reply[0], reply[1], reply[2]); + assert_eq!(reply, &[0x03, 0x02, 0x01]); + delay_tim.delay_ms(500_u32); + } else { + let mut send_buf: [u8; 3] = [0x00, 0x01, 0x02]; + let reply = spi.transfer(&mut send_buf).unwrap(); + rprintln!("Received reply: {}, {}, {}", reply[0], reply[1], reply[2]); + delay_tim.delay_ms(1000_u32); + } + } + } + } + } +} diff --git a/examples/tests.rs b/examples/tests.rs index 9b3452c..35e05d3 100644 --- a/examples/tests.rs +++ b/examples/tests.rs @@ -44,7 +44,7 @@ fn main() -> ! { let pinsa = PinsA::new(&mut dp.SYSCONFIG, None, dp.PORTA); let pinsb = PinsB::new(&mut dp.SYSCONFIG, Some(dp.IOCONFIG), dp.PORTB); let mut led1 = pinsa.pa10.into_push_pull_output(); - let test_case = TestCase::DelayMs; + let test_case = TestCase::DelayGpio; match test_case { TestCase::TestBasic diff --git a/src/lib.rs b/src/lib.rs index def728a..adc3ba2 100644 --- a/src/lib.rs +++ b/src/lib.rs @@ -1,17 +1,17 @@ #![no_std] pub use va108xx; +pub use va108xx as pac; pub mod clock; pub mod gpio; pub mod prelude; +pub mod spi; pub mod time; pub mod timer; pub mod typelevel; pub mod uart; -pub use va108xx as pac; - mod private { /// Super trait used to mark traits with an exhaustive set of /// implementations diff --git a/src/spi.rs b/src/spi.rs new file mode 100644 index 0000000..65c6325 --- /dev/null +++ b/src/spi.rs @@ -0,0 +1,716 @@ +//! API for the SPI peripheral +use crate::Sealed; +use crate::{ + clock::{enable_peripheral_clock, PeripheralClocks}, + gpio::pins::{ + AltFunc1, AltFunc2, AltFunc3, Pin, PA10, PA11, PA12, PA13, PA14, PA15, PA16, PA17, PA18, + PA19, PA20, PA21, PA22, PA23, PA24, PA25, PA26, PA27, PA28, PA29, PA30, PA31, PB0, PB1, + PB10, PB11, PB12, PB13, PB14, PB15, PB16, PB17, PB18, PB19, PB2, PB22, PB23, PB3, PB4, PB5, + PB6, PB7, PB8, PB9, + }, + pac::{SPIA, SPIB, SPIC, SYSCONFIG}, + time::Hertz, +}; +use core::{convert::Infallible, fmt::Debug, marker::PhantomData}; +use embedded_hal::{ + blocking, + spi::{FullDuplex, Mode, MODE_0, MODE_1, MODE_2, MODE_3}, +}; + +//================================================================================================== +// Defintions +//================================================================================================== + +#[derive(Debug, PartialEq, Copy, Clone)] +pub enum HwChipSelectId { + Id0 = 0, + Id1 = 1, + Id2 = 2, + Id3 = 3, + Id4 = 4, + Id5 = 5, + Id6 = 6, + Id7 = 7, + Invalid = 0xff, +} + +#[derive(Debug, PartialEq, Copy, Clone)] +pub enum WordSize { + OneBit = 0x00, + FourBits = 0x03, + EightBits = 0x07, + SixteenBits = 0x0f, +} + +//================================================================================================== +// Pin type definitions +//================================================================================================== + +pub trait PinSck: Sealed {} +pub trait PinMosi: Sealed {} +pub trait PinMiso: Sealed {} + +pub trait OptionalHwCs: Sealed { + const CS_ID: HwChipSelectId; +} + +macro_rules! hw_cs_pin { + ($SPIx:ident, $PXx:ident, $AFx:ident, $HwCsIdent:path, $typedef:ident) => { + impl OptionalHwCs<$SPIx> for Pin<$PXx, $AFx> { + const CS_ID: HwChipSelectId = $HwCsIdent; + } + pub type $typedef = Pin<$PXx, $AFx>; + }; +} + +impl OptionalHwCs for NoneT { + const CS_ID: HwChipSelectId = HwChipSelectId::Invalid; +} +impl OptionalHwCs for NoneT { + const CS_ID: HwChipSelectId = HwChipSelectId::Invalid; +} + +// SPIA + +impl PinSck for Pin {} +impl PinMosi for Pin {} +impl PinMiso for Pin {} + +pub type SpiAPortASck = Pin; +pub type SpiAPortAMosi = Pin; +pub type SpiAPortAMiso = Pin; + +impl PinSck for Pin {} +impl PinMosi for Pin {} +impl PinMiso for Pin {} + +pub type SpiAPortBSck = Pin; +pub type SpiAPortBMosi = Pin; +pub type SpiAPortBMiso = Pin; + +hw_cs_pin!(SPIA, PA28, AltFunc1, HwChipSelectId::Id0, HwCs0SpiAPortA); +hw_cs_pin!(SPIA, PA27, AltFunc1, HwChipSelectId::Id1, HwCs1SpiAPortA); +hw_cs_pin!(SPIA, PA26, AltFunc1, HwChipSelectId::Id2, HwCs2SpiAPortA); +hw_cs_pin!(SPIA, PA25, AltFunc1, HwChipSelectId::Id3, HwCs3SpiAPortA); +hw_cs_pin!(SPIA, PA24, AltFunc1, HwChipSelectId::Id4, HwCs4SpiAPortA); +hw_cs_pin!(SPIA, PA23, AltFunc1, HwChipSelectId::Id5, HwCs5SpiAPortA); +hw_cs_pin!(SPIA, PA22, AltFunc1, HwChipSelectId::Id6, HwCs6SpiAPortA); +hw_cs_pin!(SPIA, PA21, AltFunc1, HwChipSelectId::Id7, HwCs7SpiAPortA); + +hw_cs_pin!(SPIA, PB6, AltFunc2, HwChipSelectId::Id0, HwCs0SpiAPortB); +hw_cs_pin!(SPIA, PB5, AltFunc2, HwChipSelectId::Id6, HwCs6SpiAPortB); +hw_cs_pin!(SPIA, PB4, AltFunc2, HwChipSelectId::Id5, HwCs5SpiAPortB); +hw_cs_pin!(SPIA, PB3, AltFunc2, HwChipSelectId::Id4, HwCs4SpiAPortB); +hw_cs_pin!(SPIA, PB2, AltFunc2, HwChipSelectId::Id3, HwCs3SpiAPortB); +hw_cs_pin!(SPIA, PB1, AltFunc2, HwChipSelectId::Id2, HwCs2SpiAPortB); +hw_cs_pin!(SPIA, PB0, AltFunc2, HwChipSelectId::Id1, HwCs1SpiAPortB); + +// SPIB + +impl PinSck for Pin {} +impl PinMosi for Pin {} +impl PinMiso for Pin {} + +pub type SpiBPortASck = Pin; +pub type SpiBPortAMosi = Pin; +pub type SpiBPortAMiso = Pin; + +impl PinSck for Pin {} +impl PinMosi for Pin {} +impl PinMiso for Pin {} + +impl PinSck for Pin {} +impl PinMosi for Pin {} +impl PinMiso for Pin {} + +hw_cs_pin!(SPIB, PB16, AltFunc1, HwChipSelectId::Id0, HwCs0SpiBPortB0); +hw_cs_pin!(SPIB, PB15, AltFunc1, HwChipSelectId::Id1, HwCs1SpiBPortB0); +hw_cs_pin!(SPIB, PB14, AltFunc1, HwChipSelectId::Id2, HwCs2SpiBPortB0); +hw_cs_pin!(SPIB, PB13, AltFunc1, HwChipSelectId::Id3, HwCs3SpiBPortB); +hw_cs_pin!(SPIB, PB12, AltFunc1, HwChipSelectId::Id4, HwCs4SpiBPortB); +hw_cs_pin!(SPIB, PB11, AltFunc1, HwChipSelectId::Id5, HwCs5SpiBPortB); +hw_cs_pin!(SPIB, PB10, AltFunc1, HwChipSelectId::Id6, HwCs6SpiBPortB); + +hw_cs_pin!(SPIB, PB2, AltFunc1, HwChipSelectId::Id0, HwCs0SpiBPortB1); +hw_cs_pin!(SPIB, PB1, AltFunc1, HwChipSelectId::Id1, HwCs1SpiBPortB1); +hw_cs_pin!(SPIB, PB0, AltFunc1, HwChipSelectId::Id2, HwCs2SpiBPortB1); + +hw_cs_pin!(SPIB, PB12, AltFunc2, HwChipSelectId::Id0, HwCs0SpiBPortB2); +hw_cs_pin!(SPIB, PB11, AltFunc2, HwChipSelectId::Id1, HwCs1SpiBPortB2); +hw_cs_pin!(SPIB, PB10, AltFunc2, HwChipSelectId::Id2, HwCs2SpiBPortB2); + +hw_cs_pin!(SPIB, PA17, AltFunc2, HwChipSelectId::Id0, HwCs0SpiBPortA); +hw_cs_pin!(SPIB, PA16, AltFunc2, HwChipSelectId::Id1, HwCs1SpiBPortA); +hw_cs_pin!(SPIB, PA15, AltFunc2, HwChipSelectId::Id2, HwCs2SpiBPortA); +hw_cs_pin!(SPIB, PA14, AltFunc2, HwChipSelectId::Id3, HwCs3SpiBPortA); +hw_cs_pin!(SPIB, PA13, AltFunc2, HwChipSelectId::Id4, HwCs4SpiBPortA); +hw_cs_pin!(SPIB, PA12, AltFunc2, HwChipSelectId::Id5, HwCs5SpiBPortA0); +hw_cs_pin!(SPIB, PA11, AltFunc2, HwChipSelectId::Id6, HwCs6SpiBPortA0); +hw_cs_pin!(SPIB, PA10, AltFunc2, HwChipSelectId::Id7, HwCs7SpiBPortA0); + +hw_cs_pin!(SPIB, PA23, AltFunc2, HwChipSelectId::Id5, HwCs5SpiBPortA1); +hw_cs_pin!(SPIB, PA22, AltFunc2, HwChipSelectId::Id6, HwCs6SpiBPortA1); +hw_cs_pin!(SPIB, PA21, AltFunc2, HwChipSelectId::Id7, HwCs7SpiBPortA1); + +// SPIC + +hw_cs_pin!(SPIC, PB9, AltFunc3, HwChipSelectId::Id1, HwCs1SpiCPortB0); +hw_cs_pin!(SPIC, PB8, AltFunc3, HwChipSelectId::Id2, HwCs2SpiCPortB0); +hw_cs_pin!(SPIC, PB7, AltFunc3, HwChipSelectId::Id3, HwCs3SpiCPortB); + +hw_cs_pin!(SPIC, PB22, AltFunc3, HwChipSelectId::Id1, HwCs1SpiCPortB1); +hw_cs_pin!(SPIC, PB23, AltFunc3, HwChipSelectId::Id2, HwCs2SpiCPortB1); + +hw_cs_pin!(SPIC, PA20, AltFunc1, HwChipSelectId::Id1, HwCs1SpiCPortA0); +hw_cs_pin!(SPIC, PA19, AltFunc1, HwChipSelectId::Id2, HwCs2SpiCPortA0); +hw_cs_pin!(SPIC, PB18, AltFunc1, HwChipSelectId::Id3, HwCs3SpiCPortA0); + +hw_cs_pin!(SPIC, PA23, AltFunc3, HwChipSelectId::Id1, HwCs1SpiCPortA1); +hw_cs_pin!(SPIC, PA22, AltFunc3, HwChipSelectId::Id2, HwCs2SpiCPortA1); +hw_cs_pin!(SPIC, PA21, AltFunc3, HwChipSelectId::Id3, HwCs3SpiCPortA1); +hw_cs_pin!(SPIC, PA20, AltFunc3, HwChipSelectId::Id4, HwCs4SpiCPortA); + +//================================================================================================== +// Config +//================================================================================================== + +pub trait GenericTransferConfig { + fn sod(&mut self, sod: bool); + fn blockmode(&mut self, blockmode: bool); + fn mode(&mut self, mode: Mode); + fn frequency(&mut self, spi_clk: Hertz); +} + +#[derive(Copy, Clone)] +pub struct TransferConfig { + pub spi_clk: Hertz, + pub mode: Mode, + /// This only works if the Slave Output Disable (SOD) bit of the [`SpiConfig`] is set to + /// false + pub hw_cs: Option, + pub sod: bool, + pub blockmode: bool, +} + +impl GenericTransferConfig for TransferConfig { + /// Slave Output Disable + fn sod(&mut self, sod: bool) { + self.sod = sod; + } + + fn blockmode(&mut self, blockmode: bool) { + self.blockmode = blockmode; + } + + fn mode(&mut self, mode: Mode) { + self.mode = mode; + } + + fn frequency(&mut self, spi_clk: Hertz) { + self.spi_clk = spi_clk; + } +} + +/// Configuration options for a single transfer. These can be used to reconfigure the SPI bus +/// for transaction to different devices +impl> TransferConfig { + pub fn cfg_spia(spi_clk: Hertz, mode: Mode, hw_cs: Option) -> Self { + TransferConfig { + spi_clk, + mode, + hw_cs, + sod: false, + blockmode: false, + } + } +} + +impl> TransferConfig { + pub fn cfg_spib(spi_clk: Hertz, mode: Mode, hw_cs: Option) -> Self { + TransferConfig { + spi_clk, + mode, + hw_cs, + sod: false, + blockmode: false, + } + } +} + +#[derive(Default)] +/// Configuration options for the whole SPI bus. See Programmer Guide p.92 for more details +pub struct SpiConfig { + /// Serial clock rate divider. Together with the CLKPRESCALE register, it determines + /// the SPI clock rate in master mode. 0 by default. Specifying a higher value + /// limits the maximum attainable SPI speed + pub scrdv: u8, + /// By default, configure SPI for master mode (ms == false) + ms: bool, + /// Slave output disable. Useful if separate GPIO pins or decoders are used for CS control + sod: bool, + /// Loopback mode. If you use this, don't connect MISO to MOSI, they will be tied internally + lbm: bool, + /// Enable Master Delayer Capture Mode. See Programmers Guide p.92 for more details + pub mdlycap: bool, +} + +impl SpiConfig { + pub fn loopback(mut self, enable: bool) -> Self { + self.lbm = enable; + self + } + + pub fn master_mode(mut self, master: bool) -> Self { + self.ms = !master; + self + } + + pub fn slave_output_disable(mut self, sod: bool) -> Self { + self.sod = sod; + self + } +} + +//================================================================================================== +// Word Size +//================================================================================================== + +/// Configuration trait for the Word Size +/// used by the SPI peripheral +pub trait Word { + fn word_reg() -> u8; +} + +impl Word for u8 { + fn word_reg() -> u8 { + 0x07 + } +} + +impl Word for u16 { + fn word_reg() -> u8 { + 0x0f + } +} + +//================================================================================================== +// Spi +//================================================================================================== + +pub struct SpiBase { + spi: SPI, + cfg: SpiConfig, + sys_clk: Hertz, + _word: PhantomData, +} +pub struct Spi { + spi_base: SpiBase, + pins: PINS, +} + +// Re-export this so it can be used for the constructor +pub use crate::typelevel::NoneT; + +macro_rules! spi { + ($($SPIX:ident: ($spix:ident, $clk_enb:path) => ($($WORD:ident),+),)+) => { + $( + impl, Miso: PinMiso<$SPIX>, Mosi: PinMosi<$SPIX>, + WORD: Word> Spi<$SPIX, (Sck, Miso, Mosi), WORD> + { + /// Create a new SPI struct + /// + /// This function has the optional feature to transfer the configuration. + /// This configuration struct requires a generic type information to enforce + /// the correct configuration of hardware chip select pins. If you are not using + /// this feature you can use + /// + /// ``` + /// let spia = Spi::spia::( + /// ... + /// ) + /// ``` + /// + /// in the function call + /// + /// ## Arguments + /// * `transfer_cfg` - Transfer configuration which includes configuration + /// which can change across individual SPI transfers like SPI mode or SPI clock. + /// If only one device is connected, this configuration only needs to be done + /// once. + /// * `syscfg` - Can be passed optionally to enable the peripheral clock + pub fn $spix>( + spi: $SPIX, + pins: (Sck, Miso, Mosi), + sys_clk: Hertz, + spi_cfg: SpiConfig, + syscfg: Option<&mut SYSCONFIG>, + transfer_cfg: Option<&TransferConfig>, + ) -> Self { + if let Some(syscfg) = syscfg { + enable_peripheral_clock(syscfg, $clk_enb); + } + let SpiConfig { + scrdv, + ms, + sod, + lbm, + mdlycap, + } = spi_cfg; + let mut mode = MODE_0; + let mut clk_prescale = 0x02; + let mut ss = 0; + if let Some(transfer_cfg) = transfer_cfg { + mode = transfer_cfg.mode; + clk_prescale = sys_clk.0 / (transfer_cfg.spi_clk.0 * (scrdv as u32 + 1)); + if transfer_cfg.hw_cs.is_some() { + ss = HwCs::CS_ID as u8; + } + } + + let (cpo_bit, cph_bit) = match mode { + MODE_0 => (false, false), + MODE_1 => (false, true), + MODE_2 => (true, false), + MODE_3 => (true, true), + }; + spi.ctrl0.write(|w| { + unsafe { + w.size().bits(WORD::word_reg()); + w.scrdv().bits(scrdv); + // Clear clock phase and polarity. Will be set to correct value for each + // transfer + w.spo().bit(cpo_bit); + w.sph().bit(cph_bit) + } + }); + spi.ctrl1.write(|w| { + w.lbm().bit(lbm); + w.sod().bit(sod); + w.ms().bit(ms); + w.mdlycap().bit(mdlycap); + unsafe { w.ss().bits(ss) } + }); + + spi.fifo_clr.write(|w| { + w.rxfifo().set_bit(); + w.txfifo().set_bit() + }); + spi.clkprescale.write(|w| unsafe { w.bits(clk_prescale) }); + // Enable the peripheral as the last step as recommended in the + // programmers guide + spi.ctrl1.modify(|_, w| w.enable().set_bit()); + Spi { + spi_base: SpiBase { + spi, + cfg: spi_cfg, + sys_clk, + _word: PhantomData, + }, + pins, + } + } + + #[inline] + pub fn cfg_clock(&mut self, spi_clk: Hertz) { + self.spi_base.cfg_clock(spi_clk); + } + + #[inline] + pub fn cfg_mode(&mut self, mode: Mode) { + self.spi_base.cfg_mode(mode); + } + + #[inline] + pub fn perid(&self) -> u32 { + self.spi_base.perid() + } + + pub fn cfg_transfer>(&mut self, transfer_cfg: &TransferConfig) { + self.spi_base.cfg_transfer(transfer_cfg); + } + + /// Releases the SPI peripheral and associated pins + pub fn release(self) -> ($SPIX, (Sck, Miso, Mosi), SpiConfig) { + (self.spi_base.spi, self.pins, self.spi_base.cfg) + } + + pub fn downgrade(self) -> SpiBase<$SPIX, WORD> { + self.spi_base + } + } + + impl SpiBase<$SPIX, WORD> { + #[inline] + pub fn cfg_clock(&mut self, spi_clk: Hertz) { + let clk_prescale = self.sys_clk.0 / (spi_clk.0 * (self.cfg.scrdv as u32 + 1)); + self.spi + .clkprescale + .write(|w| unsafe { w.bits(clk_prescale) }); + } + + #[inline] + pub fn cfg_mode(&mut self, mode: Mode) { + let (cpo_bit, cph_bit) = match mode { + MODE_0 => (false, false), + MODE_1 => (false, true), + MODE_2 => (true, false), + MODE_3 => (true, true), + }; + self.spi.ctrl0.modify(|_, w| { + w.spo().bit(cpo_bit); + w.sph().bit(cph_bit) + }); + } + + #[inline] + pub fn perid(&self) -> u32 { + self.spi.perid.read().bits() + } + + pub fn cfg_transfer>(&mut self, transfer_cfg: &TransferConfig) { + self.cfg_clock(transfer_cfg.spi_clk); + self.cfg_mode(transfer_cfg.mode); + self.spi.ctrl1.modify(|_, w| { + if transfer_cfg.sod { + w.sod().set_bit(); + } else if transfer_cfg.hw_cs.is_some() { + w.sod().clear_bit(); + unsafe { + w.ss().bits(HwCs::CS_ID as u8); + } + } else { + w.sod().clear_bit(); + } + if transfer_cfg.blockmode { + w.blockmode().set_bit(); + } else { + w.blockmode().clear_bit(); + } + w + }); + } + } + + // Changing the word size also requires a type conversion + impl , Miso: PinMiso<$SPIX>, Mosi: PinMosi<$SPIX>> + From> for Spi<$SPIX, (Sck, Miso, Mosi), u16> + { + fn from( + old_spi: Spi<$SPIX, (Sck, Miso, Mosi), u8> + ) -> Self { + old_spi.spi_base.spi.ctrl0.modify(|_, w| { + unsafe { + w.size().bits(WordSize::SixteenBits as u8) + } + }); + Spi { + spi_base: SpiBase { + spi: old_spi.spi_base.spi, + cfg: old_spi.spi_base.cfg, + sys_clk: old_spi.spi_base.sys_clk, + _word: PhantomData, + }, + pins: old_spi.pins, + } + } + } + + // Changing the word size also requires a type conversion + impl , Miso: PinMiso<$SPIX>, Mosi: PinMosi<$SPIX>> + From> for + Spi<$SPIX, (Sck, Miso, Mosi), u8> + { + fn from( + old_spi: Spi<$SPIX, (Sck, Miso, Mosi), u16> + ) -> Self { + old_spi.spi_base.spi.ctrl0.modify(|_, w| { + unsafe { + w.size().bits(WordSize::EightBits as u8) + } + }); + Spi { + spi_base: SpiBase { + spi: old_spi.spi_base.spi, + cfg: old_spi.spi_base.cfg, + sys_clk: old_spi.spi_base.sys_clk, + _word: PhantomData, + }, + pins: old_spi.pins, + } + } + } + + $( + + impl FullDuplex<$WORD> for SpiBase<$SPIX, $WORD> + { + type Error = Infallible; + + /// Read a word from the slave. Must be preceeded by a [`send`] call + #[inline(always)] + fn read(&mut self) -> nb::Result<$WORD, Self::Error> { + if self.spi.status.read().rne().bit_is_clear() { + return Err(nb::Error::WouldBlock); + } + Ok((self.spi.data.read().bits() & 0xffff) as $WORD) + } + + /// Sends a word to the slave + #[inline(always)] + fn send(&mut self, word: $WORD) -> nb::Result<(), Self::Error> { + if self.spi.status.read().tnf().bit_is_clear() { + return Err(nb::Error::WouldBlock); + } + self.spi.data.write(|w| unsafe { w.bits(word as u32) }); + Ok(()) + } + } + + impl, Miso: PinMiso<$SPIX>, Mosi: PinMosi<$SPIX>> + FullDuplex<$WORD> for Spi<$SPIX, (Sck, Miso, Mosi), $WORD> + { + type Error = Infallible; + + #[inline(always)] + fn read(&mut self) -> nb::Result<$WORD, Self::Error> { + self.spi_base.read() + } + + #[inline(always)] + fn send(&mut self, word: $WORD) -> nb::Result<(), Self::Error> { + self.spi_base.send(word) + } + } + + impl SpiBase<$SPIX, $WORD> + where SpiBase<$SPIX, $WORD>: FullDuplex<$WORD> + { + /// Internal implementation for blocking::spi::Transfer and + /// blocking::spi::Write using the FIFO + fn transfer_internal<'w>( + &mut self, + write_words: &'w [$WORD], + read_words: Option<&'w mut [$WORD]>, + ) -> Result<(), Infallible> { + // FIFO has a depth of 16. Only fill the first half for now + const FIFO_WORDS: usize = 8; + + // Fill the first half of the write FIFO + let len = write_words.len(); + let mut write = write_words.iter(); + for _ in 0..core::cmp::min(FIFO_WORDS, len) { + nb::block!(self.send(*write.next().unwrap())).ok().unwrap(); + } + if let Some(read) = read_words { + let mut read = read.iter_mut(); + + // Continue filling write FIFO and emptying read FIFO + for word in write { + nb::block!(self.send(*word)).ok().unwrap(); + *read.next().unwrap() = nb::block!(self.read()).ok().unwrap(); + } + + // Finish emptying the read FIFO + for word in read { + *word = nb::block!(self.read()).ok().unwrap(); + } + } else { + // Continue filling write FIFO and emptying read FIFO + for word in write { + nb::block!(self.send(*word)).ok().unwrap(); + let _ = nb::block!(self.read()).ok().unwrap(); + } + + // Dummy read from the read FIFO + for _ in 0..core::cmp::min(FIFO_WORDS, len) { + let _ = nb::block!(self.read()).ok().unwrap(); + } + } + Ok(()) + } + } + + impl, Miso: PinMiso<$SPIX>, Mosi: PinMosi<$SPIX>> + Spi<$SPIX, (Sck, Miso, Mosi), $WORD> + where Spi<$SPIX, (Sck, Miso, Mosi), $WORD>: FullDuplex<$WORD> + { + /// Internal implementation for blocking::spi::Transfer and + /// blocking::spi::Write using the FIFO + fn transfer_internal<'w>( + &mut self, + write_words: &'w [$WORD], + read_words: Option<&'w mut [$WORD]>, + ) -> Result<(), Infallible> { + return self.spi_base.transfer_internal(write_words, read_words) + } + } + + impl blocking::spi::Transfer<$WORD> for SpiBase<$SPIX, $WORD> + where + SpiBase<$SPIX, $WORD>: FullDuplex<$WORD> + { + type Error = Infallible; + + fn transfer<'w>( + &mut self, + words: &'w mut [$WORD] + ) -> Result<&'w [$WORD], Self::Error> { + if words.is_empty() { + return Ok(words); + } + // SAFETY: transfer_internal always writes out bytes + // before modifying them + let write = unsafe { + core::slice::from_raw_parts(words.as_ptr(), words.len()) + }; + self.transfer_internal(write, Some(words))?; + Ok(words) + } + } + + impl, Miso: PinMiso<$SPIX>, Mosi: PinMosi<$SPIX>> + blocking::spi::Transfer<$WORD> for Spi<$SPIX, (Sck, Miso, Mosi), $WORD> + where + Spi<$SPIX, (Sck, Miso, Mosi), $WORD>: FullDuplex<$WORD>, + { + type Error = Infallible; + + fn transfer<'w>( + &mut self, + words: &'w mut [$WORD] + ) -> Result<&'w [$WORD], Self::Error> { + self.spi_base.transfer(words) + } + } + + impl blocking::spi::Write<$WORD> for SpiBase<$SPIX, $WORD> + where + SpiBase<$SPIX, $WORD>: FullDuplex<$WORD> + { + type Error = Infallible; + fn write(&mut self, words: &[$WORD]) -> Result<(), Self::Error> { + self.transfer_internal(words, None) + } + } + + impl, Miso: PinMiso<$SPIX>, Mosi: PinMosi<$SPIX>> + blocking::spi::Write<$WORD> for Spi<$SPIX, (Sck, Miso, Mosi), $WORD> + where + Spi<$SPIX, (Sck, Miso, Mosi), $WORD>: FullDuplex<$WORD>, + { + type Error = Infallible; + fn write(&mut self, words: &[$WORD]) -> Result<(), Self::Error> { + self.transfer_internal(words, None) + } + } + )+ + + )+ + } +} + +spi!( + SPIA: (spia, PeripheralClocks::Spi0) => (u8, u16), + SPIB: (spib, PeripheralClocks::Spi1) => (u8, u16), + SPIC: (spic, PeripheralClocks::Spi2) => (u8, u16), +); diff --git a/src/uart.rs b/src/uart.rs index 0fb06c9..bc1de14 100644 --- a/src/uart.rs +++ b/src/uart.rs @@ -11,8 +11,8 @@ use crate::clock::enable_peripheral_clock; use crate::{ clock, gpio::pins::{ - Alternate, Funsel1, Funsel2, Funsel3, Pin, PA16, PA17, PA18, PA19, PA2, PA26, PA27, PA3, - PA30, PA31, PA8, PA9, PB18, PB19, PB20, PB21, PB22, PB23, PB6, PB7, PB8, PB9, + AltFunc1, AltFunc2, AltFunc3, Pin, PA16, PA17, PA18, PA19, PA2, PA26, PA27, PA3, PA30, + PA31, PA8, PA9, PB18, PB19, PB20, PB21, PB22, PB23, PB6, PB7, PB8, PB9, }, pac::{uarta as uart_base, SYSCONFIG, UARTA, UARTB}, prelude::*, @@ -23,20 +23,20 @@ use embedded_hal::{blocking, serial}; pub trait Pins {} -impl Pins for (Pin>, Pin>) {} -impl Pins for (Pin>, Pin>) {} -impl Pins for (Pin>, Pin>) {} +impl Pins for (Pin, Pin) {} +impl Pins for (Pin, Pin) {} +impl Pins for (Pin, Pin) {} -impl Pins for (Pin>, Pin>) {} -impl Pins for (Pin>, Pin>) {} +impl Pins for (Pin, Pin) {} +impl Pins for (Pin, Pin) {} -impl Pins for (Pin>, Pin>) {} -impl Pins for (Pin>, Pin>) {} -impl Pins for (Pin>, Pin>) {} +impl Pins for (Pin, Pin) {} +impl Pins for (Pin, Pin) {} +impl Pins for (Pin, Pin) {} -impl Pins for (Pin>, Pin>) {} -impl Pins for (Pin>, Pin>) {} -impl Pins for (Pin>, Pin>) {} +impl Pins for (Pin, Pin) {} +impl Pins for (Pin, Pin) {} +impl Pins for (Pin, Pin) {} #[derive(Debug)] pub enum Error {