Cooperative Guidance for Waypoint Following of Distributed Multi-UAV System

摘要

This paper proposes an algorithm for cooperative guidance of an unmanned aerial vehicle (UAV) formation following a set of waypoints. Way-points are linked by straight lines to form a sequence, which effectively tasks the formation to cooperatively follow a rectilinear path between these points. Unlike in earlier known papers, we propose a Fermat's spiral rather than a circular arc as a fillet to smooth the trajectory. This is because a Fermat's spiral has zero curvature at its origin, which helps avoid breaks in curvature observable when using straight lines and circular arcs. To make a UAV formation and to follow the path, we propose a novel guidance vector field that is direction- and magnitude-nonuniform. This is where the novelty of this paper lies, as it proposes the vector field method for following a Fermat's spiral. Known studies used line-of-sight (LOS) guidance to that end. In that case, the UAV formation shapes itself using consensus-based coordination topology, i.e. the group has no leader. To test the algorithm for cooperative waypoint following when smoothing is provided by fillets, we utilized complete nonlinear models of two fixed-wing UAVs, each equipped with a tuned autopilot. Numerical simulation shows the proposed approach efficient.