纯方位目标跟踪方法是在被动测量的情况下,根据传感器测量到的受到噪声污染的方位数据来估计目标运动特性的跟踪方法,在许多领域有着非常广泛的应用[1],例如雷达、水下、航空等领域,特别是在水下环境中,这种跟踪方法备受关注。尤其是本文将要讨论的单站纯方位目标跟踪,它的优点在于可以仅通过单个观测站在隐蔽状态下对目标进行被动的观测,并进行运动参数的估计,从而可以单独秘密地进行行动策划并对目标实施打击。但由于单个观测站所能获得的观测数据有限,系统可观测性差,对目标的定位和跟踪难度更大。因此,单站纯方位目标跟踪是水下目标攻击领域中最受关注的一种方法,它既是目标跟踪算法领域中的基本方法,又是公认的最具挑战性的一大难题。随着水下目标的运动速度不断提高,对水下快速目标的跟踪定位提出了新的挑战。
单站纯方位目标跟踪方法的研究热点集中在批处理和递推类估计两大类方法中。其中递推类估计方法由于模型简单、数据储存量小的特点,更加适合计算机应用,已经成为目标定位跟踪方法的发展方向和研究热点[2]。由于水下单站纯方位目标跟踪模型是非线性的,线性滤波效果不佳,用于此方面的递推类估计方法有:扩展卡尔曼滤波[3]、无迹卡尔曼滤波[4]、粒子滤波[5]等。
递推类估计方法有一共同难点在于,由于递推的性质,后一时刻的结果依赖于前一时刻,误差易随迭代过程扩大。对于卡尔曼系的算法,还有一大问题在于估计结果对于估计初值的选取十分依赖,起始时刻误差通过迭代始终影响后续时刻的滤波,因此起始时刻初值的准确度对后续的参数估计和目标跟踪的效果有着较大影响。近年来一些文献研究了双向滤波[6-8]或者是后向平滑[9-11]的滤波方法,试图通过正反向的滤波,增加对观测数据的利用,以提高估计精度。但这些方法都是针对滤波中上一时刻的优化,没有对滤波初值进行单独优化,对于短时观测的情况,误差降低效果有限。本文的研究是在这种后向滤波思路的基础上,采用一种逆向平滑方法对滤波的初值进行优化,使整个跟踪过程的误差降低,提高短时观测下快速目标跟踪的准确度。
1 单站纯方位目标运动模型只考虑目标在二维平面运动,假定目标做匀速直线运动,坐标系如图1所示。X轴指向正东,Y轴指向正北,观测站初始位置位于坐标原点,目标在XOY平面运动。
定义
$\left\{ {\begin{array}{l} {{V_{mx}} = {V_m}\sin {K_m}} \text{,}\\ {{V_{my}} = {V_m}\cos {K_m}} \text{,}\\ {{x_{m0}} = {D_0}\sin {\beta _0}} \text{,}\\ {{y_{m0}} = {D_0}\cos {\beta _0}} \text{。} \end{array}} \right.{\text{}} $ | (1) |
显然,
首先将目标的状态表示为向量:
对于匀速直线运动的目标,系统的状态空间模型可表示为:
${{X}}\left( {k + 1} \right) = {{\varPhi}} {{X}}\left( k \right) + {{\varGamma w}}\left( k \right){\text{,}} $ | (2) |
${{Z}}\left( k \right) = {{HX}}\left( k \right) + {{v}}\left( k \right){\text{。}} $ | (3) |
其中:
当观测量是方位角时,观测方程可以写为:
${{Z}}\left( k \right) = \arctan \frac{{{y_m}\left( k \right) - {y_w}\left( k \right)}}{{{x_m}\left( k \right) - {x_w}\left( k \right)}} + {{v}}\left( k \right){\text{。}} $ | (4) |
观测方程(4)是非线性的,而卡尔曼滤波算法是线性的,应用于纯方位目标运动分析,通常是将其进行各种方式的处理改进,形成非线性滤波方法。但其实这类算法的核心部分是类似的,以传统的卡尔曼滤波算法为例,说明其原理。
卡尔曼系滤波算法通常首先根据式(2)和式(3)构造递推卡尔曼滤波器,过程如下:
1)状态一步预测
$\hat {{X}}\left( {k + 1|k} \right) = {{\varPhi}} \hat {{X}}\left( {k|k} \right){\text{;}} $ | (5) |
2)状态更新
$ \hat {{X}}\left( {k + 1|k + 1} \right) = \hat {{X}}\left( {k + 1|k} \right) + {{K}}\left( {k + 1} \right){{\varepsilon}} \left( {k + 1} \right){\text{,}} $ | (6) |
${{\varepsilon}} \left( {k + 1} \right) = {{Z}}\left( {k + 1} \right) - {{H}}\hat {{X}}\left( {k + 1|k} \right){\text{;}} $ | (7) |
3)滤波增益矩阵
$ {{K}}\left( {k + 1} \right) = {{P}}\left( {k + 1|k} \right){{{H}}}^{\rm{T}}{\left[ {{{HP}}\left( {k + 1|k} \right){{{H}}}^{\rm{T}} + {{R}}} \right]^{ - 1}}{\text{;}} $ | (8) |
4)一步预测协方差
${{P}}\left( {k + 1|k} \right) = {{\varPhi P}}\left( {k|k} \right){{{\varPhi}} ^{\rm{T}}} + {{\varGamma Q}}{{{\varGamma}} ^{\rm{T}}}{\text{;}} $ | (9) |
5)协方差阵更新
$ {{P}}\left( {k + 1|k + 1} \right) = \left[ {{{{I}}_n} - {{K}}\left( {k + 1} \right){{H}}} \right]P\left( {k + 1|k} \right){\text{。}} $ | (10) |
根据以上步骤,可以进行卡尔曼滤波估计。其中,
这是一个递推的滤波过程,其中
由于卡尔曼滤波算法的递推性质,导致其对滤波初值的选取十分敏感,后段滤波依赖于前段滤波的结果,因此初值误差的影响长时间地存在于滤波过程中。本文提出一种初值的优化方法,通过卡尔曼滤波的逆向递推,对滤波初值进行重新估计,降低初始的估计误差,从而提高整个滤波过程的精度。
3.1 逆向平滑式(5)~式(10)描述了一般的正向卡尔曼滤波类方法的基本过程,作为递推类的滤波,这一过程是可以进行逆向递推的,其原理如下:
将式(2)展开,有
$\left\{ {\begin{array}{l} {{x_m}\left( {k + 1} \right) = {x_m}\left( k \right) + {T_0}{v_x}\left( k \right) + \frac{{{T_0}^2}}{2} \cdot {w_x}}\text{,} \\ {{v_x}\left( {k + 1} \right) = {v_x}\left( k \right) + {T_0}{w_x}} \text{,}\\ {{y_m}\left( {k + 1} \right) = {y_m}\left( k \right) + {T_0}{v_y}\left( k \right) + \frac{{{T_0}^2}}{2} \cdot {w_y}} \text{,}\\ {{v_y}\left( {k + 1} \right) = {v_y}\left( k \right) + {T_0}{w_y}} \text{,} \end{array}} \right.{\text{}} $ | (11) |
对于匀速直线运动目标,可以认为目标速度不变,即
${v_x}\left( {k + 1} \right) = {v_x}\left( k \right){\text{,}} $ | (12) |
将式(11)中等号左右移动,并将式(12)代入整理得:
$ \left\{ {\begin{array}{*{20}{l}} {{x_m}\left( {k + 1} \right) - {T_0}{v_x}\left( {k + 1} \right) - \frac{{{T_0}^2}}{2} \cdot {w_x} = {x_m}\left( k \right)} \text{,}\\ {{v_x}\left( {k + 1} \right) - {T_0}{w_x} = {v_x}\left( k \right)} \text{,}\\ {{y_m}\left( {k + 1} \right) - {T_0}{v_y}\left( {k + 1} \right) - \frac{{{T_0}^2}}{2} \cdot {w_y} = {y_m}\left( k \right)}\text{,} \\ {{v_y}\left( {k + 1} \right) - {T_0}{w_y} = {v_y}\left( k \right)} \text{,} \end{array}} \right.{\text{}} $ | (13) |
可将方程组(13)用矩阵表示为:
${{\varPsi X}}\left( {k + 1} \right) - {{\varGamma w}}\left( k \right) = {{X}}\left( k \right){\text{。}} $ | (14) |
其中:
将式(14)与式(3)组合,可构造出一组新的状态空间模型。此空间模型同样适用于卡尔曼滤波方法,将这组新的状态空间模型运用到卡尔曼滤波的递推过程中,可以实现从
1)状态一步逆向预测
$\hat {{X}}\left( {k|k + 1} \right) = {{\varPsi}} \hat {{X}}\left( {k + 1|k + 1} \right){\text{;}} $ | (15) |
2)状态逆向更新
$\hat {{X}}\left( {k|k} \right) = \hat {{X}}\left( {k|k + 1} \right) + {{K}}\left( k \right){{\varepsilon}} \left( k \right){\text{,}} $ | (16) |
${{\varepsilon}} \left( k \right) = {{Z}}\left( k \right) - {{H}}\hat {{X}}\left( {k|k + 1} \right){\text{;}} $ | (17) |
3)滤波增益矩阵
$ {{K}}\left( k \right) = {{P}}\left( {k|k + 1} \right){{{H}}}^{\rm{T}}{\left[ {{{HP}}\left( {k|k + 1} \right){{{H}}}^{\rm{T}} + {{R}}} \right]^{ - 1}}{\text{;}} $ | (18) |
4)一步逆向预测协方差
$ {{P}}\left( {k|k + 1} \right) = {{\varPsi P}}\left( {k + 1|k + 1} \right){{{\varPsi}} }^{\rm{T}} + {{\varGamma Q}}{{{\varGamma}} ^{\rm{T}}}{\text{;}} $ | (19) |
5)协方差阵逆向更新
${{P}}\left( {k|k} \right) = \left[ {{{{I}}_n} - {{K}}\left( k \right){{H}}} \right]{{P}}\left( {k|k + 1} \right){\text{。}} $ | (20) |
将通过状态的逆向更新得到的目标状态估计值记为
由于这种逆向平滑的估计值是通过正向的卡尔曼滤波得到的估计值
针对卡尔曼滤波方法对目标状态初始值
1)根据目标状态初始值
2)根据观测值
3)将
4)将逆向更新得到的
对于无迹卡尔曼滤波、扩展卡尔曼滤波及各种改进的卡尔曼滤波方法而言,虽然各方法的具体步骤不同,但由于各种算法的核心部分都是基于卡尔曼滤波的,因此上述初值优化过程也同样适用于其他的卡尔曼系的滤波方法。
新的目标状态估计值是由初值
为了验证所提出的基于逆向平滑的初值优化方法对纯方位目标跟踪轨迹的改善性能,选用无迹卡尔曼滤波和扩展卡尔曼滤波两大经典的卡尔曼系滤波方法进行试验,分别用2种方法进行基于逆向平滑的初值优化,验证使用所提方法优化初值后对整个跟踪结果的改善效果。
4.1 仿真条件根据快速目标短时跟踪的背景需要,设置目标和观测站运动轨迹如下:目标做匀速直线运动,初始位置坐标为(100 m,–400 m);目标运动速度为50 kn,航向为–41°,即直角坐标系下目标的初始速度为(−30,40)kn,换算单位后为(–15.42,20.56)m/s,目标真实的状态向量为(100,–15.42,–400,20.56)。观测站的初始位置(0 m,0 m),以45 kn的速度向−36°方向匀速直线运动50 s,而后向–63°方向继续以45 kn速度匀速直线运动100 s。针对目标运动速度快、观测时间较短的问题,设置观测站方位估计频率为10 Hz。设置各项误差条件如下:
1)仿真条件1
观测站方位估计误差的标准差为2°,初始距离估计误差为10%,初始速度矢量估计误差为10%。设置此仿真条件为基础仿真条件,其他仿真条件在此基础上对比。
2)仿真条件2
在条件1的基础上,增加目标方位估计误差的标准差为8°,其他条件不变。
3)仿真条件3
在条件1的基础上,增加初始距离估计误差为20%,其他条件不变。
4)仿真条件4
在条件1的基础上,增加初始速度矢量估计误差为20%,其他条件不变。
4.2 无迹卡尔曼仿真结果对比在仿真条件1下,分别采用无迹卡尔曼滤波和基于逆向平滑的初值优化的无迹卡尔曼滤波2种方法,进行200次蒙特卡罗试验,并将200次仿真试验中2种方法的误差进行平均,结果如图2所示。
在图2给出的仿真结果中,进行50个采样点的逆向递推,即步数
为了对比不同仿真条件下初值优化方法的效果,分别在条件1、条件2、条件3、条件4下进行仿真试验,取200次蒙特卡罗试验的误差进行平均,并将优化前后的平均误差统计如表1所示。
对于分别增大方位估计角度误差标准差、增大初始速度估计误差、增大初始距离估计误差后,本文所提方法对无迹卡尔曼滤波的误差降低依然有效,但误差降低率有所下降。
4.3 扩展卡尔曼仿真结果对比用扩展卡尔曼滤波对比本文所提基于逆向平滑的初值优化的扩展卡尔曼滤波,在给出的仿真条件下分别进行200次蒙特卡罗试验,并将200次仿真结果中2种方法的误差进行平均处理,结果如图3所示。
本次仿真同样进行了50步的逆向递推,即步数
分别根据条件1、条件2、条件3、条件4这4组仿真条件进行200次蒙特卡罗试验,统计扩展卡尔曼滤波初值优化前后平均误差,对比结果如表2所示。
由表2可知,在增加方位估计误差标准差、初始速度误差、初始距离误差后,本文所提初值优化方法对扩展卡尔曼滤波的误差降低率下降,但依然有降低误差的效果。
综合表1与表2的结果,本文所提逆向平滑初值优化方法对于无迹卡尔曼滤波和扩展卡尔曼滤波有着相似的效果。对比不同仿真条件下的误差降低率,此优化方法在条件1下有着更高的误差降低率,说明此方法在各项初始误差和方位误差标准差更低、环境条件较好时有更明显的优势。
4.4 逆向滤波步数的影响对于本文所提的对初值的逆向滤波优化,有一个重要的影响因素即为逆向步数
根据表中数据可以看出,在逆向滤波步数不超过400的时候,经过逆向滤波初值优化的结果具有更低的滤波误差,而逆向滤波步数在450点以上时,未经初值优化的传统滤波方法具有更低的滤波误差。对比不同的运动参数估计,逆向滤波的初值优化对于目标速度和目标距离的估计更加准确,而对于目标航向估计的性能提升相对不明显。对于UKF和EKF,均是在逆向滤波步数为150的时候取得最佳的优化效果,此时对位置坐标估计误差的平均降低率分别达到了65.90%和65.38%。
以目标位置坐标的估计为研究对象,比较本文所提的逆向滤波初值优化方法对于UKF和EKF的优化效果,统计不同逆向滤波步数对位置估计误差的影响,结果分别如图4和图5所示。
从图4和图5可以看出,通过改变逆向滤波步数,不论是UKF还是EKF,逆向滤波步数对于优化效果的影响是非线性的。并不是逆向滤波的步数越多优化效果越好,对2种滤波的优化均在逆向滤波步数取值150的时候取得最低的目标位置估计误差,在此之后,随着逆向滤波步数增加估计误差增大,在逆向滤波步数到400点以上,优化后的误差甚至超过原本UKF或EKF的误差,失去了优化的意义。当逆向滤波步数在150点左右时可取得最佳的优化效果,对误差的降低率达到最高。其原因在于在该仿真条件下150点左右正向滤波即观测15 s时估计误差较小,此时估计正向滤波误差取得局部极小值。根据图2(a)和图3(a)所显示的目标位置估计误差,不论对于EKF还是UKF,在观测时刻15 s左右即150点左右时刻,目标位置坐标估计的误差取得极小值,利用此时时段内较小误差的估计值进行逆向滤波,理论上可取得更小的误差,得到初值优化的效果更佳。而滤波误差的极小值点的取得步数或者是滤波收敛的步数是不一定的,它与目标和观测站的运动轨迹有关,因此在不同的场景下的最佳逆向滤波步数是不同的,不具有普适性。
但这并不意味着逆向滤波步数在滤波误差最低时是最佳选择,由于逆向滤波需要取得一定量的观测数据作为先验,更多步数的逆向滤波需要更多的观测数据和观测时长,同时需要更大的计算量。
5 结 语本文研究背景是基于快速目标短时观测下的目标跟踪,根据仿真结果与比较分析可得,本文所提基于逆向平滑滤波的初值优化方法对于无迹卡尔曼滤波和扩展卡尔曼滤波都有效果,对于目标位置坐标估计误差、目标速度估计误差和目标距离估计误差都有明显的缩小,并且在分别增大方位估计误差标准差、距离初值误差、速度初值误差后,本文所提方法依然有效缩小估计误差。本文所提方法虽然只改变滤波的初值,但在目标跟踪中对于误差的缩小有着长时间的效应。优化的效果和算法的实时性均与逆向平滑的步数有关,在实际应用中,可根据需求选取适合的逆向平滑步数,以满足不同的实际需求。
[1] |
MILLER A B, MILLER B M. Underwater target tracking using bearing-only measurements[J]. Journal of Communications Technology and Electronics, 2018, 63(6): 643-649. DOI:10.1134/S1064226918060207 |
[2] |
GUSTAFSSON F, HENDEBY G. Some relations between extened kalman filter and unscented kalman filter[J]. IEEE Transactions on Signal Processing, 2013, 60(2): 545-555. |
[3] |
SHALOM Y, LI X R, THIAGALINGAM K. Estimation with applications to tracking and navigation[M]. New York: Wiley, 2001: 381-394.
|
[4] |
JULIER S J, UHLMANN J K. Unscented filtering and nonlinear estimation[J]. Proc. of the IEEE, 2004, 92(3): 401-422. DOI:10.1109/JPROC.2003.823141 |
[5] |
GORDON N J, SALMOND D J, SMITH A F M. Novel approach to nonlinear/non-Gaussian Bayesian state estimate[J]. IEEE Proceeding of Radar, Sonar and Navagation, 1993, 140(2): 107-113. |
[6] |
MOHAMMAD Jannati, TOLE Sutikno, NIK Rumzi Nik Idris, et al. High performance speed control of single-phase induction motors using switching forward and backward EKF strategy[J]. International Journal of Power Electronics and Drive System (IJPEDS), 2016, 7(1): 17-27. DOI:10.11591/ijpeds.v7.i1.pp17-27 |
[7] |
张刚兵, 刘渝, 胥嘉佳. 基于UKF的单站无源定位于跟踪双向预测滤波算法[J]. 系统工程与电子技术, 2010, 32(7): 1415-1418. Zhang Gangbing, Liu Yu, Xu Jiajia. Unscented Kalman filter with forward-backward prediction for signal observer passive location and tracking[J]. Systems Engineering and Electronics, 2010, 32(7): 1415-1418. DOI:10.3969/j.issn.1001-506X.2010.07.015 |
[8] |
BENEDIKT T. BÖNNINGHOFF, ROBERT M. Nickel, STEFFEN Zeiler, et al. Unsupervised classification of voiced speech and pitch tracking using forward-backward Kalman filtering[C]. ITG-Fachbericht 267: Speech Communication. Paderborn, Germany: VDE, 2016: 46-50.
|
[9] |
WU B, LIU P Y. A new cubature Kalman filter improved by backward iterative algorithm[C]// International Conference on Intelligent Computation Technology and Automation (ICICTA). Nanchang, China: IEEE press, 2015: 44-48.
|
[10] |
MARK L. Psiaki. Backward-smoothing extended Kalman filter[J]. Journal of Guidance, Control, and Dynamics, 2005, 28(5): 885-894. DOI:10.2514/1.12108 |
[11] |
霍光, 李冬海. 基于后向平滑容积卡尔曼滤波的单站无源定位算法[J]. 信号处理, 2013, 29(1): 68-74. HUO Guang, LI Donghai. A single observer passive location algorithm based on backward-smoothing cubature Kalman filter[J]. Journal of Signal Processing, 2013, 29(1): 68-74. DOI:10.3969/j.issn.1003-0530.2013.01.010 |