From 63d8893f5d15a4c0c60b5d1aba04c26fef0b10ea Mon Sep 17 00:00:00 2001
From: Scott Lahteine <sourcetree@thinkyhead.com>
Date: Mon, 11 Apr 2016 20:30:00 -0700
Subject: [PATCH] Add DEBUG_LEVELING output for gcode_T
---
Marlin/Marlin_main.cpp | 21 +++++++++++++++++++++
1 file changed, 21 insertions(+)
diff --git a/Marlin/Marlin_main.cpp b/Marlin/Marlin_main.cpp
index d0cdf0a4969..9b4cee080e5 100644
--- a/Marlin/Marlin_main.cpp
+++ b/Marlin/Marlin_main.cpp
@@ -6183,10 +6183,31 @@ inline void gcode_T(uint8_t tmp_extruder) {
extruder_offset[Y_AXIS][active_extruder],
extruder_offset[Z_AXIS][active_extruder]),
offset_vec = tmp_offset_vec - act_offset_vec;
+
+ #if ENABLED(DEBUG_LEVELING_FEATURE)
+ if (DEBUGGING(LEVELING)) {
+ SERIAL_ECHOLNPGM(">>> gcode_T");
+ tmp_offset_vec.debug("tmp_offset_vec");
+ act_offset_vec.debug("act_offset_vec");
+ offset_vec.debug("offset_vec (BEFORE)");
+ DEBUG_POS("BEFORE rotation", current_position);
+ }
+ #endif
+
offset_vec.apply_rotation(plan_bed_level_matrix.transpose(plan_bed_level_matrix));
+
current_position[X_AXIS] += offset_vec.x;
current_position[Y_AXIS] += offset_vec.y;
current_position[Z_AXIS] += offset_vec.z;
+
+ #if ENABLED(DEBUG_LEVELING_FEATURE)
+ if (DEBUGGING(LEVELING)) {
+ offset_vec.debug("offset_vec (AFTER)");
+ DEBUG_POS("AFTER rotation", current_position);
+ SERIAL_ECHOLNPGM("<<< gcode_T");
+ }
+ #endif
+
#else // !AUTO_BED_LEVELING_FEATURE
// Offset extruder (only by XY)
for (int i=X_AXIS; i<=Y_AXIS; i++)