andrey
/
Marlin_FB4S
1
0
Fork 0
Code Issues Pull Requests Projects Releases Wiki Activity
Browse Source

Consolidate smart stepper driver initialization

pull/1/head
Scott Lahteine 7 years ago
parent
53362b81cc
commit
48d7036874
5 changed files with 173 additions and 146 deletions
Whitespace
Show all changes Ignore whitespace when comparing lines Ignore changes in amount of whitespace Ignore changes in whitespace at EOL
Split View
Diff Options
Show Stats Download Patch File Download Diff File
  1. 5
      Marlin/src/feature/power.cpp
  2. 11
      Marlin/src/gcode/control/M80_M81.cpp
  3. 25
      Marlin/src/module/stepper.cpp
  4. 201
      Marlin/src/module/stepper_indirection.cpp
  5. 77
      Marlin/src/module/stepper_indirection.h

5
Marlin/src/feature/power.cpp
View File

@ -88,6 +88,11 @@ void Power::check() {
void Power::power_on() {
lastPowerOn = millis();
PSU_PIN_ON();
#if HAS_TRINAMIC
delay(100); // Wait for power to settle
restore_stepper_drivers();
#endif
}
void Power::power_off() {

11
Marlin/src/gcode/control/M80_M81.cpp
View File

@ -76,14 +76,9 @@
OUT_WRITE(SUICIDE_PIN, HIGH);
#endif
#if ENABLED(HAVE_TMC2130)
delay(100);
tmc2130_init(); // Settings only stick when the driver has power
#endif
#if ENABLED(HAVE_TMC2208)
delay(100);
tmc2208_init();
#if DISABLED(AUTO_POWER_CONTROL)
delay(100); // Wait for power to settle
restore_stepper_drivers();
#endif
#if ENABLED(ULTIPANEL)

25
Marlin/src/module/stepper.cpp
View File

@ -921,31 +921,6 @@ void Stepper::init() {
microstep_init();
#endif
// Init TMC Steppers
#if ENABLED(HAVE_TMC26X)
tmc26x_init();
#endif
// Init TMC2130 Steppers
#if ENABLED(HAVE_TMC2130)
tmc2130_init();
#endif
// Init TMC2208 Steppers
#if ENABLED(HAVE_TMC2208)
tmc2208_init();
#endif
// TRAMS, TMC2130 and TMC2208 advanced settings
#if HAS_TRINAMIC
TMC_ADV()
#endif
// Init L6470 Steppers
#if ENABLED(HAVE_L6470DRIVER)
L6470_init();
#endif
// Init Dir Pins
#if HAS_X_DIR
X_DIR_INIT;

201
Marlin/src/module/stepper_indirection.cpp
View File

@ -47,83 +47,82 @@
#include <TMC26XStepper.h>
#endif
#define _TMC_DEFINE(ST) TMC26XStepper stepper##ST(200, ST##_ENABLE_PIN, ST##_STEP_PIN, ST##_DIR_PIN, ST##_MAX_CURRENT, ST##_SENSE_RESISTOR)
#define _TMC26X_DEFINE(ST) TMC26XStepper stepper##ST(200, ST##_ENABLE_PIN, ST##_STEP_PIN, ST##_DIR_PIN, ST##_MAX_CURRENT, ST##_SENSE_RESISTOR)
#if ENABLED(X_IS_TMC26X)
_TMC_DEFINE(X);
_TMC26X_DEFINE(X);
#endif
#if ENABLED(X2_IS_TMC26X)
_TMC_DEFINE(X2);
_TMC26X_DEFINE(X2);
#endif
#if ENABLED(Y_IS_TMC26X)
_TMC_DEFINE(Y);
_TMC26X_DEFINE(Y);
#endif
#if ENABLED(Y2_IS_TMC26X)
_TMC_DEFINE(Y2);
_TMC26X_DEFINE(Y2);
#endif
#if ENABLED(Z_IS_TMC26X)
_TMC_DEFINE(Z);
_TMC26X_DEFINE(Z);
#endif
#if ENABLED(Z2_IS_TMC26X)
_TMC_DEFINE(Z2);
_TMC26X_DEFINE(Z2);
#endif
#if ENABLED(E0_IS_TMC26X)
_TMC_DEFINE(E0);
_TMC26X_DEFINE(E0);
#endif
#if ENABLED(E1_IS_TMC26X)
_TMC_DEFINE(E1);
_TMC26X_DEFINE(E1);
#endif
#if ENABLED(E2_IS_TMC26X)
_TMC_DEFINE(E2);
_TMC26X_DEFINE(E2);
#endif
#if ENABLED(E3_IS_TMC26X)
_TMC_DEFINE(E3);
_TMC26X_DEFINE(E3);
#endif
#if ENABLED(E4_IS_TMC26X)
_TMC_DEFINE(E4);
_TMC26X_DEFINE(E4);
#endif
#define _TMC_INIT(A) do{ \
#define _TMC26X_INIT(A) do{ \
stepper##A.setMicrosteps(A##_MICROSTEPS); \
stepper##A.start(); \
}while(0)
void tmc26x_init() {
void tmc26x_init_to_defaults() {
#if ENABLED(X_IS_TMC26X)
_TMC_INIT(X);
_TMC26X_INIT(X);
#endif
#if ENABLED(X2_IS_TMC26X)
_TMC_INIT(X2);
_TMC26X_INIT(X2);
#endif
#if ENABLED(Y_IS_TMC26X)
_TMC_INIT(Y);
_TMC26X_INIT(Y);
#endif
#if ENABLED(Y2_IS_TMC26X)
_TMC_INIT(Y2);
_TMC26X_INIT(Y2);
#endif
#if ENABLED(Z_IS_TMC26X)
_TMC_INIT(Z);
_TMC26X_INIT(Z);
#endif
#if ENABLED(Z2_IS_TMC26X)
_TMC_INIT(Z2);
_TMC26X_INIT(Z2);
#endif
#if ENABLED(E0_IS_TMC26X)
_TMC_INIT(E0);
_TMC26X_INIT(E0);
#endif
#if ENABLED(E1_IS_TMC26X)
_TMC_INIT(E1);
_TMC26X_INIT(E1);
#endif
#if ENABLED(E2_IS_TMC26X)
_TMC_INIT(E2);
_TMC26X_INIT(E2);
#endif
#if ENABLED(E3_IS_TMC26X)
_TMC_INIT(E3);
_TMC26X_INIT(E3);
#endif
#if ENABLED(E4_IS_TMC26X)
_TMC_INIT(E4);
_TMC26X_INIT(E4);
#endif
}
#endif // HAVE_TMC26X
//
@ -180,9 +179,9 @@
// 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 mA, const uint16_t microsteps, const uint32_t thrs, const float spmm) {
st.begin();
st.setCurrent(st.getCurrent(), R_SENSE, HOLD_MULTIPLIER);
st.setCurrent(mA, R_SENSE, HOLD_MULTIPLIER);
st.microsteps(microsteps);
st.blank_time(24);
st.off_time(5); // Only enables the driver if used with stealthChop
@ -209,9 +208,9 @@
st.GSTAT(); // Clear GSTAT
}
#define _TMC2130_INIT(ST, SPMM) tmc2130_init(stepper##ST, ST##_MICROSTEPS, ST##_HYBRID_THRESHOLD, SPMM)
#define _TMC2130_INIT(ST, SPMM) tmc2130_init(stepper##ST, ST##_CURRENT, ST##_MICROSTEPS, ST##_HYBRID_THRESHOLD, SPMM)
void tmc2130_init() {
void tmc2130_init_to_defaults() {
#if ENABLED(X_IS_TMC2130)
_TMC2130_INIT( X, planner.axis_steps_per_mm[X_AXIS]);
#endif
@ -234,34 +233,45 @@
_TMC2130_INIT(E0, planner.axis_steps_per_mm[E_AXIS]);
#endif
#if ENABLED(E1_IS_TMC2130)
_TMC2130_INIT(E1, planner.axis_steps_per_mm[E_AXIS
#if ENABLED(DISTINCT_E_FACTORS)
+ 1
#endif
]);
{ constexpr int extruder = 1; _TMC2130_INIT(E1, planner.axis_steps_per_mm[E_AXIS_N]); }
#endif
#if ENABLED(E2_IS_TMC2130)
_TMC2130_INIT(E2, planner.axis_steps_per_mm[E_AXIS
#if ENABLED(DISTINCT_E_FACTORS)
+ 2
#endif
]);
{ constexpr int extruder = 2; _TMC2130_INIT(E2, planner.axis_steps_per_mm[E_AXIS_N]); }
#endif
#if ENABLED(E3_IS_TMC2130)
_TMC2130_INIT(E3, planner.axis_steps_per_mm[E_AXIS
#if ENABLED(DISTINCT_E_FACTORS)
+ 3
#endif
]);
{ constexpr int extruder = 3; _TMC2130_INIT(E3, planner.axis_steps_per_mm[E_AXIS_N]); }
#endif
#if ENABLED(E4_IS_TMC2130)
_TMC2130_INIT(E4, planner.axis_steps_per_mm[E_AXIS
#if ENABLED(DISTINCT_E_FACTORS)
+ 4
#endif
]);
{ constexpr int extruder = 4; _TMC2130_INIT(E4, planner.axis_steps_per_mm[E_AXIS_N]); }
#endif
#if ENABLED(SENSORLESS_HOMING)
#define TMC_INIT_SGT(P,Q) stepper##Q.sgt(P##_HOMING_SENSITIVITY);
#ifdef X_HOMING_SENSITIVITY
#if ENABLED(X_IS_TMC2130) || ENABLED(IS_TRAMS)
stepperX.sgt(X_HOMING_SENSITIVITY);
#endif
#if ENABLED(X2_IS_TMC2130)
stepperX2.sgt(X_HOMING_SENSITIVITY);
#endif
#endif
#ifdef Y_HOMING_SENSITIVITY
#if ENABLED(Y_IS_TMC2130) || ENABLED(IS_TRAMS)
stepperY.sgt(Y_HOMING_SENSITIVITY);
#endif
#if ENABLED(Y2_IS_TMC2130)
stepperY2.sgt(Y_HOMING_SENSITIVITY);
#endif
#endif
#ifdef Z_HOMING_SENSITIVITY
#if ENABLED(Z_IS_TMC2130) || ENABLED(IS_TRAMS)
stepperZ.sgt(Z_HOMING_SENSITIVITY);
#endif
#if ENABLED(Z2_IS_TMC2130)
stepperZ2.sgt(Z_HOMING_SENSITIVITY);
#endif
#endif
#endif
}
#endif // HAVE_TMC2130
@ -396,11 +406,11 @@
// 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) {
void tmc2208_init(TMC2208Stepper &st, const uint16_t mA, 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.rms_current(mA, HOLD_MULTIPLIER, R_SENSE);
st.microsteps(microsteps);
st.blank_time(24);
st.toff(5);
@ -430,9 +440,9 @@
delay(200);
}
#define _TMC2208_INIT(ST, SPMM) tmc2208_init(stepper##ST, ST##_MICROSTEPS, ST##_HYBRID_THRESHOLD, SPMM)
#define _TMC2208_INIT(ST, SPMM) tmc2208_init(stepper##ST, ST##_CURRENT, ST##_MICROSTEPS, ST##_HYBRID_THRESHOLD, SPMM)
void tmc2208_init() {
void tmc2208_init_to_defaults() {
#if ENABLED(X_IS_TMC2208)
_TMC2208_INIT(X, planner.axis_steps_per_mm[X_AXIS]);
#endif
@ -455,36 +465,76 @@
_TMC2208_INIT(E0, planner.axis_steps_per_mm[E_AXIS]);
#endif
#if ENABLED(E1_IS_TMC2208)
_TMC2208_INIT(E1, planner.axis_steps_per_mm[E_AXIS
#if ENABLED(DISTINCT_E_FACTORS)
+ 1
#endif
]);
{ constexpr int extruder = 1; _TMC2208_INIT(E1, planner.axis_steps_per_mm[E_AXIS_N]); }
#endif
#if ENABLED(E2_IS_TMC2208)
_TMC2208_INIT(E2, planner.axis_steps_per_mm[E_AXIS
#if ENABLED(DISTINCT_E_FACTORS)
+ 2
#endif
]);
{ constexpr int extruder = 2; _TMC2208_INIT(E2, planner.axis_steps_per_mm[E_AXIS_N]); }
#endif
#if ENABLED(E3_IS_TMC2208)
_TMC2208_INIT(E3, planner.axis_steps_per_mm[E_AXIS
#if ENABLED(DISTINCT_E_FACTORS)
+ 3
#endif
]);
{ constexpr int extruder = 3; _TMC2208_INIT(E3, planner.axis_steps_per_mm[E_AXIS_N]); }
#endif
#if ENABLED(E4_IS_TMC2208)
_TMC2208_INIT(E4, planner.axis_steps_per_mm[E_AXIS
#if ENABLED(DISTINCT_E_FACTORS)
+ 4
#endif
]);
{ constexpr int extruder = 4; _TMC2208_INIT(E4, planner.axis_steps_per_mm[E_AXIS_N]); }
#endif
}
#endif // HAVE_TMC2208
void restore_stepper_drivers() {
#if X_IS_TRINAMIC
stepperX.push();
#endif
#if X2_IS_TRINAMIC
stepperX2.push();
#endif
#if Y_IS_TRINAMIC
stepperY.push();
#endif
#if Y2_IS_TRINAMIC
stepperY2.push();
#endif
#if Z_IS_TRINAMIC
stepperZ.push();
#endif
#if Z2_IS_TRINAMIC
stepperZ2.push();
#endif
#if E0_IS_TRINAMIC
stepperE0.push();
#endif
#if E1_IS_TRINAMIC
stepperE1.push();
#endif
#if E2_IS_TRINAMIC
stepperE2.push();
#endif
#if E3_IS_TRINAMIC
stepperE3.push();
#endif
#if E4_IS_TRINAMIC
stepperE4.push();
#endif
}
void reset_stepper_drivers() {
#if ENABLED(HAVE_TMC26X)
tmc26x_init_to_defaults();
#endif
#if ENABLED(HAVE_TMC2130)
delay(100);
tmc2130_init_to_defaults();
#endif
#if ENABLED(HAVE_TMC2208)
delay(100);
tmc2208_init_to_defaults();
#endif
#ifdef TMC_ADV
TMC_ADV()
#endif
#if ENABLED(HAVE_L6470DRIVER)
L6470_init_to_defaults();
#endif
}
//
// L6470 Driver objects and inits
//
@ -538,7 +588,7 @@
stepper##A.setStallCurrent(A##_STALLCURRENT); \
}while(0)
void L6470_init() {
void L6470_init_to_defaults() {
#if ENABLED(X_IS_L6470)
_L6470_INIT(X);
#endif
@ -575,4 +625,3 @@
}
#endif // HAVE_L6470DRIVER

77
Marlin/src/module/stepper_indirection.h
View File

@ -54,29 +54,32 @@
#else
#include <TMC26XStepper.h>
#endif
void tmc26x_init();
void tmc26x_init_to_defaults();
#endif
#if ENABLED(HAVE_TMC2130)
#include <TMC2130Stepper.h>
void tmc2130_init();
void tmc2130_init_to_defaults();
#endif
#if ENABLED(HAVE_TMC2208)
#include <TMC2208Stepper.h>
void tmc2208_serial_begin();
void tmc2208_init();
void tmc2208_init_to_defaults();
#endif
// L6470 has STEP on normal pins, but DIR/ENABLE via SPI
#if ENABLED(HAVE_L6470DRIVER)
#include <SPI.h>
#include <L6470.h>
void L6470_init();
void L6470_init_to_defaults();
#endif
void restore_stepper_drivers(); // Called by PSU_ON
void reset_stepper_drivers(); // Called by settings.load / settings.reset
// X Stepper
#if ENABLED(HAVE_L6470DRIVER) && ENABLED(X_IS_L6470)
#if ENABLED(X_IS_L6470)
extern L6470 stepperX;
#define X_ENABLE_INIT NOOP
#define X_ENABLE_WRITE(STATE) do{ if (STATE) stepperX.Step_Clock(stepperX.getStatus() & STATUS_HIZ); else stepperX.softFree(); }while(0)
@ -91,9 +94,9 @@
#define X_ENABLE_WRITE(STATE) stepperX.setEnabled(STATE)
#define X_ENABLE_READ stepperX.isEnabled()
#else
#if ENABLED(HAVE_TMC2130) && ENABLED(X_IS_TMC2130)
#if ENABLED(X_IS_TMC2130)
extern TMC2130Stepper stepperX;
#elif ENABLED(HAVE_TMC2208) && ENABLED(X_IS_TMC2208)
#elif ENABLED(X_IS_TMC2208)
extern TMC2208Stepper stepperX;
#endif
#define X_ENABLE_INIT SET_OUTPUT(X_ENABLE_PIN)
@ -109,7 +112,7 @@
#define X_STEP_READ READ(X_STEP_PIN)
// Y Stepper
#if ENABLED(HAVE_L6470DRIVER) && ENABLED(Y_IS_L6470)
#if ENABLED(Y_IS_L6470)
extern L6470 stepperY;
#define Y_ENABLE_INIT NOOP
#define Y_ENABLE_WRITE(STATE) do{ if (STATE) stepperY.Step_Clock(stepperY.getStatus() & STATUS_HIZ); else stepperY.softFree(); }while(0)
@ -124,9 +127,9 @@
#define Y_ENABLE_WRITE(STATE) stepperY.setEnabled(STATE)
#define Y_ENABLE_READ stepperY.isEnabled()
#else
#if ENABLED(HAVE_TMC2130) && ENABLED(Y_IS_TMC2130)
#if ENABLED(Y_IS_TMC2130)
extern TMC2130Stepper stepperY;
#elif ENABLED(HAVE_TMC2208) && ENABLED(Y_IS_TMC2208)
#elif ENABLED(Y_IS_TMC2208)
extern TMC2208Stepper stepperY;
#endif
#define Y_ENABLE_INIT SET_OUTPUT(Y_ENABLE_PIN)
@ -142,7 +145,7 @@
#define Y_STEP_READ READ(Y_STEP_PIN)
// Z Stepper
#if ENABLED(HAVE_L6470DRIVER) && ENABLED(Z_IS_L6470)
#if ENABLED(Z_IS_L6470)
extern L6470 stepperZ;
#define Z_ENABLE_INIT NOOP
#define Z_ENABLE_WRITE(STATE) do{ if (STATE) stepperZ.Step_Clock(stepperZ.getStatus() & STATUS_HIZ); else stepperZ.softFree(); }while(0)
@ -157,9 +160,9 @@
#define Z_ENABLE_WRITE(STATE) stepperZ.setEnabled(STATE)
#define Z_ENABLE_READ stepperZ.isEnabled()
#else
#if ENABLED(HAVE_TMC2130) && ENABLED(Z_IS_TMC2130)
#if ENABLED(Z_IS_TMC2130)
extern TMC2130Stepper stepperZ;
#elif ENABLED(HAVE_TMC2208) && ENABLED(Z_IS_TMC2208)
#elif ENABLED(Z_IS_TMC2208)
extern TMC2208Stepper stepperZ;
#endif
#define Z_ENABLE_INIT SET_OUTPUT(Z_ENABLE_PIN)
@ -176,7 +179,7 @@
// X2 Stepper
#if HAS_X2_ENABLE
#if ENABLED(HAVE_L6470DRIVER) && ENABLED(X2_IS_L6470)
#if ENABLED(X2_IS_L6470)
extern L6470 stepperX2;
#define X2_ENABLE_INIT NOOP
#define X2_ENABLE_WRITE(STATE) do{ if (STATE) stepperX2.Step_Clock(stepperX2.getStatus() & STATUS_HIZ); else stepperX2.softFree(); }while(0)
@ -191,9 +194,9 @@
#define X2_ENABLE_WRITE(STATE) stepperX2.setEnabled(STATE)
#define X2_ENABLE_READ stepperX2.isEnabled()
#else
#if ENABLED(HAVE_TMC2130) && ENABLED(X2_IS_TMC2130)
#if ENABLED(X2_IS_TMC2130)
extern TMC2130Stepper stepperX2;
#elif ENABLED(HAVE_TMC2208) && ENABLED(X2_IS_TMC2208)
#elif ENABLED(X2_IS_TMC2208)
extern TMC2208Stepper stepperX2;
#endif
#define X2_ENABLE_INIT SET_OUTPUT(X2_ENABLE_PIN)
@ -211,7 +214,7 @@
// Y2 Stepper
#if HAS_Y2_ENABLE
#if ENABLED(HAVE_L6470DRIVER) && ENABLED(Y2_IS_L6470)
#if ENABLED(Y2_IS_L6470)
extern L6470 stepperY2;
#define Y2_ENABLE_INIT NOOP
#define Y2_ENABLE_WRITE(STATE) do{ if (STATE) stepperY2.Step_Clock(stepperY2.getStatus() & STATUS_HIZ); else stepperY2.softFree(); }while(0)
@ -226,9 +229,9 @@
#define Y2_ENABLE_WRITE(STATE) stepperY2.setEnabled(STATE)
#define Y2_ENABLE_READ stepperY2.isEnabled()
#else
#if ENABLED(HAVE_TMC2130) && ENABLED(Y2_IS_TMC2130)
#if ENABLED(Y2_IS_TMC2130)
extern TMC2130Stepper stepperY2;
#elif ENABLED(HAVE_TMC2208) && ENABLED(Y2_IS_TMC2208)
#elif ENABLED(Y2_IS_TMC2208)
extern TMC2208Stepper stepperY2;
#endif
#define Y2_ENABLE_INIT SET_OUTPUT(Y2_ENABLE_PIN)
@ -246,7 +249,7 @@
// Z2 Stepper
#if HAS_Z2_ENABLE
#if ENABLED(HAVE_L6470DRIVER) && ENABLED(Z2_IS_L6470)
#if ENABLED(Z2_IS_L6470)
extern L6470 stepperZ2;
#define Z2_ENABLE_INIT NOOP
#define Z2_ENABLE_WRITE(STATE) do{ if (STATE) stepperZ2.Step_Clock(stepperZ2.getStatus() & STATUS_HIZ); else stepperZ2.softFree(); }while(0)
@ -261,9 +264,9 @@
#define Z2_ENABLE_WRITE(STATE) stepperZ2.setEnabled(STATE)
#define Z2_ENABLE_READ stepperZ2.isEnabled()
#else
#if ENABLED(HAVE_TMC2130) && ENABLED(Z2_IS_TMC2130)
#if ENABLED(Z2_IS_TMC2130)
extern TMC2130Stepper stepperZ2;
#elif ENABLED(HAVE_TMC2208) && ENABLED(Z2_IS_TMC2208)
#elif ENABLED(Z2_IS_TMC2208)
extern TMC2208Stepper stepperZ2;
#endif
#define Z2_ENABLE_INIT SET_OUTPUT(Z2_ENABLE_PIN)
@ -280,7 +283,7 @@
#endif
// E0 Stepper
#if ENABLED(HAVE_L6470DRIVER) && ENABLED(E0_IS_L6470)
#if ENABLED(E0_IS_L6470)
extern L6470 stepperE0;
#define E0_ENABLE_INIT NOOP
#define E0_ENABLE_WRITE(STATE) do{ if (STATE) stepperE0.Step_Clock(stepperE0.getStatus() & STATUS_HIZ); else stepperE0.softFree(); }while(0)
@ -295,9 +298,9 @@
#define E0_ENABLE_WRITE(STATE) stepperE0.setEnabled(STATE)
#define E0_ENABLE_READ stepperE0.isEnabled()
#else
#if ENABLED(HAVE_TMC2130) && ENABLED(E0_IS_TMC2130)
#if ENABLED(E0_IS_TMC2130)
extern TMC2130Stepper stepperE0;
#elif ENABLED(HAVE_TMC2208) && ENABLED(E0_IS_TMC2208)
#elif ENABLED(E0_IS_TMC2208)
extern TMC2208Stepper stepperE0;
#endif
#define E0_ENABLE_INIT SET_OUTPUT(E0_ENABLE_PIN)
@ -313,7 +316,7 @@
#define E0_STEP_READ READ(E0_STEP_PIN)
// E1 Stepper
#if ENABLED(HAVE_L6470DRIVER) && ENABLED(E1_IS_L6470)
#if ENABLED(E1_IS_L6470)
extern L6470 stepperE1;
#define E1_ENABLE_INIT NOOP
#define E1_ENABLE_WRITE(STATE) do{ if (STATE) stepperE1.Step_Clock(stepperE1.getStatus() & STATUS_HIZ); else stepperE1.softFree(); }while(0)
@ -328,9 +331,9 @@
#define E1_ENABLE_WRITE(STATE) stepperE1.setEnabled(STATE)
#define E1_ENABLE_READ stepperE1.isEnabled()
#else
#if ENABLED(HAVE_TMC2130) && ENABLED(E1_IS_TMC2130)
#if ENABLED(E1_IS_TMC2130)
extern TMC2130Stepper stepperE1;
#elif ENABLED(HAVE_TMC2208) && ENABLED(E1_IS_TMC2208)
#elif ENABLED(E1_IS_TMC2208)
extern TMC2208Stepper stepperE1;
#endif
#define E1_ENABLE_INIT SET_OUTPUT(E1_ENABLE_PIN)
@ -346,7 +349,7 @@
#define E1_STEP_READ READ(E1_STEP_PIN)
// E2 Stepper
#if ENABLED(HAVE_L6470DRIVER) && ENABLED(E2_IS_L6470)
#if ENABLED(E2_IS_L6470)
extern L6470 stepperE2;
#define E2_ENABLE_INIT NOOP
#define E2_ENABLE_WRITE(STATE) do{ if (STATE) stepperE2.Step_Clock(stepperE2.getStatus() & STATUS_HIZ); else stepperE2.softFree(); }while(0)
@ -361,9 +364,9 @@
#define E2_ENABLE_WRITE(STATE) stepperE2.setEnabled(STATE)
#define E2_ENABLE_READ stepperE2.isEnabled()
#else
#if ENABLED(HAVE_TMC2130) && ENABLED(E2_IS_TMC2130)
#if ENABLED(E2_IS_TMC2130)
extern TMC2130Stepper stepperE2;
#elif ENABLED(HAVE_TMC2208) && ENABLED(E2_IS_TMC2208)
#elif ENABLED(E2_IS_TMC2208)
extern TMC2208Stepper stepperE2;
#endif
#define E2_ENABLE_INIT SET_OUTPUT(E2_ENABLE_PIN)
@ -379,7 +382,7 @@
#define E2_STEP_READ READ(E2_STEP_PIN)
// E3 Stepper
#if ENABLED(HAVE_L6470DRIVER) && ENABLED(E3_IS_L6470)
#if ENABLED(E3_IS_L6470)
extern L6470 stepperE3;
#define E3_ENABLE_INIT NOOP
#define E3_ENABLE_WRITE(STATE) do{ if (STATE) stepperE3.Step_Clock(stepperE3.getStatus() & STATUS_HIZ); else stepperE3.softFree(); }while(0)
@ -394,9 +397,9 @@
#define E3_ENABLE_WRITE(STATE) stepperE3.setEnabled(STATE)
#define E3_ENABLE_READ stepperE3.isEnabled()
#else
#if ENABLED(HAVE_TMC2130) && ENABLED(E3_IS_TMC2130)
#if ENABLED(E3_IS_TMC2130)
extern TMC2130Stepper stepperE3;
#elif ENABLED(HAVE_TMC2208) && ENABLED(E3_IS_TMC2208)
#elif ENABLED(E3_IS_TMC2208)
extern TMC2208Stepper stepperE3;
#endif
#define E3_ENABLE_INIT SET_OUTPUT(E3_ENABLE_PIN)
@ -412,7 +415,7 @@
#define E3_STEP_READ READ(E3_STEP_PIN)
// E4 Stepper
#if ENABLED(HAVE_L6470DRIVER) && ENABLED(E4_IS_L6470)
#if ENABLED(E4_IS_L6470)
extern L6470 stepperE4;
#define E4_ENABLE_INIT NOOP
#define E4_ENABLE_WRITE(STATE) do{ if (STATE) stepperE4.Step_Clock(stepperE4.getStatus() & STATUS_HIZ); else stepperE4.softFree(); }while(0)
@ -427,9 +430,9 @@
#define E4_ENABLE_WRITE(STATE) stepperE4.setEnabled(STATE)
#define E4_ENABLE_READ stepperE4.isEnabled()
#else
#if ENABLED(HAVE_TMC2130) && ENABLED(E4_IS_TMC2130)
#if ENABLED(E4_IS_TMC2130)
extern TMC2130Stepper stepperE4;
#elif ENABLED(HAVE_TMC2208) && ENABLED(E4_IS_TMC2208)
#elif ENABLED(E4_IS_TMC2208)
extern TMC2208Stepper stepperE4;
#endif
#define E4_ENABLE_INIT SET_OUTPUT(E4_ENABLE_PIN)

Write Preview
Loading…
Cancel
Save