1 files changed, 2 insertions, 3 deletions
diff --git a/os/hal/platforms/STM32/can_lld.c b/os/hal/platforms/STM32/can_lld.c
index 526ecb98e..d8e12af9e 100644
--- a/os/hal/platforms/STM32/can_lld.c
+++ b/os/hal/platforms/STM32/can_lld.c
@@ -236,11 +236,10 @@ void can_lld_start(CANDriver *canp) {
         cfp->FR1 = 0;
         cfp->FR2 = 0;
       }
-      cfp++;
-      fmask <<= 1;
       /* Gives a chance for preemption since this is a rather long loop.*/
       chSysUnlock();
-      chThdYield();
+      cfp++;
+      fmask <<= 1;
       chSysLock();
     }
   }