Decentralized triangular relative localization of multiple UAVs based on relative range and inertial measurements

In this paper, a novel algorithm for cooperative relative localization of multiple Unmanned Aerial Vehicles (UAVs) is proposed based on relative range and inertial measurements. In this algorithm, a relative motion estimation model is established for each group of three UAVs that can form a triangle in space. Each group member estimates the relative position and heading angle of the other group members and shares the estimation results with the other group members. When members satisfy the triangle law among their estimated relative position vectors, they can estimate more accurately. After analyzing the observability of the presented model, the necessary conditions for observability are also given, which are less restrictive compared to previous methods. Then, the presented method is compared with the decentralized consensus-based Kalman filter approach. The results of both methods are analyzed in the presence of noise and disturbances, and under the condition of disconnection between the members.