一种残膜回收机防缠绕挑膜装置的制 一种秧草收获机用电力驱动行走机构

一种雷达慢速弱机动目标量测修正伯努利滤波方法及装置

2022-08-13 12:43:08 来源:中国专利 TAG:


1.本发明属于雷达数据处理技术领域,具体涉及一种雷达慢速弱机动目标量测修正伯努利滤波方法及装置。


背景技术:

2.雷达目标跟踪是对回波信号处理之后形成的量测数据进行处理,获得目标的位置和运动状态等参数,并形成目标的运动轨迹,从而是将雷达下发的点迹集合处理输出为目标航迹集合的过程,是雷达数据处理的一个重要环节。跟踪滤波算法的本质是对目标的运动状态进行估计,即从包含噪声的量测数据中提取出目标的状态信息,雷达系统根据每一时刻的状态形成目标运动轨迹,对目标进行评估与预测。因此跟踪滤波算法的优劣直接影响着雷达的安全效能。
3.现有的雷达目标跟踪系统中,对目标进行跟踪滤波时,主要有以下两种方式。第一种是传统的卡尔曼滤波方法。将状态估计问题视为概率的推理问题,不直接求解目标的状态估计,而是求解目标后验概率密度,将后验概率密度p(xk|yk)取最大值时目标所处的位置xk视作当前时刻目标状态的最优估计。该方法将滤波分为两个过程,第一个过程为预测过程,分别对状态向量和误差协方差矩阵进行一步预测;第二个过程为更新过程,使用当前时刻获得的量测值对状态向量和误差协方差矩阵的预测进行更新。该方法采用最小方差准则进行估计,通过递推的方式实现对目标的更新。但是该方法没有考虑虚警、杂波和目标的漏检,且不适用于非线性非高斯的系统。第二种方法是基于随机有限集的伯努利滤波方法。将目标的出现和消失以及存在杂波等物理现象统一以集合的形式描述,目标消失时为空集,目标出现时为概率密度为pk的单元素集,在杂波环境下也能获得较好的跟踪效果。但是该方法相较于第一种方法只能提高杂波环境下目标跟踪的准确性,无法提高目标的跟踪精度。
4.低分辨雷达测量精度低,在对慢速运动目标进行跟踪时,由于慢速目标运动速度慢,在探测周期内的位移距离难以超出低分辨雷达的误差范围,使得难以捕捉慢速目标的运动趋势,进一步增大了低测量精度对目标跟踪精度和航迹稳定性的影响,使用常规滤波方法进行跟踪,会导致较大的跟踪误差,甚至可能出现跟丢目标的情况,即常规方法的稳定性不高。
5.综上,在量测误差较大的情况下对慢速目标进行跟踪时,目标的运动趋势难以捕捉,直接对目标的量测数据进行滤波,或只是简单对量测数据的可靠性进行判断后决定丢弃还是直接进行处理,会导致目标跟踪的精度较低甚至跟丢目标。


技术实现要素:

6.为了解决现有技术中存在的上述问题,本发明提供了一种雷达慢速弱机动目标量测修正伯努利滤波方法及装置。本发明要解决的技术问题通过以下技术方案实现:
7.本发明实施例提供了一种雷达慢速弱机动目标量测修正伯努利滤波方法,包括步
骤:
8.s1、获取目标航迹当前时刻的前m个时刻的状态估计值,得到邻近时刻目标的航迹历史值;
9.s2、利用所述航迹历史值对目标的运动模型进行拟合,得到所述前m个时刻中任一时刻的运动模型参数,所述运动模型为匀速运动模型;
10.s3、利用所述任一时刻的运动模型参数对所述当前时刻获得的目标量测值进行修正,得到当前时刻目标的量测修正值;
11.s4、根据所述航迹历史值和所述运动模型对每个时刻目标的量测修正值计算目标量测的协方差矩阵;
12.s5、采用高斯和伯努利滤波器,结合所述当前时刻目标的量测修正值和所述协方差矩阵计算目标当前时刻的存在概率,并根据所述当前时刻的存在概率对目标状态进行更新。
13.在本发明的一个实施例中,步骤s2包括:
14.s21、利用总体最小二乘方法,根据所述航迹历史值中目标邻近时刻航迹的纬度坐标和运动速度计算目标的北向速度估计值和任一时刻的纬度估计值;
15.s22、利用总体最小二乘方法,根据所述航迹历史值中目标邻近时刻航迹的经度坐标和运动速度计算目标的东向速度估计值和任一时刻的经度估计值。
16.在本发明的一个实施例中,所述北向速度估计值和所述任一时刻的纬度估计值为:
[0017][0018]
其中,为任一时刻的纬度估计值,为北向速度估计值,ab为系数矩阵,σb为增广矩阵b'=[-b,ab]的最小奇异值,b为目标邻近时刻航迹的纬度坐标,b=[b
k-m
,b
k-m 1
,

