单像空间后方交会算法的研究 下载: 1047次
1 引言
单像空间后方交会算法,是一种在三维空间中,根据控制点与像点之间的对应关系获得相机外参数的求解方法[1],主要有角锥体法和共线方程法两种。共线方程法可根据其变换过程中旋转变换的表达,分为基于旋转矩阵的共线方程法和基于四元数描述的共线方程法。官云兰等[2]通过改进角锥体法计算获得相机外参数,该算法需要利用多个控制点才能获得更高精度;刘建辉[3]通过实验证明基于几何代数的后方交会算法不依赖于初值,但是计算精度较低;黄旭等[4]利用单应性模型的约束条件,在多个控制点共面时可将共线方程转换为线性方程求解,无需初值就可以获得相机外参数的直接解;龚辉等[5]采用绝对定向与正交投影2种变换代替共线方程,利用非线性方程的直接迭代实现单像空间后方交会求解;贲进等[6]基于Pope-Hinsken算法,采用四元数构造旋转矩阵,计算结果一定程度上依赖于初值;江刚武等[7]直接迭代求解旋转矩阵,王勇等[8]采用四元数描述像片位置和姿态,这2种方法均避免了旋转矩阵与欧拉角相互转换引起的误差;江刚武等[9]提出了一种基于四元数的不依赖于初值的空间后方交会算法,实验结果表明该算法对外参数初值无特殊要求;徐振亮等[10]采用加权直接线性方法估计物像间的投影矩阵,经过转换计算后得到摄影测量中的外参数,计算过程较为复杂;吕继兵等[11-12]利用四元数推导了空间三维坐标转换方法,该方法无需线性化,计算过程较简单;洪洋等[13]提出了基于矩形几何特性的位姿分步估计方法;李鑫等[14]利用直线段之间的距离,通过求解三元三次方程组获得旋转矩阵的全局最优解;宋佳慧等[15]通过合作靶球与测量仪器靶球之间的相互替换,实现视觉坐标系和外部标准坐标系下公共点的直接获取,进而实现视觉传感器的外参标定。
本文通过研究提出了一种新的后方交会算法,此算法是利用3个控制点建立临时坐标系,根据这些控制点在临时坐标系下的部分坐标分量为0的特点,将后方交会求解转换为三元二次方程组的求解,3个控制点的图像坐标数据可为方程组的迭代求解提供初始值。
2 算法模型
2.1 共线条件方程
式中:
用(x,y)表示空间某控制点经过畸变纠正后的图像坐标,f为相机焦距,用(x',y')=
式中:λ为齐次因子。将(1)式代入(2)式中,可得:
2.2 求解算法
在控制点中任取3个不共线的控制点(M、N、L),以M点为原点,
若以坐标系O-XYZ为世界坐标系,(3)式仍然成立,在坐标系O-XYZ中,M、N、L 3点的三维坐标为
式中:XN、XL为N点、L点在O-XYZ坐标系中的X轴坐标;YL为L点在O-XYZ坐标系中的Y轴坐标。在坐标系O-XYZ下,M、N、L点的Z轴坐标均为0,消去齐次因子后,(3)式可表示为
将像点m的归一化图像坐标(x'm,y'm,1)以及空间点M在O-XYZ坐标系下的三维坐标(0,0,0)代入(5)式可得:
将像点n的归一化图像坐标(x'n,y'n,1)以及空间点N在O-XYZ坐标系下的三维坐标(XN,0,0)代入(5)式可得:
将(6)式和(7)式合并可得
式中:k1=x'n;e1=
将像点l的归一化图像坐标(x'l,y'l,1)以及空间点L在坐标系O-XYZ下的三维坐标(XL,YL,0)代入式(5)可得
将(8)式和(9)式合并可得
式中:q1=
将(10)式代入(8)式,并联立(10)式可得
式中:r11=k1·r1+e1·q1;r12=k1·r2+e1·q2;r13=k1·r3+e1·q3;r21=k2·r1+e2·q1;r22=k2·r2+e2·q2;r23=k2·r3+e2·q3;r31=r1;r32=r2;r33=r3。
旋转矩阵为单位正交矩阵,则有:
将(11)式代入(12)式,得到一个关于旋转矩阵元素b1、b2、b3的三元二次方程组,即
式中:u1=
向量
三元二次方程组的求解一般会出现多解的情况,可依据垂线向量
上述求解是以O-XYZ为世界坐标系求解出的外参数,依据坐标系O-XYZ与坐标系OW-XWYWZW之间的固有关系,则可将该参数转换至实际的世界坐标系中,转换过程此处不再详述[1,4]。
3 结果与分析
为验证本文算法的有效性,在实验空间中布设了由数百个控制点组成的控制场,采用某商用工业摄影测量系统对控制场拍摄120幅图像,并用系统软件测量出控制点的三维坐标,该商用系统软件测量完毕会输出每幅图像的外参数。如
表 3. 使用本文算法和DLT算法计算得到的相机外参数
Table 3. Results calculated by proposed algorithm and DLT algorithm
|
表 4. 在3个控制点中同时建立坐标系的计算结果
Table 4. Calculation results in three coordinate systems
|
如
表 2. 使用本文方法和角锥体法计算得到的相机外参数
Table 2. Results calculated by proposed algorithm and pyramid algorithm
|
表 1. 三维坐标与二维图像点坐标及相机外参数
Table 1. Three-dimensional coordinates, point coordinates of 2D image, and the external parameters of camera
|
分别使用本文方法和角锥体法计算外参数,计算结果如
根据
根据
在三元二次方程组的求解过程中,可以利用垂线向量
由上述实验及对比分析可知,本文方法求解的参数正确,适用于任意大小旋转角的相机外参数求解。
4 结论
提出一种新的后方交会求解算法,通过建立
临时坐标系,根据3个控制点在临时坐标系下的部分坐标分量为0的特点,将后方交会求解转换为三元二次方程组的求解,以3个控制点图像的坐标数据为三元二次方程组的求解提供初始值。针对三元二次方程组多解的情况,依据3个控制点的图像坐标数据进行错误解判断,同时采用两组数据分别求解,通过两组多解求出最接近的正确解,进行最终正确解的判断。计算结果表明,提出的后方交会算法迭代收敛性好,求解的参数准确性高。本文算法输出的外参数可作为后方交会整体平差的迭代初值。
表 5. 三元二次方程组求解结果
Table 5. Results of solving the quadratic equations
|
[1] 冯其强, 李广云, 黄桂平. 数字工业摄影测量中的单像空间后方交会[J]. 测绘通报, 2008( 6): 4- 6.
Feng QQ, Li GY, Huang GP. Single image space resection in digital industrial photogrammetry[J]. Bulletin of Surveying and Mapping, 2008( 6): 4- 6.
[2] 官云兰, 周世健, 周铭, 等. 基于角锥体原理的空间后方交会改进算法[J]. 测绘科学, 2006, 31(2): 27-28.
Guan Y L, Zhou S J, Zhou M, et al. An improved algorithm of space resection based on pyramid principle[J]. Science of Surveying and Mapping, 2006, 31(2): 27-28.
[3] 刘建辉. 基于几何代数的空间后方交会理论与方法[D]. 郑州: 解放军信息工程大学, 2011.
Liu JH. Principles and methods of space resection based on geometric algebra[D]. Zhengzhou: Information Engineering University, 2011.
[4] 黄旭, 张永军, 杨璟林, 等. 单应性几何下的后方交会直接解法[J]. 遥感学报, 2016, 20(3): 431-440.
Huang X, Zhang Y J, Yang J L, et al. Closed-form solution to space resection based on homography matrix[J]. Journal of Remote Sensing, 2016, 20(3): 431-440.
[5] 龚辉, 姜挺, 江刚武, 等. 一种基于四元数的空间后方交会全局收敛算法[J]. 测绘学报, 2011, 40(5): 639-645, 654.
Gong H, Jiang T, Jiang G W, et al. A globally convergent algorithm of space resection based on quaternion[J]. Acta Geodaetica et Cartographica Sinica, 2011, 40(5): 639-645, 654.
[6] 贲进, 童晓冲, 闾海庆. 基于Pope-Hinsken算法的空间后方交会[J]. 测绘科学技术学报, 2011, 28(1): 37-41.
Ben J, Tong X C, Lü H Q. Space resection based on the Pope-Hinsken algorithm[J]. Journal of Geomatics Science and Technology, 2011, 28(1): 37-41.
[7] 江刚武, 姜挺, 丁静, 等. 直接利用旋转矩阵进行空间后方交会的原理和方法[J]. 测绘科学技术学报, 2009, 26(1): 15-19, 23.
Jiang G W, Jiang T, Ding J, et al. Principle and method of space resection using orientation matrix[J]. Journal of Geomatics Science and Technology, 2009, 26(1): 15-19, 23.
[8] 王勇, 姜挺, 江刚武, 等. 基于单位四元数描述的单像空间后方交会[J]. 测绘科学技术学报, 2007, 24(2): 133-135, 144.
Wang Y, Jiang T, Jiang G W, et al. Space resection of single image based on the description of unit quaternions[J]. Journal of Zhengzhou Institute of Surveying and Mapping, 2007, 24(2): 133-135, 144.
[9] 江刚武, 姜挺, 王勇, 等. 基于单位四元数的无初值依赖空间后方交会[J]. 测绘学报, 2007, 36(2): 169-175.
Jiang G W, Jiang T, Wang Y, et al. Space resection independent of initial value based on unit quaternions[J]. Acta Geodaetica et Cartographica Sinica, 2007, 36(2): 169-175.
[10] 徐振亮, 李艳焕, 闫利. 单张大角度影像后方交会初值确定方法[J]. 辽宁工程技术大学学报(自然科学版), 2014, 33(7): 951-954.
Xu Z L, Li Y H, Yan L. Pose initial value determining method for single large-angle image[J]. Journal of Liaoning Technical University(Natural Science), 2014, 33(7): 951-954.
[11] 吕继兵, 朱建军, 伍雅晴. 基于单位四元数的三维空间坐标转换直接解法[J]. 资源信息与工程, 2017, 32(2): 94-96, 98.
Lü J B, Zhu J J, Wu Y Q. Direct solution of coordinate transformation in 3D space based on unit quaternion[J]. Resource Information and Engineering, 2017, 32(2): 94-96, 98.
[12] 王可伟, 岳东杰, 王性猛. 基于单位四元数的三维坐标转换新方法[J]. 测绘与空间地理信息, 2014, 37(11): 216-218.
Wang K W, Yue D J, Wang X M. A new method of the three-dimensional coordinate transformation based on the unit quaternion[J]. Geomatics & Spatial Information Technology, 2014, 37(11): 216-218.
[13] 洪洋, 孙秀霞, 王栋, 等. 基于矩形几何特性的小型无人机快速位姿估计方法[J]. 中国激光, 2016, 43(5): 0508006.
[14] 李鑫, 张跃强, 刘进博, 等. 基于直线段对应的相机位姿估计直接最小二乘法[J]. 光学学报, 2015, 35(6): 0615003.
[15] 宋佳慧, 任永杰, 杨守瑞, 等. 基于合作靶球的视觉传感器外参标定方法[J]. 光学学报, 2017, 37(9): 0915003.
陈继华, 孙荣旭, 张斌. 单像空间后方交会算法的研究[J]. 激光与光电子学进展, 2020, 57(2): 021504. Chen Jihua, Sun Rongxu, Zhang Bin. A New Algorithm for Single Image Space Based Resection[J]. Laser & Optoelectronics Progress, 2020, 57(2): 021504.