CN104298650B - 基于多方法融合的量化卡尔曼滤波方法 - Google Patents
基于多方法融合的量化卡尔曼滤波方法 Download PDFInfo
- Publication number
- CN104298650B CN104298650B CN201410522855.0A CN201410522855A CN104298650B CN 104298650 B CN104298650 B CN 104298650B CN 201410522855 A CN201410522855 A CN 201410522855A CN 104298650 B CN104298650 B CN 104298650B
- Authority
- CN
- China
- Prior art keywords
- fusion
- kalman filtering
- estimation
- covariance
- target
- 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
Landscapes
- Radar Systems Or Details Thereof (AREA)
Abstract
本发明涉及一种基于多方法融合的量化卡尔曼滤波方法,本发明大体包括三部分内容。第一部分根据实际目标运动进行系统建模;第二部分参考相关文献,分别给定QKF‑STF和VB‑AQKF的最优估计结果;第三部分使用QKF‑MMF实现最优线性加权融合,其中包括计算最优加权矩阵、最终目标状态的加权融合状态估计、融合估计误差协方差及互协方差矩阵。上述方法既具有强跟踪功能还能对未知方差进行动态估计,不仅实现了在线实时估计还提高目标跟踪的精确度。因此,该发明能够通过雷达所测得的现有数据准确估计任意时刻目标的运动状态,实现了目标跟踪的功能。
Description
技术领域
本发明属于线性系统的目标跟踪领域,特别涉及一种基于多方法融合的量化卡尔曼滤波方法。
背景技术
线性滤波理论被广泛应用于目标跟踪、信息处理和故障诊断等应用领域当中,其发展较之于非线性滤波已然相当成熟。尤其,在分布式传感器网络系统大量涌现的时代背景下,量化滤波和融合已经在信号处理和控制等领域成为了热点研究话题。
卡尔曼滤波器(KF)最初是由R.E Kalman处理线性动态系统的状态估计时提出来的,它建立在模型精确、随机干扰信号统计特性已知以及状态没有突变的基础上。但在实际系统中,往往存在这些不确定因素,这导致了Kalman滤波算法的估计精度大大降低,失去了原先的最优性。在此基础上,强跟踪(STF)方法和变分贝叶斯(VB)方法的引入使得问题得到了有效的解决。在状态突变且估计量化误差的方差未知情况下,STF通过引入渐消因子来自动调节一步预测误差协方差,以有效跟踪状态即实现了强跟踪功能,提高了估计精度,但它无法估计量测噪声的未知方差。而VB能实时在线估计量测噪声的未知方差,它提高了系统的估计精度,但鲁棒性能较差。实际上,量测噪声的方差为强跟踪滤波提供了基础,量测噪声的方差的准确计算提高了强跟踪的自适应能力;而强跟踪渐消因子则有助于量化估计适应最新信息并能从中提取出有效信息。因此在这种复杂环境下,最优线性加权融合技术的引入,同步实现了强跟踪功能和针对量测噪声未知方差的动态估计功能,提高了状态估计的精确性。
发明内容
为了应对上面提到的未知量测噪声方差和状态突变等情况,本发明参考运用基于强跟踪量化卡尔曼滤波(QKF-STF)方法得到的估计结果与基于变分贝叶斯自适应量化卡尔曼滤波(VB-AQKF)方法得到的估计结果进行加权融合,提出了一种新的线性滤波方法,即基于多方法融合的量化卡尔曼滤波方法(QKF-MMF)。
本发明大体包括三部分内容。第一部分根据实际目标运动进行系统建模;第二部分参考相关文献,分别给定QKF-STF和VB-AQKF的最优估计结果;第三部分使用QKF-MMF实现最优线性加权融合,其中包括计算最优加权矩阵、最终目标状态的加权融合状态估计、融合估计误差协方差及互协方差矩阵。
利用本发明实现的线性滤波器不仅具有强跟踪能力,而且还能动态估计量测噪声的未知方差。
附图说明
图1为本发明方法的流程图。
具体实施方式
下面首先为跟踪目标的运动状态建立模型,其次给出基于强跟踪的量化卡尔曼滤波和基于变分贝叶斯的自适应量化卡尔曼滤波的估计结果,最后给出基于多方法融合的量化卡尔曼滤波方法,以估计运动状态,实现目标跟踪。下面详细介绍本发明的实施过程。
步骤1.系统建模
考虑二维平面目标的跟踪问题,假设目标为匀速运动模型,给出跟踪系统模型如下
式中,k是时间指数,是系统状态向量(是n×1维列向量全集),分别由运动状态的距离和速度构成;是相应的从k-1到k时刻系统状态转移矩阵;是传感器观测值,即表示由雷达所测得的距离;是相关观测矩阵。和为均值为零,方差分别为Qk,k-1和Rk的高斯白噪声,即:
其中E{·}是均值运算。假设初始状态为X0,其中均值和方差分别是和P0|0,并且与Wk,k-1和Vk不相关。
步骤2.分别给定QKF-STF和VB-AQKF的最优估计结果
强跟踪滤波器具有较强的针对模型不确定性的鲁棒性能,同时对于突变状态具有极强的跟踪能力。而变分贝叶斯方法用于实现状态和观测噪声未知方差的同步估计。参考《VB-AQKF-STF:A Novel Linear State Estimator for Stochastic QuantizedMeasurements Systems》,得出基于强跟踪量化卡尔曼滤波(QKF-STF)方法得到的状态估计和估计误差协方差P1,k|k,基于变分贝叶斯自适应量化卡尔曼滤波(VB-AQKF)方法得到的状态估计和估计误差协方差P2,k|k。
步骤3.给出基于多方法融合的量化卡尔曼滤波方法
针对步骤二中所给定的QKF-STF和VB-AQKF,它们只能分别实现强跟踪和量化信息噪声未知方差估计功能。因此,引入基于多方法融合的量化卡尔曼滤波方法,通过融合前两种方法的估计结果,同步实现了两种功能,即针对非精确系统模型和状态突变的强跟踪功能以及针对量测噪声未知方差的动态估计功能。
(3.1)假设加权融合估计
式中,假设A1,k和A2,k是最优加权矩阵;分别是QKF-STF和VB-AQKF的最优状态估计;
(3.2)计算最优加权矩阵A1,k,A2,k和融合估计误差协方差矩阵Pf,k|k:
根据如下最优约束条件:
式中,
其中,P12,k|k和P21,k|k是融合估计误差互协方差矩阵;
得到最优加权矩阵和融合估计误差协方差矩阵如下:
Pf,k|k=P1,k|k-A2,k(P1,k|k-P21,k|k) (7)
式中,Mk=P1,k|k+P2,k|k-P12,k|k-P21,k|k;将最优加权矩阵代入式(3)中,即可得到最终加权融合估计
(3.3)计算滤波增益Kq,k(q=1,2):
式中,是量测噪声的未知方差,Pq,k|k(q=1,2)分别是QKF-STF和VB-AQKF的估计误差协方差矩阵;
(3.4)根据上式所求得的加权融合估计,计算融合估计误差互协方差矩阵P12,k|k和P21,k|k:
式中,根据初始条件可得P12,0|0=P21,0|0=P0|0。
本发明使用多方法融合的量化卡尔曼滤波方法能够同步实现两种功能,即针对非精确系统模型和状态突变的强跟踪功能以及针对信息噪声未知方差的动态估计功能。综上所述,基于多方法融合的量化卡尔曼滤波方法通过雷达所测得的数据并融合多种方法的状态估计结果,能够准确地估计任意时刻目标的运动状态,提高了估计精度,有效地实现了目标跟踪的功能。
Claims (1)
1.基于多方法融合的量化卡尔曼滤波方法,其特征在于该方法包括以下步骤:
步骤1.系统建模,考虑二维平面目标的跟踪问题,假设目标为匀速运动模型,给出跟踪目标的系统模型如下:
式中,k是时间指数,Xk是系统状态向量,分别由运动状态的距离和速度组成;φk,k-1是相应的从k-1到k时刻系统状态转移矩阵;Zk是传感器观测值,即表示由雷达所测得的距离;Hk是相关观测矩阵;Wk,k-1是均值为零方差Qk,k-1的高斯白噪声,Vk是均值为零方差Rk的高斯白噪声;假设初始状态为X0,其中均值和方差分别是和P0|0,并且与Wk,k-1和Vk不相关;
步骤2.分别给定基于强跟踪量化卡尔曼滤波和基于变分贝叶斯自适应量化卡尔曼滤波的最优估计结果,具体是:
得出基于强跟踪量化卡尔曼滤波得到的状态估计和估计误差协方差P1,k|k,基于变分贝叶斯自适应量化卡尔曼滤波得到的状态估计和估计误差协方差P2,k|k;
步骤3.给出基于多方法融合的量化卡尔曼滤波方法
(3.1)假设加权融合估计
式中,假设A1,k和A2,k是最优加权矩阵;
(3.2)计算最优加权矩阵A1,k,A2,k和融合估计误差协方差矩阵Pf,k|k:
根据如下最优约束条件:
可得:
Pf,k|k=P1,k|k-A2,k(P1,k|k-P21,k|k);
式中,Pq,k|k(q=1,2)分别是基于强跟踪量化卡尔曼滤波和基于变分贝叶斯自适应量化卡尔曼滤波的估计误差协方差矩阵;P12,k|k和P21,k|k是融合估计误差互协方差矩阵;Mk=P1,k|k+P2,k|k-P12,k|k-P21,k|k;将最优加权矩阵代入(3.1)中,即可得到最终加权融合估计
(3.3)计算滤波增益Kq,k(q=1,2):
式中,是量测噪声的未知方差;
(3.4)根据上式所求得的加权融合估计,计算融合估计误差互协方差矩阵P12,k|k和P21,k|k:
式中,是量测噪声的未知方差;根据初始条件可得P12,0|0=P21,0|0=P0|0。
Priority Applications (1)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
CN201410522855.0A CN104298650B (zh) | 2014-09-30 | 2014-09-30 | 基于多方法融合的量化卡尔曼滤波方法 |
Applications Claiming Priority (1)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
CN201410522855.0A CN104298650B (zh) | 2014-09-30 | 2014-09-30 | 基于多方法融合的量化卡尔曼滤波方法 |
Publications (2)
Publication Number | Publication Date |
---|---|
CN104298650A CN104298650A (zh) | 2015-01-21 |
CN104298650B true CN104298650B (zh) | 2017-05-10 |
Family
ID=52318379
Family Applications (1)
Application Number | Title | Priority Date | Filing Date |
---|---|---|---|
CN201410522855.0A Active CN104298650B (zh) | 2014-09-30 | 2014-09-30 | 基于多方法融合的量化卡尔曼滤波方法 |
Country Status (1)
Country | Link |
---|---|
CN (1) | CN104298650B (zh) |
Families Citing this family (6)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
CN105699903B (zh) * | 2016-01-15 | 2019-03-26 | 宁波飞拓电器有限公司 | 一种基于变分贝叶斯ckf的应急灯电池soc估计方法 |
CN106454892B (zh) * | 2016-08-30 | 2020-02-11 | 衢州学院 | 一种基于量化和事件的集值卡尔曼滤波方法 |
CN108599737B (zh) * | 2018-04-10 | 2021-11-23 | 西北工业大学 | 一种变分贝叶斯的非线性卡尔曼滤波器的设计方法 |
CN111612729B (zh) * | 2020-05-26 | 2023-06-23 | 杭州电子科技大学 | 基于卡尔曼滤波的目标序列跟踪图像恢复方法 |
CN114519728A (zh) * | 2022-01-25 | 2022-05-20 | 河南大学 | 未知噪声下的变分贝叶斯强跟踪phd多目标跟踪方法 |
CN116303786B (zh) * | 2023-03-18 | 2023-10-27 | 上海圈讯科技股份有限公司 | 一种基于多维数据融合算法的区块链金融大数据管理系统 |
Citations (2)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
CN103345735A (zh) * | 2013-07-16 | 2013-10-09 | 上海交通大学 | 一种基于Kalman滤波器的压缩时空多传感器融合跟踪方法 |
CN103776453A (zh) * | 2014-01-22 | 2014-05-07 | 东南大学 | 一种多模型水下航行器组合导航滤波方法 |
Family Cites Families (1)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
US20100230347A1 (en) * | 2007-08-08 | 2010-09-16 | Haslem Keith R | Adjustable height inlet/outlet liquid level management tools and systems |
-
2014
- 2014-09-30 CN CN201410522855.0A patent/CN104298650B/zh active Active
Patent Citations (2)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
CN103345735A (zh) * | 2013-07-16 | 2013-10-09 | 上海交通大学 | 一种基于Kalman滤波器的压缩时空多传感器融合跟踪方法 |
CN103776453A (zh) * | 2014-01-22 | 2014-05-07 | 东南大学 | 一种多模型水下航行器组合导航滤波方法 |
Non-Patent Citations (2)
Title |
---|
Federated Cubature Kalman Filter for Multi-sensor Information Fusion;Binglei Guan,et al.;《2012 International Conference on Computer Technology and Science (ICCTS 2012)》;20120930;第47卷;第253-258页 * |
基于EKF的集中式融合估计研究;葛泉波,等;《自动化学报》;20130630;第39卷(第6期);第816-825页 * |
Also Published As
Publication number | Publication date |
---|---|
CN104298650A (zh) | 2015-01-21 |
Similar Documents
Publication | Publication Date | Title |
---|---|---|
CN104298650B (zh) | 基于多方法融合的量化卡尔曼滤波方法 | |
CN109508445B (zh) | 一种带有色量测噪声和变分贝叶斯自适应卡尔曼滤波的目标跟踪方法 | |
CN107292344B (zh) | 一种基于环境交互的机器人实时控制方法 | |
CN107765347B (zh) | 一种高斯过程回归和粒子滤波的短期风速预测方法 | |
CN107396322B (zh) | 基于路径匹配与编码译码循环神经网络的室内定位方法 | |
CN106487358B (zh) | 一种机动目标转弯跟踪方法 | |
CN107451102B (zh) | 一种基于改进自训练算法的半监督高斯过程回归软测量建模对脱丁烷塔底丁烷浓度进行预测的方法 | |
CN110849369B (zh) | 机器人跟踪方法、装置、设备及计算机可读存储介质 | |
CN106599368B (zh) | 基于改进粒子提议分布和自适应粒子重采样的FastSLAM方法 | |
CN102853836B (zh) | 一种基于航迹质量的反馈加权融合方法 | |
CN105352535A (zh) | 一种基于多传感器数据融合的测量方法 | |
CN107994885B (zh) | 一种同时估计未知输入和状态的分布式融合滤波方法 | |
CN103900541B (zh) | 一种海况估计器 | |
CN104462015B (zh) | 处理非高斯Lévy噪声的分数阶线性离散系统状态更新方法 | |
CN110501696A (zh) | 一种基于多普勒量测自适应处理的雷达目标跟踪方法 | |
CN104318072B (zh) | 基于qkf‑mmf的多传感器量化融合方法 | |
CN110865343A (zh) | 基于lmb的粒子滤波检测前跟踪方法及系统 | |
CN103778320A (zh) | 一种基于变分贝叶斯多传感器量化融合目标跟踪方法 | |
CN110031798A (zh) | 一种基于简化Sage-Husa自适应滤波的室内目标跟踪方法 | |
CN109752710A (zh) | 一种基于稀疏贝叶斯学习的快速目标角度估计方法 | |
CN110084295B (zh) | 一种多智能体系统分组包围控制方法及控制系统 | |
CN109341690A (zh) | 一种鲁棒高效的组合导航自适应数据融合方法 | |
CN106570536B (zh) | 一种时差定位系统目标高精度跟踪滤波方法 | |
She et al. | A new adaptive local linear prediction method and its application in hydrological time series | |
CN109379058B (zh) | 基于平方根容积信息一致的分布式非线性状态估计方法 |
Legal Events
Date | Code | Title | Description |
---|---|---|---|
C06 | Publication | ||
PB01 | Publication | ||
C10 | Entry into substantive examination | ||
SE01 | Entry into force of request for substantive examination | ||
GR01 | Patent grant | ||
GR01 | Patent grant |