|
@ -2707,6 +2707,48 @@ inline void gcode_G4() { |
|
|
|
|
|
|
|
|
#endif // DEBUG_LEVELING_FEATURE
|
|
|
#endif // DEBUG_LEVELING_FEATURE
|
|
|
|
|
|
|
|
|
|
|
|
#if ENABLED(DELTA) |
|
|
|
|
|
|
|
|
|
|
|
/**
|
|
|
|
|
|
* A delta can only safely home all axes at the same time |
|
|
|
|
|
* This is like quick_home_xy() but for 3 towers. |
|
|
|
|
|
*/ |
|
|
|
|
|
inline void home_delta() { |
|
|
|
|
|
// Init the current position of all carriages to 0,0,0
|
|
|
|
|
|
memset(current_position, 0, sizeof(current_position)); |
|
|
|
|
|
sync_plan_position(); |
|
|
|
|
|
|
|
|
|
|
|
// Move all carriages together linearly until an endstop is hit.
|
|
|
|
|
|
current_position[X_AXIS] = current_position[Y_AXIS] = current_position[Z_AXIS] = (Z_MAX_LENGTH + 10); |
|
|
|
|
|
feedrate_mm_s = homing_feedrate_mm_s[X_AXIS]; |
|
|
|
|
|
line_to_current_position(); |
|
|
|
|
|
stepper.synchronize(); |
|
|
|
|
|
endstops.hit_on_purpose(); // clear endstop hit flags
|
|
|
|
|
|
|
|
|
|
|
|
// Probably not needed. Double-check this line:
|
|
|
|
|
|
memset(current_position, 0, sizeof(current_position)); |
|
|
|
|
|
|
|
|
|
|
|
// At least one carriage has reached the top.
|
|
|
|
|
|
// Now back off and re-home each carriage separately.
|
|
|
|
|
|
HOMEAXIS(A); |
|
|
|
|
|
HOMEAXIS(B); |
|
|
|
|
|
HOMEAXIS(C); |
|
|
|
|
|
|
|
|
|
|
|
// Set all carriages to their home positions
|
|
|
|
|
|
// Do this here all at once for Delta, because
|
|
|
|
|
|
// XYZ isn't ABC. Applying this per-tower would
|
|
|
|
|
|
// give the impression that they are the same.
|
|
|
|
|
|
LOOP_XYZ(i) set_axis_is_at_home((AxisEnum)i); |
|
|
|
|
|
|
|
|
|
|
|
SYNC_PLAN_POSITION_KINEMATIC(); |
|
|
|
|
|
|
|
|
|
|
|
#if ENABLED(DEBUG_LEVELING_FEATURE) |
|
|
|
|
|
if (DEBUGGING(LEVELING)) DEBUG_POS("(DELTA)", current_position); |
|
|
|
|
|
#endif |
|
|
|
|
|
} |
|
|
|
|
|
|
|
|
|
|
|
#endif // DELTA
|
|
|
|
|
|
|
|
|
/**
|
|
|
/**
|
|
|
* G28: Home all axes according to settings |
|
|
* G28: Home all axes according to settings |
|
|
* |
|
|
* |
|
@ -2784,42 +2826,8 @@ inline void gcode_G28() { |
|
|
|
|
|
|
|
|
|
|
|
|
|
|
#if ENABLED(DELTA) |
|
|
#if ENABLED(DELTA) |
|
|
/**
|
|
|
|
|
|
* A delta can only safely home all axes at the same time |
|
|
|
|
|
* This is like quick_home_xy() but for 3 towers. |
|
|
|
|
|
*/ |
|
|
|
|
|
|
|
|
|
|
|
// Init the current position of all carriages to 0,0,0
|
|
|
|
|
|
memset(current_position, 0, sizeof(current_position)); |
|
|
|
|
|
sync_plan_position(); |
|
|
|
|
|
|
|
|
|
|
|
// Move all carriages together linearly until an endstop is hit.
|
|
|
|
|
|
current_position[X_AXIS] = current_position[Y_AXIS] = current_position[Z_AXIS] = (Z_MAX_LENGTH + 10); |
|
|
|
|
|
feedrate_mm_s = homing_feedrate_mm_s[X_AXIS]; |
|
|
|
|
|
line_to_current_position(); |
|
|
|
|
|
stepper.synchronize(); |
|
|
|
|
|
endstops.hit_on_purpose(); // clear endstop hit flags
|
|
|
|
|
|
|
|
|
|
|
|
// Probably not needed. Double-check this line:
|
|
|
|
|
|
memset(current_position, 0, sizeof(current_position)); |
|
|
|
|
|
|
|
|
|
|
|
// At least one carriage has reached the top.
|
|
|
|
|
|
// Now back off and re-home each carriage separately.
|
|
|
|
|
|
HOMEAXIS(A); |
|
|
|
|
|
HOMEAXIS(B); |
|
|
|
|
|
HOMEAXIS(C); |
|
|
|
|
|
|
|
|
|
|
|
// Set all carriages to their home positions
|
|
|
|
|
|
// Do this here all at once for Delta, because
|
|
|
|
|
|
// XYZ isn't ABC. Applying this per-tower would
|
|
|
|
|
|
// give the impression that they are the same.
|
|
|
|
|
|
LOOP_XYZ(i) set_axis_is_at_home((AxisEnum)i); |
|
|
|
|
|
|
|
|
|
|
|
SYNC_PLAN_POSITION_KINEMATIC(); |
|
|
home_delta(); |
|
|
|
|
|
|
|
|
#if ENABLED(DEBUG_LEVELING_FEATURE) |
|
|
|
|
|
if (DEBUGGING(LEVELING)) DEBUG_POS("(DELTA)", current_position); |
|
|
|
|
|
#endif |
|
|
|
|
|
|
|
|
|
|
|
#else // NOT DELTA
|
|
|
#else // NOT DELTA
|
|
|
|
|
|
|
|
|