Time-optimal path planning in dynamic flows using level set equations: theory and schemes

We develop an accurate partial differential equation-based methodology that predicts the time-optimal paths of autonomous vehicles navigating in any continuous, strong, and dynamic ocean currents, obviating the need for heuristics. The goal is to predict a sequence of steering directions so that vehicles can best utilize or avoid currents to minimize their travel time. Inspired by the level set method, we derive and demonstrate that a modified level set equation governs the time-optimal path in any continuous flow. We show that our algorithm is computationally efficient and apply it to a number of experiments. First, we validate our approach through a simple benchmark application in a Rankine vortex flow for which an analytical solution is available. Next, we apply our methodology to more complex, simulated flow fields such as unsteady double-gyre flows driven by wind stress and flows behind a circular island. These examples show that time-optimal paths for multiple vehicles can be planned even in the presence of complex flows in domains with obstacles. Finally, we present and support through illustrations several remarks that describe specific features of our methodology.

[1]  S. Kahne,et al.  Optimal control: An introduction to the theory and ITs applications , 1967, IEEE Transactions on Automatic Control.

[2]  B. Vanleer,et al.  Towards the ultimate conservative difference scheme. IV. A new approach to numerical convection , 1977 .

[3]  George M. Siouris,et al.  Applied Optimal Control: Optimization, Estimation, and Control , 1979, IEEE Transactions on Systems, Man, and Cybernetics.

[4]  J. Sethian,et al.  Fronts propagating with curvature-dependent speed: algorithms based on Hamilton-Jacobi formulations , 1988 .

[5]  John Canny,et al.  The complexity of robot motion planning , 1988 .

[6]  S. Osher,et al.  Algorithms Based on Hamilton-Jacobi Formulations , 1988 .

[7]  H. Frankowska Hamilton-Jacobi equations: Viscosity solutions and generalized gradients , 1989 .

[8]  C. W. Warren,et al.  A technique for autonomous underwater vehicle route planning , 1990, Symposium on Autonomous Underwater Vehicle Technology.

[9]  Jean-Claude Latombe,et al.  Numerical potential field techniques for robot path planning , 1991, Fifth International Conference on Advanced Robotics 'Robots in Unstructured Environments.

[10]  S. Osher,et al.  Computing interface motion in compressible gas dynamics , 1992 .

[11]  E. L. Nelson,et al.  AUV path planning: an A* approach to path planning with consideration of variable vehicle speeds and multiple, overlapping, time-dependent exclusion zones , 1992, Proceedings of the 1992 Symposium on Autonomous Underwater Vehicle Technology.

[12]  D. Chopp Computing Minimal Surfaces via Level Set Curvature Flow , 1993 .

[13]  C. Vasudevan,et al.  Case-based path planning for autonomous underwater vehicles , 1994, Proceedings of 1994 9th IEEE International Symposium on Intelligent Control.

[14]  B. Cushman-Roisin Introduction to Geophysical Fluid Dynamics , 1994 .

[15]  S. Osher,et al.  A level set approach for computing solutions to incompressible two-phase flow , 1994 .

[16]  J. Sethian,et al.  A Fast Level Set Method for Propagating Interfaces , 1995 .

[17]  Henk A. Dijkstra,et al.  Temporal variability of the wind-driven quasi-geostrophic double gyre ocean circulation: Basic bifurcation diagrams , 1997 .

[18]  B. V. Leer,et al.  Towards the Ultimate Conservative Difference Scheme , 1997 .

[19]  M. Bardi,et al.  Optimal Control and Viscosity Solutions of Hamilton-Jacobi-Bellman Equations , 1997 .

[20]  Yu. S. Ledyaev,et al.  Nonsmooth analysis and control theory , 1998 .

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

[22]  James A. Sethian,et al.  The Fast Construction of Extension Velocities in Level Set Methods , 1999 .

[23]  Steven M. LaValle,et al.  RRT-connect: An efficient approach to single-query path planning , 2000, Proceedings 2000 ICRA. Millennium Conference. IEEE International Conference on Robotics and Automation. Symposia Proceedings (Cat. No.00CH37065).

[24]  Alex M. Andrew,et al.  Level Set Methods and Fast Marching Methods: Evolving Interfaces in Computational Geometry, Fluid Mechanics, Computer Vision, and Materials Science (2nd edition) , 2000 .

[25]  P. Smereka,et al.  A Remark on Computing Distance Functions , 2000 .

[26]  Naomi Ehrich Leonard,et al.  Virtual leaders, artificial potentials and coordinated control of groups , 2001, Proceedings of the 40th IEEE Conference on Decision and Control (Cat. No.01CH37228).

[27]  Manuela M. Veloso,et al.  Real-time randomized path planning for robot navigation , 2002, IEEE/RSJ International Conference on Intelligent Robots and Systems.

