mirror of
https://github.com/introlab/rtabmap_ros.git
synced 2026-10-03 16:27:46 +08:00
segmentObstaclesFromGround() fixed identical ground and obstacles indices
This commit is contained in:
@@ -116,14 +116,17 @@ void segmentObstaclesFromGround(
|
|||||||
}
|
}
|
||||||
|
|
||||||
//Cluster remaining stuff (obstacles)
|
//Cluster remaining stuff (obstacles)
|
||||||
std::vector<pcl::IndicesPtr> clusteredObstaclesSurfaces = util3d::extractClusters(
|
if(otherStuffIndices->size())
|
||||||
cloud,
|
{
|
||||||
otherStuffIndices,
|
std::vector<pcl::IndicesPtr> clusteredObstaclesSurfaces = util3d::extractClusters(
|
||||||
clusterRadius,
|
cloud,
|
||||||
minClusterSize);
|
otherStuffIndices,
|
||||||
|
clusterRadius,
|
||||||
|
minClusterSize);
|
||||||
|
|
||||||
// merge indices
|
// merge indices
|
||||||
obstacles = util3d::concatenate(clusteredObstaclesSurfaces);
|
obstacles = util3d::concatenate(clusteredObstaclesSurfaces);
|
||||||
|
}
|
||||||
}
|
}
|
||||||
}
|
}
|
||||||
}
|
}
|
||||||
|
|||||||
Reference in New Issue
Block a user