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.

indirection.h 18KB

123456789101112131415161718192021222324252627282930313233343536373839404142434445464748495051525354555657585960616263646566676869707172737475767778798081828384858687888990919293949596979899100101102103104105106107108109110111112113114115116117118119120121122123124125126127128129130131132133134135136137138139140141142143144145146147148149150151152153154155156157158159160161162163164165166167168169170171172173174175176177178179180181182183184185186187188189190191192193194195196197198199200201202203204205206207208209210211212213214215216217218219220221222223224225226227228229230231232233234235236237238239240241242243244245246247248249250251252253254255256257258259260261262263264265266267268269270271272273274275276277278279280281282283284285286287288289290291292293294295296297298299300301302303304305306307308309310311312313314315316317318319320321322323324325326327328329330331332333334335336337338339340341342343344345346347348349350351352353354355356357358359360361362363364365366367368369370371372373374375376377378379380381382383384385386387388389390391392393394395396397398399
  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. #if HAS_L64XX
  33. #include "L64xx.h"
  34. #endif
  35. #if HAS_DRIVER(TMC26X)
  36. #include "TMC26X.h"
  37. #endif
  38. #if HAS_TRINAMIC
  39. #include "trinamic.h"
  40. #endif
  41. void restore_stepper_drivers(); // Called by PSU_ON
  42. void reset_stepper_drivers(); // Called by settings.load / settings.reset
  43. // X Stepper
  44. #ifndef X_ENABLE_INIT
  45. #define X_ENABLE_INIT SET_OUTPUT(X_ENABLE_PIN)
  46. #define X_ENABLE_WRITE(STATE) WRITE(X_ENABLE_PIN,STATE)
  47. #define X_ENABLE_READ() READ(X_ENABLE_PIN)
  48. #endif
  49. #ifndef X_DIR_INIT
  50. #define X_DIR_INIT SET_OUTPUT(X_DIR_PIN)
  51. #define X_DIR_WRITE(STATE) WRITE(X_DIR_PIN,STATE)
  52. #define X_DIR_READ() READ(X_DIR_PIN)
  53. #endif
  54. #define X_STEP_INIT SET_OUTPUT(X_STEP_PIN)
  55. #ifndef X_STEP_WRITE
  56. #define X_STEP_WRITE(STATE) WRITE(X_STEP_PIN,STATE)
  57. #endif
  58. #define X_STEP_READ READ(X_STEP_PIN)
  59. // Y Stepper
  60. #ifndef Y_ENABLE_INIT
  61. #define Y_ENABLE_INIT SET_OUTPUT(Y_ENABLE_PIN)
  62. #define Y_ENABLE_WRITE(STATE) WRITE(Y_ENABLE_PIN,STATE)
  63. #define Y_ENABLE_READ() READ(Y_ENABLE_PIN)
  64. #endif
  65. #ifndef Y_DIR_INIT
  66. #define Y_DIR_INIT SET_OUTPUT(Y_DIR_PIN)
  67. #define Y_DIR_WRITE(STATE) WRITE(Y_DIR_PIN,STATE)
  68. #define Y_DIR_READ() READ(Y_DIR_PIN)
  69. #endif
  70. #define Y_STEP_INIT SET_OUTPUT(Y_STEP_PIN)
  71. #ifndef Y_STEP_WRITE
  72. #define Y_STEP_WRITE(STATE) WRITE(Y_STEP_PIN,STATE)
  73. #endif
  74. #define Y_STEP_READ READ(Y_STEP_PIN)
  75. // Z Stepper
  76. #ifndef Z_ENABLE_INIT
  77. #define Z_ENABLE_INIT SET_OUTPUT(Z_ENABLE_PIN)
  78. #define Z_ENABLE_WRITE(STATE) WRITE(Z_ENABLE_PIN,STATE)
  79. #define Z_ENABLE_READ() READ(Z_ENABLE_PIN)
  80. #endif
  81. #ifndef Z_DIR_INIT
  82. #define Z_DIR_INIT SET_OUTPUT(Z_DIR_PIN)
  83. #define Z_DIR_WRITE(STATE) WRITE(Z_DIR_PIN,STATE)
  84. #define Z_DIR_READ() READ(Z_DIR_PIN)
  85. #endif
  86. #define Z_STEP_INIT SET_OUTPUT(Z_STEP_PIN)
  87. #ifndef Z_STEP_WRITE
  88. #define Z_STEP_WRITE(STATE) WRITE(Z_STEP_PIN,STATE)
  89. #endif
  90. #define Z_STEP_READ READ(Z_STEP_PIN)
  91. // X2 Stepper
  92. #if HAS_X2_ENABLE
  93. #ifndef X2_ENABLE_INIT
  94. #define X2_ENABLE_INIT SET_OUTPUT(X2_ENABLE_PIN)
  95. #define X2_ENABLE_WRITE(STATE) WRITE(X2_ENABLE_PIN,STATE)
  96. #define X2_ENABLE_READ() READ(X2_ENABLE_PIN)
  97. #endif
  98. #ifndef X2_DIR_INIT
  99. #define X2_DIR_INIT SET_OUTPUT(X2_DIR_PIN)
  100. #define X2_DIR_WRITE(STATE) WRITE(X2_DIR_PIN,STATE)
  101. #define X2_DIR_READ() READ(X2_DIR_PIN)
  102. #endif
  103. #define X2_STEP_INIT SET_OUTPUT(X2_STEP_PIN)
  104. #ifndef X2_STEP_WRITE
  105. #define X2_STEP_WRITE(STATE) WRITE(X2_STEP_PIN,STATE)
  106. #endif
  107. #define X2_STEP_READ READ(X2_STEP_PIN)
  108. #endif
  109. // Y2 Stepper
  110. #if HAS_Y2_ENABLE
  111. #ifndef Y2_ENABLE_INIT
  112. #define Y2_ENABLE_INIT SET_OUTPUT(Y2_ENABLE_PIN)
  113. #define Y2_ENABLE_WRITE(STATE) WRITE(Y2_ENABLE_PIN,STATE)
  114. #define Y2_ENABLE_READ() READ(Y2_ENABLE_PIN)
  115. #endif
  116. #ifndef Y2_DIR_INIT
  117. #define Y2_DIR_INIT SET_OUTPUT(Y2_DIR_PIN)
  118. #define Y2_DIR_WRITE(STATE) WRITE(Y2_DIR_PIN,STATE)
  119. #define Y2_DIR_READ() READ(Y2_DIR_PIN)
  120. #endif
  121. #define Y2_STEP_INIT SET_OUTPUT(Y2_STEP_PIN)
  122. #ifndef Y2_STEP_WRITE
  123. #define Y2_STEP_WRITE(STATE) WRITE(Y2_STEP_PIN,STATE)
  124. #endif
  125. #define Y2_STEP_READ READ(Y2_STEP_PIN)
  126. #else
  127. #define Y2_DIR_WRITE(STATE) NOOP
  128. #endif
  129. // Z2 Stepper
  130. #if HAS_Z2_ENABLE
  131. #ifndef Z2_ENABLE_INIT
  132. #define Z2_ENABLE_INIT SET_OUTPUT(Z2_ENABLE_PIN)
  133. #define Z2_ENABLE_WRITE(STATE) WRITE(Z2_ENABLE_PIN,STATE)
  134. #define Z2_ENABLE_READ() READ(Z2_ENABLE_PIN)
  135. #endif
  136. #ifndef Z2_DIR_INIT
  137. #define Z2_DIR_INIT SET_OUTPUT(Z2_DIR_PIN)
  138. #define Z2_DIR_WRITE(STATE) WRITE(Z2_DIR_PIN,STATE)
  139. #define Z2_DIR_READ() READ(Z2_DIR_PIN)
  140. #endif
  141. #define Z2_STEP_INIT SET_OUTPUT(Z2_STEP_PIN)
  142. #ifndef Z2_STEP_WRITE
  143. #define Z2_STEP_WRITE(STATE) WRITE(Z2_STEP_PIN,STATE)
  144. #endif
  145. #define Z2_STEP_READ READ(Z2_STEP_PIN)
  146. #else
  147. #define Z2_DIR_WRITE(STATE) NOOP
  148. #endif
  149. // Z3 Stepper
  150. #if HAS_Z3_ENABLE
  151. #ifndef Z3_ENABLE_INIT
  152. #define Z3_ENABLE_INIT SET_OUTPUT(Z3_ENABLE_PIN)
  153. #define Z3_ENABLE_WRITE(STATE) WRITE(Z3_ENABLE_PIN,STATE)
  154. #define Z3_ENABLE_READ() READ(Z3_ENABLE_PIN)
  155. #endif
  156. #ifndef Z3_DIR_INIT
  157. #define Z3_DIR_INIT SET_OUTPUT(Z3_DIR_PIN)
  158. #define Z3_DIR_WRITE(STATE) WRITE(Z3_DIR_PIN,STATE)
  159. #define Z3_DIR_READ() READ(Z3_DIR_PIN)
  160. #endif
  161. #define Z3_STEP_INIT SET_OUTPUT(Z3_STEP_PIN)
  162. #ifndef Z3_STEP_WRITE
  163. #define Z3_STEP_WRITE(STATE) WRITE(Z3_STEP_PIN,STATE)
  164. #endif
  165. #define Z3_STEP_READ READ(Z3_STEP_PIN)
  166. #else
  167. #define Z3_DIR_WRITE(STATE) NOOP
  168. #endif
  169. // E0 Stepper
  170. #ifndef E0_ENABLE_INIT
  171. #define E0_ENABLE_INIT SET_OUTPUT(E0_ENABLE_PIN)
  172. #define E0_ENABLE_WRITE(STATE) WRITE(E0_ENABLE_PIN,STATE)
  173. #define E0_ENABLE_READ() READ(E0_ENABLE_PIN)
  174. #endif
  175. #ifndef E0_DIR_INIT
  176. #define E0_DIR_INIT SET_OUTPUT(E0_DIR_PIN)
  177. #define E0_DIR_WRITE(STATE) WRITE(E0_DIR_PIN,STATE)
  178. #define E0_DIR_READ() READ(E0_DIR_PIN)
  179. #endif
  180. #define E0_STEP_INIT SET_OUTPUT(E0_STEP_PIN)
  181. #ifndef E0_STEP_WRITE
  182. #define E0_STEP_WRITE(STATE) WRITE(E0_STEP_PIN,STATE)
  183. #endif
  184. #define E0_STEP_READ READ(E0_STEP_PIN)
  185. // E1 Stepper
  186. #ifndef E1_ENABLE_INIT
  187. #define E1_ENABLE_INIT SET_OUTPUT(E1_ENABLE_PIN)
  188. #define E1_ENABLE_WRITE(STATE) WRITE(E1_ENABLE_PIN,STATE)
  189. #define E1_ENABLE_READ() READ(E1_ENABLE_PIN)
  190. #endif
  191. #ifndef E1_DIR_INIT
  192. #define E1_DIR_INIT SET_OUTPUT(E1_DIR_PIN)
  193. #define E1_DIR_WRITE(STATE) WRITE(E1_DIR_PIN,STATE)
  194. #define E1_DIR_READ() READ(E1_DIR_PIN)
  195. #endif
  196. #define E1_STEP_INIT SET_OUTPUT(E1_STEP_PIN)
  197. #ifndef E1_STEP_WRITE
  198. #define E1_STEP_WRITE(STATE) WRITE(E1_STEP_PIN,STATE)
  199. #endif
  200. #define E1_STEP_READ READ(E1_STEP_PIN)
  201. // E2 Stepper
  202. #ifndef E2_ENABLE_INIT
  203. #define E2_ENABLE_INIT SET_OUTPUT(E2_ENABLE_PIN)
  204. #define E2_ENABLE_WRITE(STATE) WRITE(E2_ENABLE_PIN,STATE)
  205. #define E2_ENABLE_READ() READ(E2_ENABLE_PIN)
  206. #endif
  207. #ifndef E2_DIR_INIT
  208. #define E2_DIR_INIT SET_OUTPUT(E2_DIR_PIN)
  209. #define E2_DIR_WRITE(STATE) WRITE(E2_DIR_PIN,STATE)
  210. #define E2_DIR_READ() READ(E2_DIR_PIN)
  211. #endif
  212. #define E2_STEP_INIT SET_OUTPUT(E2_STEP_PIN)
  213. #ifndef E2_STEP_WRITE
  214. #define E2_STEP_WRITE(STATE) WRITE(E2_STEP_PIN,STATE)
  215. #endif
  216. #define E2_STEP_READ READ(E2_STEP_PIN)
  217. // E3 Stepper
  218. #ifndef E3_ENABLE_INIT
  219. #define E3_ENABLE_INIT SET_OUTPUT(E3_ENABLE_PIN)
  220. #define E3_ENABLE_WRITE(STATE) WRITE(E3_ENABLE_PIN,STATE)
  221. #define E3_ENABLE_READ() READ(E3_ENABLE_PIN)
  222. #endif
  223. #ifndef E3_DIR_INIT
  224. #define E3_DIR_INIT SET_OUTPUT(E3_DIR_PIN)
  225. #define E3_DIR_WRITE(STATE) WRITE(E3_DIR_PIN,STATE)
  226. #define E3_DIR_READ() READ(E3_DIR_PIN)
  227. #endif
  228. #define E3_STEP_INIT SET_OUTPUT(E3_STEP_PIN)
  229. #ifndef E3_STEP_WRITE
  230. #define E3_STEP_WRITE(STATE) WRITE(E3_STEP_PIN,STATE)
  231. #endif
  232. #define E3_STEP_READ READ(E3_STEP_PIN)
  233. // E4 Stepper
  234. #ifndef E4_ENABLE_INIT
  235. #define E4_ENABLE_INIT SET_OUTPUT(E4_ENABLE_PIN)
  236. #define E4_ENABLE_WRITE(STATE) WRITE(E4_ENABLE_PIN,STATE)
  237. #define E4_ENABLE_READ() READ(E4_ENABLE_PIN)
  238. #endif
  239. #ifndef E4_DIR_INIT
  240. #define E4_DIR_INIT SET_OUTPUT(E4_DIR_PIN)
  241. #define E4_DIR_WRITE(STATE) WRITE(E4_DIR_PIN,STATE)
  242. #define E4_DIR_READ() READ(E4_DIR_PIN)
  243. #endif
  244. #define E4_STEP_INIT SET_OUTPUT(E4_STEP_PIN)
  245. #ifndef E4_STEP_WRITE
  246. #define E4_STEP_WRITE(STATE) WRITE(E4_STEP_PIN,STATE)
  247. #endif
  248. #define E4_STEP_READ READ(E4_STEP_PIN)
  249. // E5 Stepper
  250. #ifndef E5_ENABLE_INIT
  251. #define E5_ENABLE_INIT SET_OUTPUT(E5_ENABLE_PIN)
  252. #define E5_ENABLE_WRITE(STATE) WRITE(E5_ENABLE_PIN,STATE)
  253. #define E5_ENABLE_READ() READ(E5_ENABLE_PIN)
  254. #endif
  255. #ifndef E5_DIR_INIT
  256. #define E5_DIR_INIT SET_OUTPUT(E5_DIR_PIN)
  257. #define E5_DIR_WRITE(STATE) WRITE(E5_DIR_PIN,STATE)
  258. #define E5_DIR_READ() READ(E5_DIR_PIN)
  259. #endif
  260. #define E5_STEP_INIT SET_OUTPUT(E5_STEP_PIN)
  261. #ifndef E5_STEP_WRITE
  262. #define E5_STEP_WRITE(STATE) WRITE(E5_STEP_PIN,STATE)
  263. #endif
  264. #define E5_STEP_READ READ(E5_STEP_PIN)
  265. /**
  266. * Extruder indirection for the single E axis
  267. */
  268. #if ENABLED(SWITCHING_EXTRUDER) // One stepper driver per two extruders, reversed on odd index
  269. #if EXTRUDERS > 5
  270. #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)
  271. #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)
  272. #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)
  273. #elif EXTRUDERS > 4
  274. #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)
  275. #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)
  276. #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)
  277. #elif EXTRUDERS > 3
  278. #define E_STEP_WRITE(E,V) do{ if (E < 2) { E0_STEP_WRITE(V); } else { E1_STEP_WRITE(V); } }while(0)
  279. #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)
  280. #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)
  281. #elif EXTRUDERS > 2
  282. #define E_STEP_WRITE(E,V) do{ if (E < 2) { E0_STEP_WRITE(V); } else { E1_STEP_WRITE(V); } }while(0)
  283. #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)
  284. #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)
  285. #else
  286. #define E_STEP_WRITE(E,V) E0_STEP_WRITE(V)
  287. #define NORM_E_DIR(E) do{ E0_DIR_WRITE(E ? INVERT_E0_DIR : !INVERT_E0_DIR); }while(0)
  288. #define REV_E_DIR(E) do{ E0_DIR_WRITE(E ? !INVERT_E0_DIR : INVERT_E0_DIR); }while(0)
  289. #endif
  290. #elif ENABLED(PRUSA_MMU2)
  291. #define E_STEP_WRITE(E,V) E0_STEP_WRITE(V)
  292. #define NORM_E_DIR(E) E0_DIR_WRITE(!INVERT_E0_DIR)
  293. #define REV_E_DIR(E) E0_DIR_WRITE( INVERT_E0_DIR)
  294. #elif ENABLED(MK2_MULTIPLEXER) // One multiplexed stepper driver, reversed on odd index
  295. #define E_STEP_WRITE(E,V) E0_STEP_WRITE(V)
  296. #define NORM_E_DIR(E) do{ E0_DIR_WRITE(TEST(E, 0) ? !INVERT_E0_DIR: INVERT_E0_DIR); }while(0)
  297. #define REV_E_DIR(E) do{ E0_DIR_WRITE(TEST(E, 0) ? INVERT_E0_DIR: !INVERT_E0_DIR); }while(0)
  298. #elif E_STEPPERS > 1
  299. #if E_STEPPERS > 5
  300. #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)
  301. #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)
  302. #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)
  303. #elif E_STEPPERS > 4
  304. #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)
  305. #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)
  306. #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)
  307. #elif E_STEPPERS > 3
  308. #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)
  309. #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)
  310. #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)
  311. #elif E_STEPPERS > 2
  312. #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)
  313. #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)
  314. #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)
  315. #else
  316. #define _E_STEP_WRITE(E,V) do{ if (E == 0) { E0_STEP_WRITE(V); } else { E1_STEP_WRITE(V); } }while(0)
  317. #define _NORM_E_DIR(E) do{ if (E == 0) { E0_DIR_WRITE(!INVERT_E0_DIR); } else { E1_DIR_WRITE(!INVERT_E1_DIR); } }while(0)
  318. #define _REV_E_DIR(E) do{ if (E == 0) { E0_DIR_WRITE( INVERT_E0_DIR); } else { E1_DIR_WRITE( INVERT_E1_DIR); } }while(0)
  319. #endif
  320. #if HAS_DUPLICATION_MODE
  321. #if ENABLED(MULTI_NOZZLE_DUPLICATION)
  322. #define _DUPE(N,T,V) do{ if (TEST(duplication_e_mask, N)) E##N##_##T##_WRITE(V); }while(0)
  323. #else
  324. #define _DUPE(N,T,V) E##N##_##T##_WRITE(V)
  325. #endif
  326. #define NDIR(N) _DUPE(N,DIR,!INVERT_E##N##_DIR)
  327. #define RDIR(N) _DUPE(N,DIR, INVERT_E##N##_DIR)
  328. #define E_STEP_WRITE(E,V) do{ if (extruder_duplication_enabled) { DUPE(STEP,V); } else _E_STEP_WRITE(E,V); }while(0)
  329. #if E_STEPPERS > 2
  330. #if E_STEPPERS > 5
  331. #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)
  332. #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)
  333. #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)
  334. #elif E_STEPPERS > 4
  335. #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)
  336. #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)
  337. #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)
  338. #elif E_STEPPERS > 3
  339. #define DUPE(T,V) do{ _DUPE(0,T,V); _DUPE(1,T,V); _DUPE(2,T,V); _DUPE(3,T,V); }while(0)
  340. #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)
  341. #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)
  342. #else
  343. #define DUPE(T,V) do{ _DUPE(0,T,V); _DUPE(1,T,V); _DUPE(2,T,V); }while(0)
  344. #define NORM_E_DIR(E) do{ if (extruder_duplication_enabled) { NDIR(0); NDIR(1); NDIR(2); } else _NORM_E_DIR(E); }while(0)
  345. #define REV_E_DIR(E) do{ if (extruder_duplication_enabled) { RDIR(0); RDIR(1); RDIR(2); } else _REV_E_DIR(E); }while(0)
  346. #endif
  347. #else
  348. #define DUPE(T,V) do{ _DUPE(0,T,V); _DUPE(1,T,V); }while(0)
  349. #define NORM_E_DIR(E) do{ if (extruder_duplication_enabled) { NDIR(0); NDIR(1); } else _NORM_E_DIR(E); }while(0)
  350. #define REV_E_DIR(E) do{ if (extruder_duplication_enabled) { RDIR(0); RDIR(1); } else _REV_E_DIR(E); }while(0)
  351. #endif
  352. #else
  353. #define E_STEP_WRITE(E,V) _E_STEP_WRITE(E,V)
  354. #define NORM_E_DIR(E) _NORM_E_DIR(E)
  355. #define REV_E_DIR(E) _REV_E_DIR(E)
  356. #endif
  357. #elif E_STEPPERS
  358. #define E_STEP_WRITE(E,V) E0_STEP_WRITE(V)
  359. #define NORM_E_DIR(E) E0_DIR_WRITE(!INVERT_E0_DIR)
  360. #define REV_E_DIR(E) E0_DIR_WRITE( INVERT_E0_DIR)
  361. #else
  362. #define E_STEP_WRITE(E,V) NOOP
  363. #define NORM_E_DIR(E) NOOP
  364. #define REV_E_DIR(E) NOOP
  365. #endif