Geometrical Foundations of Robotics door J.M. Selig