Robot dynamics and control : Mark W. Spong and M. Vidyasagar