Closed Form Solution for the Scale Ambiguity Problem in Monocular Visual Odometry

This paper presents a fast monocular visual odometry algorithm. We propose a closed form solution for the computation of the unknown scale ratio between two consecutive image pairs. Our method requires only 1 2D-3D correspondence. A least square solution can also be found in closed form when more correspondences are available. Additionally we provide a first order analysis on the propagation of the error from the noise in the image features to the computation of the scale. We show by means of simulated and real data that our method is more robust and accurate than standard techniques. We demonstrate that our visual odometry algorithm is well suited for the task of 3D reconstruction in urban areas.

[1]  Frank Dellaert,et al.  Structure from motion without correspondence , 2000, Proceedings IEEE Conference on Computer Vision and Pattern Recognition. CVPR 2000 (Cat. No.PR00662).

[2]  O. Pizarro,et al.  Visually Augmented Navigation for Autonomous Underwater Vehicles , 2008, IEEE Journal of Oceanic Engineering.

[3]  Zuzana Kukelova,et al.  A general solution to the P4P problem for camera with unknown focal length , 2008, 2008 IEEE Conference on Computer Vision and Pattern Recognition.

[4]  David G. Lowe,et al.  Distinctive Image Features from Scale-Invariant Keypoints , 2004, International Journal of Computer Vision.

[5]  Frans C. A. Groen,et al.  Accurate and robust ego-motion estimation using expectation maximization , 2008, 2008 IEEE/RSJ International Conference on Intelligent Robots and Systems.

[6]  Vincent Lepetit,et al.  Accurate Non-Iterative O(n) Solution to the PnP Problem , 2007, 2007 IEEE 11th International Conference on Computer Vision.

[7]  Roland Siegwart,et al.  Real-time monocular visual odometry for on-road vehicles with 1-point RANSAC , 2009, 2009 IEEE International Conference on Robotics and Automation.

[8]  Marie-Odile Berger,et al.  Computing the Uncertainty of the 8 point Algorithm for Fundamental Matrix Estimation , 2008, BMVC.

[9]  Kenichi Kanatani,et al.  Statistical optimization for geometric computation - theory and practice , 1996, Machine intelligence and pattern recognition.

[10]  Hugh F. Durrant-Whyte,et al.  Simultaneous localization and mapping: part I , 2006, IEEE Robotics & Automation Magazine.

[11]  David Nistér,et al.  An efficient solution to the five-point relative pose problem , 2003, 2003 IEEE Computer Society Conference on Computer Vision and Pattern Recognition, 2003. Proceedings..

[12]  B. Triggs,et al.  Camera Pose Revisited -- New Linear Algorithms , 2000 .

[13]  Judith Dijk,et al.  FIT3D toolbox: multiple view geometry and 3D reconstruction for Matlab , 2010, Security + Defence.

[14]  Roland Siegwart,et al.  Appearance-Guided Monocular Omnidirectional Visual Odometry for Outdoor Ground Vehicles , 2008, IEEE Transactions on Robotics.

[15]  Larry S. Davis,et al.  Exact and Approximate Solutions of the Perspective-Three-Point Problem , 1992, IEEE Trans. Pattern Anal. Mach. Intell..

[16]  Hans P. Moravec.  Obstacle avoidance and navigation in the real world by a seeing robot rover , 1980 .

[17]  Robert C. Bolles,et al.  Random sample consensus: a paradigm for model fitting with applications to image analysis and automated cartography , 1981, CACM.

[18]  Reinhard Koch,et al.  Visual Modeling with a Hand-Held Camera , 2004, International Journal of Computer Vision.

[19]  Andrew Zisserman,et al.  Multiple view geometry in computer visiond , 2001 .

[20]  James R. Bergen,et al.  Visual odometry for ground vehicle applications , 2006, J. Field Robotics.