Introduction to robotics: mechanics and control - CRAIG, John J (Pearson Prentice Hall, 2005)