机动目标跟踪的一种防发散RBUKF算法

张 园,钟志通,刘淑波,初俊博

(海军大连舰艇学院,辽宁 大连 116018)

机动目标跟踪的一种防发散RBUKF算法

张 园,钟志通,刘淑波,初俊博

(海军大连舰艇学院,辽宁 大连 116018)

针对观测方程为非线性,状态方程为线性,且噪声为加性情况下的机动目标跟踪问题,应用Rao-Blackwellised UKF (RBUKF)算法滤波并对其进行了防发散处理,得到机动目标跟踪的一种基于防发散RBUKF (AD-RBUKF)算法。对二维机动目标跟踪的仿真结果显示,本算法的跟踪效果明显优于其它两种常用的非线性滤波方法——基本的UKF算法和SPPF算法,仿真结果表明该算法是一种跟踪精度高,且适合工程应用的非线性滤波方法。

机动目标跟踪;Rao-Blackwellised UKF (RBUKF);防发散

机动目标跟踪是军事和民用领域的一个基本问题,可用于导弹的精确定位打击、卫星监控系统、防卫系统、海岸监视系统、核武器运载系统以及海上或空中交通管制等。

机动目标跟踪本质上是一个估计问题，在贝叶斯估计的框架内,线性高斯条件下可得到解析解,即基本的卡尔曼滤波方程。但实际系统大多不满足线性高斯条件,无法得到解析解。

无迹卡尔曼滤波(unscented Kalman filtering,简称UKF),又称无味卡尔曼滤波,是针对贝叶斯估计在非线性高斯条件下无法得到解析解的难题产生的一种次优的非线性系统滤波方法,与通常采用的局部线性化方法(扩展卡尔曼滤波,extended Kalman filtering,简称EKF)相比,计算量相当,但UKF不需要计算雅可比矩阵;能处理不可微的非线性函数;能对所有高斯输入向量的非线性函数进行近似[1],因此在非线性系统滤波问题中得到了广泛应用。与针对线性高斯系统滤波问题的基本卡尔曼滤波方法相比,UKF、EKF的计算量较大。

普通的UKF针对最一般的情况,即:描述机动目标及其观测的数学模型均为非线性,系统噪声和观测噪声均为非加性。但实际我们常常遇到下面一类情况:目标机动模型在直角坐标系下建立,且为线性模型;而雷达观测在极坐标系下,将状态量进行坐标变换使得观测方程成为非线性模型;噪声均为加性噪声。在上述特定情况下,将普通的UKF算法简化为一种特定的RBUKF(Rao-Blackwellised UKF)算法[2-4],可以减少一些不必要的计算,提高运算速度,提高算法的效费比。

发散问题是理论上的滤波算法应用于实际系统所面临的一个瓶颈问题,解决得不好,滤波器会陷入“瘫痪”,因此,对上述RBUKF算法进行防发散改进,是增强算法实用性的重要手段。

1 机动目标及其观测模型

假设机动目标及其观测可用下述状态空间表达式描述:

X(k+1)=Φ(k+1,k)X(k)+Γ(k+1,k)W(k)

(1)

Z(k)=h[X(k)]+V(k)

(2)

2 防发散RBUKF(ARBUKF)算法

2.1 RBUKF算法

当系统噪声与观测噪声均为加性噪声,且状态方程为线性,观测方程为非线性时,修改最一般形式的UKF算法,得到相应的RBUKF算法为:

1) 初始化

(3)

(4)

2) 时间更新

(5)

P(k/k-1)=Φ(k,k-1)P(k-1/k-1)Φ(k,k-1)T+Γ(k,k-1)Q(k-1)Γ(k,k-1)T

(6)

3) 采样2n+1个西格玛点

采用比例采样策略,式中,λ=α2(n+κ)-n。

4) 测量更新

ζi(k/k-1)=h[χi(k/k-1)]

(8)

(9)

(10)

其余步骤、公式与最一般形式的UKF算法完全相同,不赘述。

(11)

(12)

(13)

P(k/k)=P(k/k-1)-K(k)PZZK(k)T

(14)

2.2 防发散改进

卡尔曼滤波算法的一个突出特点是若模型准确,滤波器在3-5个采样周期就能收敛;但若模型不准,滤波器很容易发散。因此,防发散是卡尔曼滤波器在实际应用中不可回避的问题。在基本卡尔曼滤波算法中,通常认为滤波器发散是模型误差不断积累,而观测值过早“老化”导致。防发散的主要思想是:当实际估计误差超过理论预测值的r倍以上(r≥1)时,认为滤波器发散,这时,通过修改算法减小模型递推的权重,相对增大观测值的权重。在各种防发散算法中,有一种实际不发散的新算法(亦称s(k)法),在检测到滤波器发散后,通过增大预测误差方差,迫使滤波器减小估计值对通过模型递推产生的预测数据的依赖,相应增大新的观测值对估计值的修正作用,该方法物理概念清楚[5]，防发散效果好,可将其思想移植到上述RBUKF算法中，具体改进方法如下。

(15)

(16)

ν(k)Tν(k)>r·trace[H(k)P(k/k-1)HT(k)+R(k)]时,认为滤波器发散,这时,式(6)变为P(k/k-1)=s(k)·Φ(k,k-1)P(k-1/k-1)Φ(k,k-1)T+Γ(k,k-1)Q(k-1)Γ(k,k-1)T

