Geometric and Numerical Optimal Control