,bk]
t
,k为当前时刻,m为当前时刻向后回溯的时刻数,i为单位矩阵;
[0019]
系数矩阵ab为:
[0020][0021]
其中,t为相邻时刻的时间间隔,k为当前时刻,rb=6356752m为地球短轴半径。
[0022]
在本发明的一个实施例中,所述东向速度估计值和所述任一时刻的经度估计值为:
[0023][0024]
其中,为任一时刻的经度估计值,为东向速度估计值,a
l
为系数矩阵,σ
l
为增广矩阵l'=[-l,a
l
]的最小奇异值,l为目标邻近时刻航迹的经度坐标,l=[l
k-m
,l
k-m 1
,

,lk]
t
,k为当前时刻,m为当前时刻的向后回溯的时刻数,i为单位矩阵;
[0025]
系数矩阵a
l
为:
[0026][0027]
其中,t为相邻时刻的时间间隔,k为当前时刻,为目标所处的纬度圆半径,r为地球平均半径,b
k-m
为目标k-m时刻所处的纬度。
[0028]
在本发明的一个实施例中,步骤s3包括:
[0029]
s31、利用所述北向速度估计值、所述任一时刻的纬度估计值、所述东向速度估计值和所述任一时刻的经度估计值计算当前时刻目标量测坐标的估计值:
[0030][0031]
其中,为当前时刻的纬度坐标,为当前时刻的经度坐标,为任一时刻的纬度估计值,为任一时刻的经度估计值,m为任一时刻距离当前时刻的时刻数,δt为每一帧数据的时间间隔,为北向速度估计值,为东向速度估计值,rb为地球平均半径,r
l
为目标所处的纬度圆半径;
[0032]
s32、利用所述北向速度估计值和所述东向速度估计值计算当前时刻目标量测速度的估计值:
[0033][0034]
其中,为北向速度估计值,为东向速度估计值。
[0035]
s33、由所述当前时刻目标量测坐标的估计值和所述当前时刻目标量测速度的估计值得到所述当前时刻目标的量测修正值:
[0036][0037]
其中,为当前时刻目标的量测修正值。
[0038]
在本发明的一个实施例中,所述目标量测的协方差矩阵为:
[0039][0040]
其中,为目标量测的协方差矩阵,为量测误差均值,e为期望函数,zm为k-m时刻至k时刻的航迹历史值,为k-m时刻至k时刻的量测修正值。
[0041]
在本发明的一个实施例中,步骤s5包括:
[0042]
s51、利用上一时刻目标的存在概率预测当前时刻目标的存在概率,利用上一时刻所有高斯成分的均值预测当前时刻每个高斯成分的均值,利用上一时刻所有高斯成分的协
方差矩阵预测当前时刻每个高斯成分的协方差矩阵,利用上一时刻存活高斯成分的权值预测当前时刻存活高斯成分的权值和新生高斯成分的权值;
[0043]
s52、利用所述当前时刻目标的量测修正值和预测的所述当前时刻每个高斯成分的均值更新每个高斯成分的均值,利用预测的所述当前时刻每个高斯成分的协方差矩阵更新每个高斯成分的协方差矩阵,利用所述当前时刻目标的量测修正值和预测的所述当前时刻每个高斯成分的权值更新每个高斯成分的权值,根据预测的所述当前时刻目标的存在概率和更新后的所述每个高斯成分的权值更新目标的存在概率:
[0044][0045]
其中,r
k|k-1
为预测的当前时刻目标的存在概率,为更新后的高斯成分的权值,pf为雷达的虚警概率;
[0046]
s53、判断更新后的所述目标的存在概率是否满足预设条件,若满足,则根据更新后的所述每个高斯成分的均值和更新后的所述每个高斯成分的权值设置当前时刻所述目标状态,如不满足,则将当前时刻的所述目标状态更新为上一时刻目标状态的预测。
[0047]
在本发明的一个实施例中,所述预设条件为:更新后的所述目标的存在概率大于0.5。
[0048]
在本发明的一个实施例中,根据更新后的所述每个高斯成分的均值和更新后的所述每个高斯成分的权值设置当前时刻所述目标状态,包括,
[0049]
将所有所述高斯成分的权值中权值最大的所述高斯成分的均值设置为所述当前时刻所述目标状态。
[0050]
本发明的另一实施例提供了一种雷达慢速弱机动目标量测修正伯努利滤波装置,包括:
[0051]
航迹历史值获取模块,用于获取目标航迹当前时刻的前m个时刻的状态估计值,得到航迹历史值;
[0052]
运动模型拟合模块,用于利用所述航迹历史值对目标的运动模型进行拟合,得到所述前m个时刻中任一时刻的运动模型参数,所述运动模型为匀速运动模型;
[0053]
目标量测值修正模块,用于利用所述任一时刻的运动模型参数对所述当前时刻获得的目标量测值进行修正,得到当前时刻目标的量测修正值;
[0054]
协方差矩阵量测模块,用于根据所述航迹历史值和所述运动模型对每个时刻目标的量测修正值计算目标量测的协方差矩阵;
[0055]
目标状态更新模块,用于采用高斯和伯努利滤波器,结合所述当前时刻目标的量测修正值和所述协方差矩阵计算目标当前时刻的存在概率,并根据所述当前时刻的存在概率对目标状态进行更新。
[0056]
与现有技术相比,本发明的有益效果:
[0057]
本发明的滤波方法利用弱机动目标邻近时刻运动状态的一致性,使用邻近时刻目标的航迹历史值对当前时刻目标的量测值进行修正,使用修正后的量测值进行滤波,使得目标跟踪的准确性和稳定性得以大幅提升,能够针对低分辨雷达对弱机动目标的跟踪提供
高精度的滤波值,能有效提高目标的跟踪精度。
附图说明
[0058]
图1为本发明实施例提供的一种雷达慢速弱机动目标量测修正伯努利滤波方法的流程示意图;
[0059]
图2为本发明实施例提供的另一种雷达慢速弱机动目标量测修正伯努利滤波方法的流程示意图;
[0060]
图3为本发明实施例提供的一种伯努利滤波方法仿真对目标航迹进行滤波处理的结果示意图;
[0061]
图4为本发明实施例提供的一种雷达慢速弱机动目标量测修正伯努利滤波方法对目标航迹进行滤波处理的结果示意图;
[0062]
图5为本发明实施例提供的一种伯努利滤波方法和雷达慢速弱机动目标量测修正伯努利滤波方法的跟踪误差对比图;
[0063]
图6为本发明实施例提供的一种伯努利滤波方法仿真对实测数据进行滤波处理的结果示意图;
[0064]
图7为本发明实施例提供的一种雷达慢速弱机动目标量测修正伯努利滤波方法对实测数据进行处理的结果示意图;
[0065]
图8为本发明实施例提供的一种雷达慢速弱机动目标量测修正伯努利滤波装置的示意图。
具体实施方式
[0066]
下面结合具体实施例对本发明做进一步详细的描述,但本发明的实施方式不限于此。
[0067]
实施例一
[0068]
请参见图1和图2,图1为本发明实施例提供的一种雷达慢速弱机动目标量测修正伯努利滤波方法的流程示意图,图2为本发明实施例提供的另一种雷达慢速弱机动目标量测修正伯努利滤波方法的流程示意图。该滤波方法适用于低分辨雷达对慢速弱机动目标的跟踪,该方法包括步骤:
[0069]
s1、获取目标航迹当前时刻的前m个时刻的状态估计值,得到邻近时刻目标的航迹历史值。
[0070]
具体的,根据高斯和伯努利滤波方法从目标航迹当前时刻k向后回溯m个时刻,获取前m个时刻的状态估计值,得到邻近时刻即目标前m步的航迹历史值{y
k-m
},其中,m=1,2,

