Use prepare_move_to_destination for Allen Key deploy/stow
This commit is contained in:
		
							parent
							
								
									c42f8fb8dd
								
							
						
					
					
						commit
						da6b0dab5f
					
				| @ -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; | ||||||
| 
 | 
 | ||||||
|  | |||||||
		Loading…
	
	
			
			x
			
			
		
	
		Reference in New Issue
	
	Block a user