从零开始一起学习SLAM | 不推公式，如何真正理解对极约束? - 开发语言

小程序：扫一扫查出行
【扫一扫了解最新限行尾号】
复制小程序

自从小白向师兄学习了李群李代数和相机成像模型的基本原理后，感觉书上的内容没那么难了，公式推导也能推得动了，感觉进步神速，不过最近小白在学习对极几何，貌似又遇到了麻烦。。。

小白：师兄，对极几何这块你觉得重要吗？
师兄：当然重要啦，这个是多视角立体视觉的核心啊

小白：那师兄一定得帮帮我讲清楚啊，最近在看书上这部分内容，感觉很难理解呢！
师兄：哪里不理解？书上公式推导的挺详细了都

小白：这么说吧，公式推导我也能大概看懂，但总觉得不知道为啥这么推导，这样推导的物理意义是什么？
师兄：哦哦，明白啦，就是不能转化为直观的理解方式吧

小白：是的，只能被动接受推导结果，但不能理解背后的原理，这种感觉好差。。
师兄：嗯，那我想想，怎么给你讲。。。说实话，你这个问题挺有意义的

小白：太好啦！开讲吧师兄，小板凳我都搬好啦，瓜子花生都准备好啦

对极几何基本概念
师兄：好。那我就从几何意义的角度来推导一下对极几何中的对极约束吧。先看下面这个图，很熟悉吧，对极约束中很常见的图。它表示的是一个运动的相机在两个不同位置的成像，其中：

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

小白：嗯，这个图见到很多次了，不过一直理解的不透彻
师兄：你看上面左侧的图，如果将点P沿着C0-p0所在的直线移动，你会发现P在左边相机的成像一直不变，都是p0，这时候P在右边相机的成像点p1是一直在变化的

小白：对，好像是沿着右边那条红色的线滑动
师兄：嗯，你看C0-C1-P-p0-p1他们都是在同一个平面上的，你可以想象C0-C1-P组成的平面是一个三角尺，它所在的平面称之为极平面（epipolar plane），它像一把锋利的刀，切割了左右两个成像平面

小白：哇塞，这样感觉直观多了
师兄：嗯，其中和成像平面相交的直线称之为极线（epipolar line），两个光心C0, C1和成像平面的交点叫做极点（epipole）。

小白：师兄，好多新的术语啊，都要记吗？
师兄：不用死记，知道是哪个就行了。我们重点来说说极平面，你看下面这个图，C0-C1-P-p0-p1他们是不是都是在极平面上？

小白：嗯，是的，它们都是共面的。

不推公式，如何理解对极约束？
师兄：还记得我们在《从零开始一起学习SLAM | 为什么要用齐次坐标？》里讲的叉乘的定义吗？两个向量的叉乘结果是一个同时垂直于这两个向量的向量。
小白：记得呢，叉乘只在三维空间中有定义，比如两个向量 a和b 的叉乘写作 a x b，它是与向量 a, b都垂直的向量，其方向通过右手定则决定。

师兄：对，除了叉乘，还有点乘，a点乘b的定义是
a * b = ||a||* ||b|| *cos(θ)
因此如果两个互相垂直的向量点乘，cos(θ) = 0，点乘结果也为0。
小白：师兄，这些我都记得呢！可是怎么突然说这个呢，和对极几何有什么关系吗？

师兄：当然有关系！刚刚你说了点乘和叉乘的特点，现在我们把极平面中C0-C1-p0-p1单拎出来，看下面的图

我们能够得到下面的结论1：

你自己说说为什么这个等式成立？
小白：我看看哈，额，根据叉乘的定义

的结果是一个同时垂直于它们的向量，也就是说垂直于C0-C1-p0-p1组成的极平面，因此这个叉乘的结果再点乘

结果就是0了。是吧，师兄？
师兄：完全正确，用到的都是我们前面刚刚讲过的基础知识~
小白：可是，师兄，叉乘不是仅在三维空间中有定义吗？我们这里的p0, p1都是图像上的二维点啊

师兄：这个问题问的好！确实如你所说，p0, p1都是图像上的二维点，不过，这里我们会把它变成三维的方向向量来考虑
小白：啥是方向向量啊？

师兄：就是我们只考虑它的方向，而不考虑它的起点或终点的向量。我们假设一个归一化的图像平面，该平面上焦距f =1 ，因此我们可以定义在以C0为原点的坐标系下

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

小白：这样定义可以吗？
师兄：可以的，事实上，你在C0-C1-p0-p1组成的极平面上，保证

的方向不变，在极平面上随便移动，结论1中等式都成立。同样的道理，在极平面上，保证

方向不变，在极平面上随便移动，结论1中等式仍然都成立。
小白：确实是这样，师兄，下一步怎么办？好像p0, p1不在同一个参考坐标系里？

师兄：是的，前面说过，p0在以C0为原点的参考坐标系，p1在以C1为原点的参考坐标系，所以我们还是需要转换坐标系。这里我们把所有点的坐标都转换到以C0为原点的坐标系。前面说过这些向量都是方向向量和向量起始位置无关，所以这里坐标系变换只考虑旋转就可以。我们记 R 为从C1坐标系到C0坐标系的旋转矩阵
小白：那么 Rp1 就是p1 在以C0为原点的C0坐标系了
师兄：对的~现在再看看结论1：