Weight Factor Graph Co-Location Method for UAV Formation Based on Navigation Performance Evaluation

Abstract

At present, multiple unmanned aerial vehicles (UAVs) collaboration have attracted people’s more and more attention. The abundant relative distance information in UAV cooperative network can be employed to further improve UAV’s positioning accuracy. However, the traditional distance-based cooperative localization (CL) algorithm does not consider the performance of cooperative navigation information. Cooperative information with poor navigation performance will affect follower UAV’s state estimation accuracy. Thus, this paper proposes a weight factor graph CL method based on navigation performance evaluation. A novel navigation performance evaluation strategy based on Fisher information and relative entropy is proposed. The distance observations and cooperative nodes’ positions with higher estimation accuracy and contribution are selected to estimate follower UAV’s position. Considering the difference contributions of the selected cooperative information to follower UAV’s state estimation, we employ the information weight processing to achieve higher state estimation accuracy. Based on the selected cooperative information and weight coefficient, a multi-UAVs cooperative optimization graph model based on navigation performance is constructed. The global optimization cost function is constructed using relative distance constraints from the current time to historical time in the sliding window. The global optimal navigation solution of follower UAV is achieved using iterative weighted least squares method. Simulation and experiment results show that the proposed navigation performance evaluation strategy can effectively screen cooperative information with higher estimation accuracy and contribution for CL. Using the selected high-quality cooperative information, the system computational complexity is reduced without significantly affecting system positioning accuracy.