diff --git a/Marlin/Marlin_main.cpp b/Marlin/Marlin_main.cpp index 66e84843c..6b0f52b6a 100644 --- a/Marlin/Marlin_main.cpp +++ b/Marlin/Marlin_main.cpp @@ -3196,6 +3196,14 @@ inline void gcode_G28() { if (!dryrun) { + #if ENABLED(DEBUG_LEVELING_FEATURE) && DISABLED(DELTA) + if (DEBUGGING(LEVELING)) { + vector_3 corrected_position = plan_get_position(); + DEBUG_POS("BEFORE matrix.set_to_identity", corrected_position); + DEBUG_POS("BEFORE matrix.set_to_identity", current_position); + } + #endif + // make sure the bed_level_rotation_matrix is identity or the planner will get it wrong plan_bed_level_matrix.set_to_identity(); @@ -3203,14 +3211,6 @@ inline void gcode_G28() { 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); - DEBUG_POS("BEFORE matrix.set_to_identity", current_position); - } - #endif - //vector_3 corrected_position = plan_get_position(); //corrected_position.debug("position before G29"); vector_3 uncorrected_position = plan_get_position();