소스 검색

Recalculate LA_phase correctly

Yuri D'Elia 5 년 전
부모
커밋
9d834925c0
1개의 변경된 파일2개의 추가작업 그리고 1개의 파일을 삭제
  1. 2 1
      Firmware/stepper.cpp

+ 2 - 1
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
       }