Fix bogus timer check preventing fast LA steps to be scheduled

Simplify and fix the broken timer check when scheduling advance ticks. This dates back to the original LA15 PR, an old bug...
prusa3d · Jun 21, 2020 · 173aa2d · 173aa2d
1 parent 51a5396
commit 173aa2d
Showing 1 changed file with 1 addition and 1 deletion.
diff --git a/Firmware/stepper.cpp b/Firmware/stepper.cpp
@@ -1016,7 +1016,7 @@ FORCE_INLINE void advance_isr_scheduler() {
 
     // Schedule the next closest tick, ignoring advance if scheduled too
     // soon in order to avoid skewing the regular stepper acceleration
-    if (nextAdvanceISR != ADV_NEVER && (nextAdvanceISR + TCNT1 + 40) < nextMainISR)
+    if (nextAdvanceISR != ADV_NEVER && (nextAdvanceISR + 40) < nextMainISR)
         OCR1A = nextAdvanceISR;
     else
         OCR1A = nextMainISR;