Robot Modeling and Control von Spong, Mark W.;Hutchinson, Seth;Vidyasagar, M.;