mirror of
https://github.com/introlab/rtabmap.git
synced 2026-09-01 17:10:26 +08:00
MainWindow: Fixed "Invalid (NaN, Inf) point coordinates given to radiusSearch" error when creating occupancy map from projection
This commit is contained in:
@@ -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,
|
||||
|
||||
Reference in New Issue
Block a user