Scan matching for flooded subterranean voids

This paper presents a new technique for scan matching with sparse, noisy sensors such as sonar range finders. This method allows an underwater vehicle to estimate its position within a 2-D plane. When combined with other sensors typically used on such vehicles, full 6 degree of freedom pose estimation is possible in flooded subterranean environments. Our approach uses a particle filter and an approximation of the likelihood of sensor readings, based on nearest neighbor distances, to approximate the probability distribution over possible poses. We present simulated results based on field-collected data, demonstrating our approaches advantages over traditional scan matching techniques.

[1]  Peter J. Huber,et al.  Robust Statistics , 2005, Wiley Series in Probability and Statistics.

[2]  Hans P. Moravec,et al.  High resolution maps from wide angle sonar , 1985, Proceedings. 1985 IEEE International Conference on Robotics and Automation.

[3]  Randall Smith,et al.  Estimating uncertain spatial relationships in robotics , 1986, Proceedings. 1987 IEEE International Conference on Robotics and Automation.

[4]  Hugh F. Durrant-Whyte,et al.  Simultaneous map building and localization for an autonomous mobile robot , 1991, Proceedings IROS '91:IEEE/RSJ International Workshop on Intelligent Robots and Systems '91.

[5]  Paul J. Besl,et al.  A Method for Registration of 3-D Shapes , 1992, IEEE Trans. Pattern Anal. Mach. Intell..

[6]  Evangelos E. Milios,et al.  Robot Pose Estimation in Unknown Environments by Matching 2D Range Scans , 1994, 1994 Proceedings of IEEE Conference on Computer Vision and Pattern Recognition.

[7]  Wolfram Burgard,et al.  Monte Carlo Localization: Efficient Position Estimation for Mobile Robots , 1999, AAAI/IAAI.

[8]  Hanumant Singh,et al.  Advances in Doppler-based navigation of underwater robotic vehicles , 1999, Proceedings 1999 IEEE International Conference on Robotics and Automation (Cat. No.99CH36288C).

[9]  Wolfram Burgard,et al.  Monte Carlo localization for mobile robots , 1999, Proceedings 1999 IEEE International Conference on Robotics and Automation (Cat. No.99CH36288C).

[10]  Stefan B. Williams,et al.  Autonomous underwater simultaneous localisation and map building , 2000, Proceedings 2000 ICRA. Millennium Conference. IEEE International Conference on Robotics and Automation. Symposia Proceedings (Cat. No.00CH37065).

[11]  Louis L. Whitcomb,et al.  Underwater robotics: out of the research laboratory and into the field , 2000, Proceedings 2000 ICRA. Millennium Conference. IEEE International Conference on Robotics and Automation. Symposia Proceedings (Cat. No.00CH37065).

[12]  John J. Leonard,et al.  Stochastic mapping using forward look sonar , 2001, Robotica.

[13]  Stefan B. Williams,et al.  TERRAIN AIDED UNDERWATER NAVIGATION – A DEEPER INSIGHT INTO GENERIC MONTE CARLO LOCALIZATION , 2003 .

[14]  Fredrik Gustafsson,et al.  Particle filter for underwater terrain navigation , 2003, IEEE Workshop on Statistical Signal Processing, 2003.

[15]  Dieter Fox,et al.  Adapting the Sample Size in Particle Filters Through KLD-Sampling , 2003, Int. J. Robotics Res..

[16]  John J. Leonard,et al.  Pure range-only sub-sea SLAM , 2003, 2003 IEEE International Conference on Robotics and Automation (Cat. No.03CH37422).

[17]  Wolfram Burgard,et al.  An efficient fastSLAM algorithm for generating maps of large-scale cyclic environments from raw laser range measurements , 2003, Proceedings 2003 IEEE/RSJ International Conference on Intelligent Robots and Systems (IROS 2003) (Cat. No.03CH37453).

[18]  Stefan B. Williams,et al.  Simultaneous localisation and mapping on the Great Barrier Reef , 2004, IEEE International Conference on Robotics and Automation, 2004. Proceedings. ICRA '04. 2004.

[19]  B. Ripley,et al.  Robust Statistics , 2018, Wiley Series in Probability and Statistics.

[20]  Masahiro Tomono,et al.  A scan matching method using Euclidean invariant signature for global localization and map building , 2004, IEEE International Conference on Robotics and Automation, 2004. Proceedings. ICRA '04. 2004.

[21]  Peter I. Corke,et al.  Low-cost vision-based AUV guidance system for reef navigation , 2004, IEEE International Conference on Robotics and Automation, 2004. Proceedings. ICRA '04. 2004.

[22]  Sebastian Thrun,et al.  A campaign in autonomous mine mapping , 2004, IEEE International Conference on Robotics and Automation, 2004. Proceedings. ICRA '04. 2004.