,m,k-m表示时刻,m的取值范围可以为4~10。航迹历史值{y
k-m
}包括目标历史时刻的经度l
k-m
、目标历史时刻的纬度b
k-m
和运动速度v
k-m

[0071]
s2、利用所述航迹历史值对目标的运动模型进行拟合,得到所述前m个时刻中任一时刻的运动模型参数,所述运动模型为匀速运动模型。
[0072]
本实施例中,前m个时刻中任一时刻的运动模型参数均可用于对当前时刻的量测值进行修正,即运动模型参数可以为任一时刻的参数。进一步的,运动模型参数包括任一时刻目标的经度坐标、任一时刻目标的纬度坐标和任一时刻目标的运动速度;由于运动模型
为匀速运动模型,因此,k-m到k时刻的运动速度是相同的。
[0073]
本实施例以k-m时刻为例进行说明,具体包括步骤:
[0074]
s21、利用总体最小二乘方法,根据所述航迹历史值中目标邻近时刻航迹的纬度坐标和运动速度计算目标的北向速度估计值和任一时刻的纬度估计值。
[0075]
具体的,航迹历史值{y
k-m
}中,其目标邻近时刻航迹的纬度坐标为b=[b
k-m
,b
k-m 1
,

,bk]
t
,则目标的北向速度估计值和k-m时刻的纬度估计值由下式计算得出:
[0076][0077]
其中,为k-m时刻的纬度估计值,为北向速度估计值,ab为系数矩阵,σb为增广矩阵b'=[-b,ab]的最小奇异值,b为目标邻近时刻航迹的纬度坐标,b=[b
k-m
,b
k-m 1
,

