Trajectory optimization of unmanned surface vehicle based on improved minimum snap

Abstract

To solve the problem of path discontinuity and tracking difficulty in unmanned surface vehicle path planning, this paper introduces the Minimum Snap algorithm to optimize the trajectory, and makes some improvements to the Minimum Snap algorithm to address the problem of imperfect paths caused by uneven time allocation. The concept of a safe corridor is introduced to optimize the Minimum Snap algorithm. In response to the problem of excessive deviation from the reference value in some areas of the optimized path, a guidance function is added to make the path closer to the original trajectory. In the simulation, the proposed improved Minimum Snap is compared with Bezier curve and B-spline curve, the results show that the improved Minimum Snap can enable unmanned surface vehicle to complete turns and other actions with minimal energy consumption while driving safely, without experiencing severe acceleration and Jerk, laying the foundation for subsequent path tracking control.