[icp] pcl::IterativeClosestPoint crash when encountering an invalid point in debug mode about pcl

[mvieth]

So in release mode, how are the results (the aligned cloud and the final transformation)? Do they make sense?

Most users probably use some kind of filter (e.g. PassThrough or VoxelGrid) before ICP, so ICP currently does not check for invalid points.

[QiuYilin]

The result in Release mode are meaningless. The pcd file is result of filter cropbox.

[mvieth]

The result in Release mode are meaningless. The pcd file is result of filter cropbox.

Could you describe the crop-box filtering a bit more, perhaps post some code? Did you use a pcl::CropBox<pcl::PointXYZI> or a pcl::CropBox<pcl::PCLPointCloud2> or something else?

[QiuYilin]

Yes，I used pcl::CropBoxpcl::PointXYZI with "keep organized" on.

Part of the point cloud in ascii format：

# .PCD v0.7 - Point Cloud Data file format
VERSION 0.7
FIELDS x y z intensity
SIZE 4 4 4 4
TYPE F F F F
COUNT 1 1 1 1
WIDTH 3200
HEIGHT 400
VIEWPOINT 0 0 0 1 0 0 0
POINTS 1280000
DATA ascii
nan nan nan 0
nan nan nan 0
nan nan nan 0
nan nan nan 0
nan nan nan 0
nan nan nan 0
nan nan nan 0
nan nan nan 0
nan nan nan 0
nan nan nan 0

[QiuYilin]

There is still something wrong in icp.getFitnessScore(). Fix in #6056