Updated urdf to new robot configuration