ensure DR is read to clear idle/overflow interrupt when they occur independently of the rxne

1 files changed, 21 insertions, 16 deletions

diff --git a/embassy-stm32/src/usart/buffered.rs b/embassy-stm32/src/usart/buffered.rs
index 613da5674..f55123e1d 100644
--- a/embassy-stm32/src/usart/buffered.rs
+++ b/embassy-stm32/src/usart/buffered.rs
@@ -21,27 +21,32 @@ impl<T: BasicInstance> interrupt::typelevel::Handler<T::Interrupt> for Interrupt
         // RX
         unsafe {
             let sr = sr(r).read();
+            // Reading DR clears the rxne, error and idle interrupt flags on v1.
+            let dr = if sr.ore() || sr.idle() || sr.rxne() {
+                Some(rdr(r).read_volatile())
+            }
+            else {
+                None
+            };
             clear_interrupt_flags(r, sr);
 
+            if sr.pe() {
+                warn!("Parity error");
+            }
+            if sr.fe() {
+                warn!("Framing error");
+            }
+            if sr.ne() {
+                warn!("Noise error");
+            }
+            if sr.ore() {
+                warn!("Overrun error");
+            }
             if sr.rxne() {
-                if sr.pe() {
-                    warn!("Parity error");
-                }
-                if sr.fe() {
-                    warn!("Framing error");
-                }
-                if sr.ne() {
-                    warn!("Noise error");
-                }
-                if sr.ore() {
-                    warn!("Overrun error");
-                }
-
                 let mut rx_writer = state.rx_buf.writer();
                 let buf = rx_writer.push_slice();
                 if !buf.is_empty() {
-                    // This read also clears the error and idle interrupt flags on v1.
-                    buf[0] = rdr(r).read_volatile();
+                    buf[0] = dr.unwrap();
                     rx_writer.push_done(1);
                 } else {
                     // FIXME: Should we disable any further RX interrupts when the buffer becomes full.
@@ -54,7 +59,7 @@ impl<T: BasicInstance> interrupt::typelevel::Handler<T::Interrupt> for Interrupt
 
             if sr.idle() {
                 state.rx_waker.wake();
-            };
+            }
         }
 
         // TX