Fixed some URDF errors