Robotics, Geometry and Control - Rigid body …