,bk]
t
,k为当前时刻,m为当前时刻向后回溯的时刻数,i为单位矩阵。
[0078]
系数矩阵ab为:
[0079][0080]
其中,t为相邻时刻的时间间隔,k为当前时刻,rb为地球短轴半径。
[0081]
s22、利用总体最小二乘方法,根据所述航迹历史值中目标邻近时刻航迹的经度坐标和运动速度计算目标的东向速度估计值和任一时刻的经度估计值。
[0082]
具体的,航迹历史值{y
k-m
}中,其目标邻近时刻航迹的经度值为l=[l
k-m
,l
k-m 1
,

,lk]
t
,则目标的东向速度估计值和k-m时刻的经度估计值为:
[0083][0084]
其中,为k-m时刻的经度估计值,为东向速度估计值,a
l
为系数矩阵,σ
l
为增广矩阵l'=[-l,a
l
]的最小奇异值,l为目标邻近时刻航迹的经度坐标,l=[l
k-m
,l
k-m 1
,

,lk]
t
,k为当前时刻,m为当前时刻向后回溯的时刻数,i为单位矩阵。
[0085]
系数矩阵a
l
为:
[0086][0087]
其中,t为相邻时刻的时间间隔,k为当前时刻,为目标所处的纬度圆半径,r为地球平均半径,b
k-m
为k-m时刻目标所处的纬度值。
[0088]
s3、利用所述任一时刻的运动模型参数对所述当前时刻获得的目标量测值进行修正,得到当前时刻目标的量测修正值。
[0089]
本实施例中,当前时刻目标的量测修正值包括:目标的经度坐标估计值、目标的纬度坐标估计值和目标运动速度估计值。
[0090]
具体包括步骤:
[0091]
s31、利用所述北向速度估计值、所述任一时刻的纬度估计值、所述东向速度估计值和所述任一时刻的经度估计值计算当前时刻目标量测坐标的估计值。
[0092]
具体的,以任一时刻为k-m时刻为例,利用步骤s2估计得到的运动模型参数:k-m时刻的纬度估计值k-m时刻的经度估计值北向速度估计值东向速度估计值计算当前时刻目标量测坐标的估计值:
[0093][0094]
其中,为当前时刻的纬度坐标,为当前时刻的经度坐标,为k-m时刻的纬度估计值,为k-m时刻的经度估计值,m为向后回溯的时刻数,δt为每一帧数据的时间间隔,为北向速度估计值,为东向速度估计值,rb为地球平均半径,r
l
为目标所处的纬度圆半径。
[0095]
s32、利用所述北向速度估计值和所述东向速度估计值计算当前时刻目标量测速度的估计值。
[0096]
具体的,利用北向速度估计值东向速度估计值计算当前时刻目标量测速度的估计值:
[0097][0098]
其中,为北向速度估计值,为东向速度估计值。
[0099]
s33、由所述当前时刻目标量测坐标的估计值和所述当前时刻目标量测速度的估计值得到所述当前时刻目标的量测修正值。
[0100]
具体的,当前时刻目标的量测修正值即为当前时刻目标量测坐标的估计值和当前时刻目标量测速度的估计值形成的矩阵:
[0101][0102]
其中,为当前时刻目标的量测修正值。
[0103]
进一步的,通过上述方法可以获得每个时刻目标的量测修正值
[0104]
s4、根据所述航迹历史值和所述运动模型对每个时刻目标的量测修正值计算目标量测的协方差矩阵。
[0105]
具体的,首先,由邻近时刻目标的航迹历史值{y
k-m
}和运动模型对每个时刻目标的量测修正值计算得到所有时刻的量测误差均值
[0106][0107]
其中,e为期望函数,zm为k-m时刻至k时刻的航迹历史值,为k-m时刻至k时刻的量测修正值。
[0108]
然后,由量测误差均值计算所有时刻目标量测的协方差矩阵
[0109][0110]
其中,为目标量测的协方差矩阵,为量测误差均值。
[0111]
s5、采用高斯和伯努利滤波器,结合所述当前时刻目标的量测修正值和所述协方差矩阵计算目标当前时刻的存在概率,并根据所述当前时刻的存在概率对目标状态进行更新。
[0112]
具体的,高斯和伯努利滤波器将目标状态视为多个服从高斯分布状态的叠加,目标的概率密度由l个高斯成分表示。高斯和伯努利滤波器分两个步骤实现,分别为预测步和更新步,其具体实现步骤为:
[0113]
s51、预测步。
[0114]
具体的,利用上一时刻目标的存在概率r
k-1|k-1
预测当前时刻目标的存在概率:
[0115]rk|k-1
=pb(1-r
k-1|k-1
) p
srk-1|k-1
ꢀꢀꢀꢀꢀꢀꢀꢀꢀꢀꢀꢀꢀꢀꢀꢀꢀꢀꢀꢀꢀꢀ
(10)
[0116]
其中,r
k|k-1
为当前时刻目标的存在概率,pb为目标的新生概率,r
k-1|k-1
为上一时刻目标的存在概率,ps为目标的存活概率。
[0117]
利用上一时刻所有高斯成分的均值预测当前时刻每个高斯成分的均值,其中,所有高斯成分是指l个高斯成分。预测得到的当前时刻每个高斯成分的均值为:
[0118][0119]
其中,l=1,2,

