Robot Modeling and Control by M. Vidyasagar, Mark W. Spong & Seth Hutchinson