Dynamic Collision Avoidance Algorithm for Unmanned Surface Vehicles via Layered Artificial Potential Field with Collision Cone
Xinli Xu, Pan Wei, Yubo Huang, Weidong Zhang
Abstract
A dynamic collision avoidance algorithm via layered artificial potential field with collision cone (LAPF-CC) is proposed to overcome the shortcomings of the traditional artificial potential field method in dynamic collision avoidance. In order to reduce invalid actions for collision avoidance, the potential field is divided into four layers, and a collision cone with risk detection function is introduced. Relative distance and relative velocity are used as variables to establish the risk of collision, and a torque named ‘speed torque’ is constructed. Speed torque, attractive force and repulsive force work together to change the speed and heading of the unmanned surface vehicle (USV). Driving force and torque are controlled separately, which makes it possible for the LAPF-CC algorithm to be used for real-time collision avoidance control of underactuated USVs. Simulation results show that the LAPF-CC algorithm performs well in dynamic collision avoidance.