URDF should now have the robot facing +X with Wheel2 aligned with X axis. robot now stands on the surface