Building 2D and 3D models of the robot body