3D-ICP Example


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:


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


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


The code

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