Resumen
This paper proposes an approach of target tracking of a ground target for UAVs using Optimal Two-Stage Cubature Kalman Filter and Improved Coordinated Lateral Guidance Law. Firstly, the Optimal Two-Stage Cubature Kalman Filter (OTSCKF) is proposed to estimate the target motion. The OTSCKF combines two-stage filtering technology with CKF to improve the estimation accuracy. Secondly, to keep a constant distance between the UAV and the target, a new guidance law based on the lateral turning equation is proposed and its asymptotic stability is proven. On this basis, a distributed tracking algorithm is designed to balance the phase difference and achieve cooperation among multi-UAVs. Thirdly, numerical experiments are performed for the tracking problems of moving targets and the results verify the effectiveness of the proposed guidance algorithm.