ICP 算法是一种点云到点云的配准方法. 在SLAM中通过空间点云的配准(可以通过相机或者3D激光雷达获取点云数据),可以估计相机运动(机器人运动,旋转矩阵R与平移向量t),累积配准,并不断回环检测,可以保证机器人定位的精度. 想象三维空间中两组点云PL(参考点) 以及 PR(目标点): 1. 在PL和PR中寻找最近点(对于稀疏点云的微小运动,寻找欧拉空间最近点:对于密集点云或者较大运动,可能需要寻找描述子之间距离的最近点)注意理解:这里最近点的意思是在各自点云坐标系中的坐标距离最近,而不是同一…