From 26bd8fc5235f0eea184afac0a911736fedd3daca Mon Sep 17 00:00:00 2001 From: PavelSindler Date: Fri, 7 Jul 2017 10:58:10 +0200 Subject: [PATCH] reverting --- Firmware/ultralcd.cpp | 6 ++++-- 1 file changed, 4 insertions(+), 2 deletions(-) diff --git a/Firmware/ultralcd.cpp b/Firmware/ultralcd.cpp index 2c61a442..57ec0c61 100644 --- a/Firmware/ultralcd.cpp +++ b/Firmware/ultralcd.cpp @@ -4462,8 +4462,10 @@ static bool lcd_selfcheck_axis_sg(char axis) { current_position_init = st_get_position_mm(axis); if (i < 1) { - - current_position[axis] += (axis_length + margin); + current_position[axis] += margin; + plan_buffer_line(current_position[X_AXIS], current_position[Y_AXIS], current_position[Z_AXIS], current_position[3], manual_feedrate[0] / 60, active_extruder); + st_synchronize(); + current_position[axis] += axis_length; plan_buffer_line(current_position[X_AXIS], current_position[Y_AXIS], current_position[Z_AXIS], current_position[3], manual_feedrate[0] / 60, active_extruder); #ifdef HAVE_TMC2130_DRIVERS tmc2130_home_enter(X_AXIS_MASK << axis);