Title: Geometrical Foundations of Robotics