Split do_blocking_move() to XY and Z sections to make sure that the Z homing feedrate is not exceeded

10 years ago · 2ef0669b19
parent 2f9ed1777d
commit 2ef0669b19
1 changed files with 6 additions and 1 deletions
--- a/Marlin/Marlin_main.cpp
+++ b/Marlin/Marlin_main.cpp
@ -1057,11 +1057,16 @@ static void run_z_probe() {
 static void do_blocking_move_to(float x, float y, float z) {
    float oldFeedRate = feedrate;

+    feedrate = homing_feedrate[Z_AXIS];
+
+    current_position[Z_AXIS] = z;
+    plan_buffer_line(current_position[X_AXIS], current_position[Y_AXIS], current_position[Z_AXIS], current_position[E_AXIS], feedrate/60, active_extruder);
+    st_synchronize();
+
    feedrate = XY_TRAVEL_SPEED;

    current_position[X_AXIS] = x;
    current_position[Y_AXIS] = y;
-    current_position[Z_AXIS] = z;
    plan_buffer_line(current_position[X_AXIS], current_position[Y_AXIS], current_position[Z_AXIS], current_position[E_AXIS], feedrate/60, active_extruder);
    st_synchronize();