本文主要是介绍迭代法求解ICP,希望对大家解决编程问题提供一定的参考价值,需要的开发者们随着小编来一起学习吧!
目录
- 一、预备知识
- 1、空间变换后的点对变换求导
- 1.1.1 左扰动
- 1.1.2 右扰动
- 2、高斯牛顿优化
- 二、公式推导
- 1、构建误差函数
- 2、计算雅克比
- 3、构建增量方程
- 4、更新待优化量
- 三、代码
- 四、参考
一、预备知识
1、空间变换后的点对变换求导
为了简单采用扰动模型
1.1.1 左扰动
1.1.2 右扰动
2、高斯牛顿优化
二、公式推导
1、构建误差函数
2、计算雅克比
3、构建增量方程
4、更新待优化量
三、代码
见github
四、参考
参考博客:https://blog.csdn.net/weixin_41281151/article/details/109439049
这篇关于迭代法求解ICP的文章就介绍到这儿,希望我们推荐的文章对编程师们有所帮助!