CN109284677B - 一种贝叶斯滤波目标跟踪算法 - Google Patents
一种贝叶斯滤波目标跟踪算法 Download PDFInfo
- Publication number
- CN109284677B CN109284677B CN201810935639.7A CN201810935639A CN109284677B CN 109284677 B CN109284677 B CN 109284677B CN 201810935639 A CN201810935639 A CN 201810935639A CN 109284677 B CN109284677 B CN 109284677B
- Authority
- CN
- China
- Prior art keywords
- target
- moment
- target state
- state
- estimation
- 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
- G06—COMPUTING; CALCULATING OR COUNTING
- G06F—ELECTRIC DIGITAL DATA PROCESSING
- G06F2218/00—Aspects of pattern recognition specially adapted for signal processing
- G06F2218/02—Preprocessing
- G06F2218/04—Denoising
-
- 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
-
- 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
- G01S7/00—Details of systems according to groups G01S13/00, G01S15/00, G01S17/00
- G01S7/02—Details of systems according to groups G01S13/00, G01S15/00, G01S17/00 of systems according to group G01S13/00
-
- G—PHYSICS
- G06—COMPUTING; CALCULATING OR COUNTING
- G06F—ELECTRIC DIGITAL DATA PROCESSING
- G06F18/00—Pattern recognition
- G06F18/20—Analysing
- G06F18/25—Fusion techniques
Landscapes
- Engineering & Computer Science (AREA)
- General Physics & Mathematics (AREA)
- Remote Sensing (AREA)
- Radar, Positioning & Navigation (AREA)
- Physics & Mathematics (AREA)
- Theoretical Computer Science (AREA)
- Data Mining & Analysis (AREA)
- General Engineering & Computer Science (AREA)
- Computer Networks & Wireless Communication (AREA)
- Computer Vision & Pattern Recognition (AREA)
- Artificial Intelligence (AREA)
- Signal Processing (AREA)
- Life Sciences & Earth Sciences (AREA)
- Bioinformatics & Cheminformatics (AREA)
- Bioinformatics & Computational Biology (AREA)
- Evolutionary Biology (AREA)
- Evolutionary Computation (AREA)
- Radar Systems Or Details Thereof (AREA)
Abstract
本发明公开了一种贝叶斯滤波目标跟踪算法,本发明方法第一步,由k‑1时刻的目标状态最优估计通过运动模型得到下一个时刻的目标状态一步预测估计;第二步,由雷达观测站获得k时刻目标的观测值后采用随机变量固定点采样非线性变换方法将目标相对于雷达的距离信息和角度信息转化为目标的笛卡尔坐标位置信息;第三步,将目标状态一步预测先验信息和雷达观测反向估计似然函数两部分信息,通过本发明的概率似然乘积规则进行乘积融合最终得到k时刻目标状态的后验估计,储存目标状态后更新时刻并进入下一轮迭代,本发明具有精度更高、鲁棒性更好、算法结构更简明的特点,在雷达、多传感器、机动和多目标跟踪方面具有很高的实用价值。
Description
技术领域
本发明涉及一种贝叶斯滤波目标跟踪算法,属于目标跟踪领域。
背景技术
目标跟踪在军事和民用领域都具有广泛的应用,如空中监视、卫星和飞船跟踪以及智能交通和视频监控等。目标跟踪问题实质上是一个状态估计问题,其核心是滤波算法。
根据动态系统空间模型的不同,可将滤波问题分为线性滤波和非线性滤波。上世纪七十年代,卡尔曼滤波器成功的被应用于目标跟踪领域,作为目标跟踪领域最经典的线性滤波算法,在线性高斯情况下,卡尔曼滤波器的滤波结果在最小方差,最大似然等准则下都是最优的。利用克拉美罗下限可以证明,本发明在线性高斯情况下跟卡尔曼滤波精度一致。面对非线性滤波问题,近三十年来,大量学者和专家提出了许多有效的非线性滤波算法,最著名的有扩展卡尔曼滤波(extended Kalman filter,EKF)、无迹卡尔曼滤波(Unscented Kalman filter,UKF)、粒子滤波(Particle filter,PF),但它们都存在一些问题,如扩展卡尔曼滤波算法存在线性化精度较低和需要计算复杂的雅可比矩阵;一般无迹卡尔曼滤波算法存在计算繁琐、滤波发散甚至失真的问题,粒子滤波存在计算量大和权值退化的问题。
所以寻找新的、滤波精度高的、鲁棒的、简明高效目标跟踪算法一直是研究人员努力的方向。
发明内容
鉴于传统非线性滤波器存在的问题,本发明的目的在于提供一种贝叶斯滤波目标跟踪算法,本算法是一种在贝叶斯滤波框架下不同于卡尔曼体系的新的滤波方法,用以提高滤波的精度和鲁棒性。本发明方法通过随机变量固定点采样非线性变换方法,将传感器的观测数据反向估计得到目标状态的似然信息,进一步在贝叶斯滤波框架下,将通过运动模型预测的目标状态先验信息和从观测反向估计的目标状态似然信息通过乘积进行有效的融合,得到比一般非线性滤波算法精度更高的估计。
本发明的技术方案如下:(1)初始化数据,确定目标的初始位置、状态、运动模型(机动目标一般采用多模型),运动模型的过程噪声,传感器的位置、观测噪声等,相关噪声一般都采用高斯白噪声。
(2)结合运动模型求出目标状态的一步预测先验信息,通常为高斯分布,非高斯场景的一步预测可近似为多峰的混合高斯分布。
(3)通过传感器获得目标的观测数据后,通过随机变量固定点采样非线性变换方法(包括Unscented变换、Cabuture变换或高斯厄米特数值积分等)将观测信息转换成目标状态信息,此目标状态信息一般只包含目标的位置信息,为了与目标状态的一步预测维度保持一致,我们对它进行扩维处理,即在没有的维度处置零。
(4)运用本发明推导的贝叶斯滤波乘积融合规则,将借助运动模型得到的目标状态先验信息和从观测数据得到的目标状态似然信息进行融合,计算出目标状态的后验估计。
一种贝叶斯滤波目标跟踪算法,具体步骤如下:
(1)按照贝叶斯滤波方法,将k-1时刻目标状态的后验估计均值和方差Pk-1/k-1代入反映目标运动规律的状态方程,求出k时刻目标状态xk的先验估计概率其中Pk/k-1分别表示先验估计的均值和方差,Zk-1表示0~k-1时刻目标的观测数据集;
(3)采用贝叶斯滤波公式p(xk|Zk)=p(zk|xk,Zk-1)p(xk|Zk-1)/p(zk|Zk-1)将步骤(1)得到的k时刻目标状态的先验估计概率与步骤(2)得到的目标状态的似然函数进行乘积融合,求出k时刻目标状态的后验估计概率其中,为后验估计均值、Pk|k为后验估计方差,p(zk|Zk-1)为归一化常数;
所述步骤(2)中,通过随机变量固定点采样非线性变换方法将k时刻雷达观测数据zk转换为目标状态的似然函数,该随机变量固定点采样非线性变换方法为Unscented变换、Cabuture变换或高斯厄米特数值积分。
所述Unscented变换的具体步骤如下:
其中n为量测数据的维度。
所述步骤(3)采用贝叶斯滤波公式进行概率乘积融合时,对低维数据进行扩维处理,扩维时,无信息维度处置0。
所述步骤(3)采用贝叶斯滤波公式p(xk|Zk)=p(zk|xk,Zk-1)p(xk|Zk-1)/p(zk|Zk-1)将步骤(1)得到的k时刻目标状态的先验估计概率与步骤(2)得到的目标状态的似然函数进行乘积融合,其融合的规则为:
与现有非线性滤波技术相比,本发明的有益效果是:
(1)本发明将借助运动模型获得的目标状态先验信息与传感器数据反向估计得到的目标状态似然信息进行了有效的融合,具有精度更高和鲁棒性更强的特点。
(2)本发明算法结构更简明,应用范围广,在雷达、多传感器、机动和多目标跟踪方面具有很高的实用价值。
附图说明
图1为本发明的工作流程简图;
图2是本发明实施例中本发明和经典算法100次蒙特卡洛仿真的位置均方根误差比较图;
图3是本发明实施例中本发明和经典算法100次蒙特卡洛仿真的速度均方根误差比较图。
具体实施方式
下面结合附图和实施例对本发明作进一步说明。
实施例1:本实施例中雷达观测站位于坐标原点,目标在平面内做近似匀速直线运动,目标的非线性系统方程描述如下:
xk=Fxk-1+Lvk-1
在直角坐标系下,取目标的运动参数(位置、速度)作为系统的状态向量,即其中x和分别表示X轴上的位置分量和速度分量,y和分别表示Y轴上的位置分量和速度分量,目标的初始状态为x0=[50m/s 1m/s 50m/s -1m/s]T。
zk是观测向量,其分量rk和θk分别为斜距和方向角,系统噪声vk-1和wk是均值为零的高斯白噪声序列,其协方差矩阵分别为Q和R。仿真时间为100s,采样时间T=1s。
按照Unscented变换规则计算出状态似然一、二阶矩(UT实现):
由于雷达观测向量反向估计得到的目标状态似然只有位置信息,即状态向量的维度数只有2,与运动模型端的估计状态不匹配,所以对反向估计得到的状态似然信息进行扩维处理,扩维矩阵为:
扩维处理如下:
得到运动模型端先验信息和观测端似然信息后,采用本发明方法的贝叶斯滤波乘积融合规则,对两部分信息进行乘积融合完成一次滤波,得到目标状态和方差的后验估计为:
储存后验估计信息,进入下一步迭代,运行100步直至完成借助Unscented变换实施的本发明算法。
获得k时刻的雷达观测向量zk后,按照Cubature变换规则产生样本点和权值(C实现):计算观测端状态似然一、二阶矩:再对运动模型端先验信息和观测端状态似然进行乘积融合,完成一步贝叶斯滤波;储存后验估计信息,进入下一步迭代,运行100步直至完成借助Cubature变换实施的本发明算法。
获得k时刻的雷达观测向量zk后,按照高斯厄米特积分规则产生样本点和权值(GH实现):计算观测端状态似然一、二阶矩:再对运动模型端先验信息和观测端状态似然进行乘积融合,完成一步贝叶斯滤波;储存后验估计信息,进入下一步迭代,运行100步直至完成借助高斯厄米特积分方法实施的本发明算法。
为了验证本发明的稳定性和有效性,进行100次蒙特卡洛仿真,图2为不同算法位置均方根误差比较,图3为不同算法速度均方根误差比较,表1呈现出不同算法平均耗时及目标跟踪平均误差统计结果。
表1蒙特卡洛统计分析结果
从表1、图2和图3可以看出相对其他经典算法,本发明滤波精度更高,耗时相对较少,具有较高的实际应用价值。
尽管本发明已经给出和描述了本发明的实施例,但其并非用以限定本发明,任何熟悉此技术的人,在不脱离本发明的精神和范围内,都可做各种改动和修饰,因此本发明的保护范围应该以权力要求书所界定的为准。
Claims (1)
1.一种贝叶斯滤波雷达目标跟踪方法,其特征在于,具体步骤如下:
(1)按照贝叶斯滤波方法,将k-1时刻目标状态的后验估计均值和方差Pk-1k-1代入反映目标运动规律的状态方程,求出k时刻目标状态xk的先验估计概率其中Pk-1k-1分别表示先验估计的均值和方差,Zk-1表示0~k-1时刻目标的雷达观测数据集;
(3)采用贝叶斯滤波公式p(xk|Zk)=p(zk|xk,Zk-1)p(xk|Zk-1)/p(zk|Zk-1)将步骤(1)得到的k时刻目标状态的先验估计概率与步骤(2)得到的目标状态的似然函数进行乘积融合,求出k时刻目标状态的后验估计概率其中,为后验估计均值、Pk|k为后验估计方差,p(zk|Zk-1)为归一化常数;
所述步骤(2)中,通过随机变量固定点采样非线性变换方法将k时刻雷达观测数据zk转换为目标状态的似然函数,该随机变量固定点采样非线性变换方法为Unscented变换、Cabuture变换或高斯厄米特数值积分;
所述Unscented变换的具体步骤如下:
其中n为量测数据的维度;
所述步骤(3)采用贝叶斯滤波公式进行概率乘积融合时,对低维数据进行扩维处理,扩维时,无信息维度处置0;
所述步骤(3)采用贝叶斯滤波公式p(xk|Zk)=p(zk|xk,Zk-1)p(xk|Zk-1)/p(zk|Zk-1)将步骤(1)得到的k时刻目标状态的先验估计概率与步骤(2)得到的目标状态的似然函数进行乘积融合,其融合的规则为:
Priority Applications (1)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
CN201810935639.7A CN109284677B (zh) | 2018-08-16 | 2018-08-16 | 一种贝叶斯滤波目标跟踪算法 |
Applications Claiming Priority (1)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
CN201810935639.7A CN109284677B (zh) | 2018-08-16 | 2018-08-16 | 一种贝叶斯滤波目标跟踪算法 |
Publications (2)
Publication Number | Publication Date |
---|---|
CN109284677A CN109284677A (zh) | 2019-01-29 |
CN109284677B true CN109284677B (zh) | 2022-06-03 |
Family
ID=65183087
Family Applications (1)
Application Number | Title | Priority Date | Filing Date |
---|---|---|---|
CN201810935639.7A Active CN109284677B (zh) | 2018-08-16 | 2018-08-16 | 一种贝叶斯滤波目标跟踪算法 |
Country Status (1)
Country | Link |
---|---|
CN (1) | CN109284677B (zh) |
Families Citing this family (10)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
CN110046378B (zh) * | 2019-02-28 | 2022-09-13 | 昆明理工大学 | 一种基于进化多目标优化的选择性分层集成高斯过程回归软测量建模方法 |
CN110702095B (zh) * | 2019-09-30 | 2022-09-16 | 江苏大学 | 一种数据驱动的高精度组合导航数据融合方法 |
WO2021081816A1 (zh) * | 2019-10-30 | 2021-05-06 | 深圳市大疆创新科技有限公司 | 一种数据处理方法、装置和可移动平台 |
CN111722214B (zh) * | 2020-06-03 | 2024-01-30 | 昆明理工大学 | 雷达多目标跟踪phd实现方法 |
CN111965594B (zh) * | 2020-07-14 | 2023-06-06 | 杭州电子科技大学 | 一种基于特征值搜索的轻量级直接跟踪方法 |
CN111948601B (zh) * | 2020-07-31 | 2024-01-30 | 中国电子科技集团公司第四十一研究所 | 一种非高斯噪声条件下的单站纯角度目标定位与跟踪方法 |
CN112285698B (zh) * | 2020-12-25 | 2021-04-20 | 四川写正智能科技有限公司 | 一种基于雷达传感器的多目标跟踪装置及方法 |
CN113537299A (zh) * | 2021-06-23 | 2021-10-22 | 西北工业大学 | 基于期望最大化高斯混合缩减的分布式贝叶斯滤波器目标跟踪方法 |
CN113514810B (zh) * | 2021-07-07 | 2023-07-18 | 北京信息科技大学 | Mimo雷达观测噪声优化方法及装置 |
CN115201799A (zh) * | 2022-09-09 | 2022-10-18 | 昆明理工大学 | 一种用于声呐的时变卡尔曼滤波跟踪方法 |
Citations (2)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
CN103902819A (zh) * | 2014-03-21 | 2014-07-02 | 哈尔滨工程大学 | 基于变分滤波的粒子优化概率假设密度多目标跟踪方法 |
CN104794735A (zh) * | 2015-04-02 | 2015-07-22 | 西安电子科技大学 | 基于变分贝叶斯期望最大化的扩展目标跟踪方法 |
Family Cites Families (1)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
EP2799902A1 (en) * | 2013-04-30 | 2014-11-05 | Baselabs GmbH | Method and apparatus for the tracking of multiple objects |
-
2018
- 2018-08-16 CN CN201810935639.7A patent/CN109284677B/zh active Active
Patent Citations (2)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
CN103902819A (zh) * | 2014-03-21 | 2014-07-02 | 哈尔滨工程大学 | 基于变分滤波的粒子优化概率假设密度多目标跟踪方法 |
CN104794735A (zh) * | 2015-04-02 | 2015-07-22 | 西安电子科技大学 | 基于变分贝叶斯期望最大化的扩展目标跟踪方法 |
Non-Patent Citations (1)
Title |
---|
贝叶斯目标跟踪方法的研究;郭晓松等;《计算机工程》;20090630;第35卷(第12期);参见第137-139页 * |
Also Published As
Publication number | Publication date |
---|---|
CN109284677A (zh) | 2019-01-29 |
Similar Documents
Publication | Publication Date | Title |
---|---|---|
CN109284677B (zh) | 一种贝叶斯滤波目标跟踪算法 | |
CN106646453B (zh) | 一种基于预测值量测转换的多普勒雷达目标跟踪方法 | |
CN111722214B (zh) | 雷达多目标跟踪phd实现方法 | |
CN110543929A (zh) | 一种基于Lorenz系统的风速区间预测方法及系统 | |
Shi et al. | Adaptive UKF for target tracking with unknown process noise statistics | |
CN106600624B (zh) | 基于粒子群的粒子滤波视频目标跟踪方法 | |
CN112115419A (zh) | 系统状态估计方法、系统状态估计装置 | |
CN108871365B (zh) | 一种航向约束下的状态估计方法及系统 | |
CN116500575B (zh) | 一种基于变分贝叶斯理论的扩展目标跟踪方法和装置 | |
CN111181529A (zh) | 一种应用于非线性高斯模型的平滑约束扩展卡尔曼滤波方法 | |
CN111289964A (zh) | 一种基于径向速度的无偏量测转换的多普勒雷达目标运动状态估计方法 | |
CN111765883B (zh) | 机器人蒙特卡罗定位方法、设备及存储介质 | |
CN111736144B (zh) | 一种仅用距离观测的机动转弯目标状态估计方法 | |
CN115685128B (zh) | 一种机动目标场景下的雷达目标跟踪算法及电子设备 | |
CN112379350A (zh) | 智能车辆毫米波雷达多目标跟踪方法、装置及设备 | |
CN109375159B (zh) | 纯方位加权约束总体最小二乘定位方法 | |
CN107977943B (zh) | 一种基于提纯优化的空间目标光谱解混方法 | |
CN113030945B (zh) | 一种基于线性序贯滤波的相控阵雷达目标跟踪方法 | |
CN115544425A (zh) | 一种基于目标信噪比特征估计的鲁棒多目标跟踪方法 | |
CN114415157A (zh) | 一种基于水声传感器网络的水下目标多模型跟踪方法 | |
CN114445456A (zh) | 基于部分模型的数据驱动智能机动目标跟踪方法及装置 | |
CN117784114B (zh) | 异常噪声下基于混合熵的不规则扩展目标跟踪方法 | |
CN116224320B (zh) | 一种极坐标系下处理多普勒量测的雷达目标跟踪方法 | |
CN110991354A (zh) | 基于逆空间变换网络的isar图像识别方法 | |
CN112731395B (zh) | 基于非凸&全变差正则化的sar成像方法 |
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 |