Commited version with coherent urdf and sdf