Hierarchical Planning in Time-Dependent Flow Fields for Marine Robots

We present an efficient approach for finding shortest paths in flow fields that vary as a sequence of flow predictions over time. This approach is applicable to motion planning for slow marine robots that are subject to dynamic ocean currents. Although the problem is NP-hard in general form, we incorporate recent results from the theory of finding shortest paths in time-dependent graphs to construct a polynomial-time algorithm that finds continuous trajectories in time-dependent flow fields. The algorithm has a hierarchical structure where a graph is constructed with time-varying edge costs that are derived from sets of continuous trajectories in the underlying flow field. We show that the continuous algorithm retains the time complexity and path quality properties of the discrete graph solution, and demonstrate its application to surface and underwater vehicles including a traversal along the East Australian Current with an autonomous marine vehicle. Results show that the algorithm performs efficiently in practice and can find paths that adapt to changing ocean currents. These results are significant to marine robotics because they allow for efficient use of time-varying ocean predictions for motion planning.

[1]  Robert Fitch,et al.  Distance and Steering Heuristics for Streamline-Based Flow Field Planning , 2020, 2020 IEEE International Conference on Robotics and Automation (ICRA).

[2]  Enrique Alvarez Fanjul,et al.  Path planning for gliders using Regional Ocean Models: Application of Pinzón path planner with the ESEOAT model and the RU27 trans-Atlantic flight data , 2010, OCEANS'10 IEEE SYDNEY.

[3]  Robert Fitch,et al.  Streamlines for Motion Planning in Underwater Currents , 2019, 2019 International Conference on Robotics and Automation (ICRA).

[4]  Daniel Hernandez-Sosa,et al.  Single and multiple glider path planning using an optimization-based approach , 2011, OCEANS 2011 IEEE - Spain.

[5]  D. Paley,et al.  Underwater gliders: recent developments and future applications , 2004, Proceedings of the 2004 International Symposium on Underwater Technology (IEEE Cat. No.04EX869).

[6]  Gaurav S. Sukhatme,et al.  A Solution to Time-Varying Markov Decision Processes , 2016, IEEE Robotics and Automation Letters.

[7]  Ariel Orda,et al.  Shortest-path and minimum-delay algorithms in networks with time-dependent edge-length , 1990, JACM.

[8]  Graham Hine,et al.  The Wave Glider: A Wave-Powered autonomous marine vehicle , 2009, OCEANS 2009.

[9]  Christos D. Zaroliagis,et al.  Distance Oracles for Time-Dependent Networks , 2015, Algorithmica.

[10]  Robert Fitch,et al.  Probabilistic Temporal Logic for Motion Planning with Resource Threshold Constraints , 2012, Robotics: Science and Systems.

[11]  D. C. Webb,et al.  SLOCUM: an underwater glider propelled by environmental energy , 2001 .

[12]  Daniel Hernández-Sosa,et al.  Path planning for underwater gliders using iterative optimization , 2011, 2011 IEEE International Conference on Robotics and Automation.

[13]  Dorothea Wagner,et al.  Time-Dependent Route Planning , 2009, Encyclopedia of GIS.

[14]  Robert Fitch,et al.  Online task planning and control for fuel-constrained aerial robots in wind fields , 2016, Int. J. Robotics Res..

[15]  Stuart E. Dreyfus,et al.  An Appraisal of Some Shortest-Path Algorithms , 1969, Oper. Res..

[16]  Farnoush Banaei Kashani,et al.  Online Computation of Fastest Path in Time-Dependent Spatial Networks , 2011, SSTD.

[17]  M. Ani Hsieh,et al.  Optimal Path Planning in Time-Varying Flows with Forecasting Uncertainties , 2018, 2018 IEEE International Conference on Robotics and Automation (ICRA).

[18]  P. Oke,et al.  Development and evaluation of a high-resolution reanalysis of the East Australian Current region using the Regional Ocean Modelling System (ROMS 3.4) and Incremental Strong-Constraint 4-Dimensional Variational (IS4D-Var) data assimilation , 2016 .

[19]  Robert Fitch,et al.  Provably-correct stochastic motion planning with safety constraints , 2013, 2013 IEEE International Conference on Robotics and Automation.

[20]  Brian Claus,et al.  Development of an Auxiliary Propulsion Module for an Autonomous Underwater Glider , 2010 .

[21]  Pierre FJ Lermusiaux,et al.  Time-optimal path planning in dynamic flows using level set equations: theory and schemes , 2014, Ocean Dynamics.

[22]  K. Cooke,et al.  The shortest route through a network with time-dependent internodal transit times , 1966 .

[23]  B. Allen,et al.  Development of the REMUS 600 autonomous underwater vehicle , 2005, Proceedings of OCEANS 2005 MTS/IEEE.

[24]  Chanyeol Yoo,et al.  Stochastic Path Planning for Autonomous Underwater Gliders with Safety Constraints , 2019, 2019 IEEE/RSJ International Conference on Intelligent Robots and Systems (IROS).

[25]  Robert Fitch,et al.  Efficient Optimal Planning in non-FIFO Time-Dependent Flow Fields , 2019, ArXiv.

[26]  Shashi Shekhar,et al.  Time-Aggregated Graphs for Modeling Spatio-temporal Networks , 2006, J. Data Semant..

[27]  Naomi Ehrich Leonard,et al.  Model-based feedback control of autonomous underwater gliders , 2001 .

[28]  Shoudong Huang,et al.  Online Estimation of Ocean Current from Sparse GPS Data for Underwater Vehicles , 2019, 2019 International Conference on Robotics and Automation (ICRA).

[29]  Robert Fitch,et al.  Active perception for plume source localisation with underwater gliders , 2018 .

[30]  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.

[31]  Robert Fitch,et al.  Energy-optimal kinodynamic planning for underwater gliders in flow fields , 2017 .

[32]  B. C. Dean Shortest Paths in FIFO Time-Dependent Networks : Theory and Algorithms , 2004 .