Zhu Xudong, Lai Jizhou, Chen Sheng
College of Automation Engineering, Nanjing University of Aeronautics and Astronautics, Nanjing 210016, China.
Sensors (Basel). 2022 Sep 20;22(19):7125. doi: 10.3390/s22197125.
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.
传统的基于相对测距的无人机编队协同定位(CP)算法,领导者 - 跟随者无人机编队需要至少准确知道四个领导者无人机的位置,利用与领导者无人机的相对距离来实现未知位置跟随者无人机的高精度定位。当已知位置的领导者无人机数量有限时,传统的CP算法不适用。针对由一个已知位置的领导者无人机和一个未知位置的跟随者无人机组成的最小协同单元,本文提出了一种基于跟随者无人机运动矢量的CP方法。考虑到跟随者无人机在每个距离采样周期只能获取与领导者无人机的单一距离,难以确定跟随者无人机的空间位置。利用跟随者无人机的运动矢量来构建跟随者无人机惯性导航系统(INS)的位置观测。通过结合跟随者无人机的运动矢量实现高精度定位。在协同定位过程中,领导者无人机通过INS/全球定位系统(GPS)松组合导航系统获得高精度位置,并将其位置信息传输给跟随者无人机。基于跟随者无人机INS的精确建模,构建了跟随者无人机INS的位置、速度和航向观测方程。设计了改进的扩展卡尔曼滤波器来估计状态矢量,以提高跟随者无人机的定位精度。此外,考虑到基于无线电信号的数据链系统可能会受到外部环境的干扰,跟随者无人机难以实时从领导者无人机获取相对距离信息。本文通过二态马尔可夫链判断相对距离信息的可用性。最后,进行了实际飞行测试以验证所提算法的性能。