Correcting urdf orientations and origins