Planning algorithm enables high-performance flight