Abstract
This work presents an NMPC (Nonlinear Model Predictive Control)-based algorithm for safe navigation of multi-agent dynamical systems in a variable environment with fixed or moving obstacles. The contribution lies in the construction of repulsive potential fields for the fixed and moving obstacles which are introduced in a predictive control optimization problem to penalize collision. The constraints are activated only in the view range of the agent using on-off barrier functions. Collision-free motion planning of ships in Trondheim fjord harbor serves as a benchmark for testing our algorithm. Some scenarios are simulated in order to prove the efficiency of the algorithm and its feasibility to run in real-time.