Simulation and Flight Test of Autonomous Aircraft Estimation, Planning, and Control Algorithms