Quadrotor Thrust Vectoring Control with Time Optimal Trajectory Planning in Constant Wind Fields