My Marlin configs for Fabrikator Mini and CTC i3 Pro B
You can not select more than 25 topics Topics must start with a letter or number, can include dashes ('-') and can be up to 35 characters long.

stepper_indirection.h 31KB

123456789101112131415161718192021222324252627282930313233343536373839404142434445464748495051525354555657585960616263646566676869707172737475767778798081828384858687888990919293949596979899100101102103104105106107108109110111112113114115116117118119120121122123124125126127128129130131132133134135136137138139140141142143144145146147148149150151152153154155156157158159160161162163164165166167168169170171172173174175176177178179180181182183184185186187188189190191192193194195196197198199200201202203204205206207208209210211212213214215216217218219220221222223224225226227228229230231232233234235236237238239240241242243244245246247248249250251252253254255256257258259260261262263264265266267268269270271272273274275276277278279280281282283284285286287288289290291292293294295296297298299300301302303304305306307308309310311312313314315316317318319320321322323324325326327328329330331332333334335336337338339340341342343344345346347348349350351352353354355356357358359360361362363364365366367368369370371372373374375376377378379380381382383384385386387388389390391392393394395396397398399400401402403404405406407408409410411412413414415416417418419420421422423424425426427428429430431432433434435436437438439440441442443444445446447448449450451452453454455456457458459460461462463464465466467468469470471472473474475476477478479480481482483484485486487488489490491492493494495496497498499500501502503504505506507508509510511512513514515516517518519520521522523524525526527528529530531532533534535536537538539540541542543544545546547548549550551552553554555556557558559560561562563564565566567568569570571572573574575576577578579580581582583584585586587588589590591592593594595596597598599600601602603604605606607608609610611612613614615616617618619620621622623624625626627628629630631632633634635636637638639640641642643644645646647648649650651652653654655656657658659660661662663664665666667668669670671672673674675676677678679680681682683684685686687688689690691692693694695696697698699700701702703704705706707708709710711712713714715716717718719720721722723724725726727
  1. /**
  2. * Marlin 3D Printer Firmware
  3. * Copyright (c) 2019 MarlinFirmware [https://github.com/MarlinFirmware/Marlin]
  4. *
  5. * Based on Sprinter and grbl.
  6. * Copyright (c) 2011 Camiel Gubbels / Erik van der Zalm
  7. *
  8. * This program is free software: you can redistribute it and/or modify
  9. * it under the terms of the GNU General Public License as published by
  10. * the Free Software Foundation, either version 3 of the License, or
  11. * (at your option) any later version.
  12. *
  13. * This program is distributed in the hope that it will be useful,
  14. * but WITHOUT ANY WARRANTY; without even the implied warranty of
  15. * MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE. See the
  16. * GNU General Public License for more details.
  17. *
  18. * You should have received a copy of the GNU General Public License
  19. * along with this program. If not, see <http://www.gnu.org/licenses/>.
  20. *
  21. */
  22. #pragma once
  23. /**
  24. * stepper_indirection.h
  25. *
  26. * Stepper motor driver indirection to allow some stepper functions to
  27. * be done via SPI/I2c instead of direct pin manipulation.
  28. *
  29. * Copyright (c) 2015 Dominik Wenger
  30. */
  31. #include "../inc/MarlinConfig.h"
  32. // TMC26X drivers have STEP/DIR on normal pins, but ENABLE via SPI
  33. #if HAS_DRIVER(TMC26X)
  34. #include <SPI.h>
  35. #if defined(STM32GENERIC) && defined(STM32F7)
  36. #include "../HAL/HAL_STM32_F4_F7/STM32F7/TMC2660.h"
  37. #else
  38. #include <TMC26XStepper.h>
  39. #endif
  40. void tmc26x_init_to_defaults();
  41. #endif
  42. #if HAS_TRINAMIC
  43. #include <TMCStepper.h>
  44. #include "../feature/tmc_util.h"
  45. #if TMCSTEPPER_VERSION < 0x000405
  46. #error "Update TMCStepper library to 0.4.5 or newer."
  47. #endif
  48. #define ____TMC_CLASS(MODEL, A, I, E) TMCMarlin<TMC##MODEL##Stepper, A, I, E>
  49. #define ___TMC_CLASS(MODEL, A, I, E) ____TMC_CLASS(MODEL, A, I, E)
  50. #define __TMC_CLASS(MODEL, A, I, E) ___TMC_CLASS(_##MODEL, A, I, E)
  51. #define _TMC_CLASS(MODEL, L, E) __TMC_CLASS(MODEL, L, E)
  52. #define TMC_CLASS(ST, A) _TMC_CLASS(ST##_DRIVER_TYPE, TMC_##ST##_LABEL, A##_AXIS)
  53. #if ENABLED(DISTINCT_E_FACTORS)
  54. #define TMC_CLASS_E(I) TMC_CLASS(E##I, E##I)
  55. #else
  56. #define TMC_CLASS_E(I) TMC_CLASS(E##I, E)
  57. #endif
  58. typedef struct {
  59. uint8_t toff;
  60. int8_t hend;
  61. uint8_t hstrt;
  62. } chopper_timing_t;
  63. static constexpr chopper_timing_t chopper_timing = CHOPPER_TIMING;
  64. #if HAS_TMC220x
  65. void tmc_serial_begin();
  66. #endif
  67. #endif
  68. // L6470 has STEP on normal pins, but DIR/ENABLE via SPI
  69. #if HAS_DRIVER(L6470)
  70. #include "L6470/L6470_Marlin.h"
  71. #define L6470_WRITE_DIR_COMMAND(STATE,Q) do{ L6470_dir_commands[Q] = (STATE ? dSPIN_STEP_CLOCK_REV : dSPIN_STEP_CLOCK_FWD); }while(0)
  72. #endif
  73. void restore_stepper_drivers(); // Called by PSU_ON
  74. void reset_stepper_drivers(); // Called by settings.load / settings.reset
  75. #define AXIS_HAS_SQUARE_WAVE(A) (AXIS_IS_TMC(A) && ENABLED(SQUARE_WAVE_STEPPING))
  76. // X Stepper
  77. #if AXIS_DRIVER_TYPE_X(L6470)
  78. extern L6470 stepperX;
  79. #define X_ENABLE_INIT NOOP
  80. #define X_ENABLE_WRITE(STATE) NOOP
  81. #define X_ENABLE_READ() (stepperX.getStatus() & STATUS_HIZ)
  82. #define X_DIR_INIT NOOP
  83. #define X_DIR_WRITE(STATE) L6470_WRITE_DIR_COMMAND(STATE,X)
  84. #define X_DIR_READ() (stepperX.getStatus() & STATUS_DIR)
  85. #else
  86. #if AXIS_IS_TMC(X)
  87. extern TMC_CLASS(X, X) stepperX;
  88. #endif
  89. #if AXIS_DRIVER_TYPE_X(TMC26X)
  90. extern TMC26XStepper stepperX;
  91. #define X_ENABLE_INIT NOOP
  92. #define X_ENABLE_WRITE(STATE) stepperX.setEnabled(STATE)
  93. #define X_ENABLE_READ() stepperX.isEnabled()
  94. #elif ENABLED(SOFTWARE_DRIVER_ENABLE) && AXIS_IS_TMC(X)
  95. #define X_ENABLE_INIT NOOP
  96. #define X_ENABLE_WRITE(STATE) stepperX.toff((STATE)==X_ENABLE_ON ? chopper_timing.toff : 0)
  97. #define X_ENABLE_READ() stepperX.isEnabled()
  98. #else
  99. #define X_ENABLE_INIT SET_OUTPUT(X_ENABLE_PIN)
  100. #define X_ENABLE_WRITE(STATE) WRITE(X_ENABLE_PIN,STATE)
  101. #define X_ENABLE_READ() READ(X_ENABLE_PIN)
  102. #endif
  103. #define X_DIR_INIT SET_OUTPUT(X_DIR_PIN)
  104. #define X_DIR_WRITE(STATE) WRITE(X_DIR_PIN,STATE)
  105. #define X_DIR_READ() READ(X_DIR_PIN)
  106. #endif
  107. #define X_STEP_INIT SET_OUTPUT(X_STEP_PIN)
  108. #if AXIS_HAS_SQUARE_WAVE(X)
  109. #define X_STEP_WRITE(STATE) do{ if(STATE) TOGGLE(X_STEP_PIN); }while(0)
  110. #else
  111. #define X_STEP_WRITE(STATE) WRITE(X_STEP_PIN,STATE)
  112. #endif
  113. #define X_STEP_READ READ(X_STEP_PIN)
  114. // Y Stepper
  115. #if AXIS_DRIVER_TYPE_Y(L6470)
  116. extern L6470 stepperY;
  117. #define Y_ENABLE_INIT NOOP
  118. #define Y_ENABLE_WRITE(STATE) NOOP
  119. #define Y_ENABLE_READ() (stepperY.getStatus() & STATUS_HIZ)
  120. #define Y_DIR_INIT NOOP
  121. #define Y_DIR_WRITE(STATE) L6470_WRITE_DIR_COMMAND(STATE,Y)
  122. #define Y_DIR_READ() (stepperY.getStatus() & STATUS_DIR)
  123. #else
  124. #if AXIS_IS_TMC(Y)
  125. extern TMC_CLASS(Y, Y) stepperY;
  126. #endif
  127. #if AXIS_DRIVER_TYPE_Y(TMC26X)
  128. extern TMC26XStepper stepperY;
  129. #define Y_ENABLE_INIT NOOP
  130. #define Y_ENABLE_WRITE(STATE) stepperY.setEnabled(STATE)
  131. #define Y_ENABLE_READ() stepperY.isEnabled()
  132. #elif ENABLED(SOFTWARE_DRIVER_ENABLE) && AXIS_IS_TMC(Y)
  133. #define Y_ENABLE_INIT NOOP
  134. #define Y_ENABLE_WRITE(STATE) stepperY.toff((STATE)==Y_ENABLE_ON ? chopper_timing.toff : 0)
  135. #define Y_ENABLE_READ() stepperY.isEnabled()
  136. #else
  137. #define Y_ENABLE_INIT SET_OUTPUT(Y_ENABLE_PIN)
  138. #define Y_ENABLE_WRITE(STATE) WRITE(Y_ENABLE_PIN,STATE)
  139. #define Y_ENABLE_READ() READ(Y_ENABLE_PIN)
  140. #endif
  141. #define Y_DIR_INIT SET_OUTPUT(Y_DIR_PIN)
  142. #define Y_DIR_WRITE(STATE) WRITE(Y_DIR_PIN,STATE)
  143. #define Y_DIR_READ() READ(Y_DIR_PIN)
  144. #endif
  145. #define Y_STEP_INIT SET_OUTPUT(Y_STEP_PIN)
  146. #if AXIS_HAS_SQUARE_WAVE(Y)
  147. #define Y_STEP_WRITE(STATE) do{ if (STATE) TOGGLE(Y_STEP_PIN); }while(0)
  148. #else
  149. #define Y_STEP_WRITE(STATE) WRITE(Y_STEP_PIN,STATE)
  150. #endif
  151. #define Y_STEP_READ READ(Y_STEP_PIN)
  152. // Z Stepper
  153. #if AXIS_DRIVER_TYPE_Z(L6470)
  154. extern L6470 stepperZ;
  155. #define Z_ENABLE_INIT NOOP
  156. #define Z_ENABLE_WRITE(STATE) NOOP
  157. #define Z_ENABLE_READ() (stepperZ.getStatus() & STATUS_HIZ)
  158. #define Z_DIR_INIT NOOP
  159. #define Z_DIR_WRITE(STATE) L6470_WRITE_DIR_COMMAND(STATE,Z)
  160. #define Z_DIR_READ() (stepperZ.getStatus() & STATUS_DIR)
  161. #else
  162. #if AXIS_IS_TMC(Z)
  163. extern TMC_CLASS(Z, Z) stepperZ;
  164. #endif
  165. #if AXIS_DRIVER_TYPE_Z(TMC26X)
  166. extern TMC26XStepper stepperZ;
  167. #define Z_ENABLE_INIT NOOP
  168. #define Z_ENABLE_WRITE(STATE) stepperZ.setEnabled(STATE)
  169. #define Z_ENABLE_READ() stepperZ.isEnabled()
  170. #elif ENABLED(SOFTWARE_DRIVER_ENABLE) && AXIS_IS_TMC(Z)
  171. #define Z_ENABLE_INIT NOOP
  172. #define Z_ENABLE_WRITE(STATE) stepperZ.toff((STATE)==Z_ENABLE_ON ? chopper_timing.toff : 0)
  173. #define Z_ENABLE_READ() stepperZ.isEnabled()
  174. #else
  175. #define Z_ENABLE_INIT SET_OUTPUT(Z_ENABLE_PIN)
  176. #define Z_ENABLE_WRITE(STATE) WRITE(Z_ENABLE_PIN,STATE)
  177. #define Z_ENABLE_READ() READ(Z_ENABLE_PIN)
  178. #endif
  179. #define Z_DIR_INIT SET_OUTPUT(Z_DIR_PIN)
  180. #define Z_DIR_WRITE(STATE) WRITE(Z_DIR_PIN,STATE)
  181. #define Z_DIR_READ() READ(Z_DIR_PIN)
  182. #endif
  183. #define Z_STEP_INIT SET_OUTPUT(Z_STEP_PIN)
  184. #if AXIS_HAS_SQUARE_WAVE(Z)
  185. #define Z_STEP_WRITE(STATE) do{ if(STATE) TOGGLE(Z_STEP_PIN); }while(0)
  186. #else
  187. #define Z_STEP_WRITE(STATE) WRITE(Z_STEP_PIN,STATE)
  188. #endif
  189. #define Z_STEP_READ READ(Z_STEP_PIN)
  190. // X2 Stepper
  191. #if HAS_X2_ENABLE
  192. #if AXIS_DRIVER_TYPE_X2(L6470)
  193. extern L6470 stepperX2;
  194. #define X2_ENABLE_INIT NOOP
  195. #define X2_ENABLE_WRITE(STATE) NOOP
  196. #define X2_ENABLE_READ() (stepperX2.getStatus() & STATUS_HIZ)
  197. #define X2_DIR_INIT NOOP
  198. #define X2_DIR_WRITE(STATE) L6470_WRITE_DIR_COMMAND(STATE,X2)
  199. #define X2_DIR_READ() (stepperX2.getStatus() & STATUS_DIR)
  200. #else
  201. #if AXIS_IS_TMC(X2)
  202. extern TMC_CLASS(X2, X) stepperX2;
  203. #endif
  204. #if AXIS_DRIVER_TYPE_X2(TMC26X)
  205. extern TMC26XStepper stepperX2;
  206. #define X2_ENABLE_INIT NOOP
  207. #define X2_ENABLE_WRITE(STATE) stepperX2.setEnabled(STATE)
  208. #define X2_ENABLE_READ() stepperX2.isEnabled()
  209. #elif ENABLED(SOFTWARE_DRIVER_ENABLE) && AXIS_IS_TMC(X2)
  210. #define X2_ENABLE_INIT NOOP
  211. #define X2_ENABLE_WRITE(STATE) stepperX2.toff((STATE)==X_ENABLE_ON ? chopper_timing.toff : 0)
  212. #define X2_ENABLE_READ() stepperX2.isEnabled()
  213. #else
  214. #define X2_ENABLE_INIT SET_OUTPUT(X2_ENABLE_PIN)
  215. #define X2_ENABLE_WRITE(STATE) WRITE(X2_ENABLE_PIN,STATE)
  216. #define X2_ENABLE_READ() READ(X2_ENABLE_PIN)
  217. #endif
  218. #define X2_DIR_INIT SET_OUTPUT(X2_DIR_PIN)
  219. #define X2_DIR_WRITE(STATE) WRITE(X2_DIR_PIN,STATE)
  220. #define X2_DIR_READ() READ(X2_DIR_PIN)
  221. #endif
  222. #define X2_STEP_INIT SET_OUTPUT(X2_STEP_PIN)
  223. #if AXIS_HAS_SQUARE_WAVE(X2)
  224. #define X2_STEP_WRITE(STATE) do{ if(STATE) TOGGLE(X2_STEP_PIN); }while(0)
  225. #else
  226. #define X2_STEP_WRITE(STATE) WRITE(X2_STEP_PIN,STATE)
  227. #endif
  228. #define X2_STEP_READ READ(X2_STEP_PIN)
  229. #endif
  230. // Y2 Stepper
  231. #if HAS_Y2_ENABLE
  232. #if AXIS_DRIVER_TYPE_Y2(L6470)
  233. extern L6470 stepperY2;
  234. #define Y2_ENABLE_INIT NOOP
  235. #define Y2_ENABLE_WRITE(STATE) NOOP
  236. #define Y2_ENABLE_READ() (stepperY2.getStatus() & STATUS_HIZ)
  237. #define Y2_DIR_INIT NOOP
  238. #define Y2_DIR_WRITE(STATE) L6470_WRITE_DIR_COMMAND(STATE,Y2)
  239. #define Y2_DIR_READ() (stepperY2.getStatus() & STATUS_DIR)
  240. #else
  241. #if AXIS_IS_TMC(Y2)
  242. extern TMC_CLASS(Y2, Y) stepperY2;
  243. #endif
  244. #if AXIS_DRIVER_TYPE_Y2(TMC26X)
  245. extern TMC26XStepper stepperY2;
  246. #define Y2_ENABLE_INIT NOOP
  247. #define Y2_ENABLE_WRITE(STATE) stepperY2.setEnabled(STATE)
  248. #define Y2_ENABLE_READ() stepperY2.isEnabled()
  249. #elif ENABLED(SOFTWARE_DRIVER_ENABLE) && AXIS_IS_TMC(Y2)
  250. #define Y2_ENABLE_INIT NOOP
  251. #define Y2_ENABLE_WRITE(STATE) stepperY2.toff((STATE)==Y_ENABLE_ON ? chopper_timing.toff : 0)
  252. #define Y2_ENABLE_READ() stepperY2.isEnabled()
  253. #else
  254. #define Y2_ENABLE_INIT SET_OUTPUT(Y2_ENABLE_PIN)
  255. #define Y2_ENABLE_WRITE(STATE) WRITE(Y2_ENABLE_PIN,STATE)
  256. #define Y2_ENABLE_READ() READ(Y2_ENABLE_PIN)
  257. #endif
  258. #define Y2_DIR_INIT SET_OUTPUT(Y2_DIR_PIN)
  259. #define Y2_DIR_WRITE(STATE) WRITE(Y2_DIR_PIN,STATE)
  260. #define Y2_DIR_READ() READ(Y2_DIR_PIN)
  261. #endif
  262. #define Y2_STEP_INIT SET_OUTPUT(Y2_STEP_PIN)
  263. #if AXIS_HAS_SQUARE_WAVE(Y2)
  264. #define Y2_STEP_WRITE(STATE) do{ if(STATE) TOGGLE(Y2_STEP_PIN); }while(0)
  265. #else
  266. #define Y2_STEP_WRITE(STATE) WRITE(Y2_STEP_PIN,STATE)
  267. #endif
  268. #define Y2_STEP_READ READ(Y2_STEP_PIN)
  269. #else
  270. #define Y2_DIR_WRITE(STATE) NOOP
  271. #endif
  272. // Z2 Stepper
  273. #if HAS_Z2_ENABLE
  274. #if AXIS_DRIVER_TYPE_Z2(L6470)
  275. extern L6470 stepperZ2;
  276. #define Z2_ENABLE_INIT NOOP
  277. #define Z2_ENABLE_WRITE(STATE) NOOP
  278. #define Z2_ENABLE_READ() (stepperZ2.getStatus() & STATUS_HIZ)
  279. #define Z2_DIR_INIT NOOP
  280. #define Z2_DIR_WRITE(STATE) L6470_WRITE_DIR_COMMAND(STATE,Z2)
  281. #define Z2_DIR_READ() (stepperZ2.getStatus() & STATUS_DIR)
  282. #else
  283. #if AXIS_IS_TMC(Z2)
  284. extern TMC_CLASS(Z2, Z) stepperZ2;
  285. #endif
  286. #if AXIS_DRIVER_TYPE_Z2(TMC26X)
  287. extern TMC26XStepper stepperZ2;
  288. #define Z2_ENABLE_INIT NOOP
  289. #define Z2_ENABLE_WRITE(STATE) stepperZ2.setEnabled(STATE)
  290. #define Z2_ENABLE_READ() stepperZ2.isEnabled()
  291. #elif ENABLED(SOFTWARE_DRIVER_ENABLE) && AXIS_IS_TMC(Z2)
  292. #define Z2_ENABLE_INIT NOOP
  293. #define Z2_ENABLE_WRITE(STATE) stepperZ2.toff((STATE)==Z_ENABLE_ON ? chopper_timing.toff : 0)
  294. #define Z2_ENABLE_READ() stepperZ2.isEnabled()
  295. #else
  296. #define Z2_ENABLE_INIT SET_OUTPUT(Z2_ENABLE_PIN)
  297. #define Z2_ENABLE_WRITE(STATE) WRITE(Z2_ENABLE_PIN,STATE)
  298. #define Z2_ENABLE_READ() READ(Z2_ENABLE_PIN)
  299. #endif
  300. #define Z2_DIR_INIT SET_OUTPUT(Z2_DIR_PIN)
  301. #define Z2_DIR_WRITE(STATE) WRITE(Z2_DIR_PIN,STATE)
  302. #define Z2_DIR_READ() READ(Z2_DIR_PIN)
  303. #endif
  304. #define Z2_STEP_INIT SET_OUTPUT(Z2_STEP_PIN)
  305. #if AXIS_HAS_SQUARE_WAVE(Z2)
  306. #define Z2_STEP_WRITE(STATE) do{ if(STATE) TOGGLE(Z2_STEP_PIN); }while(0)
  307. #else
  308. #define Z2_STEP_WRITE(STATE) WRITE(Z2_STEP_PIN,STATE)
  309. #endif
  310. #define Z2_STEP_READ READ(Z2_STEP_PIN)
  311. #else
  312. #define Z2_DIR_WRITE(STATE) NOOP
  313. #endif
  314. // Z3 Stepper
  315. #if HAS_Z3_ENABLE
  316. #if AXIS_DRIVER_TYPE_Z3(L6470)
  317. extern L6470 stepperZ3;
  318. #define Z3_ENABLE_INIT NOOP
  319. #define Z3_ENABLE_WRITE(STATE) NOOP
  320. #define Z3_ENABLE_READ() (stepperZ3.getStatus() & STATUS_HIZ)
  321. #define Z3_DIR_INIT NOOP
  322. #define Z3_DIR_WRITE(STATE) L6470_WRITE_DIR_COMMAND(STATE,Z3)
  323. #define Z3_DIR_READ() (stepperZ3.getStatus() & STATUS_DIR)
  324. #else
  325. #if AXIS_IS_TMC(Z3)
  326. extern TMC_CLASS(Z3, Z) stepperZ3;
  327. #endif
  328. #if ENABLED(Z3_IS_TMC26X)
  329. extern TMC26XStepper stepperZ3;
  330. #define Z3_ENABLE_INIT NOOP
  331. #define Z3_ENABLE_WRITE(STATE) stepperZ3.setEnabled(STATE)
  332. #define Z3_ENABLE_READ() stepperZ3.isEnabled()
  333. #elif ENABLED(SOFTWARE_DRIVER_ENABLE) && AXIS_IS_TMC(Z3)
  334. #define Z3_ENABLE_INIT NOOP
  335. #define Z3_ENABLE_WRITE(STATE) stepperZ3.toff((STATE)==Z_ENABLE_ON ? chopper_timing.toff : 0)
  336. #define Z3_ENABLE_READ() stepperZ3.isEnabled()
  337. #else
  338. #define Z3_ENABLE_INIT SET_OUTPUT(Z3_ENABLE_PIN)
  339. #define Z3_ENABLE_WRITE(STATE) WRITE(Z3_ENABLE_PIN,STATE)
  340. #define Z3_ENABLE_READ() READ(Z3_ENABLE_PIN)
  341. #endif
  342. #define Z3_DIR_INIT SET_OUTPUT(Z3_DIR_PIN)
  343. #define Z3_DIR_WRITE(STATE) WRITE(Z3_DIR_PIN,STATE)
  344. #define Z3_DIR_READ() READ(Z3_DIR_PIN)
  345. #endif
  346. #define Z3_STEP_INIT SET_OUTPUT(Z3_STEP_PIN)
  347. #if AXIS_HAS_SQUARE_WAVE(Z3)
  348. #define Z3_STEP_WRITE(STATE) do{ if(STATE) TOGGLE(Z3_STEP_PIN); }while(0)
  349. #else
  350. #define Z3_STEP_WRITE(STATE) WRITE(Z3_STEP_PIN,STATE)
  351. #endif
  352. #define Z3_STEP_READ READ(Z3_STEP_PIN)
  353. #else
  354. #define Z3_DIR_WRITE(STATE) NOOP
  355. #endif
  356. // E0 Stepper
  357. #if AXIS_DRIVER_TYPE_E0(L6470)
  358. extern L6470 stepperE0;
  359. #define E0_ENABLE_INIT NOOP
  360. #define E0_ENABLE_WRITE(STATE) NOOP
  361. #define E0_ENABLE_READ() (stepperE0.getStatus() & STATUS_HIZ)
  362. #define E0_DIR_INIT NOOP
  363. #define E0_DIR_WRITE(STATE) L6470_WRITE_DIR_COMMAND(STATE,E0)
  364. #define E0_DIR_READ() (stepperE0.getStatus() & STATUS_DIR)
  365. #else
  366. #if AXIS_IS_TMC(E0)
  367. extern TMC_CLASS_E(0) stepperE0;
  368. #endif
  369. #if AXIS_DRIVER_TYPE_E0(TMC26X)
  370. extern TMC26XStepper stepperE0;
  371. #define E0_ENABLE_INIT NOOP
  372. #define E0_ENABLE_WRITE(STATE) stepperE0.setEnabled(STATE)
  373. #define E0_ENABLE_READ() stepperE0.isEnabled()
  374. #elif ENABLED(SOFTWARE_DRIVER_ENABLE) && AXIS_IS_TMC(E0)
  375. #define E0_ENABLE_INIT NOOP
  376. #define E0_ENABLE_WRITE(STATE) stepperE0.toff((STATE)==E_ENABLE_ON ? chopper_timing.toff : 0)
  377. #define E0_ENABLE_READ() stepperE0.isEnabled()
  378. #else
  379. #define E0_ENABLE_INIT SET_OUTPUT(E0_ENABLE_PIN)
  380. #define E0_ENABLE_WRITE(STATE) WRITE(E0_ENABLE_PIN,STATE)
  381. #define E0_ENABLE_READ() READ(E0_ENABLE_PIN)
  382. #endif
  383. #define E0_DIR_INIT SET_OUTPUT(E0_DIR_PIN)
  384. #define E0_DIR_WRITE(STATE) WRITE(E0_DIR_PIN,STATE)
  385. #define E0_DIR_READ() READ(E0_DIR_PIN)
  386. #endif
  387. #define E0_STEP_INIT SET_OUTPUT(E0_STEP_PIN)
  388. #if AXIS_HAS_SQUARE_WAVE(E0)
  389. #define E0_STEP_WRITE(STATE) do{ if(STATE) TOGGLE(E0_STEP_PIN); }while(0)
  390. #else
  391. #define E0_STEP_WRITE(STATE) WRITE(E0_STEP_PIN,STATE)
  392. #endif
  393. #define E0_STEP_READ READ(E0_STEP_PIN)
  394. // E1 Stepper
  395. #if AXIS_DRIVER_TYPE_E1(L6470)
  396. extern L6470 stepperE1;
  397. #define E1_ENABLE_INIT NOOP
  398. #define E1_ENABLE_WRITE(STATE) NOOP
  399. #define E1_ENABLE_READ() (stepperE1.getStatus() & STATUS_HIZ)
  400. #define E1_DIR_INIT NOOP
  401. #define E1_DIR_WRITE(STATE) L6470_WRITE_DIR_COMMAND(STATE,E1)
  402. #define E1_DIR_READ() (stepperE1.getStatus() & STATUS_DIR)
  403. #else
  404. #if AXIS_IS_TMC(E1)
  405. extern TMC_CLASS_E(1) stepperE1;
  406. #endif
  407. #if AXIS_DRIVER_TYPE_E1(TMC26X)
  408. extern TMC26XStepper stepperE1;
  409. #define E1_ENABLE_INIT NOOP
  410. #define E1_ENABLE_WRITE(STATE) stepperE1.setEnabled(STATE)
  411. #define E1_ENABLE_READ() stepperE1.isEnabled()
  412. #elif ENABLED(SOFTWARE_DRIVER_ENABLE) && AXIS_IS_TMC(E1)
  413. #define E1_ENABLE_INIT NOOP
  414. #define E1_ENABLE_WRITE(STATE) stepperE1.toff((STATE)==E_ENABLE_ON ? chopper_timing.toff : 0)
  415. #define E1_ENABLE_READ() stepperE1.isEnabled()
  416. #else
  417. #define E1_ENABLE_INIT SET_OUTPUT(E1_ENABLE_PIN)
  418. #define E1_ENABLE_WRITE(STATE) WRITE(E1_ENABLE_PIN,STATE)
  419. #define E1_ENABLE_READ() READ(E1_ENABLE_PIN)
  420. #endif
  421. #define E1_DIR_INIT SET_OUTPUT(E1_DIR_PIN)
  422. #define E1_DIR_WRITE(STATE) WRITE(E1_DIR_PIN,STATE)
  423. #define E1_DIR_READ() READ(E1_DIR_PIN)
  424. #endif
  425. #define E1_STEP_INIT SET_OUTPUT(E1_STEP_PIN)
  426. #if AXIS_HAS_SQUARE_WAVE(E1)
  427. #define E1_STEP_WRITE(STATE) do{ if(STATE) TOGGLE(E1_STEP_PIN); }while(0)
  428. #else
  429. #define E1_STEP_WRITE(STATE) WRITE(E1_STEP_PIN,STATE)
  430. #endif
  431. #define E1_STEP_READ READ(E1_STEP_PIN)
  432. // E2 Stepper
  433. #if AXIS_DRIVER_TYPE_E2(L6470)
  434. extern L6470 stepperE2;
  435. #define E2_ENABLE_INIT NOOP
  436. #define E2_ENABLE_WRITE(STATE) NOOP
  437. #define E2_ENABLE_READ() (stepperE2.getStatus() & STATUS_HIZ)
  438. #define E2_DIR_INIT NOOP
  439. #define E2_DIR_WRITE(STATE) L6470_WRITE_DIR_COMMAND(STATE,E2)
  440. #define E2_DIR_READ() (stepperE2.getStatus() & STATUS_DIR)
  441. #else
  442. #if AXIS_IS_TMC(E2)
  443. extern TMC_CLASS_E(2) stepperE2;
  444. #endif
  445. #if AXIS_DRIVER_TYPE_E2(TMC26X)
  446. extern TMC26XStepper stepperE2;
  447. #define E2_ENABLE_INIT NOOP
  448. #define E2_ENABLE_WRITE(STATE) stepperE2.setEnabled(STATE)
  449. #define E2_ENABLE_READ() stepperE2.isEnabled()
  450. #elif ENABLED(SOFTWARE_DRIVER_ENABLE) && AXIS_IS_TMC(E2)
  451. #define E2_ENABLE_INIT NOOP
  452. #define E2_ENABLE_WRITE(STATE) stepperE2.toff((STATE)==E_ENABLE_ON ? chopper_timing.toff : 0)
  453. #define E2_ENABLE_READ() stepperE2.isEnabled()
  454. #else
  455. #define E2_ENABLE_INIT SET_OUTPUT(E2_ENABLE_PIN)
  456. #define E2_ENABLE_WRITE(STATE) WRITE(E2_ENABLE_PIN,STATE)
  457. #define E2_ENABLE_READ() READ(E2_ENABLE_PIN)
  458. #endif
  459. #define E2_DIR_INIT SET_OUTPUT(E2_DIR_PIN)
  460. #define E2_DIR_WRITE(STATE) WRITE(E2_DIR_PIN,STATE)
  461. #define E2_DIR_READ() READ(E2_DIR_PIN)
  462. #endif
  463. #define E2_STEP_INIT SET_OUTPUT(E2_STEP_PIN)
  464. #if AXIS_HAS_SQUARE_WAVE(E2)
  465. #define E2_STEP_WRITE(STATE) do{ if(STATE) TOGGLE(E2_STEP_PIN); }while(0)
  466. #else
  467. #define E2_STEP_WRITE(STATE) WRITE(E2_STEP_PIN,STATE)
  468. #endif
  469. #define E2_STEP_READ READ(E2_STEP_PIN)
  470. // E3 Stepper
  471. #if AXIS_DRIVER_TYPE_E3(L6470)
  472. extern L6470 stepperE3;
  473. #define E3_ENABLE_INIT NOOP
  474. #define E3_ENABLE_WRITE(STATE) NOOP
  475. #define E3_ENABLE_READ() (stepperE3.getStatus() & STATUS_HIZ)
  476. #define E3_DIR_INIT NOOP
  477. #define E3_DIR_WRITE(STATE) L6470_WRITE_DIR_COMMAND(STATE,E3)
  478. #define E3_DIR_READ() (stepperE3.getStatus() & STATUS_DIR)
  479. #else
  480. #if AXIS_IS_TMC(E3)
  481. extern TMC_CLASS_E(3) stepperE3;
  482. #endif
  483. #if AXIS_DRIVER_TYPE_E3(TMC26X)
  484. extern TMC26XStepper stepperE3;
  485. #define E3_ENABLE_INIT NOOP
  486. #define E3_ENABLE_WRITE(STATE) stepperE3.setEnabled(STATE)
  487. #define E3_ENABLE_READ() stepperE3.isEnabled()
  488. #elif ENABLED(SOFTWARE_DRIVER_ENABLE) && AXIS_IS_TMC(E3)
  489. #define E3_ENABLE_INIT NOOP
  490. #define E3_ENABLE_WRITE(STATE) stepperE3.toff((STATE)==E_ENABLE_ON ? chopper_timing.toff : 0)
  491. #define E3_ENABLE_READ() stepperE3.isEnabled()
  492. #else
  493. #define E3_ENABLE_INIT SET_OUTPUT(E3_ENABLE_PIN)
  494. #define E3_ENABLE_WRITE(STATE) WRITE(E3_ENABLE_PIN,STATE)
  495. #define E3_ENABLE_READ() READ(E3_ENABLE_PIN)
  496. #endif
  497. #define E3_DIR_INIT SET_OUTPUT(E3_DIR_PIN)
  498. #define E3_DIR_WRITE(STATE) WRITE(E3_DIR_PIN,STATE)
  499. #define E3_DIR_READ() READ(E3_DIR_PIN)
  500. #endif
  501. #define E3_STEP_INIT SET_OUTPUT(E3_STEP_PIN)
  502. #if AXIS_HAS_SQUARE_WAVE(E3)
  503. #define E3_STEP_WRITE(STATE) do{ if(STATE) TOGGLE(E3_STEP_PIN); }while(0)
  504. #else
  505. #define E3_STEP_WRITE(STATE) WRITE(E3_STEP_PIN,STATE)
  506. #endif
  507. #define E3_STEP_READ READ(E3_STEP_PIN)
  508. // E4 Stepper
  509. #if AXIS_DRIVER_TYPE_E4(L6470)
  510. extern L6470 stepperE4;
  511. #define E4_ENABLE_INIT NOOP
  512. #define E4_ENABLE_WRITE(STATE) NOOP
  513. #define E4_ENABLE_READ() (stepperE4.getStatus() & STATUS_HIZ)
  514. #define E4_DIR_INIT NOOP
  515. #define E4_DIR_WRITE(STATE) L6470_WRITE_DIR_COMMAND(STATE,E4)
  516. #define E4_DIR_READ() (stepperE4.getStatus() & STATUS_DIR)
  517. #else
  518. #if AXIS_IS_TMC(E4)
  519. extern TMC_CLASS_E(4) stepperE4;
  520. #endif
  521. #if AXIS_DRIVER_TYPE_E4(TMC26X)
  522. extern TMC26XStepper stepperE4;
  523. #define E4_ENABLE_INIT NOOP
  524. #define E4_ENABLE_WRITE(STATE) stepperE4.setEnabled(STATE)
  525. #define E4_ENABLE_READ() stepperE4.isEnabled()
  526. #elif ENABLED(SOFTWARE_DRIVER_ENABLE) && AXIS_IS_TMC(E4)
  527. #define E4_ENABLE_INIT NOOP
  528. #define E4_ENABLE_WRITE(STATE) stepperE4.toff((STATE)==E_ENABLE_ON ? chopper_timing.toff : 0)
  529. #define E4_ENABLE_READ() stepperE4.isEnabled()
  530. #else
  531. #define E4_ENABLE_INIT SET_OUTPUT(E4_ENABLE_PIN)
  532. #define E4_ENABLE_WRITE(STATE) WRITE(E4_ENABLE_PIN,STATE)
  533. #define E4_ENABLE_READ() READ(E4_ENABLE_PIN)
  534. #endif
  535. #define E4_DIR_INIT SET_OUTPUT(E4_DIR_PIN)
  536. #define E4_DIR_WRITE(STATE) WRITE(E4_DIR_PIN,STATE)
  537. #define E4_DIR_READ() READ(E4_DIR_PIN)
  538. #endif
  539. #define E4_STEP_INIT SET_OUTPUT(E4_STEP_PIN)
  540. #if AXIS_HAS_SQUARE_WAVE(E4)
  541. #define E4_STEP_WRITE(STATE) do{ if(STATE) TOGGLE(E4_STEP_PIN); }while(0)
  542. #else
  543. #define E4_STEP_WRITE(STATE) WRITE(E4_STEP_PIN,STATE)
  544. #endif
  545. #define E4_STEP_READ READ(E4_STEP_PIN)
  546. // E5 Stepper
  547. #if AXIS_DRIVER_TYPE_E5(L6470)
  548. extern L6470 stepperE5;
  549. #define E5_ENABLE_INIT NOOP
  550. #define E5_ENABLE_WRITE(STATE) NOOP
  551. #define E5_ENABLE_READ() (stepperE5.getStatus() & STATUS_HIZ)
  552. #define E5_DIR_INIT NOOP
  553. #define E5_DIR_WRITE(STATE) L6470_WRITE_DIR_COMMAND(STATE,E5)
  554. #define E5_DIR_READ() (stepperE5.getStatus() & STATUS_DIR)
  555. #else
  556. #if AXIS_IS_TMC(E5)
  557. extern TMC_CLASS_E(5) stepperE5;
  558. #endif
  559. #if AXIS_DRIVER_TYPE_E5(TMC26X)
  560. extern TMC26XStepper stepperE5;
  561. #define E5_ENABLE_INIT NOOP
  562. #define E5_ENABLE_WRITE(STATE) stepperE5.setEnabled(STATE)
  563. #define E5_ENABLE_READ() stepperE5.isEnabled()
  564. #elif ENABLED(SOFTWARE_DRIVER_ENABLE) && AXIS_IS_TMC(E5)
  565. #define E5_ENABLE_INIT NOOP
  566. #define E5_ENABLE_WRITE(STATE) stepperE5.toff((STATE)==E_ENABLE_ON ? chopper_timing.toff : 0)
  567. #define E5_ENABLE_READ() stepperE5.isEnabled()
  568. #else
  569. #define E5_ENABLE_INIT SET_OUTPUT(E5_ENABLE_PIN)
  570. #define E5_ENABLE_WRITE(STATE) WRITE(E5_ENABLE_PIN,STATE)
  571. #define E5_ENABLE_READ() READ(E5_ENABLE_PIN)
  572. #endif
  573. #define E5_DIR_INIT SET_OUTPUT(E5_DIR_PIN)
  574. #define E5_DIR_WRITE(STATE) WRITE(E5_DIR_PIN,STATE)
  575. #define E5_DIR_READ() READ(E5_DIR_PIN)
  576. #endif
  577. #define E5_STEP_INIT SET_OUTPUT(E5_STEP_PIN)
  578. #if AXIS_HAS_SQUARE_WAVE(E5)
  579. #define E5_STEP_WRITE(STATE) do{ if(STATE) TOGGLE(E5_STEP_PIN); }while(0)
  580. #else
  581. #define E5_STEP_WRITE(STATE) WRITE(E5_STEP_PIN,STATE)
  582. #endif
  583. #define E5_STEP_READ READ(E5_STEP_PIN)
  584. /**
  585. * Extruder indirection for the single E axis
  586. */
  587. #if ENABLED(SWITCHING_EXTRUDER) // One stepper driver per two extruders, reversed on odd index
  588. #if EXTRUDERS > 5
  589. #define E_STEP_WRITE(E,V) do{ if (E < 2) { E0_STEP_WRITE(V); } else if (E < 4) { E1_STEP_WRITE(V); } else { E2_STEP_WRITE(V); } }while(0)
  590. #define NORM_E_DIR(E) do{ switch (E) { case 0: E0_DIR_WRITE(!INVERT_E0_DIR); break; case 1: E0_DIR_WRITE( INVERT_E0_DIR); break; case 2: E1_DIR_WRITE(!INVERT_E1_DIR); break; case 3: E1_DIR_WRITE( INVERT_E1_DIR); break; case 4: E2_DIR_WRITE(!INVERT_E2_DIR); case 5: E2_DIR_WRITE( INVERT_E2_DIR); } }while(0)
  591. #define REV_E_DIR(E) do{ switch (E) { case 0: E0_DIR_WRITE( INVERT_E0_DIR); break; case 1: E0_DIR_WRITE(!INVERT_E0_DIR); break; case 2: E1_DIR_WRITE( INVERT_E1_DIR); break; case 3: E1_DIR_WRITE(!INVERT_E1_DIR); break; case 4: E2_DIR_WRITE( INVERT_E2_DIR); case 5: E2_DIR_WRITE(!INVERT_E2_DIR); } }while(0)
  592. #elif EXTRUDERS > 4
  593. #define E_STEP_WRITE(E,V) do{ if (E < 2) { E0_STEP_WRITE(V); } else if (E < 4) { E1_STEP_WRITE(V); } else { E2_STEP_WRITE(V); } }while(0)
  594. #define NORM_E_DIR(E) do{ switch (E) { case 0: E0_DIR_WRITE(!INVERT_E0_DIR); break; case 1: E0_DIR_WRITE( INVERT_E0_DIR); break; case 2: E1_DIR_WRITE(!INVERT_E1_DIR); break; case 3: E1_DIR_WRITE( INVERT_E1_DIR); break; case 4: E2_DIR_WRITE(!INVERT_E2_DIR); } }while(0)
  595. #define REV_E_DIR(E) do{ switch (E) { case 0: E0_DIR_WRITE( INVERT_E0_DIR); break; case 1: E0_DIR_WRITE(!INVERT_E0_DIR); break; case 2: E1_DIR_WRITE( INVERT_E1_DIR); break; case 3: E1_DIR_WRITE(!INVERT_E1_DIR); break; case 4: E2_DIR_WRITE( INVERT_E2_DIR); } }while(0)
  596. #elif EXTRUDERS > 3
  597. #define E_STEP_WRITE(E,V) do{ if (E < 2) { E0_STEP_WRITE(V); } else { E1_STEP_WRITE(V); } }while(0)
  598. #define NORM_E_DIR(E) do{ switch (E) { case 0: E0_DIR_WRITE(!INVERT_E0_DIR); break; case 1: E0_DIR_WRITE( INVERT_E0_DIR); break; case 2: E1_DIR_WRITE(!INVERT_E1_DIR); break; case 3: E1_DIR_WRITE( INVERT_E1_DIR); } }while(0)
  599. #define REV_E_DIR(E) do{ switch (E) { case 0: E0_DIR_WRITE( INVERT_E0_DIR); break; case 1: E0_DIR_WRITE(!INVERT_E0_DIR); break; case 2: E1_DIR_WRITE( INVERT_E1_DIR); break; case 3: E1_DIR_WRITE(!INVERT_E1_DIR); } }while(0)
  600. #elif EXTRUDERS > 2
  601. #define E_STEP_WRITE(E,V) do{ if (E < 2) { E0_STEP_WRITE(V); } else { E1_STEP_WRITE(V); } }while(0)
  602. #define NORM_E_DIR(E) do{ switch (E) { case 0: E0_DIR_WRITE(!INVERT_E0_DIR); break; case 1: E0_DIR_WRITE( INVERT_E0_DIR); break; case 2: E1_DIR_WRITE(!INVERT_E1_DIR); } }while(0)
  603. #define REV_E_DIR(E) do{ switch (E) { case 0: E0_DIR_WRITE( INVERT_E0_DIR); break; case 1: E0_DIR_WRITE(!INVERT_E0_DIR); break; case 2: E1_DIR_WRITE( INVERT_E1_DIR); } }while(0)
  604. #else
  605. #define E_STEP_WRITE(E,V) E0_STEP_WRITE(V)
  606. #define NORM_E_DIR(E) do{ E0_DIR_WRITE(E ? INVERT_E0_DIR : !INVERT_E0_DIR); }while(0)
  607. #define REV_E_DIR(E) do{ E0_DIR_WRITE(E ? !INVERT_E0_DIR : INVERT_E0_DIR); }while(0)
  608. #endif
  609. #elif ENABLED(PRUSA_MMU2)
  610. #define E_STEP_WRITE(E,V) E0_STEP_WRITE(V)
  611. #define NORM_E_DIR(E) E0_DIR_WRITE(!INVERT_E0_DIR)
  612. #define REV_E_DIR(E) E0_DIR_WRITE( INVERT_E0_DIR)
  613. #elif ENABLED(MK2_MULTIPLEXER) // One multiplexed stepper driver, reversed on odd index
  614. #define E_STEP_WRITE(E,V) E0_STEP_WRITE(V)
  615. #define NORM_E_DIR(E) do{ E0_DIR_WRITE(TEST(E, 0) ? !INVERT_E0_DIR: INVERT_E0_DIR); }while(0)
  616. #define REV_E_DIR(E) do{ E0_DIR_WRITE(TEST(E, 0) ? INVERT_E0_DIR: !INVERT_E0_DIR); }while(0)
  617. #elif E_STEPPERS > 1
  618. #if E_STEPPERS > 5
  619. #define _E_STEP_WRITE(E,V) do{ switch (E) { case 0: E0_STEP_WRITE(V); break; case 1: E1_STEP_WRITE(V); break; case 2: E2_STEP_WRITE(V); break; case 3: E3_STEP_WRITE(V); break; case 4: E4_STEP_WRITE(V); case 5: E5_STEP_WRITE(V); } }while(0)
  620. #define _NORM_E_DIR(E) do{ switch (E) { case 0: E0_DIR_WRITE(!INVERT_E0_DIR); break; case 1: E1_DIR_WRITE(!INVERT_E1_DIR); break; case 2: E2_DIR_WRITE(!INVERT_E2_DIR); break; case 3: E3_DIR_WRITE(!INVERT_E3_DIR); break; case 4: E4_DIR_WRITE(!INVERT_E4_DIR); case 5: E5_DIR_WRITE(!INVERT_E5_DIR); } }while(0)
  621. #define _REV_E_DIR(E) do{ switch (E) { case 0: E0_DIR_WRITE( INVERT_E0_DIR); break; case 1: E1_DIR_WRITE( INVERT_E1_DIR); break; case 2: E2_DIR_WRITE( INVERT_E2_DIR); break; case 3: E3_DIR_WRITE( INVERT_E3_DIR); break; case 4: E4_DIR_WRITE( INVERT_E4_DIR); case 5: E5_DIR_WRITE( INVERT_E5_DIR); } }while(0)
  622. #elif E_STEPPERS > 4
  623. #define _E_STEP_WRITE(E,V) do{ switch (E) { case 0: E0_STEP_WRITE(V); break; case 1: E1_STEP_WRITE(V); break; case 2: E2_STEP_WRITE(V); break; case 3: E3_STEP_WRITE(V); break; case 4: E4_STEP_WRITE(V); } }while(0)
  624. #define _NORM_E_DIR(E) do{ switch (E) { case 0: E0_DIR_WRITE(!INVERT_E0_DIR); break; case 1: E1_DIR_WRITE(!INVERT_E1_DIR); break; case 2: E2_DIR_WRITE(!INVERT_E2_DIR); break; case 3: E3_DIR_WRITE(!INVERT_E3_DIR); break; case 4: E4_DIR_WRITE(!INVERT_E4_DIR); } }while(0)
  625. #define _REV_E_DIR(E) do{ switch (E) { case 0: E0_DIR_WRITE( INVERT_E0_DIR); break; case 1: E1_DIR_WRITE( INVERT_E1_DIR); break; case 2: E2_DIR_WRITE( INVERT_E2_DIR); break; case 3: E3_DIR_WRITE( INVERT_E3_DIR); break; case 4: E4_DIR_WRITE( INVERT_E4_DIR); } }while(0)
  626. #elif E_STEPPERS > 3
  627. #define _E_STEP_WRITE(E,V) do{ switch (E) { case 0: E0_STEP_WRITE(V); break; case 1: E1_STEP_WRITE(V); break; case 2: E2_STEP_WRITE(V); break; case 3: E3_STEP_WRITE(V); } }while(0)
  628. #define _NORM_E_DIR(E) do{ switch (E) { case 0: E0_DIR_WRITE(!INVERT_E0_DIR); break; case 1: E1_DIR_WRITE(!INVERT_E1_DIR); break; case 2: E2_DIR_WRITE(!INVERT_E2_DIR); break; case 3: E3_DIR_WRITE(!INVERT_E3_DIR); } }while(0)
  629. #define _REV_E_DIR(E) do{ switch (E) { case 0: E0_DIR_WRITE( INVERT_E0_DIR); break; case 1: E1_DIR_WRITE( INVERT_E1_DIR); break; case 2: E2_DIR_WRITE( INVERT_E2_DIR); break; case 3: E3_DIR_WRITE( INVERT_E3_DIR); } }while(0)
  630. #elif E_STEPPERS > 2
  631. #define _E_STEP_WRITE(E,V) do{ switch (E) { case 0: E0_STEP_WRITE(V); break; case 1: E1_STEP_WRITE(V); break; case 2: E2_STEP_WRITE(V); } }while(0)
  632. #define _NORM_E_DIR(E) do{ switch (E) { case 0: E0_DIR_WRITE(!INVERT_E0_DIR); break; case 1: E1_DIR_WRITE(!INVERT_E1_DIR); break; case 2: E2_DIR_WRITE(!INVERT_E2_DIR); } }while(0)
  633. #define _REV_E_DIR(E) do{ switch (E) { case 0: E0_DIR_WRITE( INVERT_E0_DIR); break; case 1: E1_DIR_WRITE( INVERT_E1_DIR); break; case 2: E2_DIR_WRITE( INVERT_E2_DIR); } }while(0)
  634. #else
  635. #define _E_STEP_WRITE(E,V) do{ if (E == 0) { E0_STEP_WRITE(V); } else { E1_STEP_WRITE(V); } }while(0)
  636. #define _NORM_E_DIR(E) do{ if (E == 0) { E0_DIR_WRITE(!INVERT_E0_DIR); } else { E1_DIR_WRITE(!INVERT_E1_DIR); } }while(0)
  637. #define _REV_E_DIR(E) do{ if (E == 0) { E0_DIR_WRITE( INVERT_E0_DIR); } else { E1_DIR_WRITE( INVERT_E1_DIR); } }while(0)
  638. #endif
  639. #if HAS_DUPLICATION_MODE
  640. #if ENABLED(MULTI_NOZZLE_DUPLICATION)
  641. #define _DUPE(N,T,V) do{ if (TEST(duplication_e_mask, N)) E##N##_##T##_WRITE(V); }while(0)
  642. #else
  643. #define _DUPE(N,T,V) E##N##_##T##_WRITE(V)
  644. #endif
  645. #define NDIR(N) _DUPE(N,DIR,!INVERT_E##N##_DIR)
  646. #define RDIR(N) _DUPE(N,DIR, INVERT_E##N##_DIR)
  647. #define E_STEP_WRITE(E,V) do{ if (extruder_duplication_enabled) { DUPE(STEP,V); } else _E_STEP_WRITE(E,V); }while(0)
  648. #if E_STEPPERS > 2
  649. #if E_STEPPERS > 5
  650. #define DUPE(T,V) do{ _DUPE(0,T,V); _DUPE(1,T,V); _DUPE(2,T,V); _DUPE(3,T,V); _DUPE(4,T,V); _DUPE(5,T,V); }while(0)
  651. #define NORM_E_DIR(E) do{ if (extruder_duplication_enabled) { NDIR(0); NDIR(1); NDIR(2); NDIR(3); NDIR(4); NDIR(5); } else _NORM_E_DIR(E); }while(0)
  652. #define REV_E_DIR(E) do{ if (extruder_duplication_enabled) { RDIR(0); RDIR(1); RDIR(2); RDIR(3); RDIR(4); RDIR(5); } else _REV_E_DIR(E); }while(0)
  653. #elif E_STEPPERS > 4
  654. #define DUPE(T,V) do{ _DUPE(0,T,V); _DUPE(1,T,V); _DUPE(2,T,V); _DUPE(3,T,V); _DUPE(4,T,V); }while(0)
  655. #define NORM_E_DIR(E) do{ if (extruder_duplication_enabled) { NDIR(0); NDIR(1); NDIR(2); NDIR(3); NDIR(4); } else _NORM_E_DIR(E); }while(0)
  656. #define REV_E_DIR(E) do{ if (extruder_duplication_enabled) { RDIR(0); RDIR(1); RDIR(2); RDIR(3); RDIR(4); } else _REV_E_DIR(E); }while(0)
  657. #elif E_STEPPERS > 3
  658. #define DUPE(T,V) do{ _DUPE(0,T,V); _DUPE(1,T,V); _DUPE(2,T,V); _DUPE(3,T,V); }while(0)
  659. #define NORM_E_DIR(E) do{ if (extruder_duplication_enabled) { NDIR(0); NDIR(1); NDIR(2); NDIR(3); } else _NORM_E_DIR(E); }while(0)
  660. #define REV_E_DIR(E) do{ if (extruder_duplication_enabled) { RDIR(0); RDIR(1); RDIR(2); RDIR(3); } else _REV_E_DIR(E); }while(0)
  661. #else
  662. #define DUPE(T,V) do{ _DUPE(0,T,V); _DUPE(1,T,V); _DUPE(2,T,V); }while(0)
  663. #define NORM_E_DIR(E) do{ if (extruder_duplication_enabled) { NDIR(0); NDIR(1); NDIR(2); } else _NORM_E_DIR(E); }while(0)
  664. #define REV_E_DIR(E) do{ if (extruder_duplication_enabled) { RDIR(0); RDIR(1); RDIR(2); } else _REV_E_DIR(E); }while(0)
  665. #endif
  666. #else
  667. #define DUPE(T,V) do{ _DUPE(0,T,V); _DUPE(1,T,V); }while(0)
  668. #define NORM_E_DIR(E) do{ if (extruder_duplication_enabled) { NDIR(0); NDIR(1); } else _NORM_E_DIR(E); }while(0)
  669. #define REV_E_DIR(E) do{ if (extruder_duplication_enabled) { RDIR(0); RDIR(1); } else _REV_E_DIR(E); }while(0)
  670. #endif
  671. #else
  672. #define E_STEP_WRITE(E,V) _E_STEP_WRITE(E,V)
  673. #define NORM_E_DIR(E) _NORM_E_DIR(E)
  674. #define REV_E_DIR(E) _REV_E_DIR(E)
  675. #endif
  676. #elif E_STEPPERS
  677. #define E_STEP_WRITE(E,V) E0_STEP_WRITE(V)
  678. #define NORM_E_DIR(E) E0_DIR_WRITE(!INVERT_E0_DIR)
  679. #define REV_E_DIR(E) E0_DIR_WRITE( INVERT_E0_DIR)
  680. #else
  681. #define E_STEP_WRITE(E,V) NOOP
  682. #define NORM_E_DIR(E) NOOP
  683. #define REV_E_DIR(E) NOOP
  684. #endif