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.

G28.cpp 21KB

123456789101112131415161718192021222324252627282930313233343536373839404142434445464748495051525354555657585960616263646566676869707172737475767778798081828384858687888990919293949596979899100101102103104105106107108109110111112113114115116117118119120121122123124125126127128129130131132133134135136137138139140141142143144145146147148149150151152153154155156157158159160161162163164165166167168169170171172173174175176177178179180181182183184185186187188189190191192193194195196197198199200201202203204205206207208209210211212213214215216217218219220221222223224225226227228229230231232233234235236237238239240241242243244245246247248249250251252253254255256257258259260261262263264265266267268269270271272273274275276277278279280281282283284285286287288289290291292293294295296297298299300301302303304305306307308309310311312313314315316317318319320321322323324325326327328329330331332333334335336337338339340341342343344345346347348349350351352353354355356357358359360361362363364365366367368369370371372373374375376377378379380381382383384385386387388389390391392393394395396397398399400401402403404405406407408409410411412413414415416417418419420421422423424425426427428429430431432433434435436437438439440441442443444445446447448449450451452453454455456457458459460461462463464465466467468469470471472473474475476477478479480481482483484485486487488489490491492493494495496497498499500501502503504505506507508509510511512513514515516517518519520521522523524525526527528529530531532533534535536537538539540541542543544545546547548549550551552553554555556557558559560561562563564565566567568569570571572573574575576577578579580581582583584585586587588589590591592593594595596597598599600601602603604605606607608609610611612613614615616617618619620
  1. /**
  2. * Marlin 3D Printer Firmware
  3. * Copyright (c) 2020 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 <https://www.gnu.org/licenses/>.
  20. *
  21. */
  22. #include "../../inc/MarlinConfig.h"
  23. #include "../gcode.h"
  24. #include "../../module/stepper.h"
  25. #include "../../module/endstops.h"
  26. #if HAS_MULTI_HOTEND
  27. #include "../../module/tool_change.h"
  28. #endif
  29. #if HAS_LEVELING
  30. #include "../../feature/bedlevel/bedlevel.h"
  31. #endif
  32. #if ENABLED(SENSORLESS_HOMING)
  33. #include "../../feature/tmc_util.h"
  34. #endif
  35. #include "../../module/probe.h"
  36. #if ENABLED(BLTOUCH)
  37. #include "../../feature/bltouch.h"
  38. #endif
  39. #include "../../lcd/marlinui.h"
  40. #if ENABLED(EXTENSIBLE_UI)
  41. #include "../../lcd/extui/ui_api.h"
  42. #elif ENABLED(DWIN_CREALITY_LCD)
  43. #include "../../lcd/e3v2/creality/dwin.h"
  44. #elif ENABLED(DWIN_LCD_PROUI)
  45. #include "../../lcd/e3v2/proui/dwin.h"
  46. #endif
  47. #if HAS_L64XX // set L6470 absolute position registers to counts
  48. #include "../../libs/L64XX/L64XX_Marlin.h"
  49. #endif
  50. #if ENABLED(LASER_FEATURE)
  51. #include "../../feature/spindle_laser.h"
  52. #endif
  53. #define DEBUG_OUT ENABLED(DEBUG_LEVELING_FEATURE)
  54. #include "../../core/debug_out.h"
  55. #if ENABLED(QUICK_HOME)
  56. static void quick_home_xy() {
  57. // Pretend the current position is 0,0
  58. current_position.set(0.0, 0.0);
  59. sync_plan_position();
  60. const int x_axis_home_dir = TOOL_X_HOME_DIR(active_extruder);
  61. // Use a higher diagonal feedrate so axes move at homing speed
  62. const float minfr = _MIN(homing_feedrate(X_AXIS), homing_feedrate(Y_AXIS)),
  63. fr_mm_s = HYPOT(minfr, minfr);
  64. #if ENABLED(SENSORLESS_HOMING)
  65. sensorless_t stealth_states {
  66. NUM_AXIS_LIST(
  67. TERN0(X_SENSORLESS, tmc_enable_stallguard(stepperX)),
  68. TERN0(Y_SENSORLESS, tmc_enable_stallguard(stepperY)),
  69. false, false, false, false
  70. )
  71. , TERN0(X2_SENSORLESS, tmc_enable_stallguard(stepperX2))
  72. , TERN0(Y2_SENSORLESS, tmc_enable_stallguard(stepperY2))
  73. };
  74. #endif
  75. do_blocking_move_to_xy(1.5 * max_length(X_AXIS) * x_axis_home_dir, 1.5 * max_length(Y_AXIS) * Y_HOME_DIR, fr_mm_s);
  76. endstops.validate_homing_move();
  77. current_position.set(0.0, 0.0);
  78. #if ENABLED(SENSORLESS_HOMING) && DISABLED(ENDSTOPS_ALWAYS_ON_DEFAULT)
  79. TERN_(X_SENSORLESS, tmc_disable_stallguard(stepperX, stealth_states.x));
  80. TERN_(X2_SENSORLESS, tmc_disable_stallguard(stepperX2, stealth_states.x2));
  81. TERN_(Y_SENSORLESS, tmc_disable_stallguard(stepperY, stealth_states.y));
  82. TERN_(Y2_SENSORLESS, tmc_disable_stallguard(stepperY2, stealth_states.y2));
  83. #endif
  84. }
  85. #endif // QUICK_HOME
  86. #if ENABLED(Z_SAFE_HOMING)
  87. inline void home_z_safely() {
  88. DEBUG_SECTION(log_G28, "home_z_safely", DEBUGGING(LEVELING));
  89. // Disallow Z homing if X or Y homing is needed
  90. if (homing_needed_error(_BV(X_AXIS) | _BV(Y_AXIS))) return;
  91. sync_plan_position();
  92. /**
  93. * Move the Z probe (or just the nozzle) to the safe homing point
  94. * (Z is already at the right height)
  95. */
  96. constexpr xy_float_t safe_homing_xy = { Z_SAFE_HOMING_X_POINT, Z_SAFE_HOMING_Y_POINT };
  97. #if HAS_HOME_OFFSET
  98. xy_float_t okay_homing_xy = safe_homing_xy;
  99. okay_homing_xy -= home_offset;
  100. #else
  101. constexpr xy_float_t okay_homing_xy = safe_homing_xy;
  102. #endif
  103. destination.set(okay_homing_xy, current_position.z);
  104. TERN_(HOMING_Z_WITH_PROBE, destination -= probe.offset_xy);
  105. if (position_is_reachable(destination)) {
  106. if (DEBUGGING(LEVELING)) DEBUG_POS("home_z_safely", destination);
  107. // Free the active extruder for movement
  108. TERN_(DUAL_X_CARRIAGE, idex_set_parked(false));
  109. TERN_(SENSORLESS_HOMING, safe_delay(500)); // Short delay needed to settle
  110. do_blocking_move_to_xy(destination);
  111. homeaxis(Z_AXIS);
  112. }
  113. else {
  114. LCD_MESSAGE(MSG_ZPROBE_OUT);
  115. SERIAL_ECHO_MSG(STR_ZPROBE_OUT_SER);
  116. }
  117. }
  118. #endif // Z_SAFE_HOMING
  119. #if ENABLED(IMPROVE_HOMING_RELIABILITY)
  120. motion_state_t begin_slow_homing() {
  121. motion_state_t motion_state{0};
  122. motion_state.acceleration.set(planner.settings.max_acceleration_mm_per_s2[X_AXIS],
  123. planner.settings.max_acceleration_mm_per_s2[Y_AXIS]
  124. OPTARG(DELTA, planner.settings.max_acceleration_mm_per_s2[Z_AXIS])
  125. );
  126. planner.settings.max_acceleration_mm_per_s2[X_AXIS] = 100;
  127. planner.settings.max_acceleration_mm_per_s2[Y_AXIS] = 100;
  128. TERN_(DELTA, planner.settings.max_acceleration_mm_per_s2[Z_AXIS] = 100);
  129. #if HAS_CLASSIC_JERK
  130. motion_state.jerk_state = planner.max_jerk;
  131. planner.max_jerk.set(0, 0 OPTARG(DELTA, 0));
  132. #endif
  133. planner.refresh_acceleration_rates();
  134. return motion_state;
  135. }
  136. void end_slow_homing(const motion_state_t &motion_state) {
  137. planner.settings.max_acceleration_mm_per_s2[X_AXIS] = motion_state.acceleration.x;
  138. planner.settings.max_acceleration_mm_per_s2[Y_AXIS] = motion_state.acceleration.y;
  139. TERN_(DELTA, planner.settings.max_acceleration_mm_per_s2[Z_AXIS] = motion_state.acceleration.z);
  140. TERN_(HAS_CLASSIC_JERK, planner.max_jerk = motion_state.jerk_state);
  141. planner.refresh_acceleration_rates();
  142. }
  143. #endif // IMPROVE_HOMING_RELIABILITY
  144. /**
  145. * G28: Home all axes according to settings
  146. *
  147. * Parameters
  148. *
  149. * None Home to all axes with no parameters.
  150. * With QUICK_HOME enabled XY will home together, then Z.
  151. *
  152. * L<bool> Force leveling state ON (if possible) or OFF after homing (Requires RESTORE_LEVELING_AFTER_G28 or ENABLE_LEVELING_AFTER_G28)
  153. * O Home only if the position is not known and trusted
  154. * R<linear> Raise by n mm/inches before homing
  155. *
  156. * Cartesian/SCARA parameters
  157. *
  158. * X Home to the X endstop
  159. * Y Home to the Y endstop
  160. * Z Home to the Z endstop
  161. */
  162. void GcodeSuite::G28() {
  163. DEBUG_SECTION(log_G28, "G28", DEBUGGING(LEVELING));
  164. if (DEBUGGING(LEVELING)) log_machine_info();
  165. /*
  166. * Set the laser power to false to stop the planner from processing the current power setting.
  167. */
  168. #if ENABLED(LASER_FEATURE)
  169. planner.laser_inline.status.isPowered = false;
  170. #endif
  171. #if ENABLED(DUAL_X_CARRIAGE)
  172. bool IDEX_saved_duplication_state = extruder_duplication_enabled;
  173. DualXMode IDEX_saved_mode = dual_x_carriage_mode;
  174. #endif
  175. #if ENABLED(MARLIN_DEV_MODE)
  176. if (parser.seen_test('S')) {
  177. LOOP_NUM_AXES(a) set_axis_is_at_home((AxisEnum)a);
  178. sync_plan_position();
  179. SERIAL_ECHOLNPGM("Simulated Homing");
  180. report_current_position();
  181. return;
  182. }
  183. #endif
  184. // Home (O)nly if position is unknown
  185. if (!axes_should_home() && parser.seen_test('O')) {
  186. if (DEBUGGING(LEVELING)) DEBUG_ECHOLNPGM("> homing not needed, skip");
  187. return;
  188. }
  189. #if ENABLED(FULL_REPORT_TO_HOST_FEATURE)
  190. const M_StateEnum old_grblstate = M_State_grbl;
  191. set_and_report_grblstate(M_HOMING);
  192. #endif
  193. TERN_(HAS_DWIN_E3V2_BASIC, DWIN_HomingStart());
  194. TERN_(EXTENSIBLE_UI, ExtUI::onHomingStart());
  195. planner.synchronize(); // Wait for planner moves to finish!
  196. SET_SOFT_ENDSTOP_LOOSE(false); // Reset a leftover 'loose' motion state
  197. // Disable the leveling matrix before homing
  198. #if CAN_SET_LEVELING_AFTER_G28
  199. const bool leveling_restore_state = parser.boolval('L', TERN1(RESTORE_LEVELING_AFTER_G28, planner.leveling_active));
  200. #endif
  201. // Cancel any prior G29 session
  202. TERN_(PROBE_MANUALLY, g29_in_progress = false);
  203. // Disable leveling before homing
  204. TERN_(HAS_LEVELING, set_bed_leveling_enabled(false));
  205. // Reset to the XY plane
  206. TERN_(CNC_WORKSPACE_PLANES, workspace_plane = PLANE_XY);
  207. // Count this command as movement / activity
  208. reset_stepper_timeout();
  209. #define HAS_CURRENT_HOME(N) (defined(N##_CURRENT_HOME) && N##_CURRENT_HOME != N##_CURRENT)
  210. #if HAS_CURRENT_HOME(X) || HAS_CURRENT_HOME(X2) || HAS_CURRENT_HOME(Y) || HAS_CURRENT_HOME(Y2) || (ENABLED(DELTA) && HAS_CURRENT_HOME(Z)) || HAS_CURRENT_HOME(I) || HAS_CURRENT_HOME(J) || HAS_CURRENT_HOME(K) || HAS_CURRENT_HOME(U) || HAS_CURRENT_HOME(V) || HAS_CURRENT_HOME(W)
  211. #define HAS_HOMING_CURRENT 1
  212. #endif
  213. #if HAS_HOMING_CURRENT
  214. auto debug_current = [](FSTR_P const s, const int16_t a, const int16_t b) {
  215. DEBUG_ECHOF(s); DEBUG_ECHOLNPGM(" current: ", a, " -> ", b);
  216. };
  217. #if HAS_CURRENT_HOME(X)
  218. const int16_t tmc_save_current_X = stepperX.getMilliamps();
  219. stepperX.rms_current(X_CURRENT_HOME);
  220. if (DEBUGGING(LEVELING)) debug_current(F(STR_X), tmc_save_current_X, X_CURRENT_HOME);
  221. #endif
  222. #if HAS_CURRENT_HOME(X2)
  223. const int16_t tmc_save_current_X2 = stepperX2.getMilliamps();
  224. stepperX2.rms_current(X2_CURRENT_HOME);
  225. if (DEBUGGING(LEVELING)) debug_current(F(STR_X2), tmc_save_current_X2, X2_CURRENT_HOME);
  226. #endif
  227. #if HAS_CURRENT_HOME(Y)
  228. const int16_t tmc_save_current_Y = stepperY.getMilliamps();
  229. stepperY.rms_current(Y_CURRENT_HOME);
  230. if (DEBUGGING(LEVELING)) debug_current(F(STR_Y), tmc_save_current_Y, Y_CURRENT_HOME);
  231. #endif
  232. #if HAS_CURRENT_HOME(Y2)
  233. const int16_t tmc_save_current_Y2 = stepperY2.getMilliamps();
  234. stepperY2.rms_current(Y2_CURRENT_HOME);
  235. if (DEBUGGING(LEVELING)) debug_current(F(STR_Y2), tmc_save_current_Y2, Y2_CURRENT_HOME);
  236. #endif
  237. #if HAS_CURRENT_HOME(Z) && ENABLED(DELTA)
  238. const int16_t tmc_save_current_Z = stepperZ.getMilliamps();
  239. stepperZ.rms_current(Z_CURRENT_HOME);
  240. if (DEBUGGING(LEVELING)) debug_current(F(STR_Z), tmc_save_current_Z, Z_CURRENT_HOME);
  241. #endif
  242. #if HAS_CURRENT_HOME(I)
  243. const int16_t tmc_save_current_I = stepperI.getMilliamps();
  244. stepperI.rms_current(I_CURRENT_HOME);
  245. if (DEBUGGING(LEVELING)) debug_current(F(STR_I), tmc_save_current_I, I_CURRENT_HOME);
  246. #endif
  247. #if HAS_CURRENT_HOME(J)
  248. const int16_t tmc_save_current_J = stepperJ.getMilliamps();
  249. stepperJ.rms_current(J_CURRENT_HOME);
  250. if (DEBUGGING(LEVELING)) debug_current(F(STR_J), tmc_save_current_J, J_CURRENT_HOME);
  251. #endif
  252. #if HAS_CURRENT_HOME(K)
  253. const int16_t tmc_save_current_K = stepperK.getMilliamps();
  254. stepperK.rms_current(K_CURRENT_HOME);
  255. if (DEBUGGING(LEVELING)) debug_current(F(STR_K), tmc_save_current_K, K_CURRENT_HOME);
  256. #endif
  257. #if HAS_CURRENT_HOME(U)
  258. const int16_t tmc_save_current_U = stepperU.getMilliamps();
  259. stepperU.rms_current(U_CURRENT_HOME);
  260. if (DEBUGGING(LEVELING)) debug_current(F(STR_U), tmc_save_current_U, U_CURRENT_HOME);
  261. #endif
  262. #if HAS_CURRENT_HOME(V)
  263. const int16_t tmc_save_current_V = stepperV.getMilliamps();
  264. stepperV.rms_current(V_CURRENT_HOME);
  265. if (DEBUGGING(LEVELING)) debug_current(F(STR_V), tmc_save_current_V, V_CURRENT_HOME);
  266. #endif
  267. #if HAS_CURRENT_HOME(W)
  268. const int16_t tmc_save_current_W = stepperW.getMilliamps();
  269. stepperW.rms_current(W_CURRENT_HOME);
  270. if (DEBUGGING(LEVELING)) debug_current(F(STR_W), tmc_save_current_W, W_CURRENT_HOME);
  271. #endif
  272. #if SENSORLESS_STALLGUARD_DELAY
  273. safe_delay(SENSORLESS_STALLGUARD_DELAY); // Short delay needed to settle
  274. #endif
  275. #endif
  276. #if ENABLED(IMPROVE_HOMING_RELIABILITY)
  277. motion_state_t saved_motion_state = begin_slow_homing();
  278. #endif
  279. // Always home with tool 0 active
  280. #if HAS_MULTI_HOTEND
  281. #if DISABLED(DELTA) || ENABLED(DELTA_HOME_TO_SAFE_ZONE)
  282. const uint8_t old_tool_index = active_extruder;
  283. #endif
  284. // PARKING_EXTRUDER homing requires different handling of movement / solenoid activation, depending on the side of homing
  285. #if ENABLED(PARKING_EXTRUDER)
  286. const bool pe_final_change_must_unpark = parking_extruder_unpark_after_homing(old_tool_index, X_HOME_DIR + 1 == old_tool_index * 2);
  287. #endif
  288. tool_change(0, true);
  289. #endif
  290. TERN_(HAS_DUPLICATION_MODE, set_duplication_enabled(false));
  291. remember_feedrate_scaling_off();
  292. endstops.enable(true); // Enable endstops for next homing move
  293. #if ENABLED(DELTA)
  294. constexpr bool doZ = true; // for NANODLP_Z_SYNC if your DLP is on a DELTA
  295. home_delta();
  296. TERN_(IMPROVE_HOMING_RELIABILITY, end_slow_homing(saved_motion_state));
  297. #elif ENABLED(AXEL_TPARA)
  298. constexpr bool doZ = true; // for NANODLP_Z_SYNC if your DLP is on a TPARA
  299. home_TPARA();
  300. #else
  301. #define _UNSAFE(A) (homeZ && TERN0(Z_SAFE_HOMING, axes_should_home(_BV(A##_AXIS))))
  302. const bool homeZ = TERN0(HAS_Z_AXIS, parser.seen_test('Z')),
  303. NUM_AXIS_LIST( // Other axes should be homed before Z safe-homing
  304. needX = _UNSAFE(X), needY = _UNSAFE(Y), needZ = false, // UNUSED
  305. needI = _UNSAFE(I), needJ = _UNSAFE(J), needK = _UNSAFE(K),
  306. needU = _UNSAFE(U), needV = _UNSAFE(V), needW = _UNSAFE(W)
  307. ),
  308. NUM_AXIS_LIST( // Home each axis if needed or flagged
  309. homeX = needX || parser.seen_test('X'),
  310. homeY = needY || parser.seen_test('Y'),
  311. homeZZ = homeZ,
  312. homeI = needI || parser.seen_test(AXIS4_NAME), homeJ = needJ || parser.seen_test(AXIS5_NAME),
  313. homeK = needK || parser.seen_test(AXIS6_NAME), homeU = needU || parser.seen_test(AXIS7_NAME),
  314. homeV = needV || parser.seen_test(AXIS8_NAME), homeW = needW || parser.seen_test(AXIS9_NAME)
  315. ),
  316. home_all = NUM_AXIS_GANG( // Home-all if all or none are flagged
  317. homeX == homeX, && homeY == homeX, && homeZ == homeX,
  318. && homeI == homeX, && homeJ == homeX, && homeK == homeX,
  319. && homeU == homeX, && homeV == homeX, && homeW == homeX
  320. ),
  321. NUM_AXIS_LIST(
  322. doX = home_all || homeX, doY = home_all || homeY, doZ = home_all || homeZ,
  323. doI = home_all || homeI, doJ = home_all || homeJ, doK = home_all || homeK,
  324. doU = home_all || homeU, doV = home_all || homeV, doW = home_all || homeW
  325. );
  326. #if HAS_Z_AXIS
  327. UNUSED(needZ); UNUSED(homeZZ);
  328. #else
  329. constexpr bool doZ = false;
  330. #endif
  331. TERN_(HOME_Z_FIRST, if (doZ) homeaxis(Z_AXIS));
  332. const bool seenR = parser.seenval('R');
  333. const float z_homing_height = seenR ? parser.value_linear_units() : Z_HOMING_HEIGHT;
  334. if (z_homing_height && (seenR || NUM_AXIS_GANG(doX, || doY, || TERN0(Z_SAFE_HOMING, doZ), || doI, || doJ, || doK, || doU, || doV, || doW))) {
  335. // Raise Z before homing any other axes and z is not already high enough (never lower z)
  336. if (DEBUGGING(LEVELING)) DEBUG_ECHOLNPGM("Raise Z (before homing) by ", z_homing_height);
  337. do_z_clearance(z_homing_height);
  338. TERN_(BLTOUCH, bltouch.init());
  339. }
  340. // Diagonal move first if both are homing
  341. TERN_(QUICK_HOME, if (doX && doY) quick_home_xy());
  342. // Home Y (before X)
  343. if (ENABLED(HOME_Y_BEFORE_X) && (doY || TERN0(CODEPENDENT_XY_HOMING, doX)))
  344. homeaxis(Y_AXIS);
  345. // Home X
  346. if (doX || (doY && ENABLED(CODEPENDENT_XY_HOMING) && DISABLED(HOME_Y_BEFORE_X))) {
  347. #if ENABLED(DUAL_X_CARRIAGE)
  348. // Always home the 2nd (right) extruder first
  349. active_extruder = 1;
  350. homeaxis(X_AXIS);
  351. // Remember this extruder's position for later tool change
  352. inactive_extruder_x = current_position.x;
  353. // Home the 1st (left) extruder
  354. active_extruder = 0;
  355. homeaxis(X_AXIS);
  356. // Consider the active extruder to be in its "parked" position
  357. idex_set_parked();
  358. #else
  359. homeaxis(X_AXIS);
  360. #endif
  361. }
  362. #if BOTH(FOAMCUTTER_XYUV, HAS_I_AXIS)
  363. // Home I (after X)
  364. if (doI) homeaxis(I_AXIS);
  365. #endif
  366. // Home Y (after X)
  367. if (DISABLED(HOME_Y_BEFORE_X) && doY)
  368. homeaxis(Y_AXIS);
  369. #if BOTH(FOAMCUTTER_XYUV, HAS_J_AXIS)
  370. // Home J (after Y)
  371. if (doJ) homeaxis(J_AXIS);
  372. #endif
  373. TERN_(IMPROVE_HOMING_RELIABILITY, end_slow_homing(saved_motion_state));
  374. #if ENABLED(FOAMCUTTER_XYUV)
  375. // skip homing of unused Z axis for foamcutters
  376. if (doZ) set_axis_is_at_home(Z_AXIS);
  377. #else
  378. // Home Z last if homing towards the bed
  379. #if HAS_Z_AXIS && DISABLED(HOME_Z_FIRST)
  380. if (doZ) {
  381. #if EITHER(Z_MULTI_ENDSTOPS, Z_STEPPER_AUTO_ALIGN)
  382. stepper.set_all_z_lock(false);
  383. stepper.set_separate_multi_axis(false);
  384. #endif
  385. #if ENABLED(Z_SAFE_HOMING)
  386. if (TERN1(POWER_LOSS_RECOVERY, !parser.seen_test('H'))) home_z_safely(); else homeaxis(Z_AXIS);
  387. #else
  388. homeaxis(Z_AXIS);
  389. #endif
  390. probe.move_z_after_homing();
  391. }
  392. #endif
  393. SECONDARY_AXIS_CODE(
  394. if (doI) homeaxis(I_AXIS),
  395. if (doJ) homeaxis(J_AXIS),
  396. if (doK) homeaxis(K_AXIS),
  397. if (doU) homeaxis(U_AXIS),
  398. if (doV) homeaxis(V_AXIS),
  399. if (doW) homeaxis(W_AXIS)
  400. );
  401. #endif
  402. sync_plan_position();
  403. #endif
  404. /**
  405. * Preserve DXC mode across a G28 for IDEX printers in DXC_DUPLICATION_MODE.
  406. * This is important because it lets a user use the LCD Panel to set an IDEX Duplication mode, and
  407. * then print a standard GCode file that contains a single print that does a G28 and has no other
  408. * IDEX specific commands in it.
  409. */
  410. #if ENABLED(DUAL_X_CARRIAGE)
  411. if (idex_is_duplicating()) {
  412. TERN_(IMPROVE_HOMING_RELIABILITY, saved_motion_state = begin_slow_homing());
  413. // Always home the 2nd (right) extruder first
  414. active_extruder = 1;
  415. homeaxis(X_AXIS);
  416. // Remember this extruder's position for later tool change
  417. inactive_extruder_x = current_position.x;
  418. // Home the 1st (left) extruder
  419. active_extruder = 0;
  420. homeaxis(X_AXIS);
  421. // Consider the active extruder to be parked
  422. idex_set_parked();
  423. dual_x_carriage_mode = IDEX_saved_mode;
  424. set_duplication_enabled(IDEX_saved_duplication_state);
  425. TERN_(IMPROVE_HOMING_RELIABILITY, end_slow_homing(saved_motion_state));
  426. }
  427. #endif // DUAL_X_CARRIAGE
  428. endstops.not_homing();
  429. // Clear endstop state for polled stallGuard endstops
  430. TERN_(SPI_ENDSTOPS, endstops.clear_endstop_state());
  431. // Move to a height where we can use the full xy-area
  432. TERN_(DELTA_HOME_TO_SAFE_ZONE, do_blocking_move_to_z(delta_clip_start_height));
  433. TERN_(CAN_SET_LEVELING_AFTER_G28, if (leveling_restore_state) set_bed_leveling_enabled());
  434. restore_feedrate_and_scaling();
  435. // Restore the active tool after homing
  436. #if HAS_MULTI_HOTEND && (DISABLED(DELTA) || ENABLED(DELTA_HOME_TO_SAFE_ZONE))
  437. tool_change(old_tool_index, TERN(PARKING_EXTRUDER, !pe_final_change_must_unpark, DISABLED(DUAL_X_CARRIAGE))); // Do move if one of these
  438. #endif
  439. #if HAS_HOMING_CURRENT
  440. if (DEBUGGING(LEVELING)) DEBUG_ECHOLNPGM("Restore driver current...");
  441. #if HAS_CURRENT_HOME(X)
  442. stepperX.rms_current(tmc_save_current_X);
  443. #endif
  444. #if HAS_CURRENT_HOME(X2)
  445. stepperX2.rms_current(tmc_save_current_X2);
  446. #endif
  447. #if HAS_CURRENT_HOME(Y)
  448. stepperY.rms_current(tmc_save_current_Y);
  449. #endif
  450. #if HAS_CURRENT_HOME(Y2)
  451. stepperY2.rms_current(tmc_save_current_Y2);
  452. #endif
  453. #if HAS_CURRENT_HOME(Z) && ENABLED(DELTA)
  454. stepperZ.rms_current(tmc_save_current_Z);
  455. #endif
  456. #if HAS_CURRENT_HOME(I)
  457. stepperI.rms_current(tmc_save_current_I);
  458. #endif
  459. #if HAS_CURRENT_HOME(J)
  460. stepperJ.rms_current(tmc_save_current_J);
  461. #endif
  462. #if HAS_CURRENT_HOME(K)
  463. stepperK.rms_current(tmc_save_current_K);
  464. #endif
  465. #if HAS_CURRENT_HOME(U)
  466. stepperU.rms_current(tmc_save_current_U);
  467. #endif
  468. #if HAS_CURRENT_HOME(V)
  469. stepperV.rms_current(tmc_save_current_V);
  470. #endif
  471. #if HAS_CURRENT_HOME(W)
  472. stepperW.rms_current(tmc_save_current_W);
  473. #endif
  474. #if SENSORLESS_STALLGUARD_DELAY
  475. safe_delay(SENSORLESS_STALLGUARD_DELAY); // Short delay needed to settle
  476. #endif
  477. #endif // HAS_HOMING_CURRENT
  478. ui.refresh();
  479. TERN_(HAS_DWIN_E3V2_BASIC, DWIN_HomingDone());
  480. TERN_(EXTENSIBLE_UI, ExtUI::onHomingDone());
  481. report_current_position();
  482. if (ENABLED(NANODLP_Z_SYNC) && (doZ || ENABLED(NANODLP_ALL_AXIS)))
  483. SERIAL_ECHOLNPGM(STR_Z_MOVE_COMP);
  484. TERN_(FULL_REPORT_TO_HOST_FEATURE, set_and_report_grblstate(old_grblstate));
  485. #if HAS_L64XX
  486. // Set L6470 absolute position registers to counts
  487. // constexpr *might* move this to PROGMEM.
  488. // If not, this will need a PROGMEM directive and an accessor.
  489. #define _EN_ITEM(N) , E_AXIS
  490. static constexpr AxisEnum L64XX_axis_xref[MAX_L64XX] = {
  491. NUM_AXIS_LIST(X_AXIS, Y_AXIS, Z_AXIS, I_AXIS, J_AXIS, K_AXIS, U_AXIS, V_AXIS, W_AXIS),
  492. X_AXIS, Y_AXIS, Z_AXIS, Z_AXIS, Z_AXIS
  493. REPEAT(E_STEPPERS, _EN_ITEM)
  494. };
  495. #undef _EN_ITEM
  496. for (uint8_t j = 1; j <= L64XX::chain[0]; j++) {
  497. const uint8_t cv = L64XX::chain[j];
  498. L64xxManager.set_param((L64XX_axis_t)cv, L6470_ABS_POS, stepper.position(L64XX_axis_xref[cv]));
  499. }
  500. #endif
  501. }