update to load urdf model
Update to load urdf model