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

相关推荐
tobias.b3 小时前
408真题解析-2010-7-数据结构-无向连通图
数据结构·算法·图论·计算机考研·408真题解析
良木生香4 小时前
【鼠鼠优选算法-双指针】003:快乐数 & 004:盛水最多的容器
算法
Cx330❀4 小时前
【优选算法必刷100题】第41-42题(模拟):Z 字形变换,外观数列
c++·算法
沃尔特。4 小时前
直流无刷电机FOC控制算法
c语言·stm32·嵌入式硬件·算法
CW32生态社区4 小时前
CW32L012的PID温度控制——算法基础
单片机·嵌入式硬件·算法·pid·cw32
Cx330❀4 小时前
【优选算法必刷100题】第038题(位运算):消失的两个数字
开发语言·c++·算法·leetcode·面试
漫随流水4 小时前
leetcode回溯算法(93.复原IP地址)
数据结构·算法·leetcode·回溯算法
燃于AC之乐4 小时前
我的算法修炼之路--5——专破“思维陷阱”,那些让你拍案叫绝的非常规秒解
c++·算法·贪心算法·bfs·二分答案·扩展域并查集·动态规划(最长上升子序列)
艾莉丝努力练剑4 小时前
【优选算法必刷100题】第021~22题(二分查找算法):山脉数组的峰顶索引、寻找峰值
数据结构·c++·算法·leetcode·stl
艾莉丝努力练剑4 小时前
【优选算法必刷100题】第007~008题(双指针算法):三数之和、四数之和问题求解
linux·算法·双指针·优选算法