Do not plan a Z move if no move is actually performed

This commit is contained in:
Alex Voinea 2023-05-05 18:03:57 +02:00
parent de98551691
commit a5c20a1c6e
No known key found for this signature in database
GPG Key ID: 37EDFD565CB33BAD
1 changed files with 4 additions and 3 deletions

View File

@ -2915,10 +2915,11 @@ static void gcode_G80()
// Move Z up to the probe height of the current Z point.
const float z0 = mbl.z_values[iy][ix];
const float init_z_bckp = !has_z ? MESH_HOME_Z_SEARCH : z0 + MESH_HOME_Z_SEARCH_FAST;
if (init_z_bckp > current_position[Z_AXIS])
if (init_z_bckp > current_position[Z_AXIS]) {
current_position[Z_AXIS] = init_z_bckp;
plan_buffer_line_curposXYZE(Z_LIFT_FEEDRATE);
st_synchronize();
plan_buffer_line_curposXYZE(Z_LIFT_FEEDRATE);
st_synchronize();
}
// Move to XY position of the sensor point.
current_position[X_AXIS] = x_pos;