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

相机模型

基本模型

内参

外参

对极几何

对极约束


外积符号

基础矩阵F和本质矩阵E


相机姿态估计问题分为如下两步:

本质矩阵

E = t ∧ R E=t^{\wedge}R E=t∧R因为 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十四讲

相关推荐
小郭团队31 分钟前
2_1_七段式SVPWM (经典算法)算法理论与 MATLAB 实现详解
嵌入式硬件·算法·硬件架构·arm·dsp开发
充值修改昵称40 分钟前
数据结构基础:从二叉树到多叉树数据结构进阶
数据结构·python·算法
Deepoch1 小时前
Deepoc数学大模型:发动机行业的算法引擎
人工智能·算法·机器人·发动机·deepoc·发动机行业
浅念-1 小时前
C语言小知识——指针(3)
c语言·开发语言·c++·经验分享·笔记·学习·算法
Hcoco_me2 小时前
大模型面试题84:是否了解 OpenAI 提出的Clip,它和SigLip有什么区别?为什么SigLip效果更好?
人工智能·算法·机器学习·chatgpt·机器人
BHXDML2 小时前
第九章:EM 算法
人工智能·算法·机器学习
却道天凉_好个秋3 小时前
目标检测算法与原理(三):PyTorch实现迁移学习
pytorch·算法·目标检测
无限进步_3 小时前
【C++】大数相加算法详解:从字符串加法到内存布局的思考
开发语言·c++·windows·git·算法·github·visual studio
C+-C资深大佬3 小时前
C++ 数据类型转换是如何实现的?
开发语言·c++·算法
cwplh4 小时前
DP 优化二:斜率优化 DP
算法·动态规划