From f42b81fa38be4b994cec2af582d74bf2494a89b6 Mon Sep 17 00:00:00 2001
From: PavelSindler <sindlerpa@gmail.com>
Date: Thu, 19 Oct 2017 16:50:49 +0200
Subject: [PATCH] linear advance fix: advance_isr and plan_set_e_position

---
 Firmware/Marlin_main.cpp | 4 ++--
 Firmware/planner.cpp     | 3 +++
 Firmware/stepper.cpp     | 9 ++++++---
 3 files changed, 11 insertions(+), 5 deletions(-)

diff --git a/Firmware/Marlin_main.cpp b/Firmware/Marlin_main.cpp
index faff31e85..dcea522d5 100644
--- a/Firmware/Marlin_main.cpp
+++ b/Firmware/Marlin_main.cpp
@@ -5764,7 +5764,9 @@ case 404:  //M404 Enter the nominal filament width (3mm, 1.75mm ) N<3.0> or disp
 
   else if(code_seen('T'))
   {
+	#ifdef SNMM
 	  int index;
+	  st_synchronize();
 	  for (index = 1; *(strchr_pointer + index) == ' ' || *(strchr_pointer + index) == '\t'; index++);
 	   
 	  if ((*(strchr_pointer + index) < '0' || *(strchr_pointer + index) > '9') && *(strchr_pointer + index) != '?') {
@@ -5778,7 +5780,6 @@ case 404:  //M404 Enter the nominal filament width (3mm, 1.75mm ) N<3.0> or disp
 			  tmp_extruder = code_value();
 		  }
 		  snmm_filaments_used |= (1 << tmp_extruder); //for stop print
-#ifdef SNMM
       #ifdef LIN_ADVANCE
         if (snmm_extruder != tmp_extruder)
           clear_current_adv_vars(); //Check if the selected extruder is not the active one and reset LIN_ADVANCE variables if so.
@@ -5786,7 +5787,6 @@ case 404:  //M404 Enter the nominal filament width (3mm, 1.75mm ) N<3.0> or disp
       
       snmm_extruder = tmp_extruder;
 
-		  st_synchronize();
 		  delay(100);
 
 		  disable_e0();
diff --git a/Firmware/planner.cpp b/Firmware/planner.cpp
index d6d70fb4c..c5a8f5b2f 100644
--- a/Firmware/planner.cpp
+++ b/Firmware/planner.cpp
@@ -1294,6 +1294,9 @@ void plan_set_z_position(const float &z)
 
 void plan_set_e_position(const float &e)
 {
+  #ifdef LIN_ADVANCE
+  position_float[E_AXIS] = e;
+  #endif
   position[E_AXIS] = lround(e*axis_steps_per_unit[E_AXIS]);  
   st_set_e_position(position[E_AXIS]);
 }
diff --git a/Firmware/stepper.cpp b/Firmware/stepper.cpp
index 0f3f65aaa..bfcf1f723 100644
--- a/Firmware/stepper.cpp
+++ b/Firmware/stepper.cpp
@@ -735,7 +735,7 @@ void isr() {
 
   void advance_isr() {
 
-    nextAdvanceISR = eISR_Rate;
+	nextAdvanceISR = eISR_Rate;
 
     if (e_steps) {
       bool dir =
@@ -752,7 +752,10 @@ void isr() {
         e_steps < 0 ? ++e_steps : --e_steps;
         WRITE(E0_STEP_PIN, INVERT_E_STEP_PIN);
       }
-    }
+	}
+	else if(eISR_Rate == 0) {
+	  nextAdvanceISR = ADV_NEVER;
+	}
   }
 
   void advance_isr_scheduler() {
@@ -782,7 +785,7 @@ void isr() {
     }
 
     // Don't run the ISR faster than possible
-    if (OCR1A < TCNT1 + 16) OCR1A = TCNT1 + 16;
+	if (OCR1A < TCNT1 + 16) OCR1A = TCNT1 + 16;
   }
   
   void clear_current_adv_vars() {