Fix for UBL set_bed_leveling_enabled

This commit is contained in:
Scott Lahteine 2018-04-18 00:14:00 -05:00
parent df2f24617b
commit ad6baa5c9d

View File

@ -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