Geometric Optimal Control - Schättler, Heinz (Springer New York, 2012)