From: Erik van der Zalm <erik@vdzalm.eu>
Date: Mon, 6 Feb 2012 16:38:16 +0000 (+0100)
Subject: Fix Z_LATE_ENABLE
X-Git-Tag: iwj-success-2012-07-29~123
X-Git-Url: http://www.chiark.greenend.org.uk/ucgi/~ianmdlvl/git?a=commitdiff_plain;h=292ddd2edbf4663ad2b5f69f7e46e2eb3600d465;p=marlin.git

Fix Z_LATE_ENABLE
---

diff --git a/Marlin/stepper.cpp b/Marlin/stepper.cpp
index a32dd8d..26c265e 100644
--- a/Marlin/stepper.cpp
+++ b/Marlin/stepper.cpp
@@ -275,9 +275,7 @@ FORCE_INLINE void trapezoid_generator_reset() {
   OCR1A = acceleration_time;
   OCR1A_nominal = calc_timer(current_block->nominal_rate);
   
-  #ifdef Z_LATE_ENABLE 
-    if(current_block->steps_z > 0) enable_z();
-  #endif
+
   
 //    SERIAL_ECHO_START;
 //    SERIAL_ECHOPGM("advance :");
@@ -306,6 +304,14 @@ ISR(TIMER1_COMPA_vect)
       counter_z = counter_x;
       counter_e = counter_x;
       step_events_completed = 0;
+      #ifdef Z_LATE_ENABLE 
+        if(current_block->steps_z > 0) {
+          enable_z();
+          OCR1A = 2000; //1ms wait
+          return;
+        }
+      #endif
+      
 //      #ifdef ADVANCE
 //      e_steps[current_block->active_extruder] = 0;
 //      #endif