Fundamentals of robotics theory and applications - Heath, Larry (Reston, 1985)