A Motion Planning Method for Unmanned Surface Vehicle Based on Improved RRT Algorithm

Abstract

Aiming at the problem that the path search rules in the traditional path planning methods are divorced from the actual maneuverability of an unmanned surface vehicle (USV), a motion planning method of state prediction rapidly exploring random tree (spRRT) is proposed. This method retains the discrete search of the original rules of RRT while adding the continuity of the motion of USV. Firstly, the state information for each movement (position, yaw angle, velocity, etc.), is calculated based on the mathematical model of USV’s motion which takes into account the complete dynamic constraints. Secondly, this information is added to the RRT path search rules to predict the state points that can be reached by the USV. Furthermore, in order to improve search efficiency and reduce cost, spRRT is enhanced by an elliptic sampling domain (spRRT-Informed). The simulation results indicate that spRRT can effectively plan smooth paths for smoothly navigating USV. The inclusion of the USV motion model has improved steering performance by an average of over 40%. Additionally, the spRRT-Informed enhanced with sampling optimization strategy improves performance by at least 10% over spRRT in terms of sailing time and distance of the path. The results of the simulation conducted in a realistic scenario validate that spRRT-Informed can be used as a reference for practical applications.

Keywords

• USV
• motion planning
• state prediction
• RRT
• elliptic sampling domain