|
|
|
@ -37,7 +37,6 @@ |
|
|
|
#endif |
|
|
|
|
|
|
|
bool report_tmc_status = false; |
|
|
|
char extended_axis_codes[11][3] = { "X", "X2", "Y", "Y2", "Z", "Z2", "E0", "E1", "E2", "E3", "E4" }; |
|
|
|
|
|
|
|
/**
|
|
|
|
* Check for over temperature or short to ground error flags. |
|
|
|
@ -96,18 +95,17 @@ char extended_axis_codes[11][3] = { "X", "X2", "Y", "Y2", "Z", "Z2", "E0", "E1", |
|
|
|
#endif |
|
|
|
|
|
|
|
template<typename TMC> |
|
|
|
void monitor_tmc_driver(TMC &st, const char * const axisName, uint8_t &otpw_cnt) { |
|
|
|
void monitor_tmc_driver(TMC &st, const TMC_AxisEnum axis, uint8_t &otpw_cnt) { |
|
|
|
TMC_driver_data data = get_driver_data(st); |
|
|
|
|
|
|
|
#if ENABLED(STOP_ON_ERROR) |
|
|
|
if (data.is_error) { |
|
|
|
SERIAL_EOL(); |
|
|
|
SERIAL_ECHO(axisName); |
|
|
|
SERIAL_ECHOPGM(" driver error detected:"); |
|
|
|
if (data.is_ot) SERIAL_ECHOPGM("\novertemperature"); |
|
|
|
if (st.s2ga()) SERIAL_ECHOPGM("\nshort to ground (coil A)"); |
|
|
|
if (st.s2gb()) SERIAL_ECHOPGM("\nshort to ground (coil B)"); |
|
|
|
SERIAL_EOL(); |
|
|
|
_tmc_say_axis(axis); |
|
|
|
SERIAL_ECHOLNPGM(" driver error detected:"); |
|
|
|
if (data.is_ot) SERIAL_ECHOLNPGM("overtemperature"); |
|
|
|
if (st.s2ga()) SERIAL_ECHOLNPGM("short to ground (coil A)"); |
|
|
|
if (st.s2gb()) SERIAL_ECHOLNPGM("short to ground (coil B)"); |
|
|
|
#if ENABLED(TMC_DEBUG) |
|
|
|
tmc_report_all(); |
|
|
|
#endif |
|
|
|
@ -124,7 +122,7 @@ char extended_axis_codes[11][3] = { "X", "X2", "Y", "Y2", "Z", "Z2", "E0", "E1", |
|
|
|
SERIAL_EOL(); |
|
|
|
SERIAL_ECHO(timestamp); |
|
|
|
SERIAL_ECHOPGM(": "); |
|
|
|
SERIAL_ECHO(axisName); |
|
|
|
_tmc_say_axis(axis); |
|
|
|
SERIAL_ECHOPGM(" driver overtemperature warning! ("); |
|
|
|
SERIAL_ECHO(st.getCurrent()); |
|
|
|
SERIAL_ECHOLNPGM("mA)"); |
|
|
|
@ -134,7 +132,7 @@ char extended_axis_codes[11][3] = { "X", "X2", "Y", "Y2", "Z", "Z2", "E0", "E1", |
|
|
|
if (data.is_otpw && !st.isEnabled() && otpw_cnt > 4) { |
|
|
|
st.setCurrent(st.getCurrent() - CURRENT_STEP_DOWN, R_SENSE, HOLD_MULTIPLIER); |
|
|
|
#if ENABLED(REPORT_CURRENT_CHANGE) |
|
|
|
SERIAL_ECHO(axisName); |
|
|
|
_tmc_say_axis(axis); |
|
|
|
SERIAL_ECHOLNPAIR(" current decreased to ", st.getCurrent()); |
|
|
|
#endif |
|
|
|
} |
|
|
|
@ -148,7 +146,7 @@ char extended_axis_codes[11][3] = { "X", "X2", "Y", "Y2", "Z", "Z2", "E0", "E1", |
|
|
|
|
|
|
|
if (report_tmc_status) { |
|
|
|
const uint32_t pwm_scale = get_pwm_scale(st); |
|
|
|
SERIAL_ECHO(axisName); |
|
|
|
_tmc_say_axis(axis); |
|
|
|
SERIAL_ECHOPAIR(":", pwm_scale); |
|
|
|
SERIAL_ECHOPGM(" |0b"); SERIAL_PRINT(get_status_response(st), BIN); |
|
|
|
SERIAL_ECHOPGM("| "); |
|
|
|
@ -169,47 +167,47 @@ char extended_axis_codes[11][3] = { "X", "X2", "Y", "Y2", "Z", "Z2", "E0", "E1", |
|
|
|
next_cOT = millis() + 500; |
|
|
|
#if HAS_HW_COMMS(X) || ENABLED(IS_TRAMS) |
|
|
|
static uint8_t x_otpw_cnt = 0; |
|
|
|
monitor_tmc_driver(stepperX, extended_axis_codes[TMC_X], x_otpw_cnt); |
|
|
|
monitor_tmc_driver(stepperX, TMC_X, x_otpw_cnt); |
|
|
|
#endif |
|
|
|
#if HAS_HW_COMMS(Y) || ENABLED(IS_TRAMS) |
|
|
|
static uint8_t y_otpw_cnt = 0; |
|
|
|
monitor_tmc_driver(stepperY, extended_axis_codes[TMC_Y], y_otpw_cnt); |
|
|
|
monitor_tmc_driver(stepperY, TMC_Y, y_otpw_cnt); |
|
|
|
#endif |
|
|
|
#if HAS_HW_COMMS(Z) || ENABLED(IS_TRAMS) |
|
|
|
static uint8_t z_otpw_cnt = 0; |
|
|
|
monitor_tmc_driver(stepperZ, extended_axis_codes[TMC_Z], z_otpw_cnt); |
|
|
|
monitor_tmc_driver(stepperZ, TMC_Z, z_otpw_cnt); |
|
|
|
#endif |
|
|
|
#if HAS_HW_COMMS(X2) |
|
|
|
static uint8_t x2_otpw_cnt = 0; |
|
|
|
monitor_tmc_driver(stepperX2, extended_axis_codes[TMC_X], x2_otpw_cnt); |
|
|
|
monitor_tmc_driver(stepperX2, TMC_X, x2_otpw_cnt); |
|
|
|
#endif |
|
|
|
#if HAS_HW_COMMS(Y2) |
|
|
|
static uint8_t y2_otpw_cnt = 0; |
|
|
|
monitor_tmc_driver(stepperY2, extended_axis_codes[TMC_Y], y2_otpw_cnt); |
|
|
|
monitor_tmc_driver(stepperY2, TMC_Y, y2_otpw_cnt); |
|
|
|
#endif |
|
|
|
#if HAS_HW_COMMS(Z2) |
|
|
|
static uint8_t z2_otpw_cnt = 0; |
|
|
|
monitor_tmc_driver(stepperZ2, extended_axis_codes[TMC_Z], z2_otpw_cnt); |
|
|
|
monitor_tmc_driver(stepperZ2, TMC_Z, z2_otpw_cnt); |
|
|
|
#endif |
|
|
|
#if HAS_HW_COMMS(E0) || ENABLED(IS_TRAMS) |
|
|
|
static uint8_t e0_otpw_cnt = 0; |
|
|
|
monitor_tmc_driver(stepperE0, extended_axis_codes[TMC_E0], e0_otpw_cnt); |
|
|
|
monitor_tmc_driver(stepperE0, TMC_E0, e0_otpw_cnt); |
|
|
|
#endif |
|
|
|
#if HAS_HW_COMMS(E1) |
|
|
|
static uint8_t e1_otpw_cnt = 0; |
|
|
|
monitor_tmc_driver(stepperE1, extended_axis_codes[TMC_E1], e1_otpw_cnt); |
|
|
|
monitor_tmc_driver(stepperE1, TMC_E1, e1_otpw_cnt); |
|
|
|
#endif |
|
|
|
#if HAS_HW_COMMS(E2) |
|
|
|
static uint8_t e2_otpw_cnt = 0; |
|
|
|
monitor_tmc_driver(stepperE2, extended_axis_codes[TMC_E2], e2_otpw_cnt); |
|
|
|
monitor_tmc_driver(stepperE2, TMC_E2, e2_otpw_cnt); |
|
|
|
#endif |
|
|
|
#if HAS_HW_COMMS(E3) |
|
|
|
static uint8_t e3_otpw_cnt = 0; |
|
|
|
monitor_tmc_driver(stepperE3, extended_axis_codes[TMC_E3], e3_otpw_cnt); |
|
|
|
monitor_tmc_driver(stepperE3, TMC_E3, e3_otpw_cnt); |
|
|
|
#endif |
|
|
|
#if HAS_HW_COMMS(E4) |
|
|
|
static uint8_t e4_otpw_cnt = 0; |
|
|
|
monitor_tmc_driver(stepperE4, extended_axis_codes[TMC_E4], e4_otpw_cnt); |
|
|
|
monitor_tmc_driver(stepperE4, TMC_E4, e4_otpw_cnt); |
|
|
|
#endif |
|
|
|
|
|
|
|
if (report_tmc_status) SERIAL_EOL(); |
|
|
|
@ -218,33 +216,44 @@ char extended_axis_codes[11][3] = { "X", "X2", "Y", "Y2", "Z", "Z2", "E0", "E1", |
|
|
|
|
|
|
|
#endif // MONITOR_DRIVER_STATUS
|
|
|
|
|
|
|
|
void _tmc_say_current(const char name[], const uint16_t curr) { |
|
|
|
SERIAL_ECHO(name); |
|
|
|
void _tmc_say_axis(const TMC_AxisEnum axis) { |
|
|
|
const static char ext_X[] PROGMEM = "X", ext_X2[] PROGMEM = "X2", |
|
|
|
ext_Y[] PROGMEM = "Y", ext_Y2[] PROGMEM = "Y2", |
|
|
|
ext_Z[] PROGMEM = "Z", ext_Z2[] PROGMEM = "Z2", |
|
|
|
ext_E0[] PROGMEM = "E0", ext_E1[] PROGMEM = "E1", |
|
|
|
ext_E2[] PROGMEM = "E2", ext_E3[] PROGMEM = "E3", |
|
|
|
ext_E4[] PROGMEM = "E4"; |
|
|
|
const static char* const tmc_axes[] PROGMEM = { ext_X, ext_X2, ext_Y, ext_Y2, ext_Z, ext_Z2, ext_E0, ext_E1, ext_E2, ext_E3, ext_E4 }; |
|
|
|
serialprintPGM(tmc_axes[axis]); |
|
|
|
} |
|
|
|
|
|
|
|
void _tmc_say_current(const TMC_AxisEnum axis, const uint16_t curr) { |
|
|
|
_tmc_say_axis(axis); |
|
|
|
SERIAL_ECHOLNPAIR(" axis driver current: ", curr); |
|
|
|
} |
|
|
|
void _tmc_say_otpw(const char name[], const bool otpw) { |
|
|
|
SERIAL_ECHO(name); |
|
|
|
void _tmc_say_otpw(const TMC_AxisEnum axis, const bool otpw) { |
|
|
|
_tmc_say_axis(axis); |
|
|
|
SERIAL_ECHOPGM(" axis temperature prewarn triggered: "); |
|
|
|
serialprintPGM(otpw ? PSTR("true") : PSTR("false")); |
|
|
|
SERIAL_EOL(); |
|
|
|
} |
|
|
|
void _tmc_say_otpw_cleared(const char name[]) { |
|
|
|
SERIAL_ECHO(name); |
|
|
|
void _tmc_say_otpw_cleared(const TMC_AxisEnum axis) { |
|
|
|
_tmc_say_axis(axis); |
|
|
|
SERIAL_ECHOLNPGM(" prewarn flag cleared"); |
|
|
|
} |
|
|
|
void _tmc_say_pwmthrs(const char name[], const uint32_t thrs) { |
|
|
|
SERIAL_ECHO(name); |
|
|
|
void _tmc_say_pwmthrs(const TMC_AxisEnum axis, const uint32_t thrs) { |
|
|
|
_tmc_say_axis(axis); |
|
|
|
SERIAL_ECHOLNPAIR(" stealthChop max speed set to ", thrs); |
|
|
|
} |
|
|
|
void _tmc_say_sgt(const char name[], const int8_t sgt) { |
|
|
|
SERIAL_ECHO(name); |
|
|
|
void _tmc_say_sgt(const TMC_AxisEnum axis, const int8_t sgt) { |
|
|
|
_tmc_say_axis(axis); |
|
|
|
SERIAL_ECHOPGM(" driver homing sensitivity set to "); |
|
|
|
SERIAL_PRINTLN(sgt, DEC); |
|
|
|
} |
|
|
|
|
|
|
|
#if ENABLED(TMC_DEBUG) |
|
|
|
|
|
|
|
enum TMC_debug_enum { |
|
|
|
enum TMC_debug_enum : char { |
|
|
|
TMC_CODES, |
|
|
|
TMC_ENABLED, |
|
|
|
TMC_CURRENT, |
|
|
|
@ -268,7 +277,7 @@ void _tmc_say_sgt(const char name[], const int8_t sgt) { |
|
|
|
TMC_HSTRT, |
|
|
|
TMC_SGT |
|
|
|
}; |
|
|
|
enum TMC_drv_status_enum { |
|
|
|
enum TMC_drv_status_enum : char { |
|
|
|
TMC_DRV_CODES, |
|
|
|
TMC_STST, |
|
|
|
TMC_OLB, |
|
|
|
@ -290,8 +299,8 @@ void _tmc_say_sgt(const char name[], const int8_t sgt) { |
|
|
|
TMC_S2VSB, |
|
|
|
TMC_S2VSA |
|
|
|
}; |
|
|
|
static void drv_status_print_hex(const char name[], const uint32_t drv_status) { |
|
|
|
SERIAL_ECHO(name); |
|
|
|
static void drv_status_print_hex(const TMC_AxisEnum axis, const uint32_t drv_status) { |
|
|
|
_tmc_say_axis(axis); |
|
|
|
SERIAL_ECHOPGM(" = 0x"); |
|
|
|
for (int B = 24; B >= 8; B -= 8){ |
|
|
|
SERIAL_PRINT((drv_status >> (B + 4)) & 0xF, HEX); |
|
|
|
@ -345,10 +354,10 @@ void _tmc_say_sgt(const char name[], const int8_t sgt) { |
|
|
|
#endif |
|
|
|
|
|
|
|
template <typename TMC> |
|
|
|
static void tmc_status(TMC &st, TMC_AxisEnum axis, const TMC_debug_enum i, const float spmm) { |
|
|
|
static void tmc_status(TMC &st, const TMC_AxisEnum axis, const TMC_debug_enum i, const float spmm) { |
|
|
|
SERIAL_ECHO('\t'); |
|
|
|
switch(i) { |
|
|
|
case TMC_CODES: SERIAL_ECHO(extended_axis_codes[axis]); break; |
|
|
|
case TMC_CODES: _tmc_say_axis(axis); break; |
|
|
|
case TMC_ENABLED: serialprintPGM(st.isEnabled() ? PSTR("true") : PSTR("false")); break; |
|
|
|
case TMC_CURRENT: SERIAL_ECHO(st.getCurrent()); break; |
|
|
|
case TMC_RMS_CURRENT: SERIAL_PROTOCOL(st.rms_current()); break; |
|
|
|
@ -390,10 +399,10 @@ void _tmc_say_sgt(const char name[], const int8_t sgt) { |
|
|
|
} |
|
|
|
|
|
|
|
template <typename TMC> |
|
|
|
static void tmc_parse_drv_status(TMC &st, TMC_AxisEnum axis, const TMC_drv_status_enum i) { |
|
|
|
static void tmc_parse_drv_status(TMC &st, const TMC_AxisEnum axis, const TMC_drv_status_enum i) { |
|
|
|
SERIAL_CHAR('\t'); |
|
|
|
switch(i) { |
|
|
|
case TMC_DRV_CODES: SERIAL_ECHO(extended_axis_codes[axis]); break; |
|
|
|
case TMC_DRV_CODES: _tmc_say_axis(axis); break; |
|
|
|
case TMC_STST: if (st.stst()) SERIAL_CHAR('X'); break; |
|
|
|
case TMC_OLB: if (st.olb()) SERIAL_CHAR('X'); break; |
|
|
|
case TMC_OLA: if (st.ola()) SERIAL_CHAR('X'); break; |
|
|
|
@ -402,7 +411,7 @@ void _tmc_say_sgt(const char name[], const int8_t sgt) { |
|
|
|
case TMC_DRV_OTPW: if (st.otpw()) SERIAL_CHAR('X'); break; |
|
|
|
case TMC_OT: if (st.ot()) SERIAL_CHAR('X'); break; |
|
|
|
case TMC_DRV_CS_ACTUAL: SERIAL_PRINT(st.cs_actual(), DEC); break; |
|
|
|
case TMC_DRV_STATUS_HEX:drv_status_print_hex(extended_axis_codes[axis], st.DRV_STATUS()); break; |
|
|
|
case TMC_DRV_STATUS_HEX:drv_status_print_hex(axis, st.DRV_STATUS()); break; |
|
|
|
default: tmc_parse_drv_status(st, i); break; |
|
|
|
} |
|
|
|
} |
|
|
|
|
Scott Lahteine
6 years ago
GitHub