A Robust Initialization Scheme for a Lateral Trajectory Optimization Problem with Time of Arrival Windows

Abstract

We present a robust initialization scheme that estimates parameter values for the numerical solution of a two-point boundary value problem. The two-point boundary value problem formulation stems from the optimization of a cost functional subject to the dynamics of a simplified lateral aircraft model and other constraints. Leveraging regular perturbation methods, initial parameter estimates are analytically determined and used to initialize a gradient descent optimization routine which is shown to rapidly converge over a range of initial aircraft positions and heading angles. Additionally, the velocity of the aircraft is optimized to ensure the trajectory of the aircraft terminates within a desired region in both time and space.