Error growth in position estimation from noisy relative pose measurements

We examine how the estimation error grows with time when a mobile robot estimates its location from relative pose measurements without global position or orientation sensors. We show that, in both two-dimensional and three-dimensional space, both the bias and the variance of the position estimation error grows at most linearly with time asymptotically. Non-asymptotic bounds on the bias and variance are obtained, which provide insight into the mechanism of error growth. The bias is crucially dependent on the trajectory of the robot. Conclusions on the asymptotic growth rate of the bias continue to hold even with unbiased measurements or error-free translation measurements. Exact formulas for the bias and the variance of the position estimation error are provided for two specific two-dimensional trajectories-straight line and periodic. Experiments with a P3-DX wheeled robot and Monte Carlo simulations are provided to verify the theoretical predictions. A method to reduce the bias is proposed based on the lessons learned.

[1]  Gregory S. Chirikjian,et al.  Probabilistic models of dead-reckoning error in nonholonomic mobile robots , 2003, 2003 IEEE International Conference on Robotics and Automation (Cat. No.03CH37422).

[2]  Peter Cheeseman,et al.  On the Representation and Estimation of Spatial Uncertainty , 1986 .

[3]  Luke Fletcher,et al.  Multiple relative pose graphs for robust cooperative mapping , 2010, 2010 IEEE International Conference on Robotics and Automation.

[4]  Clark F. Olson,et al.  Rover navigation using stereo ego-motion , 2003, Robotics Auton. Syst..

[5]  Stergios I. Roumeliotis,et al.  Distributed Maximum A Posteriori Estimation for Multi-robot Cooperative Localization , 2009 .

[6]  Ian D. Reid,et al.  Article in Press Robotics and Autonomous Systems ( ) – Robotics and Autonomous Systems a Comparison of Loop Closing Techniques in Monocular Slam , 2022 .

[7]  Timothy D. Barfoot,et al.  Path planning on a network of paths , 2011, 2011 Aerospace Conference.

[8]  Paul Smith,et al.  Computing MAP trajectories by representing, propagating and combining PDFs over groups , 2003, Proceedings Ninth IEEE International Conference on Computer Vision.

[9]  M. Spong,et al.  Robot Modeling and Control , 2005 .

[10]  Gaurav S. Sukhatme,et al.  Bias Reduction and Filter Convergence for Long Range Stereo , 2005, ISRR.

[11]  Giuseppe Carlo Calafiore,et al.  Multi-agent localization from noisy relative pose measurements , 2011, 2011 IEEE International Conference on Robotics and Automation.

[12]  Supun Samarasekera,et al.  Visual Odometry System Using Multiple Stereo Cameras and Inertial Measurement Unit , 2007, 2007 IEEE Conference on Computer Vision and Pattern Recognition.

[13]  S. Shankar Sastry,et al.  An Invitation to 3-D Vision , 2004 .

[14]  Shigang Wang,et al.  Modeling of Unbounded Long-Range Drift in Visual Odometry , 2010, 2010 Fourth Pacific-Rim Symposium on Image and Video Technology.

[15]  Hernán Badino,et al.  A Robust Approach for Ego-Motion Estimation Using a Mobile Stereo Platform , 2004, IWCM.

[16]  Frank Chongwoo Park,et al.  Particle Filtering on the Euclidean Group , 2007, Proceedings 2007 IEEE International Conference on Robotics and Automation.

[17]  K. Kanatani,et al.  Statistical optimization and geometric inference in computer vision , 1998, Philosophical Transactions of the Royal Society of London. Series A: Mathematical, Physical and Engineering Sciences.

[18]  Gregory S. Chirikjian,et al.  Error propagation on the Euclidean group with applications to manipulator kinematics , 2006, IEEE Transactions on Robotics.

[19]  C. S. George Lee,et al.  Manipulation and propagation of uncertainty and verification of applicability of actions in assembly tasks , 1992, IEEE Trans. Syst. Man Cybern..

[20]  Frans C. A. Groen,et al.  Bias reduction for stereo based motion estimation with applications to large scale visual odometry , 2009, 2009 IEEE Conference on Computer Vision and Pattern Recognition.

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

[22]  Gregory S. Chirikjian,et al.  Nonparametric Second-order Theory of Error Propagation on Motion Groups , 2008, Int. J. Robotics Res..

[23]  S. Se,et al.  VISION BASED MODELING AND LOCALIZATION FOR PLANETARY EXPLORATION ROVERS , 2004 .

[24]  G. Lachapelle,et al.  PEDESTRIAN DEAD RECKONING— A SOLUTION TO NAVIGATION IN GPS SIGNAL DEGRADED AREAS? , 2005 .

[25]  Nicholas I. Fisher,et al.  Statistical Analysis of Spherical Data. , 1987 .

[26]  Richard Volpe.  Mars rover navigation results using sun sensor heading determination , 1999, Proceedings 1999 IEEE/RSJ International Conference on Intelligent Robots and Systems. Human and Environment Friendly Robots with High Intelligence and Emotional Quotients (Cat. No.99CH36289).

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

[28]  Dieter Schmalstieg,et al.  Automatic Reconstruction of Wide-Area Fiducial Marker Models , 2007, 2007 6th IEEE and ACM International Symposium on Mixed and Augmented Reality.

[29]  Bernhard P. Wrobel,et al.  Multiple View Geometry in Computer Vision , 2001 .

[30]  Didier Stricker,et al.  Advanced tracking through efficient image processing and visual-inertial sensor fusion , 2008, 2008 IEEE Virtual Reality Conference.

[31]  John Enright,et al.  Visual odometry aided by a sun sensor and inclinometer , 2011 .

[32]  Nicholas I. Fisher,et al.  Statistical Analysis of Spherical Data. , 1987 .

[33]  Sébastien Krut,et al.  Internal singularity analysis of a class of lower mobility parallel manipulators with articulated traveling plate , 2006, IEEE Transactions on Robotics.

[34]  Prabir Barooah,et al.  Distributed collaborative localization of multiple vehicles from relative pose measurements , 2009, 2009 47th Annual Allerton Conference on Communication, Control, and Computing (Allerton).