-
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.
-
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.