|
|
@ -269,14 +269,12 @@
|
|
|
|
void tmc_init(TMCMarlin<TMC2160Stepper, AXIS_LETTER, DRIVER_ID, AXIS_ID> &st, const uint16_t mA, const uint16_t microsteps, const uint32_t thrs, const bool stealth) {
|
|
|
|
void tmc_init(TMCMarlin<TMC2160Stepper, AXIS_LETTER, DRIVER_ID, AXIS_ID> &st, const uint16_t mA, const uint16_t microsteps, const uint32_t thrs, const bool stealth) {
|
|
|
|
st.begin();
|
|
|
|
st.begin();
|
|
|
|
|
|
|
|
|
|
|
|
static constexpr int8_t timings[] = CHOPPER_TIMING; // Default 4, -2, 1
|
|
|
|
|
|
|
|
|
|
|
|
|
|
|
|
CHOPCONF_t chopconf{0};
|
|
|
|
CHOPCONF_t chopconf{0};
|
|
|
|
chopconf.tbl = 1;
|
|
|
|
chopconf.tbl = 1;
|
|
|
|
chopconf.toff = timings[0];
|
|
|
|
chopconf.toff = chopper_timing.toff;
|
|
|
|
chopconf.intpol = INTERPOLATE;
|
|
|
|
chopconf.intpol = INTERPOLATE;
|
|
|
|
chopconf.hend = timings[1] + 3;
|
|
|
|
chopconf.hend = chopper_timing.hend + 3;
|
|
|
|
chopconf.hstrt = timings[2] - 1;
|
|
|
|
chopconf.hstrt = chopper_timing.hstrt - 1;
|
|
|
|
#if ENABLED(SQUARE_WAVE_STEPPING)
|
|
|
|
#if ENABLED(SQUARE_WAVE_STEPPING)
|
|
|
|
chopconf.dedge = true;
|
|
|
|
chopconf.dedge = true;
|
|
|
|
#endif
|
|
|
|
#endif
|
|
|
@ -286,16 +284,9 @@
|
|
|
|
st.microsteps(microsteps);
|
|
|
|
st.microsteps(microsteps);
|
|
|
|
st.iholddelay(10);
|
|
|
|
st.iholddelay(10);
|
|
|
|
st.TPOWERDOWN(128); // ~2s until driver lowers to hold current
|
|
|
|
st.TPOWERDOWN(128); // ~2s until driver lowers to hold current
|
|
|
|
st.TCOOLTHRS(0xFFFFF);
|
|
|
|
|
|
|
|
|
|
|
|
|
|
|
|
#if ENABLED(ADAPTIVE_CURRENT)
|
|
|
|
|
|
|
|
COOLCONF_t coolconf{0};
|
|
|
|
|
|
|
|
coolconf.semin = INCREASE_CURRENT_THRS;
|
|
|
|
|
|
|
|
coolconf.semax = REDUCE_CURRENT_THRS;
|
|
|
|
|
|
|
|
st.COOLCONF(coolconf.sr);
|
|
|
|
|
|
|
|
#endif
|
|
|
|
|
|
|
|
|
|
|
|
|
|
|
|
st.en_pwm_mode(stealth);
|
|
|
|
st.en_pwm_mode(stealth);
|
|
|
|
|
|
|
|
st.stored.stealthChop_enabled = stealth;
|
|
|
|
|
|
|
|
|
|
|
|
TMC2160_n::PWMCONF_t pwmconf{0};
|
|
|
|
TMC2160_n::PWMCONF_t pwmconf{0};
|
|
|
|
pwmconf.pwm_lim = 12;
|
|
|
|
pwmconf.pwm_lim = 12;
|
|
|
@ -573,6 +564,9 @@
|
|
|
|
chopconf.intpol = INTERPOLATE;
|
|
|
|
chopconf.intpol = INTERPOLATE;
|
|
|
|
chopconf.hend = chopper_timing.hend + 3;
|
|
|
|
chopconf.hend = chopper_timing.hend + 3;
|
|
|
|
chopconf.hstrt = chopper_timing.hstrt - 1;
|
|
|
|
chopconf.hstrt = chopper_timing.hstrt - 1;
|
|
|
|
|
|
|
|
#if ENABLED(SQUARE_WAVE_STEPPING)
|
|
|
|
|
|
|
|
chopconf.dedge = true;
|
|
|
|
|
|
|
|
#endif
|
|
|
|
st.CHOPCONF(chopconf.sr);
|
|
|
|
st.CHOPCONF(chopconf.sr);
|
|
|
|
|
|
|
|
|
|
|
|
st.rms_current(mA, HOLD_MULTIPLIER);
|
|
|
|
st.rms_current(mA, HOLD_MULTIPLIER);
|
|
|
@ -673,14 +667,12 @@
|
|
|
|
void tmc_init(TMCMarlin<TMC5160Stepper, AXIS_LETTER, DRIVER_ID, AXIS_ID> &st, const uint16_t mA, const uint16_t microsteps, const uint32_t thrs, const bool stealth) {
|
|
|
|
void tmc_init(TMCMarlin<TMC5160Stepper, AXIS_LETTER, DRIVER_ID, AXIS_ID> &st, const uint16_t mA, const uint16_t microsteps, const uint32_t thrs, const bool stealth) {
|
|
|
|
st.begin();
|
|
|
|
st.begin();
|
|
|
|
|
|
|
|
|
|
|
|
int8_t timings[] = CHOPPER_TIMING; // Default 4, -2, 1
|
|
|
|
|
|
|
|
|
|
|
|
|
|
|
|
CHOPCONF_t chopconf{0};
|
|
|
|
CHOPCONF_t chopconf{0};
|
|
|
|
chopconf.tbl = 1;
|
|
|
|
chopconf.tbl = 1;
|
|
|
|
chopconf.toff = timings[0];
|
|
|
|
chopconf.toff = chopper_timing.toff;
|
|
|
|
chopconf.intpol = INTERPOLATE;
|
|
|
|
chopconf.intpol = INTERPOLATE;
|
|
|
|
chopconf.hend = timings[1] + 3;
|
|
|
|
chopconf.hend = chopper_timing.hend + 3;
|
|
|
|
chopconf.hstrt = timings[2] - 1;
|
|
|
|
chopconf.hstrt = chopper_timing.hstrt - 1;
|
|
|
|
#if ENABLED(SQUARE_WAVE_STEPPING)
|
|
|
|
#if ENABLED(SQUARE_WAVE_STEPPING)
|
|
|
|
chopconf.dedge = true;
|
|
|
|
chopconf.dedge = true;
|
|
|
|
#endif
|
|
|
|
#endif
|
|
|
@ -691,14 +683,8 @@
|
|
|
|
st.iholddelay(10);
|
|
|
|
st.iholddelay(10);
|
|
|
|
st.TPOWERDOWN(128); // ~2s until driver lowers to hold current
|
|
|
|
st.TPOWERDOWN(128); // ~2s until driver lowers to hold current
|
|
|
|
|
|
|
|
|
|
|
|
#if ENABLED(ADAPTIVE_CURRENT)
|
|
|
|
|
|
|
|
COOLCONF_t coolconf{0};
|
|
|
|
|
|
|
|
coolconf.semin = INCREASE_CURRENT_THRS;
|
|
|
|
|
|
|
|
coolconf.semax = REDUCE_CURRENT_THRS;
|
|
|
|
|
|
|
|
st.COOLCONF(coolconf.sr);
|
|
|
|
|
|
|
|
#endif
|
|
|
|
|
|
|
|
|
|
|
|
|
|
|
|
st.en_pwm_mode(stealth);
|
|
|
|
st.en_pwm_mode(stealth);
|
|
|
|
|
|
|
|
st.stored.stealthChop_enabled = stealth;
|
|
|
|
|
|
|
|
|
|
|
|
TMC2160_n::PWMCONF_t pwmconf{0};
|
|
|
|
TMC2160_n::PWMCONF_t pwmconf{0};
|
|
|
|
pwmconf.pwm_lim = 12;
|
|
|
|
pwmconf.pwm_lim = 12;
|
|
|
|