式中,m为观测向量的维数。

3 仿真结果及分析

为了验证本文提出的AD-RBUKF算法的性能,将其与基本UKF、Sigma点粒子滤波(SPPF)进行比较。

仿真场景选取一种非线性运动轨迹——转圈运动[6]。假设初始位置为[300m,0m],初始速度为[300m/s,0m/s],初始切向加速度为a0=40m/s2,仿真时间80s。

AD-RBUKF算法中,r=2,S=1.5,其它参数选择如下:α=0.5,amax=80m/s2,采样周期T=1s。假设观测噪声为V(k)=[βx(k)+Δx0]w(k)。式中,β为相对误差系数,这里取β=0.01;Δx0为固定量测误差,这里取Δx=30m;w(k)是均值为零,方差为1的正态伪随机数。观测噪声方差为:R(k)=[βx(k)+Δx0]2。

采用CT模型,分别对各算法进行100次MonteCarlo仿真,UKF、SPPF和AD-RBUKF算法的位置RMSE仿真结果如表1所示,平均计算时间如表2所示。三种算法的x方向、y方向位置RMSE的仿真曲线分别如图1、图2所示。

表1 100次蒙特卡罗仿真结果

表2 100次蒙特卡罗仿真平均计算时间

图1 x方向位置RMSE曲线

图2 y方向位置RMSE曲线

由图1、图2和表1、表2可以看出,在模型为非线性的情况下,基本的UKF算法已经是一种次优解,实际估计误差超过理论预测值是常态,因此,当实际估计误差超过理论预测值的r(r≥1)倍以上时,通过修改算法减小模型递推的权重,相对增大观测值权重的方法,能有效改善跟踪精度,且非线性程度越高,模型误差持续积累、观测值过早“老化”的问题越突出,防发散改进的效果越明显。r值太小,防发散检测过于敏感,修正过于频繁,会使滤波器出现不必要的震荡,导致滤波精度的改善受损;r值太大,防发散门限过宽,则不能有效发现和修正。针对本文设定的运动轨迹的跟踪问题,仿真结果表明,随着r值增大跟踪精度提升幅度先增大后减小,因此,本文取r=2。此时,

1) 在使用相同的CT模型时,相对于基本UKF算法,AD-RBUKF和SPPF算法的跟踪精度大幅提高。其中,AD-RBUKF算法x方向、y方向位置RMSE分别是基本UKF算法的6.37%、7.39%。

2) 相对于SPPF算法,AD-RBUKF算法提高了跟踪精度。AD-RBUKF算法x方向、y方向位置RMSE分别是SPPF算法的18.32%、22.40%。更令人关注的是,AD-RBUKF算法比SPPF算法的计算复杂度和计算时间大幅降低,其平均计算时间只有SPPF算法的1.11%。

4 结束语

本文提出的AD-RBUKF算法跟踪效果明显优于其它两种常用的非线性滤波方法。与基本的UKF算法相比,AD-RBUKF算法在计算时间基本相当的前提下跟踪精度显著提高;与SPPF算法相比,AD-RBUKF算法缩短计算时间的优势显著,在此前提下,跟踪精度还能有所提高。

[1] 程水英.无味变换与无味卡尔曼滤波[J].计算机工程与应用,2008,44(24):25-35.

[2] 刘江,陆明泉,王忠勇. RBUKF算法在GPS实时定位解算中的应用[J].系统工程与电子技术, 2009, 31(11):2578-2581.

[3] 王海霞.舰船组合导航信息综合集成技术应用研究[D]. 哈尔滨：哈尔滨工程大学,2009.

[4] 康叶伟,黄亚楼,孙凤池，等.一种基于RBUKF 滤波器的SLAM算法[J].计算机工程,2008,34(1):17-19+29.

[5] 张园.卡尔曼滤波及其军事应用[M].北京：国防工业出版社，2016.

[6] 敬忠良. 神经网络跟踪理论及应用[M]. 北京: 国防工业出版社， 1995.

A kind of Anti-divergent RBUKF Algorithm of Maneuvering Target Tracking

ZHANG Yuan, ZHONG Zhi-tong, LIU Su-bo, CHU Jun-bo

(Dalian Naval Academy, Dalian 116018, China)

Devoted to the problem of maneuvering target tracking under nonlinear observation, linear state and added noise, a kind of algorithm based on anti-divergent RBUKF (AD-RBUKF) of maneuvering target tracking is developed, which uses Rao-Blackwellised UKF (RBUKF) for filter and anti-divergent work. Two-dimensional maneuvering target tracking simulation results show that, the tracking effect of this algorithm is clearly better than the other two commonly used nonlinear filtering method of the basic UKF algorithm and the SPPF algorithm. And the simulation results show that this algorithm is of high tracking accuracy, and it is suitable for nonlinear filtering method for engineering application.

maneuvering target tracking; Rao-Blackwellised UKF (RBUKF); anti-divergent

2016-11-10

张 园(1972-),女,山东青岛人,博士,副教授,研究方向为机动目标跟踪。 钟志通(1967-),男,博士,副教授。 刘淑波(1979-),女,副教授。 初俊博(1981-),女,讲师。

1673-3819(2017)01-0041-03

TJ765.1；E917

A

10.3969/j.issn.1673-3819.2017.01.009

修回日期： 2016-11-30