|
@@ -308,7 +308,7 @@ void GcodeSuite::G28(const bool always_home_all) {
|
308
|
308
|
|
309
|
309
|
if (z_homing_height && (doX || doY)) {
|
310
|
310
|
// Raise Z before homing any other axes and z is not already high enough (never lower z)
|
311
|
|
- destination.z = z_homing_height;
|
|
311
|
+ destination.z = z_homing_height + (TEST(axis_known_position, Z_AXIS) ? 0.0f : current_position.z);
|
312
|
312
|
if (destination.z > current_position.z) {
|
313
|
313
|
if (DEBUGGING(LEVELING)) DEBUG_ECHOLNPAIR("Raise Z (before homing) to ", destination.z);
|
314
|
314
|
do_blocking_move_to_z(destination.z);
|