From 4b93989a77f78dd049377cb362f7c4ef22f6b2e4 Mon Sep 17 00:00:00 2001
From: Scott Lahteine <sourcetree@thinkyhead.com>
Date: Sat, 11 Jun 2016 13:00:30 -0700
Subject: [PATCH] MBL Z adjustment on toolchange
---
Marlin/Marlin_main.cpp | 16 +++++++---------
1 file changed, 7 insertions(+), 9 deletions(-)
diff --git a/Marlin/Marlin_main.cpp b/Marlin/Marlin_main.cpp
index 0dc8d2a6cb..300a69e1a3 100644
--- a/Marlin/Marlin_main.cpp
+++ b/Marlin/Marlin_main.cpp
@@ -6748,17 +6748,15 @@ inline void gcode_T(uint8_t tmp_extruder) {
}
#endif
- #else // !AUTO_BED_LEVELING_FEATURE
-
- // The newly-selected extruder is actually at...
- for (int i=X_AXIS; i<=Y_AXIS; i++) {
- float diff = hotend_offset[i][tmp_extruder] - hotend_offset[i][active_extruder];
- current_position[i] += diff;
- position_shift[i] += diff; // Offset the coordinate space
- update_software_endstops((AxisEnum)i);
+ #elif ENABLED(MESH_BED_LEVELING)
+
+ if (mbl.active()) {
+ float xpos = current_position[X_AXIS] - home_offset[X_AXIS],
+ ypos = current_position[Y_AXIS] - home_offset[Y_AXIS];
+ current_position[Z_AXIS] += mbl.get_z(xpos + xydiff[X_AXIS], ypos + xydiff[Y_AXIS]) - mbl.get_z(xpos, ypos);
}
- #endif // !AUTO_BED_LEVELING_FEATURE
+ #else // no bed leveling
// The newly-selected extruder XY is actually at...
current_position[X_AXIS] += xydiff[X_AXIS];
--
GitLab