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

相关推荐
Hrain-AI23 分钟前
企业 AI 治理运营怎么做:分级授权、Token 用量可观测与模型统一纳管
大数据·人工智能·算法
长江后浪博客35 分钟前
陶瓷浮雕盘印刷视觉定位方案:8K线扫相机 + 暗场光源 + 旋转平台
人工智能·数码相机·机器视觉·视觉定位·线扫相机·暗场光源·陶瓷印刷
剑指offer.1 小时前
Linux多任务-线程篇
java·jvm·算法
nike0good1 小时前
CF 126B(Password-z algorithm/exkmp)
开发语言·c++·算法
无定义_1 小时前
Bellman-Ford——贝尔曼福特算法
数据库·算法
HanhahnaH2 小时前
各数据结构操作的时间复杂度汇总
数据结构·算法
Yzzz-F2 小时前
CF2023D
c++·算法·dp
小小帅呀2 小时前
学习 VLA 第6天:SWIN VIT算法原理以及复现
学习·算法
爱分享的康康3 小时前
破解座舱数采五大痛点:DMS/OMS多路相机数采工程方案
数码相机·自动驾驶