Fixes to urdf