diff --git a/Marlin/ubl_G29.cpp b/Marlin/ubl_G29.cpp index f9ee5ae085..1161075b2e 100644 --- a/Marlin/ubl_G29.cpp +++ b/Marlin/ubl_G29.cpp @@ -1559,7 +1559,10 @@ incremental_LSF(&lsf_results, PROBE_PT_3_X, PROBE_PT_3_Y, measured_z); } } - + STOW_PROBE(); + #ifdef Z_AFTER_PROBING + move_z_after_probing(); + #endif if (abort_flag) { SERIAL_ECHOPGM("?Error probing point. Aborting operation.\n"); return; @@ -1615,9 +1618,12 @@ zig_zag ^= true; } - STOW_PROBE(); } - + STOW_PROBE(); + #ifdef Z_AFTER_PROBING + move_z_after_probing(); + #endif + if (abort_flag || finish_incremental_LSF(&lsf_results)) { SERIAL_ECHOPGM("Could not complete LSF!"); return;