视觉SLAM理论入门——(9)视觉里程计之特征点法—ICP

该文详细介绍了如何通过线性代数和非线性优化方法解决3D点集配对的欧氏变换问题。线性代数方法利用最小二乘原理和奇异值分解(SVD)估计旋转矩阵R和平移向量t;非线性优化方法则涉及李代数和雅可比矩阵,寻找误差函数的极小值。文中还讨论了ICP问题可能存在的唯一解或无穷多解的情况。

假设有一组配对好的 3D 点

想要找一个欧氏变换 R,t,使得:

这个问题可以用迭代最近点(Iterative Closest Point, ICP)求解。ICP求解方法有两种方法:线性代数求解(SVD)、非线性优化求解

 

1、线性代数求解法

定义第 i 对点的误差为

定义两组点的质心:

构建最小二乘问题,求使误差平方和达到极小的 R,t:

评论
成就一亿技术人!
拼手气红包6.0元
还能输入1000个字符
 
红包 添加红包
表情包 插入表情
 条评论被折叠 查看
添加红包

请填写红包祝福语或标题

红包个数最小为10个

红包金额最低5元

当前余额3.43前往充值 >
需支付:10.00
成就一亿技术人!
领取后你会自动成为博主和红包主的粉丝 规则
hope_wisdom
发出的红包
实付
使用余额支付
点击重新获取
扫码支付
钱包余额 0

抵扣说明:

1.余额是钱包充值的虚拟货币,按照1:1的比例进行支付金额的抵扣。
2.余额无法直接购买下载,可以购买VIP、付费专栏及课程。

余额充值