Nonlinear Model Predictive Path Following Controller with Obstacle Avoidance

Abstract

In the control systems community, path-following refers to the problem of tracking an output reference curve. This work presents a novel model predictive path-following control formulation for nonlinear systems with constraints, extended with an obstacle avoidance strategy. The method proposed in this work simultaneously provides an optimizing solution for both, path-following and obstacle avoidance tasks in a single optimization problem, using Nonlinear Model Predictive Control (NMPC). The main idea consists in extending the existing NMPC controllers by the introduction of an additional auxiliary trajectory that maintains the feasibility of the successive optimization problems even when the reference curve is unfeasible, possibly discontinuous, relaxing assumptions required in previous works. The obstacle avoidance is fulfilled by introducing additional terms in the value functional, rather than imposing state space constraints, with the aim of maintaining the convexity of the state and output spaces. Simulations results considering an autonomous vehicle subject to input and state constraints are carried out to illustrate the performance of the proposed control strategy.