Uncertainty-driven survey path planning for bathymetric mapping

We present a novel survey path planning technique which minimizes the robot's position uncertainty along the planned path while taking into account area coverage performance. The proposed technique especially targets bathymetric mapping applications and respects application constraints such as the desire to survey in parallel tracks and to avoid turns in the target area to maximize sonar measurements quality. While accounting for uncertainty in the survey planning process can lead to more accurate data products, existing survey planning tools typically ignore it. Our method bridges this gap using the saliency on an a priori map to predict how the terrain will affect the robot's belief at every point on the target area. Based on this magnitude, we provide an algorithm that computes the order in which to trace parallel tracks to cover the target area minimizing the overall uncertainty along the path. A particle filter keeps track of the robot's position uncertainty during the planning process and, in order to find useful loop-closures for mapping, crossing tracks that visit salient locations are added when the uncertainty surpasses a user-provided threshold. We test our method on real-world datasets collected off the coasts of Spain, Greece and Australia. We evaluate the expected robot's position uncertainty along the planned paths and assess their associated mapping performance using a bathymetric mapping algorithm. Results show that our method offers benefits over a standard lawnmower-type path both in terms of position uncertainty and map quality.

[1]  Suman Chakravorty,et al.  Generalized Sampling-Based Motion Planners , 2011, IEEE Transactions on Systems, Man, and Cybernetics, Part B (Cybernetics).

[2]  Giorgio Gambosi,et al.  Complexity and approximation: combinatorial optimization problems and their approximability properties , 1999 .

[3]  Howie Choset,et al.  Morse Decompositions for Coverage Tasks , 2002, Int. J. Robotics Res..

[4]  Leslie Pack Kaelbling,et al.  Belief space planning assuming maximum likelihood observations , 2010, Robotics: Science and Systems.

[5]  Alain Lambert,et al.  Safe Path Planning in an Uncertain-Configuration Space using RRT , 2006, 2006 IEEE/RSJ International Conference on Intelligent Robots and Systems.

[6]  Steven M. LaValle,et al.  Rapidly-Exploring Random Trees: Progress and Prospects , 2000 .

[7]  Oliver Brock,et al.  Sampling-Based Motion Planning Using Uncertain Knowledge , 2006 .

[8]  Ron Alterovitz,et al.  Motion planning under uncertainty using iterative local optimization in belief space , 2012, Int. J. Robotics Res..

[9]  Christof Koch,et al.  A Model of Saliency-Based Visual Attention for Rapid Scene Analysis , 2009 .

[10]  Pedro J. Sanz,et al.  An open source tool for simulation and supervision of underwater intervention missions , 2012, 2012 IEEE/RSJ International Conference on Intelligent Robots and Systems.

[11]  KochChristof,et al.  A Model of Saliency-Based Visual Attention for Rapid Scene Analysis , 1998 .

[12]  Leonidas J. Guibas,et al.  Bounded Uncertainty Roadmaps for Path Planning , 2008, WAFR.

[13]  Jaime Valls Miró,et al.  Active Pose SLAM , 2012, 2012 IEEE/RSJ International Conference on Intelligent Robots and Systems.

[14]  B. Faverjon,et al.  Probabilistic Roadmaps for Path Planning in High-Dimensional Con(cid:12)guration Spaces , 1996 .

[15]  Anthony Stentz,et al.  Using linear landmarks for path planning with uncertainty in outdoor environments , 2009, 2009 IEEE/RSJ International Conference on Intelligent Robots and Systems.

[16]  Reid G. Simmons,et al.  Particle RRT for Path Planning with Uncertainty , 2007, Proceedings 2007 IEEE International Conference on Robotics and Automation.

[17]  Ling Xu,et al.  Graph Planning for Environmental Coverage , 2011 .

[18]  Ayoung Kim Active Visual SLAM with Exploration for Autonomous Underwater Navigation , 2012 .

[19]  David P. Williams On optimal AUV track-spacing for underwater mine detection , 2010, 2010 IEEE International Conference on Robotics and Automation.

[20]  Nicholas Roy,et al.  Adapting probabilistic roadmaps to handle uncertain maps , 2006, Proceedings 2006 IEEE International Conference on Robotics and Automation, 2006. ICRA 2006..

[21]  Pieter Abbeel,et al.  LQG-MP: Optimized path planning for robots with motion uncertainty and imperfect state information , 2010, Int. J. Robotics Res..

[22]  Pere Ridao,et al.  Probabilistic surface matching for bathymetry based SLAM , 2013, 2013 IEEE International Conference on Robotics and Automation.

[23]  J. Escartín,et al.  Globally aligned photomosaic of the Lucky Strike hydrothermal vent field (Mid‐Atlantic Ridge, 37°18.5′N): Release of georeferenced data, mosaic construction, and viewing software , 2008 .

[24]  Thierry Siméon,et al.  The Stochastic Motion Roadmap: A Sampling Framework for Planning with Markov Motion Uncertainty , 2007, Robotics: Science and Systems.

[25]  Marc Carreras,et al.  Girona 500 AUV: From Survey to Intervention , 2012, IEEE/ASME Transactions on Mechatronics.

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

[27]  P. Ridao,et al.  COLA2: A Control Architecture for AUVs , 2012, IEEE Journal of Oceanic Engineering.

[28]  Hanumant Singh,et al.  Robotic tools for deep water archaeology: Surveying an ancient shipwreck with an autonomous underwater vehicle , 2010, J. Field Robotics.

[29]  David Hsu,et al.  SARSOP: Efficient Point-Based POMDP Planning by Approximating Optimally Reachable Belief Spaces , 2008, Robotics: Science and Systems.

[30]  Vladimir J. Lumelsky,et al.  Dynamic path planning in sensor-based terrain acquisition , 1990, IEEE Trans. Robotics Autom..

[31]  Seth Hutchinson,et al.  Minimum uncertainty robot path planning using a POMDP approach , 2010, 2010 IEEE/RSJ International Conference on Intelligent Robots and Systems.

[32]  N. Roy,et al.  The Belief Roadmap: Efficient Planning in Belief Space by Factoring the Covariance , 2009, Int. J. Robotics Res..

[33]  Florent Lamiraux,et al.  A framework for planning motions in stochastic maps , 2008, 2008 10th International Conference on Control, Automation, Robotics and Vision.

[34]  Karl Iagnemma,et al.  Stochastic mobility-based path planning in uncertain environments , 2009, 2009 IEEE/RSJ International Conference on Intelligent Robots and Systems.

[35]  Wolfram Burgard,et al.  Active mobile robot localization by entropy minimization , 1997, Proceedings Second EUROMICRO Workshop on Advanced Mobile Robots.

[36]  Stefan B. Williams,et al.  Bathymetric particle filter SLAM using trajectory maps , 2012, Int. J. Robotics Res..

[37]  Wolfram Burgard,et al.  Coastal navigation-mobile robot navigation with uncertainty in dynamic environments , 1999, Proceedings 1999 IEEE International Conference on Robotics and Automation (Cat. No.99CH36288C).

[38]  Branko Ristic,et al.  Beyond the Kalman Filter: Particle Filters for Tracking Applications , 2004 .

[39]  Yasir Latif,et al.  Fast minimum uncertainty search on a graph map representation , 2012, 2012 IEEE/RSJ International Conference on Intelligent Robots and Systems.

[40]  Dana R. Yoerger,et al.  Fine-Scale Three-Dimensional Mapping of a Deep-Sea Hydrothermal Vent Site Using the Jason ROV System , 2000, Int. J. Robotics Res..