Merge pull request #4927 from leftger/fix/stm32wba-adc4

stm32: Fixed ADC4 enable() for WBA

1 files changed, 17 insertions, 1 deletions

diff --git a/embassy-stm32/src/adc/adc4.rs b/embassy-stm32/src/adc/adc4.rs
index 499fc2093..472eb46fd 100644
--- a/embassy-stm32/src/adc/adc4.rs
+++ b/embassy-stm32/src/adc/adc4.rs
@@ -113,10 +113,26 @@ foreach_adc!(
             }
 
             fn enable() {
+                let cr_initial = ADC4::regs().cr().read();
+                let isr_initial = ADC4::regs().isr().read();
+
+                if cr_initial.aden() && isr_initial.adrdy() {
+                    return;
+                }
+
+                if cr_initial.aden() || cr_initial.adstart() {
+                    if cr_initial.adstart() {
+                        ADC4::regs().cr().modify(|w| w.set_adstp(true));
+                        while ADC4::regs().cr().read().adstart() {}
+                    }
+
+                    ADC4::regs().cr().modify(|w| w.set_addis(true));
+                    while ADC4::regs().cr().read().aden() {}
+                }
+
                 ADC4::regs().isr().write(|w| w.set_adrdy(true));
                 ADC4::regs().cr().modify(|w| w.set_aden(true));
                 while !ADC4::regs().isr().read().adrdy() {}
-                ADC4::regs().isr().write(|w| w.set_adrdy(true));
             }
 
             fn start() {