Provably Safe Finite-Time Guidance for Marine Vehicles
Bhawana Singh, Karim Ahmadi Dastgerdi, Nikolaos Athanasopoulos, Wasif Naeem, Benoit Lecallard
TL;DR
This work addresses provably safe, finite-time waypoint navigation for marine vehicles in environments with static and dynamic obstacles. A cascade architecture combines a predefined-time heading autopilot with an LOS-based waypoint guidance law, generating intermediate virtual waypoints to guarantee both finite-time convergence to the waypoint and safety constraints such as a minimum distance $C_s$ from obstacles. Lyapunov-based analysis yields predefined-time convergence of the heading error within $t_p$ and finite-time convergence to the waypoint within $T_F$, with switching rules that respect COLREGs. Simulations on the Imazu benchmarks demonstrate improved safety distances over Velocity Obstacle and geometric LOS methods while maintaining competitive path length and travel time.
Abstract
We consider a new control strategy for marine navigation, equipped with finite-time convergence characteristics. We provide mathematical guarantees for waypoint reaching and obstacle avoidance for different encounter scenarios, by deriving conditions under which (i) convergence to waypoint and (ii) safe obstacle avoidance is achieved while (iii) satisfying input constraints. We propose a predefined-time heading control to enforce ship heading error convergence and waypoint reaching in finite time. Using this as a building block, we develop a provably safe algorithm for safe waypoint navigation by strategically and automatically introducing intermediate virtual waypoints. Using Imazu problems as benchmarks, we show that the proposed method is better than other existing strategies such as Velocity Obstacle Avoidance and biased Line-of-Sight methods, in terms of the safe distance between the ship and the obstacles, cross track error, control effort, waypoint reaching time and ship path length.
