3D-ICP Example

Results

The main method used in this example is CICP::Align3DPDF. This example first simulates a pair of 3D point clouds by performing ray-tracing from two different poses:

Icp3d_scene

Next, a small error in all six dimensions is introduced in the pose of one point cloud, leading to unaligned point clouds:

Icp3d_unaligned
 

After applying the ICP-3D algorithm to these unaligned maps, the algorithm successfully recovers the correct alignment, as can be seen in the figure:

Icp3d_aligned
 

The code

The up-to-date example can be found in: https://github.com/MRPT/mrpt/tree/master/samples/icp3D/