Trajectory Planning for Cooperative Double Unmanned Surface Vehicles Connected with a Floating Rope for Floating Garbage Cleaning

Abstract

Double unmanned surface vehicles (DUSVs) towing a floating rope are more effective at removing large floating garbage on the water’s surface than a single USV. This paper proposes a comprehensive trajectory planner for DUSVs connected with a floating rope for cooperative water-surface garbage collection with dynamic collision avoidance, which takes into account the kinematic constraints and dynamic cooperation constraints of the DUSVs, which reflects the current collection capacity of DUSVs. The optimal travel sequence is determined by solving the TSP problem with an ant colony algorithm. The DUSVs approach the garbage targets based on the guidance of target key points selected by taking into account the dynamic cooperation constraints. An artificial potential field (APF) combined with a leader–follower strategy is adopted so that the each USV passes from different sides of the garbage to ensure garbage capturing. For dynamic obstacle avoidance, an improved APF (IAPF) combined with a leader–follower strategy is proposed, for which a velocity repulsion field is introduced to reduce travel distance. A fuzzy logic algorithm is adopted for adaptive adjustment of the desired velocities of the DUSVs to achieve better cooperation between the DUSVs. The simulation results verify the effectiveness of the algorithm of the proposed planner in that the generated trajectories for the DUSVs successfully realize cooperative garbage collection and dynamic obstacle avoidance while complying with the kinematic constraints and dynamic cooperation constraints of the DUSVs.