|
@@ -8740,10 +8740,10 @@ void quickstop_stepper() {
|
8740
|
8740
|
bool err = false;
|
8741
|
8741
|
LOOP_XYZ(i) {
|
8742
|
8742
|
if (axis_homed[i]) {
|
8743
|
|
- float base = (current_position[i] > (soft_endstop_min[i] + soft_endstop_max[i]) * 0.5) ? base_home_pos((AxisEnum)i) : 0,
|
8744
|
|
- diff = current_position[i] - LOGICAL_POSITION(base, i);
|
|
8743
|
+ const float base = (current_position[i] > (soft_endstop_min[i] + soft_endstop_max[i]) * 0.5) ? base_home_pos((AxisEnum)i) : 0,
|
|
8744
|
+ diff = base - RAW_POSITION(current_position[i], i);
|
8745
|
8745
|
if (WITHIN(diff, -20, 20)) {
|
8746
|
|
- set_home_offset((AxisEnum)i, home_offset[i] - diff);
|
|
8746
|
+ set_home_offset((AxisEnum)i, diff);
|
8747
|
8747
|
}
|
8748
|
8748
|
else {
|
8749
|
8749
|
SERIAL_ERROR_START;
|