Geometric Control of Mechanical Systems - Bullo (Springer New York, 2005)