从零开始学习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即为本质矩阵,所以本质矩阵和基本矩阵的区别在于,本质矩阵是使用归一化相机坐标系下的点表示极线约束,基本矩阵是使用图像坐标系下的点表示极线约束的。

相关推荐
前沿科技说3 小时前
努比亚Z70S Ultra 摄影师版将于4月28日发布,首发【光影大师990】传感器
数码相机
gaosushexiangji6 小时前
产品动态|千眼狼sCMOS科学相机捕获单分子荧光信号
数码相机
电鱼智能的电小鱼2 天前
基于 EFISH-SBC-RK3588 的无人机环境感知与数据采集方案
linux·网络·嵌入式硬件·数码相机·无人机·边缘计算
二狗哈2 天前
制作一款打飞机游戏19:碰撞检测
数码相机·游戏
电鱼智能的电小鱼3 天前
SAIL-RK3588协作机器人运动控制器技术方案
linux·嵌入式硬件·数码相机·机器人·无人机·边缘计算
中达瑞和-高光谱·多光谱3 天前
高光谱相机在工业检测中的应用:LED屏检、PCB板缺陷检测
数码相机
labview_自动化3 天前
焊接机排错
数码相机
中达瑞和-高光谱·多光谱3 天前
高光谱相机在生物医学中的应用:病理分析、智慧中医与成分分析
数码相机
THe CHallEnge of THe BrAve3 天前
面阵相机中M12镜头和远心镜头的区别及性能优势
图像处理·数码相机·计算机视觉·视觉检测
敢敢のwings3 天前
相机雷达外参标定算法调研
数码相机·算法