cs.ROApr 24, 2025

Bias-Eliminated PnP for Stereo Visual Odometry: Provably Consistent and Large-Scale Localization

Authors: Guangyang Zeng, Yuan Shen, Ziyang Hong, Yuze Hong, Viorela Ila, Guodong Shi, Junfeng Wu

Organizations: School of Data Science, Chinese University of Hong Kong, Shenzhen 518172, China. · Australian Center for Robotics and School of Aerospace, Mechanical and Mechatronic Engineering, University of Sydney, Australia.

Abstract

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 n\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.

Figures & tables

Explore similar work

CardsList
  1. SFVO: Decoupled Confidence-Guided Stereo-Flow Visual Odometry with Bidirectional PnP

    Sep 18, 2026Kai Zhang, Guoyang Zhao, Jun MaVisual OdometryCamera Pose Estimation

  2. PnP*: A certifiable solver for Perspective-n-Point

    Oct 22, 2026Bang-Shien Chen, Caitrin E. Eaton, David M. RosenCamera Pose EstimationConvex Relaxation