一种立体影像对相对姿态恢复方法技术

本发明专利技术属于计算机视觉领域，涉及一种立体影像对相对姿态恢复方法。本发明专利技术使用立体影像对中全部对应点通过极线约束构建方程组并求解本质矩阵；选取最优的本质矩阵；检测并剔除粗差，并依据粗差检测结果判断是否进行迭代，当无法检测到新的粗差时结束迭代，分解当前选取的本质矩阵恢复立体影像对的相对姿态。本发明专利技术在保证精度的同时，避免了RANSAC随机抽样问题，提高了计算速度，能够节约系统资源，提高实时性。

【技术实现步骤摘要】
一种立体影像对相对姿态恢复方法
本专利技术属于计算机视觉领域，尤其涉及一种立体影像对相对姿态恢复方法。
技术介绍
立体影像对相对姿态恢复是摄影测量和计算机视觉的基本问题。在摄影测量和计算机视觉中，广泛应用于三维场景重建、运动匹配、智能机器人自主导航控制、摄影测量的几何定位、车载移动测量、低空无人机测量等方面。通过求解并分解本质矩阵来恢复立体影像对相对姿态，是计算机视觉中的常用方法。本质矩阵由旋转矩阵和平移矢量决定，可利用对应点的归一化坐标直接计算。传统的直接求解本质矩阵的方法通常与RANSAC(随机取样一致)机制相结合。RANSAC通过迭代方式估计数学模型的参数，其从数据中选取随机子集，假设选取的子集是正确的并估计数学模型的参数，最后用其他点进行验证。传统方法中，每次迭代从对应点中进行随机取样，使用样本点结合本质矩阵的定义和性质列出多项式方程，并通过求解多项式方程直接计算本质矩阵。根据对应点的数量将进行多次迭代，最后从多次迭代的结果中选出最优解。由于RANSAC是一种不确定的算法，为了提高得出合理结果的概率必须提高迭代次数。因此，在对应点数目较多时，传统的方法通常需要进行大量的迭代，这导致计算量过大，存在耗时较长的问题。而且，在随机取样时样本点是随机分布的，难以保证样本点均匀分布在影像上，从而对计算精度产生影响。
技术实现思路
本专利技术针对现有技术的不足，提出一种新的立体影像对相对姿态恢复方法。本专利技术利用立体像对中全部对应点直接计算本质矩阵，并依据求得的本质矩阵在迭代中剔除粗差，最后将求得的本质矩阵分解，得到立体影像对的相对姿态。本专利技术在计算流程区别于传统方法，避免了RANSAC随机取样问题，减少了求解本质矩阵的迭代次数，从而提高了计算速度，同时避免了取样时样本点随机分布的问题。本专利技术能在保证精度的同时，较快的实现立体影像对相对姿态恢复。为了达到上述目的，本专利技术提供的技术方案提供一种立体影像对相对姿态恢复方法，包括如下步骤：步骤1，使用立体影像对中全部对应点通过极线约束构建方程组并求解本质矩阵；步骤2，从步骤1的结果中选取最优的本质矩阵；步骤3，利用步骤2选取的本质矩阵检测并剔除粗差，并依据粗差检测结果判断是否返回步骤1进行迭代，当无法检测到新的粗差时结束迭代进入步骤4；步骤4，分解当前选取的本质矩阵恢复立体影像对的相对姿态。而且，所述步骤1中，使用立体影像对中全部对应点通过极线约束构建方程组并求解本质矩阵的实现方式如下，将全部对应点代入极线约束中，构建方程组，极线约束如(1)所示：其中，和和是三维的列向量，表示立体影像对中左影像和右影像对应点的相机坐标，E为本质矩阵；求解方程组，得到一个由四个通解构成的基础解系；将求得的四个通解代入本质矩阵的性质中，构建新的方程，所使用的本质矩阵性质如(2)(3)所示；对新的方程进行高斯消元，并通过基求解；将求得的实数解代入基础解系，得到本质矩阵；det(E)＝0(2)2EETE-trance(EET)E＝0(3)。而且，所述步骤2中，从步骤1的结果中选取最优本质矩阵的实现方式如下，将步骤1求得的本质矩阵E转化为基本矩阵F，并为所有对应点计算对称对极点距离，其中对称对极点距离的计算方式如下：其中，D为对称对极点距离；x和x′是三维的列向量，表示对应点的齐次化影像坐标；给定阈值distance,分别统计每个本质矩阵对应的对称对极点距离中小于阈值的个数；记为num；并利用distance和对称对极点距离为每个本质矩阵计算得分，记为score；其中得分的计算方式如下：Di为第i对对应点对应的对称对极点距离；比较num的大小，对应num值最大的本质矩阵为最优本质矩阵，若num值相同，则比较对应score的大小，对应score值最小的本质矩阵为最优本质矩阵。而且，所述步骤3中，利用本质矩阵检测并剔除粗差，并依据粗差检测结果判断是否进行迭代的实现方式如下，将步骤2中得到的本质矩阵代入极线约束中，可求得残差；计算残差的平均数和中误差，如残差满足如条件(6)，则该残差对应的对应点将被视为粗差，并且将这对对应点从数据中剔除；|ri-mean|＞nσ(6)其中，ri为第i对对应点对应的残差,mean为残差的平均值，σ为残差的中误差，n为预设的标量；如果没有检测到新的粗差，则进入步骤4；如果检测到了新的粗差，则使用剔除过粗差的对应点，从步骤1开始进行迭代。以上一种立体影像对相对姿态恢复方法可用于摄影测量。和现有技术相比，本专利技术是利用立体像对中所有对应点进行立体影像对相对姿态恢复的方法，避免了RANSAC随机抽样问题，能在保证立体影像对相对姿态恢复精度的同时，快速的实现立体影像对相对姿态恢复，从而满足部分摄影测量及其他应用中对计算速度的要求，节约系统资源，提高实时性，支持摄影测量等设备的优化设计制造，具有重要的市场价值。附图说明图1为本专利技术实施例的流程图。图2为本专利技术实施例的极线几何示意图。图3为本专利技术实施例的本质矩阵分解的4个可能解的几何解释示意图，其中图3a为正确解示意图，图3b为基线倒置示意图，图3c为P2绕基线旋转了180度示意图，图3d为基线倒置的同时P2绕基线旋转了180度示意图。具体实施方式下面结合附图和实施例对本专利技术的技术方案作进一步说明。本专利技术提供一种立体影像对相对姿态恢复方法。首先使用像对中所有的对应点来构建方程，并结合本质矩阵的性质直接计算本质矩阵，然后依据求得的本质矩阵剔除对应点中的粗差，并将求解本质矩阵和剔除粗差的步骤重复多次，直到无法检测到新的粗差为止，最后将求得的本质矩阵分解，得到立体影像对的相对姿态。如图1所示，本专利技术实施例的流程包括以下步骤：设立体影像中存在N对对应点，其影像坐标是已知的，以齐次坐标表达，为(ximg，yimg，1)；左右影像的摄像机经过标定，其中标定矩阵是已知的，用K1和K2表示。以上是本专利技术所需的计算数据。步骤1，使用立体影像对中全部对应点通过极线约束构建方程组并求解本质矩阵。第一次执行步骤1时使用初始的N对对应点，后续迭代执行步骤1时采用上一次提出粗差后的当前全部对应点。首先，通过将左右影像中对应点的影像坐标(ximg，yimg，1)转化为相机坐标(xcam，ycam，f)，其中f表示影像对应相机的焦距。方法为：将以齐次坐标表达影像坐标分别乘以和和为标定矩阵K1和K2的逆矩阵。再进行归一化，将相机坐标由(xcam，ycam，f)转化为并使用所有对应点通过极线约束构建方程组。极线几何如图2所示，有左影像相机坐标系xyz，右影像相机坐标系x′y′z′，物体在左右影像中的对应点分别为像点p和像点p′，其齐次化影像坐标在下文中用x和x′表示，相机坐标在下文中用和表示。极线约束如公式(1)所示：和是三维的列向量，表示立体影像对中左影像和右影像对应点的相机坐标，E为本质矩阵，本专利技术中上标T都表示向量或矩阵的转置。用矩阵A表示该方程组的系数，则A为N×9的矩阵。本质矩阵的9个元素之间存在相关性，其自由度为5，因此该方程组的未知数之间存在相关性，A矩阵的列向量是线性相关的，其列秩为5。故该方程组的秩为5，其解为由四个通解构成的基础解系。在实际应用中由于存在误差，因此需要使用奇异值分解求该方程组的最小二乘解。对A进行奇异值分解，得到其中UA、DA、本文档来自技高网...

