提出无偏加权PnP方法,提升立体视觉里程计的定位精度与稳定性。
Bias-Eliminated PnP for Stereo Visual Odometry: Provably Consistent and Large-Scale Localization
- 基于统计理论设计无偏且渐近一致的加权PnP估计器,自适应处理3D点三角化不确定性。
- 在KITTI和Oxford RobotCar上实现相对误差与绝对轨迹误差显著降低,大场景下表现更鲁棒。
- 适合高不确定性测量环境中的机器人定位任务,尤其适用于动态或复杂运动场景。
本文首次提出一种无偏加权(Bias-Eli-W)视角-三点(PnP)估计算法,用于立体视觉里程计(VO),并证明其一致性。通过统计理论,构建了渐近无偏、√n-一致的PnP估计器,可处理随特征数量变化的3D三角化不确定性,确保当特征数增加时,相对位姿估计收敛至真实值。此外,在立体VO流程中,提出持续三角化当前特征以追踪新帧的框架,有效解耦位姿与3D点误差间的时序依赖关系。将该估计算法集成至新框架,产生协同效应,显著抑制位姿估计误差。在KITTI和Oxford RobotCar数据集上的实验表明:1)在大规模环境中显著降低相对位姿误差与绝对轨迹误差;2)在机器人运动剧烈且不可预测的情况下仍能提供可靠定位。该方法的成功实施凸显了在高不确定性测量任务中信息筛选的重要性,为多种以PnP为核心模块的应用提供了新思路。
原文摘要 · Abstract (English)
In this paper, we first present a bias-eliminated weighted (Bias-Eli-W) perspective-n-point (PnP) estimator for stereo visual odometry (VO) with provable consistency. Specifically, leveraging statistical theory, we develop an asymptotically unbiased and $\sqrt {n}$-consistent PnP estimator that accounts for varying 3D triangulation uncertainties, ensuring that the relative pose estimate converges to the ground truth as the number of features increases. Next, on the stereo VO pipeline side, we propose a framework that continuously triangulates contemporary features for tracking new frames, effectively decoupling temporal dependencies between pose and 3D point errors. We integrate the Bias-Eli-W PnP estimator into the proposed stereo VO pipeline, creating a synergistic effect that enhances the suppression of pose estimation errors. We validate the performance of our method on the KITTI and Oxford RobotCar datasets. Experimental results demonstrate that our method: 1) achieves significant improvements in both relative pose error and absolute trajectory error in large-scale environments; 2) provides reliable localization under erratic and unpredictable robot motions. The successful implementation of the Bias-Eli-W PnP in stereo VO indicates the importance of information screening in robotic estimation tasks with high-uncertainty measurements, shedding light on diverse applications where PnP is a key ingredient.
Thank you to arXiv for use of its open access interoperability. PaperDance 不是 arXiv 官方产品;中文卡片由大模型生成,请以原文为准。