一种机动策略自适应的目标跟踪信息滤波方法技术

技术编号:11012677 阅读:98 留言:0更新日期:2015-02-05 18:22
本发明专利技术提供了一种机动策略自适应的目标跟踪信息滤波算法,首先建立多机动策略和多运动模式的目标跟踪模型,然后进行多机动策略多模型下的目标跟踪信息滤波算法,得到目标跟踪轨迹。本发明专利技术引入了机动决策的概念,建立了多机动策略、多运动模型的目标跟踪模型,并通过不匹配机动策略的误差压缩率,利用后验信息实时校正机动策略转移概率矩阵,显著提高目标跟踪过程中机动策略的匹配度,进而提高运动模型的匹配度。同时,通过结合自适应变结构模型和卡尔曼信息滤波,有效融合多传感器量测信息,显著提高目标跟踪精度和稳定度。

【技术实现步骤摘要】
一种机动策略自适应的目标跟踪信息滤波方法
本专利技术属于目标跟踪领域,涉及一种目标跟踪信息滤波算法。
技术介绍
随着经济的发展,人们对商用客机的使用需求显著提升,客机数量的提升对如何高效的进行空中交通管理提出了新的要求。同时,随着科技的进步,客机飞行速度的提升和其他民用飞行器的逐渐投入使用,对如何高效进行空中管理提出了挑战。高效空中管理的前提是获取各飞行器精确的运动状态信息,这要求滤波跟踪算法能有效地对各种不同类型目标进行高精度跟踪。但是目前一般的跟踪算法是基于卡尔曼滤波算法,主要存在以下几个问题:1.适合于弱机动能力单一运动方式的目标,对现在空域中具备不同机动能力的飞行器(客机、直升机、无人机等)显然不完全适用。2.随着传感器技术的发展,海量的传感器探测数据要求滤波算法能有效地融合各传感器的量测数据,但是一般的卡尔曼滤波算法不具备多量测信息融合的能力。
技术实现思路
为了克服现有技术在跟踪不同机动能力的飞行器时自适应能力较差,缺乏多量测信息融合能力的问题,提出一种机动策略自适应的目标跟踪信息滤波算法。本专利技术解决其技术问题所采用的技术方案包括以下步骤:步骤1:建立多机动策略和多运动模式的目标跟踪模型设目标共有m种可能的运动模型,m取1~3,则k时刻第i种运动模型的目标运动模型与观测模型为:式中,xk和Zk分别为状态向量和观测向量;为模型的噪声向量,为观测噪声向量,且与为相互独立不相关的零均值高斯白噪声,方差分别为和和分别为对应的状态转移矩阵、过程噪声输入阵和观测矩阵;用表示在机动策略d的作用下由转移到的模型转移概率,该机动策略对应的模型转移概率矩阵为:式中,d=1,2,…n表示目标有n种可能的机动策略,k-1时刻所有可能的模型转移概率矩阵的集合为用表示机动策略的转移概率,即由转变为的转移概率,Pdl为模型转移概率矩阵之间的转移概率,机动策略之间的转移概率矩阵为:步骤2:多机动策略多模型下的目标跟踪信息滤波算法设共有N个坐标雷达并行量测,即k时刻对目标的位置量测信息共有N组分别为:k-1时刻目标的运动模型和机动策略分别为和状态滤波值和协方差分别为与且已知和初值分别为和用表示目标初始时刻运动模型为Mi的概率,表示目标在初始时刻采用机动策略的概率;机动策略转移概率矩阵初值设为T0={Pij|i,j=1,2,…n};包含以下步骤:2.1机动策略与模型联合条件概率的混合估计运动模型j与机动策略l的联合概率预测值式中,为转变为的转移概率;表示k-1时刻采用机动策略d时对应的模型转移概率矩阵中位于第i行、第j列的项,即由转移到的概率;为k-1时刻目标的运动模型i和机动策略d的联合条件概率;运动模型j与机动策略l的联合条件概率的混合估计2.2滤波器混合初始条件计算机动策略l下运动模型j的初始状态混合估计式中,为k-1时刻机动策略d下运动模型i的滤波估计值;机动策略l下运动模型j初始状态混合估计的协方差式中,为k-1时刻机动策略d下运动模型i的滤波估计协方差;2.3利用卡尔曼信息滤波估计各机动策略及运动模型下的状态与协方差1).计算k时刻观测序列Zk对信息状态yk和Fisher信息Yk的贡献ik和Ik式中,和分别为第i个观测的量测矩阵和量测误差方差,为第i个观测序列;2).时间更新式中,分别为机动策略l下运动模型j的状态转移矩阵、观测矩阵和过程噪声方差;分别为机动策略l下运动模型j初始状态混合估计及估计协方差,分别为k时刻机动策略l下运动模型j的状态预测值和量测预测值,为状态预测协方差;3).卡尔曼增益及模型似然概率计算式中,分别为k时刻机动策略l下运动模型j的新息、新息协方差、卡尔曼滤波增益、模型似然概率;4).机动策略l与模型j的联合条件概率更新5).信息状态、Fisher信息更新6).滤波估计结果2.4输出综合2.5机动策略转移概率矩阵自适应调整将原机动策略转移概率矩阵T中各元素Pij做如下修正:即可得到自适应调整后的机动策略转移概率矩阵T'={Pij'|i,j=1…n};不断重复2.1~2.5,直到满足终止条件;步骤3:步骤2.4所得的终止时刻滤波结果输出即可得到终端滤波值,每一时刻的滤波估计结果为对应每一时刻目标运动的跟踪滤波值,以连续形式输出,即可得到目标跟踪轨迹。本专利技术的有益效果是:引入了机动决策的概念,建立了多机动策略、多运动模型的目标跟踪模型,并通过不匹配机动策略的误差压缩率,利用后验信息实时校正机动策略转移概率矩阵,显著提高目标跟踪过程中机动策略的匹配度,进而提高运动模型的匹配度。同时,通过结合自适应变结构模型和卡尔曼信息滤波,有效融合多传感器量测信息,显著提高目标跟踪精度和稳定度。附图说明图1是本专利技术实现方法流程图;图2是目标真实运动轨迹;图3是本专利技术方法与IMM、P-MmMs的跟踪轨迹及目标真实轨迹对比图;图4是本专利技术方法与IMM、P-MmMs在目标位置跟踪上的RMSE图;图5是本专利技术方法与IMM、P-MmMs在目标速度跟踪上的RMSE图;图中,IMM为标准交互多模型算法;P-MmMs为机动策略自适应的多模型多机动策略算法;IF-P-MmMs为本专利技术方法,即机动策略自适应的目标跟踪信息滤波算法。具体实施方式下面结合附图和实施例对本专利技术进一步说明,本专利技术包括但不仅限于下述实施例。一种机动策略自适应的目标跟踪信息滤波算法,其特征在于,引入机动决策和机动策略概率转移矩阵的概念,建立具有多种机动决策和多种运动模型的目标跟踪模型;同时,以各个机动策略的误差压缩率反映机动策略相对目标真实机动的匹配度,并由此利用后验信息在线调整机动策略概率转移矩阵;引入卡尔曼信息滤波算法实时融合多传感器量测信息。该算法包括以下步骤:步骤1:建立多机动策略和多运动模式的目标跟踪模型设目标共有m种可能的运动模型(m一般取1~3),则k时刻运动模型i(用表示)的目标运动模型与观测模型为:式中,xk和Zk分别为状态向量和观测向量;为模型的噪声向量,为观测噪声向量,且与为相互独立不相关的零均值高斯白噪声,方差分别为和和分别为对应的状态转移矩阵、过程噪声输入阵和观测矩阵。用表示在机动策略d的作用下,由转移到的模型转移概率,因此,该机动策略对应的模型转移概率矩阵为:式中,d=1,2,…n表示目标有n种可能的机动策略,n一般取2。于是,k-1时刻所有可能的模型转移概率矩阵的集合为:用表示机动策略的转移概率,即由转变为的转移概率(Pdl为模型转移概率矩阵之间的转移概率)。因此,机动策略之间的转移概率矩阵为:式(1)~(3)即组成了具有多种机动策略及多种运动模式的目标跟踪模型。步骤2:多机动策略多模型下的目标跟踪信息滤波算法设共有N个坐标雷达并行量测(N一般取2),即k时刻对目标的位置量测信息共有N组分别为:k-1时刻目标的运动模型和机动策略分别为和状态滤波值和协方差分别为与且已知和初值分别为和用表示目标初始时刻运动模型为Mi的概率,表示目标在初始时刻采用机动策略的概率。机动策略转移概率矩阵初值设为T0={Pij|i,j=1,2,…n}。由于目标采用何种运动模式和采用何种机动策略是相互独立的两个事件,因此认为目标在各时刻采用的机动策略只对其下一时刻将要采用的运动模式产生影响,且整体算法包含以下步骤:2.1机动策略与模型联合条件概率的混合估本文档来自技高网...
一种机动策略自适应的目标跟踪信息滤波方法

