透视三点问题的一种快速且稳定的代数解法

摘要

对于经典的透视三点(P3P)问题,当三维控制点的Z轴坐标在较大范围内随机分布时,仍然存在数值稳定性差、图像噪声增加导致的退化、计算效率低的问题。为此,文中提出了一种快速且稳定的代数求解方法。首先,在根据3个三维到二维的对应点对估计已校准摄像机的旋转角度和相对位置时,在世界坐标系与相机坐标系之间引入中间坐标系,以减少未知参数的数量,并对旋转矩阵进行归一化,以简化计算过程,提高计算效率;然后,选取两个控制点的中心作为中间坐标系的坐标原点,以提高P3P问题在退化配置中的抗噪性能;最后,通过使用Gröbner基将P3P问题转化为求解只有一个未知参数的四次方程,求出P3P问题的封闭解。实验结果表明,文中算法的数值稳定性以及在退化配置中的抗噪性能,均优于其他3种P3P问题的经典算法。