Geometric Optimal Control by Heinz Schaettler & Urszula Ledzewicz