【技术保护点】
1.一种立体影像对相对姿态恢复方法，其特征在于，包括如下步骤：步骤1，使用立体影像对中全部对应点通过极线约束构建方程组并求解本质矩阵；步骤2，从步骤1的结果中选取最优的本质矩阵；步骤3，利用步骤2选取的本质矩阵检测并剔除粗差，并依据粗差检测结果判断是否返回步骤1进行迭代，当无法检测到新的粗差时结束迭代进入步骤4；步骤4，分解当前选取的本质矩阵恢复立体影像对的相对姿态。

【技术特征摘要】
1.一种立体影像对相对姿态恢复方法，其特征在于，包括如下步骤：步骤1，使用立体影像对中全部对应点通过极线约束构建方程组并求解本质矩阵；步骤2，从步骤1的结果中选取最优的本质矩阵；步骤3，利用步骤2选取的本质矩阵检测并剔除粗差，并依据粗差检测结果判断是否返回步骤1进行迭代，当无法检测到新的粗差时结束迭代进入步骤4；步骤4，分解当前选取的本质矩阵恢复立体影像对的相对姿态。2.如权利要求1所述的一种立体影像对相对姿态恢复方法，其特征在于：所述步骤1中，使用立体影像对中全部对应点通过极线约束构建方程组并求解本质矩阵的实现方式如下，将全部对应点代入极线约束中，构建方程组，极线约束如(1)所示：其中，和和是三维的列向量，表示立体影像对中左影像和右影像对应点的相机坐标，E为本质矩阵；求解方程组，得到一个由四个通解构成的基础解系；将求得的四个通解代入本质矩阵的性质中，构建新的方程，所使用的本质矩阵性质如(2)(3)所示；对新的方程进行高斯消元，并通过基求解；将求得的实数解代入基础解系，得到本质矩阵；det(E)＝0(2)2EETE-trance(EET)E＝0(3)。3.如权利要求2所述的一种立体影像对相对姿态恢复方法，其特征在于：所述步骤2中，从步骤1的结果中选取最优本质矩阵的实现方式如下，将步骤1求得的本质矩阵E转化为基本矩阵F，并为所有对应点计算对称...

【专利技术属性】
技术研发人员：赵双明，崔云帆，常青，
申请(专利权)人：武汉大学，
类型：发明
国别省市：湖北,42