1 files changed, 7 insertions, 3 deletions

diff --git a/embassy-stm32/src/can/bxcan/mod.rs b/embassy-stm32/src/can/bxcan/mod.rs
index baa4bee79..19f1cea29 100644
--- a/embassy-stm32/src/can/bxcan/mod.rs
+++ b/embassy-stm32/src/can/bxcan/mod.rs
@@ -893,7 +893,7 @@ impl RxMode {
                     RxFifo::Fifo0 => 0usize,
                     RxFifo::Fifo1 => 1usize,
                 };
-                T::regs().ier().write(|w| {
+                T::regs().ier().modify(|w| {
                     w.set_fmpie(fifo_idx, false);
                 });
                 waker.wake();
@@ -936,18 +936,22 @@ impl RxMode {
             Self::NonBuffered(_) => {
                 let registers = &info.regs;
                 if let Some(msg) = registers.receive_fifo(RxFifo::Fifo0) {
-                    registers.0.ier().write(|w| {
+                    registers.0.ier().modify(|w| {
                         w.set_fmpie(0, true);
                     });
                     Ok(msg)
                 } else if let Some(msg) = registers.receive_fifo(RxFifo::Fifo1) {
-                    registers.0.ier().write(|w| {
+                    registers.0.ier().modify(|w| {
                         w.set_fmpie(1, true);
                     });
                     Ok(msg)
                 } else if let Some(err) = registers.curr_error() {
                     Err(TryReadError::BusError(err))
                 } else {
+                    registers.0.ier().modify(|w| {
+                        w.set_fmpie(0, true);
+                        w.set_fmpie(1, true);
+                    });
                     Err(TryReadError::Empty)
                 }
             }