为什么 Generalized ICP（GICP）通常比 Point-to-Plane 更稳定？

Generalized ICPGICP通常比Point-to-Plane ICP更稳定是因为它把点的不确定性局部几何结构建模为协方差矩阵从而使误差函数更符合真实几何结构。1. Point-to-Plane ICP 的问题Point-to-Plane ICP 的误差含义 源点 目标点 目标点法向 只计算 点到平面的法向距离。 几何上 p_i | | 法向误差 v ----------- 平面 q_i 优点 比 Point-to-Point 收敛快 缺点 只考虑目标点的法向信息 没考虑源点的几何结构 没考虑点云的噪声分布2. GICPGICP 把每个点看成一个小的概率分布高斯。每个点都有协方差矩阵Ci 表示局部表面的形状。例如平面点GICP 的误差函数几何意义误差按照局部表面形状加权几何直观理解只看 法向误差 GICP 同时考虑 源点表面 目标点表面 例如 两个平面对齐 源点云 目标点云 GICP 会理解 沿平面方向 允许滑动 法向方向 约束更强 因此更符合真实几何。为什么更稳定原因 1利用双侧几何信息Point-to-Plane 只看目标点法向 GICP 源点协方差 目标点协方差原因 2误差方向自适应误差不再是固定方向。原因 3更好的 Hessian 条件数优化问题3、三种 ICP 的本质关系方法协方差Point-to-Point(CI)Point-to-Plane单方向约束GICP完整协方差方法收敛速度稳定性Point-to-Point慢低Point-to-Plane快中GICP中最高很多 SLAM 系统使用GICPNDT来替代普通 ICP。4、总结GICP 更稳定的本质原因它把点云局部几何建模为协方差矩阵使误差函数更符合真实表面结构。数学表达