Energy-Optimized Hybrid Collision Avoidance for ASVs

This paper considers the development of a hybrid planning and collision avoidance architecture for autonomous surface vehicles (ASVs), The proposed architecture combines a high-level optimization-based planning algorithm with a mid-level collision avoidance (COLAV) algorithm based on model-predictive control (MPC). The high-level planner produces an energy-optimized trajectory by solving an optimal control problem via a pseudospectral method, taking into account known static obstacles and ocean currents. The mid-level algorithm performs MPC by solving a nonlinear program (NLP) to produce a collision-free local trajectory, also taking into account dynamic obstacles. In particular, the NLP optimizes for a combination of following the energy-optimized trajectory with performing readily observable maneuvers, as defined by Rule 8 of the International Regulations for Preventing Collisions at Sea (COLREGs). Numerical simulations are used to verify that the hybrid architecture produces safe, efficient and readily observable trajectories.

[1]  Giuseppe Casalino,et al.  A three-layered architecture for real time path planning and obstacle avoidance for surveillance USVs operating in harbour fields , 2009, OCEANS 2009-EUROPE.

[2]  Øivind Aleksander G. Loe Collision Avoidance for Unmanned Surface Vehicles , 2008 .

[3]  Axel Hahn,et al.  NMPC-based trajectory tracking and collision avoidance of unmanned surface vessels with rule-based colregs confinement , 2016, 2016 IEEE Conference on Systems, Process and Control (ICSPC).

[4]  Morten Breivik,et al.  The branching‐course model predictive control algorithm for maritime collision avoidance , 2019, J. Field Robotics.

[5]  Asgeir J. Sørensen,et al.  A Voronoi-diagram-based dynamic path-planning system for underactuated marine vessels☆ , 2017 .

[6]  Michael T. Wolf,et al.  Safe Maritime Autonomous Navigation With COLREGS, Using Velocity Obstacles , 2014, IEEE Journal of Oceanic Engineering.

[7]  Tor Arne Johansen,et al.  MPC-based Collision Avoidance Strategy for Existing Marine Vessel Guidance Systems , 2018, 2018 IEEE International Conference on Robotics and Automation (ICRA).

[8]  Bj⊘rn-Olav H. Eriksen,et al.  Radar-based maritime collision avoidance using dynamic window , 2018, 2018 IEEE Aerospace Conference.

[9]  Morten Breivik,et al.  Modeling, Identification and Control of High-Speed ASVs: Theory and Experiments , 2017 .

[10]  Lorenz T. Biegler,et al.  On the implementation of an interior-point filter line-search algorithm for large-scale nonlinear programming , 2006, Math. Program..

[11]  Oskar Levander,et al.  Autonomous ships on the high seas , 2017, IEEE Spectrum.

[12]  Anastasios M. Lekkas,et al.  Energy-Optimized Path Planning for Autonomous Ferries , 2018 .

[13]  Moritz Diehl,et al.  CasADi: a software framework for nonlinear optimization and optimal control , 2018, Mathematical Programming Computation.

[14]  M. Shanmugavel,et al.  Cooperative Path Planning of Unmanned Aerial Vehicles , 2010 .

[15]  Satyandra K. Gupta,et al.  Dynamics-aware target following for an autonomous surface vehicle operating under COLREGs in civilian traffic , 2013, 2013 IEEE/RSJ International Conference on Intelligent Robots and Systems.

[16]  Lydia Tapia,et al.  COLREG-RRT: An RRT-Based COLREGS-Compliant Motion Planner for Surface Vehicle Navigation , 2018, IEEE Robotics and Automation Letters.

[17]  I. Michael Ross,et al.  A review of pseudospectral optimal control: From theory to flight , 2012, Annu. Rev. Control..

[18]  Thor I. Fossen,et al.  Guidance and control of ocean vehicles , 1994 .

[19]  Morten Breivik,et al.  A Model-Based Speed and Course Controller for High-Speed ASVs , 2018 .

[20]  Morten Breivik,et al.  MPC-Based mid-level collision avoidance for asvs using nonlinear programming , 2017, 2017 IEEE Conference on Control Technology and Applications (CCTA).

[21]  Mario Zanon,et al.  Penalty Functions for Handling Large Deviation of Quadrature States in NMPC , 2017, IEEE Transactions on Automatic Control.

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