|
|
@ -1638,15 +1638,6 @@ inline void line_to_z(float zPosition) {
|
|
|
|
planner.buffer_line(current_position[X_AXIS], current_position[Y_AXIS], zPosition, current_position[E_AXIS], feedrate_mm_s, active_extruder);
|
|
|
|
planner.buffer_line(current_position[X_AXIS], current_position[Y_AXIS], zPosition, current_position[E_AXIS], feedrate_mm_s, active_extruder);
|
|
|
|
}
|
|
|
|
}
|
|
|
|
|
|
|
|
|
|
|
|
inline void line_to_axis_pos(AxisEnum axis, float where, float fr_mm_s = 0.0) {
|
|
|
|
|
|
|
|
float old_feedrate_mm_s = feedrate_mm_s;
|
|
|
|
|
|
|
|
current_position[axis] = where;
|
|
|
|
|
|
|
|
feedrate_mm_s = (fr_mm_s != 0.0) ? fr_mm_s : homing_feedrate_mm_s[axis];
|
|
|
|
|
|
|
|
planner.buffer_line(current_position[X_AXIS], current_position[Y_AXIS], current_position[Z_AXIS], current_position[E_AXIS], feedrate_mm_s, active_extruder);
|
|
|
|
|
|
|
|
stepper.synchronize();
|
|
|
|
|
|
|
|
feedrate_mm_s = old_feedrate_mm_s;
|
|
|
|
|
|
|
|
}
|
|
|
|
|
|
|
|
|
|
|
|
|
|
|
|
//
|
|
|
|
//
|
|
|
|
// line_to_destination
|
|
|
|
// line_to_destination
|
|
|
|
// Move the planner, not necessarily synced with current_position
|
|
|
|
// Move the planner, not necessarily synced with current_position
|
|
|
@ -2415,6 +2406,15 @@ static void clean_up_after_endstop_or_probe_move() {
|
|
|
|
* Home an individual axis
|
|
|
|
* Home an individual axis
|
|
|
|
*/
|
|
|
|
*/
|
|
|
|
|
|
|
|
|
|
|
|
|
|
|
|
static void do_homing_move(AxisEnum axis, float where, float fr_mm_s = 0.0) {
|
|
|
|
|
|
|
|
float old_feedrate_mm_s = feedrate_mm_s;
|
|
|
|
|
|
|
|
current_position[axis] = where;
|
|
|
|
|
|
|
|
feedrate_mm_s = (fr_mm_s != 0.0) ? fr_mm_s : homing_feedrate_mm_s[axis];
|
|
|
|
|
|
|
|
planner.buffer_line(current_position[X_AXIS], current_position[Y_AXIS], current_position[Z_AXIS], current_position[E_AXIS], feedrate_mm_s, active_extruder);
|
|
|
|
|
|
|
|
stepper.synchronize();
|
|
|
|
|
|
|
|
feedrate_mm_s = old_feedrate_mm_s;
|
|
|
|
|
|
|
|
}
|
|
|
|
|
|
|
|
|
|
|
|
#define HOMEAXIS(LETTER) homeaxis(LETTER##_AXIS)
|
|
|
|
#define HOMEAXIS(LETTER) homeaxis(LETTER##_AXIS)
|
|
|
|
|
|
|
|
|
|
|
|
static void homeaxis(AxisEnum axis) {
|
|
|
|
static void homeaxis(AxisEnum axis) {
|
|
|
@ -2456,17 +2456,17 @@ static void homeaxis(AxisEnum axis) {
|
|
|
|
#endif
|
|
|
|
#endif
|
|
|
|
|
|
|
|
|
|
|
|
// Move towards the endstop until an endstop is triggered
|
|
|
|
// Move towards the endstop until an endstop is triggered
|
|
|
|
line_to_axis_pos(axis, 1.5 * max_length(axis) * axis_home_dir);
|
|
|
|
do_homing_move(axis, 1.5 * max_length(axis) * axis_home_dir);
|
|
|
|
|
|
|
|
|
|
|
|
// Set the axis position as setup for the move
|
|
|
|
// Set the axis position as setup for the move
|
|
|
|
current_position[axis] = 0;
|
|
|
|
current_position[axis] = 0;
|
|
|
|
sync_plan_position();
|
|
|
|
sync_plan_position();
|
|
|
|
|
|
|
|
|
|
|
|
// Move away from the endstop by the axis HOME_BUMP_MM
|
|
|
|
// Move away from the endstop by the axis HOME_BUMP_MM
|
|
|
|
line_to_axis_pos(axis, -home_bump_mm(axis) * axis_home_dir);
|
|
|
|
do_homing_move(axis, -home_bump_mm(axis) * axis_home_dir);
|
|
|
|
|
|
|
|
|
|
|
|
// Move slowly towards the endstop until triggered
|
|
|
|
// Move slowly towards the endstop until triggered
|
|
|
|
line_to_axis_pos(axis, 2 * home_bump_mm(axis) * axis_home_dir, get_homing_bump_feedrate(axis));
|
|
|
|
do_homing_move(axis, 2 * home_bump_mm(axis) * axis_home_dir, get_homing_bump_feedrate(axis));
|
|
|
|
|
|
|
|
|
|
|
|
// reset current_position to 0 to reflect hitting endpoint
|
|
|
|
// reset current_position to 0 to reflect hitting endpoint
|
|
|
|
current_position[axis] = 0;
|
|
|
|
current_position[axis] = 0;
|
|
|
@ -2490,7 +2490,7 @@ static void homeaxis(AxisEnum axis) {
|
|
|
|
if (lockZ1) stepper.set_z_lock(true); else stepper.set_z2_lock(true);
|
|
|
|
if (lockZ1) stepper.set_z_lock(true); else stepper.set_z2_lock(true);
|
|
|
|
|
|
|
|
|
|
|
|
// Move to the adjusted endstop height
|
|
|
|
// Move to the adjusted endstop height
|
|
|
|
line_to_axis_pos(axis, adj);
|
|
|
|
do_homing_move(axis, adj);
|
|
|
|
|
|
|
|
|
|
|
|
if (lockZ1) stepper.set_z_lock(false); else stepper.set_z2_lock(false);
|
|
|
|
if (lockZ1) stepper.set_z_lock(false); else stepper.set_z2_lock(false);
|
|
|
|
stepper.set_homing_flag(false);
|
|
|
|
stepper.set_homing_flag(false);
|
|
|
@ -2506,7 +2506,7 @@ static void homeaxis(AxisEnum axis) {
|
|
|
|
DEBUG_POS("", current_position);
|
|
|
|
DEBUG_POS("", current_position);
|
|
|
|
}
|
|
|
|
}
|
|
|
|
#endif
|
|
|
|
#endif
|
|
|
|
line_to_axis_pos(axis, endstop_adj[axis]);
|
|
|
|
do_homing_move(axis, endstop_adj[axis]);
|
|
|
|
}
|
|
|
|
}
|
|
|
|
#endif
|
|
|
|
#endif
|
|
|
|
|
|
|
|
|
|
|
|