Mapping of complex marine environments using an unmanned surface craft

Recent technology has combined accurate GPS localization with mapping to build 3D maps in a diverse range of terrestrial environments, but the mapping of marine environments lags behind. This is particularly true in shallow water and coastal areas with man-made structures such as bridges, piers, and marinas, which can pose formidable challenges to autonomous underwater vehicle (AUV) operations. In this thesis, we propose a new approach for mapping shallow water marine environments, combining data from both above and below the water in a robust probabilistic state estimation framework. The ability to rapidly acquire detailed maps of these environments would have many applications, including surveillance, environmental monitoring, forensic search, and disaster recovery. Whereas most recent AUV mapping research has been limited to open waters, far from man-made surface structures, in our work we focus on complex shallow water environments, such as rivers and harbors, where man-made structures block GPS signals and pose hazards to navigation. Our goal is to enable an autonomous surface craft to combine data from the heterogeneous environments above and below the water surface – as if the water were drained, and we had a complete integrated model of the marine environment, with full visibility. To tackle this problem, we propose a new framework for 3D SLAM in marine environments that combines data obtained concurrently from above and below the water in a robust probabilistic state estimation framework. Our work makes systems, algorithmic, and experimental contributions in perceptual robotics for the marine environment. We have created a novel Autonomous Surface Vehicle (ASV), equipped with substantial onboard computation and an extensive sensor suite that includes three SICK lidars, a Blueview MB2250 imaging sonar, a Doppler Velocity Log, and an integrated global positioning system/inertial measurement unit (GPS/IMU) device. The data from these sensors is processed in a hybrid metric/topological SLAM state estimation framework. A key challenge to mapping is extracting effective constraints from 3D lidar data despite GPS loss and reacquisition. This was achieved by developing a GPS trust engine that uses a semi-supervised learning classifier to ascertain the validity of GPS information for different segments of the vehicle trajectory. This eliminates the troublesome effects of multipath on the vehicle trajectory estimate, and provides cues for submap decomposition. Localization from lidar point clouds is performed using octrees combined with Iterative Closest Point (ICP) matching, which provides constraints between submaps both within and across different mapping sessions. Submap positions are optimized via least squares optimization of the graph of constraints, to achieve global alignment. The global vehicle trajectory is used for subsea sonar bathymetric map generation and for mesh reconstruction from lidar data for 3D visualization of above-water structures. We present experimental results in the vicinity of several structures spanning or along the Charles River between Boston and Cambridge, MA. The Harvard and Longfellow Bridges, three sailing pavilions and a yacht club provide structures of interest, having both extensive superstructure and subsurface foundations. To quantitatively assess the mapping error, we compare against a georeferenced model of the Harvard Bridge using blueprints from the Library of Congress. Our results demonstrate the potential of this new approach to achieve robust and efficient model capture for complex shallow-water marine environments. Future work aims to incorporate autonomy for path planning of a region of interest while performing collision avoidance to enable fully autonomous surveys that achieve full sensor coverage of a complete marine environment. (Copies available exclusively from MIT Libraries, Rm. 14-0551, Cambridge, MA 02139-4307. Ph. 617-253-5668; Fax 617-253-1690.)

[1]  John F. Canny,et al.  A Computational Approach to Edge Detection , 1986, IEEE Transactions on Pattern Analysis and Machine Intelligence.

[2]  M. Purcell,et al.  REMUS: a small, low cost AUV; system description, field trials and performance results , 1997, Oceans '97. MTS/IEEE Conference Proceedings.

[3]  Luke Fletcher,et al.  Simultaneous local and global state estimation for robotic navigation , 2009, 2009 IEEE International Conference on Robotics and Automation.

[4]  Joachim Hertzberg,et al.  An autonomous mobile robot with a 3D laser range finder for 3D exploration and digitalization of indoor environments , 2003, Robotics Auton. Syst..

[5]  J. Craighead,et al.  Use of Tethered Small Unmanned Aerial System at Berkman Plaza II Collapse , 2008, 2008 IEEE International Workshop on Safety, Security and Rescue Robotics.

[6]  J.E. Manley,et al.  Unmanned surface vehicles, 15 years of development , 2008, OCEANS 2008.

[7]  José A. Castellanos,et al.  Multisensor fusion for simultaneous localization and map building , 2001, IEEE Trans. Robotics Autom..

[8]  J. Wilhelms,et al.  Octrees for faster isosurface generation , 1992, TOGS.

