Merge pull request #3597 from thinkyhead/rc_fix_g29_debug

Move G29 debug output before matrix.set_to_identity()

Marlin/Marlin_main.cpp

@@ -3196,14 +3196,7 @@ inline void gcode_G28() {
 
     if (!dryrun) {
 
-      // make sure the bed_level_rotation_matrix is identity or the planner will get it wrong
+      #if ENABLED(DEBUG_LEVELING_FEATURE) && DISABLED(DELTA)
-      plan_bed_level_matrix.set_to_identity();
-
-      #if ENABLED(DELTA)
-        reset_bed_level();
-      #else //!DELTA
-
-        #if ENABLED(DEBUG_LEVELING_FEATURE)
         if (DEBUGGING(LEVELING)) {
           vector_3 corrected_position = plan_get_position();
           DEBUG_POS("BEFORE matrix.set_to_identity", corrected_position);
@@ -3211,6 +3204,13 @@ inline void gcode_G28() {
         }
       #endif
 
+      // make sure the bed_level_rotation_matrix is identity or the planner will get it wrong
+      plan_bed_level_matrix.set_to_identity();
+
+      #if ENABLED(DELTA)
+        reset_bed_level();
+      #else //!DELTA
+
         //vector_3 corrected_position = plan_get_position();
         //corrected_position.debug("position before G29");
         vector_3 uncorrected_position = plan_get_position();