CN106874701A - 一种基于模型切换次数受限的多模型机动目标跟踪滤波方法 - Google Patents
一种基于模型切换次数受限的多模型机动目标跟踪滤波方法 Download PDFInfo
- Publication number
- CN106874701A CN106874701A CN201710231054.2A CN201710231054A CN106874701A CN 106874701 A CN106874701 A CN 106874701A CN 201710231054 A CN201710231054 A CN 201710231054A CN 106874701 A CN106874701 A CN 106874701A
- Authority
- CN
- China
- Prior art keywords
- model
- time
- order
- sequence
- covariance
- 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.)
- Granted
Links
- 238000000034 method Methods 0.000 title claims abstract description 64
- 238000001914 filtration Methods 0.000 title claims abstract description 48
- 239000013598 vector Substances 0.000 claims abstract description 48
- 230000007704 transition Effects 0.000 claims abstract description 12
- 239000011159 matrix material Substances 0.000 claims description 22
- 230000008569 process Effects 0.000 claims description 19
- 238000004364 calculation method Methods 0.000 claims description 14
- 239000000203 mixture Substances 0.000 claims description 3
- 238000005070 sampling Methods 0.000 claims description 3
- 239000000470 constituent Substances 0.000 claims description 2
- 230000002452 interceptive effect Effects 0.000 description 10
- 238000004088 simulation Methods 0.000 description 6
- 238000000342 Monte Carlo simulation Methods 0.000 description 5
- 230000003044 adaptive effect Effects 0.000 description 2
- 230000007423 decrease Effects 0.000 description 2
- RAFGELQLHMBRHD-VFYVRILKSA-N Bixin Natural products COC(=O)C=CC(=C/C=C/C(=C/C=C/C=C(C)/C=C/C=C(C)/C=C/C(=O)O)/C)C RAFGELQLHMBRHD-VFYVRILKSA-N 0.000 description 1
- RAFGELQLHMBRHD-UHFFFAOYSA-N alpha-Fuc-(1-2)-beta-Gal-(1-3)-(beta-GlcNAc-(1-6))-GalNAc-ol Natural products COC(=O)C=CC(C)=CC=CC(C)=CC=CC=C(C)C=CC=C(C)C=CC(O)=O RAFGELQLHMBRHD-UHFFFAOYSA-N 0.000 description 1
- 239000001670 anatto Substances 0.000 description 1
- 235000012665 annatto Nutrition 0.000 description 1
- 230000009286 beneficial effect Effects 0.000 description 1
- RAFGELQLHMBRHD-SLEZCNMESA-N bixin Chemical compound COC(=O)\C=C\C(\C)=C/C=C/C(/C)=C/C=C/C=C(\C)/C=C/C=C(\C)/C=C/C(O)=O RAFGELQLHMBRHD-SLEZCNMESA-N 0.000 description 1
- 238000004422 calculation algorithm Methods 0.000 description 1
- 230000006872 improvement Effects 0.000 description 1
Classifications
-
- G—PHYSICS
- G16—INFORMATION AND COMMUNICATION TECHNOLOGY [ICT] SPECIALLY ADAPTED FOR SPECIFIC APPLICATION FIELDS
- G16Z—INFORMATION AND COMMUNICATION TECHNOLOGY [ICT] SPECIALLY ADAPTED FOR SPECIFIC APPLICATION FIELDS, NOT OTHERWISE PROVIDED FOR
- G16Z99/00—Subject matter not provided for in other main groups of this subclass
Landscapes
- Radar Systems Or Details Thereof (AREA)
Abstract
一种基于模型切换次数受限的多模型机动目标跟踪滤波方法,涉及机动目标跟踪领域,具体涉及一种多模型的机动目标跟踪滤波方法。本发明为了解决现有多模型滤波不能描述高阶模型切换先验信息的问题以及在保证较高滤波精度时存在计算量大的问题。本发明首先对2阶模型序列中的模型进行建模,并基于跳变次数受限的假设设置2阶模型序列的转移概率pijl,然后初始化k为1、2时估计状态向量和相对应的协方差及2阶模型序列概率,然后对k≥3时的状态用模型切换次数受限的多模型机动目标跟踪滤波方法进行滤波。本发明适用于模型切换次数受限的多模型机动目标跟踪滤波。
Description
技术领域
本发明涉及机动目标跟踪领域,具体涉及一种多模型的机动目标跟踪滤波方法。
背景技术
在目标跟踪的模型不确定问题中,H.A.P.Blom,Y.Bar-Shalom.“The interactingmultiple model algorithm for systems with Markovian switching coefficients,”IEEE Transactions on Automatic Control,vol.33(8),pp.780-783,1988提出了经典的交互式多模型滤波方法。该经典方法使用模型转移概率来自动识别当前使用的模型,进行模型切换,从而实现在多模型下的自适应滤波估计。但缺点是估计精度不是很高,且依赖于模型转移概率的设置。当模型不变转移概率的值设置很大时,虽然在模型不变区域误差会减少,但同时却会增大模型切换区域的误差,并且从模型切换区域到模型不变区域的误差收敛速度会减慢。
改进的方法如P.Suchomski,“High-order interacting multiple-modelestimation for hybrid systems with Markovian switching parameters,”International Journal of Systems Science,vol.32(5),pp.669-679,2001中提出的广义高阶多模型滤波方法,虽然利用高阶模型序列能提高估计精度,但却以增加大量计算为代价。
毕欣,杜劲松,王伟,高洁,田星,赵越南,赵乾,丛日刚,仝盼盼,李想,张清石,徐洪庆,高扬等人的“一种基于自适应转移概率矩阵的交互多模型跟踪方法(申请号:CN201410715327.7)”和周卫东,蔡佳楠,孙龙,沈忱,郑兰等人的“一种具有最优运动模式切换参数的交互式多模型目标跟踪方法(申请号:CN201410234810.3)”的专利都对交互式多模型方法进行了改进,通过对一阶模型转移概率进行修正,进一步提高滤波精度,但这些方法并没有利用更多的先验信息,估计精度有待进一步改进。
因此,仍需要一种更好的多模型滤波方法,通过利用更多的先验信息,使得既有很高的滤波精度,同时又保持计算量小的特点。
发明内容
本发明为了解决现有多模型滤波不能描述高阶模型切换先验信息的问题以及在保证较高滤波精度时存在计算量大的问题。
一种基于模型切换次数受限的多模型机动目标跟踪滤波方法,包括:
步骤1:对机动目标的2阶模型序列中的模型mi、mj、ml进行建模,并基于跳变次数受限的假设,设置2阶模型序列的转移概率pijl,表示从模型序列mimj跳变到模型ml的概率;i、j、l分别为用于区别模型mi、mj、ml的序号;设模型个数为r,则i,j,l的取值范围为1~r;
其中,Pmax是预先设定的一个值,理论上取值范围为0~1,在本发明中,该值设得很大,远大于现有方法中常用的0.98等值,本发明Pmax取值范围为[0.99,1),Pmax典型取值为0.99~0.9999,基于0.99~0.9999能使模型不变段的滤波精度极限接近无模型不确定性问题时的滤波精度;
步骤2:分以下三种情况对k时刻的估计状态向量和相对应的协方差为进行实时处理;
(1)当k=1时,转步骤3;
(2)当k=2时,转步骤4;
(3)当k≥3时,转步骤5;
步骤3:对k=1时的估计状态向量和相对应的协方差为初始化
其中,zk=[xk yk]T表示k时刻接收到的雷达观测数据,xk表示k时刻x轴位置,yk表示k时刻y轴位置,zk(q′)表示zk的第q′个值;ri′j′是观测噪声协方差R的第i′行第j′列元素,即
转步骤2等待接收k=k+1时刻的雷达观测数据并继续处理;
步骤4:对k=2时的估计状态向量和相对应的协方差为初始化
再初始化k-1时刻模型为mi、k时刻模型为mj时的2阶模型序列概率r表示模型个数,r与ri′j′表示不同参数;
令2阶模型序列估计状态向量和与相对应的协方差
转步骤2等待接收k=k+1时刻的雷达观测数据并继续处理;
步骤5:对k≥3时的状态进行如下处理:
步骤5.1:计算混合概率
当l=j时,则i的取值范围是1,2,...,r,
其中,为k-1时刻的2阶模型序列概率;Cjj为归一化参数,Cjj对应的第一个j代表k-1时刻的模型为mj,第二个j代表k时刻的模型为mj;
当l≠j时,则i=j,
其中,Cjl分别为归一化参数,
在跳变受限的条件下,l≠j、i≠j的情况不存在,不参与滤波计算;本发明是基于模型切换次数受限的情况,所以模型连续切换的概率设置为零,不参与滤波计算,减少了计算量;
步骤5.2:计算2阶模型序列混合状态向量及其协方差
当l=j时
当l≠j时
为2阶模型序列估计状态向量,多个2阶模型序列估计状态向量构成估计状态向量只有在k=2时才令2阶模型序列估计状态向量
步骤5.3:将和作为输入对模型ml进行卡尔曼滤波,计算k时刻和似然函数
步骤5.4:计算k时刻的2阶模型序列概率
步骤5.5:计算k时刻的估计状态向量及其协方差
转步骤2等待接收k=k+1时刻的雷达观测数据并继续处理。
优选地,步骤5.3所述卡尔曼滤波的具体步骤包括以下步骤:
计算2阶模型序列的估计状态向量的一步预测值
其中,Fk-1(ml)是在k-1时刻模型ml下的系统转移矩阵,Gk-1(ml)是在k-1时刻模型ml的输入控制矩阵,uk-1(ml)是在k-1时刻模型ml的信号输入;下角标为k|k或者k-1|k-1表示估计状态向量,而下角标k|k-1表示对估计状态向量的一步预测;
计算与相对应的协方差的一步预测值
其中,Γk-1(ml)是噪声系数矩阵;Qk-1(ml)是过程噪声协方差;
计算2阶模型序列的观测预测值
其中,Hk是观测矩阵;
计算2阶模型序列的新息
其中新息与零均值白色高斯过程噪声vk-1(ml)为不同参数;
计算2阶模型序列的新息协方差
计算2阶模型序列的似然函数
其中,表示zk服从均值为协方差为的高斯分布;
计算2阶模型序列的增益
计算2阶模型序列的估计状态向量
计算相对应的协方差
本发明具有以下有益效果:
为了提高目标跟踪时的滤波精度,本发明利用目标不会时刻发生模型切换的先验信息,提出一种基于模型切换次数受限的多模型机动目标跟踪滤波方法(SC-IMM)。本发明假设连续3个时刻内最多只发生一次模型切换,舍去了在该假设下不可能产生的模型序列;同时在此假设基础上设计一个合适的模型序列转移概率,把不发生切换的模型序列转移概率值设得很大。因此,本发明极大地减小了估计误差和收敛区域,在获得更高滤波精度的同时又保留较小的计算量。
与经典的交互式多模型滤波方法(IMM方法)相比,本发明不仅在模型不变区域精度极大提高,同时在模型切换区域估计误差迅速降低,有极小的收敛区,精度提高20%~27%左右;相比于广义2阶交互式多模型方法(IMM2),本发明的精度提高18%左右,同时减少计算时间约6%。
附图说明
图1为500次蒙特卡洛仿真下的IMM、IMM2和SC-IMM三种方法的位置均方根误差对比图;
图2为500次蒙特卡洛仿真下的IMM、IMM2和SC-IMM三种方法的速度均方根误差对比图。
具体实施方式
具体实施方式一:
一种基于模型切换次数受限的多模型机动目标跟踪滤波方法,包括:
步骤1:将机动目标的三个时刻的状态作为2阶模型序列中的模型mi、mj、ml,对机动目标的2阶模型序列中的模型mi、mj、ml进行建模,并基于跳变次数受限的假设,设置2阶模型序列的转移概率pijl,表示从模型序列mimj跳变到模型ml的概率;i、j、l分别为用于区别模型mi、mj、ml的序号;设模型个数为r,则i,j,l的取值范围为1~r;
其中,Pmax是预先设定的一个值,理论上取值范围为0~1,在本发明中,该值设得很大,远大于现有方法中常用的0.98等值,本发明Pmax取值范围为[0.99,1);
步骤2:分以下三种情况对k时刻的估计状态向量和相对应的协方差为进行实时处理;
(1)当k=1时,转步骤3;
(2)当k=2时,转步骤4;
(3)当k≥3时,转步骤5;
步骤3:对k=1时的估计状态向量和相对应的协方差为初始化
其中,zk=[xk yk]T表示k时刻接收到的雷达观测数据,xk表示k时刻x轴位置,yk表示k时刻y轴位置,zk(q′)表示zk的第q′个值;ri′j′是观测噪声协方差R的第i′行第j′列元素,即
转步骤2等待接收k=k+1时刻的雷达观测数据并继续处理;
步骤4:对k=2时的估计状态向量和相对应的协方差为初始化
再初始化k-1时刻模型为mi、k时刻模型为mj时的2阶模型序列概率r表示模型个数,r与ri′j′表示不同参数;
令2阶模型序列估计状态向量和与相对应的协方差
转步骤2等待接收k=k+1时刻的雷达观测数据并继续处理;
步骤5:对k≥3时的状态进行如下处理:
步骤5.1:计算混合概率
当l=j时,则i的取值范围是1,2,...,r,
其中,为k-1时刻的2阶模型序列概率;Cjj为归一化参数,Cjj对应的第一个j代表k-1时刻的模型为mj,第二个j代表k时刻的模型为mj;
当l≠j时,则i=j,
其中,Cjl分别为归一化参数,
在跳变受限的条件下,l≠j、i≠j的情况不存在,不参与滤波计算;本发明的核心是基于模型切换次数受限的情况,所以模型连续切换的概率设置为零,不参与滤波计算,减少了计算量;
步骤5.2:计算2阶模型序列混合状态向量及其协方差
当l=j时
当l≠j时
为2阶模型序列估计状态向量,多个2阶模型序列估计状态向量构成估计状态向量只有在k=2时才令2阶模型序列估计状态向量
步骤5.3:将和作为输入对模型ml进行卡尔曼滤波,计算k时刻和似然函数
步骤5.4:计算k时刻的2阶模型序列概率
步骤5.5:计算k时刻的估计状态向量及其协方差
转步骤2等待接收k=k+1时刻的雷达观测数据并继续处理。
具体实施方式二:
本实施方式Pmax典型取值为0.99~0.9999。
其他步骤和参数与具体实施方式一相同。
具体实施方式三:
本实施方式步骤1所述的对机动目标的2阶模型序列中的模型mi、mj、ml进行建模的过程包括以下步骤:
模型mi、mj、ml具体的建模过程相同,以模型ml为例进行建模,建模方程为:
Xk=Fk-1(ml)Xk-1+Gk-1(ml)uk-1(ml)+Γk-1(ml)vk-1(ml)
其中,Xk是由k时刻x轴位置xk,x轴速度y轴位置yk,y轴速度组成的状态向量,即Fk-1(ml)是在k-1时刻模型ml下的系统转移矩阵,Gk-1(ml)是在k-1时刻模型ml的输入控制矩阵,uk-1(ml)是在k-1时刻模型ml的信号输入,Γk-1(ml)是噪声系数矩阵,vk-1(ml)是在k-1时刻模型ml下的零均值白色高斯过程噪声,vk-1(ml)的协方差为Qk-1(ml)。
其他步骤和参数与具体实施方式一或二相同。
具体实施方式四:
本实施方式步骤1中所述的模型ml的建模方程中
其中,T表示采样间隔。
其他步骤和参数与具体实施方式三相同。
具体实施方式五:
本实施方式步骤1中所述的模型ml的建模方程中Fk-1(ml)和uk-1(ml)的确定过程包括以下步骤:
(1)当模型为匀速运动模型时
(2)当模型协同转弯模型时
其中,ω为角速度;
(3)当模型匀加速运动模型时
其中,ax,ay分别是x轴,y轴方向的加速度。
以上列举的三种是在机动目标跟踪中最常用的三种模型,但仅仅作为范例,在实际场景中还可以有其他的模型情况。
其他步骤和参数与具体实施方式四相同。
具体实施方式六:
本实施方式步骤5.3所述卡尔曼滤波的具体步骤包括以下步骤:
计算2阶模型序列的估计状态向量的一步预测值
其中,Fk-1(ml)是在k-1时刻模型ml下的系统转移矩阵,Gk-1(ml)是在k-1时刻模型ml的输入控制矩阵,uk-1(ml)是在k-1时刻模型ml的信号输入;下角标为k|k或者k-1|k-1表示估计状态向量,而下角标k|k-1表示对估计状态向量的一步预测;
计算与相对应的协方差的一步预测值
其中,Γk-1(ml)是噪声系数矩阵;Qk-1(ml)是过程噪声协方差;
计算2阶模型序列的观测预测值
其中,Hk是观测矩阵;
计算2阶模型序列的新息
其中新息与零均值白色高斯过程噪声vk-1(ml)为不同参数;
计算2阶模型序列的新息协方差
计算2阶模型序列的似然函数
其中,表示zk服从均值为协方差为的高斯分布;
计算2阶模型序列的增益
计算2阶模型序列的估计状态向量
计算相对应的协方差
其他步骤和参数与具体实施方式一至五之一相同。
实施例
按照本发明的发明步骤进行仿真实验,同时将本发明(SC-IMM)与交互式多模型滤波方法(IMM方法)和广义2阶交互式多模型滤波方法(IMM2)进行对比实验。
在500次蒙特卡洛仿真下的本发明仿真过程:
实验仿真为:
使用卡尔曼线性滤波模型,观测方程为:
zk=HkXk+wk
其中,wk是观测噪声,其协方差为R。
在该仿真场景中,一共使用匀速直线运动和坐标转弯运动这两种模型。具体仿真场景是:机动目标先以X1=[1000,50,1000,50]T的初始状态做匀速运动飞行40s,然后在40-80s的时候以wk=3rad/s转弯运动,最后40s继续做匀速运动。其中,R=1Im2。采样间隔T=1s。
模型切换次数受限的交互式多模型滤波方法的步骤为:
步骤1:基于跳变次数受限的假设,设置2阶模型序列的转移概率pijl
步骤2:分以下三种情况对k时刻的估计状态向量和相对应的协方差为进行实时处理;
(1)当k=1时,转步骤3;
(2)当k=2时,转步骤4;
(3)当k≥3时,转步骤5。
步骤3:对k=1时的估计状态向量和相对应的协方差为初始化
转步骤2等待接收k=k+1时刻的雷达观测数据并继续处理。
步骤4:对k=2时的估计状态向量和相对应的协方差为初始化
再初始化k-1时刻模型为mi,k时刻模型为mj的2阶模型序列概率
2阶模型序列状态估计值和与相对应的协方差
转步骤2等待接收k=k+1时刻的雷达观测数据并继续处理。
步骤5:对k≥3时的状态用模型切换次数受限的多模型机动目标跟踪滤波方法,具体过程为:
步骤5.1、计算混合概率
其中
步骤5.2、计算2阶模型序列混合状态向量及其协方差
其中,[·]T矩阵中的·表示前面的矩阵中的内容;例如中的[·]T表示
步骤5.3、把和作为输入,对模型ml进行卡尔曼滤波,计算k时刻 和似然函数
所述卡尔曼滤波的具体步骤包括以下步骤:
计算2阶模型序列的估计状态向量的一步预测值
下角标为k|k或者k-1|k-1表示估计状态向量,而下角标k|k-1表示对估计状态向量的一步预测;
计算与相对应的协方差的一步预测值
计算2阶模型序列的观测预测值
其中,Hk是观测矩阵;
计算2阶模型序列的新息
其中新息与k-1时刻模型ml下的零均值白色高斯过程噪声vk-1(ml)表示不同参数;
计算2阶模型序列的新息协方差
计算2阶模型序列的似然函数
其中,表示zk服从均值为协方差为的高斯分布;计算2阶模型序列的增益
计算2阶模型序列的估计状态向量
计算相对应的协方差
步骤5.4、计算k时刻的2阶模型序列概率
步骤5.5、计算k时刻的估计状态向量及其协方差
转步骤2等待处理下一k=k+1时刻的雷达观测数据。
仿真结果数据如表1和表2所示
表1三种方法平均均方误差对比数据
表2三种方法运行时间对比数据
同时,500次蒙特卡洛仿真下的IMM、IMM2和SC-IMM三种方法的位置均方根误差对比图如图1所示,500次蒙特卡洛仿真下的IMM、IMM2和SC-IMM三种方法的速度均方根误差对比图如图2所示。
从图1和图2中可以看出,三种方法的尖峰误差差不多,但是SC-IMM在跳变点之后误差迅速降低,收敛区域十分窄小,且在模型不变区域的误差最小。从表1中可以看出SC-IMM的整个过程平均均方根误差值最小,IMM2次之,IMM误差最大。
从表2中可以看出,IMM2运行时间最多,SC-IMM次之,而IMM运行时间最小。
综合分析可得,SC-IMM与IMM相比,虽然牺牲了少量额外的计算时间,但是所获得的精度有很大的提高。且SC-IMM与同阶的IMM2相比,不仅精度有所提高,而且所需的时间减少了。
Claims (6)
1.一种基于模型切换次数受限的多模型机动目标跟踪滤波方法,其特征在于,包括:
步骤1:对机动目标的2阶模型序列中的模型mi、mj、ml进行建模,并基于跳变次数受限的假设,设置2阶模型序列的转移概率pijl,表示从模型序列mimj跳变到模型ml的概率;i、j、l分别为用于区别模型mi、mj、ml的序号;设模型个数为r,则i,j,l的取值范围为1~r;
其中,Pmax是预先设定的一个值,Pmax取值范围为[0.99,1);
步骤2:分以下三种情况对k时刻的估计状态向量和相对应的协方差为进行实时处理;
(1)当k=1时,转步骤3;
(2)当k=2时,转步骤4;
(3)当k≥3时,转步骤5;
步骤3:对k=1时的估计状态向量和相对应的协方差为初始化
其中,zk=[xk yk]T表示k时刻接收到的雷达观测数据,xk表示k时刻x轴位置,yk表示k时刻y轴位置,zk(q′)表示zk的第q′个值;ri′j′是观测噪声协方差R的第i′行第j′列元素,即
转步骤2等待接收k=k+1时刻的雷达观测数据并继续处理;
步骤4:对k=2时的估计状态向量和相对应的协方差为初始化
再初始化k-1时刻模型为mi、k时刻模型为mj时的2阶模型序列概率
令2阶模型序列估计状态向量和与相对应的协方差
转步骤2等待接收k=k+1时刻的雷达观测数据并继续处理;
步骤5:对k≥3时的状态进行如下处理:
步骤5.1:计算混合概率
当l=j时,则i的取值范围是1,2,...,r,
其中,为k-1时刻的2阶模型序列概率;Cjj为归一化参数,
当l≠j时,则i=j,
其中,Cjl分别为归一化参数,
在跳变受限的条件下,l≠j、i≠j的情况不存在,不参与滤波计算;
步骤5.2:计算2阶模型序列混合状态向量及其协方差
当l=j时
当l≠j时
步骤5.3:将和作为输入对模型ml进行卡尔曼滤波,计算k时刻和似然函数
步骤5.4:计算k时刻的2阶模型序列概率
步骤5.5:计算k时刻的估计状态向量及其协方差
转步骤2等待接收k=k+1时刻的雷达观测数据并继续处理。
2.根据权利要求1所述的一种基于模型切换次数受限的多模型机动目标跟踪滤波方法,其特征在于,Pmax取值为0.99~0.9999。
3.根据权利要求2所述的一种基于模型切换次数受限的多模型机动目标跟踪滤波方法,其特征在于,步骤1所述的对机动目标的2阶模型序列中的模型mi、mj、ml进行建模的过程包括以下步骤:
模型mi、mj、ml具体的建模过程相同,以模型ml为例进行建模,建模方程为:
Xk=Fk-1(ml)Xk-1+Gk-1(ml)uk-1(ml)+Γk-1(ml)vk-1(ml)
其中,Xk是由k时刻x轴位置xk,x轴速度y轴位置yk,y轴速度组成的状态向量;Fk-1(ml)是在k-1时刻模型ml下的系统转移矩阵,Gk-1(ml)是在k-1时刻模型ml的输入控制矩阵,uk-1(ml)是在k-1时刻模型ml的信号输入,Γk-1(ml)是噪声系数矩阵,vk-1(ml)是在k-1时刻模型ml下的零均值白色高斯过程噪声,vk-1(ml)的协方差为Qk-1(ml)。
4.根据权利要求3所述的一种基于模型切换次数受限的多模型机动目标跟踪滤波方法,其特征在于,步骤1中所述的模型ml的建模方程中
其中,T表示采样间隔。
5.根据权利要求4所述的一种基于模型切换次数受限的多模型机动目标跟踪滤波方法,其特征在于,步骤1中所述的模型ml的建模方程中Fk-1(ml)和uk-1(ml)的确定过程包括以下步骤:
(1)当模型为匀速运动模型时
(2)当模型协同转弯模型时
其中,ω为角速度;
(3)当模型匀加速运动模型时
其中,ax,ay分别是x轴,y轴方向的加速度。
6.根据权利要求1至5之一所述的一种基于模型切换次数受限的多模型机动目标跟踪滤波方法,其特征在于,步骤5.3所述卡尔曼滤波的具体步骤包括以下步骤:
计算2阶模型序列的估计状态向量的一步预测值
其中,Fk-1(ml)是在k-1时刻模型ml下的系统转移矩阵,Gk-1(ml)是在k-1时刻模型ml的输入控制矩阵,uk-1(ml)是在k-1时刻模型ml的信号输入;
计算与相对应的协方差的一步预测值
其中,Γk-1(ml)是噪声系数矩阵;Qk-1(ml)是过程噪声协方差;
计算2阶模型序列的观测预测值
其中,Hk是观测矩阵;
计算2阶模型序列的新息
计算2阶模型序列的新息协方差
计算2阶模型序列的似然函数
其中,表示zk服从均值为协方差为的高斯分布;
计算2阶模型序列的增益
计算2阶模型序列的估计状态向量
计算相对应的协方差
Priority Applications (1)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
CN201710231054.2A CN106874701B (zh) | 2017-04-10 | 2017-04-10 | 一种基于模型切换次数受限的多模型机动目标跟踪滤波方法 |
Applications Claiming Priority (1)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
CN201710231054.2A CN106874701B (zh) | 2017-04-10 | 2017-04-10 | 一种基于模型切换次数受限的多模型机动目标跟踪滤波方法 |
Publications (2)
Publication Number | Publication Date |
---|---|
CN106874701A true CN106874701A (zh) | 2017-06-20 |
CN106874701B CN106874701B (zh) | 2019-01-08 |
Family
ID=59162947
Family Applications (1)
Application Number | Title | Priority Date | Filing Date |
---|---|---|---|
CN201710231054.2A Active CN106874701B (zh) | 2017-04-10 | 2017-04-10 | 一种基于模型切换次数受限的多模型机动目标跟踪滤波方法 |
Country Status (1)
Country | Link |
---|---|
CN (1) | CN106874701B (zh) |
Cited By (1)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
CN117406589A (zh) * | 2023-10-08 | 2024-01-16 | 哈尔滨工业大学 | 一种针对模型未知的机动目标交互式平滑变结构滤波方法 |
Citations (12)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
CN102622520A (zh) * | 2012-03-14 | 2012-08-01 | 北京航空航天大学 | 一种机动目标跟踪的分布式多模型估计融合方法 |
CN102663771A (zh) * | 2012-03-14 | 2012-09-12 | 北京航空航天大学 | 一种基于协方差交叉的交互式多模型估计方法 |
CN103605886A (zh) * | 2013-11-12 | 2014-02-26 | 中交天津航道局有限公司 | 一种船舶动力定位系统多模型自适应融合滤波方法 |
CN104020466A (zh) * | 2014-06-17 | 2014-09-03 | 西安电子科技大学 | 基于变结构多模型的机动目标跟踪方法 |
CN104021285A (zh) * | 2014-05-30 | 2014-09-03 | 哈尔滨工程大学 | 一种具有最优运动模式切换参数的交互式多模型目标跟踪方法 |
CN104331623A (zh) * | 2014-11-06 | 2015-02-04 | 西北工业大学 | 一种机动策略自适应的目标跟踪信息滤波算法 |
CN104408744A (zh) * | 2014-11-17 | 2015-03-11 | 电子科技大学 | 一种用于目标跟踪的强跟踪容积卡尔曼滤波方法 |
CN104880707A (zh) * | 2014-11-30 | 2015-09-02 | 中国科学院沈阳自动化研究所 | 一种基于自适应转移概率矩阵的交互多模型跟踪方法 |
US20160054430A1 (en) * | 2014-08-25 | 2016-02-25 | Princeton Satellite Systems, Inc. | Multi-sensor target tracking using multiple hypothesis testing |
CN105785359A (zh) * | 2016-05-19 | 2016-07-20 | 哈尔滨工业大学 | 一种多约束机动目标跟踪方法 |
CN105929391A (zh) * | 2016-04-24 | 2016-09-07 | 西安电子科技大学 | 基于后验概率的变结构交互多模型雷达机动目标跟踪方法 |
CN106443661A (zh) * | 2016-09-08 | 2017-02-22 | 河南科技大学 | 基于无迹卡尔曼滤波的机动扩展目标跟踪方法 |
-
2017
- 2017-04-10 CN CN201710231054.2A patent/CN106874701B/zh active Active
Patent Citations (12)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
CN102622520A (zh) * | 2012-03-14 | 2012-08-01 | 北京航空航天大学 | 一种机动目标跟踪的分布式多模型估计融合方法 |
CN102663771A (zh) * | 2012-03-14 | 2012-09-12 | 北京航空航天大学 | 一种基于协方差交叉的交互式多模型估计方法 |
CN103605886A (zh) * | 2013-11-12 | 2014-02-26 | 中交天津航道局有限公司 | 一种船舶动力定位系统多模型自适应融合滤波方法 |
CN104021285A (zh) * | 2014-05-30 | 2014-09-03 | 哈尔滨工程大学 | 一种具有最优运动模式切换参数的交互式多模型目标跟踪方法 |
CN104020466A (zh) * | 2014-06-17 | 2014-09-03 | 西安电子科技大学 | 基于变结构多模型的机动目标跟踪方法 |
US20160054430A1 (en) * | 2014-08-25 | 2016-02-25 | Princeton Satellite Systems, Inc. | Multi-sensor target tracking using multiple hypothesis testing |
CN104331623A (zh) * | 2014-11-06 | 2015-02-04 | 西北工业大学 | 一种机动策略自适应的目标跟踪信息滤波算法 |
CN104408744A (zh) * | 2014-11-17 | 2015-03-11 | 电子科技大学 | 一种用于目标跟踪的强跟踪容积卡尔曼滤波方法 |
CN104880707A (zh) * | 2014-11-30 | 2015-09-02 | 中国科学院沈阳自动化研究所 | 一种基于自适应转移概率矩阵的交互多模型跟踪方法 |
CN105929391A (zh) * | 2016-04-24 | 2016-09-07 | 西安电子科技大学 | 基于后验概率的变结构交互多模型雷达机动目标跟踪方法 |
CN105785359A (zh) * | 2016-05-19 | 2016-07-20 | 哈尔滨工业大学 | 一种多约束机动目标跟踪方法 |
CN106443661A (zh) * | 2016-09-08 | 2017-02-22 | 河南科技大学 | 基于无迹卡尔曼滤波的机动扩展目标跟踪方法 |
Non-Patent Citations (3)
Title |
---|
JIAN LAN 等: "Second-Order Markov Chain Based Multiple-Model Algorithm for Maneuvering Target Tracking", 《IEEE TRANSACTIONS ON AEROSPACE & ELECTRONIC SYSTEMS》 * |
石章松 等: "单站纯方位目标多模型卡尔曼滤波跟踪算法的研究", 《系统仿真学报》 * |
范小军 等: "一种新的机动目标跟踪的多模型算法", 《电子与信息学报》 * |
Cited By (1)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
CN117406589A (zh) * | 2023-10-08 | 2024-01-16 | 哈尔滨工业大学 | 一种针对模型未知的机动目标交互式平滑变结构滤波方法 |
Also Published As
Publication number | Publication date |
---|---|
CN106874701B (zh) | 2019-01-08 |
Similar Documents
Publication | Publication Date | Title |
---|---|---|
CN106933106B (zh) | 一种基于模糊控制多模型算法的目标跟踪方法 | |
Li et al. | Approximate Gaussian conjugacy: parametric recursive filtering under nonlinearity, multimodality, uncertainty, and constraint, and beyond | |
CN111985093A (zh) | 一种带噪声估计器的自适应无迹卡尔曼滤波状态估计方法 | |
CN106487358B (zh) | 一种机动目标转弯跟踪方法 | |
Molloy et al. | Inverse open-loop noncooperative differential games and inverse optimal control | |
CN108682023A (zh) | 基于Elman神经网络的紧耦合无迹卡尔曼跟踪滤波算法 | |
CN109284677B (zh) | 一种贝叶斯滤波目标跟踪算法 | |
CN104793201B (zh) | 一种跟踪临近空间高超声速目标的修正变结构网格交互多模型滤波方法 | |
CN106054170A (zh) | 一种约束条件下的机动目标跟踪方法 | |
CN104408744A (zh) | 一种用于目标跟踪的强跟踪容积卡尔曼滤波方法 | |
CN106767780A (zh) | 基于Chebyshev多项式插值逼近的扩展椭球集员滤波方法 | |
CN104182609B (zh) | 基于去相关的无偏转换量测的三维目标跟踪方法 | |
CN107229060A (zh) | 一种基于自适应滤波的gps测量数据处理方法 | |
CN107015945B (zh) | 一种基于目标运动模式混合转移分布高阶交互式多模型滤波方法 | |
CN109687844A (zh) | 一种智能机动目标跟踪方法 | |
CN107452017A (zh) | 一种基于期望最大化算法的机动目标跟踪方法 | |
CN106874701B (zh) | 一种基于模型切换次数受限的多模型机动目标跟踪滤波方法 | |
CN107391446A (zh) | 基于随机矩阵的不规则形状多扩展目标形状和状态估计方法 | |
Deng et al. | Data-efficient Gaussian process online learning for adaptive control of multi-DoF robotic arms | |
CN108681621B (zh) | 基于Chebyshev正交多项式扩展RTS Kalman平滑方法 | |
CN106845016B (zh) | 一种基于事件驱动的量测调度方法 | |
CN113190960B (zh) | 一种基于非等维状态混合估计的并行imm机动目标跟踪方法 | |
CN114594785B (zh) | 基于混合整数二阶锥优化的无人机避障实时轨迹规划方法 | |
Havangi et al. | A novel adaptive neuro-fuzzy unscented Kalman filter for SLAM | |
Yunhong et al. | Maneuvering target tracking based on adaptive turning rate interactive multiple model |
Legal Events
Date | Code | Title | Description |
---|---|---|---|
PB01 | Publication | ||
PB01 | Publication | ||
SE01 | Entry into force of request for substantive examination | ||
SE01 | Entry into force of request for substantive examination | ||
GR01 | Patent grant | ||
GR01 | Patent grant |