Trajectory Optimization of Hypersonic Vehicles via a Radau Pseudospectral Method