Multi-UAV Cooperative Obstacle Avoidance of 3D Vector Field Histogram Plus and Dynamic Window Approach

In this paper, we propose a fusion algorithm that integrates the 3D vector field histogram plus (VFH+) algorithm and the improved dynamic window approach (DWA) algorithm. The aim is to address the challenge of cooperative obstacle avoidance faced by multi-UAV formation flying in unknown environments. First, according to the navigation evaluation function of the standard DWA algorithm, the target distance is introduced to correct the azimuth. Then, aiming at the problem that the fixed weight mechanism in standard DWA algorithm is unreasonable, we combine the A* algorithm and introduce variable weight factors related to azimuth to improve the target orientation ability in local path planning. A new rotation cost evaluation function is added to improve the obstacle avoidance ability of two-dimensional UAV. Then, 3D VFH+ algorithm is introduced and integrated with improved DWA algorithm to design a distributed cooperative formation obstacle avoidance control algorithm. Simulation validation suggests that compared with the traditional DWA algorithm, the improved collaborative obstacle avoidance control algorithm can greatly optimize the obstacle avoidance effect of UAVs’ formation flight.