【技术保护点】
一种机动策略自适应的目标跟踪信息滤波算法,其特征在于包括下述步骤:步骤1:建立多机动策略和多运动模式的目标跟踪模型设目标共有m种可能的运动模型,m取1~3,则k时刻第i种运动模型的目标运动模型与观测模型为:xk=Fk-1ixk-1+Gk-1iξk-1iZk=Hkixk+ηki]]>i=1,2…m式中,xk和Zk分别为状态向量和观测向量;为模型的噪声向量,为观测噪声向量,且与为相互独立不相关的零均值高斯白噪声,方差分别为和和分别为对应的状态转移矩阵、过程噪声输入阵和观测矩阵;用表示在机动策略d的作用下由转移到的模型转移概率,该机动策略对应的模型转移概率矩阵为:式中,d=1,2,…n表示目标有n种可能的机动策略,k‑1时刻所有可能的模型转移概率矩阵的集合为用表示机动策略的转移概率,即由转变为的转移概率,Pdl为模型转移概率矩阵之间的转移概率,机动策略之间的转移概率矩阵为:步骤2:多机动策略多模型下的目标跟踪信息滤波算法设共有N个坐标雷达并行量测,即k时刻对目标的位置量测信息共有N组分别为:k‑1时刻目标的运动模型和机动策略分别为和状态滤波值和协方差分别为与且已知和初值分别为和用表示目标初始时刻运动模型为Mi的概率,表示目标在初始时刻采用机动策略的概率;机动策略转移概率矩阵初值设为T0={Pij|i,j=1,2,…n};μk-1id=P{Mk-1i,Ik-1d}=P{Mk-1i}·P{Ik-1d},μ0id=P{M0i}·P{I0d},]]>包含以下步骤:2.1机动策略与模型联合条件概率的混合估计运动模型j与机动策略l的联合概率预测值式中,为转变为的转移概率;表示k‑1时刻采用机动策略d时对应的模型转移概率矩阵中位于第i行、第j列的项,即由转移到的概率;为k‑1时刻目标的运动模型i和机动策略d的联合条件概率;运动模型j与机动策略l的联合条件概率的混合估计2.2滤波器混合初始条件计算机动策略l下运动模型j的初始状态混合估计x~k-1jl=E(x^k-1|Mkj,Ikl,Zk-1)=ΣiΣdx^k-1idμid|jl,]]>式中,为k‑1时刻机动策略d下运动模型i的滤波估计值;机动策略l下运动模型j初始状态混合估计的协方差P~k-1jl=ΣiΣd{Pk-1id+[x^k-1id-x~k-1jl]·[x^k-1id-x~k-1jl]T}x^k-1idμid|jl,]]>式中,为k‑1时刻机动策略d下运动模型i的滤波估计协方差;2.3利用卡尔曼信息滤波估计各机动策略及运动模型下的状态与协方差1).计算k时刻观测序列Zk对信息状态yk和Fisher信息Yk的贡献ik和Ikik=Σi=1N(Hki)T·(Rki)-1·ZkiIk=Σi=1N(Hki)T·(Rki)-1·Hki]]>式中,和分别为第i个观测的量测矩阵和量测误差方差,为第i个观测序列;2).时间更新xk|k-1jl=Fkjl·x~k-1jl]]>Pk|k-1jl=FkjlP~k-1jl(Fkjl)T+Qkjl]]>Zk|k-1jl=Hkjl·xk|k-1jl]]>式中,分别为机动策略l下运动模型j的状态转移矩阵、观测矩阵和过程噪声方差;分别为机动策略l下运动模型j初始状态混合估计及估计协方差,分别为k时刻机动策略l下运动模型j的状态预测值和量测预测值,为状态预测协方差;3).卡尔曼增益及模型似然概率计算vkjl=Zk-Zk|k-1jl]]>Skjl=HkjlPk|k-1jl(Hkjl)T+Rk]]>Kgkjl=Pk|k-1jl(Hkjl)T(Skjl)-1]]>Λkjl=exp[-0.5(vkjl)T(Skjl)-1vkjl]det(2πSkjl)]]>式中,分别为k时刻机动策略l下运动模型j的新息、新息协方差、卡尔曼滤波增益、模型似然概率;4).机动策略l与模型j的联合条件概率更新μkjl=P{Mkj,Ikl|Zk}=Λkjlμ^kjlΣjΣlΛkjlμ^jl;]]>5).信息状态、Fisher信息更新Yk|k-1jl=(Pk|k-1jl)-1yk|k-1jl=Yk|k-1jlxk|k-1jlYkjl=Yk|k-1jl+Ikykjl=yk|k-1jl+ik;]]>6).滤波估计结果x^kjl=(Ykjl)-1ykjlPkjl=(Ykjl)-1;]]>2.4输出综合x^k=ΣjΣlx^...

