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

相关推荐
程序员东岸8 小时前
《数据结构——排序(中)》选择与交换的艺术:从直接选择到堆排序的性能跃迁
数据结构·笔记·算法·leetcode·排序算法
程序员-King.8 小时前
day104—对向双指针—接雨水(LeetCode-42)
算法·贪心算法
神仙别闹8 小时前
基于C++实现(控制台)应用递推法完成经典型算法的应用
开发语言·c++·算法
Ayanami_Reii8 小时前
进阶数据结构应用-一个简单的整数问题2(线段树解法)
数据结构·算法·线段树·延迟标记
listhi5209 小时前
基于改进SET的时频分析MATLAB实现
开发语言·算法·matlab
Keep_Trying_Go10 小时前
基于Zero-Shot的目标计数算法详解(Open-world Text-specified Object Counting)
人工智能·pytorch·python·算法·多模态·目标统计
xl.liu10 小时前
零售行业仓库商品数据标记
算法·零售
confiself10 小时前
通义灵码分析ms-swift框架中CHORD算法实现
开发语言·算法·swift
做怪小疯子10 小时前
LeetCode 热题 100——二叉树——二叉树的层序遍历&将有序数组转换为二叉搜索树
算法·leetcode·职场和发展
CoderYanger10 小时前
递归、搜索与回溯-记忆化搜索:38.最长递增子序列
java·算法·leetcode·1024程序员节