CN115128597B - 基于imm-stekf的非高斯噪声下机动目标跟踪方法 - Google Patents
基于imm-stekf的非高斯噪声下机动目标跟踪方法 Download PDFInfo
- Publication number
- CN115128597B CN115128597B CN202211024283.4A CN202211024283A CN115128597B CN 115128597 B CN115128597 B CN 115128597B CN 202211024283 A CN202211024283 A CN 202211024283A CN 115128597 B CN115128597 B CN 115128597B
- Authority
- CN
- China
- Prior art keywords
- model
- state
- maneuvering target
- matrix
- motion
- 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
Images
Classifications
-
- G—PHYSICS
- G01—MEASURING; TESTING
- G01S—RADIO DIRECTION-FINDING; RADIO NAVIGATION; DETERMINING DISTANCE OR VELOCITY BY USE OF RADIO WAVES; LOCATING OR PRESENCE-DETECTING BY USE OF THE REFLECTION OR RERADIATION OF RADIO WAVES; ANALOGOUS ARRANGEMENTS USING OTHER WAVES
- G01S13/00—Systems using the reflection or reradiation of radio waves, e.g. radar systems; Analogous systems using reflection or reradiation of waves whose nature or wavelength is irrelevant or unspecified
- G01S13/66—Radar-tracking systems; Analogous systems
- G01S13/72—Radar-tracking systems; Analogous systems for two-dimensional tracking, e.g. combination of angle and range tracking, track-while-scan radar
- G01S13/723—Radar-tracking systems; Analogous systems for two-dimensional tracking, e.g. combination of angle and range tracking, track-while-scan radar by using numerical data
- G01S13/726—Multiple target tracking
Abstract
本发明公开了一种基于IMM‑STEKF的非高斯噪声下机动目标跟踪方法,包括:获取机动目标的量测值;建立非高斯噪声条件下的目标状态方程和量测方程,构建包括多个运动模型的模型集,并对机动目标的状态估计值和精度矩阵分别进行交互混合,得到每个运动模型的混合状态输入值和混合精度矩阵;利用STEKF算法对每个运动模型的混合状态输入值和混合精度矩阵进行跟踪滤波处理;对模型集中的每个运动模型对应的概率进行更新;更新机动目标在当前时刻的状态估计值和精度矩阵。本发明提供的方法可以在非高斯噪声条件下实现对机动目标的实时精确跟踪。
Description
技术领域
本发明属于目标跟踪技术领域,具体涉及一种基于IMM-STEKF的非高斯噪声下机动目标跟踪方法。
背景技术
在雷达跟踪系统中,距离、方位角、俯仰角等量测信息通常是在球坐标系下获得的,而状态向量是在笛卡尔坐标系下,这就会导致雷达跟踪系统是非线性的。另外过程噪声和量测噪声的统计特性也是机动目标跟踪技术研究中比较重要的一部分。目前大多数的机动目标跟踪算法都是在假设噪声服从高斯分布的条件下进行的,但在雷达的实际探测过程中,环境扰动、传感器瞬时故障、飞行目标突发高机动、飞行目标不同位置的散射强度不同等因素都会使得过程噪声或量测噪声具有重尾特性,这样噪声不再服从高斯分布,如果仍然使用传统的假设噪声为高斯白噪声的机动目标跟踪算法会使得算法的跟踪性能降低甚至出现失跟的问题。
针对上述问题,中国电子科技集团公司信息科学研究院在其申请的专利文献“一种基于最大相关熵扩展卡尔曼滤波的雷达目标跟踪算法”(申请公布号:CN111596290A)中公开了一种适用于非线性系统的非高斯量测噪声下的目标跟踪方法。该方法首先根据雷达状态方程、雷达量测方程构建雷达系统非线性模型,然后根据下一时刻雷达点迹的预测值和量测值得到核函数对角阵奇异参数,若核函数对角阵奇异参数大于阈值则将状态预测值作为雷达滤波值。然而,由于该方法选用了单一的运动模型对目标的运动状态进行描述,使得其只适用于对机动性不是很强的目标进行跟踪。当目标的机动变化很大时,所建立的运动模型与目标真实的运动状态不再适配,从而会使得目标的跟踪精度下降或者出现跟踪丢失的问题。
深圳大学在其申请的专利文献“一种适用于闪烁噪声的多机动目标跟踪方法及系统”(申请公布号:CN107462882A)中公开了一种将变分贝叶斯方法和JMS-PHD滤波器结合对非高斯量测噪声条件下的机动目标进行跟踪的技术。该方法首先利用t分布对闪烁噪声,即非高斯噪声进行建模,然后应用变分贝叶斯方法近似求出不同模型下的联合概率密度,最后结合JMS-PHD滤波器对目标的状态进行估计,从而实现对多个机动目标的跟踪。该方法存在的不足之处是,第一,该方法中只是假设量测方程中的量测噪声为非高斯噪声,状态方程中的过程噪声仍然服从高斯分布,这对机动目标而言,突发的机动会导致过程噪声也是具有重尾特性的非高斯分布,那么该方法假设的过程高斯噪声与目标真实的运动会有一定的偏差,这样会影响机动目标的跟踪精度。第二,该方法中利用变分贝叶斯方法对参数进行学习时需要多次迭代,会使得跟踪滤波的时间大大增加,不适用于实时性要求比较高的跟踪场景。
发明内容
为了解决现有技术中存在的上述问题,本发明提供了一种基于IMM-STEKF(Interactive Multiple Model - Student’s t Extended Kalman Filtering,交互式多模型-学生 t扩展卡尔曼滤波)的非高斯噪声下机动目标跟踪方法,旨在解决传感器瞬时故障、飞行目标突发机动等原因导致具有重尾特性的非高斯噪声条件下的机动目标跟踪问题。
实现本发明目的的思路是:采用学生t分布对过程噪声和量测噪声进行建模并且选取多个运动模型组成模型集,将上一时刻各个滤波器的输出值进行交互混合作为本时刻各个滤波器的输入值,基于各个运动模型进行STEKF跟踪滤波获得状态估计值,然后根据获得的状态估计值计算各个模型的似然函数和对应的概率,最后将各个滤波器的状态估计值和精度矩阵按照求得的模型概率进行加权求和获得当前时刻的状态估计值和精度矩阵,从而可以实现非高斯噪声条件下的机动目标跟踪。
本发明要解决的技术问题通过以下技术方案实现:
一种基于IMM-STEKF的非高斯噪声下机动目标跟踪方法,包括:
步骤1:获取机动目标的量测值;
步骤2:建立非高斯噪声条件下的目标状态方程和量测方程,并初始化机动目标的状态估计值和对应的精度矩阵;
步骤3:构建包括多个运动模型的模型集,并对机动目标的状态估计值和精度矩阵分别进行交互混合,得到每个运动模型的混合状态输入值和混合精度矩阵;
步骤4:基于所述量测值、所述目标状态方程和量测方程,利用STEKF算法对每个运动模型的混合状态输入值和混合精度矩阵进行跟踪滤波处理,得到每个运动模型的状态估计值和精度矩阵;
步骤5:对所述模型集中的每个运动模型对应的概率进行更新;
步骤6:基于每个运动模型对应的概率以及每个运动模型的状态估计值和精度矩阵更新机动目标在当前时刻的状态估计值和精度矩阵。
在本发明的一个实施例中,在步骤3中,对机动目标的状态估计值和精度矩阵分别进行交互混合,包括:
利用状态混合公式计算模型集中每个运动模型的混合状态输入值;所述状态混合公式为:
利用精度矩阵混合公式计算模型集中每个运动模型的混合精度矩阵;所述精度矩阵混合公式为:
在本发明的一个实施例中,步骤4包括:
4a) 时间更新
基于所述目标状态方程和量测方程,利用每个运动模型的混合状态输入值和混合精度矩阵对每个运动模型的状态和精度矩阵进行预测,得到每个运动模型的状态预测值和预测精度矩阵;
4b) 量测更新
根据当前时刻获得的量测值以及每个运动模型的状态预测值和预测精度矩阵对每个运动模型的状态估计值和精度矩阵进行更新,得到当前时刻每个运动模型的状态估计值和精度矩阵。
在本发明的一个实施例中,在进行步骤4a)之前,还包括:
利用矩匹配方法对每个运动模型的混合精度矩阵进行自由度调整。
在本发明的一个实施例中,对每个运动模型的混合精度矩阵进行自由度调整的公式为:
在本发明的一个实施例中,在步骤4a)中,对每个运动模型的状态和精度矩阵进行预测的公式分别为:
其中,表示时刻模型集中第个运动模型的状态预测值,表示时刻模型集中第个运动模型的状态转移矩阵;表示时刻模型集中第个运动模型的预测精度矩阵,表示时刻模型集中第个运动模型对应的过程噪声所服从的学生t分布中的精度矩阵。
在本发明的一个实施例中,在步骤4b)中,对每个运动模型的状态估计值和精度矩阵进行更新的公式分别为:
其中,表示时刻模型集中第个运动模型的状态估计值,表示时刻量测方程的雅克比矩阵,T表示转置,表示时刻过程噪声所服从的学生分布中的精度矩阵,表示时刻获得的量测值,表示经过量测方程传递的量测预测值;表示量测的维数,。
在本发明的一个实施例中,步骤5包括:
5a) 利用模型可能性公式计算模型中各个模型的似然函数;
5b) 基于步骤5a)求得的似然函数更新模型集中各个模型的概率,计算公式为:
在本发明的一个实施例中,步骤6包括:
利用状态加权求和公式计算当前时刻机动目标的状态估计值;所述状态加权求和公式为:
利用精度矩阵加权求和公式计算当前时刻机动目标的精度矩阵;所述精度矩阵加权求和公式为:
本发明的有益效果:
1、本发明引入了交互式多模型算法,首先选取多个运动模型组成模型集,然后利用各个运动模型的概率对多个运动模型的状态估计值进行加权求和,以获得最终的机动目标状态估计值;该方法可以在机动目标的运动状态不确定且实时变化的情况下通过多个模型的交互实现对机动目标的精确跟踪;
2、本发明通过将过程噪声和量测噪声均建模为t分布非高斯噪声,然后采用学生t扩展卡尔曼滤波对非高斯噪声进行处理,该方法无需迭代学习,复杂度较低,实时性较高,且跟踪精度高,使得算法可以在非高斯噪声条件下对机动目标进行实时跟踪。
以下将结合附图及实施例对本发明做进一步详细说明。
附图说明
图1是本发明实施例提供的一种基于IMM-STEKF的非高斯噪声下机动目标跟踪方法的流程示意图;
图2是仿真场景中机载雷达和机动目标的真实轨迹图;
图3是机载雷达对在非高斯噪声条件下的两个机动目标进行跟踪的量测轨迹与跟踪的轨迹曲线的对比图;
图4是对机动目标1跟踪过程中距离误差随机载雷达与机动目标1之间的距离变化的曲线图;
图5是对机动目标1跟踪过程中方位角误差随机载雷达与机动目标1之间的距离变化的曲线图;
图6是对机动目标1跟踪过程中俯仰角误差随机载雷达与机动目标1之间的距离变化的曲线图;
图7是对机动目标2跟踪过程中距离误差随机载雷达与机动目标2之间的距离变化的曲线图;
图8是对机动目标2跟踪过程中方位角误差随机载雷达与机动目标2之间的距离变化的曲线图;
图9是对机动目标2跟踪过程中俯仰角误差随机载雷达与机动目标2之间的距离变化的曲线图。
具体实施方式
下面结合具体实施例对本发明做进一步详细的描述,但本发明的实施方式不限于此。
实施例一
请参见图1,图1是本发明实施例提供的一种基于IMM-STEKF的非高斯噪声下机动目标跟踪方法的流程示意图,其包括:
步骤1:获取机动目标的量测值。
在本实施例中,量测值主要包括每个高机动目标与机载雷达之间的距离、每个高机动目标相对于机载雷达的方位角和俯仰角。
具体的,本实施例可以每隔50毫秒从机载雷达接收的回波信号中检测一次每个高机动目标的量测值,以便于后续根据当前时刻的量测值实时进行目标状态估计。
步骤2:建立非高斯噪声条件下的目标状态方程和量测方程,并初始化机动目标的状态估计值和对应的精度矩阵。
具体的,本实施例将过程噪声和量测噪声均建模为t分布非高斯噪声,构建非高斯噪声条件下的目标状态方程和量测方程。其中,状态方程为:
量测方程为:
根据上述状态方程和量测方程即可得到机动目标在某一时刻的状态估计值和对应的精度矩阵。
步骤3:构建包括多个运动模型的模型集,并对机动目标的状态估计值和精度矩阵分别进行交互混合,得到每个运动模型的混合状态输入值和混合精度矩阵。
首先,本实施例可以通过对机动目标运动特点进行分析,从现有的运动模型中选择多个合适的运动模型组成模型集。
然后,对每个机动目标的状态估计值和精度矩阵进行交互混合,具体如下:
利用状态混合公式计算模型集中每个运动模型的混合状态输入值,计算公式为:
利用精度矩阵混合公式计算模型集中每个运动模型的混合精度矩阵,计算公式为:
步骤4:基于量测值、目标状态方程和量测方程,利用STEKF(Student’s tExtended Kalman Filtering,学生t扩展卡尔曼滤波)算法对每个运动模型的混合状态输入值和混合精度矩阵进行跟踪滤波处理,得到每个运动模型的状态估计值和精度矩阵。
需要说明的是,为了防止STEKF经过多次迭代之后回归到传统的EKF,本实施例还利用矩匹配方法对自由度进行了调整,具体如下:
则对每个运动模型的混合精度矩阵进行自由度调整的公式可以表示为:
在完成了自由度调整之后,对模型集中各个运动模型利用STEKF算法进行跟踪滤波处理。具体包括:
4a) 时间更新
基于所述目标状态方程和量测方程,利用每个运动模型的混合状态输入值和混合精度矩阵对每个运动模型的状态和精度矩阵进行预测,得到每个运动模型的状态预测值和预测精度矩阵,公式表示为:
其中,表示时刻模型集中第个运动模型的状态预测值,表示时刻模型集中第个运动模型的状态转移矩阵;表示时刻模型集中第个运动模型的预测精度矩阵,表示时刻模型集中第个运动模型对应的过程噪声所服从的学生分布中的精度矩阵。
4b) 量测更新
根据当前时刻获得的量测值以及每个运动模型的状态预测值和预测精度矩阵对每个运动模型的状态估计值和精度矩阵进行更新,得到当前时刻每个运动模型的状态估计值和精度矩阵,公式表示为:
其中,表示时刻模型集中第个运动模型的状态估计值,表示时刻量测方程的雅克比矩阵,T表示转置,表示时刻过程噪声所服从的学生分布中的精度矩阵,表示时刻获得的量测值,表示经过量测方程传递的量测预测值;表示量测的维数。
本发明通过将过程噪声和量测噪声均建模为t分布非高斯噪声,然后采用学生t扩展卡尔曼滤波对非高斯噪声进行处理,该方法无需迭代学习,复杂度较低,实时性较高,且跟踪精度高,使得算法可以在非高斯噪声条件下对机动目标进行实时跟踪。
步骤5:对模型集中的每个运动模型对应的概率进行更新。
5a) 利用模型可能性公式计算模型中各个模型的似然函数。
具体的,模型可能性公式如下:
5b) 基于步骤5a)求得的似然函数更新模型集中各个模型的概率,计算公式为:
步骤6:基于每个运动模型对应的概率以及每个运动模型的状态估计值和精度矩阵更新机动目标在当前时刻的状态估计值和精度矩阵。
首先,利用状态加权求和公式计算当前时刻机动目标的状态估计值;计算公式为:
然后,利用精度矩阵加权求和公式计算当前时刻机动目标的精度矩阵;计算公式为:
本发明引入了交互式多模型算法,首先选取多个运动模型组成模型集,然后利用各个运动模型的概率对多个运动模型的状态估计值进行加权求和,以获得最终的机动目标状态估计值;该方法可以在机动目标的运动状态不确定且实时变化的情况下通过多个模型的交互实现对机动目标的精确跟踪。
此外,本发明通过将过程噪声和量测噪声建模为学生t分布,在此条件下以类似于高斯噪声下扩展卡尔曼的滤波过程对非高斯噪声进行处理,这样可以解决非线性系统中非高斯噪声下的跟踪滤波问题,并且和高斯噪声下扩展卡尔曼的计算复杂度是在同一数量级的,实时性比较高,然后将其与IMM算法结合,使得本发明可以在非高斯噪声条件下对机动目标进行实时跟踪。
实施例二
下面结合仿真实验,对本发明的有益效果进行进一步说明。
1.仿真实验的条件。
本实施例在Intel(R) Core(TM) i7-9700K CPU 3.60 GHz处理器的电脑上,采用MATLAB R2019a软件完成仿真。
仿真场景设置:雷达所在的载机做匀速直线运动,两个高机动目标基于比例导引律对载机进行攻击,速度4马赫左右,以载机的飞行方向为基准,机动目标1在右侧方位角为30°、俯仰角为20°,距离为15km处出现,机动目标2在左侧方位角为30°、俯仰角为20°,距离为14.5km处出现,对载机进行制导攻击。
2. 仿真内容与结果分析。
本实施例中的仿真实验除了利用本发明的方法,另外还选择了IMM-EKF算法在非高斯噪声条件下对上面两个基于比例导引律制导的机动目标进行跟踪,其跟踪性能的对比结果如图2-9所示。
本发明中的两个机动目标运动轨迹是基于比例导引律对机载雷达所在的载机进行制导打击。
图2是仿真场景中机载雷达和机动目标的真实轨迹图。其中,加号标示的曲线表示雷达所在载机的运动轨迹曲线,以实线标示的曲线表示两个机动目标跟踪的轨迹曲线。
图3是机载雷达对在非高斯噪声条件下的两个机动目标进行跟踪的量测轨迹与跟踪的轨迹曲线的对比图。具体的,该跟踪的轨迹曲线是通过采用本发明的方法每隔50ms计算一次两个机动目标的状态估计值,将计算134次后的所有两个机动目标的状态估计值绘制得到的。横坐标表示在三维空间中两个机动目标的位置坐标沿着x轴移动对应的值,纵坐标表示在三维空间中机动目标的位置坐标沿着y轴移动对应的值,竖坐标表示在三维空间中机动目标的位置坐标沿着z轴移动对应的值,单位为米m。图3中以实线标示的曲线表示两个高机动目标的量测轨迹曲线,以虚线标示的曲线表示两个高机动目标跟踪的轨迹曲线,以加号标示的曲线表示雷达所在载机的运动轨迹曲线。
图4是对机动目标1跟踪过程中距离误差随机载雷达与机动目标1之间的距离变化的曲线图。其主要是通过将本发明方法获得的机动目标1跟踪的轨迹曲线和真实轨迹曲线对比得到的。图4中的横坐标表示机载雷达与机动目标1之间的距离,单位是千米(km),纵坐标表示机动目标1的距离误差,单位为米。在图4中,以点线标示的曲线表示机动目标1距离的量测误差曲线,该曲线是由机动目标1每个时刻的距离量测值与方位角真实值做差然后取绝对值绘制得到的,以实线标示的曲线表示机动目标1距离的跟踪误差曲线,该曲线是由机动目标1在每个时刻的距离估计值与距离真实值做差然后取绝对值绘制得到的。
图5是对机动目标1跟踪过程中方位角误差随机载雷达与机动目标1之间的距离变化的曲线图,其主要是通过将本发明方法获得的机动目标1跟踪的轨迹曲线和真实轨迹曲线对比得到的。图5中的横坐标表示机载雷达与机动目标1之间的距离,单位是千米,纵坐标表示机动目标1的方位角误差,单位为度。在图5中,以点线标示的曲线表示机动目标1方位角的量测误差曲线,该曲线是由机动目标1每个时刻的方位角量测值与方位角真实值做差然后取绝对值绘制得到的,以实线标示的曲线表示机动目标1方位角的跟踪误差曲线,该曲线是由机动目标1在每个时刻的方位角估计值与方位角真实值做差然后取绝对值绘制得到的。
图6是对机动目标1跟踪过程中俯仰角误差随机载雷达与机动目标1之间的距离变化的曲线图,其是通过将本发明方法获得的机动目标1跟踪的轨迹曲线和真实轨迹曲线对比得到的。图6中的横坐标表示机载雷达与机动目标1之间的距离,单位是千米,纵坐标表示机动目标1的俯仰角误差,单位为度。在图6中,以点线标示的曲线表示机动目标1俯仰角的量测误差曲线,该曲线是由机动目标1在每个时刻的俯仰角量测值与俯仰角真实值做差然后取绝对值绘制得到的,以实线标示的曲线表示机动目标1俯仰角的跟踪误差曲线,该曲线是由机动目标1每个时刻的俯仰角估计值与俯仰角真实值做差然后取绝对值绘制得到的。
图7是对机动目标2跟踪过程中距离误差随机载雷达与机动目标2之间的距离变化的曲线图,其是通过将本发明方法获得的机动目标2跟踪的轨迹曲线和真实轨迹曲线对比得到的。图7中的横坐标表示机载雷达与机动目标2之间的距离,单位是千米,纵坐标表示机动目标2的距离误差,单位为米。在图7中,以点线标示的曲线表示机动目标2距离的量测误差曲线,该曲线是由机动目标2在每个时刻的距离量测值与方位角真实值做差然后取绝对值绘制得到的,以实线标示的曲线表示机动目标2距离的跟踪误差曲线,该曲线是由机动目标2在每个时刻的距离估计值与距离真实值做差然后取绝对值绘制得到的。
图8是对机动目标2跟踪过程中方位角误差随机载雷达与机动目标2之间的距离变化的曲线图,其是通过将本发明方法获得的机动目标2跟踪的轨迹曲线和真实轨迹曲线对比得到的。图8中的横坐标表示机载雷达与机动目标2之间的距离,单位是千米,纵坐标表示机动目标2的方位角误差,单位为度。在图8中,以点线标示的曲线表示机动目标2方位角的量测误差曲线,该曲线是由机动目标2在每个时刻的方位角量测值与方位角真实值做差然后取绝对值绘制得到的,以实线标示的曲线表示机动目标2方位角的跟踪误差曲线,该曲线是由机动目标2在每个时刻的方位角估计值与方位角真实值做差然后取绝对值绘制得到的。
图9是对机动目标2跟踪过程中俯仰角误差随机载雷达与机动目标2之间的距离变化的曲线图,其是通过将本发明方法获得的机动目标2跟踪的轨迹曲线和真实轨迹曲线对比得到的。图9中的横坐标表示机载雷达与机动目标2之间的距离,单位是千米,纵坐标表示机动目标2的俯仰角误差,单位为度。在图9中,以点线标示的曲线表示机动目标2俯仰角的量测误差曲线,该曲线是由机动目标2每个时刻的俯仰角量测值与俯仰角真实值做差然后取绝对值绘制得到的,以实线标示的曲线表示机动目标2俯仰角的跟踪误差曲线,该曲线是由机动目标2在每个时刻的俯仰角估计值与俯仰角真实值做差然后取绝对值绘制得到的。
由图2和图3可以看出,本发明方法跟踪得到的非高斯噪声条件下的两个机动目标的轨迹曲线与真实的轨迹曲线走向几乎趋于重合,表明本发明方法跟踪的两个机动目标的轨迹曲线具有较高的精度。
由图4-图9可以看出,在对非高斯噪声条件下的两个机动目标进行跟踪的过程中,距离、方位角、俯仰角的量测误差和跟踪误差都在随着机动目标与机载雷达之间距离的拉近而逐渐减小,并且距离、方位角、俯仰角的跟踪误差始终比量测误差小,表明本发明方法可以同时对非高斯噪声条件下的机动目标进行跟踪。
以上内容是结合具体的优选实施方式对本发明所作的进一步详细说明,不能认定本发明的具体实施只局限于这些说明。对于本发明所属技术领域的普通技术人员来说,在不脱离本发明构思的前提下,还可以做出若干简单推演或替换,都应当视为属于本发明的保护范围。
Claims (9)
1.一种基于IMM-STEKF的非高斯噪声下机动目标跟踪方法,其特征在于,包括:
步骤1:获取机动目标的量测值;
步骤2:建立非高斯噪声条件下的目标状态方程和量测方程,并初始化机动目标的状态估计值和对应的精度矩阵;
步骤3:构建包括多个运动模型的模型集,并对机动目标的状态估计值和精度矩阵分别进行交互混合,得到每个运动模型的混合状态输入值和混合精度矩阵;
步骤4:基于所述量测值、所述目标状态方程和量测方程,利用STEKF算法对每个运动模型的混合状态输入值和混合精度矩阵进行跟踪滤波处理,得到每个运动模型的状态估计值和精度矩阵;
步骤5:对所述模型集中的每个运动模型对应的概率进行更新;
步骤6:基于每个运动模型对应的概率以及每个运动模型的状态估计值和精度矩阵更新机动目标在当前时刻的状态估计值和精度矩阵。
2.根据权利要求1所述的基于IMM-STEKF的非高斯噪声下机动目标跟踪方法,其特征在于,在步骤3中,对机动目标的状态估计值和精度矩阵分别进行交互混合,包括:
利用状态混合公式计算模型集中每个运动模型的混合状态输入值;所述状态混合公式为:
利用精度矩阵混合公式计算模型集中每个运动模型的混合精度矩阵;所述精度矩阵混合公式为:
3.根据权利要求2所述的基于IMM-STEKF的非高斯噪声下机动目标跟踪方法,其特征在于,步骤4包括:
4a) 时间更新
基于所述目标状态方程和量测方程,利用每个运动模型的混合状态输入值和混合精度矩阵对每个运动模型的状态和精度矩阵进行预测,得到每个运动模型的状态预测值和预测精度矩阵;
4b) 量测更新
根据当前时刻获得的量测值以及每个运动模型的状态预测值和预测精度矩阵对每个运动模型的状态估计值和精度矩阵进行更新,得到当前时刻每个运动模型的状态估计值和精度矩阵。
4.根据权利要求3所述的基于IMM-STEKF的非高斯噪声下机动目标跟踪方法,其特征在于,在进行步骤4a)之前,还包括:
利用矩匹配方法对每个运动模型的混合精度矩阵进行自由度调整。
Priority Applications (1)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
CN202211024283.4A CN115128597B (zh) | 2022-08-25 | 2022-08-25 | 基于imm-stekf的非高斯噪声下机动目标跟踪方法 |
Applications Claiming Priority (1)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
CN202211024283.4A CN115128597B (zh) | 2022-08-25 | 2022-08-25 | 基于imm-stekf的非高斯噪声下机动目标跟踪方法 |
Publications (2)
Publication Number | Publication Date |
---|---|
CN115128597A CN115128597A (zh) | 2022-09-30 |
CN115128597B true CN115128597B (zh) | 2022-11-25 |
Family
ID=83387748
Family Applications (1)
Application Number | Title | Priority Date | Filing Date |
---|---|---|---|
CN202211024283.4A Active CN115128597B (zh) | 2022-08-25 | 2022-08-25 | 基于imm-stekf的非高斯噪声下机动目标跟踪方法 |
Country Status (1)
Country | Link |
---|---|
CN (1) | CN115128597B (zh) |
Citations (1)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
CN113963025A (zh) * | 2021-10-22 | 2022-01-21 | 西北工业大学深圳研究院 | 水下自适应机动目标快速跟踪及追踪方法 |
Family Cites Families (6)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
SG101444A1 (en) * | 2001-04-20 | 2004-01-30 | Singapore Tech Aerospace Ltd | A maneuvering target tracking method via modifying the interacting multiple model (imm) and the interacting acceleration compensation (iac) algorithms |
CN104252178B (zh) * | 2014-09-12 | 2017-11-03 | 西安电子科技大学 | 一种基于强机动的目标跟踪方法 |
CN107045125B (zh) * | 2017-03-17 | 2020-01-14 | 电子科技大学 | 一种基于预测值量测转换的交互多模型雷达目标跟踪方法 |
CN110376582B (zh) * | 2019-01-24 | 2022-10-04 | 西安电子科技大学 | 自适应gm-phd的机动目标跟踪方法 |
CN111596290B (zh) * | 2020-06-01 | 2022-07-29 | 中国电子科技集团公司信息科学研究院 | 一种基于最大相关熵扩展卡尔曼滤波的雷达目标跟踪方法 |
CN113376626A (zh) * | 2021-06-23 | 2021-09-10 | 西安电子科技大学 | 基于immpda算法的高机动目标跟踪方法 |
-
2022
- 2022-08-25 CN CN202211024283.4A patent/CN115128597B/zh active Active
Patent Citations (1)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
CN113963025A (zh) * | 2021-10-22 | 2022-01-21 | 西北工业大学深圳研究院 | 水下自适应机动目标快速跟踪及追踪方法 |
Also Published As
Publication number | Publication date |
---|---|
CN115128597A (zh) | 2022-09-30 |
Similar Documents
Publication | Publication Date | Title |
---|---|---|
CN103925925B (zh) | 一种用于多点定位系统的实时高精度位置解算方法 | |
CN101221238B (zh) | 基于高斯均值移动配准的动态偏差估计方法 | |
CN104199022B (zh) | 一种基于目标模态估计的临近空间高超声速目标跟踪方法 | |
CN111178385A (zh) | 一种鲁棒在线多传感器融合的目标跟踪方法 | |
Thormann et al. | Extended target tracking using Gaussian processes with high-resolution automotive radar | |
CN111722214B (zh) | 雷达多目标跟踪phd实现方法 | |
CN111027692A (zh) | 一种目标运动态势预测方法及装置 | |
CN110865343A (zh) | 基于lmb的粒子滤波检测前跟踪方法及系统 | |
CN109212519B (zh) | 基于bf-dlstm的窄带雷达目标跟踪方法 | |
CN111913484A (zh) | 一种变电站巡检机器人在未知环境下的路径规划方法 | |
CN115204212A (zh) | 一种基于stm-pmbm滤波算法的多目标跟踪方法 | |
CN105424043A (zh) | 一种基于判断机动的运动状态估计方法 | |
CN113759364A (zh) | 一种基于激光地图的毫米波雷达连续定位方法及装置 | |
Zhao et al. | Adaptive non-linear joint probabilistic data association for vehicle target tracking | |
CN115542309A (zh) | 基于imm-vb的非高斯噪声条件下机动目标自适应跟踪方法 | |
CN107621632A (zh) | 用于nshv跟踪滤波的自适应滤波方法及系统 | |
CN111711432B (zh) | 一种基于ukf和pf混合滤波的目标跟踪算法 | |
CN115128597B (zh) | 基于imm-stekf的非高斯噪声下机动目标跟踪方法 | |
Ebert et al. | Deep radar sensor models for accurate and robust object tracking | |
CN113030940A (zh) | 一种转弯机动下的多星凸型扩展目标跟踪方法 | |
CN112379350A (zh) | 智能车辆毫米波雷达多目标跟踪方法、装置及设备 | |
CN113376626A (zh) | 基于immpda算法的高机动目标跟踪方法 | |
CN114445456B (zh) | 基于部分模型的数据驱动智能机动目标跟踪方法及装置 | |
CN115544425A (zh) | 一种基于目标信噪比特征估计的鲁棒多目标跟踪方法 | |
CN112025709B (zh) | 一种基于车载摄像头视觉的移动机器人定位系统及方法 |
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 |