【技术特征摘要】
1.一种机动策略自适应的目标跟踪信息滤波方法,其特征在于包括下述步骤:步骤1:建立多机动策略和多运动模式的目标跟踪模型目标共有m种可能的运动模型,m取1~3,则k时刻第i种运动模型的目标运动模型与观测模型为:式中,xk和Zk分别为状态向量和观测向量;为模型的噪声向量,为观测噪声向量,且与为相互独立不相关的零均值高斯白噪声,方差分别为和和分别为对应的状态转移矩阵、过程噪声输入阵和观测矩阵;用表示在机动策略d的作用下由转移到的模型转移概率,该机动策略对应的模型转移概率矩阵为:式中,d=1,2,…n表示目标有n种可能的机动策略,k-1时刻所有可能的模型转移概率矩阵的集合为用表示机动策略的转移概率,即由转变为的转移概率,Pdl为模型转移概率矩阵之间的转移概率,机动策略之间的转移概率矩阵为:步骤2:多机动策略多模型下的目标跟踪信息滤波算法共有N个坐标雷达并行量测,即k时刻对目标的位置量测信息共有N组分别为:k-1时刻目标的运动模型和机动策略分别为和状态滤波值和协方差分别为与且已知和初值分别为和用表示目标初始时刻运动模型为的概率,表示目标在初始时刻采用机动策略的概率;机动策略转移概率矩阵初值设为T0={Pij|i,j=1,2,…n};包含以下步骤:2.1机动策略与模型联合条件概率的混合估计运动模型j与机动策略l的联合概率预测值式中,为转变为的转移概率;表示k-1时刻采用机动策略d时对应的模型转移概率矩阵中位于第i行、第j列的项,即由转移到的概率;为k-1时刻目标的运动模型i和机动策略d的联合条件概率;运动模型j与机动策略l的联合条件概率的混合估计2.2滤波器混合初始条件计算机动策略l下运动模型j的初始状态混合估计式中,为k-1时刻机动策略d下运动模型i的滤波估计值;机动策略l下运动模型j初始状态混合估计的协方差式中,为k-1时刻机动策略d下运动模型i的滤波估计协方差;2.3利用卡尔曼信息滤波估计各机动策略及运动模型下的状态与协方差1).计算k时刻观测序列Zk对信息状态yk和Fisher信息Yk的贡献ik和Ik式中,和分别为第i个观测的量测矩阵和量测误差方差,为第i个观测序列;2).时间更新

【专利技术属性】
技术研发人员:李莹周德云黄吉传
申请(专利权)人:西北工业大学
类型:发明
国别省市:陕西;61

网友询问留言 已有0条评论
  • 还没有人留言评论。发表了对其他浏览者有用的留言会获得科技券。

1