Model predictive control based trajectory optimization for nap-of-the-earth (NOE) flight including obstacle avoidance

This work presents a model predictive control based trajectory optimization method for nap-of-the-earth (NOE) flight including obstacle avoidance, emphasizing the mission objective of low altitude at high speed. A NOE trajectory reference is generated over a subspace of the terrain. It is then inserted into the cost function and the resulting trajectory tracking error term is weighted for more precise longitudinal tracking than lateral tracking through the introduction of the TF/TA ratio. Obstacle avoidance including preclusion of ground collision is accomplished through the establishment of hard state constraints. These state constraints create a ´safe envelope´ within which the optimal trajectory can be found. Steps are taken to reduce complexity in the optimization problem including perturbational linearization in the prediction model generation and the use of control basis functions. Preliminary results over a variety of sample terrains are provided to show the mission objective of low altitude and high speed was met satisfactorily without terrain or obstacle collision, however, methods to preclude or deal with infeasibility must be investigated as speed is increased to and past 30 knots.