[28]  Ronald Fedkiw,et al.  Level set methods and dynamic implicit surfaces , 2002, Applied mathematical sciences.

[29]  A. Caiti,et al.  Evolutionary path planning for autonomous underwater vehicles in a variable ocean , 2004, IEEE Journal of Oceanic Engineering.

[30]  P. Cannarsa,et al.  Semiconcave Functions, Hamilton-Jacobi Equations, and Optimal Control , 2004 .

[31]  Ron Kimmel,et al.  Fast Marching Methods , 2004 .

[32]  Alexandre M. Bayen,et al.  A time-dependent Hamilton-Jacobi formulation of reachable sets for continuous dynamic games , 2005, IEEE Transactions on Automatic Control.

[33]  Naomi Ehrich Leonard,et al.  Coordination of an underwater glider fleet for adaptive sampling , 2005 .

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

[35]  Steven M. LaValle,et al.  Planning algorithms , 2006 .

[36]  Pierre F. J. Lermusiaux,et al.  Quantifying Uncertainties in Ocean Predictions , 2006 .

[37]  Dolores Blanco,et al.  Voronoi diagram and fast marching applied to path planning , 2006, Proceedings 2006 IEEE International Conference on Robotics and Automation, 2006. ICRA 2006..

[38]  Pierre F. J. Lermusiaux,et al.  Uncertainty estimation and prediction for interdisciplinary ocean dynamics , 2006, J. Comput. Phys..

[39]  David M. Fratantoni,et al.  Multi-AUV Control and Adaptive Sampling in Monterey Bay , 2006, IEEE Journal of Oceanic Engineering.

[40]  G. Swaminathan Robot Motion Planning , 2006 .

[41]  Naomi Ehrich Leonard,et al.  Collective Motion, Sensor Networks, and Ocean Sampling , 2007, Proceedings of the IEEE.

[42]  Rustam Stolkin,et al.  Optimal AUV path planning for extended missions in complex, fast-flowing estuarine environments , 2007, Proceedings 2007 IEEE International Conference on Robotics and Automation.

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

[44]  Naomi Ehrich Leonard,et al.  Control of coordinated patterns for ocean sampling , 2007, Int. J. Control.

[45]  Yan Pailhas,et al.  Path Planning for Autonomous Underwater Vehicles , 2007, IEEE Transactions on Robotics.

[46]  Pierre F. J. Lermusiaux,et al.  Nonlinear optimization of autonomous undersea vehicle sampling strategies for oceanographic data-assimilation , 2007, J. Field Robotics.

[47]  Pierre F. J. Lermusiaux,et al.  Adaptive modeling, adaptive data assimilation and adaptive sampling , 2007 .

[48]  N.M. Patrikalakis,et al.  Path Planning of Autonomous Underwater Vehicles for Adaptive Sampling Using Mixed Integer Linear Programming , 2008, IEEE Journal of Oceanic Engineering.

[49]  Naomi Ehrich Leonard,et al.  Cooperative Control for Ocean Sampling: The Glider Coordinated Control System , 2008, IEEE Transactions on Control Systems Technology.

[50]  Jerrold E. Marsden,et al.  Optimal trajectory generation for a glider in time-varying 2D ocean flows B-spline model , 2008, 2008 IEEE International Conference on Robotics and Automation.

[51]  Ding Wang,et al.  Acoustically focused adaptive sampling and on-board routing for marine rapid environmental assessment , 2009 .

[52]  Alberto Alvarez,et al.  Path planning for autonomous underwater vehicles in realistic oceanic current fields: Application to gliders in the Western Mediterranean sea , 2009 .

[53]  Naomi Ehrich Leonard,et al.  Preparing to predict: The Second Autonomous Ocean Sampling Network (AOSN-II) experiment in the Monterey Bay , 2009 .

[54]  Stefan B. Williams,et al.  Large-scale path planning for Underwater Gliders in ocean currents , 2009 .

[55]  Matthew Dunbabin,et al.  Go with the flow : optimal AUV path planning in coastal environments , 2009, ICRA 2009.

[56]  David L. Chopp,et al.  Another Look at Velocity Extensions in the Level Set Method , 2009, SIAM J. Sci. Comput..

[57]  David R. Thompson,et al.  Mission Planning in a Dynamic Ocean Sensorweb , 2009 .

[58]  Naomi Ehrich Leonard,et al.  Routing strategies for underwater gliders , 2009 .

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

[60]  Pierre F. J. Lermusiaux,et al.  Forecasting and Reanalysis in the Monterey Bay/California Current Region for the Autonomous Ocean Sampling Network-II Experiment , 2009 .

