Extra debugging for leveling on/off
This commit is contained in:
parent
1c042bbaea
commit
b7a67f6f74
|
@ -68,5 +68,4 @@ bool watchdog_timed_out() { return TEST(WDT_ReadTimeOutFlag(), 0); }
|
||||||
void watchdog_clear_timeout_flag() { WDT_ClrTimeOutFlag(); }
|
void watchdog_clear_timeout_flag() { WDT_ClrTimeOutFlag(); }
|
||||||
|
|
||||||
#endif // USE_WATCHDOG
|
#endif // USE_WATCHDOG
|
||||||
|
|
||||||
#endif // TARGET_LPC1768
|
#endif // TARGET_LPC1768
|
||||||
|
|
|
@ -86,14 +86,18 @@ void set_bed_leveling_enabled(const bool enable/*=true*/) {
|
||||||
#endif
|
#endif
|
||||||
|
|
||||||
if (planner.leveling_active) { // leveling from on to off
|
if (planner.leveling_active) { // leveling from on to off
|
||||||
|
if (DEBUGGING(LEVELING)) DEBUG_POS("Leveling ON", current_position);
|
||||||
// change unleveled current_position to physical current_position without moving steppers.
|
// change unleveled current_position to physical current_position without moving steppers.
|
||||||
planner.apply_leveling(current_position);
|
planner.apply_leveling(current_position);
|
||||||
planner.leveling_active = false; // disable only AFTER calling apply_leveling
|
planner.leveling_active = false; // disable only AFTER calling apply_leveling
|
||||||
|
if (DEBUGGING(LEVELING)) DEBUG_POS("...Now OFF", current_position);
|
||||||
}
|
}
|
||||||
else { // leveling from off to on
|
else { // leveling from off to on
|
||||||
|
if (DEBUGGING(LEVELING)) DEBUG_POS("Leveling OFF", current_position);
|
||||||
planner.leveling_active = true; // enable BEFORE calling unapply_leveling, otherwise ignored
|
planner.leveling_active = true; // enable BEFORE calling unapply_leveling, otherwise ignored
|
||||||
// change physical current_position to unleveled current_position without moving steppers.
|
// change physical current_position to unleveled current_position without moving steppers.
|
||||||
planner.unapply_leveling(current_position);
|
planner.unapply_leveling(current_position);
|
||||||
|
if (DEBUGGING(LEVELING)) DEBUG_POS("...Now ON", current_position);
|
||||||
}
|
}
|
||||||
|
|
||||||
sync_plan_position();
|
sync_plan_position();
|
||||||
|
|
Loading…
Reference in a new issue