Re-enable MBL/ABL after M48

8 years ago · 04636f78eb
parent 9b41638672
commit 04636f78eb
1 changed files with 7 additions and 1 deletions
--- a/Marlin/Marlin_main.cpp
+++ b/Marlin/Marlin_main.cpp
@ -5051,7 +5051,8 @@ inline void gcode_M42() {

    // Disable bed level correction in M48 because we want the raw data when we probe
    #if HAS_ABL
-      reset_bed_level();
+      const bool abl_was_enabled = planner.abl_enabled;
+      set_bed_leveling_enabled(false);
    #endif

    setup_for_endstop_or_probe_move();
@ -5202,6 +5203,11 @@ inline void gcode_M42() {

    clean_up_after_endstop_or_probe_move();

+    // Re-enable bed level correction if it has been on
+    #if HAS_ABL
+      set_bed_leveling_enabled(abl_was_enabled);
+    #endif
+
    report_current_position();
  }