Geometric Optimal Control: Theory, Methods and