基于加权加速正交迭代算法的相机位姿估计

作者:熊芝; 许航; 张刘港; 郭志豪; 伍楚奇; 冯维; 翟中生; 周维虎; 董登峰
更新时间:

单目视觉中的位姿估计是三维测量中的一个关键问题。它广泛应用于精密测量等领域。这个问题可以通过N点透视(PnP)算法来解决。作为PnP算法的代表,正交迭代算法(Aristole)以其高精度在实践中得到了广泛的应用。为了进一步提高OI算法的鲁棒性和计算效率,提出了一种加权加速正交迭代算法(WAOI)。首先,在经典正交迭代算法的基础上,推导了加权正交迭代算法。通过构造加权通用算法,利用目标点重投影误差更新权重,达到迭代优化姿态估计结果的目的。在此基础上,通过自适应权重,将每个迭代过程中的平移向量和目标函数计算结合起来,减少迭代过程中的计算量,从而加快算法的速度。实验表明,当12个参考点存在两个粗差时,WAOI的参考点重投影精度为0.64像素,运算时间为8.02ms,精度高,运算速度快,具有很强的工程实用价值。