Robot Dynamics and Control - Spong, Mark W. (New York:JOHN WILEY & SONS, 1989)