SLAM中相机姿态估计算法推导基础数学总结

相机模型

基本模型

在这里插入图片描述
内参
在这里插入图片描述
在这里插入图片描述
外参
在这里插入图片描述
在这里插入图片描述

对极几何

对极约束

在这里插入图片描述
在这里插入图片描述
外积符号
在这里插入图片描述
基础矩阵F和本质矩阵E
在这里插入图片描述
在这里插入图片描述
相机姿态估计问题分为如下两步:

在这里插入图片描述

本质矩阵

E = t ∧ R E=t^{\wedge}R E=tR因为 t ∧ t^{\wedge} t其实就是个3x3的反对称矩阵,所以 E E E也是一个3x3的矩阵

用八点法估计E
在这里插入图片描述
在这里插入图片描述

零空间矩阵的讲解

要通过E获得R和t就需要进行 E E E的奇异值(SVD)分解
在这里插入图片描述在这里插入图片描述
带入之后的看相机的正深度,就只有第一种情况满足

单应矩阵

在这里插入图片描述
在这里插入图片描述

这个等式只有在非零因子情况下才成立,所以可以除以非零因子把 h 9 h_9 h9变为0
在这里插入图片描述

三角测量

在这里插入图片描述在这里插入图片描述

3D-2D:PnP

直接线性变换

在这里插入图片描述

P3P

在这里插入图片描述
在这里插入图片描述
最后要求得未知量只有x,y,这是一个二元二次多项式方程,用吴消元法求解,最多得四个解,根据第四个点进行验证即可求得A,B,C 的3D坐标

Bundle Ajustment

在这里插入图片描述
这部分略显复杂,建议直接看视觉SLAM十四讲
在这里插入图片描述

  • 0
    点赞
  • 2
    收藏
    觉得还不错? 一键收藏
  • 打赏
    打赏
  • 0
    评论

“相关推荐”对你有帮助么?

  • 非常没帮助
  • 没帮助
  • 一般
  • 有帮助
  • 非常有帮助
提交
评论
添加红包

请填写红包祝福语或标题

红包个数最小为10个

红包金额最低5元

当前余额3.43前往充值 >
需支付:10.00
成就一亿技术人!
领取后你会自动成为博主和红包主的粉丝 规则
hope_wisdom
发出的红包

打赏作者

玛卡巴卡_qin

你的鼓励将是我创作的最大动力

¥1 ¥2 ¥4 ¥6 ¥10 ¥20
扫码支付:¥1
获取中
扫码支付

您的余额不足,请更换扫码支付或充值

打赏作者

实付
使用余额支付
点击重新获取
扫码支付
钱包余额 0

抵扣说明:

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

余额充值