set_current_position_from_planner() after stepper.quick_stop()
This commit is contained in:
		@@ -5889,13 +5889,31 @@ inline void gcode_M400() { stepper.synchronize(); }
 | 
			
		||||
 | 
			
		||||
#endif // FILAMENT_WIDTH_SENSOR
 | 
			
		||||
 | 
			
		||||
void set_current_position_from_planner() {
 | 
			
		||||
  stepper.synchronize();
 | 
			
		||||
  #if ENABLED(AUTO_BED_LEVELING_FEATURE)
 | 
			
		||||
    vector_3 pos = planner.adjusted_position(); // values directly from steppers...
 | 
			
		||||
    current_position[X_AXIS] = pos.x;
 | 
			
		||||
    current_position[Y_AXIS] = pos.y;
 | 
			
		||||
    current_position[Z_AXIS] = pos.z;
 | 
			
		||||
  #else
 | 
			
		||||
    current_position[X_AXIS] = stepper.get_axis_position_mm(X_AXIS);
 | 
			
		||||
    current_position[Y_AXIS] = stepper.get_axis_position_mm(Y_AXIS);
 | 
			
		||||
    current_position[Z_AXIS] = stepper.get_axis_position_mm(Z_AXIS);
 | 
			
		||||
  #endif
 | 
			
		||||
  sync_plan_position();                       // ...re-apply to planner position
 | 
			
		||||
}
 | 
			
		||||
 | 
			
		||||
/**
 | 
			
		||||
 * M410: Quickstop - Abort all planned moves
 | 
			
		||||
 *
 | 
			
		||||
 * This will stop the carriages mid-move, so most likely they
 | 
			
		||||
 * will be out of sync with the stepper position after this.
 | 
			
		||||
 */
 | 
			
		||||
inline void gcode_M410() { stepper.quick_stop(); }
 | 
			
		||||
inline void gcode_M410() {
 | 
			
		||||
  stepper.quick_stop();
 | 
			
		||||
  set_current_position_from_planner();
 | 
			
		||||
}
 | 
			
		||||
 | 
			
		||||
 | 
			
		||||
#if ENABLED(MESH_BED_LEVELING)
 | 
			
		||||
 
 | 
			
		||||
		Reference in New Issue
	
	Block a user