Distance and Steering Heuristics for Streamline-Based Flow Field Planning

Motion planning for vehicles under the influence of flow fields can benefit from the idea of streamline-based planning, which exploits ideas from fluid dynamics to achieve computational efficiency. Important to such planners is an efficient means of computing the travel distance and direction between two points in free space, but this is difficult to achieve in strong incompressible flows such as ocean currents. We propose two useful distance functions in analytical form that combine Euclidean distance with values of the stream function associated with a flow field, and with an estimation of the strength of the opposing flow between two points. Further, we propose steering heuristics that are useful for steering towards a sampled point. We evaluate these ideas by integrating them with RRT* and comparing the algorithm’s performance with state-of-the-art methods in an artificial flow field and in actual ocean prediction data in the region of the dominant East Australian Current between Sydney and Brisbane. Results demonstrate the method’s computational efficiency and ability to find high-quality paths outperforming state-of-the-art methods, and show promise for practical use with autonomous marine robots.

[1]  E. Zermelo Über das Navigationsproblem bei ruhender oder veränderlicher Windverteilung , 1931 .

[2]  J. Halton On the efficiency of certain quasi-random sequences of points in evaluating multi-dimensional integrals , 1960 .

[3]  G. Batchelor,et al.  An Introduction to Fluid Dynamics , 1968 .

[4]  Jon Louis Bentley,et al.  Multidimensional binary search trees used for associative searching , 1975, CACM.

[5]  Hans-Peter Kriegel,et al.  The R*-tree: an efficient and robust access method for points and rectangles , 1990, SIGMOD '90.

[6]  Harald Niederreiter,et al.  Random number generation and Quasi-Monte Carlo methods , 1992, CBMS-NSF regional conference series in applied mathematics.

[7]  Sunil Arya,et al.  An optimal algorithm for approximate nearest neighbor searching fixed dimensions , 1998, JACM.

[8]  Lydia E. Kavraki,et al.  Analysis of probabilistic roadmaps for path planning , 1998, IEEE Trans. Robotics Autom..

[9]  Steven M. LaValle,et al.  Randomized Kinodynamic Planning , 1999, Proceedings 1999 IEEE International Conference on Robotics and Automation (Cat. No.99CH36288C).

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

[11]  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).

[12]  Alexander F. Shchepetkin,et al.  The regional oceanic modeling system (ROMS): a split-explicit, free-surface, topography-following-coordinate oceanic model , 2005 .

[13]  Peter R. Oke,et al.  Ensemble data assimilation for an eddy‐resolving ocean model of the Australian region , 2005 .

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

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

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

[17]  Emilio Frazzoli,et al.  Sampling-based algorithms for optimal motion planning , 2011, Int. J. Robotics Res..

[18]  Baris Akgün,et al.  Sampling heuristics for optimal motion planning in high dimensions , 2011, 2011 IEEE/RSJ International Conference on Intelligent Robots and Systems.

[19]  Emilio Frazzoli,et al.  Anytime computation of time-optimal off-road vehicle maneuvers using the RRT* , 2011, IEEE Conference on Decision and Control and European Control Conference.

[20]  Peter R. Oke,et al.  Evaluation of a near-global eddy-resolving ocean model , 2012 .

[21]  Leslie Pack Kaelbling,et al.  A hierarchical approach to manipulation with diverse actions , 2013, 2013 IEEE International Conference on Robotics and Automation.

[22]  Frank Chongwoo Park,et al.  Randomized path planning on vector fields , 2014, Int. J. Robotics Res..

[23]  Siddhartha S. Srinivasa,et al.  Informed RRT*: Optimal sampling-based path planning focused via direct sampling of an admissible ellipsoidal heuristic , 2014, 2014 IEEE/RSJ International Conference on Intelligent Robots and Systems.

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

[25]  M. Ani Hsieh,et al.  Time and Energy Optimal Path Planning in General Flows , 2016, Robotics: Science and Systems.

[26]  Deepak N. Subramani,et al.  Energy-optimal path planning by stochastic dynamically orthogonal level-set optimization , 2016 .

[27]  Fouad Sukkar,et al.  Fast, reliable and efficient database search motion planner (FREDS-MP) for repetitive manipulator tasks , 2017 .

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

[29]  Marco Pavone,et al.  Deterministic sampling-based motion planning: Optimality, complexity, and performance , 2015, ISRR.

[30]  M. Ani Hsieh,et al.  Going with the flow: a graph based approach to optimal path planning in general flows , 2018, Autonomous Robots.

[31]  Subhrajit Bhattacharya,et al.  Optimal Path Planning in Time-Varying Flows Using Adaptive Discretization , 2018, IEEE Robotics and Automation Letters.

[32]  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).

[33]  Chanyeol Yoo,et al.  Streamline-Based Control of Underwater Gliders in 3D Environments , 2019, 2019 IEEE 58th Conference on Decision and Control (CDC).

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

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

[36]  Lydia E. Kavraki,et al.  Online motion planning for unexplored underwater environments using autonomous underwater vehicles , 2018, J. Field Robotics.

[37]  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).

[38]  Chanyeol Yoo,et al.  Hierarchical Planning in Time-Dependent Flow Fields for Marine Robots , 2020, 2020 IEEE International Conference on Robotics and Automation (ICRA).