Fundamentals of Robotics : Theory and applications - Heath, Larry