基于递推更新卡尔曼滤波的磁偶极子目标跟踪

摘要

针对磁性目标跟踪问题,以磁偶极子等效场源模型为基础,建立磁性目标跟踪的离散状态空间模型,将磁偶极子目标实时跟踪问题转化为状态空间模型的滤波估值问题.针对磁性目标初始条件难以获得且现有卡尔曼类滤波算法在大初始误差条件下容易出现发散的问题,提出一种递推观测更新的卡尔曼滤波算法,将现有的一步观测更新描述为递推更新过程,等效降低大初始误差带来的大非线性误差.仿真与实测数据测试结果表明,本文算法具有良好的精度和收敛性,能够有效抑制磁偶极子跟踪中由于大初始误差导致的滤波发散,适于实际应用.%The magnetic target tracking problem is addressed in this paper by establishing the discrete state-space model on the basis of the equivalent magnetic dipole model in order to formulate the real-time magnetic dipole target tracking problem as filtering estimation problem of state-space model.Then a novel filtering approach with the recursive update process is proposed to address the divergence problem of magnetic target tracking under large prior error condition when using present Kalman-type filters.The one-step measurement update is replaced by recursive update process;hence the large nonlinearized error caused by large prior error is reduced in each recursive step.The proposed algorithm is tested by simulation and real-world magnetic data.Both results validate the superior performance in comparison with present filters in terms of accuracy and convergence,and the capacity to suppress the divergence problem caused by large prior error in magnetic dipole target tracking.