[9]  S. J. Corfield,et al.  Unmanned surface vehicles - game changing technology for naval operations , 2006 .

[10]  Sebastian Thrun,et al.  FastSLAM: a factored solution to the simultaneous localization and mapping problem , 2002, AAAI/IAAI.

[11]  C. Roman Self Consistent Bathymetric Mapping From Robotic Vehicles in the Deep Ocean , 2005 .

[12]  Wolfram Burgard,et al.  Autonomous exploration and mapping of abandoned mines , 2004, IEEE Robotics & Automation Magazine.

[13]  Marco Bibuli,et al.  Unmanned Surface Vehicle for Coastal and Protected Waters Applications: the Charlie Project , 2007 .

[14]  Albert-Jan Baerveldt,et al.  Robot localization based on scan-matching - estimating the covariance matrix for the IDC algorithm , 2003, Robotics Auton. Syst..

[15]  S. M. Smith,et al.  Experimental results of an inexpensive short baseline acoustic positioning system for AUV navigation , 1997, Oceans '97. MTS/IEEE Conference Proceedings.

[16]  Michael Bosse,et al.  Simultaneous Localization and Map Building in Large-Scale Cyclic Environments Using the Atlas Framework , 2004, Int. J. Robotics Res..

[17]  Paolo Cignoni,et al.  MeshLab: an Open-Source 3D Mesh Processing System , 2008, ERCIM News.

[18]  David Wettergreen,et al.  Real‐Time SLAM with Octree Evidence Grids for Exploration in Underwater Tunnels , 2007, J. Field Robotics.

[19]  John J. Leonard,et al.  Directed Sonar Sensing for Mobile Robot Navigation , 1992 .

[20]  J.T. Cobb,et al.  Forward-Looking Sonar Target Tracking and Homing From a Small AIV , 2005, Proceedings of OCEANS 2005 MTS/IEEE.

[21]  Frank Dellaert,et al.  3D reconstruction of underwater structures , 2010, 2010 IEEE/RSJ International Conference on Intelligent Robots and Systems.

[22]  Michael Bosse,et al.  ATLAS: a framework for large scale automated mapping and localization , 2004 .

[23]  Seth J. Teller,et al.  Automatic recovery of relative camera rotations for urban scenes , 2000, Proceedings IEEE Conference on Computer Vision and Pattern Recognition. CVPR 2000 (Cat. No.PR00662).

[24]  M. Purcell,et al.  Hunting for mines with REMUS: a high performance, affordable, free swimming underwater robot , 2001, MTS/IEEE Oceans 2001. An Ocean Odyssey. Conference Proceedings (IEEE Cat. No.01CH37295).

[25]  Junku Yuh,et al.  Design and Control of Autonomous Underwater Robots: A Survey , 2000, Auton. Robots.

[26]  Stefan B. Williams,et al.  Generation and visualization of large‐scale three‐dimensional reconstructions from underwater robotic surveys , 2010, J. Field Robotics.

[27]  Huosheng Hu,et al.  3D mapping with multi-resolution occupied voxel lists , 2010, Auton. Robots.

