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…
	
	
			
			x
			
			
		
	
		Reference in New Issue
	
	Block a user