Foundations of robotics : analysis and control. - Yoshikawa, Tsuneo