fix blocking move with PENTA_AXIS_TRT, PENTA_AXIS_HT

DerAndere1 · Oct 1, 2024 · 8ba4421 · 8ba4421
1 parent 52faabf
commit 8ba4421
Showing 1 changed file with 4 additions and 2 deletions.
diff --git a/Marlin/src/module/motion.cpp b/Marlin/src/module/motion.cpp
@@ -1180,8 +1180,10 @@ void do_blocking_move_to(NUM_AXIS_ARGS_(const_float_t) const_feedRate_t fr_mm_s/
     if (!position_is_reachable(x, y)) return;
     destination = current_position;          // sync destination at the start
   #elif ANY(PENTA_AXIS_TRT, PENTA_AXIS_HT)
-      if (!position_is_reachable_xyijkuvw(NUM_AXIS_LIST(x, y, z, i, j, k, u, v, w))) return;
-    destination = current_position;          // sync destination at the start
+    if (!position_is_reachable_xyijkuvw(NUM_AXIS_LIST(x, y, z, i, j, k, u, v, w))) {
+      if (DEBUGGING(LEVELING)) DEBUG_POS("position not reachable. ignore move", destination);
+      return;
+    }
   #endif
 
   #if ENABLED(DELTA)