-
Trajectory Planning and Control for Automatic Docking of ASVs with Full-Scale Experiments
Authors:
Glenn Bitar,
Andreas B. Martinsen,
Anastasios M. Lekkas,
Morten Breivik
Abstract:
We propose a method for performing automatic docking of a small autonomous surface vehicle (ASV) by interconnecting an optimization-based trajectory planner with a dynamic positioning (DP) controller for trajectory tracking. The trajectory planner provides collision-free trajectories by considering a map with static obstacles, and produces feasible trajectories through inclusion of a mathematical…
▽ More
We propose a method for performing automatic docking of a small autonomous surface vehicle (ASV) by interconnecting an optimization-based trajectory planner with a dynamic positioning (DP) controller for trajectory tracking. The trajectory planner provides collision-free trajectories by considering a map with static obstacles, and produces feasible trajectories through inclusion of a mathematical model of the ASV and its actuators. The DP controller tracks the time-parametrized position, velocity and acceleration produced by the trajectory planner using proportional-integral-derivative feedback with velocity and acceleration feed forward. The method's performance is tested on a small ASV in confined waters in Trondheim, Norway. The ASV performs collision-free docking maneuvers with respect to static obstacles when tracking the generated reference trajectories and achieves successful docking.
△ Less
Submitted 16 April, 2020;
originally announced April 2020.
-
Improvements to Warm-Started Optimized Trajectory Planning for ASVs
Authors:
Glenn Bitar,
Anastasios M. Lekkas,
Morten Breivik
Abstract:
We present improvements to a recently developed method for trajectory planning for autonomous surface vehicles (ASVs) in terms of run time. The original method combines two types of planners: An A* implementation that quickly finds the global shortest piecewise linear path on a uniformly discretized map, and an optimal control-based trajectory planner which takes into account ASV dynamics. Firstly…
▽ More
We present improvements to a recently developed method for trajectory planning for autonomous surface vehicles (ASVs) in terms of run time. The original method combines two types of planners: An A* implementation that quickly finds the global shortest piecewise linear path on a uniformly discretized map, and an optimal control-based trajectory planner which takes into account ASV dynamics. Firstly, we propose an improvement to the discretization of the map by switching to a Voronoi diagram rather than the uniform discretization, which offers a far more sparse search tree for the A* implementation. Secondly, modifications to the path refinement are made, as suggested in a paper by Bhattacharya and Gavrilova. The changes result in a reduction to the run time of the first part of the method of 85% for an example scenario while maintaining the same level of optimality.
△ Less
Submitted 20 August, 2019;
originally announced August 2019.
-
Short-term ASV Collision Avoidance with Static and Moving Obstacles
Authors:
Bjørn-Olav H. Eriksen,
Morten Breivik
Abstract:
This article considers collision avoidance (COLAV) for both static and moving obstacles using the branching-course model predictive control (BC-MPC) algorithm, which is designed for use by autonomous surface vehicles (ASVs). The BC-MPC algorithm originally only considered COLAV of moving obstacles, so in order to make the algorithm also be able to avoid static obstacles, we introduce an extra term…
▽ More
This article considers collision avoidance (COLAV) for both static and moving obstacles using the branching-course model predictive control (BC-MPC) algorithm, which is designed for use by autonomous surface vehicles (ASVs). The BC-MPC algorithm originally only considered COLAV of moving obstacles, so in order to make the algorithm also be able to avoid static obstacles, we introduce an extra term in the objective function based on an occupancy grid. In addition, other improvements are made to the algorithm resulting in trajectories with less wobbling. The modified algorithm is verified through full-scale experiments in the Trondheimsfjord in Norway with both virtual static obstacles and a physical moving obstacle. A radar-based tracking system is used to detect and track the moving obstacle, which enables the algorithm to avoid obstacles without depending on vessel-to-vessel communication. The experiments show that the algorithm is able to simultaneously avoid both static and moving obstacles, while providing clear and readily observable maneuvers. The BC-MPC algorithm is compliant with rules 8, 13 and 17 of the the International Regulations for Preventing Collisions at Sea (COLREGs), and favors maneuvers following rules 14 and 15.
△ Less
Submitted 10 July, 2019;
originally announced July 2019.
-
Warm-Started Optimized Trajectory Planning for ASVs
Authors:
Glenn Bitar,
Vegard N. Vestad,
Anastasios M. Lekkas,
Morten Breivik
Abstract:
We consider warm-started optimized trajectory planning for autonomous surface vehicles (ASVs) by combining the advantages of two types of planners: an A* implementation that quickly finds the shortest piecewise linear path, and an optimal control-based trajectory planner. A nonlinear 3-degree-of-freedom underactuated model of an ASV is considered, along with an objective functional that promotes e…
▽ More
We consider warm-started optimized trajectory planning for autonomous surface vehicles (ASVs) by combining the advantages of two types of planners: an A* implementation that quickly finds the shortest piecewise linear path, and an optimal control-based trajectory planner. A nonlinear 3-degree-of-freedom underactuated model of an ASV is considered, along with an objective functional that promotes energy-efficient and readily observable maneuvers. The A* algorithm is guaranteed to find the shortest piecewise linear path to the goal position based on a uniformly decomposed map. Dynamic information is constructed and added to the A*-generated path, and provides an initial guess for warm starting the optimal control-based planner. The run time for the optimal control planner is greatly reduced by this initial guess and outputs a dynamically feasible and locally optimal trajectory.
△ Less
Submitted 5 July, 2019;
originally announced July 2019.
-
Hybrid Collision Avoidance for ASVs Compliant with COLREGs Rules 8 and 13-17
Authors:
Bjørn-Olav H. Eriksen,
Glenn Bitar,
Morten Breivik,
Anastasios M. Lekkas
Abstract:
This paper presents a three-layered hybrid collision avoidance (COLAV) system for autonomous surface vehicles, compliant with rules 8 and 13-17 of the International Regulations for Preventing Collisions at Sea (COLREGs). The COLAV system consists of a high-level planner producing an energy-optimized trajectory, a model predictive control based mid-level COLAV algorithm considering moving obstacles…
▽ More
This paper presents a three-layered hybrid collision avoidance (COLAV) system for autonomous surface vehicles, compliant with rules 8 and 13-17 of the International Regulations for Preventing Collisions at Sea (COLREGs). The COLAV system consists of a high-level planner producing an energy-optimized trajectory, a model predictive control based mid-level COLAV algorithm considering moving obstacles and the COLREGs, and the branching-course model predictive control algorithm for short-term COLAV handling emergency situations in accordance with the COLREGs. Previously developed algorithms by the authors are used for the high-level planner and short-term COLAV, while we in this paper further develop the mid-level algorithm to make it comply with COLREGs rules 13-17. This includes develo** a state machine for classifying obstacle vessels using a combination of the geometrical situation, the distance and time to the closest point of approach (CPA) and a new CPA-like measure. The performance of the hybrid COLAV system is tested through numerical simulations for three scenarios representing a range of different challenges, including multi-obstacle situations with multiple simultaneously active COLREGs rules, and also obstacles ignoring the COLREGs. The COLAV system avoids collision in all the scenarios, and follows the energy-optimized trajectory when the obstacles do not interfere with it.
△ Less
Submitted 14 July, 2019; v1 submitted 29 June, 2019;
originally announced July 2019.
-
The Branching-Course MPC Algorithm for Maritime Collision Avoidance
Authors:
Bjørn-Olav H. Eriksen,
Morten Breivik,
Erik F. Wilthil,
Andreas L. Flåten,
Edmund F. Brekke
Abstract:
This article presents a new algorithm for short-term maritime collision avoidance (COLAV) named the branching-course MPC (BC-MPC) algorithm. The algorithm is designed to be robust with respect to noise on obstacle estimates, which is a significant source of disturbance when using exteroceptive sensors such as e.g. radars for obstacle detection and tracking. Exteroceptive sensors do not require ves…
▽ More
This article presents a new algorithm for short-term maritime collision avoidance (COLAV) named the branching-course MPC (BC-MPC) algorithm. The algorithm is designed to be robust with respect to noise on obstacle estimates, which is a significant source of disturbance when using exteroceptive sensors such as e.g. radars for obstacle detection and tracking. Exteroceptive sensors do not require vessel-to-vessel communication, which enables COLAV toward vessels not equipped with e.g. automatic identification system (AIS) transponders, in addition to increasing the robustness with respect to faulty information which may be provided by other vessels. The BC-MPC algorithm is compliant with rules 8 and 17 of the International Regulations for Preventing Collisions at Sea (COLREGs), and favors maneuvers following rules 13-15. This results in a COLREGs-aware algorithm which can ignore rules 13-15 when necessary. The algorithm is experimentally validated in several full-scale experiments in the Trondheimsfjord in 2017 using a radar-based system for obstacle detection and tracking. The COLAV experiments show good performance in compliance with the desired algorithm behavior.
△ Less
Submitted 28 June, 2019;
originally announced July 2019.