mirror of
https://github.com/introlab/rtabmap_ros.git
synced 2026-10-03 16:27:46 +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;
|
float groundNormalMaxAngle = M_PI_4;
|
||||||
int minClusterSize = 20;
|
int minClusterSize = 20;
|
||||||
cv::Mat ground, obstacles;
|
cv::Mat ground, obstacles;
|
||||||
|
pcl::PointCloud<pcl::PointXYZRGBNormal>::Ptr voxelCloud = util3d::voxelize(cloud, indices, cellSize);
|
||||||
util3d::occupancy2DFromCloud3D<pcl::PointXYZRGBNormal>(
|
util3d::occupancy2DFromCloud3D<pcl::PointXYZRGBNormal>(
|
||||||
cloud,
|
voxelCloud,
|
||||||
indices,
|
|
||||||
ground,
|
ground,
|
||||||
obstacles,
|
obstacles,
|
||||||
cellSize,
|
cellSize,
|
||||||
|
|||||||
Reference in New Issue
Block a user