Optimal Trajectory Tracking for an Autonomous UAV

The aim of the present project is the design of optimal flight trajectories for an automomous aerial vehicle which is expected to reach the desired locations in the operational environment expressed in terms of planned waypoints. The navigation must be performed with the vehicle's best effort, i.e. with the lowest cost. Hence, we want to minimize the input energy, a function of the inputs for the mathematical model which describes the dynamics of the vehicle. The trajectory must satisfy all the constraints and pass through all the planned waypoints. Assuming the vehicle as a point mass model, the best solution has been investigated through a genetic algorithm search procedure. The optimisation problem has been solved by modifying a micro-genetic algorithm software which was initially developed by D.L. Carroll. Between all the possible trajectories we select the more "realistic" connections among the waypoints. First of all, we have left out the trajectories with discontinuity in the derivatives as these are not feasible by the real aircraft. The polynomial spline is a suitable candidate to solve our problem. The algorithm splits the trajectory in sub-trajectories which join a sequence of three waypoints. Starting from the first three waypoints, the following sub-trajectories are superimposed keeping the first waypoint coincident with the last of the previous sub-trajectory. The sequence of polynomials is initialized assuming that jumps in the direction of flight are avoided pointing the heading angle in the presumed direction of flight. The optimal trajectory is a trade-off amongst three factors: the required energy cost, the minimum distance from the required waypoint and the feasibility of the trajectory. Results obtained with this optimization procedure are presented