[61]  M. Ghil,et al.  Bifurcation analysis of ocean, atmosphere and climate models , 2009 .

[62]  Michel Rueher,et al.  Time-minimal path planning in dynamic current fields , 2009, 2009 IEEE International Conference on Robotics and Automation.

[63]  Pierre F. J. Lermusiaux,et al.  Dynamically orthogonal field equations for continuous stochastic dynamical systems , 2009 .

[64]  Hasnaa Zidani,et al.  Reachability and Minimal Times for State Constrained Nonlinear Problems without Any Controllability Assumption , 2010, SIAM J. Control. Optim..

[65]  Han-Lim Choi,et al.  Continuous trajectory planning of mobile sensors for informative forecasting , 2010, Autom..

[66]  Pierre F. J. Lermusiaux,et al.  Multiscale two-way embedding schemes for free-surface primitive equations in the “Multidisciplinary Simulation, Estimation and Assimilation System” , 2010 .

[67]  Igor Mezic,et al.  Minimum time feedback control of autonomous underwater vehicles , 2010, 49th IEEE Conference on Decision and Control (CDC).

[68]  Gaurav S. Sukhatme,et al.  Informative path planning for an autonomous underwater vehicle , 2010, 2010 IEEE International Conference on Robotics and Automation.

[69]  David R. Thompson,et al.  Spatiotemporal path planning in strong, dynamic, uncertain currents , 2010, 2010 IEEE International Conference on Robotics and Automation.

[70]  Steve Chien,et al.  Automated Sensor Network to Advance Ocean Science , 2010 .

[71]  Henrik Schmidt,et al.  Unified command and control for heterogeneous marine sensing networks , 2010, J. Field Robotics.

[72]  Efstathios Bakolas,et al.  The Zermelo-Voronoi Diagram: a dynamic partition problem , 2010, Proceedings of the 2010 American Control Conference.

[73]  Salah Sukkarieh,et al.  An Efficient Path Planning and Control Algorithm for RUAV’s in Unknown and Cluttered Environments , 2010, J. Intell. Robotic Syst..

[74]  Gaurav S. Sukhatme,et al.  Planning and Implementing Trajectories for Autonomous Underwater Vehicles to Track Evolving Ocean Processes Based on Predictions from a Regional Ocean Model , 2010, Int. J. Robotics Res..

[75]  Alberto Bressan,et al.  Viscosity Solutions of Hamilton-Jacobi Equations and Optimal Control Problems , 2011 .

[76]  Konuralp Yiğit,et al.  Path Planning Methods for Autonomous Underwater Vehicles , 2011 .

[77]  Wolfgang Desch,et al.  Progress in nonlinear differential equations and their applications, Vol. 80 , 2011 .

[78]  B. Cushman-Roisin,et al.  Introduction to geophysical fluid dynamics : physical and numerical aspects , 2011 .

[79]  Pierre F. J. Lermusiaux,et al.  Path planning in time dependent flow fields using level set methods , 2012, 2012 IEEE International Conference on Robotics and Automation.

[80]  José Isern González,et al.  Obstacle avoidance in underwater glider path planning , 2012 .

[81]  Geoffrey A. Hollinger,et al.  Underwater Data Collection Using Robotic Sensor Networks , 2012, IEEE Journal on Selected Areas in Communications.

[82]  Stefano Bianchini,et al.  SBV Regularity for Hamilton-Jacobi Equations with Hamiltonian Depending on (t, x) , 2012, SIAM J. Math. Anal..

[83]  Franz S. Hover,et al.  Autonomous mobile acoustic relay positioning as a multi-armed bandit with switching costs , 2013, 2013 IEEE/RSJ International Conference on Intelligent Robots and Systems.

[84]  Pierre F. J. Lermusiaux,et al.  Numerical schemes for dynamically orthogonal equations of stochastic fluid and ocean flows , 2013, J. Comput. Phys..

[85]  T. Patterson,et al.  Deep Sea Research Part II: Topical Studies in Oceanography , 2013 .

[86]  Geoffrey A. Hollinger,et al.  Risk‐aware Path Planning for Autonomous Underwater Vehicles using Predictive Ocean Models , 2013, J. Field Robotics.

[87]  Pierre F. J. Lermusiaux,et al.  Time-optimal path planning in dynamic flows using level set equations: realistic applications , 2014, Ocean Dynamics.

[88]  Pierre F. J. Lermusiaux,et al.  Path planning in multi-scale ocean flows: Coordination and dynamic obstacles , 2015 .

[89]  Pierre F. J. Lermusiaux,et al.  Science of Autonomy: Time-Optimal Path Planning and Adaptive Sampling for Swarms of Ocean Vehicles , 2016 .

[90]  Martin Kuefer,et al.  Ocean Circulation Theory , 2016 .