Berthing Trajectory Tracking of Underactuated Surface Vehicle Based on NMPC and Position Estimation

In order to realize waypoint-based automatic berthing alongside or astern, a generation algorithm of dynamic virtual ships is proposed to guide the underactuated surface vehicle (USV). In this paper, a nonlinear model predictive control (NMPC) problem is set up with multiple shooting method, which lifts the system and improves convergency. Measuring error and disturbances are reduced by moving horizon estimation (MHE) where the weights of sensors are auto-tuned according to their variation. Simulations of berthing alongside and astern of ship BAY CLASS illustrates the position error is smaller than 0.6 m and course error is smaller than 0.5(degrees). Compared to adaptive sliding mode control, proposed method has advantage on state smoothness and the control performance meets the requirements of berthing accuracy.