Have a look at: https://control-toolbox.org/docs/optimalcontrol/stable/tutorial-basic-example.html Can this package be useful for: - an improved flight path controller - a better flight path planner ?