CN103308896B - 一种适于非引擎机动目标的高精度跟踪方法 - Google Patents
一种适于非引擎机动目标的高精度跟踪方法 Download PDFInfo
- Publication number
- CN103308896B CN103308896B CN201310164782.8A CN201310164782A CN103308896B CN 103308896 B CN103308896 B CN 103308896B CN 201310164782 A CN201310164782 A CN 201310164782A CN 103308896 B CN103308896 B CN 103308896B
- Authority
- CN
- China
- Prior art keywords
- mrow
- target
- state
- mover
- value
- Prior art date
- Legal status (The legal status is an assumption and is not a legal conclusion. Google has not performed a legal analysis and makes no representation as to the accuracy of the status listed.)
- Active
Links
- 238000000034 method Methods 0.000 title claims abstract description 41
- 230000001133 acceleration Effects 0.000 claims abstract description 91
- 239000011159 matrix material Substances 0.000 claims description 39
- 230000003044 adaptive effect Effects 0.000 claims description 38
- 238000005070 sampling Methods 0.000 claims description 37
- 238000005259 measurement Methods 0.000 claims description 36
- 238000005314 correlation function Methods 0.000 claims description 11
- 230000008569 process Effects 0.000 claims description 11
- 230000007704 transition Effects 0.000 claims description 10
- 238000005311 autocorrelation function Methods 0.000 claims description 7
- 230000006978 adaptation Effects 0.000 claims description 6
- 238000012512 characterization method Methods 0.000 claims description 3
- 230000002596 correlated effect Effects 0.000 claims description 3
- 238000006073 displacement reaction Methods 0.000 claims description 3
- 238000005309 stochastic process Methods 0.000 abstract description 2
- 238000001914 filtration Methods 0.000 description 6
- 230000007547 defect Effects 0.000 description 3
- 230000036461 convulsion Effects 0.000 description 2
- 238000000354 decomposition reaction Methods 0.000 description 2
- 230000000694 effects Effects 0.000 description 2
- 230000036962 time dependent Effects 0.000 description 2
- 241001465754 Metazoa Species 0.000 description 1
- 230000009286 beneficial effect Effects 0.000 description 1
- 238000004364 calculation method Methods 0.000 description 1
- 230000008859 change Effects 0.000 description 1
- 238000001514 detection method Methods 0.000 description 1
- 238000012986 modification Methods 0.000 description 1
- 230000004048 modification Effects 0.000 description 1
- 238000005457 optimization Methods 0.000 description 1
- 239000002245 particle Substances 0.000 description 1
- 238000013179 statistical model Methods 0.000 description 1
- HOWHQWFXSLOJEF-MGZLOUMQSA-N systemin Chemical compound NCCCC[C@H](N)C(=O)N[C@@H](CCSC)C(=O)N[C@@H](CCC(N)=O)C(=O)N[C@@H]([C@@H](C)O)C(=O)N[C@@H](CC(O)=O)C(=O)OC(=O)[C@@H]1CCCN1C(=O)[C@H]1N(C(=O)[C@H](CC(O)=O)NC(=O)[C@H](CCCN=C(N)N)NC(=O)[C@H](CCCCN)NC(=O)[C@H](CO)NC(=O)[C@H]2N(CCC2)C(=O)[C@H]2N(CCC2)C(=O)[C@H](CCCCN)NC(=O)[C@H](CO)NC(=O)[C@H](CCC(N)=O)NC(=O)[C@@H](NC(=O)[C@H](C)N)C(C)C)CCC1 HOWHQWFXSLOJEF-MGZLOUMQSA-N 0.000 description 1
- 108010050014 systemin Proteins 0.000 description 1
- 230000002087 whitening effect Effects 0.000 description 1
Landscapes
- Radar Systems Or Details Thereof (AREA)
Abstract
本发明涉及一种适用于非引擎机动目标的高精度跟踪方法,其首先根据目标实际运动中加速度满足的非零均值时间相关随机过程特性,建立含有***自适应参数的目标运动模型;其次,根据建立的目标运动模型,对目标运动特性进行预测;然后,利用目标状态预测值和雷达观测数据值计算目标当前状态估计值,最后,根据目标加速度估计值修正***自适应参数,利用修正的***自适应参数更新目标的运动模型,利用更新的目标运动模型进行下一次的预测与估计;本方法对具有非引擎机动随机特征的目标进行在线估计,提高了机动目标模型描述实际运动特性的准确性,提高了非引擎机动目标的跟踪精度。
Description
技术领域
本发明涉及目标跟踪技术领域,尤其涉及雷达对非引擎机动目标的高精度跟踪方法。
背景技术
目标跟踪技术包括目标建模及利用测量数据进行估计两部分。传统的机动目标模型,如常速度模型、常加速度模型、Singer模型、Jerk模型及“当前统计模型”都是根据先验知识对目标运动特性进行建模。以下专利都是采用上述模型中的一种:基于粒子滤波和航迹管理的微弱目标检测前跟踪方法(201210106282)、一种高机动目标跟踪方法(201210138397)、一种基于多尺度维分解的目标跟踪方法(201110361072.5)、一种采用前向散射雷达的三维目标跟踪方法(201110247074)、卡尔曼滤波与经验模态分解有机结合的机动目标跟踪方法(201010235062)、一种基于分布式处理的无线传感器网络目标跟踪方法(200910037862),其中一种高机动目标跟踪方法(201210138397)使用的是改进的Jerk模型,需要已知目标的加速度机动频率及方差。由于驱动引擎本身的动力学约束,引擎驱动目标加速度机动频率及其随机特性是可测的,因此,尽管引擎目标的速度较快但加速度的机动特性可以较为准确的描述。但人、动物等非引擎驱动目标,加速度机动频率及其随机特性十分复杂而且种类繁多,目前尚没有每种运动方式的加速度机动频率及其随机特性的准确描述数据,这导致了这些方法在跟踪非引擎机动目标无法取得良好的跟踪效果。
基于嵌入式平台的自适应滤波目标跟踪定位方法(201110404800)公开了一种基于嵌入式平台的自适应滤波目标跟踪定位方法,其中涉及到根据三维空间运动的三阶拉格朗日级数展开地理位置观测数据进行建模,将运动模型建模模块输出的误差值进行残差数据处理,利用噪声空间估计关键参数,对增益矩阵进行参数优化,但其存在观测数据具有不确定性的缺点。
综上所述,目前关于目标的建模与跟踪的方法没有根据非引擎目标运动特征实时建模、在跟踪该类目标时无法取得良好的跟踪效果。
发明内容
本发明所要解决的技术问题是针对现有技术的不足,提供一种适用于非引擎机动目标的高精度跟踪方法,该方法能够利用测量数据对目标随机加速度运动特性进行实时建模并进行跟踪。
本发明解决上述技术问题的技术方案如下:
实现本发明的目的的基本思路是:首先,根据目标实际运动中加速度满足的非零均值时间相关随机过程特性,建立含有***自适应参数的目标运动模型;其次,根据建立的目标运动模型,对目标运动特性进行预测;然后,利用目标状态预测值和雷达数据观测值对目标状态进行更新,最后,根据目标加速度估计值修正***自适应参数,利用修正的***自适应参数更新目标的运动模型,利用更新的目标运动模型进行下一次的预测与估计。
具体实现步骤如下:
步骤1:目标运动状态和***自适应参数初始化;
步骤2:建立具有***自适应参数的运动模型;
步骤3:根据建立的具有***自适应参数的运动模型对目标状态进行预测,得到目标的状态预测值;
步骤4:根据目标的状态预测值和雷达数据观测值对目标状态进行更新,得到目标状态估计值;
步骤5:根据目标状态估计值计算目标加速度均值及目标加速度估计值;
步骤6:根据目标加速度估计值对***自适应参数进行修正;
步骤7:利用步骤5中求得的目标加速度均值和步骤6中求得的修正后的***自适应参数更新步骤2中的目标运动模型;
步骤8:重复步骤2至7,直至所有测量数据全部执行完毕,则结束。
在上述技术方案的基础上,本发明还可以做如下改进。
进一步,所述步骤1中目标运动状态和***自适应参数初始化包括:
1.1设置状态初值
1.2***自适应参数初值α=α0和其中α为机动频率,为加速度方差,
1.3自相关函数初值r0(0)和r0(1)的初值取为r0(0)=0,r0(1)=0,
1.4***加速度分量初值
进一步,所述步骤2中建立具有***自适应参数的运动模型的具体步骤包括:
2.1利用下式描述目标的运动特征
其中为3维状态列向量,分别是位移、速度和加速度,x(k+1)为k+1时刻目标的状态向量,k为采样时刻;Φ(k+1,k)为状态转移矩阵;x(k)为k时刻目标的状态向量;U(k)为控制矩阵;为0时刻开始至k时刻目标的加速度均值;w(k)为过程噪声,其均值为0,方差为Q(k);所述Φ(k+1,k)、U(k)及Q(k)中含有目标机动频率α和目标机动加速度方差随着***自适应参数的变化而变化。
2.2利用下式建立目标测量方程
y(k)=H(k)x(k)+v(k)
其中k为采样时刻,y(k)为目标在k时刻的雷达观测值,H(k)为测量矩阵,x(k)为k时刻目标的状态向量;v(k)为高斯测量白噪声,其方差为R,且与过程噪声w(k)相互独立。
进一步,所述步骤3中根据建立的具有***自适应参数的运动模型对目标状态进行预测,得到目标的状态预测值的具体步骤如下:
3.1根据建立的具有***自适应参数的运动模型和初始值完成目标状态的一步预测,预测方程式如下:
其中表示k-1时刻预测目标在k时刻的状态,k为采样时刻,|表示条件操作符;Φ(k,k-1)为状态转移矩阵;表示目标k-1时刻目标的状态估计值;U(k-1)为控制矩阵;为从0时刻开始至k-1的加速度均值;
3.2按照下式完成目标状态协方差的一步预测:
P(k|k-1)=Φ(k,k-1)P(k-1|k-1)ΦT(k,k-1)+Q(k-1)
其中P(k|k-1)表示k-1时刻预测目标在k时刻的状态协方差,k为采样时刻,|表示条件操作符;P(k-1|k-1)表示k-1时刻目标的状态协方差的估计值;Φ(k,k-1)为状态转移矩阵;Q(k-1)为过程噪声协方差。
进一步,所述步骤4中根据目标的状态预测值和雷达数据观测值对目标状态进行更新,得到目标状态估计值的具体步骤如下:
4.1根据目标状态协方差预测值、测量矩阵及测量噪声方差按照下式计算滤波器增益
K(k)=P(k|k-1)HT(k)[H(k)P(k|k-1)HT(k)+R]T
其中,K(k)为滤波器增益,k为采样时刻,P(k|k-1)表示k-1时刻预测目标在k时刻的状态协方差,H(k)为k时刻的测量矩阵,R为高斯测量白噪声的方差,HT(k)为k时刻的测量矩阵的转置;
4.2利用目标状态预测值和雷达数据观测值计算目标当前状态估计值
其中,表示k时刻目标的状态估计值,表示k-1时刻时预测目标在k时刻的状态,k为采样时刻,K(k)为k时刻滤波器增益,y(k)为雷达接收数据在k时刻的目标观测值,H(k)为k时刻的测量矩阵;
4.3按照下式计算目标状态协方差估计值,
P(k|k)=[I-K(k)H(k)]P(k|k-1)
其中I是3维单位矩阵,P(k|k)表示k时刻的目标状态协方差的估计值,k为采样时刻,K(k)为k时刻滤波器增益,H(k)为k时刻的测量矩阵,P(k|k-1)表示k-1时刻预测目标在k时刻的状态协方差。
进一步,所述步骤5中根据目标状态估计值计算目标加速度均值及目标加速度估计值的具体步骤如下:
步骤5.1:根据目标状态估计值计算目标加速度均值
其中为0至k时刻加速度均值,为k时刻目标的状态估计值的第三行值,k为采样时刻;
步骤5.2:按照下式获取***k-1时刻和k时刻的加速度估计值
其中为k-1时刻状态估计的第三行值,为k时刻状态估计的第三行值。
进一步,所述步骤6中根据加速度估计值对***自适应参数进行修正的具体步骤如下:
根据采样时刻k值的大小,选择修正***自适应参数α和的方法,若k小于等于4进入步骤6.1,若k大于4进入步骤6.2,
6.1当采样时刻k小于等于4时,按下式计算***自适应参数α和
α=α0,其中α0为***自适应参数α的初值,
如果 则取
如果 则取
如果则取(0,10]之间的任意数,
其中,为k时刻目标加速度估计值,π为圆周率,取为3.14,aM为正的常数,取为3,a-M为与aM绝对值相等的负常数,取为-3;
6.2当采样时刻k大于4时,按下式计算***自适应参数α和
其中rk(1)为k时刻目标加速度向前一步相关函数,rk-1(1)为k-1时刻目标加速度向前一步相关函数,和分别为k-1时刻和k时刻目标加速度估计值;rk(0)为k时刻目标加速度自相关函数,rk-1(0)为k-1时刻目标加速度自关函数;α为一个***自适应参数,T为采样间隔;为另一个***自适应参数。
进一步,所述状态初始值x0为3维全0列向量,维数为***模型中状态向量的维数。
进一步,所述***自适应参数的初始值α0和取任意正数。
本发明的有益效果是:
1.针对非引擎机动目标的加速度统计特性,建立含有***自适应参数的目标运动模型,利用加速度估计值在线地实时修正***自适应参数,保证了目标运动模型的实时准确性,实现高精度跟踪;
2.将具有自适应参数的目标运动模型与卡尔曼滤波器相结合,利用卡尔曼滤波器实时修正加速度估计值,利用加速度估计值在线地实时修正***自适应参数,进而实时更新目标运动模型,保证了目标运动模型与实际目标运动的实时逼近,避免由于使用不准确观测数据进行建模可能导致滤波发散的缺点,克服了应用现有机动目标模型进行滤波时无法准确描述非引擎目标运动模型的缺点,适用于目标跟踪领域中的非引擎机动目标跟踪。
附图说明
图1为本发明所述一种适于非引擎机动目标的高精度跟踪方法流程图;
具体实施方式
以下结合附图对本发明的原理和特征进行描述,所举实例只用于解释本发明,并非用于限定本发明的范围。
如图1所示,一种适于非引擎机动目标的高精度跟踪方法,包括如下步骤:
步骤1:目标运动状态和***自适应参数初始化
1.1设置状态初值为3维全0列向量,维数为***模型中状态向量的维数,
1.2***自适应参数初值α=α0和取任意正数,本实施例中α0取值取值3,
1.3自相关函数初值r0(0)和r0(1)的初值取为
1.4***加速度分量初值本实施例中取0;
步骤2:建立具有***自适应参数的运动模型
2.1利用下式描述目标的运动特征
设目标加速度为非零均值的时间相关随机过程其中为加速度均值,a(t)为零均值指数相关有色噪声模型,其相关函数为
其中,Ra(τ)表示相关函数;表示加速度方差;α为机动频率,反应目标的机动随机特性;
对有色噪声a(t)做白化处理,得到:
其中,w(t)为零均值白噪声,方差为
由 和 得到目标运动的连续状态方程
以周期T采样,离散化后***目标运动满足以下方程
其中为3维状态列向量,分别是位移、速度和加速度,x(k+1)为k+1时刻目标的状态向量,k为采样时刻;Φ(k+1,k)为状态转移矩阵;x(k)为k时刻目标的状态向量;U(k)为控制矩阵;为0时刻开始至k时刻目标的加速度均值;w(k)为过程噪声,其均值为0,方差为Q(k);所述Φ(k+1,k)、U(k)及Q(k)中含有目标机动频率α和目标机动加速度方差随着***自适应参数的变化而变化;
其中状态转移矩阵Φ(k+1,k)的表达式如下:
控制矩阵U(k)的表达式如下:
过程噪声w(k)的方差Q(k)的表达式如下:
其中,
E[·]表示求取均值;E[w(k)wT(k)]表示求取零均值噪声w(k)的方差;
2.2利用下式建立目标测量方程
y(k)=H(k)x(k)+v(k)
其中k为采样时刻,y(k)为目标在k时刻的雷达观测值,H(k)为测量矩阵,x(k)为k时刻目标的状态向量;v(k)为高斯测量白噪声,其方差为R,且与过程噪声w(k)相互独立;
步骤3:根据建立的具有***自适应参数的运动模型对目标状态进行预测,
3.1根据建立的具有***自适应参数的运动模型和初始值完成目标状态的一步预测,预测方程式如下:
其中表示k-1时刻预测目标在k时刻的状态,k为采样时刻,|表示条件操作符;Φ(k,k-1)为状态转移矩阵;表示目标k-1时刻目标的状态估计值;U(k-1)为控制矩阵;为从0时刻开始至k-1的加速度均值;
3.2按照下式完成目标状态协方差的一步预测:
P(k|k-1)=Φ(k,k-1)P(k-1|k-1)ΦT(k,k-1)+Q(k-1)
其中P(k|k-1)表示k-1时刻预测目标在k时刻的状态协方差,k为采样时刻,|表示条件操作符;P(k-1|k-1)表示k-1时刻目标的状态协方差的估计值;Φ(k,k-1)为状态转移矩阵;Q(k-1)为过程噪声协方差;
步骤4:根据目标的状态预测值、雷达数据观测值和目标的状态协方差预测值对目标状态进行更新
4.1根据目标状态协方差预测值、测量矩阵及测量噪声方差按照下式计算滤波器增益
K(k)=P(k|k-1)HT(k)[H(k)P(k|k-1)HT(k)+R]T
其中,K(k)为滤波器增益,k为采样时刻,P(k|k-1)表示k-1时刻预测目标在k时刻的状态协方差,H(k)为k时刻的测量矩阵,R为高斯测量白噪声的方差,HT(k)为k时刻的测量矩阵的转置;
4.2利用目标状态预测值和雷达数据观测值计算目标当前状态估计值
其中,表示k时刻目标的状态估计值,表示k-1时刻时预测目标在k时刻的状态,k为采样时刻,K(k)为k时刻滤波器增益,y(k)为雷达接收数据在k时刻的目标观测值,H(k)为k时刻的测量矩阵;
4.3按照下式计算目标状态协方差的估计值
P(k|k)=[I-K(k)H(k)]P(k|k-1)
其中I是3维单位矩阵,P(k|k)表示k时刻的目标状态协方差的估计值,k为采样时刻,K(k)为k时刻滤波器增益,H(k)为k时刻的测量矩阵,P(k|k-1)表示k-1时刻预测目标在k时刻的状态协方差;
步骤5:根据目标状态估计值计算目标加速度均值及目标加速度估计值,
步骤5.1:利用下式计算目标加速度均值
其中为0至k时刻加速度均值,为k时刻目标的状态估计值的第三行值,k为采样时刻;
步骤5.2:按照下式获取***k-1时刻和k时刻的加速度估计值
其中为k-1时刻状态估计的第三行值,为k时刻状态估计的第三行值;
步骤6:根据目标加速度估计值对***自适应参数进行修正,
根据采样时刻k值的大小,选择修正***自适应参数α和的方法若k
小于等于4进入步骤6.1,若k大于4进入步骤6.2,
6.1当采样时刻k小于等于4时,按下式计算***自适应参数α和
α=α0,其中α0为***自适应参数α的初值,
如果 则取
如果 则取
如果则取(0,10]之间的任意数,
其中,为k时刻目标加速度估计值,π为圆周率,取为3.14,aM为正的常数,取为3,a-M为与aM绝对值相等的负常数,取为-3;
6.2当采样时刻k大于4时,按下式计算***自适应参数α和
其中rk(1)为k时刻目标加速度向前一步相关函数,rk-1(1)为k-1时刻目标加速度向前一步相关函数,和分别为k-1时刻和k时刻目标加速度估计值;rk(0)为k时刻目标加速度自相关函数,rk-1(0)为k-1时刻目标加速度自关函数;
根据***方程 得到目标运动加速度
方程满足如下一阶马尔科夫随机序列:
其中为k+1时刻的加速度,为k时刻的加速度,β为离散后加速度随机序列的机动频率,wa(k)为零均值白噪声离散序列,方差为其中为零均值白噪声w(t)的方差,β与α的关系为β=e-αT;
一阶马尔科夫时间加速度序列满足以下参数关系:
其中,rk(1)为k时刻的加速度向前一步相关函数,rk(0)为k时刻的加速度自相关函数,α与β分别为加速度及其离散化后加速度序列的机动频率,自适应参数可按照下式计算得到:
其中,rk(1)为k时刻的加速度向前一步相关函数,rk-1(0)为k时刻的加速度自相关函数,ln为取以e为底的对数计算;α为一个***自适应参数,T为采样间隔;为另一个***自适应参数;
步骤7:利用步骤5中求得的目标加速度均值和步骤6中求得的修正后的***自适应参数更新步骤2中的目标运动模型;
步骤8:重复步骤2至7,直至所有测量数据全部执行完毕,则结束。
以上所述仅为本发明的较佳实施例,并不用以限制本发明,凡在本发明的精神和原则之内,所作的任何修改、等同替换、改进等,均应包含在本发明的保护范围之内。
Claims (8)
1.一种适于非引擎机动目标的高精度跟踪方法,其特征在于,包括如下步骤:
步骤1:目标运动状态和***自适应参数初始化;
步骤2:建立具有***自适应参数的运动模型,其中,***自适应参数包括机动频率α和加速度方差
步骤3:根据建立的具有***自适应参数的运动模型对目标状态进行预测,得到目标的状态预测值
步骤4:根据目标的状态预测值和雷达数据观测值y(k)对目标状态进行更新,得到目标状态估计值
步骤5:根据目标状态估计值计算目标加速度均值及目标加速度估计值;
所述步骤5中根据目标状态估计值计算目标加速度均值及目标加速度估计值的具体步骤如下:
步骤5.1:根据目标状态估计值计算目标加速度均值
其中为0至k时刻加速度均值,为k时刻目标的状态估计值的第三行值,k为采样时刻;
步骤5.2:按照下式获取***k-1时刻和k时刻的加速度估计值
其中为k-1时刻状态估计的第三行值,为k时刻状态估计的第三行值;
步骤6:根据目标加速度估计值对***自适应参数的机动频率α和加速度方差进行修正;
步骤7:利用步骤5中求得的目标加速度均值和步骤6中求得的修正后的***自适应参数更新步骤2中的目标运动模型;
步骤8:重复步骤2至7,直至所有测量数据全部执行完毕,则结束。
2.根据权利要求1所述一种适于非引擎机动目标的高精度跟踪方法,其特征在于,所述步骤1中目标运动状态和***自适应参数初始化包括:
1.1设置状态初值
1.2***自适应参数初值α=α0和其中α为机动频率,为加速度方差,
1.3自相关函数初值r0(0)和r0(1)的初值取为r0(0)=0,r0(1)=0,
1.4***加速度分量初值
3.根据权利要求2所述一种适于非引擎机动目标的高精度跟踪方法,其特征在于,所述步骤2中建立具有***自适应参数的运动模型的具体步骤包括:
2.1利用下式描述目标的运动特征
其中为3维状态列向量,x,分别是位移、速度和加速度,x(k+1)为k+1时刻目标的状态向量,k为采样时刻;Φ(k+1,k)为状态转移矩阵;x(k)为k时刻目标的状态向量;U(k)为控制矩阵;为0时刻开始至k时刻目标的加速度均值;w(k)为过程噪声,其均值为0,方差为Q(k);所述Φ(k+1,k)、U(k)及Q(k)中含有目标机动频率α和目标机动加速度方差随着***自适应参数的变化而变化;
2.2利用下式建立目标测量方程
y(k)=H(k)x(k)+v(k)
其中k为采样时刻,y(k)为目标在k时刻的雷达观测值,H(k)为测量矩阵,x(k)为k时刻目标的状态向量;v(k)为高斯测量白噪声,其方差为R,且与过程噪声w(k)相互独立。
4.根据权利要求3所述一种适于非引擎机动目标的高精度跟踪方法,其特征在于,所述步骤3中根据建立的具有***自适应参数的运动模型对目标状态进行预测,得到目标的状态预测值的具体步骤如下:
3.1根据建立的具有***自适应参数的运动模型和初始值完成目标状态的一步预测,预测方程式如下:
其中表示k-1时刻预测目标在k时刻的状态,k为采样时刻,|表示条件操作符;Φ(k,k-1)为状态转移矩阵;表示目标k-1时刻目标的状态估计值;U(k-1)为控制矩阵;为从0时刻开始至k-1的加速度均值;
3.2按照下式完成目标状态协方差的一步预测:
P(k|k-1)=Φ(k,k-1)P(k-1|k-1)ΦT(k,k-1)+Q(k-1)
其中P(k|k-1)表示k-1时刻预测目标在k时刻的状态协方差,k为采样时刻,|表示条件操作符;P(k-1|k-1)表示k-1时刻目标的状态协方差的估计值;Φ(k,k-1)为状态转移矩阵;Q(k-1)为过程噪声协方差。
5.根据权利要求4所述一种适于非引擎机动目标的高精度跟踪方法,其特征在于,所述步骤4中根据目标的状态预测值和雷达数据观测值对目标状态进行更新,得到目标状态估计值的具体步骤如下:
4.1根据目标状态协方差预测值、测量矩阵及测量噪声方差按照下式计算滤波器增益
K(k)=P(k|k-1)HT(k)[H(k)P(k|k-1)HT(k)+R]T
其中,K(k)为滤波器增益,k为采样时刻,P(k|k-1)表示k-1时刻预测目标在k时刻的状态协方差,H(k)为k时刻的测量矩阵,R为高斯测量白噪声的方差,HT(k)为k时刻的测量矩阵的转置;
4.2利用目标状态预测值和雷达数据观测值计算目标当前状态估计值
其中,表示k时刻目标的状态估计值,表示k-1时刻时预测目标在k时刻的状态,k为采样时刻,K(k)为k时刻滤波器增益,y(k)为雷达接收数据在k时刻的目标观测值,H(k)为k时刻的测量矩阵;
4.3按照下式计算目标状态协方差估计值,
P(k|k)=[I-K(k)H(k)]P(k|k-1)
其中I是3维单位矩阵,P(k|k)表示k时刻的目标状态协方差的估计值,k为采样时刻,K(k)为k时刻滤波器增益,H(k)为k时刻的测量矩阵,P(k|k-1)表示k-1时刻预测目标在k时刻的状态协方差。
6.根据权利要求1所述一种适于非引擎机动目标的高精度跟踪方法,其特征在于,所述步骤6中根据目标加速度估计值对***自适应参数进行修正的具体步骤如下:
根据采样时刻k值的大小,选择修正***自适应参数α和的方法,若k小于等于4进入步骤6.1,若k大于4进入步骤6.2,
6.1当采样时刻k小于等于4时,按下式计算***自适应参数α和α=α0,其中α0为***自适应参数α的初值,
如果 则取
如果 则取
如果则取(0,10]之间的任意数,
其中,为k时刻目标加速度估计值,π为圆周率,取为3.14,aM为正的常数,取为3,a-M为与aM绝对值相等的负常数,取为-3;
6.2当采样时刻k大于4时,按下式计算***自适应参数α和
其中rk(1)为k时刻目标加速度向前一步相关函数,rk-1(1)为k-1时刻目标加速度向前一步相关函数,和分别为k-1时刻和k时刻目标加速度估计值;rk(0)为k时刻目标加速度自相关函数,rk-1(0)为k-1时刻目标加速度自关函数;α为一个***自适应参数,T为采样间隔;为另一个***自适应参数。
7.根据权利要求2所述一种适于非引擎机动目标的高精度跟踪方法,其特征在于,所述状态初始值x0为3维全0列向量,维数为***模型中状态向量的维数。
8.根据权利要求2所述一种适于非引擎机动目标的高精度跟踪方法,其特征在于,所述***自适应参数的初始值α0和取任意正数。
Priority Applications (1)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
CN201310164782.8A CN103308896B (zh) | 2013-05-07 | 2013-05-07 | 一种适于非引擎机动目标的高精度跟踪方法 |
Applications Claiming Priority (1)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
CN201310164782.8A CN103308896B (zh) | 2013-05-07 | 2013-05-07 | 一种适于非引擎机动目标的高精度跟踪方法 |
Publications (2)
Publication Number | Publication Date |
---|---|
CN103308896A CN103308896A (zh) | 2013-09-18 |
CN103308896B true CN103308896B (zh) | 2015-07-29 |
Family
ID=49134320
Family Applications (1)
Application Number | Title | Priority Date | Filing Date |
---|---|---|---|
CN201310164782.8A Active CN103308896B (zh) | 2013-05-07 | 2013-05-07 | 一种适于非引擎机动目标的高精度跟踪方法 |
Country Status (1)
Country | Link |
---|---|
CN (1) | CN103308896B (zh) |
Families Citing this family (14)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
CN105974367A (zh) * | 2016-05-04 | 2016-09-28 | 南京理工大学 | 基于apm模型的机动频率自适应跟踪算法 |
CN105954743B (zh) * | 2016-05-31 | 2018-08-21 | 西安电子科技大学 | 一种改进权值的变结构多模型机动目标跟踪方法 |
CN106199580B (zh) * | 2016-07-01 | 2018-08-14 | 中国人民解放军海军航空工程学院 | 一种基于模糊推理***的Singer模型改进算法 |
CN106909738B (zh) * | 2017-02-24 | 2020-07-24 | 北京工商大学 | 一种模型参数辨识方法 |
CN106646452B (zh) * | 2017-02-24 | 2019-04-02 | 西北工业大学 | 一种基于摄动多高斯拟合的空间目标跟踪方法 |
CN107122724B (zh) * | 2017-04-18 | 2020-09-04 | 北京工商大学 | 一种基于自适应滤波的传感器数据在线去噪的方法 |
CN107728138B (zh) * | 2017-09-15 | 2020-11-17 | 电子科技大学 | 一种基于当前统计模型的机动目标跟踪方法 |
CN107885232A (zh) * | 2017-10-23 | 2018-04-06 | 上海机电工程研究所 | 一种用于多策略机动跟踪的滤波方法 |
CN107861115B (zh) * | 2017-11-03 | 2020-07-17 | 电子科技大学 | 一种基于瞬时自相关矩阵稀疏分解的othr机动目标参数估计方法 |
CN108037663A (zh) * | 2017-12-07 | 2018-05-15 | 电子科技大学 | 一种基于变维滤波算法的机动目标跟踪方法 |
CN109471096B (zh) * | 2018-10-31 | 2023-06-27 | 奇瑞汽车股份有限公司 | 多传感器目标匹配方法、装置及汽车 |
CN109815866A (zh) * | 2019-01-14 | 2019-05-28 | 北京工商大学 | 一种基于数据融合的噪声消除方法 |
CN110927727B (zh) * | 2019-11-25 | 2021-09-03 | 深圳市智慧海洋科技有限公司 | 目标定位跟踪方法和装置 |
CN113963025B (zh) * | 2021-10-22 | 2022-08-16 | 西北工业大学深圳研究院 | 水下自适应机动目标快速跟踪及追踪方法 |
Citations (1)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
CN102721951A (zh) * | 2012-05-04 | 2012-10-10 | 西安电子科技大学 | 一种高机动目标跟踪方法 |
-
2013
- 2013-05-07 CN CN201310164782.8A patent/CN103308896B/zh active Active
Patent Citations (1)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
CN102721951A (zh) * | 2012-05-04 | 2012-10-10 | 西安电子科技大学 | 一种高机动目标跟踪方法 |
Non-Patent Citations (1)
Title |
---|
基于当前统计模型的机动目标自适应强跟踪算法;刘望生等;《***工程与电子技术》;20110930;第33卷(第9期);1937-1940页 * |
Also Published As
Publication number | Publication date |
---|---|
CN103308896A (zh) | 2013-09-18 |
Similar Documents
Publication | Publication Date | Title |
---|---|---|
CN103308896B (zh) | 一种适于非引擎机动目标的高精度跟踪方法 | |
CN107462882B (zh) | 一种适用于闪烁噪声的多机动目标跟踪方法及*** | |
CN107045125B (zh) | 一种基于预测值量测转换的交互多模型雷达目标跟踪方法 | |
CN102980579B (zh) | 一种自主水下航行器自主导航定位方法 | |
US9851211B2 (en) | Information processing apparatus, computer-readable recording medium, and information processing system | |
CN104020480B (zh) | 一种带自适应因子的交互式多模型ukf的卫星导航方法 | |
CN105467838B (zh) | 一种随机有限集框架下的同步定位与地图构建方法 | |
WO2017124299A1 (zh) | 基于序贯贝叶斯滤波的多目标跟踪方法及跟踪*** | |
CN106772353B (zh) | 一种适用于闪烁噪声的多目标跟踪方法及*** | |
CN103389094B (zh) | 一种改进的粒子滤波方法 | |
CN102568004A (zh) | 一种高机动目标跟踪算法 | |
CN107402381A (zh) | 一种迭代自适应的多机动目标跟踪方法 | |
CN103529424B (zh) | 一种基于rfid及ukf实现室内目标快速跟踪的方法 | |
CN107084714A (zh) | 一种基于RoboCup3D的多机器人协作目标定位方法 | |
CN107884002A (zh) | 移动体的状态计算装置和计算方法、程序和记录介质 | |
CN115066631A (zh) | 用于跟踪对象的扩张状态的***和方法 | |
CN101477623A (zh) | 基于模糊推理的交互式多模型方法 | |
CN110572139A (zh) | 用于车辆状态估计的融合滤波实现方法以及装置、存储介质、车辆 | |
Geragersian et al. | An INS/GNSS fusion architecture in GNSS denied environment using gated recurrent unit | |
CN108226887B (zh) | 一种观测量短暂丢失情况下的水面目标救援状态估计方法 | |
CN106168943A (zh) | 一种用于跟踪转弯机动目标的方法及其*** | |
CN108303095A (zh) | 适用于非高斯***的鲁棒容积目标协同定位方法 | |
KR101833007B1 (ko) | 도플러 비컨을 이용한 수중 이동체의 위치 및 속도 추정 방법 및 시스템 | |
Thuy et al. | Non-linear, shape independent object tracking based on 2d lidar data | |
CN103968839B (zh) | 一种基于蜂群算法改进ckf的单点重力匹配方法 |
Legal Events
Date | Code | Title | Description |
---|---|---|---|
C06 | Publication | ||
PB01 | Publication | ||
C10 | Entry into substantive examination | ||
SE01 | Entry into force of request for substantive examination | ||
C14 | Grant of patent or utility model | ||
GR01 | Patent grant |