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十四讲

相关推荐
IT大白鼠1 天前
AIGC性能的关键瓶颈:算力、数据、算法三者如何互相制约?
算法·aigc
白雪茫茫1 天前
监督学习、半监督学习、无监督学习算法详解
python·学习·算法·ai
FengyunSky1 天前
浅析 空间频率响应 SFR 计算
算法
树下水月1 天前
PHP 一种改良版的雪花算法
算法·php·dreamweaver
一只数据集1 天前
全尺寸人形机器人灵巧手力觉触觉数据集-2908条ROSbag数据覆盖14大应用场景深度解析
大数据·人工智能·算法·机器人
罗西的思考1 天前
【GUI-Agent】阿里通义MAI-UI 代码阅读(2)--- 实现
人工智能·算法·机器学习
刀法如飞1 天前
TypeScript 数组去重的 20 种实现方式,哪一种你还不知道?
前端·javascript·算法
sali-tec1 天前
C# 基于OpenCv的视觉工作流-章66-直线夹角
图像处理·人工智能·opencv·算法·计算机视觉
AC赳赳老秦1 天前
接口测试自动化:用 OpenClaw 对接 Postman,实现批量回归测试、测试报告自动生成与推送
java·人工智能·python·算法·elasticsearch·deepseek·openclaw
_风满楼1 天前
TDD实战-会议室冲突检测的红绿重构循环
前端·javascript·算法