diff --git a/Marlin/Marlin_main.cpp b/Marlin/Marlin_main.cpp
index b373e22137e2786a33bdeb00897924924c59bc64..b1c9e4d3ce5466cd6b4e7d4e1666b6befa6171ba 100644
--- a/Marlin/Marlin_main.cpp
+++ b/Marlin/Marlin_main.cpp
@@ -3516,10 +3516,9 @@ void manage_inactivity()
   }
   
   #ifdef CHDK //Check if pin should be set to LOW after M240 set it to HIGH
-    if (chdkActive)
+    if (chdkActive && (millis() - chdkHigh > CHDK_DELAY))
     {
       chdkActive = false;
-      if (millis()-chdkHigh < CHDK_DELAY) return;
       WRITE(CHDK, LOW);
     }
   #endif