Robot Dynamics and Control by M.W. Spong & M.W. Vidyasagar