Add the move_z_after_probing() functionality to UBL's G29 J

7 years ago · 1d7dd0edfd
parent 7a84b03796
commit 1d7dd0edfd
1 changed files with 11 additions and 3 deletions
--- a/Marlin/src/feature/bedlevel/ubl/ubl_G29.cpp
+++ b/Marlin/src/feature/bedlevel/ubl/ubl_G29.cpp
@ -1562,7 +1562,12 @@
            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;
@ -1618,9 +1623,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;