Text this: Geometric optimal control :