,l,f
k-1
为状态转移矩阵。
[0120]
利用上一时刻所有高斯成分的协方差矩阵预测当前时刻每个高斯成分的协方差矩阵。其中,所有高斯成分是指l个高斯成分。预测得到的当前时刻每个高斯成分的协方差矩阵为:
[0121][0122]
其中,l=1,2,

,l,f
k-1
为状态转移矩阵,q
k-1
为状态噪声协方差矩阵,f

k-1为状态转移矩阵的转置。
[0123]
利用上一时刻存活高斯成分的权值预测当前时刻存活高斯成分的权值和新生高斯成分的权值。预测的存活高斯成分的权值为:
[0124][0125]
其中,ps为高斯成分的存活概率,r
k-1
为目标上一时刻的存在概率,为上一时刻存活高斯成分的权值。
[0126]
预测的新生高斯成分的权值为:
[0127]
[0128]
其中,pr为高斯成分的新生概率,r
k-1
为目标上一时刻的存在概率,为上一时刻存活高斯成分的权值。
[0129]
s52、更新步。
[0130]
利用所述当前时刻目标的量测修正值和预测的所述当前时刻每个高斯成分的均值更新每个高斯成分的均值。具体的,第l个高斯成分的均值更新为:
[0131][0132]
其中,为预测的当前时刻第l个高斯成分的均值,为卡尔曼增益,为预测得到的当前时刻第l个高斯成分的协方差矩阵,为量测协方差矩阵,rk为量测噪声协方差矩阵,为当前时刻目标的量测修正值,hk为量测矩阵。
[0133]
利用预测的所述当前时刻每个高斯成分的协方差矩阵更新每个高斯成分的协方差矩阵。具体的,高斯成分的协方差矩阵更新为:
[0134][0135]
其中,为预测的当前时刻第i个高斯成分的协方差矩阵,为卡尔曼增益,hk为量测矩阵。
[0136]
利用所述当前时刻目标的量测修正值和预测的所述当前时刻每个高斯成分的权值更新每个高斯成分的权值。具体的,高斯成分权值更新为:
[0137][0138]
其中,pd为雷达的检测概率,为量测的高斯似然函数,为预测的当前时刻第l个高斯成分的权值。
[0139]
高斯似然函数的表达式为:
[0140][0141]
其中,为当前时刻目标的量测修正值,s
k|k-1
为量测修正值对应的误差协方差矩阵,
[0142]
根据预测的所述当前时刻目标的存在概率和更新后的所述每个高斯成分的权值更新目标的存在概率:
[0143]
[0144]
其中,r
k|k-1
为预测的当前时刻目标的存在概率,为更新后的高斯成分的权值,pf为雷达的虚警概率。
[0145]
在滤波过程中,由于高斯成分会不断的增加,因此需要对高斯成分进行以下处理:首先,对权值低于一定阈值δ的高斯成分进行修剪以将权值较小的高斯成分去除掉,修剪阈值δ一般取1e-5
;然后,对修剪后的高斯成分进行合并,具体的,对距离小于一定阈值ε的高斯成分进行合并以保留两个距离较近中的一个高斯成分,合并阈值ε一般取4,第l个高斯和第i个高斯成分之间的距离定义为最后,经过合并后只保留一定数目且具有较高权值的高斯成分。
[0146]
s53、判断更新后的所述目标的存在概率是否满足预设条件,若满足,则根据更新后的所述每个高斯成分的均值和更新后的所述每个高斯成分的权值设置当前时刻所述目标状态,如不满足,则将当前时刻的所述目标状态更新为上一时刻目标状态的预测。
[0147]
具体的,所述预设条件为:更新后的所述目标的存在概率大于0.5。进一步的,当更新后的目标的存在概率>0.5,则将所有高斯成分的权值中权值最大的高斯成分的均值设置为当前时刻所述目标状态,即目标当前时刻的更新滤波状态x
k|k
为权值最大的高斯高斯成分均值当更新后的目标的存在概率≤0.5,则目标当前时刻的更新滤波状态为上一时刻目标状态x
k|k-1
的预测x
k|k
=fkx
k|k-1
,其中,fk为状态转移矩阵。
[0148]
本实施例滤波方法的效果通过以下对仿真和实测数据的处理进一步说明。
[0149]
1、实验环境与条件
[0150]
数据率:40s/帧;目标数:1个;目标运动速度:14m/s;测距误差:10km;数据帧数:80帧。
[0151]
2、实现内容与结果
[0152]
实验1,用伯努利滤波方法仿真对目标航迹进行滤波处理,结果如图3所示,图3为本发明实施例提供的一种伯努利滤波方法仿真对目标航迹进行滤波处理的结果示意图。
[0153]
实验2,用本实施例方法仿真对目标航迹进行滤波处理,结果如图4所示,图4为本发明实施例提供的一种雷达慢速弱机动目标量测修正伯努利滤波方法对目标航迹进行滤波处理的结果示意图。
[0154]
比较图3和图4可见,伯努利滤波方法的滤波值随量测值波动较大,目标运动趋势不明显,跟踪效果较差。而本实施例的滤波值随量测值得波动很小,目标运动趋势明显,跟踪效果得到了明显得改善。
[0155]
实验3,进行500次蒙特卡洛实验,对比伯努利滤波方法和本实施例方法的跟踪误差,结果如图5所示,图5为本发明实施例提供的一种伯努利滤波方法和雷达慢速弱机动目标量测修正伯努利滤波方法的跟踪误差对比图。从图中可以看出针对大量测误差下对慢速目标的跟踪,相比于伯努利滤波,本实施例的滤波误差有明显的减小,能够明显改善目标跟踪的精度。
[0156]
实验4,用伯努利滤波方法对实测数据进行处理,结果如图6所示,图6为本发明实施例提供的一种伯努利滤波方法仿真对实测数据进行滤波处理的结果示意图。
[0157]
实验5,用本发明方法对实测数据进行处理,结果如图7所示,图7为本发明实施例
提供的一种雷达慢速弱机动目标量测修正伯努利滤波方法对实测数据进行处理的结果示意图。
[0158]
图6和图7中目标的真实值来源于船舶自动识别系统,可作为真实值的参考,对比两图可以看出,在实际应用中本实施例也能够获得较好的跟踪效果,本实施例相较于伯努利滤波方法,拥有更好的跟踪效果,跟踪稳定性得到了明显的改善。
[0159]
综上所述,本实施例的滤波方法利用弱机动目标邻近时刻运动状态的一致性,使用邻近时刻目标的航迹历史值对当前时刻目标的量测值进行修正,使用修正后的量测值进行滤波,使得目标跟踪的准确性和稳定性得以大幅提升,能够针对低分辨雷达对弱机动目标的跟踪提供高精度的滤波值,能有效提高目标的跟踪精度。
[0160]
实施例二
[0161]
在实施例一的基础上,请参见图8,图8为本发明实施例提供的一种雷达慢速弱机动目标量测修正伯努利滤波装置的示意图。该滤波装置包括:航迹历史值获取模块、运动模型拟合模块、目标量测值修正模块、协方差矩阵量测模块和目标状态更新模块。
[0162]
具体的,航迹历史值获取模块用于获取目标航迹当前时刻的前m个时刻的状态估计值,得到航迹历史值。运动模型拟合模块用于利用所述航迹历史值对目标的运动模型进行拟合,得到所述前m个时刻中任一时刻的运动模型参数,所述运动模型为匀速运动模型。目标量测值修正模块用于利用所述任一时刻的运动模型参数对所述当前时刻获得的目标量测值进行修正,得到当前时刻目标的量测修正值。协方差矩阵量测模块用于根据所述航迹历史值和所述运动模型对每个时刻目标的量测修正值计算目标量测的协方差矩阵。目标状态更新模块用于采用高斯和伯努利滤波器,结合所述当前时刻目标的量测修正值和所述协方差矩阵计算目标当前时刻的存在概率,并根据所述当前时刻的存在概率对目标状态进行更新。
[0163]
上述各个模块的具体实施方式请参见实施例一,本实施例不再赘述。
[0164]
以上内容是结合具体的优选实施方式对本发明所作的进一步详细说明,不能认定本发明的具体实施只局限于这些说明。对于本发明所属技术领域的普通技术人员来说,在不脱离本发明构思的前提下,还可以做出若干简单推演或替换,都应当视为属于本发明的保护范围。
再多了解一些

本文用于企业家、创业者技术爱好者查询,结果仅供参考。

发表评论 共有条评论
用户名: 密码:
验证码: 匿名发表

相关文献