fix toolchange_prime()

Author: studiodyne

Marlin/src/module/tool_change.cpp

@@ -1068,15 +1068,23 @@ void fast_line_to_current(const AxisEnum fr_axis) { _line_to_current(fr_axis, 0.
       #if ENABLED(TOOLCHANGE_PARK)
         if (ok) {
           #if ENABLED(TOOLCHANGE_NO_RETURN)
-            const float temp = destination.z;
-            destination = current_position;
-            destination.z = temp;
+            destination.x = current_position.x;
+            destination.y = current_position.y;
           #endif
-          prepare_internal_move_to_destination(TERN(TOOLCHANGE_NO_RETURN, planner.settings.max_feedrate_mm_s[Z_AXIS], MMM_TO_MMS(TOOLCHANGE_PARK_XY_FEEDRATE)));
+          do_blocking_move_to_xy(destination,  MMM_TO_MMS(TOOLCHANGE_PARK_XY_FEEDRATE));
         }
       #endif
+      do_blocking_move_to_z(destination.z, planner.settings.max_feedrate_mm_s[Z_AXIS]);
+      planner.synchronize();
 
+      //Previous position applied
+      current_position.e = destination.e;
+      sync_plan_position_e();
       extruder_cutting_recover(destination.e); // Cutting recover
+
+      #if HAS_FAN && TOOLCHANGE_FS_FAN >= 0
+        RESTORE(fan);
+      #endif
     }
 
     FS_DEBUG("<<< tool_change_prime");