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.
The traditional leader-follower Unmanned Aerial Vehicle (UAV) formation cooperative positioning (CP) algorithm, based on relative ranging, requires at least four leader UAV positions to be known accurately, using relative distance with leader UAVs to achieve the unknown position follower UAV’s high-precision positioning. When the number of the known position leader UAVs is limited, the traditional CP algorithm is not applicable. Aiming at the minimum cooperative unit, which consists of a known position leader UAV and an unknown position follower UAV, this paper proposes a CP method based on the follower UAV’s moving vector. Considering the follower UAV can only acquire the single distance with the leader UAV at each distance-sampling period, it is difficult to determine the follower UAV’s spatial location. The follower UAV’s moving vector is used to construct position observation of the follower UAV’s inertial navigation system (INS). High-precision positioning is achieved by combining the follower UAV’s moving vector. In the process of CP, the leader UAV obtains a high-precision position by an INS/Global Positioning System (GPS) loosely integrated navigation system and transmits its position information to the follower UAV. Based on accurate modeling of the follower UAV’s INS, the position, velocity and heading observation equation of the follower UAV’s INS are constructed. The improved extended Kalman filtering is designed to estimate the state vector to improve the follower UAV’s positioning accuracy. In addition, considering that the datalink system based on radio signals may be interfered with by the external environment, it is difficult for the follower UAV to obtain relative distance information from the leader UAV in real time. In this paper, the availability of the relative distance information is judged by a two-state Markov chain. Finally, a real flight test is conducted to validate the performance of the proposed algorithm.