|
|
@ -2110,16 +2110,21 @@ static void clean_up_after_endstop_or_probe_move() {
|
|
|
|
planner.bed_level_matrix.set_to_identity();
|
|
|
|
planner.bed_level_matrix.set_to_identity();
|
|
|
|
#endif
|
|
|
|
#endif
|
|
|
|
|
|
|
|
|
|
|
|
do_blocking_move_to_z(-(Z_MAX_LENGTH + 10), Z_PROBE_SPEED_FAST);
|
|
|
|
#if ENABLED(PROBE_DOUBLE_TOUCH)
|
|
|
|
endstops.hit_on_purpose();
|
|
|
|
do_blocking_move_to_z(-(Z_MAX_LENGTH + 10), Z_PROBE_SPEED_FAST);
|
|
|
|
set_current_from_steppers_for_axis(Z_AXIS);
|
|
|
|
endstops.hit_on_purpose();
|
|
|
|
SYNC_PLAN_POSITION_KINEMATIC();
|
|
|
|
set_current_from_steppers_for_axis(Z_AXIS);
|
|
|
|
|
|
|
|
SYNC_PLAN_POSITION_KINEMATIC();
|
|
|
|
|
|
|
|
|
|
|
|
// move up the retract distance
|
|
|
|
// move up the retract distance
|
|
|
|
do_blocking_move_to_z(current_position[Z_AXIS] + home_bump_mm(Z_AXIS), Z_PROBE_SPEED_FAST);
|
|
|
|
do_blocking_move_to_z(current_position[Z_AXIS] + home_bump_mm(Z_AXIS), Z_PROBE_SPEED_FAST);
|
|
|
|
|
|
|
|
#else
|
|
|
|
|
|
|
|
// move fast, close to the bed
|
|
|
|
|
|
|
|
do_blocking_move_to_z(home_bump_mm(Z_AXIS), Z_PROBE_SPEED_FAST);
|
|
|
|
|
|
|
|
#endif
|
|
|
|
|
|
|
|
|
|
|
|
// move back down slowly to find bed
|
|
|
|
// move down slowly to find bed
|
|
|
|
do_blocking_move_to_z(current_position[Z_AXIS] - home_bump_mm(Z_AXIS) * 2, Z_PROBE_SPEED_SLOW);
|
|
|
|
do_blocking_move_to_z(current_position[Z_AXIS] -2.0*home_bump_mm(Z_AXIS), Z_PROBE_SPEED_SLOW);
|
|
|
|
endstops.hit_on_purpose();
|
|
|
|
endstops.hit_on_purpose();
|
|
|
|
set_current_from_steppers_for_axis(Z_AXIS);
|
|
|
|
set_current_from_steppers_for_axis(Z_AXIS);
|
|
|
|
SYNC_PLAN_POSITION_KINEMATIC();
|
|
|
|
SYNC_PLAN_POSITION_KINEMATIC();
|
|
|
|