Introduction to Robotics : Mechanics and Control - Craig, John J (2005)