Buffer management in line with other peripherals. Constructor and config redesign

This commit is contained in:
Christian Perez Llamas 2022-11-19 19:18:20 +01:00
parent f5391efe22
commit 15a93246d6
2 changed files with 395 additions and 429 deletions

View File

@ -4,6 +4,8 @@
use core::future::poll_fn; use core::future::poll_fn;
use core::marker::PhantomData; use core::marker::PhantomData;
use core::mem::size_of;
use core::ops::{Deref, DerefMut};
use core::sync::atomic::{compiler_fence, Ordering}; use core::sync::atomic::{compiler_fence, Ordering};
use core::task::Poll; use core::task::Poll;
@ -14,14 +16,9 @@ use embassy_hal_common::{into_ref, PeripheralRef};
use crate::gpio::{AnyPin, Pin as GpioPin}; use crate::gpio::{AnyPin, Pin as GpioPin};
use crate::interrupt::Interrupt; use crate::interrupt::Interrupt;
use crate::pac::i2s::RegisterBlock; use crate::pac::i2s::RegisterBlock;
use crate::util::{slice_in_ram_or, slice_ptr_parts};
use crate::{Peripheral, EASY_DMA_SIZE}; use crate::{Peripheral, EASY_DMA_SIZE};
// TODO: Define those in lib.rs somewhere else
/// Limits for Easy DMA - it can only read from data ram
pub const SRAM_LOWER: usize = 0x2000_0000;
pub const SRAM_UPPER: usize = 0x3000_0000;
#[derive(Debug, Clone, Copy, PartialEq, Eq)] #[derive(Debug, Clone, Copy, PartialEq, Eq)]
#[cfg_attr(feature = "defmt", derive(defmt::Format))] #[cfg_attr(feature = "defmt", derive(defmt::Format))]
#[non_exhaustive] #[non_exhaustive]
@ -33,159 +30,42 @@ pub enum Error {
BufferLengthMisaligned, BufferLengthMisaligned,
} }
/// Approximate sample rates.
///
/// Those are common sample rates that can not be configured without an small error.
///
/// For custom master clock configuration, please refer to [Mode].
#[derive(Clone, Copy)]
pub enum ApproxSampleRate {
_11025,
_16000,
_22050,
_32000,
_44100,
_48000,
}
impl From<ApproxSampleRate> for Mode {
fn from(value: ApproxSampleRate) -> Self {
match value {
// error = 86
ApproxSampleRate::_11025 => Mode::Master {
freq: MckFreq::_32MDiv15,
ratio: Ratio::_192x,
},
// error = 127
ApproxSampleRate::_16000 => Mode::Master {
freq: MckFreq::_32MDiv21,
ratio: Ratio::_96x,
},
// error = 172
ApproxSampleRate::_22050 => Mode::Master {
freq: MckFreq::_32MDiv15,
ratio: Ratio::_96x,
},
// error = 254
ApproxSampleRate::_32000 => Mode::Master {
freq: MckFreq::_32MDiv21,
ratio: Ratio::_48x,
},
// error = 344
ApproxSampleRate::_44100 => Mode::Master {
freq: MckFreq::_32MDiv15,
ratio: Ratio::_48x,
},
// error = 381
ApproxSampleRate::_48000 => Mode::Master {
freq: MckFreq::_32MDiv21,
ratio: Ratio::_32x,
},
}
}
}
impl ApproxSampleRate {
pub fn sample_rate(&self) -> u32 {
// This will always provide a Master mode, so it is safe to unwrap.
Mode::from(*self).sample_rate().unwrap()
}
}
/// Exact sample rates.
///
/// Those are non standard sample rates that can be configured without error.
///
/// For custom master clock configuration, please refer to [Mode].
#[derive(Clone, Copy)]
pub enum ExactSampleRate {
_8000,
_10582,
_12500,
_15625,
_15873,
_25000,
_31250,
_50000,
_62500,
_100000,
_125000,
}
impl ExactSampleRate {
pub fn sample_rate(&self) -> u32 {
// This will always provide a Master mode, so it is safe to unwrap.
Mode::from(*self).sample_rate().unwrap()
}
}
impl From<ExactSampleRate> for Mode {
fn from(value: ExactSampleRate) -> Self {
match value {
ExactSampleRate::_8000 => Mode::Master {
freq: MckFreq::_32MDiv125,
ratio: Ratio::_32x,
},
ExactSampleRate::_10582 => Mode::Master {
freq: MckFreq::_32MDiv63,
ratio: Ratio::_48x,
},
ExactSampleRate::_12500 => Mode::Master {
freq: MckFreq::_32MDiv10,
ratio: Ratio::_256x,
},
ExactSampleRate::_15625 => Mode::Master {
freq: MckFreq::_32MDiv32,
ratio: Ratio::_64x,
},
ExactSampleRate::_15873 => Mode::Master {
freq: MckFreq::_32MDiv63,
ratio: Ratio::_32x,
},
ExactSampleRate::_25000 => Mode::Master {
freq: MckFreq::_32MDiv10,
ratio: Ratio::_128x,
},
ExactSampleRate::_31250 => Mode::Master {
freq: MckFreq::_32MDiv32,
ratio: Ratio::_32x,
},
ExactSampleRate::_50000 => Mode::Master {
freq: MckFreq::_32MDiv10,
ratio: Ratio::_64x,
},
ExactSampleRate::_62500 => Mode::Master {
freq: MckFreq::_32MDiv16,
ratio: Ratio::_32x,
},
ExactSampleRate::_100000 => Mode::Master {
freq: MckFreq::_32MDiv10,
ratio: Ratio::_32x,
},
ExactSampleRate::_125000 => Mode::Master {
freq: MckFreq::_32MDiv8,
ratio: Ratio::_32x,
},
}
}
}
/// I2S configuration. /// I2S configuration.
#[derive(Clone)] #[derive(Clone)]
#[non_exhaustive] #[non_exhaustive]
pub struct Config { pub struct Config {
pub mode: Mode, pub sample_width: SampleWidth,
pub swidth: SampleWidth,
pub align: Align, pub align: Align,
pub format: Format, pub format: Format,
pub channels: Channels, pub channels: Channels,
} }
impl Config {
pub fn sample_width(mut self, sample_width: SampleWidth) -> Self {
self.sample_width = sample_width;
self
}
pub fn align(mut self, align: Align) -> Self {
self.align = align;
self
}
pub fn format(mut self, format: Format) -> Self {
self.format = format;
self
}
pub fn channels(mut self, channels: Channels) -> Self {
self.channels = channels;
self
}
}
impl Default for Config { impl Default for Config {
fn default() -> Self { fn default() -> Self {
Self { Self {
mode: ExactSampleRate::_31250.into(), sample_width: SampleWidth::_16bit,
swidth: SampleWidth::_16bit,
align: Align::Left, align: Align::Left,
format: Format::I2S, format: Format::I2S,
channels: Channels::Stereo, channels: Channels::Stereo,
@ -195,18 +75,21 @@ impl Default for Config {
/// I2S Mode /// I2S Mode
#[derive(Debug, Eq, PartialEq, Clone, Copy)] #[derive(Debug, Eq, PartialEq, Clone, Copy)]
pub enum Mode { pub struct MasterClock {
Master { freq: MckFreq, ratio: Ratio }, freq: MckFreq,
Slave, ratio: Ratio,
} }
impl Mode { impl MasterClock {
pub fn sample_rate(&self) -> Option<u32> { pub fn new(freq: MckFreq, ratio: Ratio) -> Self {
match self { Self { freq, ratio }
Mode::Master { freq, ratio } => Some(freq.to_frequency() / ratio.to_divisor()),
Mode::Slave => None,
} }
} }
impl MasterClock {
pub fn sample_rate(&self) -> u32 {
self.freq.to_frequency() / self.ratio.to_divisor()
}
} }
/// Master clock generator frequency. /// Master clock generator frequency.
@ -275,17 +158,106 @@ pub enum Ratio {
impl Ratio { impl Ratio {
const RATIOS: &'static [u32] = &[32, 48, 64, 96, 128, 192, 256, 384, 512]; const RATIOS: &'static [u32] = &[32, 48, 64, 96, 128, 192, 256, 384, 512];
/// Return the value that needs to be written to the register.
pub fn to_register_value(&self) -> u8 {
usize::from(*self) as u8
}
pub fn to_divisor(&self) -> u32 { pub fn to_divisor(&self) -> u32 {
Self::RATIOS[u8::from(*self) as usize] Self::RATIOS[usize::from(*self)]
} }
} }
impl From<Ratio> for u8 { impl From<Ratio> for usize {
fn from(variant: Ratio) -> Self { fn from(variant: Ratio) -> Self {
variant as _ variant as _
} }
} }
/// Approximate sample rates.
///
/// Those are common sample rates that can not be configured without an small error.
///
/// For custom master clock configuration, please refer to [MasterClock].
#[derive(Clone, Copy)]
pub enum ApproxSampleRate {
_11025,
_16000,
_22050,
_32000,
_44100,
_48000,
}
impl From<ApproxSampleRate> for MasterClock {
fn from(value: ApproxSampleRate) -> Self {
match value {
// error = 86
ApproxSampleRate::_11025 => MasterClock::new(MckFreq::_32MDiv15, Ratio::_192x),
// error = 127
ApproxSampleRate::_16000 => MasterClock::new(MckFreq::_32MDiv21, Ratio::_96x),
// error = 172
ApproxSampleRate::_22050 => MasterClock::new(MckFreq::_32MDiv15, Ratio::_96x),
// error = 254
ApproxSampleRate::_32000 => MasterClock::new(MckFreq::_32MDiv21, Ratio::_48x),
// error = 344
ApproxSampleRate::_44100 => MasterClock::new(MckFreq::_32MDiv15, Ratio::_48x),
// error = 381
ApproxSampleRate::_48000 => MasterClock::new(MckFreq::_32MDiv21, Ratio::_32x),
}
}
}
impl ApproxSampleRate {
pub fn sample_rate(&self) -> u32 {
MasterClock::from(*self).sample_rate()
}
}
/// Exact sample rates.
///
/// Those are non standard sample rates that can be configured without error.
///
/// For custom master clock configuration, please refer to [Mode].
#[derive(Clone, Copy)]
pub enum ExactSampleRate {
_8000,
_10582,
_12500,
_15625,
_15873,
_25000,
_31250,
_50000,
_62500,
_100000,
_125000,
}
impl ExactSampleRate {
pub fn sample_rate(&self) -> u32 {
MasterClock::from(*self).sample_rate()
}
}
impl From<ExactSampleRate> for MasterClock {
fn from(value: ExactSampleRate) -> Self {
match value {
ExactSampleRate::_8000 => MasterClock::new(MckFreq::_32MDiv125, Ratio::_32x),
ExactSampleRate::_10582 => MasterClock::new(MckFreq::_32MDiv63, Ratio::_48x),
ExactSampleRate::_12500 => MasterClock::new(MckFreq::_32MDiv10, Ratio::_256x),
ExactSampleRate::_15625 => MasterClock::new(MckFreq::_32MDiv32, Ratio::_64x),
ExactSampleRate::_15873 => MasterClock::new(MckFreq::_32MDiv63, Ratio::_32x),
ExactSampleRate::_25000 => MasterClock::new(MckFreq::_32MDiv10, Ratio::_128x),
ExactSampleRate::_31250 => MasterClock::new(MckFreq::_32MDiv32, Ratio::_32x),
ExactSampleRate::_50000 => MasterClock::new(MckFreq::_32MDiv10, Ratio::_64x),
ExactSampleRate::_62500 => MasterClock::new(MckFreq::_32MDiv16, Ratio::_32x),
ExactSampleRate::_100000 => MasterClock::new(MckFreq::_32MDiv10, Ratio::_32x),
ExactSampleRate::_125000 => MasterClock::new(MckFreq::_32MDiv8, Ratio::_32x),
}
}
}
/// Sample width. /// Sample width.
#[derive(Debug, Eq, PartialEq, Clone, Copy)] #[derive(Debug, Eq, PartialEq, Clone, Copy)]
pub enum SampleWidth { pub enum SampleWidth {
@ -336,10 +308,8 @@ impl From<Format> for bool {
#[derive(Debug, Eq, PartialEq, Clone, Copy)] #[derive(Debug, Eq, PartialEq, Clone, Copy)]
pub enum Channels { pub enum Channels {
Stereo, Stereo,
/// Mono left MonoLeft,
Left, MonoRight,
/// Mono right
Right,
} }
impl From<Channels> for u8 { impl From<Channels> for u8 {
@ -350,131 +320,160 @@ impl From<Channels> for u8 {
/// Interface to the I2S peripheral using EasyDMA to offload the transmission and reception workload. /// Interface to the I2S peripheral using EasyDMA to offload the transmission and reception workload.
pub struct I2S<'d, T: Instance> { pub struct I2S<'d, T: Instance> {
_p: PeripheralRef<'d, T>, i2s: PeripheralRef<'d, T>,
irq: PeripheralRef<'d, T::Interrupt>,
mck: Option<PeripheralRef<'d, AnyPin>>,
sck: PeripheralRef<'d, AnyPin>,
lrck: PeripheralRef<'d, AnyPin>,
sdin: Option<PeripheralRef<'d, AnyPin>>,
sdout: Option<PeripheralRef<'d, AnyPin>>,
master_clock: Option<MasterClock>,
config: Config,
} }
impl<'d, T: Instance> I2S<'d, T> { impl<'d, T: Instance> I2S<'d, T> {
/// Create a new I2S /// Create a new I2S in master mode
pub fn new( pub fn master(
i2s: impl Peripheral<P = T> + 'd, i2s: impl Peripheral<P = T> + 'd,
irq: impl Peripheral<P = T::Interrupt> + 'd, irq: impl Peripheral<P = T::Interrupt> + 'd,
mck: impl Peripheral<P = impl GpioPin> + 'd, mck: impl Peripheral<P = impl GpioPin> + 'd,
sck: impl Peripheral<P = impl GpioPin> + 'd, sck: impl Peripheral<P = impl GpioPin> + 'd,
lrck: impl Peripheral<P = impl GpioPin> + 'd, lrck: impl Peripheral<P = impl GpioPin> + 'd,
sdin: impl Peripheral<P = impl GpioPin> + 'd, master_clock: MasterClock,
sdout: impl Peripheral<P = impl GpioPin> + 'd,
config: Config, config: Config,
) -> Self { ) -> Self {
into_ref!(mck, sck, lrck, sdin, sdout); into_ref!(i2s, irq, mck, sck, lrck);
Self::new_inner( Self {
i2s, i2s,
irq, irq,
mck.map_into(), mck: Some(mck.map_into()),
sck.map_into(), sck: sck.map_into(),
lrck.map_into(), lrck: lrck.map_into(),
sdin.map_into(), sdin: None,
sdout.map_into(), sdout: None,
master_clock: Some(master_clock),
config, config,
) }
} }
fn new_inner( /// Create a new I2S in slave mode
pub fn slave(
i2s: impl Peripheral<P = T> + 'd, i2s: impl Peripheral<P = T> + 'd,
irq: impl Peripheral<P = T::Interrupt> + 'd, irq: impl Peripheral<P = T::Interrupt> + 'd,
mck: PeripheralRef<'d, AnyPin>, sck: impl Peripheral<P = impl GpioPin> + 'd,
sck: PeripheralRef<'d, AnyPin>, lrck: impl Peripheral<P = impl GpioPin> + 'd,
lrck: PeripheralRef<'d, AnyPin>,
sdin: PeripheralRef<'d, AnyPin>,
sdout: PeripheralRef<'d, AnyPin>,
config: Config, config: Config,
) -> Self { ) -> Self {
into_ref!(i2s, irq, mck, sck, lrck, sdin, sdout); into_ref!(i2s, irq, sck, lrck);
Self {
Self::apply_config(&config); i2s,
Self::select_pins(mck, sck, lrck, sdin, sdout); irq,
Self::setup_interrupt(irq); mck: None,
sck: sck.map_into(),
T::regs().enable.write(|w| w.enable().enabled()); lrck: lrck.map_into(),
sdin: None,
Self { _p: i2s } sdout: None,
master_clock: None,
config,
}
} }
/// I2S output only /// I2S output only
pub fn output(self) -> Output<'d, T> { pub fn output(mut self, sdout: impl Peripheral<P = impl GpioPin> + 'd) -> OutputStream<'d, T> {
Output { _p: self._p } self.sdout = Some(sdout.into_ref().map_into());
OutputStream { _p: self.build() }
} }
/// I2S input only /// I2S input only
pub fn input(self) -> Input<'d, T> { pub fn input(mut self, sdin: impl Peripheral<P = impl GpioPin> + 'd) -> InputStream<'d, T> {
Input { _p: self._p } self.sdin = Some(sdin.into_ref().map_into());
InputStream { _p: self.build() }
} }
/// I2S full duplex (input and output) /// I2S full duplex (input and output)
pub fn full_duplex(self) -> FullDuplex<'d, T> { pub fn full_duplex(
FullDuplex { _p: self._p } mut self,
sdin: impl Peripheral<P = impl GpioPin> + 'd,
sdout: impl Peripheral<P = impl GpioPin> + 'd,
) -> FullDuplexStream<'d, T> {
self.sdout = Some(sdout.into_ref().map_into());
self.sdin = Some(sdin.into_ref().map_into());
FullDuplexStream { _p: self.build() }
} }
fn apply_config(config: &Config) { fn build(self) -> PeripheralRef<'d, T> {
self.apply_config();
self.select_pins();
self.setup_interrupt();
let device = Device::<T>::new();
device.enable();
self.i2s
}
fn apply_config(&self) {
let c = &T::regs().config; let c = &T::regs().config;
match config.mode { match &self.master_clock {
Mode::Master { freq, ratio } => { Some(MasterClock { freq, ratio }) => {
c.mode.write(|w| w.mode().master()); c.mode.write(|w| w.mode().master());
c.mcken.write(|w| w.mcken().enabled()); c.mcken.write(|w| w.mcken().enabled());
c.mckfreq c.mckfreq
.write(|w| unsafe { w.mckfreq().bits(freq.to_register_value()) }); .write(|w| unsafe { w.mckfreq().bits(freq.to_register_value()) });
c.ratio.write(|w| unsafe { w.ratio().bits(ratio.into()) }); c.ratio.write(|w| unsafe { w.ratio().bits(ratio.to_register_value()) });
} }
Mode::Slave => { None => {
c.mode.write(|w| w.mode().slave()); c.mode.write(|w| w.mode().slave());
} }
}; };
c.swidth.write(|w| unsafe { w.swidth().bits(config.swidth.into()) }); c.swidth
c.align.write(|w| w.align().bit(config.align.into())); .write(|w| unsafe { w.swidth().bits(self.config.sample_width.into()) });
c.format.write(|w| w.format().bit(config.format.into())); c.align.write(|w| w.align().bit(self.config.align.into()));
c.format.write(|w| w.format().bit(self.config.format.into()));
c.channels c.channels
.write(|w| unsafe { w.channels().bits(config.channels.into()) }); .write(|w| unsafe { w.channels().bits(self.config.channels.into()) });
} }
fn select_pins( fn select_pins(&self) {
mck: PeripheralRef<'d, AnyPin>,
sck: PeripheralRef<'d, AnyPin>,
lrck: PeripheralRef<'d, AnyPin>,
sdin: PeripheralRef<'d, AnyPin>,
sdout: PeripheralRef<'d, AnyPin>,
) {
let psel = &T::regs().psel; let psel = &T::regs().psel;
if let Some(mck) = &self.mck {
psel.mck.write(|w| { psel.mck.write(|w| {
unsafe { w.bits(mck.psel_bits()) }; unsafe { w.bits(mck.psel_bits()) };
w.connect().connected() w.connect().connected()
}); });
}
psel.sck.write(|w| { psel.sck.write(|w| {
unsafe { w.bits(sck.psel_bits()) }; unsafe { w.bits(self.sck.psel_bits()) };
w.connect().connected() w.connect().connected()
}); });
psel.lrck.write(|w| { psel.lrck.write(|w| {
unsafe { w.bits(lrck.psel_bits()) }; unsafe { w.bits(self.lrck.psel_bits()) };
w.connect().connected() w.connect().connected()
}); });
if let Some(sdin) = &self.sdin {
psel.sdin.write(|w| { psel.sdin.write(|w| {
unsafe { w.bits(sdin.psel_bits()) }; unsafe { w.bits(sdin.psel_bits()) };
w.connect().connected() w.connect().connected()
}); });
}
if let Some(sdout) = &self.sdout {
psel.sdout.write(|w| { psel.sdout.write(|w| {
unsafe { w.bits(sdout.psel_bits()) }; unsafe { w.bits(sdout.psel_bits()) };
w.connect().connected() w.connect().connected()
}); });
} }
}
fn setup_interrupt(irq: PeripheralRef<'d, T::Interrupt>) { fn setup_interrupt(&self) {
irq.set_handler(Self::on_interrupt); self.irq.set_handler(Self::on_interrupt);
irq.unpend(); self.irq.unpend();
irq.enable(); self.irq.enable();
let device = Device::<T>::new(); let device = Device::<T>::new();
device.disable_tx_ptr_interrupt(); device.disable_tx_ptr_interrupt();
@ -538,17 +537,32 @@ impl<'d, T: Instance> I2S<'d, T> {
device.disable(); device.disable();
} }
async fn send<B>(buffer: B) -> Result<(), Error> async fn send_from_ram<S>(buffer_ptr: *const [S]) -> Result<(), Error>
where where
B: Buffer, S: Sample,
{ {
trace!("SEND: {}", buffer.bytes_ptr() as u32); trace!("SEND: {}", buffer_ptr as *const S as u32);
let device = Device::<T>::new(); slice_in_ram_or(buffer_ptr, Error::BufferNotInDataMemory)?;
let drop = device.on_tx_drop();
compiler_fence(Ordering::SeqCst); compiler_fence(Ordering::SeqCst);
let device = Device::<T>::new();
let drop = OnDrop::new(move || {
trace!("TX DROP: Stopping");
let device = Device::<T>::new();
device.disable_tx_ptr_interrupt();
device.reset_tx_ptr_event();
device.disable_tx();
// TX is stopped almost instantly, spinning is fine.
while !device.is_tx_ptr_updated() {}
trace!("TX DROP: Stopped");
});
poll_fn(|cx| { poll_fn(|cx| {
T::state().tx_waker.register(cx.waker()); T::state().tx_waker.register(cx.waker());
@ -564,7 +578,7 @@ impl<'d, T: Instance> I2S<'d, T> {
}) })
.await; .await;
device.set_tx_buffer(buffer)?; device.update_tx(buffer_ptr)?;
compiler_fence(Ordering::SeqCst); compiler_fence(Ordering::SeqCst);
drop.defuse(); drop.defuse();
@ -572,17 +586,33 @@ impl<'d, T: Instance> I2S<'d, T> {
Ok(()) Ok(())
} }
async fn receive<B>(buffer: B) -> Result<(), Error> async fn receive_from_ram<S>(buffer_ptr: *mut [S]) -> Result<(), Error>
where where
B: Buffer, S: Sample,
{ {
trace!("RECEIVE: {}", buffer.bytes_ptr() as u32); trace!("RECEIVE: {}", buffer_ptr as *const S as u32);
let device = Device::<T>::new(); // NOTE: RAM slice check for rx is not necessary, as a mutable
let drop = device.on_rx_drop(); // slice can only be built from data located in RAM.
compiler_fence(Ordering::SeqCst); compiler_fence(Ordering::SeqCst);
let device = Device::<T>::new();
let drop = OnDrop::new(move || {
trace!("RX DROP: Stopping");
let device = Device::<T>::new();
device.disable_rx_ptr_interrupt();
device.reset_rx_ptr_event();
device.disable_rx();
// TX is stopped almost instantly, spinning is fine.
while !device.is_rx_ptr_updated() {}
trace!("RX DROP: Stopped");
});
poll_fn(|cx| { poll_fn(|cx| {
T::state().rx_waker.register(cx.waker()); T::state().rx_waker.register(cx.waker());
@ -598,9 +628,10 @@ impl<'d, T: Instance> I2S<'d, T> {
}) })
.await; .await;
device.set_rx_buffer(buffer)?; device.update_rx(buffer_ptr)?;
compiler_fence(Ordering::SeqCst); compiler_fence(Ordering::SeqCst);
drop.defuse(); drop.defuse();
Ok(()) Ok(())
@ -608,15 +639,15 @@ impl<'d, T: Instance> I2S<'d, T> {
} }
/// I2S output /// I2S output
pub struct Output<'d, T: Instance> { pub struct OutputStream<'d, T: Instance> {
_p: PeripheralRef<'d, T>, _p: PeripheralRef<'d, T>,
} }
impl<'d, T: Instance> Output<'d, T> { impl<'d, T: Instance> OutputStream<'d, T> {
/// Prepare the initial buffer and start the I2S transfer. /// Prepare the initial buffer and start the I2S transfer.
pub async fn start<B>(&self, buffer: B) -> Result<(), Error> pub async fn start<S>(&self, buffer: &[S]) -> Result<(), Error>
where where
B: Buffer, S: Sample,
{ {
let device = Device::<T>::new(); let device = Device::<T>::new();
@ -627,7 +658,8 @@ impl<'d, T: Instance> Output<'d, T> {
device.enable(); device.enable();
device.enable_tx(); device.enable_tx();
device.set_tx_buffer(buffer)?;
device.update_tx(buffer as *const [S])?;
s.started.store(true, Ordering::Relaxed); s.started.store(true, Ordering::Relaxed);
@ -647,24 +679,24 @@ impl<'d, T: Instance> Output<'d, T> {
/// The buffer must not be written while being used by the DMA, /// The buffer must not be written while being used by the DMA,
/// which takes two other `send`s being awaited. /// which takes two other `send`s being awaited.
#[allow(unused_mut)] #[allow(unused_mut)]
pub async fn send<B>(&mut self, buffer: B) -> Result<(), Error> pub async fn send_from_ram<S>(&mut self, buffer: &[S]) -> Result<(), Error>
where where
B: Buffer, S: Sample,
{ {
I2S::<T>::send(buffer).await I2S::<T>::send_from_ram(buffer as *const [S]).await
} }
} }
/// I2S input /// I2S input
pub struct Input<'d, T: Instance> { pub struct InputStream<'d, T: Instance> {
_p: PeripheralRef<'d, T>, _p: PeripheralRef<'d, T>,
} }
impl<'d, T: Instance> Input<'d, T> { impl<'d, T: Instance> InputStream<'d, T> {
/// Prepare the initial buffer and start the I2S transfer. /// Prepare the initial buffer and start the I2S transfer.
pub async fn start<B>(&self, buffer: B) -> Result<(), Error> pub async fn start<S>(&self, buffer: &mut [S]) -> Result<(), Error>
where where
B: Buffer, S: Sample,
{ {
let device = Device::<T>::new(); let device = Device::<T>::new();
@ -675,7 +707,8 @@ impl<'d, T: Instance> Input<'d, T> {
device.enable(); device.enable();
device.enable_rx(); device.enable_rx();
device.set_rx_buffer(buffer)?;
device.update_rx(buffer as *mut [S])?;
s.started.store(true, Ordering::Relaxed); s.started.store(true, Ordering::Relaxed);
@ -695,24 +728,24 @@ impl<'d, T: Instance> Input<'d, T> {
/// The buffer must not be read while being used by the DMA, /// The buffer must not be read while being used by the DMA,
/// which takes two other `receive`s being awaited. /// which takes two other `receive`s being awaited.
#[allow(unused_mut)] #[allow(unused_mut)]
pub async fn receive<B>(&mut self, buffer: B) -> Result<(), Error> pub async fn receive_from_ram<S>(&mut self, buffer: &mut [S]) -> Result<(), Error>
where where
B: Buffer, S: Sample,
{ {
I2S::<T>::receive(buffer).await I2S::<T>::receive_from_ram(buffer as *mut [S]).await
} }
} }
/// I2S ful duplex (input & output) /// I2S full duplex stream (input & output)
pub struct FullDuplex<'d, T: Instance> { pub struct FullDuplexStream<'d, T: Instance> {
_p: PeripheralRef<'d, T>, _p: PeripheralRef<'d, T>,
} }
impl<'d, T: Instance> FullDuplex<'d, T> { impl<'d, T: Instance> FullDuplexStream<'d, T> {
/// Prepare the initial buffers and start the I2S transfer. /// Prepare the initial buffers and start the I2S transfer.
pub async fn start<B>(&self, buffer_out: B, buffer_in: B) -> Result<(), Error> pub async fn start<S>(&self, buffer_out: &[S], buffer_in: &mut [S]) -> Result<(), Error>
where where
B: Buffer, S: Sample,
{ {
let device = Device::<T>::new(); let device = Device::<T>::new();
@ -724,8 +757,9 @@ impl<'d, T: Instance> FullDuplex<'d, T> {
device.enable(); device.enable();
device.enable_tx(); device.enable_tx();
device.enable_rx(); device.enable_rx();
device.set_tx_buffer(buffer_out)?;
device.set_rx_buffer(buffer_in)?; device.update_tx(buffer_out as *const [S])?;
device.update_rx(buffer_in as *mut [S])?;
s.started.store(true, Ordering::Relaxed); s.started.store(true, Ordering::Relaxed);
@ -745,12 +779,12 @@ impl<'d, T: Instance> FullDuplex<'d, T> {
/// The buffers must not be written/read while being used by the DMA, /// The buffers must not be written/read while being used by the DMA,
/// which takes two other `send_and_receive` operations being awaited. /// which takes two other `send_and_receive` operations being awaited.
#[allow(unused_mut)] #[allow(unused_mut)]
pub async fn send_and_receive<B>(&mut self, buffer_out: B, buffer_in: B) -> Result<(), Error> pub async fn send_and_receive_from_ram<S>(&mut self, buffer_out: &[S], buffer_in: &mut [S]) -> Result<(), Error>
where where
B: Buffer, S: Sample,
{ {
I2S::<T>::send(buffer_out).await?; I2S::<T>::send_from_ram(buffer_out as *const [S]).await?;
I2S::<T>::receive(buffer_in).await?; I2S::<T>::receive_from_ram(buffer_in as *mut [S]).await?;
Ok(()) Ok(())
} }
} }
@ -833,38 +867,6 @@ impl<T: Instance> Device<T> {
self.0.intenset.write(|w| w.stopped().set()); self.0.intenset.write(|w| w.stopped().set());
} }
#[inline]
fn set_tx_buffer<B>(&self, buffer: B) -> Result<(), Error>
where
B: Buffer,
{
let (ptr, maxcnt) = Self::validate_buffer(buffer)?;
self.0.rxtxd.maxcnt.write(|w| unsafe { w.bits(maxcnt) });
self.0.txd.ptr.write(|w| unsafe { w.ptr().bits(ptr) });
Ok(())
}
#[inline]
fn set_rx_buffer<B>(&self, buffer: B) -> Result<(), Error>
where
B: Buffer,
{
let (ptr, maxcnt) = Self::validate_buffer(buffer)?;
self.0.rxtxd.maxcnt.write(|w| unsafe { w.bits(maxcnt) });
self.0.rxd.ptr.write(|w| unsafe { w.ptr().bits(ptr) });
Ok(())
}
#[inline(always)]
fn is_tx_ptr_updated(&self) -> bool {
self.0.events_txptrupd.read().bits() != 0
}
#[inline(always)]
fn is_rx_ptr_updated(&self) -> bool {
self.0.events_rxptrupd.read().bits() != 0
}
#[inline(always)] #[inline(always)]
fn reset_tx_ptr_event(&self) { fn reset_tx_ptr_event(&self) {
trace!("TX PTR EVENT: Reset"); trace!("TX PTR EVENT: Reset");
@ -901,58 +903,44 @@ impl<T: Instance> Device<T> {
self.0.intenclr.write(|w| w.rxptrupd().clear()); self.0.intenclr.write(|w| w.rxptrupd().clear());
} }
#[inline] #[inline(always)]
fn on_tx_drop(&self) -> OnDrop<fn()> { fn is_tx_ptr_updated(&self) -> bool {
OnDrop::new(move || { self.0.events_txptrupd.read().bits() != 0
trace!("TX DROP: Stopping"); }
let device = Device::<T>::new(); #[inline(always)]
device.disable_tx_ptr_interrupt(); fn is_rx_ptr_updated(&self) -> bool {
device.reset_tx_ptr_event(); self.0.events_rxptrupd.read().bits() != 0
device.disable_tx();
// TX is stopped almost instantly, spinning is fine.
while !device.is_tx_ptr_updated() {}
trace!("TX DROP: Stopped");
})
} }
#[inline] #[inline]
fn on_rx_drop(&self) -> OnDrop<fn()> { fn update_tx<S>(&self, buffer_ptr: *const [S]) -> Result<(), Error> {
OnDrop::new(move || { let (ptr, maxcnt) = Self::validated_dma_parts(buffer_ptr)?;
trace!("RX DROP: Stopping"); self.0.rxtxd.maxcnt.write(|w| unsafe { w.bits(maxcnt) });
self.0.txd.ptr.write(|w| unsafe { w.ptr().bits(ptr) });
let device = Device::<T>::new(); Ok(())
device.disable_rx_ptr_interrupt();
device.reset_rx_ptr_event();
device.disable_rx();
// TX is stopped almost instantly, spinning is fine.
while !device.is_rx_ptr_updated() {}
trace!("RX DROP: Stopped");
})
} }
fn validate_buffer<B>(buffer: B) -> Result<(u32, u32), Error> #[inline]
where fn update_rx<S>(&self, buffer_ptr: *const [S]) -> Result<(), Error> {
B: Buffer, let (ptr, maxcnt) = Self::validated_dma_parts(buffer_ptr)?;
{ self.0.rxtxd.maxcnt.write(|w| unsafe { w.bits(maxcnt) });
let ptr = buffer.bytes_ptr() as u32; self.0.rxd.ptr.write(|w| unsafe { w.ptr().bits(ptr) });
let len = buffer.bytes_len(); Ok(())
let maxcnt = ((len + core::mem::size_of::<u32>() - 1) / core::mem::size_of::<u32>()) as u32; }
fn validated_dma_parts<S>(buffer_ptr: *const [S]) -> Result<(u32, u32), Error> {
let (ptr, len) = slice_ptr_parts(buffer_ptr);
let ptr = ptr as u32;
let bytes_len = len * size_of::<S>();
let maxcnt = (bytes_len / size_of::<u32>()) as u32;
trace!("PTR={}, MAXCNT={}", ptr, maxcnt); trace!("PTR={}, MAXCNT={}", ptr, maxcnt);
// TODO can we avoid repeating all those runtime checks for the same buffer again and again?
if ptr % 4 != 0 { if ptr % 4 != 0 {
Err(Error::BufferMisaligned) Err(Error::BufferMisaligned)
} else if len % 4 != 0 { } else if bytes_len % 4 != 0 {
Err(Error::BufferLengthMisaligned) Err(Error::BufferLengthMisaligned)
} else if (ptr as usize) < SRAM_LOWER || (ptr as usize) > SRAM_UPPER {
Err(Error::BufferNotInDataMemory)
} else if maxcnt as usize > EASY_DMA_SIZE { } else if maxcnt as usize > EASY_DMA_SIZE {
Err(Error::BufferTooLong) Err(Error::BufferTooLong)
} else { } else {
@ -998,60 +986,19 @@ impl<T: Sample, const N: usize> Default for AlignedBuffer<T, N> {
} }
} }
impl<T: Sample, const N: usize> AsRef<[T]> for AlignedBuffer<T, N> { impl<T: Sample, const N: usize> Deref for AlignedBuffer<T, N> {
fn as_ref(&self) -> &[T] { type Target = [T];
fn deref(&self) -> &Self::Target {
self.0.as_slice() self.0.as_slice()
} }
} }
impl<T: Sample, const N: usize> AsMut<[T]> for AlignedBuffer<T, N> { impl<T: Sample, const N: usize> DerefMut for AlignedBuffer<T, N> {
fn as_mut(&mut self) -> &mut [T] { fn deref_mut(&mut self) -> &mut Self::Target {
self.0.as_mut_slice() self.0.as_mut_slice()
} }
} }
/// Common operations required for a buffer to be used by the DMA
pub trait Buffer: Sized {
fn bytes_ptr(&self) -> *const u8;
fn bytes_len(&self) -> usize;
}
impl Buffer for &[i8] {
#[inline]
fn bytes_ptr(&self) -> *const u8 {
self.as_ptr() as *const u8
}
#[inline]
fn bytes_len(&self) -> usize {
self.len()
}
}
impl Buffer for &[i16] {
#[inline]
fn bytes_ptr(&self) -> *const u8 {
self.as_ptr() as *const u8
}
#[inline]
fn bytes_len(&self) -> usize {
self.len() * core::mem::size_of::<i16>()
}
}
impl Buffer for &[i32] {
#[inline]
fn bytes_ptr(&self) -> *const u8 {
self.as_ptr() as *const u8
}
#[inline]
fn bytes_len(&self) -> usize {
self.len() * core::mem::size_of::<i32>()
}
}
pub(crate) mod sealed { pub(crate) mod sealed {
use core::sync::atomic::AtomicBool; use core::sync::atomic::AtomicBool;

View File

@ -6,33 +6,29 @@ use core::f32::consts::PI;
use defmt::{error, info}; use defmt::{error, info};
use embassy_executor::Spawner; use embassy_executor::Spawner;
use embassy_nrf::i2s::{self, Sample as _}; use embassy_nrf::i2s::{self, Channels, Config, MasterClock, Sample as _, SampleWidth, I2S};
use embassy_nrf::interrupt; use embassy_nrf::interrupt;
use {defmt_rtt as _, panic_probe as _}; use {defmt_rtt as _, panic_probe as _};
type Sample = i16;
const NUM_SAMPLES: usize = 6000;
#[embassy_executor::main] #[embassy_executor::main]
async fn main(_spawner: Spawner) { async fn main(_spawner: Spawner) {
let p = embassy_nrf::init(Default::default()); let p = embassy_nrf::init(Default::default());
let mut config = i2s::Config::default(); let master_clock: MasterClock = i2s::ExactSampleRate::_50000.into();
config.mode = i2s::ExactSampleRate::_50000.into();
config.channels = i2s::Channels::Left;
config.swidth = i2s::SampleWidth::_16bit;
let sample_rate = config.mode.sample_rate().expect("I2S Master");
let inv_sample_rate = 1.0 / sample_rate as f32;
let sample_rate = master_clock.sample_rate();
info!("Sample rate: {}", sample_rate); info!("Sample rate: {}", sample_rate);
// Wait for a button press let config = Config::default()
// use embassy_nrf::gpio::{Input, Pin, Pull}; .sample_width(SampleWidth::_16bit)
// let mut btn1 = Input::new(p.P1_00.degrade(), Pull::Up); .channels(Channels::MonoLeft);
// btn1.wait_for_low().await;
let irq = interrupt::take!(I2S); let irq = interrupt::take!(I2S);
let mut i2s = i2s::I2S::new(p.I2S, irq, p.P0_28, p.P0_29, p.P0_31, p.P0_27, p.P0_30, config).output(); let mut output_stream = I2S::master(p.I2S, irq, p.P0_25, p.P0_26, p.P0_27, master_clock, config).output(p.P0_28);
type Sample = i16;
const NUM_SAMPLES: usize = 6000;
let mut buffers: [i2s::AlignedBuffer<Sample, NUM_SAMPLES>; 3] = [ let mut buffers: [i2s::AlignedBuffer<Sample, NUM_SAMPLES>; 3] = [
i2s::AlignedBuffer::default(), i2s::AlignedBuffer::default(),
@ -40,7 +36,38 @@ async fn main(_spawner: Spawner) {
i2s::AlignedBuffer::default(), i2s::AlignedBuffer::default(),
]; ];
let mut carrier = SineOsc::new(); let mut waveform = Waveform::new(1.0 / sample_rate as f32);
waveform.process(&mut buffers[0]);
waveform.process(&mut buffers[1]);
output_stream.start(&buffers[0]).await.expect("I2S Start");
let mut index = 1;
loop {
if let Err(err) = output_stream.send_from_ram(&buffers[index]).await {
error!("{}", err);
}
index += 1;
if index >= 3 {
index = 0;
}
waveform.process(&mut buffers[index]);
}
}
struct Waveform {
inv_sample_rate: f32,
carrier: SineOsc,
freq_mod: SineOsc,
amp_mod: SineOsc,
}
impl Waveform {
fn new(inv_sample_rate: f32) -> Self {
let carrier = SineOsc::new();
let mut freq_mod = SineOsc::new(); let mut freq_mod = SineOsc::new();
freq_mod.set_frequency(8.0, inv_sample_rate); freq_mod.set_frequency(8.0, inv_sample_rate);
@ -50,38 +77,30 @@ async fn main(_spawner: Spawner) {
amp_mod.set_frequency(16.0, inv_sample_rate); amp_mod.set_frequency(16.0, inv_sample_rate);
amp_mod.set_amplitude(0.5); amp_mod.set_amplitude(0.5);
let mut generate = |buf: &mut [Sample]| { Self {
for sample in &mut buf.chunks_mut(1) { inv_sample_rate,
let freq_modulation = bipolar_to_unipolar(freq_mod.generate()); carrier,
carrier.set_frequency(220.0 + 440.0 * freq_modulation, inv_sample_rate); freq_mod,
let amp_modulation = bipolar_to_unipolar(amp_mod.generate()); amp_mod,
carrier.set_amplitude(amp_modulation); }
let signal = carrier.generate(); }
let value = (Sample::SCALE as f32 * signal) as Sample;
sample[0] = value; fn process(&mut self, buf: &mut [Sample]) {
} for sample in buf.chunks_mut(1) {
}; let freq_modulation = bipolar_to_unipolar(self.freq_mod.generate());
self.carrier
generate(buffers[0].as_mut()); .set_frequency(110.0 + 440.0 * freq_modulation, self.inv_sample_rate);
generate(buffers[1].as_mut());
let amp_modulation = bipolar_to_unipolar(self.amp_mod.generate());
i2s.start(buffers[0].as_ref()).await.expect("I2S Start"); self.carrier.set_amplitude(amp_modulation);
let mut index = 1; let signal = self.carrier.generate();
loop {
if let Err(err) = i2s.send(buffers[index].as_ref()).await { sample[0] = (Sample::SCALE as f32 * signal) as Sample;
error!("{}", err); }
}
index += 1;
if index >= 3 {
index = 0;
}
generate(buffers[index].as_mut());
} }
} }
#[derive(Clone)]
struct SineOsc { struct SineOsc {
amplitude: f32, amplitude: f32,
modulo: f32, modulo: f32,