Fix G10/G11 Z-lift

Marlin/Marlin_main.cpp

         destination[X_AXIS]=current_position[X_AXIS];
         destination[Y_AXIS]=current_position[Y_AXIS];
         destination[Z_AXIS]=current_position[Z_AXIS];
-        current_position[Z_AXIS]-=retract_zlift;
         destination[E_AXIS]=current_position[E_AXIS];
         current_position[E_AXIS]+=retract_length/volumetric_multiplier[active_extruder];
         plan_set_e_position(current_position[E_AXIS]);
         feedrate=retract_feedrate;
         retracted=true;
         prepare_move();
+        current_position[Z_AXIS]-=retract_zlift;
+        plan_set_position(current_position[X_AXIS], current_position[Y_AXIS], current_position[Z_AXIS], current_position[E_AXIS]);
+        prepare_move();
         feedrate = oldFeedrate;
       }
 
         destination[X_AXIS]=current_position[X_AXIS];
         destination[Y_AXIS]=current_position[Y_AXIS];
         destination[Z_AXIS]=current_position[Z_AXIS];
-        current_position[Z_AXIS]+=retract_zlift;
         destination[E_AXIS]=current_position[E_AXIS];
+        current_position[Z_AXIS]+=retract_zlift;
+        plan_set_position(current_position[X_AXIS], current_position[Y_AXIS], current_position[Z_AXIS], current_position[E_AXIS]);
+        //prepare_move();
         current_position[E_AXIS]-=(retract_length+retract_recover_length)/volumetric_multiplier[active_extruder]; 
         plan_set_e_position(current_position[E_AXIS]);
         float oldFeedrate = feedrate;