基于自适应强跟踪CQKF的目标跟踪算法

针对容积积分卡尔曼滤波（CQKF）受模型不确定性影响较大及需要精确已知噪声统计特性的缺点，提出了一种自适应强跟踪CQKF算法。该算法根据强跟踪滤波原理，引入渐消因子调整状态预测协方差矩阵，强迫残差序列正交，有效抑制了模型不确定性引起的滤波发散。在滤波过程中，利用Sage-Husa时变噪声统计估值器对过程噪声及量测噪声实时估计，提高了算法在未知时变噪声环境下的滤波精度。目标跟踪仿真实验验证了算法的有效性和鲁棒性。

Target tracking algorithm based on adaptive strong tracking CQKF

As cubature quadrature Kalman filter (CQKF) is easily influenced by uncertainty of state-space model and need to know exactly noise statistics, a new type of adaptive CQKF algorithm with strong tracking behavior is proposed.Based on the theory of strong tracking filter, the new algorithm introduces fa-ding factor to adapt to covariance matrix and reinforces residual sequence to be orthogonal, which effectively suppresses the filtering divergence caused by the model uncertainty.In the process of filtering, processing noise and measurement noise should be estimated online by the Sage-Husa noise statistics estimator,which will improve the filter precision under the circumstance of unknown time-varying noise.Simulations of target track-ing demonstrate the efficiency and robustness of the algorithm.