|
|
@ -346,64 +346,73 @@ |
|
|
|
#endif |
|
|
|
|
|
|
|
if (need_update_error_counters || need_debug_reporting) { |
|
|
|
|
|
|
|
#if AXIS_IS_TMC(X) || AXIS_IS_TMC(X2) |
|
|
|
{ |
|
|
|
bool result = false; |
|
|
|
#if AXIS_IS_TMC(X) |
|
|
|
if (monitor_tmc_driver(stepperX, need_update_error_counters, need_debug_reporting)) { |
|
|
|
#if AXIS_IS_TMC(X2) |
|
|
|
step_current_down(stepperX2); |
|
|
|
#endif |
|
|
|
} |
|
|
|
if (monitor_tmc_driver(stepperX, need_update_error_counters, need_debug_reporting)) result = true; |
|
|
|
#endif |
|
|
|
#if AXIS_IS_TMC(X2) |
|
|
|
if (monitor_tmc_driver(stepperX2, need_update_error_counters, need_debug_reporting)) { |
|
|
|
if (monitor_tmc_driver(stepperX2, need_update_error_counters, need_debug_reporting)) result = true; |
|
|
|
#endif |
|
|
|
if (result) { |
|
|
|
#if AXIS_IS_TMC(X) |
|
|
|
step_current_down(stepperX); |
|
|
|
#endif |
|
|
|
#if AXIS_IS_TMC(X2) |
|
|
|
step_current_down(stepperX2); |
|
|
|
#endif |
|
|
|
} |
|
|
|
} |
|
|
|
#endif |
|
|
|
|
|
|
|
#if AXIS_IS_TMC(Y) || AXIS_IS_TMC(Y2) |
|
|
|
{ |
|
|
|
bool result = false; |
|
|
|
#if AXIS_IS_TMC(Y) |
|
|
|
if (monitor_tmc_driver(stepperY, need_update_error_counters, need_debug_reporting)) { |
|
|
|
#if AXIS_IS_TMC(Y2) |
|
|
|
step_current_down(stepperY2); |
|
|
|
#endif |
|
|
|
} |
|
|
|
if (monitor_tmc_driver(stepperY, need_update_error_counters, need_debug_reporting)) result = true; |
|
|
|
#endif |
|
|
|
#if AXIS_IS_TMC(Y2) |
|
|
|
if (monitor_tmc_driver(stepperY2, need_update_error_counters, need_debug_reporting)) { |
|
|
|
if (monitor_tmc_driver(stepperY2, need_update_error_counters, need_debug_reporting)) result = true; |
|
|
|
#endif |
|
|
|
if (result) { |
|
|
|
#if AXIS_IS_TMC(Y) |
|
|
|
step_current_down(stepperY); |
|
|
|
#endif |
|
|
|
#if AXIS_IS_TMC(Y2) |
|
|
|
step_current_down(stepperY2); |
|
|
|
#endif |
|
|
|
} |
|
|
|
} |
|
|
|
#endif |
|
|
|
|
|
|
|
#if AXIS_IS_TMC(Z) || AXIS_IS_TMC(Z2) || AXIS_IS_TMC(Z3) |
|
|
|
{ |
|
|
|
bool result = false; |
|
|
|
#if AXIS_IS_TMC(Z) |
|
|
|
if (monitor_tmc_driver(stepperZ, need_update_error_counters, need_debug_reporting)) { |
|
|
|
#if AXIS_IS_TMC(Z2) |
|
|
|
step_current_down(stepperZ2); |
|
|
|
#endif |
|
|
|
#if AXIS_IS_TMC(Z3) |
|
|
|
step_current_down(stepperZ3); |
|
|
|
#endif |
|
|
|
} |
|
|
|
if (monitor_tmc_driver(stepperZ, need_update_error_counters, need_debug_reporting)) result = true; |
|
|
|
#endif |
|
|
|
#if AXIS_IS_TMC(Z2) |
|
|
|
if (monitor_tmc_driver(stepperZ2, need_update_error_counters, need_debug_reporting)) { |
|
|
|
#if AXIS_IS_TMC(Z) |
|
|
|
step_current_down(stepperZ); |
|
|
|
if (monitor_tmc_driver(stepperZ2, need_update_error_counters, need_debug_reporting)) result = true; |
|
|
|
#endif |
|
|
|
#if AXIS_IS_TMC(Z3) |
|
|
|
step_current_down(stepperZ3); |
|
|
|
if (monitor_tmc_driver(stepperZ3, need_update_error_counters, need_debug_reporting)) result = true; |
|
|
|
#endif |
|
|
|
} |
|
|
|
#endif |
|
|
|
#if AXIS_IS_TMC(Z3) |
|
|
|
if (monitor_tmc_driver(stepperZ3, need_update_error_counters, need_debug_reporting)) { |
|
|
|
if (result) { |
|
|
|
#if AXIS_IS_TMC(Z) |
|
|
|
step_current_down(stepperZ); |
|
|
|
#endif |
|
|
|
#if AXIS_IS_TMC(Z2) |
|
|
|
step_current_down(stepperZ2); |
|
|
|
#endif |
|
|
|
#if AXIS_IS_TMC(Z3) |
|
|
|
step_current_down(stepperZ3); |
|
|
|
#endif |
|
|
|
} |
|
|
|
} |
|
|
|
#endif |
|
|
|
|
|
|
|
#if AXIS_IS_TMC(E0) |
|
|
|
(void)monitor_tmc_driver(stepperE0, need_update_error_counters, need_debug_reporting); |
|
|
|
#endif |
|
|
|