Update G34_M422.cpp

This commit is contained in:
InsanityAutomation
2020-10-11 11:48:45 -04:00
parent 56f7a03a5c
commit 402a13a980
+8 -4
View File
@@ -544,10 +544,14 @@ void GcodeSuite::M422() {
do_blocking_move_to(safe_pos, MMM_TO_MMS(GANTRY_CALIBRATION_XY_PARK_FEEDRATE));
#endif
constexpr float dir = (GANTRY_CALIBRATION_DIRECTION == 1) ? -1 : 1;
const float move_distance = parser.intval('Z', GANTRY_CALIBRATION_EXTRA_HEIGHT),
zpounce = (Z_MIN_POS) + (dir * move_distance),
zgrind = (Z_MAX_POS) - (dir * move_distance);
const float move_distance = parser.intval('Z', GANTRY_CALIBRATION_EXTRA_HEIGHT);
#if GANTRY_CALIBRATION_DIRECTION == 1
const float zpounce = Z_MAX_POS - move_distance;
const float zgrind = Z_MAX_POS + move_distance;
#else
const float zpounce = Z_MIN_POS - move_distance;
const float zgrind = Z_MIN_POS + move_distance;
#endif
// Move Z to pounce position
if (DEBUGGING(LEVELING)) DEBUG_ECHOLNPGM("Setting Z Pounce");