Robot Control : Dynamics, Motion Planning and Analysis - Spong, Mark W. (IEEE)