Introduction to robotics: Mechanics and control - Craig, John J (1999)