From 292ddd2edbf4663ad2b5f69f7e46e2eb3600d465 Mon Sep 17 00:00:00 2001
From: Erik van der Zalm <erik@vdzalm.eu>
Date: Mon, 6 Feb 2012 17:38:16 +0100
Subject: [PATCH] Fix Z_LATE_ENABLE
---
Marlin/stepper.cpp | 12 +++++++++---
1 file changed, 9 insertions(+), 3 deletions(-)
diff --git a/Marlin/stepper.cpp b/Marlin/stepper.cpp
index a32dd8dff9..26c265e532 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
--
GitLab