aboutsummaryrefslogtreecommitdiff
diff options
context:
space:
mode:
authorTimo Kröger <[email protected]>2021-07-22 00:12:06 +0200
committerDario Nieuwenhuis <[email protected]>2021-07-24 09:26:07 +0200
commit5a4a5ce33417f66cb64713a8f97d7897c024f15f (patch)
tree59f0eb97f34186de5fb34c1b68b2a85270628cb0
parent9c503a92564aa5fb16ba1c0ffb15d8e3a721b742 (diff)
STM32 DMA: Use interrupt flags instead of atomics
-rw-r--r--embassy-stm32/src/dma/dma.rs59
1 files changed, 25 insertions, 34 deletions
diff --git a/embassy-stm32/src/dma/dma.rs b/embassy-stm32/src/dma/dma.rs
index c5695baca..606c9d3d7 100644
--- a/embassy-stm32/src/dma/dma.rs
+++ b/embassy-stm32/src/dma/dma.rs
@@ -1,7 +1,6 @@
1use core::future::Future; 1use core::future::Future;
2use core::task::Poll; 2use core::task::Poll;
3 3
4use atomic_polyfill::{AtomicU8, Ordering};
5use embassy::interrupt::{Interrupt, InterruptExt}; 4use embassy::interrupt::{Interrupt, InterruptExt};
6use embassy::util::{AtomicWaker, OnDrop}; 5use embassy::util::{AtomicWaker, OnDrop};
7use futures::future::poll_fn; 6use futures::future::poll_fn;
@@ -14,22 +13,16 @@ use crate::rcc::sealed::RccPeripheral;
14use super::{Channel, Request}; 13use super::{Channel, Request};
15 14
16const CH_COUNT: usize = pac::peripheral_count!(DMA) * 8; 15const CH_COUNT: usize = pac::peripheral_count!(DMA) * 8;
17const CH_STATUS_NONE: u8 = 0;
18const CH_STATUS_COMPLETED: u8 = 1;
19const CH_STATUS_ERROR: u8 = 2;
20 16
21struct State { 17struct State {
22 ch_wakers: [AtomicWaker; CH_COUNT], 18 ch_wakers: [AtomicWaker; CH_COUNT],
23 ch_status: [AtomicU8; CH_COUNT],
24} 19}
25 20
26impl State { 21impl State {
27 const fn new() -> Self { 22 const fn new() -> Self {
28 const AW: AtomicWaker = AtomicWaker::new(); 23 const AW: AtomicWaker = AtomicWaker::new();
29 const AU: AtomicU8 = AtomicU8::new(CH_STATUS_NONE);
30 Self { 24 Self {
31 ch_wakers: [AW; CH_COUNT], 25 ch_wakers: [AW; CH_COUNT],
32 ch_status: [AU; CH_COUNT],
33 } 26 }
34 } 27 }
35} 28}
@@ -56,25 +49,21 @@ pub(crate) unsafe fn do_transfer(
56 assert!(mem_len <= 0xFFFF); 49 assert!(mem_len <= 0xFFFF);
57 50
58 // Reset status 51 // Reset status
59 // Generate a DMB here to flush the store buffer (M7) before enabling the DMA 52 let isrn = channel_number as usize / 4;
60 STATE.ch_status[state_number as usize].store(CH_STATUS_NONE, Ordering::Release); 53 let isrbit = channel_number as usize % 4;
54 dma.ifcr(isrn).write(|w| {
55 w.set_tcif(isrbit, true);
56 w.set_teif(isrbit, true);
57 });
61 58
62 let ch = dma.st(channel_number as _); 59 let ch = dma.st(channel_number as _);
63 60
64 let on_drop = OnDrop::new(move || unsafe { 61 let on_drop = OnDrop::new(move || unsafe {
65 ch.cr().modify(|w| { 62 // Disable the channel and interrupts with the default value.
66 w.set_tcie(false); 63 ch.cr().write(|_| ());
67 w.set_teie(false);
68 w.set_en(false);
69 });
70 while ch.cr().read().en() {}
71 64
72 // Disabling the DMA mid transfer might cause some flags to be set, clear them all for the 65 // Wait for the transfer to complete when it was ongoing.
73 // next transfer 66 while ch.cr().read().en() {}
74 dma.ifcr(channel_number as usize / 4).write(|w| {
75 w.set_tcif(channel_number as usize % 4, true);
76 w.set_teif(channel_number as usize % 4, true);
77 });
78 }); 67 });
79 68
80 #[cfg(dmamux)] 69 #[cfg(dmamux)]
@@ -110,15 +99,20 @@ pub(crate) unsafe fn do_transfer(
110 let res = poll_fn(|cx| { 99 let res = poll_fn(|cx| {
111 let n = state_number as usize; 100 let n = state_number as usize;
112 STATE.ch_wakers[n].register(cx.waker()); 101 STATE.ch_wakers[n].register(cx.waker());
113 match STATE.ch_status[n].load(Ordering::Acquire) { 102
114 CH_STATUS_NONE => Poll::Pending, 103 let isr = dma.isr(isrn).read();
115 x => Poll::Ready(x), 104
105 // TODO handle error
106 assert!(!isr.teif(isrbit));
107
108 if isr.tcif(isrbit) {
109 Poll::Ready(())
110 } else {
111 Poll::Pending
116 } 112 }
117 }) 113 })
118 .await; 114 .await;
119 115
120 // TODO handle error
121 assert!(res == CH_STATUS_COMPLETED);
122 drop(on_drop) 116 drop(on_drop)
123 } 117 }
124} 118}
@@ -137,16 +131,13 @@ unsafe fn on_irq() {
137 (dma, $dma:ident) => { 131 (dma, $dma:ident) => {
138 for isrn in 0..2 { 132 for isrn in 0..2 {
139 let isr = pac::$dma.isr(isrn).read(); 133 let isr = pac::$dma.isr(isrn).read();
140 pac::$dma.ifcr(isrn).write_value(isr);
141 let dman = dma_num!($dma);
142 134
143 for chn in 0..4 { 135 for chn in 0..4 {
144 let n = dman * 8 + isrn * 4 + chn; 136 let cr = pac::$dma.st(isrn * 4 + chn).cr();
145 if isr.teif(chn) { 137
146 STATE.ch_status[n].store(CH_STATUS_ERROR, Ordering::Relaxed); 138 if isr.tcif(chn) && cr.read().tcie() {
147 STATE.ch_wakers[n].wake(); 139 cr.write(|_| ()); // Disable channel interrupts with the default value.
148 } else if isr.tcif(chn) { 140 let n = dma_num!($dma) * 8 + isrn * 4 + chn;
149 STATE.ch_status[n].store(CH_STATUS_COMPLETED, Ordering::Relaxed);
150 STATE.ch_wakers[n].wake(); 141 STATE.ch_wakers[n].wake();
151 } 142 }
152 } 143 }