[发明专利]用于超大场景测量多视角相机的位姿估计方法

说明书

本发明涉及图像测量技术领域，公开了一种用于超大场景测量多视角相机的位姿估计方法，包括如下步骤：将旋转矩阵和平移矩阵转换到指数映射空间；优化多视角位姿的参数；指数空间数据向旋转平移转化。本发明用于超大场景测量多视角相机的位姿估计方法，采用指数映射空间，参数少，计算量低，提高了非线性优化速度。

技术领域

本发明涉及图像测量技术领域，具体涉及一种用于超大场景测量多视角相机的位姿估计方法。

背景技术

船舶在海洋中航行受到海水的作用而发生变形，对于单个部件的设计其刚度能够满足需要，但是船舶是一个整体性设计工程，在船舶上安装的每一个设备都将对船舶的整体性产生影响，传统方法测量难以很好的解决整体性问题，现在数字图像测量技术能够很好的解决大场景多个相机的相互测量问题，目前基于数字图像的测量方法逐渐在成为工程中的一种测量手段，其具有远距离、非接触、高精度等优势，在某些特定的情况成为了不可替代的重要方法。其测量的高精度主要依赖成熟的理论计算，其中包括对相机镜头参数的标定、畸变的纠正以及各个视角下的位姿估计理论，因此，多个相机的位姿估计算法是位移测量的关键。

然而在运动测量或者基于图像建模的应用中，多视角位姿估计需要反复进行计算，这直接影响了该方法应用的实时性。传统方法是对旋转和平移矩阵进行计算，旋转矩阵存在9个元素，并且存在6个约束，因此其变量只有3个，用9个参数加6个约束来表示3个未知量的方法使得计算量大。

关于位姿估计，现有技术主要采用5点、6点法或者张氏标定算法进行位姿估计，从而计算旋转和平移矩阵。

采用5点、6点法的论文Zuzana Kukelova，Martin Bujnak et a1.《PolynomialEigenvalue Solutions to the 5-pt and 6-pt Relative Pose Problems》，其中基础矩阵E是3×3矩阵，而使用基础矩阵E，该矩阵自带附加的约束det(E)＝0，因此使得方程数量增加。张氏标定算法《Flexible Camera Calibration ByViewing a Plane From Unknown Orientations》，采用了单应性矩阵H进行计算，单应性矩阵H中包括了8个未知数，H＝[h₁ h₂ h₃]＝λA[r₁ r₂ t]，而方程中r₁和r₂正交，且r₁和r₂的模相等，因此可以得到约束/和/因此不论通过5点、6点法还是通过张氏标定算法，都将引入额外的约束，从而增加方程的个数，导致计算量增大。究其原因，主要是采用旋转矩阵R来描述问题时，旋转矩阵满足方程R^TR＝I，因此自带约束关系。

发明内容

本发明的目的就是针对上述技术的不足，提供一种用于超大场景测量多视角相机的位姿估计方法，采用指数映射空间，参数少，计算量低，提高了非线性优化速度。

为实现上述目的，本发明所设计的用于超大场景测量多视角相机的位姿估计方法，包括如下步骤：

A)将旋转矩阵和平移矩阵转换到指数映射空间：

设R_c为相机坐标系下相对世界坐标系下的旋转矩阵，T_c为相机坐标系下相对世界坐标系下的平移矩阵，将旋转矩阵R_c和平移矩阵T_c转换到指数映射空间，得到

式中，H为相机外参数，τ为向量表示，τ^∧为反对称矩阵，取得：

式中，θ为旋转轴的旋转角度，ρ为旋转轴长度，x为x轴，y为y轴，z为z轴，是θ归一化后的向量，取得