逆透视变换详解 及 代码实现（一）

逆透视变换详解 及 代码实现（一） 中主要是原理的说明：

一、世界坐标轴和摄像机坐标轴

从下图中可以看到，世界坐标为(X,Y,Z)  相机坐标为(Xc,Yc,Zc)

而世界坐标变换到相机坐标存在一个旋转矩阵变换R以及一个位移变换T。

根据上图可以得到世界坐标到相机坐标的公式变换！！

                       世界坐标到相机坐标的公式

如果假设没有坐标的平移存在即t在这里不起作用，可以简化公式为：

接下来我们来说下不同坐标轴变换的旋转矩阵

从二维图像入手，坐标变换如下图所示

如果假设不存在位移变换，那么x0 和y0 将变为0。

现在从二维图像变到三维图像上的变换，假设固定一个（X,Y,Z）轴 旋转其他两个轴组成的平面。

1、绕X轴旋转 theta 

                                

2、绕Y轴旋转

                             

3、绕Z轴旋转

                              

-------------------------------------------------------------------------------------------------------------------

-------------------------------------------------------------------------------------------------------------------

下面为相机坐标和平面坐标系（成像投影关系）

根据上述的关系我们可以推得：

      

    矩阵形式为：  

  

---------------------------------------------------------------------------------------------------------------------------

---------------------------------------------------------------------------------------------------------------------------

3、从平面坐标得到的我们看到的（照片）图像坐标系

数字图像在计算机内为MXN数组，M行N列的图像中每一个元素（pixel）数值就是图像点的亮度（灰度）。

如图，在图像上定义直角坐标系U，V，每一个像素为单位的图像坐标系坐标，

由于（u,v）只能表示像素位于数组中的列数与行数，并没有使用物理单位表示该像素在图像中位置，

所以需要再建立以物理单位（mm）表示的图像坐标系，该图像坐标系以图像内某一点uv(0,0)为原点，x轴和y轴分别平行于u、v。

如图中，（u、v）表示以像素为单位的图像坐标系的坐标，（X、Y）表示以mm为单位的图像坐标系的坐标。

假设每一个像素在X轴与Y轴方向上的物理尺寸为dx、dy，则图像任意一个像素在两个坐标系下的坐标有如下关系，

 其中(u0 ,v0) = xy(0,0)

进而得到如下的矩阵表达：

---------------------------------------------------------------------------------------------------------------------------------------

---------------------------------------------------------------------------------------------------------------------------------------

到此 逆透视变换就全部完成了！！！！

下面要说下 逆透视变换需要注意的问题，   因为有消失点的存在，也就是说当我们看火车轨道的时候总在某个距离上看到两条轨道重合到一起后消失。

对于空间中任一点（X_W，Y_W，Z_W）^T，投影之后的对应像点为（u，v，1）^T，写成矩阵形式：

其中AR为变换矩阵，假设M = AR

将矩阵展开，这里去Zc = 1 可以得到如下关系式。

消失点可以认为是空间直线上无穷远处的点投影在图像上所成的像点。对于空间中某一直线L，方向为（dx,dy,dz），给定直线上坐标（ax,ay,az）,所以直线上任一点A可以表示为:

 

当趋于无穷时可以得到

从而得到消失点的坐标。

注：逆透视变换的范围不能到达消失点，否则不能还原。

整体变换的示意图:

逆透视变换详解 及 代码实现（二）

根据上述原理，结合应用场景，列出代码的实现！！