CN115542309A - 基于imm-vb的非高斯噪声条件下机动目标自适应跟踪方法 - Google Patents
基于imm-vb的非高斯噪声条件下机动目标自适应跟踪方法 Download PDFInfo
- Publication number
- CN115542309A CN115542309A CN202211024277.9A CN202211024277A CN115542309A CN 115542309 A CN115542309 A CN 115542309A CN 202211024277 A CN202211024277 A CN 202211024277A CN 115542309 A CN115542309 A CN 115542309A
- Authority
- CN
- China
- Prior art keywords
- model
- distribution
- motion
- maneuvering target
- motion model
- 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.)
- Pending
Links
- 238000000034 method Methods 0.000 title claims abstract description 72
- 230000033001 locomotion Effects 0.000 claims abstract description 146
- 239000011159 matrix material Substances 0.000 claims abstract description 92
- 238000005259 measurement Methods 0.000 claims abstract description 44
- 238000004422 calculation algorithm Methods 0.000 claims abstract description 9
- 238000001914 filtration Methods 0.000 claims abstract description 5
- 230000006870 function Effects 0.000 claims description 89
- 230000008569 process Effects 0.000 claims description 17
- 238000004364 calculation method Methods 0.000 claims description 14
- 230000003044 adaptive effect Effects 0.000 claims description 11
- 230000005540 biological transmission Effects 0.000 claims description 6
- 238000006243 chemical reaction Methods 0.000 claims description 3
- 230000007704 transition Effects 0.000 claims description 3
- 230000017105 transposition Effects 0.000 claims description 3
- 230000002452 interceptive effect Effects 0.000 abstract description 4
- 238000004088 simulation Methods 0.000 description 6
- 238000010586 diagram Methods 0.000 description 3
- 238000005315 distribution function Methods 0.000 description 3
- 238000013398 bayesian method Methods 0.000 description 2
- 230000009286 beneficial effect Effects 0.000 description 2
- 230000007547 defect Effects 0.000 description 2
- 230000003993 interaction Effects 0.000 description 2
- 238000004458 analytical method Methods 0.000 description 1
- 230000008859 change Effects 0.000 description 1
- 238000001514 detection method Methods 0.000 description 1
- 238000005516 engineering process Methods 0.000 description 1
- 230000007613 environmental effect Effects 0.000 description 1
- 238000002474 experimental method Methods 0.000 description 1
- 238000004904 shortening Methods 0.000 description 1
- 238000006467 substitution reaction Methods 0.000 description 1
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
Landscapes
- Engineering & Computer Science (AREA)
- Radar, Positioning & Navigation (AREA)
- Remote Sensing (AREA)
- Computer Networks & Wireless Communication (AREA)
- Physics & Mathematics (AREA)
- General Physics & Mathematics (AREA)
- Radar Systems Or Details Thereof (AREA)
Abstract
本发明公开了一种基于IMM‑VB的非高斯噪声条件下机动目标自适应跟踪方法,包括:获取机动目标的量测值;构建包括多个运动模型的模型集,并对机动目标的状态估计值、精度矩阵以及共轭先验分布参数分别进行交互混合;利用变分贝叶斯算法对每个运动模型的混合状态输入值、混合精度矩阵以及共轭先验分布的混合参数进行滤波处理,以更新每个运动模型的状态估计值和精度矩阵;对所述模型集中的每个运动模型对应的概率进行更新;更新机动目标在当前时刻的状态估计值和精度矩阵。本发明提供的方法可以在时变非高斯噪声条件下实现对机动目标的实时精确跟踪。
Description
技术领域
本发明属于目标跟踪技术领域,具体涉及一种基于IMM-VB的非高斯噪声条件下机动目标自适应跟踪方法。
背景技术
在机动目标跟踪技术研究中,过程噪声和量测噪声的研究是很重要的一部分,目前大多数的机动目标跟踪算法都是在假设噪声服从高斯分布的条件下进行的,但在雷达的实际探测过程中,环境扰动、传感器瞬时故障、飞行目标突发高机动、飞行目标不同位置的散射强度不同等因素都会使得过程噪声或量测噪声具有重尾特性,并且这些因素的出现是具有不确定性的,这样在跟踪过程中非高斯噪声是时变的,如果仍然使用传统的假设噪声为高斯白噪声的机动目标跟踪算法会使得算法的跟踪性能降低甚至出现失跟的问题。
深圳大学在其申请的专利文献“一种闪烁噪声下的多目标跟踪方法及系统”(申请公布号:CN110390684A)中公开了一种将变分贝叶斯方法和标签多伯努利滤波结合的方法对非高斯噪声下的多个目标跟踪进行跟踪。该方法的步骤是:首先合并已存在和新生目标在当前时刻的预测分布函数和标签多伯努利滤波密度,然后对其进行处理获得当前时刻各目标的分布函数和标签多伯努利滤波密度,最后在非高斯噪声中准确提取当前时刻各目标的状态估计值,从而实现对多个目标的跟踪。该方法存在的不足之处是,该方法没有考虑目标的机动性,当目标做机动时,所建立的运动模型与目标真实的运动状态不再适配,这样会使得目标的跟踪精度下降或者出现跟踪丢失的问题。
深圳大学在其申请的专利文献“一种适用于闪烁噪声的多机动目标跟踪方法及系统”(申请公布号:CN107462882A)中公开了一种将变分贝叶斯方法和JMS-PHD滤波器结合对非高斯量测噪声条件下的机动目标进行跟踪的技术。该方法的步骤是:首先,利用t分布对闪烁噪声,即非高斯噪声进行建模,然后应用变分贝叶斯方法近似求出不同模型下的联合概率密度,最后结合JMS-PHD滤波器对目标的状态进行估计,从而实现对多个机动目标的跟踪。该方法存在的不足之处是,该方法中只是假设量测方程中的量测噪声为非高斯噪声,状态方程中的过程噪声仍然服从高斯分布,这对机动目标而言,突发的机动会导致过程噪声也是具有重尾特性的非高斯分布,那么该方法中假设的过程高斯噪声与目标真实的运动会有一定的偏差,从而导致机动目标的跟踪精度下降。
发明内容
为了解决现有技术中存在的上述问题,本发明提供了一种基于IMM-VB(Interactive Multiple Model - Variational Bayesian,交互式多模型-变分贝叶斯)的非高斯噪声条件下机动目标自适应跟踪方法,旨在解决传感器瞬时故障、飞行目标突发机动时导致时变非高斯噪声条件下的对机动目标进行跟踪的问题。
实现本发明目的的思路是:采用学生t分布对过程噪声和量测噪声进行建模,为了方便后面变分贝叶斯方法的应用,将学生t分布写成分层高斯的形式,利用共轭先验分布对分层高斯中的分布进行表示,接下来通过变分贝叶斯方法对时变非高斯过程和量测噪声所服从的学生t分布中的自由度、精度矩阵参数进行学习使得近似的联合后验概率密度与真实的联合后验概率密度的KL散度最小,这样估计得出的参数对应的学生t分布与每一时刻真实的噪声分布更加接近,因此获得的状态估计值也更加精确,然后根据模型集中每个模型输出的状态估计值计算每个模型的似然函数和对应的概率,将每个滤波器的状态估计值和精度矩阵按照求得的模型概率进行加权求和获得当前时刻最终的状态估计值和精度矩阵,从而可以实现时变非高斯噪声条件下机动目标的自适应跟踪。
本发明要解决的技术问题通过以下技术方案实现:
一种基于IMM-VB的非高斯噪声条件下机动目标自适应跟踪方法,包括:
步骤1:获取机动目标的量测值;
步骤2:构建包括多个运动模型的模型集,并对机动目标的状态估计值、精度矩阵以及共轭先验分布参数分别进行交互混合,对应得到每个运动模型的混合状态输入值、混合精度矩阵以及共轭先验分布的混合参数;
步骤3:基于所述量测值,利用变分贝叶斯算法对每个运动模型的混合状态输入值、混合精度矩阵以及共轭先验分布的混合参数进行滤波处理,以更新每个运动模型的状态估计值和精度矩阵;
步骤4:对所述模型集中的每个运动模型对应的概率进行更新;
步骤5:基于每个运动模型对应的概率以及每个运动模型的状态估计值和精度矩阵更新机动目标在当前时刻的状态估计值和精度矩阵。
在本发明的一个实施例中,在步骤2中,对机动目标的状态估计值、精度矩阵以及共轭先验分布参数分别进行交互混合,包括:
利用状态混合公式计算模型集中每个运动模型的混合状态输入值;所述状态混合公式为:
利用精度矩阵混合公式计算模型集中每个运动模型的混合精度矩阵;所述精度矩阵混合公式为:
利用参数混合公式计算基于模型集中每个运动模型的共轭先验分布的混合参数,计算公式为:
其中,和表示运动模型的共轭参数分布伽马分布的混合形状参数,和表示运动模型的共轭参数分布伽马分布的混合尺度参数,和表示运动模型的共轭参数分布逆Wishart分布中的混合自由度,和表示运动模型的共轭参数分布逆Wishart分布中的混合逆精度矩阵,和表示运动模型的时刻共轭参数分布伽马分布的形状参数,和表示运动模型的时刻共轭参数分布伽马分布的尺度参数,和表示运动模型的时刻共轭参数分布逆Wishart分布中的自由度,和表示运动模型的时刻共轭参数分布逆Wishart分布中的逆精度矩阵。
在本发明的一个实施例中,步骤3包括:
3a) 计算模型集中每个运动模型的状态、精度矩阵以及共轭先验分布参数的预测值和联合预测后验概率密度函数;
3b) 利用变分贝叶斯方法对共轭先验分布参数进行学习,使得近似后验概率密度函数与真实后验概率密度函数的KL散度最小化,以更新每个运动模型的状态估计值和精度矩阵。
在本发明的一个实施例中,步骤3a)中的计算公式为:
其中,表示时刻模型集中第个运动模型的状态预测值,表示模型集中第个运动模型的状态转移矩阵,T表示转置,表示时刻模型集中第个运动模型的精度矩阵预测值,表示基于模型集中第个运动模型的过程噪声矩阵,表示状态向量的维数,表示量测的维数,表示传递因子,和表示共轭参数分布伽马分布的形状参数预测值,和表示共轭参数分布伽马分布的尺度参数预测值,和表示共轭参数分布逆Wishart分布中的自由度预测值,和表示共轭参数分布逆Wishart分布中的逆精度矩阵预测值。
在本发明的一个实施例中,步骤3b)包括:
构建真实后验概率密度函数,并将其表示为近似的一个自由因子形式的近似PDF;
将近似后验概率密度函数与所述真实后验概率密度函数的KL散度最小化,从而得到最优的近似后验概率密度函数,以更新每个运动模型的状态估计值和精度矩阵。
在本发明的一个实施例中,所述真实后验密度函数的近似的一个自由因子形式的近似PDF为:
其中,表示在获得量测条件下时刻模型集中第个运动模型的真实后验密度函数,表示时刻模型集中第个运动模型的状态变量的概率密度函数,表示辅助随机变量的概率密度函数,表示辅助随机变量的概率密度函数,表示时刻模型集中第个运动模型的精度矩阵的概率密度函数,表示时刻模型集中第个运动模型的量测矩阵的概率密度函数,表示时刻模型集中第个运动模型的一步预测概率密度函数中自由度的概率密度函数,表示时刻模型集中第个运动模型的一步预测概率密度函数中自由度的概率密度函数。
在本发明的一个实施例中,所述最优的近似后验概率密度函数表示为:
在本发明的一个实施例中,步骤4包括:
4a) 计算模型中各个模型的似然函数,计算公式如下:
4b) 基于步骤4a)求得的似然函数更新模型集中各个模型的概率,计算公式为:
在本发明的一个实施例中,步骤5包括:
利用状态加权求和公式计算当前时刻机动目标的状态估计值;所述状态加权求和公式为:
利用精度矩阵加权求和公式计算当前时刻机动目标的精度矩阵;所述精度矩阵加权求和公式为:
本发明的有益效果:
1、本发明引入了交互式多模型算法,首先选取多个运动模型组成模型集,然后利用各个运动模型的概率对多个运动模型的状态估计值进行加权求和,以获得最终的机动目标状态估计值;该方法可以在机动目标的运动状态不确定且实时变化的情况下通过多个模型的交互实现对机动目标的精确跟踪;
2、本发明通过将过程噪声和量测噪声建模为学生t分布,通过变分贝叶斯方法对学生t分布的参数进行学习使得近似后验概率密度与真实后验概率密度更接近,从而使得学生t分布所表示的噪声与跟踪时真实的噪声相差更小,这样克服了目标的突然机动、探测器瞬时故障等因素会导致过程噪声和量测噪声具有重尾特性的问题,使得本发明可以在时变非高斯噪声条件下对机动目标进行跟踪。
以下将结合附图及实施例对本发明做进一步详细说明。
附图说明
图1是本发明实施例提供的一种基于IMM-VB的非高斯噪声条件下机动目标自适应跟踪方法的流程示意图;
图2是仿真场景中机载雷达和机动目标的真实轨迹图;
图3是机载雷达对在非高斯噪声条件下的两个机动目标进行跟踪的量测轨迹与跟踪的轨迹曲线的对比图;
图4是对机动目标1跟踪过程中距离误差随机载雷达与机动目标1之间的距离变化的曲线图;
图5是对机动目标1跟踪过程中方位角误差随机载雷达与机动目标1之间的距离变化的曲线图;
图6是对机动目标1跟踪过程中俯仰角误差随机载雷达与机动目标1之间的距离变化的曲线图;
图7是对机动目标2跟踪过程中距离误差随机载雷达与机动目标2之间的距离变化的曲线图;
图8是对机动目标2跟踪过程中方位角误差随机载雷达与机动目标2之间的距离变化的曲线图;
图9是对机动目标2跟踪过程中俯仰角误差随机载雷达与机动目标2之间的距离变化的曲线图。
具体实施方式
下面结合具体实施例对本发明做进一步详细的描述,但本发明的实施方式不限于此。
实施例一
请参见图1,图1是本发明实施例提供的一种基于IMM-VB的非高斯噪声条件下机动目标自适应跟踪方法的流程示意图,其包括:
步骤1:获取机动目标的量测值。
在本实施例中,量测值主要包括每个高机动目标与机载雷达之间的距离、每个高机动目标相对于机载雷达的方位角和俯仰角。
具体的,本实施例可以每隔50毫秒从机载雷达接收的回波信号中检测一次每个高机动目标的量测值,以便于后续根据当前时刻的量测值实时进行目标状态估计。
步骤2:构建包括多个运动模型的模型集,并对机动目标的状态估计值、精度矩阵以及共轭先验分布参数分别进行交互混合,对应得到每个运动模型的混合状态输入值、混合精度矩阵以及共轭先验分布的混合参数。
首先,本实施例可以通过对机动目标运动特点进行分析,从现有的运动模型中选择多个合适的运动模型组成模型集。
然后,对每个机动目标的状态估计值、精度矩阵以及共轭先验分布参数进行交互混合,具体如下:
利用状态混合公式计算模型集中每个运动模型的混合状态输入值,计算公式为:
利用精度矩阵混合公式计算模型集中每个运动模型的混合精度矩阵,计算公式为:
利用参数混合公式计算基于模型集中每个运动模型的共轭先验分布的混合参数,计算公式为:
其中,和表示运动模型的共轭参数分布伽马分布的混合形状参数,和表示运动模型的共轭参数分布伽马分布的混合尺度参数,和表示运动模型的共轭参数分布逆Wishart分布中的混合自由度,和表示运动模型的共轭参数分布逆Wishart分布中的混合逆精度矩阵,和表示运动模型的时刻共轭参数分布伽马分布的形状参数,和表示运动模型的时刻共轭参数分布伽马分布的尺度参数,和表示运动模型的时刻共轭参数分布逆Wishart分布中的自由度,和表示运动模型的时刻共轭参数分布逆Wishart分布中的逆精度矩阵。
步骤3:基于所述量测值,利用变分贝叶斯算法对每个运动模型的混合状态输入值、混合精度矩阵以及共轭先验分布的混合参数进行滤波处理,以更新每个运动模型的状态估计值和精度矩阵。
3a) 计算模型集中每个运动模型的状态、精度矩阵以及共轭先验分布参数的预测值和联合预测后验概率密度函数,计算公式为:
其中,表示时刻模型集中第个运动模型的状态预测值,表示模型集中第个运动模型的状态转移矩阵,表示转置,表示时刻模型集中第个运动模型的精度矩阵预测值,表示基于模型集中第个运动模型的过程噪声矩阵,表示状态向量的维数,表示量测的维数,表示传递因子,和表示共轭参数分布伽马分布的形状参数预测值,和表示共轭参数分布伽马分布的尺度参数预测值,和表示共轭参数分布逆Wishart分布中的自由度预测值,和表示共轭参数分布逆Wishart分布中的逆精度矩阵预测值。
3b) 利用变分贝叶斯方法对共轭先验分布参数进行学习,使得近似后验概率密度函数与真实后验概率密度函数的KL散度最小化,以更新每个运动模型的状态估计值和精度矩阵。
首先,构建真实后验概率密度函数,其表示为
其中,表示等价符号,表示前时刻的所有量测,表示将时刻模型集中第个运动模型的一步状态预测概率密度函数写成无限高斯概率密度函数混合形式时引入的辅助随机变量,表示时刻模型集中第个运动模型的一步状态预测概率密度函数中的自由度参数,表示预测量测,表示将时刻模型集中第个运动模型的似然函数写成无限高斯概率密度函数混合形式时引入的辅助随机变量,表示时刻模型集中第个运动模型的似然函数中的自由度参数,和表示共轭参数分布逆Wishart分布中的自由度预测值,和表示共轭参数分布逆Wishart分布中的逆精度矩阵预测值,和表示共轭参数分布伽马分布的形状参数预测值,和表示共轭参数分布伽马分布的尺度参数预测值,表示高斯分布,表示伽马分布,表示逆Wishart分布。
由于其没有封闭的解析解,故将其写为近似的一个自由因子形式的近似PDF(Probability Density Function,概率密度函数)为:
其中,表示在获得量测条件下时刻模型集中第个运动模型的真实后验密度函数,表示时刻模型集中第个运动模型的状态变量的概率密度函数,表示辅助随机变量的概率密度函数,表示辅助随机变量的概率密度函数,表示时刻模型集中第个运动模型的精度矩阵的概率密度函数,表示时刻模型集中第个运动模型的量测矩阵的概率密度函数,表示时刻模型集中第个运动模型的一步预测概率密度函数中自由度的概率密度函数,表示时刻模型集中第个运动模型的一步预测概率密度函数中自由度的概率密度函数。
将近似后验概率密度函数与所述真实后验概率密度函数的KL散度最小化,从而得到最优的近似后验概率密度函数,以更新每个运动模型的状态估计值和精度矩阵。其中,最优的近似后验概率密度函数表示为:
求解所述最优的近似后验概率密度函数,并将最优解带入步骤3a)的公式,计算每个运动模型的状态估计值和精度矩阵。
上式中的最优解满足:
步骤4:对模型集中的每个运动模型对应的概率进行更新。
4a) 计算模型中各个模型的似然函数,计算公式如下:
4b) 基于步骤4a)求得的似然函数更新模型集中各个模型的概率,计算公式为:
步骤5:基于每个运动模型对应的概率以及每个运动模型的状态估计值和精度矩阵更新机动目标在当前时刻的状态估计值和精度矩阵。
利用状态加权求和公式计算当前时刻机动目标的状态估计值;所述状态加权求和公式为:
利用精度矩阵加权求和公式计算当前时刻机动目标的精度矩阵;所述精度矩阵加权求和公式为:
本发明引入了交互式多模型算法,首先选取多个运动模型组成模型集,然后利用各个运动模型的概率对多个运动模型的状态估计值进行加权求和,以获得最终的机动目标状态估计值;该方法可以在机动目标的运动状态不确定且实时变化的情况下通过多个模型的交互实现对机动目标的精确跟踪。
此外,本发明通过将过程噪声和量测噪声建模为学生t分布,通过变分贝叶斯方法对学生t分布的参数进行学习使得近似后验概率密度与真实后验概率密度更接近,从而使得学生t分布所表示的噪声与跟踪时真实的噪声相差更小,这样克服了目标的突然机动、探测器瞬时故障等因素会导致过程噪声和量测噪声具有重尾特性的问题,使得本发明可以在时变非高斯噪声条件下对机动目标进行跟踪。
实施例二
下面结合仿真实验,对本发明的有益效果进行进一步说明。
1.仿真实验的条件。
本实施例在Intel(R) Core(TM) i7-9700K CPU 3.60 GHz处理器的电脑上,采用MATLAB R2019a软件完成仿真。
仿真场景设置:雷达所在的载机做匀速直线运动,两个高机动目标基于比例导引律对载机进行攻击,速度4马赫左右,以载机的飞行方向为基准,机动目标1在右侧方位角为30°、俯仰角为20°,距离为15km处出现,机动目标2在左侧方位角为30°、俯仰角为20°,距离为14.5km处出现,对载机进行制导攻击。
2. 仿真内容与结果分析。
本发明的仿真实验是利用本发明的方法对上面两个基于比例导引律制导的高机动目标进行跟踪,其结果如图2-图9所示。
本发明中的两个机动目标运动轨迹是基于比例导引律现有技术对机载雷达所在的载机进行制导打击。
图2是仿真场景中机载雷达和机动目标的真实轨迹图。其中,加号标示的曲线表示雷达所在载机的运动轨迹曲线,以实线标示的曲线表示两个机动目标跟踪的轨迹曲线。
图3是机载雷达对在非高斯噪声条件下的两个机动目标进行跟踪的量测轨迹与跟踪的轨迹曲线的对比图,该跟踪的轨迹曲线是通过采用本发明的方法每隔50ms计算一次两个机动目标的状态估计值,将计算134次后的所有两个机动目标的状态估计值绘制得到的。横坐标表示在三维空间中两个机动目标的位置坐标沿着x轴移动对应的值,纵坐标表示在三维空间中机动目标的位置坐标沿着y轴移动对应的值,竖坐标表示在三维空间中机动目标的位置坐标沿着z轴移动对应的值,单位为米(m)。图3中以虚线标示的曲线表示两个高机动目标的量测轨迹曲线,以实线标示的曲线表示两个高机动目标跟踪的轨迹曲线,以加号标示的曲线表示雷达所在载机的运动轨迹曲线。
图4是对机动目标1跟踪过程中距离误差随机载雷达与机动目标1之间的距离变化的曲线图。其主要是通过将本发明方法获得的机动目标1跟踪的轨迹曲线和真实轨迹曲线对比得到的。图4中的横坐标表示机载雷达与机动目标1之间的距离,单位是千米,纵坐标表示机动目标1的距离误差,单位为米。在图4中,以点线标示的曲线表示机动目标1距离的量测误差曲线,该曲线是由机动目标1在每个时刻的距离量测值与方位角真实值做差然后取绝对值绘制得到的,以实线标示的曲线表示机动目标1距离的跟踪误差曲线,该曲线是由机动目标1在每个时刻的距离估计值与距离真实值做差然后取绝对值绘制得到的。
图5是对机动目标1跟踪过程中方位角误差随机载雷达与机动目标1之间的距离变化的曲线图。图5是通过将本发明方法获得的机动目标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-VB的非高斯噪声条件下机动目标自适应跟踪方法,其特征在于,包括:
步骤1:获取机动目标的量测值;
步骤2:构建包括多个运动模型的模型集,并对机动目标的状态估计值、精度矩阵以及共轭先验分布参数分别进行交互混合,对应得到每个运动模型的混合状态输入值、混合精度矩阵以及共轭先验分布的混合参数;
步骤3:基于所述量测值,利用变分贝叶斯算法对每个运动模型的混合状态输入值、混合精度矩阵以及共轭先验分布的混合参数进行滤波处理,以更新每个运动模型的状态估计值和精度矩阵;
步骤4:对所述模型集中的每个运动模型对应的概率进行更新;
步骤5:基于每个运动模型对应的概率以及每个运动模型的状态估计值和精度矩阵更新机动目标在当前时刻的状态估计值和精度矩阵。
2.根据权利要求1所述的基于IMM-VB的非高斯噪声条件下机动目标自适应跟踪方法,其特征在于,在步骤2中,对机动目标的状态估计值、精度矩阵以及共轭先验分布参数分别进行交互混合,包括:
利用状态混合公式计算模型集中每个运动模型的混合状态输入值;所述状态混合公式为:
利用精度矩阵混合公式计算模型集中每个运动模型的混合精度矩阵;所述精度矩阵混合公式为:
利用参数混合公式计算基于模型集中每个运动模型的共轭先验分布的混合参数,计算公式为:
3.根据权利要求2所述的基于IMM-VB的非高斯噪声条件下机动目标自适应跟踪方法,其特征在于,步骤3包括:
3a) 计算模型集中每个运动模型的状态、精度矩阵以及共轭先验分布参数的预测值和联合预测后验概率密度函数;
3b) 利用变分贝叶斯方法对共轭先验分布参数进行学习,使得近似后验概率密度函数与真实后验概率密度函数的KL散度最小化,以更新每个运动模型的状态估计值和精度矩阵。
5.根据权利要求4所述的基于IMM-VB的非高斯噪声条件下机动目标自适应跟踪方法,其特征在于,步骤3b)包括:
构建真实后验概率密度函数,并将其表示为近似的一个自由因子形式的近似PDF;
将近似后验概率密度函数与所述真实后验概率密度函数的KL散度最小化,从而得到最优的近似后验概率密度函数,以更新每个运动模型的状态估计值和精度矩阵。
6.根据权利要求5所述的基于IMM-VB的非高斯噪声条件下机动目标自适应跟踪方法,其特征在于,所述真实后验密度函数的近似的一个自由因子形式的近似PDF为:
Priority Applications (1)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
CN202211024277.9A CN115542309A (zh) | 2022-08-25 | 2022-08-25 | 基于imm-vb的非高斯噪声条件下机动目标自适应跟踪方法 |
Applications Claiming Priority (1)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
CN202211024277.9A CN115542309A (zh) | 2022-08-25 | 2022-08-25 | 基于imm-vb的非高斯噪声条件下机动目标自适应跟踪方法 |
Publications (1)
Publication Number | Publication Date |
---|---|
CN115542309A true CN115542309A (zh) | 2022-12-30 |
Family
ID=84726394
Family Applications (1)
Application Number | Title | Priority Date | Filing Date |
---|---|---|---|
CN202211024277.9A Pending CN115542309A (zh) | 2022-08-25 | 2022-08-25 | 基于imm-vb的非高斯噪声条件下机动目标自适应跟踪方法 |
Country Status (1)
Country | Link |
---|---|
CN (1) | CN115542309A (zh) |
Cited By (1)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
CN116794646A (zh) * | 2023-06-19 | 2023-09-22 | 哈尔滨工业大学 | 基于变分贝叶斯推理的混合体制高频雷达目标跟踪方法 |
-
2022
- 2022-08-25 CN CN202211024277.9A patent/CN115542309A/zh active Pending
Cited By (2)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
CN116794646A (zh) * | 2023-06-19 | 2023-09-22 | 哈尔滨工业大学 | 基于变分贝叶斯推理的混合体制高频雷达目标跟踪方法 |
CN116794646B (zh) * | 2023-06-19 | 2024-04-19 | 哈尔滨工业大学 | 基于变分贝叶斯推理的混合体制高频雷达目标跟踪方法 |
Similar Documents
Publication | Publication Date | Title |
---|---|---|
US12072705B2 (en) | Intelligent decision-making method and system for unmanned surface vehicle | |
CN114022847B (zh) | 一种智能体轨迹预测方法、系统、设备和存储介质 | |
CN101221238B (zh) | 基于高斯均值移动配准的动态偏差估计方法 | |
CN104297748A (zh) | 一种基于轨迹增强的雷达目标检测前跟踪方法 | |
CN104715154B (zh) | 基于kmdl准则判据的核k‑均值航迹关联方法 | |
CN111562571B (zh) | 一种未知新生强度的机动多目标跟踪与航迹维持方法 | |
CN115542309A (zh) | 基于imm-vb的非高斯噪声条件下机动目标自适应跟踪方法 | |
CN111913484A (zh) | 一种变电站巡检机器人在未知环境下的路径规划方法 | |
CN113759364A (zh) | 一种基于激光地图的毫米波雷达连续定位方法及装置 | |
Zhao et al. | Adaptive non-linear joint probabilistic data association for vehicle target tracking | |
CN105424043A (zh) | 一种基于判断机动的运动状态估计方法 | |
Qian et al. | An INS/DVL integrated navigation filtering method against complex underwater environment | |
CN105842686A (zh) | 基于粒子平滑的快速tbd检测方法 | |
CN116047495B (zh) | 一种用于三坐标雷达的状态变换融合滤波跟踪方法 | |
Ebert et al. | Deep radar sensor models for accurate and robust object tracking | |
CN115128597B (zh) | 基于imm-stekf的非高斯噪声下机动目标跟踪方法 | |
CN116702459A (zh) | 基于仿真红外成像导航模型的对抗仿真导航方法及系统 | |
CN113376626A (zh) | 基于immpda算法的高机动目标跟踪方法 | |
CN113866754B (zh) | 基于高斯分布波门的运动目标航迹关联方法 | |
CN115544425A (zh) | 一种基于目标信噪比特征估计的鲁棒多目标跟踪方法 | |
Thormann et al. | Incorporating Range Rate Measurements in EKF-based Elliptical Extended Object Tracking | |
Hem et al. | Compensating radar rotation in target tracking | |
Murphy et al. | Road-assisted multiple target tracking in clutter | |
CN117928559B (zh) | 一种基于强化学习的威胁规避下无人机路径规划方法 | |
Chen et al. | Target tracking using particle filter with X-band nautical radar |
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 |