diff --git a/Marlin/stepper.cpp b/Marlin/stepper.cpp
index 2ef077346c8d0a8c3653f87a80f758ef7c094b9d..33c7e154c1c2866db960aad9cb59741199fb9b3c 100644
--- a/Marlin/stepper.cpp
+++ b/Marlin/stepper.cpp
@@ -707,15 +707,13 @@ void st_init()
 }
 
 
-#include <util/delay.h>
 // Block until all buffered steps are executed
 void st_synchronize()
 {
-  while(current_block!=0 || blocks_queued()) {
+    while( blocks_queued()) {
     manage_heater();
     manage_inactivity(1);
     LCD_STATUS;
-    //_delay_ms(1);
   }
 }