从零开始学习SLAM(五):极几何与极约束

文章参考计算机视觉life

前备知识

概念

几何关系:

上图中:

极平面(Epipolar plane):点c0, c1, p三点确定的平面;

极点(Epipoles): c0 c1 连线与两个平面的交点

基线(Baseline):c0 c1的连线

极线(Epipolar line):极平面与两像平面的交线

旋转矩阵:R

平移矩阵:t

旋转平移矩阵:T

内参:焦距,归一化坐标

外参:旋转、平移矩阵

向量叉乘和点乘的概念:

叉乘只在三维空间中有定义,比如两个向量 a和b 的叉乘写作 a x b,它是与向量 a, b都垂直的向量,其方向通过右手定则决定。

点乘:

a * b = ||a||* ||b|| *cos(θ)

因此如果两个互相垂直的向量点乘,cos(θ) = 0,点乘结果也为0。

极约束推理

上图表示的是一个运动的相机在两个不同位置的成像,其中:

左右两个平行四边形分别是相机在不同位置的成像平面C0, C1分别是两个位置中相机的光心,也就是针孔相机模型中的针孔P是空间中的一个三维点,p0, p1分别是P点在不同成像平面上对应的像素点。

如果将点P沿着C0-P0所在的直线移动,你会发现P在左边相机的成像一直不变,都是P0,这时候P在右边相机的成像点p1是一直在变化的

现在我们把极平面中C0-C1-P0-P1单拎出来,看下面的图,由于C0-C1-P-P0-P1都是共面的,所以得到结论一:

也就是说 一个同时垂直于C0C1与C1P1的向量也垂直于C0P0

p0, p1都是图像上的二维点,不过,这里我们会把它变成三维的方向向量来考虑我们假设一个归一化的图像平面,该平面上焦距f =1 ,因此我们可以定义在以C0为原点的坐标系下

而在以C1为原点的坐标系下

事实上,你在C0-C1-p0-p1组成的极平面上,保证的方向不变,在极平面上随便移动,结论1中等式都成立。同样的道理,在极平面上,保证

方向不变,在极平面上随便移动,结论1中等式仍然都成立。

p0在以C0为原点的参考坐标系,p1在以C1为原点的参考坐标系,所以我们还是需要转换坐标系。这里我们把所有点的坐标都转换到以C0为原点的坐标系。前面说过这些向量都是方向向量和向量起始位置无关,所以这里坐标系变换只考虑旋转就可以。我们记 R 为从C1坐标系到C0坐标系的旋转矩阵

小白:那么 RP1 就是P1在以C0为原点的C0坐标系了,所以在C0坐标系下结论一可以改写为:



已知:p0TEP1 = 0

根据上一节知识点

从世界坐标系到相机坐标系的公式为:

那么z=1时从相机坐标系到图像坐标系的公式就为, p0 = k-1p0', p1 = k-1p1'

p0TEP1 = 0 ----> p0'T k-TEk-1p1' = p0'T(k-TEk-1)p1' = p0'TFp1'

这里的F 即为基本矩阵 ,E即为本质矩阵,所以本质矩阵和基本矩阵的区别在于,本质矩阵是使用归一化相机坐标系下的点表示极线约束,基本矩阵是使用图像坐标系下的点表示极线约束的。

相关推荐
OPEN-F36 分钟前
ROS2系列教程:Gazebo插件(关节控制/IMU/激光雷达)
c++·python·数码相机·算法·机器人
AomanHao21 小时前
【ISP】compression artifact压缩失真情况
图像处理·数码相机·isp·sensor·图像压缩·压缩失真
蜡台1 天前
ux-camera 跨平台相机组件
数码相机·vue·uniapp·camera·nvue·取景框
长江后浪博客1 天前
YOLOv26+500万彩色工业相机实现药品铝塑板颗粒完整度检测:缺粒识别、颜色检测与穹顶漫射光机器视觉方案
数码相机·yolo·机器视觉·yolov26·药品包装检测·铝塑板检测·彩色工业相机
老兵发新帖2 天前
机器人本体:FK/IK
人工智能·数码相机·机器人
格林威2 天前
C# 相机图像阴影校正:使用OpenCvSharp实现工业相机阴影平场校正功能
人工智能·数码相机·opencv·计算机视觉·c#·机器视觉·工业相机
qq_526099133 天前
单口图像采集卡:被低估的那块“桥“
数码相机
中科同志科技先进封装3 天前
真空炉温控模块更换深度解读:工艺流程与优化策略
人工智能·数码相机
格林威3 天前
C#图像夜间识别率提升:使用OpenCvSharp和Halcon融合DeepSORT实现复杂场景下准确识别
开发语言·人工智能·数码相机·机器学习·计算机视觉·c#·视觉检测
敢敢のwings3 天前
LingBot-Depth:把 RGB-D 相机的“缺测”变成可用的空间先验
数码相机