From ceb62fc7e1f8557fdb38a8a499c549dae4f3f66b Mon Sep 17 00:00:00 2001 From: Scott Lahteine Date: Mon, 22 May 2017 17:34:03 -0500 Subject: [PATCH] Fixes #6828: M428 bug --- Marlin/Marlin_main.cpp | 6 +++--- 1 file changed, 3 insertions(+), 3 deletions(-) diff --git a/Marlin/Marlin_main.cpp b/Marlin/Marlin_main.cpp index 89e4d07982..97253f805b 100644 --- a/Marlin/Marlin_main.cpp +++ b/Marlin/Marlin_main.cpp @@ -8740,10 +8740,10 @@ void quickstop_stepper() { bool err = false; LOOP_XYZ(i) { if (axis_homed[i]) { - float base = (current_position[i] > (soft_endstop_min[i] + soft_endstop_max[i]) * 0.5) ? base_home_pos((AxisEnum)i) : 0, - diff = current_position[i] - LOGICAL_POSITION(base, i); + const float base = (current_position[i] > (soft_endstop_min[i] + soft_endstop_max[i]) * 0.5) ? base_home_pos((AxisEnum)i) : 0, + diff = base - RAW_POSITION(current_position[i], i); if (WITHIN(diff, -20, 20)) { - set_home_offset((AxisEnum)i, home_offset[i] - diff); + set_home_offset((AxisEnum)i, diff); } else { SERIAL_ERROR_START;