Consensus-based three-dimensionalmulti-UAV formation control strategy with high precision

We propose a formation control strategy for multiple unmanned aerial vehicles (multi-UAV) based on second-order consensus, by introducing position and velocity coordination variables through neighbor-to-neighbor interaction to generate steering commands. A cooperative guidance algorithm and a cooperative control algorithm are proposed together to maintain a specified geometric configuration, managing the position and attitude respectively. With the whole system composed of the six-degree-of-freedom UAV model, the cooperative guidance algorithm, and the cooperative control algorithm, the formation control strategy is a closed-loop one and with full states. The cooperative guidance law is a second-order consensus algorithm, providing the desired acceleration, pitch rate, and heading rate. Longitudinal and lateral motions are jointly considered, and the cooperative control law is designed by deducing state equations. Closed-loop stability of the formation is analyzed, and a necessary and sufficient condition is provided. Measurement errors in position data are suppressed by synchronization technology to improve the control precision. In the simulation, three-dimensional formation flight demonstrates the feasibility and effectiveness of the formation control strategy.