Remove deadcode from dmamux.
Smoosh bdma down to a single version.
This commit is contained in:
parent
45964c658c
commit
a9b2ed52ee
@ -1,8 +1,439 @@
|
|||||||
#![macro_use]
|
#![macro_use]
|
||||||
|
|
||||||
#[cfg_attr(bdma_v1, path = "v1.rs")]
|
use core::future::Future;
|
||||||
#[cfg_attr(bdma_v2, path = "v2.rs")]
|
use core::task::Poll;
|
||||||
mod _version;
|
|
||||||
|
use atomic_polyfill::{AtomicU8, Ordering};
|
||||||
|
use embassy::interrupt::{Interrupt, InterruptExt};
|
||||||
|
use embassy::util::{AtomicWaker, OnDrop};
|
||||||
|
use futures::future::poll_fn;
|
||||||
|
|
||||||
|
use crate::dma_traits::{ReadDma, WriteDma};
|
||||||
|
use crate::interrupt;
|
||||||
|
use crate::pac;
|
||||||
|
use crate::pac::bdma::vals;
|
||||||
|
|
||||||
|
const CH_COUNT: usize = pac::peripheral_count!(DMA) * 8;
|
||||||
|
const CH_STATUS_NONE: u8 = 0;
|
||||||
|
const CH_STATUS_COMPLETED: u8 = 1;
|
||||||
|
const CH_STATUS_ERROR: u8 = 2;
|
||||||
|
|
||||||
|
struct State {
|
||||||
|
ch_wakers: [AtomicWaker; CH_COUNT],
|
||||||
|
ch_status: [AtomicU8; CH_COUNT],
|
||||||
|
}
|
||||||
|
|
||||||
|
impl State {
|
||||||
|
const fn new() -> Self {
|
||||||
|
const AW: AtomicWaker = AtomicWaker::new();
|
||||||
|
const AU: AtomicU8 = AtomicU8::new(CH_STATUS_NONE);
|
||||||
|
Self {
|
||||||
|
ch_wakers: [AW; CH_COUNT],
|
||||||
|
ch_status: [AU; CH_COUNT],
|
||||||
|
}
|
||||||
|
}
|
||||||
|
}
|
||||||
|
|
||||||
|
static STATE: State = State::new();
|
||||||
|
|
||||||
#[allow(unused)]
|
#[allow(unused)]
|
||||||
pub use _version::*;
|
pub(crate) async unsafe fn transfer_p2m(
|
||||||
|
regs: pac::bdma::Ch,
|
||||||
|
state_number: usize,
|
||||||
|
src: *const u8,
|
||||||
|
dst: &mut [u8],
|
||||||
|
#[cfg(dmamux)] dmamux_regs: pac::dmamux::Dmamux,
|
||||||
|
#[cfg(dmamux)] dmamux_ch_num: u8,
|
||||||
|
#[cfg(dmamux)] request: u8,
|
||||||
|
) {
|
||||||
|
// ndtr is max 16 bits.
|
||||||
|
assert!(dst.len() <= 0xFFFF);
|
||||||
|
|
||||||
|
// Reset status
|
||||||
|
// Generate a DMB here to flush the store buffer (M7) before enabling the DMA
|
||||||
|
STATE.ch_status[state_number].store(CH_STATUS_NONE, Ordering::Release);
|
||||||
|
|
||||||
|
let on_drop = OnDrop::new(|| unsafe {
|
||||||
|
regs.cr().modify(|w| {
|
||||||
|
w.set_tcie(false);
|
||||||
|
w.set_teie(false);
|
||||||
|
w.set_en(false);
|
||||||
|
});
|
||||||
|
while regs.cr().read().en() {}
|
||||||
|
});
|
||||||
|
|
||||||
|
#[cfg(dmamux)]
|
||||||
|
crate::dmamux::configure_dmamux(dmamux_regs, dmamux_ch_num, request);
|
||||||
|
|
||||||
|
regs.par().write_value(src as u32);
|
||||||
|
regs.mar().write_value(dst.as_mut_ptr() as u32);
|
||||||
|
regs.ndtr().write(|w| w.set_ndt(dst.len() as u16));
|
||||||
|
regs.cr().write(|w| {
|
||||||
|
w.set_psize(vals::Size::BITS8);
|
||||||
|
w.set_msize(vals::Size::BITS8);
|
||||||
|
w.set_minc(vals::Inc::ENABLED);
|
||||||
|
w.set_teie(true);
|
||||||
|
w.set_tcie(true);
|
||||||
|
w.set_en(true);
|
||||||
|
});
|
||||||
|
|
||||||
|
let res = poll_fn(|cx| {
|
||||||
|
STATE.ch_wakers[state_number].register(cx.waker());
|
||||||
|
match STATE.ch_status[state_number].load(Ordering::Acquire) {
|
||||||
|
CH_STATUS_NONE => Poll::Pending,
|
||||||
|
x => Poll::Ready(x),
|
||||||
|
}
|
||||||
|
})
|
||||||
|
.await;
|
||||||
|
|
||||||
|
// TODO handle error
|
||||||
|
assert!(res == CH_STATUS_COMPLETED);
|
||||||
|
}
|
||||||
|
|
||||||
|
#[allow(unused)]
|
||||||
|
pub(crate) async unsafe fn transfer_m2p(
|
||||||
|
regs: pac::bdma::Ch,
|
||||||
|
state_number: usize,
|
||||||
|
src: &[u8],
|
||||||
|
dst: *mut u8,
|
||||||
|
#[cfg(dmamux)] dmamux_regs: pac::dmamux::Dmamux,
|
||||||
|
#[cfg(dmamux)] dmamux_ch_num: u8,
|
||||||
|
#[cfg(dmamux)] request: u8,
|
||||||
|
) {
|
||||||
|
// ndtr is max 16 bits.
|
||||||
|
assert!(src.len() <= 0xFFFF);
|
||||||
|
|
||||||
|
// Reset status
|
||||||
|
// Generate a DMB here to flush the store buffer (M7) before enabling the DMA
|
||||||
|
STATE.ch_status[state_number].store(CH_STATUS_NONE, Ordering::Release);
|
||||||
|
|
||||||
|
let on_drop = OnDrop::new(|| unsafe {
|
||||||
|
regs.cr().modify(|w| {
|
||||||
|
w.set_tcie(false);
|
||||||
|
w.set_teie(false);
|
||||||
|
w.set_en(false);
|
||||||
|
});
|
||||||
|
while regs.cr().read().en() {}
|
||||||
|
});
|
||||||
|
|
||||||
|
#[cfg(dmamux)]
|
||||||
|
crate::dmamux::configure_dmamux(dmamux_regs, dmamux_ch_num, request);
|
||||||
|
|
||||||
|
regs.par().write_value(dst as u32);
|
||||||
|
regs.mar().write_value(src.as_ptr() as u32);
|
||||||
|
regs.ndtr().write(|w| w.set_ndt(src.len() as u16));
|
||||||
|
regs.cr().write(|w| {
|
||||||
|
w.set_psize(vals::Size::BITS8);
|
||||||
|
w.set_msize(vals::Size::BITS8);
|
||||||
|
w.set_minc(vals::Inc::ENABLED);
|
||||||
|
w.set_dir(vals::Dir::FROMMEMORY);
|
||||||
|
w.set_teie(true);
|
||||||
|
w.set_tcie(true);
|
||||||
|
w.set_en(true);
|
||||||
|
});
|
||||||
|
|
||||||
|
let res = poll_fn(|cx| {
|
||||||
|
STATE.ch_wakers[state_number].register(cx.waker());
|
||||||
|
match STATE.ch_status[state_number].load(Ordering::Acquire) {
|
||||||
|
CH_STATUS_NONE => Poll::Pending,
|
||||||
|
x => Poll::Ready(x),
|
||||||
|
}
|
||||||
|
})
|
||||||
|
.await;
|
||||||
|
|
||||||
|
// TODO handle error
|
||||||
|
assert!(res == CH_STATUS_COMPLETED);
|
||||||
|
}
|
||||||
|
|
||||||
|
unsafe fn on_irq() {
|
||||||
|
pac::peripherals! {
|
||||||
|
(bdma, $dma:ident) => {
|
||||||
|
let isr = pac::$dma.isr().read();
|
||||||
|
pac::$dma.ifcr().write_value(isr);
|
||||||
|
let dman = <crate::peripherals::$dma as sealed::Dma>::num() as usize;
|
||||||
|
|
||||||
|
for chn in 0..7 {
|
||||||
|
let n = dman * 8 + chn;
|
||||||
|
if isr.teif(chn) {
|
||||||
|
STATE.ch_status[n].store(CH_STATUS_ERROR, Ordering::Relaxed);
|
||||||
|
STATE.ch_wakers[n].wake();
|
||||||
|
} else if isr.tcif(chn) {
|
||||||
|
STATE.ch_status[n].store(CH_STATUS_COMPLETED, Ordering::Relaxed);
|
||||||
|
STATE.ch_wakers[n].wake();
|
||||||
|
}
|
||||||
|
}
|
||||||
|
};
|
||||||
|
}
|
||||||
|
}
|
||||||
|
|
||||||
|
use crate::rcc::sealed::RccPeripheral;
|
||||||
|
|
||||||
|
/// safety: must be called only once
|
||||||
|
pub(crate) unsafe fn init() {
|
||||||
|
pac::interrupts! {
|
||||||
|
(DMA, $irq:ident) => {
|
||||||
|
crate::interrupt::$irq::steal().enable();
|
||||||
|
};
|
||||||
|
}
|
||||||
|
pac::peripherals! {
|
||||||
|
(bdma, $peri:ident) => {
|
||||||
|
crate::peripherals::$peri::enable();
|
||||||
|
};
|
||||||
|
}
|
||||||
|
}
|
||||||
|
|
||||||
|
pub(crate) mod sealed {
|
||||||
|
use super::*;
|
||||||
|
|
||||||
|
pub trait Dma {
|
||||||
|
fn num() -> u8;
|
||||||
|
}
|
||||||
|
|
||||||
|
pub trait Channel {
|
||||||
|
fn dma_regs() -> pac::bdma::Dma;
|
||||||
|
|
||||||
|
fn state_num(&self) -> usize;
|
||||||
|
|
||||||
|
fn ch_num(&self) -> u8;
|
||||||
|
|
||||||
|
fn regs(&self) -> pac::bdma::Ch {
|
||||||
|
Self::dma_regs().ch(self.ch_num() as usize)
|
||||||
|
}
|
||||||
|
}
|
||||||
|
}
|
||||||
|
|
||||||
|
pub trait Dma: sealed::Dma + Sized {}
|
||||||
|
pub trait Channel: sealed::Channel + Sized {}
|
||||||
|
|
||||||
|
macro_rules! impl_dma {
|
||||||
|
($peri:ident, $num:expr) => {
|
||||||
|
impl Dma for crate::peripherals::$peri {}
|
||||||
|
impl sealed::Dma for crate::peripherals::$peri {
|
||||||
|
fn num() -> u8 {
|
||||||
|
$num
|
||||||
|
}
|
||||||
|
}
|
||||||
|
};
|
||||||
|
}
|
||||||
|
|
||||||
|
macro_rules! impl_dma_channel {
|
||||||
|
($channel_peri:ident, $dma_peri:ident, $dma_num:expr, $ch_num:expr) => {
|
||||||
|
impl Channel for crate::peripherals::$channel_peri {}
|
||||||
|
impl sealed::Channel for crate::peripherals::$channel_peri {
|
||||||
|
#[inline]
|
||||||
|
fn dma_regs() -> pac::bdma::Dma {
|
||||||
|
crate::pac::$dma_peri
|
||||||
|
}
|
||||||
|
|
||||||
|
fn state_num(&self) -> usize {
|
||||||
|
($dma_num * 8) + $ch_num
|
||||||
|
}
|
||||||
|
|
||||||
|
fn ch_num(&self) -> u8 {
|
||||||
|
$ch_num
|
||||||
|
}
|
||||||
|
}
|
||||||
|
|
||||||
|
#[cfg(not(dmamux))]
|
||||||
|
impl<T> WriteDma<T> for crate::peripherals::$channel_peri
|
||||||
|
where
|
||||||
|
T: 'static,
|
||||||
|
{
|
||||||
|
type WriteDmaFuture<'a> = impl Future<Output = ()>;
|
||||||
|
|
||||||
|
fn transfer<'a>(&'a mut self, buf: &'a [u8], dst: *mut u8) -> Self::WriteDmaFuture<'a>
|
||||||
|
where
|
||||||
|
T: 'a,
|
||||||
|
{
|
||||||
|
use sealed::Channel as _Channel;
|
||||||
|
|
||||||
|
let state_num = self.state_num();
|
||||||
|
let regs = self.regs();
|
||||||
|
|
||||||
|
unsafe { transfer_m2p(regs, state_num, buf, dst) }
|
||||||
|
}
|
||||||
|
}
|
||||||
|
|
||||||
|
#[cfg(dmamux)]
|
||||||
|
impl<T> WriteDma<T> for crate::peripherals::$channel_peri
|
||||||
|
where
|
||||||
|
Self: crate::dmamux::sealed::PeripheralChannel<T, crate::dmamux::M2P>,
|
||||||
|
T: 'static,
|
||||||
|
{
|
||||||
|
type WriteDmaFuture<'a> = impl Future<Output = ()>;
|
||||||
|
|
||||||
|
fn transfer<'a>(&'a mut self, buf: &'a [u8], dst: *mut u8) -> Self::WriteDmaFuture<'a>
|
||||||
|
where
|
||||||
|
T: 'a,
|
||||||
|
{
|
||||||
|
use sealed::Channel as _Channel;
|
||||||
|
|
||||||
|
let state_num = self.state_num();
|
||||||
|
let regs = self.regs();
|
||||||
|
|
||||||
|
use crate::dmamux::sealed::Channel as _MuxChannel;
|
||||||
|
use crate::dmamux::sealed::PeripheralChannel;
|
||||||
|
let dmamux_regs = self.dmamux_regs();
|
||||||
|
let dmamux_ch_num = self.dmamux_ch_num();
|
||||||
|
let request = PeripheralChannel::<T, crate::dmamux::M2P>::request(self);
|
||||||
|
unsafe {
|
||||||
|
transfer_m2p(
|
||||||
|
regs,
|
||||||
|
state_num,
|
||||||
|
buf,
|
||||||
|
dst,
|
||||||
|
dmamux_regs,
|
||||||
|
dmamux_ch_num,
|
||||||
|
request,
|
||||||
|
)
|
||||||
|
}
|
||||||
|
}
|
||||||
|
}
|
||||||
|
|
||||||
|
#[cfg(not(dmamux))]
|
||||||
|
impl<T> ReadDma<T> for crate::peripherals::$channel_peri
|
||||||
|
where
|
||||||
|
T: 'static,
|
||||||
|
{
|
||||||
|
type ReadDmaFuture<'a> = impl Future<Output = ()>;
|
||||||
|
|
||||||
|
fn transfer<'a>(
|
||||||
|
&'a mut self,
|
||||||
|
src: *const u8,
|
||||||
|
buf: &'a mut [u8],
|
||||||
|
) -> Self::ReadDmaFuture<'a>
|
||||||
|
where
|
||||||
|
T: 'a,
|
||||||
|
{
|
||||||
|
use sealed::Channel as _Channel;
|
||||||
|
|
||||||
|
let state_num = self.state_num();
|
||||||
|
let regs = self.regs();
|
||||||
|
unsafe { transfer_p2m(regs, state_num, src, buf) }
|
||||||
|
}
|
||||||
|
}
|
||||||
|
|
||||||
|
#[cfg(dmamux)]
|
||||||
|
impl<T> ReadDma<T> for crate::peripherals::$channel_peri
|
||||||
|
where
|
||||||
|
Self: crate::dmamux::sealed::PeripheralChannel<T, crate::dmamux::M2P>,
|
||||||
|
T: 'static,
|
||||||
|
{
|
||||||
|
type ReadDmaFuture<'a> = impl Future<Output = ()>;
|
||||||
|
|
||||||
|
fn transfer<'a>(
|
||||||
|
&'a mut self,
|
||||||
|
src: *const u8,
|
||||||
|
buf: &'a mut [u8],
|
||||||
|
) -> Self::ReadDmaFuture<'a>
|
||||||
|
where
|
||||||
|
T: 'a,
|
||||||
|
{
|
||||||
|
use sealed::Channel as _Channel;
|
||||||
|
|
||||||
|
let state_num = self.state_num();
|
||||||
|
let regs = self.regs();
|
||||||
|
|
||||||
|
use crate::dmamux::sealed::Channel as _MuxChannel;
|
||||||
|
use crate::dmamux::sealed::PeripheralChannel;
|
||||||
|
let dmamux_regs = self.dmamux_regs();
|
||||||
|
let dmamux_ch_num = self.dmamux_ch_num();
|
||||||
|
let request = PeripheralChannel::<T, crate::dmamux::M2P>::request(self);
|
||||||
|
unsafe {
|
||||||
|
transfer_p2m(
|
||||||
|
regs,
|
||||||
|
state_num,
|
||||||
|
src,
|
||||||
|
buf,
|
||||||
|
dmamux_regs,
|
||||||
|
dmamux_ch_num,
|
||||||
|
request,
|
||||||
|
)
|
||||||
|
}
|
||||||
|
}
|
||||||
|
}
|
||||||
|
};
|
||||||
|
}
|
||||||
|
|
||||||
|
pac::peripherals! {
|
||||||
|
(bdma, DMA1) => {
|
||||||
|
impl_dma!(DMA1, 0);
|
||||||
|
pac::bdma_channels! {
|
||||||
|
($channel_peri:ident, DMA1, $channel_num:expr) => {
|
||||||
|
impl_dma_channel!($channel_peri, DMA1, 0, $channel_num);
|
||||||
|
};
|
||||||
|
}
|
||||||
|
};
|
||||||
|
(bdma, DMA2) => {
|
||||||
|
impl_dma!(DMA2, 1);
|
||||||
|
pac::bdma_channels! {
|
||||||
|
($channel_peri:ident, DMA2, $channel_num:expr) => {
|
||||||
|
impl_dma_channel!($channel_peri, DMA2, 1, $channel_num);
|
||||||
|
};
|
||||||
|
}
|
||||||
|
};
|
||||||
|
// Because H7cm changes the naming
|
||||||
|
(bdma, BDMA) => {
|
||||||
|
impl_dma!(BDMA, 0);
|
||||||
|
pac::bdma_channels! {
|
||||||
|
($channel_peri:ident, BDMA, $channel_num:expr) => {
|
||||||
|
impl_dma_channel!($channel_peri, BDMA, 0, $channel_num);
|
||||||
|
};
|
||||||
|
}
|
||||||
|
};
|
||||||
|
}
|
||||||
|
|
||||||
|
pac::interrupts! {
|
||||||
|
(DMA, $irq:ident) => {
|
||||||
|
#[crate::interrupt]
|
||||||
|
unsafe fn $irq () {
|
||||||
|
on_irq()
|
||||||
|
}
|
||||||
|
};
|
||||||
|
}
|
||||||
|
|
||||||
|
#[cfg(usart)]
|
||||||
|
use crate::usart;
|
||||||
|
|
||||||
|
#[cfg(not(dmamux))]
|
||||||
|
pac::peripheral_dma_channels! {
|
||||||
|
($peri:ident, usart, $kind:ident, RX, $channel_peri:ident, $dma_peri:ident, $channel_num:expr) => {
|
||||||
|
impl usart::RxDma<crate::peripherals::$peri> for crate::peripherals::$channel_peri { }
|
||||||
|
impl usart::sealed::RxDma<crate::peripherals::$peri> for crate::peripherals::$channel_peri { }
|
||||||
|
};
|
||||||
|
|
||||||
|
($peri:ident, usart, $kind:ident, TX, $channel_peri:ident, $dma_peri:ident, $channel_num:expr) => {
|
||||||
|
impl usart::TxDma<crate::peripherals::$peri> for crate::peripherals::$channel_peri { }
|
||||||
|
impl usart::sealed::TxDma<crate::peripherals::$peri> for crate::peripherals::$channel_peri { }
|
||||||
|
};
|
||||||
|
|
||||||
|
($peri:ident, uart, $kind:ident, RX, $channel_peri:ident, $dma_peri:ident, $channel_num:expr) => {
|
||||||
|
impl usart::RxDma<crate::peripherals::$peri> for crate::peripherals::$channel_peri { }
|
||||||
|
impl usart::sealed::RxDma<crate::peripherals::$peri> for crate::peripherals::$channel_peri { }
|
||||||
|
};
|
||||||
|
|
||||||
|
($peri:ident, uart, $kind:ident, TX, $channel_peri:ident, $dma_peri:ident, $channel_num:expr) => {
|
||||||
|
impl usart::TxDma<crate::peripherals::$peri> for crate::peripherals::$channel_peri { }
|
||||||
|
impl usart::sealed::TxDma<crate::peripherals::$peri> for crate::peripherals::$channel_peri { }
|
||||||
|
};
|
||||||
|
}
|
||||||
|
|
||||||
|
#[cfg(dmamux)]
|
||||||
|
pac::peripherals! {
|
||||||
|
(usart, $peri:ident) => {
|
||||||
|
pac::bdma_channels! {
|
||||||
|
($channel_peri:ident, $dma_peri:ident, $channel_num:expr) => {
|
||||||
|
impl usart::TxDma<crate::peripherals::$peri> for crate::peripherals::$channel_peri { }
|
||||||
|
impl usart::sealed::TxDma<crate::peripherals::$peri> for crate::peripherals::$channel_peri { }
|
||||||
|
};
|
||||||
|
}
|
||||||
|
};
|
||||||
|
(uart, $peri:ident) => {
|
||||||
|
pac::bdma_channels! {
|
||||||
|
($channel_peri:ident, $dma_peri:ident, $channel_num:expr) => {
|
||||||
|
impl usart::TxDma<crate::peripherals::$peri> for crate::peripherals::$channel_peri { }
|
||||||
|
impl usart::sealed::TxDma<crate::peripherals::$peri> for crate::peripherals::$channel_peri { }
|
||||||
|
};
|
||||||
|
}
|
||||||
|
};
|
||||||
|
}
|
||||||
|
@ -1,437 +0,0 @@
|
|||||||
use core::future::Future;
|
|
||||||
use core::task::Poll;
|
|
||||||
|
|
||||||
use atomic_polyfill::{AtomicU8, Ordering};
|
|
||||||
use embassy::interrupt::{Interrupt, InterruptExt};
|
|
||||||
use embassy::util::{AtomicWaker, OnDrop};
|
|
||||||
use futures::future::poll_fn;
|
|
||||||
|
|
||||||
use crate::dma_traits::{ReadDma, WriteDma};
|
|
||||||
use crate::interrupt;
|
|
||||||
use crate::pac;
|
|
||||||
use crate::pac::bdma::vals;
|
|
||||||
|
|
||||||
const CH_COUNT: usize = pac::peripheral_count!(DMA) * 8;
|
|
||||||
const CH_STATUS_NONE: u8 = 0;
|
|
||||||
const CH_STATUS_COMPLETED: u8 = 1;
|
|
||||||
const CH_STATUS_ERROR: u8 = 2;
|
|
||||||
|
|
||||||
struct State {
|
|
||||||
ch_wakers: [AtomicWaker; CH_COUNT],
|
|
||||||
ch_status: [AtomicU8; CH_COUNT],
|
|
||||||
}
|
|
||||||
|
|
||||||
impl State {
|
|
||||||
const fn new() -> Self {
|
|
||||||
const AW: AtomicWaker = AtomicWaker::new();
|
|
||||||
const AU: AtomicU8 = AtomicU8::new(CH_STATUS_NONE);
|
|
||||||
Self {
|
|
||||||
ch_wakers: [AW; CH_COUNT],
|
|
||||||
ch_status: [AU; CH_COUNT],
|
|
||||||
}
|
|
||||||
}
|
|
||||||
}
|
|
||||||
|
|
||||||
static STATE: State = State::new();
|
|
||||||
|
|
||||||
#[allow(unused)]
|
|
||||||
pub(crate) async unsafe fn transfer_p2m(
|
|
||||||
regs: pac::bdma::Ch,
|
|
||||||
state_number: usize,
|
|
||||||
src: *const u8,
|
|
||||||
dst: &mut [u8],
|
|
||||||
#[cfg(dmamux)] dmamux_regs: pac::dmamux::Dmamux,
|
|
||||||
#[cfg(dmamux)] dmamux_ch_num: u8,
|
|
||||||
#[cfg(dmamux)] request: u8,
|
|
||||||
) {
|
|
||||||
// ndtr is max 16 bits.
|
|
||||||
assert!(dst.len() <= 0xFFFF);
|
|
||||||
|
|
||||||
// Reset status
|
|
||||||
// Generate a DMB here to flush the store buffer (M7) before enabling the DMA
|
|
||||||
STATE.ch_status[state_number].store(CH_STATUS_NONE, Ordering::Release);
|
|
||||||
|
|
||||||
let on_drop = OnDrop::new(|| unsafe {
|
|
||||||
regs.cr().modify(|w| {
|
|
||||||
w.set_tcie(false);
|
|
||||||
w.set_teie(false);
|
|
||||||
w.set_en(false);
|
|
||||||
});
|
|
||||||
while regs.cr().read().en() {}
|
|
||||||
});
|
|
||||||
|
|
||||||
#[cfg(dmamux)]
|
|
||||||
crate::dmamux::configure_dmamux(dmamux_regs, dmamux_ch_num, request);
|
|
||||||
|
|
||||||
regs.par().write_value(src as u32);
|
|
||||||
regs.mar().write_value(dst.as_mut_ptr() as u32);
|
|
||||||
regs.ndtr().write(|w| w.set_ndt(dst.len() as u16));
|
|
||||||
regs.cr().write(|w| {
|
|
||||||
w.set_psize(vals::Size::BITS8);
|
|
||||||
w.set_msize(vals::Size::BITS8);
|
|
||||||
w.set_minc(vals::Inc::ENABLED);
|
|
||||||
w.set_teie(true);
|
|
||||||
w.set_tcie(true);
|
|
||||||
w.set_en(true);
|
|
||||||
});
|
|
||||||
|
|
||||||
let res = poll_fn(|cx| {
|
|
||||||
STATE.ch_wakers[state_number].register(cx.waker());
|
|
||||||
match STATE.ch_status[state_number].load(Ordering::Acquire) {
|
|
||||||
CH_STATUS_NONE => Poll::Pending,
|
|
||||||
x => Poll::Ready(x),
|
|
||||||
}
|
|
||||||
})
|
|
||||||
.await;
|
|
||||||
|
|
||||||
// TODO handle error
|
|
||||||
assert!(res == CH_STATUS_COMPLETED);
|
|
||||||
}
|
|
||||||
|
|
||||||
#[allow(unused)]
|
|
||||||
pub(crate) async unsafe fn transfer_m2p(
|
|
||||||
regs: pac::bdma::Ch,
|
|
||||||
state_number: usize,
|
|
||||||
src: &[u8],
|
|
||||||
dst: *mut u8,
|
|
||||||
#[cfg(dmamux)] dmamux_regs: pac::dmamux::Dmamux,
|
|
||||||
#[cfg(dmamux)] dmamux_ch_num: u8,
|
|
||||||
#[cfg(dmamux)] request: u8,
|
|
||||||
) {
|
|
||||||
// ndtr is max 16 bits.
|
|
||||||
assert!(src.len() <= 0xFFFF);
|
|
||||||
|
|
||||||
// Reset status
|
|
||||||
// Generate a DMB here to flush the store buffer (M7) before enabling the DMA
|
|
||||||
STATE.ch_status[state_number].store(CH_STATUS_NONE, Ordering::Release);
|
|
||||||
|
|
||||||
let on_drop = OnDrop::new(|| unsafe {
|
|
||||||
regs.cr().modify(|w| {
|
|
||||||
w.set_tcie(false);
|
|
||||||
w.set_teie(false);
|
|
||||||
w.set_en(false);
|
|
||||||
});
|
|
||||||
while regs.cr().read().en() {}
|
|
||||||
});
|
|
||||||
|
|
||||||
#[cfg(dmamux)]
|
|
||||||
crate::dmamux::configure_dmamux(dmamux_regs, dmamux_ch_num, request);
|
|
||||||
|
|
||||||
regs.par().write_value(dst as u32);
|
|
||||||
regs.mar().write_value(src.as_ptr() as u32);
|
|
||||||
regs.ndtr().write(|w| w.set_ndt(src.len() as u16));
|
|
||||||
regs.cr().write(|w| {
|
|
||||||
w.set_psize(vals::Size::BITS8);
|
|
||||||
w.set_msize(vals::Size::BITS8);
|
|
||||||
w.set_minc(vals::Inc::ENABLED);
|
|
||||||
w.set_dir(vals::Dir::FROMMEMORY);
|
|
||||||
w.set_teie(true);
|
|
||||||
w.set_tcie(true);
|
|
||||||
w.set_en(true);
|
|
||||||
});
|
|
||||||
|
|
||||||
let res = poll_fn(|cx| {
|
|
||||||
STATE.ch_wakers[state_number].register(cx.waker());
|
|
||||||
match STATE.ch_status[state_number].load(Ordering::Acquire) {
|
|
||||||
CH_STATUS_NONE => Poll::Pending,
|
|
||||||
x => Poll::Ready(x),
|
|
||||||
}
|
|
||||||
})
|
|
||||||
.await;
|
|
||||||
|
|
||||||
// TODO handle error
|
|
||||||
assert!(res == CH_STATUS_COMPLETED);
|
|
||||||
}
|
|
||||||
|
|
||||||
unsafe fn on_irq() {
|
|
||||||
pac::peripherals! {
|
|
||||||
(bdma, $dma:ident) => {
|
|
||||||
let isr = pac::$dma.isr().read();
|
|
||||||
pac::$dma.ifcr().write_value(isr);
|
|
||||||
let dman = <crate::peripherals::$dma as sealed::Dma>::num() as usize;
|
|
||||||
|
|
||||||
for chn in 0..7 {
|
|
||||||
let n = dman * 8 + chn;
|
|
||||||
if isr.teif(chn) {
|
|
||||||
STATE.ch_status[n].store(CH_STATUS_ERROR, Ordering::Relaxed);
|
|
||||||
STATE.ch_wakers[n].wake();
|
|
||||||
} else if isr.tcif(chn) {
|
|
||||||
STATE.ch_status[n].store(CH_STATUS_COMPLETED, Ordering::Relaxed);
|
|
||||||
STATE.ch_wakers[n].wake();
|
|
||||||
}
|
|
||||||
}
|
|
||||||
};
|
|
||||||
}
|
|
||||||
}
|
|
||||||
|
|
||||||
use crate::rcc::sealed::RccPeripheral;
|
|
||||||
|
|
||||||
/// safety: must be called only once
|
|
||||||
pub(crate) unsafe fn init() {
|
|
||||||
pac::interrupts! {
|
|
||||||
(DMA, $irq:ident) => {
|
|
||||||
crate::interrupt::$irq::steal().enable();
|
|
||||||
};
|
|
||||||
}
|
|
||||||
pac::peripherals! {
|
|
||||||
(bdma, $peri:ident) => {
|
|
||||||
crate::peripherals::$peri::enable();
|
|
||||||
};
|
|
||||||
}
|
|
||||||
}
|
|
||||||
|
|
||||||
pub(crate) mod sealed {
|
|
||||||
use super::*;
|
|
||||||
|
|
||||||
pub trait Dma {
|
|
||||||
fn num() -> u8;
|
|
||||||
}
|
|
||||||
|
|
||||||
pub trait Channel {
|
|
||||||
fn dma_regs() -> pac::bdma::Dma;
|
|
||||||
|
|
||||||
fn state_num(&self) -> usize;
|
|
||||||
|
|
||||||
fn ch_num(&self) -> u8;
|
|
||||||
|
|
||||||
fn regs(&self) -> pac::bdma::Ch {
|
|
||||||
Self::dma_regs().ch(self.ch_num() as usize)
|
|
||||||
}
|
|
||||||
}
|
|
||||||
}
|
|
||||||
|
|
||||||
pub trait Dma: sealed::Dma + Sized {}
|
|
||||||
pub trait Channel: sealed::Channel + Sized {}
|
|
||||||
|
|
||||||
macro_rules! impl_dma {
|
|
||||||
($peri:ident, $num:expr) => {
|
|
||||||
impl Dma for crate::peripherals::$peri {}
|
|
||||||
impl sealed::Dma for crate::peripherals::$peri {
|
|
||||||
fn num() -> u8 {
|
|
||||||
$num
|
|
||||||
}
|
|
||||||
}
|
|
||||||
};
|
|
||||||
}
|
|
||||||
|
|
||||||
macro_rules! impl_dma_channel {
|
|
||||||
($channel_peri:ident, $dma_peri:ident, $dma_num:expr, $ch_num:expr) => {
|
|
||||||
impl Channel for crate::peripherals::$channel_peri {}
|
|
||||||
impl sealed::Channel for crate::peripherals::$channel_peri {
|
|
||||||
#[inline]
|
|
||||||
fn dma_regs() -> pac::bdma::Dma {
|
|
||||||
crate::pac::$dma_peri
|
|
||||||
}
|
|
||||||
|
|
||||||
fn state_num(&self) -> usize {
|
|
||||||
($dma_num * 8) + $ch_num
|
|
||||||
}
|
|
||||||
|
|
||||||
fn ch_num(&self) -> u8 {
|
|
||||||
$ch_num
|
|
||||||
}
|
|
||||||
}
|
|
||||||
|
|
||||||
#[cfg(not(dmamux))]
|
|
||||||
impl<T> WriteDma<T> for crate::peripherals::$channel_peri
|
|
||||||
where
|
|
||||||
T: 'static,
|
|
||||||
{
|
|
||||||
type WriteDmaFuture<'a> = impl Future<Output = ()>;
|
|
||||||
|
|
||||||
fn transfer<'a>(&'a mut self, buf: &'a [u8], dst: *mut u8) -> Self::WriteDmaFuture<'a>
|
|
||||||
where
|
|
||||||
T: 'a,
|
|
||||||
{
|
|
||||||
use sealed::Channel as _Channel;
|
|
||||||
|
|
||||||
let state_num = self.state_num();
|
|
||||||
let regs = self.regs();
|
|
||||||
|
|
||||||
unsafe { transfer_m2p(regs, state_num, buf, dst) }
|
|
||||||
}
|
|
||||||
}
|
|
||||||
|
|
||||||
#[cfg(dmamux)]
|
|
||||||
impl<T> WriteDma<T> for crate::peripherals::$channel_peri
|
|
||||||
where
|
|
||||||
Self: crate::dmamux::sealed::PeripheralChannel<T, crate::dmamux::M2P>,
|
|
||||||
T: 'static,
|
|
||||||
{
|
|
||||||
type WriteDmaFuture<'a> = impl Future<Output = ()>;
|
|
||||||
|
|
||||||
fn transfer<'a>(&'a mut self, buf: &'a [u8], dst: *mut u8) -> Self::WriteDmaFuture<'a>
|
|
||||||
where
|
|
||||||
T: 'a,
|
|
||||||
{
|
|
||||||
use sealed::Channel as _Channel;
|
|
||||||
|
|
||||||
let state_num = self.state_num();
|
|
||||||
let regs = self.regs();
|
|
||||||
|
|
||||||
use crate::dmamux::sealed::Channel as _MuxChannel;
|
|
||||||
use crate::dmamux::sealed::PeripheralChannel;
|
|
||||||
let dmamux_regs = self.dmamux_regs();
|
|
||||||
let dmamux_ch_num = self.dmamux_ch_num();
|
|
||||||
let request = PeripheralChannel::<T, crate::dmamux::M2P>::request(self);
|
|
||||||
unsafe {
|
|
||||||
transfer_m2p(
|
|
||||||
regs,
|
|
||||||
state_num,
|
|
||||||
buf,
|
|
||||||
dst,
|
|
||||||
dmamux_regs,
|
|
||||||
dmamux_ch_num,
|
|
||||||
request,
|
|
||||||
)
|
|
||||||
}
|
|
||||||
}
|
|
||||||
}
|
|
||||||
|
|
||||||
#[cfg(not(dmamux))]
|
|
||||||
impl<T> ReadDma<T> for crate::peripherals::$channel_peri
|
|
||||||
where
|
|
||||||
T: 'static,
|
|
||||||
{
|
|
||||||
type ReadDmaFuture<'a> = impl Future<Output = ()>;
|
|
||||||
|
|
||||||
fn transfer<'a>(
|
|
||||||
&'a mut self,
|
|
||||||
src: *const u8,
|
|
||||||
buf: &'a mut [u8],
|
|
||||||
) -> Self::ReadDmaFuture<'a>
|
|
||||||
where
|
|
||||||
T: 'a,
|
|
||||||
{
|
|
||||||
use sealed::Channel as _Channel;
|
|
||||||
|
|
||||||
let state_num = self.state_num();
|
|
||||||
let regs = self.regs();
|
|
||||||
unsafe { transfer_p2m(regs, state_num, src, buf) }
|
|
||||||
}
|
|
||||||
}
|
|
||||||
|
|
||||||
#[cfg(dmamux)]
|
|
||||||
impl<T> ReadDma<T> for crate::peripherals::$channel_peri
|
|
||||||
where
|
|
||||||
Self: crate::dmamux::sealed::PeripheralChannel<T, crate::dmamux::M2P>,
|
|
||||||
T: 'static,
|
|
||||||
{
|
|
||||||
type ReadDmaFuture<'a> = impl Future<Output = ()>;
|
|
||||||
|
|
||||||
fn transfer<'a>(
|
|
||||||
&'a mut self,
|
|
||||||
src: *const u8,
|
|
||||||
buf: &'a mut [u8],
|
|
||||||
) -> Self::ReadDmaFuture<'a>
|
|
||||||
where
|
|
||||||
T: 'a,
|
|
||||||
{
|
|
||||||
use sealed::Channel as _Channel;
|
|
||||||
|
|
||||||
let state_num = self.state_num();
|
|
||||||
let regs = self.regs();
|
|
||||||
|
|
||||||
use crate::dmamux::sealed::Channel as _MuxChannel;
|
|
||||||
use crate::dmamux::sealed::PeripheralChannel;
|
|
||||||
let dmamux_regs = self.dmamux_regs();
|
|
||||||
let dmamux_ch_num = self.dmamux_ch_num();
|
|
||||||
let request = PeripheralChannel::<T, crate::dmamux::M2P>::request(self);
|
|
||||||
unsafe {
|
|
||||||
transfer_p2m(
|
|
||||||
regs,
|
|
||||||
state_num,
|
|
||||||
src,
|
|
||||||
buf,
|
|
||||||
dmamux_regs,
|
|
||||||
dmamux_ch_num,
|
|
||||||
request,
|
|
||||||
)
|
|
||||||
}
|
|
||||||
}
|
|
||||||
}
|
|
||||||
};
|
|
||||||
}
|
|
||||||
|
|
||||||
pac::peripherals! {
|
|
||||||
(bdma, DMA1) => {
|
|
||||||
impl_dma!(DMA1, 0);
|
|
||||||
pac::bdma_channels! {
|
|
||||||
($channel_peri:ident, DMA1, $channel_num:expr) => {
|
|
||||||
impl_dma_channel!($channel_peri, DMA1, 0, $channel_num);
|
|
||||||
};
|
|
||||||
}
|
|
||||||
};
|
|
||||||
(bdma, DMA2) => {
|
|
||||||
impl_dma!(DMA2, 1);
|
|
||||||
pac::bdma_channels! {
|
|
||||||
($channel_peri:ident, DMA2, $channel_num:expr) => {
|
|
||||||
impl_dma_channel!($channel_peri, DMA2, 1, $channel_num);
|
|
||||||
};
|
|
||||||
}
|
|
||||||
};
|
|
||||||
// Because H7cm changes the naming
|
|
||||||
(bdma, BDMA) => {
|
|
||||||
impl_dma!(BDMA, 0);
|
|
||||||
pac::bdma_channels! {
|
|
||||||
($channel_peri:ident, BDMA, $channel_num:expr) => {
|
|
||||||
impl_dma_channel!($channel_peri, BDMA, 0, $channel_num);
|
|
||||||
};
|
|
||||||
}
|
|
||||||
};
|
|
||||||
}
|
|
||||||
|
|
||||||
pac::interrupts! {
|
|
||||||
(DMA, $irq:ident) => {
|
|
||||||
#[crate::interrupt]
|
|
||||||
unsafe fn $irq () {
|
|
||||||
on_irq()
|
|
||||||
}
|
|
||||||
};
|
|
||||||
}
|
|
||||||
|
|
||||||
#[cfg(usart)]
|
|
||||||
use crate::usart;
|
|
||||||
|
|
||||||
#[cfg(not(dmamux))]
|
|
||||||
pac::peripheral_dma_channels! {
|
|
||||||
($peri:ident, usart, $kind:ident, RX, $channel_peri:ident, $dma_peri:ident, $channel_num:expr) => {
|
|
||||||
impl usart::RxDma<crate::peripherals::$peri> for crate::peripherals::$channel_peri { }
|
|
||||||
impl usart::sealed::RxDma<crate::peripherals::$peri> for crate::peripherals::$channel_peri { }
|
|
||||||
};
|
|
||||||
|
|
||||||
($peri:ident, usart, $kind:ident, TX, $channel_peri:ident, $dma_peri:ident, $channel_num:expr) => {
|
|
||||||
impl usart::TxDma<crate::peripherals::$peri> for crate::peripherals::$channel_peri { }
|
|
||||||
impl usart::sealed::TxDma<crate::peripherals::$peri> for crate::peripherals::$channel_peri { }
|
|
||||||
};
|
|
||||||
|
|
||||||
($peri:ident, uart, $kind:ident, RX, $channel_peri:ident, $dma_peri:ident, $channel_num:expr) => {
|
|
||||||
impl usart::RxDma<crate::peripherals::$peri> for crate::peripherals::$channel_peri { }
|
|
||||||
impl usart::sealed::RxDma<crate::peripherals::$peri> for crate::peripherals::$channel_peri { }
|
|
||||||
};
|
|
||||||
|
|
||||||
($peri:ident, uart, $kind:ident, TX, $channel_peri:ident, $dma_peri:ident, $channel_num:expr) => {
|
|
||||||
impl usart::TxDma<crate::peripherals::$peri> for crate::peripherals::$channel_peri { }
|
|
||||||
impl usart::sealed::TxDma<crate::peripherals::$peri> for crate::peripherals::$channel_peri { }
|
|
||||||
};
|
|
||||||
}
|
|
||||||
|
|
||||||
#[cfg(dmamux)]
|
|
||||||
pac::peripherals! {
|
|
||||||
(usart, $peri:ident) => {
|
|
||||||
pac::bdma_channels! {
|
|
||||||
($channel_peri:ident, $dma_peri:ident, $channel_num:expr) => {
|
|
||||||
impl usart::TxDma<crate::peripherals::$peri> for crate::peripherals::$channel_peri { }
|
|
||||||
impl usart::sealed::TxDma<crate::peripherals::$peri> for crate::peripherals::$channel_peri { }
|
|
||||||
};
|
|
||||||
}
|
|
||||||
};
|
|
||||||
(uart, $peri:ident) => {
|
|
||||||
pac::bdma_channels! {
|
|
||||||
($channel_peri:ident, $dma_peri:ident, $channel_num:expr) => {
|
|
||||||
impl usart::TxDma<crate::peripherals::$peri> for crate::peripherals::$channel_peri { }
|
|
||||||
impl usart::sealed::TxDma<crate::peripherals::$peri> for crate::peripherals::$channel_peri { }
|
|
||||||
};
|
|
||||||
}
|
|
||||||
};
|
|
||||||
}
|
|
@ -1 +0,0 @@
|
|||||||
pub(crate) unsafe fn init() {}
|
|
@ -6,82 +6,6 @@ use crate::pac::dma_requests;
|
|||||||
use crate::pac::peripherals;
|
use crate::pac::peripherals;
|
||||||
use crate::peripherals;
|
use crate::peripherals;
|
||||||
|
|
||||||
/*
|
|
||||||
#[allow(unused)]
|
|
||||||
pub(crate) async unsafe fn transfer_m2p(
|
|
||||||
ch: &mut impl Channel,
|
|
||||||
ch_func: u8,
|
|
||||||
src: &[u8],
|
|
||||||
dst: *mut u8,
|
|
||||||
) {
|
|
||||||
defmt::info!(
|
|
||||||
"m2p {} func {} {}-{}",
|
|
||||||
src.len(),
|
|
||||||
ch_func,
|
|
||||||
ch.num(),
|
|
||||||
ch.dma_ch_num()
|
|
||||||
);
|
|
||||||
let n = ch.num();
|
|
||||||
|
|
||||||
STATE.ch_status[n].store(CH_STATUS_NONE, Ordering::Release);
|
|
||||||
|
|
||||||
let ch_regs = ch.regs();
|
|
||||||
let dmamux_regs = ch.dmamux_regs();
|
|
||||||
let ch_mux_regs = dmamux_regs.ccr(ch.dmamux_ch_num() as _);
|
|
||||||
|
|
||||||
ch_mux_regs.write(|reg| {
|
|
||||||
// one request?
|
|
||||||
reg.set_nbreq(0);
|
|
||||||
reg.set_dmareq_id(ch_func);
|
|
||||||
});
|
|
||||||
|
|
||||||
ch_mux_regs.modify(|reg| {
|
|
||||||
reg.set_ege(true);
|
|
||||||
//reg.set_se(true);
|
|
||||||
//reg.set_soie(true);
|
|
||||||
});
|
|
||||||
|
|
||||||
ch_regs.par().write_value(dst as _);
|
|
||||||
ch_regs.mar().write_value(src.as_ptr() as _);
|
|
||||||
ch_regs.ndtr().write_value(regs::Ndtr(src.len() as _));
|
|
||||||
|
|
||||||
ch_regs.cr().write(|reg| {
|
|
||||||
reg.set_dir(vals::Dir::FROMMEMORY);
|
|
||||||
reg.set_msize(vals::Size::BITS8);
|
|
||||||
reg.set_minc(vals::Inc::ENABLED);
|
|
||||||
reg.set_pinc(vals::Inc::DISABLED);
|
|
||||||
reg.set_teie(true);
|
|
||||||
reg.set_tcie(true);
|
|
||||||
reg.set_en(true);
|
|
||||||
});
|
|
||||||
|
|
||||||
let res = poll_fn(|cx| {
|
|
||||||
defmt::info!("poll");
|
|
||||||
STATE.ch_wakers[n].register(cx.waker());
|
|
||||||
match STATE.ch_status[n].load(Ordering::Acquire) {
|
|
||||||
CH_STATUS_NONE => Poll::Pending,
|
|
||||||
x => Poll::Ready(x),
|
|
||||||
}
|
|
||||||
})
|
|
||||||
.await;
|
|
||||||
|
|
||||||
defmt::info!("cr {:b}", ch_regs.cr().read().0);
|
|
||||||
|
|
||||||
ch_regs.cr().modify(|reg| {
|
|
||||||
reg.set_en(false);
|
|
||||||
});
|
|
||||||
|
|
||||||
ch_mux_regs.modify(|reg| {
|
|
||||||
reg.set_ege(false);
|
|
||||||
//reg.set_se(true);
|
|
||||||
//reg.set_soie(true);
|
|
||||||
});
|
|
||||||
|
|
||||||
// TODO handle error
|
|
||||||
assert!(res == CH_STATUS_COMPLETED);
|
|
||||||
}
|
|
||||||
*/
|
|
||||||
|
|
||||||
pub(crate) unsafe fn configure_dmamux(
|
pub(crate) unsafe fn configure_dmamux(
|
||||||
dmamux_regs: pac::dmamux::Dmamux,
|
dmamux_regs: pac::dmamux::Dmamux,
|
||||||
dmamux_ch_num: u8,
|
dmamux_ch_num: u8,
|
||||||
@ -89,15 +13,12 @@ pub(crate) unsafe fn configure_dmamux(
|
|||||||
) {
|
) {
|
||||||
let ch_mux_regs = dmamux_regs.ccr(dmamux_ch_num as _);
|
let ch_mux_regs = dmamux_regs.ccr(dmamux_ch_num as _);
|
||||||
ch_mux_regs.write(|reg| {
|
ch_mux_regs.write(|reg| {
|
||||||
// one request?
|
|
||||||
reg.set_nbreq(0);
|
reg.set_nbreq(0);
|
||||||
reg.set_dmareq_id(request);
|
reg.set_dmareq_id(request);
|
||||||
});
|
});
|
||||||
|
|
||||||
ch_mux_regs.modify(|reg| {
|
ch_mux_regs.modify(|reg| {
|
||||||
reg.set_ege(true);
|
reg.set_ege(true);
|
||||||
//reg.set_se(true);
|
|
||||||
//reg.set_soie(true);
|
|
||||||
});
|
});
|
||||||
}
|
}
|
||||||
|
|
||||||
@ -236,6 +157,7 @@ use crate::usart;
|
|||||||
|
|
||||||
bdma_channels! {
|
bdma_channels! {
|
||||||
($channel_peri:ident, $dma_peri:ident, $channel_num:expr) => {
|
($channel_peri:ident, $dma_peri:ident, $channel_num:expr) => {
|
||||||
|
#[cfg(usart)]
|
||||||
impl_usart_dma_requests!($channel_peri, $dma_peri, $channel_num);
|
impl_usart_dma_requests!($channel_peri, $dma_peri, $channel_num);
|
||||||
};
|
};
|
||||||
}
|
}
|
||||||
|
Loading…
Reference in New Issue
Block a user