Open3D(C++) 点到平面的ICP算法实现点云精配准

一、算法原理

1、算法概述

  点到平面度量通常使用标准非线性最小二乘法来求解,例如Levenberg-Marquardt。点到平面ICP算法的每次迭代通常比点到点算法慢,但收敛速度明显更快。两个点云之间的相对旋转小于30°,在旋转矩阵中用θ替换sin θ,用1替换cos θ实现用线性逼近非线性最小二乘优化问题,加快计算速度。
  为了提高计算的数值稳定性

猜你喜欢

转载自blog.csdn.net/qq_36686437/article/details/126377508