Fundamentals of robotics analysis and control - SCHILLING, Robert J (Prentice Hall, 1990)