Robotics - [3D SLAM - 1] Scan Matching
3D Point-Point ICP, 3D Point-Plane ICP, NDT
Point-Point ICP
If we write out our state vector as [theta, translation], the pseudo code for point-point ICP is:
1
2
3
4
5
6
7
8
9
10
11
12
13
14
15
pt_pt_icp(pose_estimate, source_scan, target_...