MainWindow: Fixed "Invalid (NaN, Inf) point coordinates given to radiusSearch" error when creating occupancy map from projection

This commit is contained in:
matlabbe
2016-04-12 17:16:13 -04:00
parent b53b861342
commit f511896c43

View File

@@ -2190,9 +2190,9 @@ void MainWindow::createAndAddCloudToMap(int nodeId, const Transform & pose, int
float groundNormalMaxAngle = M_PI_4;
int minClusterSize = 20;
cv::Mat ground, obstacles;
pcl::PointCloud<pcl::PointXYZRGBNormal>::Ptr voxelCloud = util3d::voxelize(cloud, indices, cellSize);
util3d::occupancy2DFromCloud3D<pcl::PointXYZRGBNormal>(
cloud,
indices,
voxelCloud,
ground,
obstacles,
cellSize,