3D Visual SLAM Based on Multiple Iterative Closest Point

Figure 3

Schematic view of relationship among five different coordinate systems in calibration.