Geometric Optimal Control