Fix Z position after ABL bilinear G29 with fade (#17174)

This commit is contained in:
Ivo Pischner 2020-10-27 12:18:31 +01:00
parent 353d1b2fe6
commit 44570a9c0c
1 changed files with 6 additions and 1 deletions

View File

@ -5572,7 +5572,12 @@ void home_all_axes() { gcode_G28(true); }
// Unapply the offset because it is going to be immediately applied
// and cause compensation movement in Z
current_position[Z_AXIS] -= bilinear_z_offset(current_position);
#if ENABLED(ENABLE_LEVELING_FADE_HEIGHT)
const float fade_scaling_factor = planner.fade_scaling_factor_for_z(current_position[Z_AXIS]);
#else
constexpr float fade_scaling_factor = 1.0f;
#endif
current_position[Z_AXIS] -= fade_scaling_factor * bilinear_z_offset(current_position);
#if ENABLED(DEBUG_LEVELING_FEATURE)
if (DEBUGGING(LEVELING)) SERIAL_ECHOLNPAIR(" corrected Z:", current_position[Z_AXIS]);