Guo Kai, Ye Hu, Gao Xin, Chen Honglin
Northwest Institute of Nuclear Technology, Xi'an 710024, China.
Sensors (Basel). 2022 Aug 8;22(15):5925. doi: 10.3390/s22155925.
In this paper, we proposed an accurate and robust method for absolute pose estimation with UAV (unmanned aerial vehicle) using RANSAC (random sample consensus). Because the artificial 3D control points with high accuracy are time-consuming and the small point set may lead low measuring accuracy, we designed a customized UAV to efficiently obtain mass 3D points. A light source was mounted on the UAV and used as a 3D point. The position of the 3D point was given by RTK (real-time kinematic) mounted on the UAV, and the position of the corresponding 2D point was given by feature extraction. The 2D-3D point correspondences exhibited some outliers because of the failure of feature extraction, the error of RTK, and wrong matches. Hence, RANSAC was used to remove the outliers and obtain the coarse pose. Then, we proposed a method to refine the coarse pose, whose procedure was formulated as the optimization of a cost function about the reprojection error based on the error transferring model and gradient descent to refine it. Before that, normalization was given for all the valid 2D-3D point correspondences to improve the estimation accuracy. In addition, we manufactured a prototype of a UAV with RTK and light source to obtain mass 2D-3D point correspondences for real images. Lastly, we provided a thorough test using synthetic data and real images, compared with several state-of-the-art perspective-n-point solvers. Experimental results showed that, even with a high outlier ratio, our proposed method had better performance in terms of numerical stability, noise sensitivity, and computational speed.
在本文中,我们提出了一种使用随机抽样一致性算法(RANSAC)对无人机进行绝对位姿估计的精确且稳健的方法。由于高精度的人工三维控制点获取耗时且小点数集可能导致测量精度较低,我们设计了一款定制无人机以高效获取大量三维点。在无人机上安装一个光源并将其用作三维点。三维点的位置由安装在无人机上的实时动态定位(RTK)给出,相应二维点的位置通过特征提取得到。由于特征提取失败、RTK误差和错误匹配,二维 - 三维点对应关系中存在一些异常值。因此,使用RANSAC去除异常值并获得粗略位姿。然后,我们提出了一种细化粗略位姿的方法,其过程被表述为基于误差传递模型和梯度下降对关于重投影误差的代价函数进行优化以对其进行细化。在此之前,对所有有效的二维 - 三维点对应关系进行归一化处理以提高估计精度。此外,我们制造了一款带有RTK和光源的无人机原型,以获取真实图像的大量二维 - 三维点对应关系。最后,我们使用合成数据和真实图像进行了全面测试,并与几种先进的透视n点求解器进行了比较。实验结果表明,即使在异常值比例较高的情况下,我们提出的方法在数值稳定性、噪声敏感性和计算速度方面也具有更好的性能。