Use prepare_move_to_destination for Allen Key deploy/stow
This commit is contained in:
parent
c42f8fb8dd
commit
da6b0dab5f
1 changed files with 8 additions and 8 deletions
|
@ -1821,7 +1821,7 @@ static void clean_up_after_endstop_or_probe_move() {
|
||||||
destination[X_AXIS] = Z_PROBE_ALLEN_KEY_DEPLOY_1_X;
|
destination[X_AXIS] = Z_PROBE_ALLEN_KEY_DEPLOY_1_X;
|
||||||
destination[Y_AXIS] = Z_PROBE_ALLEN_KEY_DEPLOY_1_Y;
|
destination[Y_AXIS] = Z_PROBE_ALLEN_KEY_DEPLOY_1_Y;
|
||||||
destination[Z_AXIS] = Z_PROBE_ALLEN_KEY_DEPLOY_1_Z;
|
destination[Z_AXIS] = Z_PROBE_ALLEN_KEY_DEPLOY_1_Z;
|
||||||
prepare_move_to_destination_raw(); // this will also set_current_to_destination
|
prepare_move_to_destination(); // this will also set_current_to_destination
|
||||||
|
|
||||||
// Move to engage deployment
|
// Move to engage deployment
|
||||||
if (Z_PROBE_ALLEN_KEY_DEPLOY_2_FEEDRATE != Z_PROBE_ALLEN_KEY_DEPLOY_1_FEEDRATE)
|
if (Z_PROBE_ALLEN_KEY_DEPLOY_2_FEEDRATE != Z_PROBE_ALLEN_KEY_DEPLOY_1_FEEDRATE)
|
||||||
|
@ -1832,7 +1832,7 @@ static void clean_up_after_endstop_or_probe_move() {
|
||||||
destination[Y_AXIS] = Z_PROBE_ALLEN_KEY_DEPLOY_2_Y;
|
destination[Y_AXIS] = Z_PROBE_ALLEN_KEY_DEPLOY_2_Y;
|
||||||
if (Z_PROBE_ALLEN_KEY_DEPLOY_2_Z != Z_PROBE_ALLEN_KEY_DEPLOY_1_Z)
|
if (Z_PROBE_ALLEN_KEY_DEPLOY_2_Z != Z_PROBE_ALLEN_KEY_DEPLOY_1_Z)
|
||||||
destination[Z_AXIS] = Z_PROBE_ALLEN_KEY_DEPLOY_2_Z;
|
destination[Z_AXIS] = Z_PROBE_ALLEN_KEY_DEPLOY_2_Z;
|
||||||
prepare_move_to_destination_raw();
|
prepare_move_to_destination();
|
||||||
|
|
||||||
#ifdef Z_PROBE_ALLEN_KEY_DEPLOY_3_X
|
#ifdef Z_PROBE_ALLEN_KEY_DEPLOY_3_X
|
||||||
if (Z_PROBE_ALLEN_KEY_DEPLOY_3_FEEDRATE != Z_PROBE_ALLEN_KEY_DEPLOY_2_FEEDRATE)
|
if (Z_PROBE_ALLEN_KEY_DEPLOY_3_FEEDRATE != Z_PROBE_ALLEN_KEY_DEPLOY_2_FEEDRATE)
|
||||||
|
@ -1848,14 +1848,14 @@ static void clean_up_after_endstop_or_probe_move() {
|
||||||
if (Z_PROBE_ALLEN_KEY_DEPLOY_3_Z != Z_PROBE_ALLEN_KEY_DEPLOY_2_Z)
|
if (Z_PROBE_ALLEN_KEY_DEPLOY_3_Z != Z_PROBE_ALLEN_KEY_DEPLOY_2_Z)
|
||||||
destination[Z_AXIS] = Z_PROBE_ALLEN_KEY_DEPLOY_3_Z;
|
destination[Z_AXIS] = Z_PROBE_ALLEN_KEY_DEPLOY_3_Z;
|
||||||
|
|
||||||
prepare_move_to_destination_raw();
|
prepare_move_to_destination();
|
||||||
#endif
|
#endif
|
||||||
}
|
}
|
||||||
|
|
||||||
// Partially Home X,Y for safety
|
// Partially Home X,Y for safety
|
||||||
destination[X_AXIS] *= 0.75;
|
destination[X_AXIS] *= 0.75;
|
||||||
destination[Y_AXIS] *= 0.75;
|
destination[Y_AXIS] *= 0.75;
|
||||||
prepare_move_to_destination_raw(); // this will also set_current_to_destination
|
prepare_move_to_destination(); // this will also set_current_to_destination
|
||||||
|
|
||||||
feedrate = old_feedrate;
|
feedrate = old_feedrate;
|
||||||
|
|
||||||
|
@ -1921,7 +1921,7 @@ static void clean_up_after_endstop_or_probe_move() {
|
||||||
destination[X_AXIS] = Z_PROBE_ALLEN_KEY_STOW_1_X;
|
destination[X_AXIS] = Z_PROBE_ALLEN_KEY_STOW_1_X;
|
||||||
destination[Y_AXIS] = Z_PROBE_ALLEN_KEY_STOW_1_Y;
|
destination[Y_AXIS] = Z_PROBE_ALLEN_KEY_STOW_1_Y;
|
||||||
destination[Z_AXIS] = Z_PROBE_ALLEN_KEY_STOW_1_Z;
|
destination[Z_AXIS] = Z_PROBE_ALLEN_KEY_STOW_1_Z;
|
||||||
prepare_move_to_destination_raw();
|
prepare_move_to_destination();
|
||||||
|
|
||||||
// Move the nozzle down to push the Z probe into retracted position
|
// Move the nozzle down to push the Z probe into retracted position
|
||||||
if (Z_PROBE_ALLEN_KEY_STOW_2_FEEDRATE != Z_PROBE_ALLEN_KEY_STOW_1_FEEDRATE)
|
if (Z_PROBE_ALLEN_KEY_STOW_2_FEEDRATE != Z_PROBE_ALLEN_KEY_STOW_1_FEEDRATE)
|
||||||
|
@ -1931,7 +1931,7 @@ static void clean_up_after_endstop_or_probe_move() {
|
||||||
if (Z_PROBE_ALLEN_KEY_STOW_2_Y != Z_PROBE_ALLEN_KEY_STOW_1_Y)
|
if (Z_PROBE_ALLEN_KEY_STOW_2_Y != Z_PROBE_ALLEN_KEY_STOW_1_Y)
|
||||||
destination[Y_AXIS] = Z_PROBE_ALLEN_KEY_STOW_2_Y;
|
destination[Y_AXIS] = Z_PROBE_ALLEN_KEY_STOW_2_Y;
|
||||||
destination[Z_AXIS] = Z_PROBE_ALLEN_KEY_STOW_2_Z;
|
destination[Z_AXIS] = Z_PROBE_ALLEN_KEY_STOW_2_Z;
|
||||||
prepare_move_to_destination_raw();
|
prepare_move_to_destination();
|
||||||
|
|
||||||
// Move up for safety
|
// Move up for safety
|
||||||
if (Z_PROBE_ALLEN_KEY_STOW_3_FEEDRATE != Z_PROBE_ALLEN_KEY_STOW_2_FEEDRATE)
|
if (Z_PROBE_ALLEN_KEY_STOW_3_FEEDRATE != Z_PROBE_ALLEN_KEY_STOW_2_FEEDRATE)
|
||||||
|
@ -1941,13 +1941,13 @@ static void clean_up_after_endstop_or_probe_move() {
|
||||||
if (Z_PROBE_ALLEN_KEY_STOW_3_Y != Z_PROBE_ALLEN_KEY_STOW_2_Y)
|
if (Z_PROBE_ALLEN_KEY_STOW_3_Y != Z_PROBE_ALLEN_KEY_STOW_2_Y)
|
||||||
destination[Y_AXIS] = Z_PROBE_ALLEN_KEY_STOW_3_Y;
|
destination[Y_AXIS] = Z_PROBE_ALLEN_KEY_STOW_3_Y;
|
||||||
destination[Z_AXIS] = Z_PROBE_ALLEN_KEY_STOW_3_Z;
|
destination[Z_AXIS] = Z_PROBE_ALLEN_KEY_STOW_3_Z;
|
||||||
prepare_move_to_destination_raw();
|
prepare_move_to_destination();
|
||||||
|
|
||||||
// Home XY for safety
|
// Home XY for safety
|
||||||
feedrate = homing_feedrate[X_AXIS] / 2;
|
feedrate = homing_feedrate[X_AXIS] / 2;
|
||||||
destination[X_AXIS] = 0;
|
destination[X_AXIS] = 0;
|
||||||
destination[Y_AXIS] = 0;
|
destination[Y_AXIS] = 0;
|
||||||
prepare_move_to_destination_raw(); // this will also set_current_to_destination
|
prepare_move_to_destination(); // this will also set_current_to_destination
|
||||||
|
|
||||||
feedrate = old_feedrate;
|
feedrate = old_feedrate;
|
||||||
|
|
||||||
|
|
Reference in a new issue