[2.0.x] TMC driver update (#8769)
This commit is contained in:
teemuatlut
committed by
Scott Lahteine
Scott Lahteine
parent
09d13f186f
commit
0cd1e91056
@ -129,6 +129,7 @@
|
||||
|
||||
#include <SPI.h>
|
||||
#include <TMC2130Stepper.h>
|
||||
#include "planner.h"
|
||||
#include "../core/enum.h"
|
||||
|
||||
#define _TMC2130_DEFINE(ST) TMC2130Stepper stepper##ST(ST##_ENABLE_PIN, ST##_DIR_PIN, ST##_STEP_PIN, ST##_CS_PIN)
|
||||
@ -171,17 +172,17 @@
|
||||
// Use internal reference voltage for current calculations. This is the default.
|
||||
// Following values from Trinamic's spreadsheet with values for a NEMA17 (42BYGHW609)
|
||||
// https://www.trinamic.com/products/integrated-circuits/details/tmc2130/
|
||||
void tmc2130_init(TMC2130Stepper &st, const uint16_t microsteps, const uint32_t thrs, const float &spmm) {
|
||||
void tmc2130_init(TMC2130Stepper &st, const uint16_t microsteps, const uint32_t thrs, const float spmm) {
|
||||
st.begin();
|
||||
st.setCurrent(st.getCurrent(), R_SENSE, HOLD_MULTIPLIER);
|
||||
st.microsteps(microsteps);
|
||||
st.blank_time(36);
|
||||
st.blank_time(24);
|
||||
st.off_time(5); // Only enables the driver if used with stealthChop
|
||||
st.interpolate(INTERPOLATE);
|
||||
st.power_down_delay(128); // ~2s until driver lowers to hold current
|
||||
st.hysterisis_start(0); // HSTRT = 1
|
||||
st.hysterisis_low(1); // HEND = -2
|
||||
st.diag1_active_high(0); // For sensorless homing
|
||||
st.hysterisis_start(3);
|
||||
st.hysterisis_end(2);
|
||||
st.diag1_active_high(1); // For sensorless homing
|
||||
#if ENABLED(STEALTHCHOP)
|
||||
st.stealth_freq(1); // f_pwm = 2/683 f_clk
|
||||
st.stealth_autoscale(1);
|
||||
@ -189,61 +190,261 @@
|
||||
st.stealth_amplitude(255);
|
||||
st.stealthChop(1);
|
||||
#if ENABLED(HYBRID_THRESHOLD)
|
||||
st.stealth_max_speed(12650000UL*st.microsteps()/(256*thrs*spmm));
|
||||
st.stealth_max_speed(12650000UL*microsteps/(256*thrs*spmm));
|
||||
#else
|
||||
UNUSED(thrs);
|
||||
UNUSED(spmm);
|
||||
#endif
|
||||
#elif ENABLED(SENSORLESS_HOMING)
|
||||
st.coolstep_min_speed(1024UL * 1024UL - 1UL);
|
||||
#endif
|
||||
st.GSTAT(); // Clear GSTAT
|
||||
}
|
||||
|
||||
#define _TMC2130_INIT(ST, SPMM) tmc2130_init(stepper##ST, ST##_MICROSTEPS, ST##_HYBRID_THRESHOLD, SPMM)
|
||||
|
||||
void tmc2130_init() {
|
||||
constexpr float steps_per_mm[] = DEFAULT_AXIS_STEPS_PER_UNIT;
|
||||
#if ENABLED(X_IS_TMC2130)
|
||||
_TMC2130_INIT( X, steps_per_mm[X_AXIS]);
|
||||
#if ENABLED(SENSORLESS_HOMING)
|
||||
stepperX.sg_stall_value(X_HOMING_SENSITIVITY);
|
||||
#endif
|
||||
_TMC2130_INIT( X, planner.axis_steps_per_mm[X_AXIS]);
|
||||
#endif
|
||||
#if ENABLED(X2_IS_TMC2130)
|
||||
_TMC2130_INIT(X2, steps_per_mm[X_AXIS]);
|
||||
_TMC2130_INIT(X2, planner.axis_steps_per_mm[X_AXIS]);
|
||||
#endif
|
||||
#if ENABLED(Y_IS_TMC2130)
|
||||
_TMC2130_INIT( Y, steps_per_mm[Y_AXIS]);
|
||||
#if ENABLED(SENSORLESS_HOMING)
|
||||
stepperY.sg_stall_value(Y_HOMING_SENSITIVITY);
|
||||
#endif
|
||||
_TMC2130_INIT( Y, planner.axis_steps_per_mm[Y_AXIS]);
|
||||
#endif
|
||||
#if ENABLED(Y2_IS_TMC2130)
|
||||
_TMC2130_INIT(Y2, steps_per_mm[Y_AXIS]);
|
||||
_TMC2130_INIT(Y2, planner.axis_steps_per_mm[Y_AXIS]);
|
||||
#endif
|
||||
#if ENABLED(Z_IS_TMC2130)
|
||||
_TMC2130_INIT( Z, steps_per_mm[Z_AXIS]);
|
||||
_TMC2130_INIT( Z, planner.axis_steps_per_mm[Z_AXIS]);
|
||||
#endif
|
||||
#if ENABLED(Z2_IS_TMC2130)
|
||||
_TMC2130_INIT(Z2, steps_per_mm[Z_AXIS]);
|
||||
_TMC2130_INIT(Z2, planner.axis_steps_per_mm[Z_AXIS]);
|
||||
#endif
|
||||
#if ENABLED(E0_IS_TMC2130)
|
||||
_TMC2130_INIT(E0, steps_per_mm[E_AXIS]);
|
||||
_TMC2130_INIT(E0, planner.axis_steps_per_mm[E_AXIS]);
|
||||
#endif
|
||||
#if ENABLED(E1_IS_TMC2130)
|
||||
{ constexpr int extruder = 1; _TMC2130_INIT(E1, steps_per_mm[E_AXIS_N]); }
|
||||
{ constexpr int extruder = 1; _TMC2130_INIT(E1, planner.axis_steps_per_mm[E_AXIS_N]); }
|
||||
#endif
|
||||
#if ENABLED(E2_IS_TMC2130)
|
||||
{ constexpr int extruder = 2; _TMC2130_INIT(E2, steps_per_mm[E_AXIS_N]); }
|
||||
{ constexpr int extruder = 2; _TMC2130_INIT(E2, planner.axis_steps_per_mm[E_AXIS_N]); }
|
||||
#endif
|
||||
#if ENABLED(E3_IS_TMC2130)
|
||||
{ constexpr int extruder = 3; _TMC2130_INIT(E3, steps_per_mm[E_AXIS_N]); }
|
||||
{ constexpr int extruder = 3; _TMC2130_INIT(E3, planner.axis_steps_per_mm[E_AXIS_N]); }
|
||||
#endif
|
||||
#if ENABLED(E4_IS_TMC2130)
|
||||
{ constexpr int extruder = 4; _TMC2130_INIT(E4, steps_per_mm[E_AXIS_N]); }
|
||||
{ constexpr int extruder = 4; _TMC2130_INIT(E4, planner.axis_steps_per_mm[E_AXIS_N]); }
|
||||
#endif
|
||||
|
||||
TMC2130_ADV()
|
||||
}
|
||||
#endif // HAVE_TMC2130
|
||||
|
||||
//
|
||||
// TMC2208 Driver objects and inits
|
||||
//
|
||||
#if ENABLED(HAVE_TMC2208)
|
||||
|
||||
#include <SoftwareSerial.h>
|
||||
#include <HardwareSerial.h>
|
||||
#include <TMC2208Stepper.h>
|
||||
#include "planner.h"
|
||||
|
||||
#define _TMC2208_DEFINE_HARDWARE(ST) TMC2208Stepper stepper##ST(&ST##_HARDWARE_SERIAL)
|
||||
#define _TMC2208_DEFINE_SOFTWARE(ST) SoftwareSerial stepper##ST##_serial = SoftwareSerial(ST##_SERIAL_RX_PIN, ST##_SERIAL_TX_PIN); \
|
||||
TMC2208Stepper stepper##ST(&stepper##ST##_serial, ST##_SERIAL_RX_PIN > -1)
|
||||
|
||||
// Stepper objects of TMC2208 steppers used
|
||||
#if ENABLED(X_IS_TMC2208)
|
||||
#if defined(X_HARDWARE_SERIAL)
|
||||
_TMC2208_DEFINE_HARDWARE(X);
|
||||
#else
|
||||
_TMC2208_DEFINE_SOFTWARE(X);
|
||||
#endif
|
||||
#endif
|
||||
#if ENABLED(X2_IS_TMC2208)
|
||||
#if defined(X2_HARDWARE_SERIAL)
|
||||
_TMC2208_DEFINE_HARDWARE(X2);
|
||||
#else
|
||||
_TMC2208_DEFINE_SOFTWARE(X2);
|
||||
#endif
|
||||
#endif
|
||||
#if ENABLED(Y_IS_TMC2208)
|
||||
#if defined(Y_HARDWARE_SERIAL)
|
||||
_TMC2208_DEFINE_HARDWARE(Y);
|
||||
#else
|
||||
_TMC2208_DEFINE_SOFTWARE(Y);
|
||||
#endif
|
||||
#endif
|
||||
#if ENABLED(Y2_IS_TMC2208)
|
||||
#if defined(Y2_HARDWARE_SERIAL)
|
||||
_TMC2208_DEFINE_HARDWARE(Y2);
|
||||
#else
|
||||
_TMC2208_DEFINE_SOFTWARE(Y2);
|
||||
#endif
|
||||
#endif
|
||||
#if ENABLED(Z_IS_TMC2208)
|
||||
#if defined(Z_HARDWARE_SERIAL)
|
||||
_TMC2208_DEFINE_HARDWARE(Z);
|
||||
#else
|
||||
_TMC2208_DEFINE_SOFTWARE(Z);
|
||||
#endif
|
||||
#endif
|
||||
#if ENABLED(Z2_IS_TMC2208)
|
||||
#if defined(Z2_HARDWARE_SERIAL)
|
||||
_TMC2208_DEFINE_HARDWARE(Z2);
|
||||
#else
|
||||
_TMC2208_DEFINE_SOFTWARE(Z2);
|
||||
#endif
|
||||
#endif
|
||||
#if ENABLED(E0_IS_TMC2208)
|
||||
#if defined(E0_HARDWARE_SERIAL)
|
||||
_TMC2208_DEFINE_HARDWARE(E0);
|
||||
#else
|
||||
_TMC2208_DEFINE_SOFTWARE(E0);
|
||||
#endif
|
||||
#endif
|
||||
#if ENABLED(E1_IS_TMC2208)
|
||||
#if defined(E1_HARDWARE_SERIAL)
|
||||
_TMC2208_DEFINE_HARDWARE(E1);
|
||||
#else
|
||||
_TMC2208_DEFINE_SOFTWARE(E1);
|
||||
#endif
|
||||
#endif
|
||||
#if ENABLED(E2_IS_TMC2208)
|
||||
#if defined(E2_HARDWARE_SERIAL)
|
||||
_TMC2208_DEFINE_HARDWARE(E2);
|
||||
#else
|
||||
_TMC2208_DEFINE_SOFTWARE(E2);
|
||||
#endif
|
||||
#endif
|
||||
#if ENABLED(E3_IS_TMC2208)
|
||||
#if defined(E3_HARDWARE_SERIAL)
|
||||
_TMC2208_DEFINE_HARDWARE(E3);
|
||||
#else
|
||||
_TMC2208_DEFINE_SOFTWARE(E3);
|
||||
#endif
|
||||
#endif
|
||||
#if ENABLED(E4_IS_TMC2208)
|
||||
#if defined(E4_HARDWARE_SERIAL)
|
||||
_TMC2208_DEFINE_HARDWARE(E4);
|
||||
#else
|
||||
_TMC2208_DEFINE_SOFTWARE(E4);
|
||||
#endif
|
||||
#endif
|
||||
|
||||
void tmc2208_serial_begin() {
|
||||
#if ENABLED(X_IS_TMC2208) && defined(X_HARDWARE_SERIAL)
|
||||
X_HARDWARE_SERIAL.begin(250000);
|
||||
#endif
|
||||
#if ENABLED(X2_IS_TMC2208) && defined(X2_HARDWARE_SERIAL)
|
||||
X2_HARDWARE_SERIAL.begin(250000);
|
||||
#endif
|
||||
#if ENABLED(Y_IS_TMC2208) && defined(Y_HARDWARE_SERIAL)
|
||||
Y_HARDWARE_SERIAL.begin(250000);
|
||||
#endif
|
||||
#if ENABLED(Y2_IS_TMC2208) && defined(Y2_HARDWARE_SERIAL)
|
||||
Y2_HARDWARE_SERIAL.begin(250000);
|
||||
#endif
|
||||
#if ENABLED(Z_IS_TMC2208) && defined(Z_HARDWARE_SERIAL)
|
||||
Z_HARDWARE_SERIAL.begin(250000);
|
||||
#endif
|
||||
#if ENABLED(Z2_IS_TMC2208) && defined(Z2_HARDWARE_SERIAL)
|
||||
Z2_HARDWARE_SERIAL.begin(250000);
|
||||
#endif
|
||||
#if ENABLED(E0_IS_TMC2208) && defined(E0_HARDWARE_SERIAL)
|
||||
E0_HARDWARE_SERIAL.begin(250000);
|
||||
#endif
|
||||
#if ENABLED(E1_IS_TMC2208) && defined(E1_HARDWARE_SERIAL)
|
||||
E1_HARDWARE_SERIAL.begin(250000);
|
||||
#endif
|
||||
#if ENABLED(E2_IS_TMC2208) && defined(E2_HARDWARE_SERIAL)
|
||||
E2_HARDWARE_SERIAL.begin(250000);
|
||||
#endif
|
||||
#if ENABLED(E3_IS_TMC2208) && defined(E3_HARDWARE_SERIAL)
|
||||
E3_HARDWARE_SERIAL.begin(250000);
|
||||
#endif
|
||||
#if ENABLED(E4_IS_TMC2208) && defined(E4_HARDWARE_SERIAL)
|
||||
E4_HARDWARE_SERIAL.begin(250000);
|
||||
#endif
|
||||
}
|
||||
|
||||
// Use internal reference voltage for current calculations. This is the default.
|
||||
// Following values from Trinamic's spreadsheet with values for a NEMA17 (42BYGHW609)
|
||||
void tmc2208_init(TMC2208Stepper &st, const uint16_t microsteps, const uint32_t thrs, const float spmm) {
|
||||
st.pdn_disable(true); // Use UART
|
||||
st.mstep_reg_select(true); // Select microsteps with UART
|
||||
st.I_scale_analog(false);
|
||||
st.rms_current(st.getCurrent(), HOLD_MULTIPLIER, R_SENSE);
|
||||
st.microsteps(microsteps);
|
||||
st.blank_time(24);
|
||||
st.toff(5);
|
||||
st.intpol(INTERPOLATE);
|
||||
st.TPOWERDOWN(128); // ~2s until driver lowers to hold current
|
||||
st.hysterisis_start(3);
|
||||
st.hysterisis_end(2);
|
||||
#if ENABLED(STEALTHCHOP)
|
||||
st.pwm_lim(12);
|
||||
st.pwm_reg(8);
|
||||
st.pwm_autograd(1);
|
||||
st.pwm_autoscale(1);
|
||||
st.pwm_freq(1);
|
||||
st.pwm_grad(14);
|
||||
st.pwm_ofs(36);
|
||||
st.en_spreadCycle(false);
|
||||
#if ENABLED(HYBRID_THRESHOLD)
|
||||
st.TPWMTHRS(12650000UL*microsteps/(256*thrs*spmm));
|
||||
#else
|
||||
UNUSED(thrs);
|
||||
UNUSED(spmm);
|
||||
#endif
|
||||
#else
|
||||
st.en_spreadCycle(true);
|
||||
#endif
|
||||
st.GSTAT(0b111); // Clear
|
||||
delay(200);
|
||||
}
|
||||
|
||||
#define _TMC2208_INIT(ST, SPMM) tmc2208_init(stepper##ST, ST##_MICROSTEPS, ST##_HYBRID_THRESHOLD, SPMM)
|
||||
|
||||
void tmc2208_init() {
|
||||
#if ENABLED(X_IS_TMC2208)
|
||||
_TMC2208_INIT(X, planner.axis_steps_per_mm[X_AXIS]);
|
||||
#endif
|
||||
#if ENABLED(X2_IS_TMC2208)
|
||||
_TMC2208_INIT(X2, planner.axis_steps_per_mm[X_AXIS]);
|
||||
#endif
|
||||
#if ENABLED(Y_IS_TMC2208)
|
||||
_TMC2208_INIT(Y, planner.axis_steps_per_mm[Y_AXIS]);
|
||||
#endif
|
||||
#if ENABLED(Y2_IS_TMC2208)
|
||||
_TMC2208_INIT(Y2, planner.axis_steps_per_mm[Y_AXIS]);
|
||||
#endif
|
||||
#if ENABLED(Z_IS_TMC2208)
|
||||
_TMC2208_INIT(Z, planner.axis_steps_per_mm[Z_AXIS]);
|
||||
#endif
|
||||
#if ENABLED(Z2_IS_TMC2208)
|
||||
_TMC2208_INIT(Z2, planner.axis_steps_per_mm[Z_AXIS]);
|
||||
#endif
|
||||
#if ENABLED(E0_IS_TMC2208)
|
||||
_TMC2208_INIT(E0, planner.axis_steps_per_mm[E_AXIS]);
|
||||
#endif
|
||||
#if ENABLED(E1_IS_TMC2208)
|
||||
{ constexpr int extruder = 1; _TMC2208_INIT(E1, planner.axis_steps_per_mm[E_AXIS_N]); }
|
||||
#endif
|
||||
#if ENABLED(E2_IS_TMC2208)
|
||||
{ constexpr int extruder = 2; _TMC2208_INIT(E2, planner.axis_steps_per_mm[E_AXIS_N]); }
|
||||
#endif
|
||||
#if ENABLED(E3_IS_TMC2208)
|
||||
{ constexpr int extruder = 3; _TMC2208_INIT(E3, planner.axis_steps_per_mm[E_AXIS_N]); }
|
||||
#endif
|
||||
#if ENABLED(E4_IS_TMC2208)
|
||||
{ constexpr int extruder = 4; _TMC2208_INIT(E4, planner.axis_steps_per_mm[E_AXIS_N]); }
|
||||
#endif
|
||||
}
|
||||
#endif // HAVE_TMC2208
|
||||
|
||||
|
||||
//
|
||||
// L6470 Driver objects and inits
|
||||
|
||||
Reference in New Issue
Block a user