[urdf_import] Properly fix bug to importing com