|
|
|
@ -107,12 +107,12 @@ void set_bed_leveling_enabled(const bool enable/*=true*/) {
|
|
|
|
|
const float (&pos)[XYZE] = current_position;
|
|
|
|
|
#endif
|
|
|
|
|
if (planner.leveling_active) {
|
|
|
|
|
current_position[Z_AXIS] += ubl.get_z_correction(pos[X_AXIS], pos[Y_AXIS], pos[Z_AXIS]);
|
|
|
|
|
current_position[Z_AXIS] += ubl.get_z_correction(pos[X_AXIS], pos[Y_AXIS]);
|
|
|
|
|
planner.leveling_active = false;
|
|
|
|
|
}
|
|
|
|
|
else {
|
|
|
|
|
planner.leveling_active = true;
|
|
|
|
|
current_position[Z_AXIS] -= ubl.get_z_correction(pos[X_AXIS], pos[Y_AXIS], pos[Z_AXIS]);
|
|
|
|
|
current_position[Z_AXIS] -= ubl.get_z_correction(pos[X_AXIS], pos[Y_AXIS]);
|
|
|
|
|
}
|
|
|
|
|
#endif
|
|
|
|
|
|
|
|
|
|