line_to_axis_pos => do_homing_move
This commit is contained in:
parent
7a4ccd7967
commit
ead333e7da
@ -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
|
||||||
|
|
||||||
|
Loading…
Reference in New Issue
Block a user