为了提高平面、近平面和近线等奇异构型目标点的位姿估计精度和稳定性,提出了面向奇异构型目标点分布的位姿估计算法。首先,选择距离最远的两个点作为基本目标点,将n点划分为n-2个三点子集。其次,根据三点子集的几何关系构建辅助点,旨在增加透射相似三角形法的几何约束,进而求得较为准确的相机位姿初值。最后,结合EPnP算法和高斯牛顿算法进行迭代优化,通过奇异值分解求得最终位姿。测量实验结果表明,当平面目标点数n=4时,正交迭代算法、EPnP算法和IEPnP算法的像方平均重投影误差分别为0.062mm、0.324mm和2.238mm,本文算法的像方平均重投影误差为0.003mm,有效提高了奇异构型下目标点的位姿估计精度和稳定性。
Aiming at improving the accuracy and stability of the pose estimation when the target points located in the planar, quasi-planar and quasi-linear case. In this study, we propose an iterative solution for singular configuration of target points. The main idea of the algorithm is to select two farthest points as the basic reference points, and divide n points into n-2 three-point sets. Then, the auxiliary points are constructed according to the geometric relationship of the three-point set, aiming to increase the geometric constraints of the perspective similar triangle algorithm, and obtain a more accurate initial value. Finally, the simplified EPnP algorithm is combined with Gaussian Newton algorithm for optimization. Experiments conducted on synthetic data and real images show that when the number of planar target points n=4, the average image re-projection error of this algorithm is 0.003 mm, compared with the orthogonal iterative algorithm, EPnP algorithm and IEPnP algorithm, which is 0.062 mm, 0.324 mm and 2.238 mm respectively, this algorithm effectively improves the accuracy and stability of the pose estimation of the target point in singular configuration.