Update to load urdf model