|
|
|
@ -346,64 +346,73 @@
|
|
|
|
|
#endif
|
|
|
|
|
|
|
|
|
|
if (need_update_error_counters || need_debug_reporting) {
|
|
|
|
|
#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
|
|
|
|
|
}
|
|
|
|
|
#endif
|
|
|
|
|
#if AXIS_IS_TMC(X2)
|
|
|
|
|
if (monitor_tmc_driver(stepperX2, 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)) result = true;
|
|
|
|
|
#endif
|
|
|
|
|
#if AXIS_IS_TMC(X2)
|
|
|
|
|
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
|
|
|
|
|
}
|
|
|
|
|
#endif
|
|
|
|
|
#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);
|
|
|
|
|
#if AXIS_IS_TMC(X2)
|
|
|
|
|
step_current_down(stepperX2);
|
|
|
|
|
#endif
|
|
|
|
|
}
|
|
|
|
|
}
|
|
|
|
|
#endif
|
|
|
|
|
#if AXIS_IS_TMC(Y2)
|
|
|
|
|
if (monitor_tmc_driver(stepperY2, need_update_error_counters, need_debug_reporting)) {
|
|
|
|
|
|
|
|
|
|
#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)) result = true;
|
|
|
|
|
#endif
|
|
|
|
|
#if AXIS_IS_TMC(Y2)
|
|
|
|
|
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
|
|
|
|
|
}
|
|
|
|
|
#endif
|
|
|
|
|
#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
|
|
|
|
|
}
|
|
|
|
|
#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);
|
|
|
|
|
#endif
|
|
|
|
|
#if AXIS_IS_TMC(Z3)
|
|
|
|
|
step_current_down(stepperZ3);
|
|
|
|
|
#if AXIS_IS_TMC(Y2)
|
|
|
|
|
step_current_down(stepperY2);
|
|
|
|
|
#endif
|
|
|
|
|
}
|
|
|
|
|
}
|
|
|
|
|
#endif
|
|
|
|
|
#if AXIS_IS_TMC(Z3)
|
|
|
|
|
if (monitor_tmc_driver(stepperZ3, need_update_error_counters, need_debug_reporting)) {
|
|
|
|
|
|
|
|
|
|
#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)) result = true;
|
|
|
|
|
#endif
|
|
|
|
|
#if AXIS_IS_TMC(Z2)
|
|
|
|
|
if (monitor_tmc_driver(stepperZ2, need_update_error_counters, need_debug_reporting)) result = true;
|
|
|
|
|
#endif
|
|
|
|
|
#if AXIS_IS_TMC(Z3)
|
|
|
|
|
if (monitor_tmc_driver(stepperZ3, need_update_error_counters, need_debug_reporting)) result = true;
|
|
|
|
|
#endif
|
|
|
|
|
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
|
|
|
|
|