Foundations of robotics analysis and control - Yoshikawa, Tsuneo (MIT Press, 1990)