Use prepare_move_to_destination for Allen Key deploy/stow
This commit is contained in:
		@@ -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 New Issue
	
	Block a user