From 9d834925c03f82994cb1c93471966eca536c8d01 Mon Sep 17 00:00:00 2001
From: Yuri D'Elia <wavexx@thregr.org>
Date: Sun, 26 May 2019 17:05:47 +0200
Subject: [PATCH] Recalculate LA_phase correctly

---
 Firmware/stepper.cpp | 3 ++-
 1 file changed, 2 insertions(+), 1 deletion(-)

diff --git a/Firmware/stepper.cpp b/Firmware/stepper.cpp
index 6eaa9003..ed265da6 100644
--- a/Firmware/stepper.cpp
+++ b/Firmware/stepper.cpp
@@ -816,8 +816,9 @@ FORCE_INLINE void isr() {
         deceleration_time += timer;
 #ifdef LIN_ADVANCE
         if (current_block->use_advance_lead) {
+            la_state = ADV_DECELERATE;
             if (step_events_completed.wide <= (unsigned long int)current_block->decelerate_after + step_loops)
-                la_state = ADV_INIT | ADV_DECELERATE;
+                la_state |= ADV_INIT;
         }
 #endif
       }