[28]  Wolfram Burgard,et al.  Coastal Navigation { Robot Motion with Uncertainty , 1998, AAAI 1998.

[29]  Edwin Olson,et al.  Robust and efficient robotic mapping , 2008 .

[30]  John J. Leonard,et al.  Protocol-Based COLREGS Collision Avoidance Navigation Between Unmanned Marine Surface Craft , 2006 .

[31]  Berthold K. P. Horn,et al.  Closed-form solution of absolute orientation using unit quaternions , 1987 .

[32]  Wolfram Burgard,et al.  Efficient Sparse Pose Adjustment for 2D mapping , 2010, 2010 IEEE/RSJ International Conference on Intelligent Robots and Systems.

[33]  J. Laurie Snell,et al.  Markov Random Fields and Their Applications , 1980 .

[34]  Frank Dellaert,et al.  Subgraph-preconditioned conjugate gradients for large scale SLAM , 2010, 2010 IEEE/RSJ International Conference on Intelligent Robots and Systems.

[35]  Hanumant Singh,et al.  Consistency based error evaluation for deep sea bathymetric mapping with robotic vehicles , 2006, Proceedings 2006 IEEE International Conference on Robotics and Automation, 2006. ICRA 2006..

[36]  S. LaValle Rapidly-exploring random trees : a new tool for path planning , 1998 .

[37]  A.J. Shafer,et al.  Autonomous cooperation of heterogeneous platforms for sea-based search tasks , 2008, OCEANS 2008.

[38]  N. Fairfield Localization, mapping, and planning in 3D environments , 2009 .

[39]  Wolfram Burgard,et al.  A Tree Parameterization for Efficiently Computing Maximum Likelihood Maps using Gradient Descent , 2007, Robotics: Science and Systems.

[40]  Fan-Ren Chang,et al.  A Solution to the Ill-Conditioned GPS Positioning Problem in an Urban Environment , 2009, IEEE Transactions on Intelligent Transportation Systems.

[41]  조동우 A Bayesian Method for Certainty Grids , 1989 .

[42]  Markus H. Gross,et al.  Efficient simplification of point-sampled surfaces , 2002, IEEE Visualization, 2002. VIS 2002..

[43]  Sebastian Thrun,et al.  Large-Scale Robotic 3-D Mapping of Urban Structures , 2004, ISER.

[44]  Michael Bosse,et al.  Keypoint design and evaluation for place recognition in 2D lidar maps , 2009, Robotics Auton. Syst..

[45]  David S. Wettergreen,et al.  Active localization on the ocean floor with multibeam sonar , 2008, OCEANS 2008.

[46]  S. LaValle,et al.  Randomized Kinodynamic Planning , 2001 .

[47]  Alexander Leonessa,et al.  Design of a small, multi-purpose, autonomous surface vessel , 2003, Oceans 2003. Celebrating the Past ... Teaming Toward the Future (IEEE Cat. No.03CH37492).

[48]  Ian D. Reid,et al.  Vast-scale Outdoor Navigation Using Adaptive Relative Bundle Adjustment , 2010, Int. J. Robotics Res..

[49]  Ryan M. Eustice,et al.  Large-area visually augmented navigation for autonomous underwater vehicles , 2005 .

[50]  Hugh Durrant-Whyte,et al.  Simultaneous Localisation and Mapping ( SLAM ) : Part I The Essential Algorithms , 2006 .

[51]  J. M. Wozencraft,et al.  Complete coastal mapping with airborne lidar , 2002, OCEANS '02 MTS/IEEE.

[52]  Gabriel Taubin,et al.  The ball-pivoting algorithm for surface reconstruction , 1999, IEEE Transactions on Visualization and Computer Graphics.

[53]  Roni Yagel,et al.  Octree-based decimation of marching cubes surfaces , 1996, Proceedings of Seventh Annual IEEE Visualization '96.

[54]  E. Olson,et al.  Robust Range-Only Beacon Localization , 2004, IEEE Journal of Oceanic Engineering.

[55]  Matthew R. Walter,et al.  Exactly Sparse Extended Information Filters for Feature-based SLAM , 2007, Int. J. Robotics Res..

[56]  Michael Ian Shamos,et al.  Divide-and-conquer in multidimensional space , 1976, STOC '76.

[57]  Jeffrey K. Uhlmann,et al.  New extension of the Kalman filter to nonlinear systems , 1997, Defense, Security, and Sensing.

[58]  R. Stokey,et al.  Very shallow water mine countermeasures using the REMUS AUV: a practical approach yielding accurate results , 2001, MTS/IEEE Oceans 2001. An Ocean Odyssey. Conference Proceedings (IEEE Cat. No.01CH37295).

[59]  Frank Dellaert,et al.  Multi-level submap based SLAM using nested dissection , 2010, 2010 IEEE/RSJ International Conference on Intelligent Robots and Systems.

[60]  Sven Koenig,et al.  Incremental A* , 2001, NIPS.

[61]  Pere Ridao,et al.  Underwater SLAM in man-made structured environments , 2008 .

[62]  Hugh F. Durrant-Whyte,et al.  Mobile robot localization by tracking geometric beacons , 1991, IEEE Trans. Robotics Autom..

[63]  Nico Blodow,et al.  Towards 3D Point cloud based object maps for household environments , 2008, Robotics Auton. Syst..

[64]  Hanumant Singh,et al.  Visually Mapping the RMS Titanic: Conservative Covariance Estimates for SLAM Information Filters , 2006, Int. J. Robotics Res..

[65]  Oleg A. Yakimenko,et al.  RECENT DEVELOPMENTS FOR AN OBSTACLE AVOIDANCE SYSTEM FOR A SMALL AUV , 2007 .

[66]  Peter Cheeseman,et al.  A stochastic map for uncertain spatial relationships , 1988 .

[67]  Wolfram Burgard,et al.  An Efficient Extension to Elevation Maps for Outdoor Terrain Mapping and Loop Closing , 2007, Int. J. Robotics Res..

[68]  Anna Vilanova,et al.  Visualization of boundaries in volumetric data sets using LH histograms , 2006, IEEE Transactions on Visualization and Computer Graphics.

[69]  Michael Bosse,et al.  Continuous 3D scan-matching with a spinning 2D laser , 2009, 2009 IEEE International Conference on Robotics and Automation.

[70]  John J. Leonard,et al.  Cooperative Localization for Autonomous Underwater Vehicles , 2009, Int. J. Robotics Res..

[71]  Hugh F. Durrant-Whyte,et al.  Simultaneous Localization and Mapping with Sparse Extended Information Filters , 2004, Int. J. Robotics Res..

[72]  Wolfram Burgard,et al.  Probabilistic Robotics (Intelligent Robotics and Autonomous Agents) , 2005 .

[73]  Rüdiger Westermann,et al.  Real-time exploration of regular volume data by adaptive reconstruction of isosurfaces , 1999, The Visual Computer.

[74]  John J. Leonard,et al.  Towards Constant-Time SLAM on an Autonomous Underwater Vehicle Using Synthetic Aperture Sonar , 2003, ISRR.

[75]  Christoph Stiller,et al.  Velodyne SLAM , 2011, 2011 IEEE Intelligent Vehicles Symposium (IV).

[76]  Xiaojin Gong,et al.  Shoreline Mapping using an Omni-directional Camera for Autonomous Surface Vehicle Applications , 2006, OCEANS 2006.

[77]  Noah Snavely,et al.  Scene Reconstruction and Visualization from Internet Photo Collections: A Survey , 2011, IPSJ Trans. Comput. Vis. Appl..

[78]  E. Feron,et al.  Real-time motion planning for agile autonomous vehicles , 2000, Proceedings of the 2001 American Control Conference. (Cat. No.01CH37148).

[79]  Alberto Elfes,et al.  Occupancy grids: a probabilistic framework for robot perception and navigation , 1989 .

[80]  Amir Averbuch,et al.  Interacting Multiple Model Methods in Target Tracking: A Survey , 1988 .

[81]  E. O. Belcher,et al.  Beamforming and imaging with acoustic lenses in small, high-frequency sonars , 1999, Oceans '99. MTS/IEEE. Riding the Crest into the 21st Century. Conference and Exhibition. Conference Proceedings (IEEE Cat. No.99CH37008).

[82]  John J. Leonard,et al.  Navigation of unmanned marine vehicles in accordance with the rules of the road , 2006, Proceedings 2006 IEEE International Conference on Robotics and Automation, 2006. ICRA 2006..

[83]  Frank Dellaert,et al.  Tectonic SAM: Exact, Out-of-Core, Submap-Based SLAM , 2007, Proceedings 2007 IEEE International Conference on Robotics and Automation.

[84]  Huosheng Hu,et al.  3D Laser range scanner with hemispherical field of view for robot navigation , 2008, 2008 IEEE/ASME International Conference on Advanced Intelligent Mechatronics.

[85]  Lindsay Kleeman,et al.  Uncertainty of Line Segments Extracted from Static SICK PLS Laser Scans , 2003 .

[86]  Justin E. Manley,et al.  Evolution of the autonomous surface craft AutoCat , 2000, OCEANS 2000 MTS/IEEE Conference and Exhibition. Conference Proceedings (Cat. No.00CH37158).

[87]  Paul Newman,et al.  High quality 3D laser ranging under general vehicle motion , 2008, 2008 IEEE International Conference on Robotics and Automation.

[88]  Hugh F. Durrant-Whyte,et al.  A solution to the simultaneous localization and map building (SLAM) problem , 2001, IEEE Trans. Robotics Autom..

[89]  D. Yoerger,et al.  Combined Doppler/LBL Based Navigation of Underwater Vehicles , 1999 .

[90]  Ronald Parr,et al.  Hierarchical Linear/Constant Time SLAM Using Particle Filters for Dense Maps , 2005, NIPS.

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

[92]  Pere Ridao,et al.  SLAM using an Imaging Sonar for Partially Structured Underwater Environments , 2006, 2006 IEEE/RSJ International Conference on Intelligent Robots and Systems.

[93]  Robin R. Murphy,et al.  Robot-assisted bridge inspection after Hurricane Ike , 2009, 2009 IEEE International Workshop on Safety, Security & Rescue Robotics (SSRR 2009).

[94]  Michael Bosse,et al.  Calibrated, Registered Images of an Extended Urban Area , 2001, Proceedings of the 2001 IEEE Computer Society Conference on Computer Vision and Pattern Recognition. CVPR 2001.

[95]  Justin Carlson,et al.  Mapping Large, Urban Environments with GPS-Aided SLAM , 2010 .

[96]  Reid G. Simmons,et al.  Approaches for heuristically biasing RRT growth , 2003, Proceedings 2003 IEEE/RSJ International Conference on Intelligent Robots and Systems (IROS 2003) (Cat. No.03CH37453).

[97]  Matthew R. Walter,et al.  A Provably Consistent Method for Imposing Sparsity in Feature-Based SLAM Information Filters , 2007, ISRR.

[98]  Wolfram Burgard,et al.  Improving Grid-based SLAM with Rao-Blackwellized Particle Filters by Adaptive Proposals and Selective Resampling , 2005, Proceedings of the 2005 IEEE International Conference on Robotics and Automation.

[99]  Frank Dellaert,et al.  Out-of-Core Bundle Adjustment for Large-Scale 3D Reconstruction , 2007, 2007 IEEE 11th International Conference on Computer Vision.

[100]  Abraham Bachrach,et al.  Autonomous flight in unstructured and unknown indoor environments , 2009 .

[101]  Frank Dellaert,et al.  Square Root SAM: Simultaneous Localization and Mapping via Square Root Information Smoothing , 2006, Int. J. Robotics Res..

[102]  Henrik I. Christensen,et al.  Graphical SLAM - a self-correcting map , 2004, IEEE International Conference on Robotics and Automation, 2004. Proceedings. ICRA '04. 2004.

[103]  Hanumant Singh,et al.  Improved vehicle based multibeam bathymetry using sub-maps and SLAM , 2005, 2005 IEEE/RSJ International Conference on Intelligent Robots and Systems.

[104]  Wolfram Burgard,et al.  A real-time algorithm for mobile robot mapping with applications to multi-robot and 3D mapping , 2000, Proceedings 2000 ICRA. Millennium Conference. IEEE International Conference on Robotics and Automation. Symposia Proceedings (Cat. No.00CH37065).

[105]  Edwin Olson,et al.  Real-time correlative scan matching , 2009, 2009 IEEE International Conference on Robotics and Automation.

[106]  Richard Szeliski,et al.  Skeletal graphs for efficient structure from motion , 2008, 2008 IEEE Conference on Computer Vision and Pattern Recognition.

[107]  Richard Szeliski,et al.  Building Rome in a day , 2009, ICCV.

[108]  J.-S. Gutmann,et al.  AMOS: comparison of scan matching approaches for self-localization in indoor environments , 1996, Proceedings of the First Euromicro Workshop on Advanced Mobile Robots (EUROBOT '96).

[109]  L. Whitcomb,et al.  A SURVEY OF UNDERWATER VEHICLE NAVIGATION : RECENT ADVANCES AND NEW CHALLENGES , 2006 .

[110]  Kurt Konolige,et al.  Sparse Sparse Bundle Adjustment , 2010, BMVC.

[111]  Gregory Dudek,et al.  Online control policy optimization for minimizing map uncertainty during exploration , 2004, IEEE International Conference on Robotics and Automation, 2004. Proceedings. ICRA '04. 2004.

[112]  J. Curcio,et al.  SCOUT - a low cost autonomous surface platform for research in cooperative autonomy , 2005, Proceedings of OCEANS 2005 MTS/IEEE.

[113]  Ronald Parr,et al.  DP-SLAM: fast, robust simultaneous localization and mapping without predetermined landmarks , 2003, IJCAI 2003.

[114]  Michael M. Kazhdan,et al.  Poisson surface reconstruction , 2006, SGP '06.

[115]  Michael Bosse,et al.  Map Matching and Data Association for Large-Scale Two-dimensional Laser Scan-based SLAM , 2008, Int. J. Robotics Res..

[116]  F. Frances Yao,et al.  Efficient binary space partitions for hidden-surface removal and solid modeling , 1990, Discret. Comput. Geom..

[117]  T. Başar,et al.  A New Approach to Linear Filtering and Prediction Problems , 2001 .

[118]  John Perry Fish,et al.  Sound underwater images : a guide to the generation and interpretation of side scan sonar data , 1990 .

[119]  Hanumant Singh,et al.  Experimental Results in Synchronous-Clock One-Way-Travel-Time Acoustic Navigation for Autonomous Underwater Vehicles , 2007, Proceedings 2007 IEEE International Conference on Robotics and Automation.

[120]  Hanan Samet,et al.  Implementing ray tracing with octrees and neighbor finding , 1989, Comput. Graph..

[121]  Hongyuan Zha,et al.  Adaptive Manifold Learning , 2004, IEEE Transactions on Pattern Analysis and Machine Intelligence.

[122]  Robin R. Murphy,et al.  Robot-Assisted Bridge Inspection , 2011, J. Intell. Robotic Syst..

[123]  David Wettergreen,et al.  3D mapping and characterization of sistema zacatón from DEPTHX (DĒep P̄hreatic TH̄ermal eX̄plorer) , 2008 .

[124]  Samuli Laine,et al.  Efficient Sparse Voxel Octrees , 2011, IEEE Trans. Vis. Comput. Graph..

[125]  Shuzhi Sam Ge,et al.  Autonomous vehicle positioning with GPS in urban canyon environments , 2001, IEEE Trans. Robotics Autom..

[126]  Frank Dellaert,et al.  iSAM: Incremental Smoothing and Mapping , 2008, IEEE Transactions on Robotics.

[127]  Larry H. Matthies,et al.  Integration of sonar and stereo range data using a grid-based representation , 1988, Proceedings. 1988 IEEE International Conference on Robotics and Automation.

[128]  Thia Kirubarajan,et al.  Estimation with Applications to Tracking and Navigation: Theory, Algorithms and Software , 2001 .

[129]  Kurt Konolige,et al.  Towards lifelong visual maps , 2009, 2009 IEEE/RSJ International Conference on Intelligent Robots and Systems.

[130]  Gaurav S. Sukhatme,et al.  Towards 3D mapping in large urban environments , 2004, 2004 IEEE/RSJ International Conference on Intelligent Robots and Systems (IROS) (IEEE Cat. No.04CH37566).

[131]  Paul Newman,et al.  Using laser range data for 3D SLAM in outdoor environments , 2006, Proceedings 2006 IEEE International Conference on Robotics and Automation, 2006. ICRA 2006..

[132]  M. Grund,et al.  Experiments in moving baseline navigation using autonomous surface craft , 2005, Proceedings of OCEANS 2005 MTS/IEEE.

[133]  L.L. Whitcomb,et al.  Recent Advances in Synchronous-Clock One-Way-Travel-Time Acoustic Navigation , 2006, OCEANS 2006.

[134]  Markus Hadwiger,et al.  High-quality two-level volume rendering of segmented data sets on consumer graphics hardware , 2003, IEEE Visualization, 2003. VIS 2003..

[135]  Terrance L. Huntsberger,et al.  Stereo vision–based navigation for autonomous surface vessels , 2011, J. Field Robotics.

[136]  Anthony Stentz Map-Based Strategies for Robot Navigation in Unknown Environments , 1998 .

[137]  K. S. Arun,et al.  Least-Squares Fitting of Two 3-D Point Sets , 1987, IEEE Transactions on Pattern Analysis and Machine Intelligence.

[138]  Jon Louis Bentley,et al.  K-d trees for semidynamic point sets , 1990, SCG '90.

[139]  Evangelos E. Milios,et al.  Globally Consistent Range Scan Alignment for Environment Mapping , 1997, Auton. Robots.

[140]  John J. Leonard,et al.  A Feature Based Navigation System for an Autonomous Underwater Robot , 2007, FSR.

[141]  Zhengyou Zhang,et al.  Iterative point matching for registration of free-form curves and surfaces , 1994, International Journal of Computer Vision.

[142]  Anil K. Jain,et al.  Markov random fields : theory and application , 1993 .

[143]  John Folkesson Simultaneous localization and mapping with robots , 2005 .

[144]  Viii Supervisor Sonar-Based Real-World Mapping and Navigation , 2001 .

[145]  Edwin Olson,et al.  Fast iterative alignment of pose graphs with poor initial estimates , 2006, Proceedings 2006 IEEE International Conference on Robotics and Automation, 2006. ICRA 2006..

[146]  Sebastian Thrun,et al.  6D SLAM with an application in autonomous mine mapping , 2004, IEEE International Conference on Robotics and Automation, 2004. Proceedings. ICRA '04. 2004.