CN111444474A - 一种基于乘性噪声相关自适应ckf的目标跟踪方法 - Google Patents
一种基于乘性噪声相关自适应ckf的目标跟踪方法 Download PDFInfo
- Publication number
- CN111444474A CN111444474A CN202010211107.6A CN202010211107A CN111444474A CN 111444474 A CN111444474 A CN 111444474A CN 202010211107 A CN202010211107 A CN 202010211107A CN 111444474 A CN111444474 A CN 111444474A
- Authority
- CN
- China
- Prior art keywords
- noise
- multiplicative
- ckf
- noise correlation
- measurement
- 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.)
- Granted
Links
- 238000000034 method Methods 0.000 title claims abstract description 26
- 238000005259 measurement Methods 0.000 claims abstract description 29
- 238000001914 filtration Methods 0.000 claims abstract description 16
- 239000000654 additive Substances 0.000 claims abstract description 14
- 230000000996 additive effect Effects 0.000 claims abstract description 14
- 238000005094 computer simulation Methods 0.000 claims abstract description 5
- 239000011159 matrix material Substances 0.000 claims description 18
- 230000003044 adaptive effect Effects 0.000 claims description 7
- 150000001875 compounds Chemical class 0.000 claims description 6
- 238000006243 chemical reaction Methods 0.000 claims description 3
- 230000002596 correlated effect Effects 0.000 claims description 2
- 238000000354 decomposition reaction Methods 0.000 claims description 2
- 230000004927 fusion Effects 0.000 claims description 2
- 238000006073 displacement reaction Methods 0.000 claims 2
- NAWXUBYGYWOOIX-SFHVURJKSA-N (2s)-2-[[4-[2-(2,4-diaminoquinazolin-6-yl)ethyl]benzoyl]amino]-4-methylidenepentanedioic acid Chemical compound C1=CC2=NC(N)=NC(N)=C2C=C1CCC1=CC=C(C(=O)N[C@@H](CC(=C)C(O)=O)C(O)=O)C=C1 NAWXUBYGYWOOIX-SFHVURJKSA-N 0.000 description 1
- 230000009286 beneficial effect Effects 0.000 description 1
- 238000005070 sampling Methods 0.000 description 1
Images
Classifications
-
- G—PHYSICS
- G06—COMPUTING; CALCULATING OR COUNTING
- G06F—ELECTRIC DIGITAL DATA PROCESSING
- G06F17/00—Digital computing or data processing equipment or methods, specially adapted for specific functions
- G06F17/10—Complex mathematical operations
- G06F17/18—Complex mathematical operations for evaluating statistical data, e.g. average values, frequency distributions, probability functions, regression analysis
Landscapes
- Engineering & Computer Science (AREA)
- Physics & Mathematics (AREA)
- Data Mining & Analysis (AREA)
- General Physics & Mathematics (AREA)
- Mathematical Optimization (AREA)
- Pure & Applied Mathematics (AREA)
- Theoretical Computer Science (AREA)
- Mathematical Physics (AREA)
- Computational Mathematics (AREA)
- Mathematical Analysis (AREA)
- Life Sciences & Earth Sciences (AREA)
- Operations Research (AREA)
- Probability & Statistics with Applications (AREA)
- Bioinformatics & Cheminformatics (AREA)
- Algebra (AREA)
- Evolutionary Biology (AREA)
- Databases & Information Systems (AREA)
- Software Systems (AREA)
- General Engineering & Computer Science (AREA)
- Bioinformatics & Computational Biology (AREA)
- Measurement Of Mechanical Vibrations Or Ultrasonic Waves (AREA)
- Radar Systems Or Details Thereof (AREA)
Abstract
本发明涉及一种基于乘性噪声相关自适应CKF的目标跟踪方法,本发明大体包括三部分内容。第一部分根据实际运动目标进行系统建模;第二部分,根据乘性噪声相关系统设计了乘性噪声相关CKF算法;第三部分,根据协方差匹配原理自适应地估计出噪声相关系数,使用乘性噪声相关自适应CKF算法实时计算得到运动目标的状态。本发明既能实现对量测系统中乘性量测噪声与加性量测噪声相关的运动目标的状态估计,又能解决噪声相关系数不准确时的滤波状态估计问题,极大地提高了目标跟踪的精度,实现了对复杂工程环境中目标状态的有效跟踪。
Description
技术领域
本发明涉及一种基于乘性噪声相关自适应CKF的目标跟踪方法,属于目标跟踪领域,可用于提高目标跟踪的精度。
背景技术
卡尔曼滤波的一个重要作用是去除量测数据中的噪声,尽可能地还原相对真实的目标数据,被广泛地应用在目标跟踪中。然而,卡尔曼滤波具有一定的局限性,该理论是以线性系统为对象建立的,而实际目标跟踪系统多为非线性。应用线性模型描述非线性系统将导致较大的模型误差,从而导致滤波估计性能降低。因此,非线性滤波估计成为研究热点和难点,大量非线性滤波方法得以提出。
容积卡尔曼滤波(CKF)是一种基于采样近似的非线性高斯滤波方法,具有较高的滤波估计性能,受到广大科研人员和工程技术人员的喜爱。然而,该滤波理论是建立在滤波模型精准且过程噪声和量测噪声均为不相关的高斯白噪声的前提下成立的。经研究表明,实际目标跟踪系统较为复杂,系统量测中不仅存在加性噪声,同时还存在乘性噪声的干扰。
乘性噪声一般是由信道不理想引起的,如测量过程中的抖动振动,信号能量的衰减等,其与信号是相乘的关系,导致传感器量测噪声随着距离的增大而增大,并且乘性量测噪声与加性量测噪声具有相关性。因此,本发明首先对乘性噪声与加性噪声相关系统的滤波器进行重新设计。由于实际工程环境的复杂性,噪声的相关性很难得到,模型参数往往是未知或者不准确的,国内已有学者提出当滤波模型与实际系统不匹配时滤波的估计性能度量将会不准确。本发明提出一种乘性噪声相关自适应CKF算法用以解决乘性噪声相关系数不精准情形下的目标跟踪问题。
发明内容
为了应对乘性量测噪声与加性量测噪声相关以及噪声相关系数不精准情况下的目标跟踪精度较低的问题,本发明设计了乘性噪声相关CKF算法,使用协方差匹配法自适应估计噪声相关系数,得到乘性噪声相关自适应CKF算法,并将其应用到目标跟踪问题中,提高了目标跟踪的精度。
本发明大体包括三部分内容。第一部分根据实际运动目标进行系统建模;第二部分,根据乘性噪声相关系统设计了乘性噪声相关CKF算法;第三部分,根据协方差匹配原理自适应地估计出噪声相关系数,使用乘性噪声相关自适应CKF算法得到目标状态。
利用本发明不仅可以应对乘性噪声与加性噪声相关的情况,而且能够处理噪声相关系数不精准问题,提高了复杂系统下目标跟踪的精度,本发明具体包括以下步骤:
步骤1.系统建模
考虑如下具有乘性噪声相关的离散时间非线性系统模型,其跟踪目标的状态方程和量测方程如下:
式中:是k时刻的系统状态向量,其是由x方向位移和速度以及y方向位移和速度构成,f和h分别为已知非线性过程函数和非线性量测函数。是k时刻系统的量测向量,过程噪声wk-1是零均值协方差矩阵为Qk-1的高斯白噪声向量;Ak=diag{1+uk,…,1+uk}=(1+uk)I,uk和vk分别是乘性和加性高斯白噪声,并具有相关性,vk=[v1,k,…,vm,k]T,且E{vk}=μv1=μv[1,…,1]T,wk-1和vk互不相关。
步骤2.模型转换
将量测方程表示为非线性量测和虚拟量测噪声的总和:
步骤3.给出乘性噪声相关CKF算法,具体如下:
步骤3.2计算E{h(xk)}、Var{h(xk)}和Cov{xk,h(xk)}:
式中Sk|k-1为由预测误差协方差矩阵Pk|k-1经过cholesky分解得到,ξi为提前确定的cubature点,和都为k时刻第i个cubature点,E{h(xk)}和为h(xk)的均值,Var{h(xk)}为h(xk)的方差,Cov{xk,h(xk)}为xk和h(xk)的互协方差。
步骤4.给出噪声相关系数不精准情况下的乘性噪声相关自适应CKF算法,具体如下:
其中,rk为滤波新息,其公式如下:
步骤4.3给出噪声相关系数估计值的计算方法:
令
式中,Ck表示噪声不相关时的新息协方差矩阵。
当系统中乘性噪声相关时且相关性不确定时,使用该方法估计出噪声相关系数,并将其代入式(11),不断对上面两个模块内容进行迭代计算,便可实现对目标状态的实时跟踪估计。
本发明的有益效果:本发明既能处理乘性量测噪声与加性量测噪声相关问题,又能应对噪声相关系数不精准的滤波估计问题,实现了复杂情形下对目标的有效跟踪。
附图说明
图1:本发明方法的流程图。
具体实施方法
本发明提出一种基于乘性噪声相关自适应CKF的目标跟踪方法,首先根据实际目标的运动状态建立乘性噪声相关系统模型,其次给出乘性噪声相关CKF算法的步骤,最后给出乘性噪声相关自适应CKF算法,其流程图如图1所示,包括以下几个步骤:
步骤1.系统建模
考虑如下具有乘性噪声相关的离散时间非线性系统模型,其跟踪目标的状态方程和量测方程如下:
式中:是k时刻的系统状态向量,其是由x方向位移和速度以及y方向位移和速度构成,f和h分别为已知非线性过程函数和非线性量测函数。是k时刻系统的量测向量,过程噪声wk-1是零均值协方差矩阵为Qk-1的高斯白噪声向量;Ak=diag{1+uk,…,1+uk}=(1+uk)I,uk和vk分别是乘性和加性高斯白噪声,并具有相关性,vk=[v1,k,…,vm,k]T,且E{vk}=μv1=μv[1,…,1]T,wk-1和vk互不相关。
步骤2.模型转换
将量测方程表示为非线性量测和虚拟量测噪声的总和:
步骤4.根据公式(4)-公式(9)计算出E{h(xk)}、Var{h(xk)}和Cov{xk,h(xk)}。
步骤5.若噪声相关系数精准,则根据公式(10)-公式(17)进行量测更新,得到状态估计值和估计误差协方差。
通过对步骤3-6进行循环迭代,便能实现对目标状态的实时跟踪估计。
本发明所述基于乘性噪声相关自适应CKF的目标跟踪方法不仅能够实现量测系统出现乘性量测噪声与加性量测噪声相关的目标状态估计,而且提供了噪声相关系数不精准时的自适应滤波状态估计方法,有效地实现了复杂工程环境下的目标跟踪功能。
Claims (1)
1.一种基于乘性噪声相关自适应CKF的目标跟踪方法,其特征在于该方法包括以下步骤:
步骤1.系统建模
考虑如下具有乘性噪声相关的离散时间非线性系统模型,其跟踪目标的状态方程和量测方程如下:
式中:是k时刻的系统状态向量,其是由x方向位移和速度以及y方向位移和速度构成,f和h分别为已知非线性过程函数和非线性量测函数;是k时刻系统的量测向量,过程噪声wk-1是零均值协方差矩阵为Qk-1的高斯白噪声向量;Ak=diag{1+uk,…,1+uk}=(1+uk)I,uk和vk分别是乘性和加性高斯白噪声,并具有相关性,vk=[v1,k,…,vm,k]T,且E{vk}=μv1=μv[1,…,1]T,wk-1和vk互不相关;
步骤2.模型转换
将量测方程表示为非线性量测和虚拟量测噪声的总和:
步骤3.给出乘性噪声相关CKF算法,具体如下:
步骤3.2计算E{h(xk)}、Var{h(xk)}和Cov{xk,h(xk)}:
式中Sk|k-1为由预测误差协方差矩阵Pk|k-1经过cholesky分解得到,ξi为提前确定的cubature点,和都为k时刻第i个cubature点,E{h(xk)}和为h(xk)的均值,Var{h(xk)}为h(xk)的方差,Cov{xk,h(xk)}为xk和h(xk)的互协方差;
步骤4.给出噪声相关系数不精准情况下的乘性噪声相关自适应CKF算法,具体如下:
其中,rk为滤波新息,其公式如下:
步骤4.3给出噪声相关系数估计值:
令
式中,Ck表示噪声不相关时的新息协方差矩阵;
当系统中乘性噪声相关时且相关性不确定时,估计出噪声相关系数,并将其代入式(11),不断进行迭代计算,便可实现对目标状态的实时跟踪估计。
Priority Applications (1)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
CN202010211107.6A CN111444474B (zh) | 2020-03-24 | 2020-03-24 | 一种基于乘性噪声相关自适应ckf的目标跟踪方法 |
Applications Claiming Priority (1)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
CN202010211107.6A CN111444474B (zh) | 2020-03-24 | 2020-03-24 | 一种基于乘性噪声相关自适应ckf的目标跟踪方法 |
Publications (2)
Publication Number | Publication Date |
---|---|
CN111444474A true CN111444474A (zh) | 2020-07-24 |
CN111444474B CN111444474B (zh) | 2024-02-27 |
Family
ID=71650728
Family Applications (1)
Application Number | Title | Priority Date | Filing Date |
---|---|---|---|
CN202010211107.6A Active CN111444474B (zh) | 2020-03-24 | 2020-03-24 | 一种基于乘性噪声相关自适应ckf的目标跟踪方法 |
Country Status (1)
Country | Link |
---|---|
CN (1) | CN111444474B (zh) |
Cited By (3)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
CN112034713A (zh) * | 2020-09-07 | 2020-12-04 | 山东大学 | 非理想网络环境下移动目标的最优状态估计方法及系统 |
CN112284384A (zh) * | 2020-10-26 | 2021-01-29 | 东南大学 | 考虑量测异常的集群式多深海潜航器的协同定位方法 |
CN115450858A (zh) * | 2022-10-18 | 2022-12-09 | 山东大学 | 基于数字孪生的风机叶片状态检测方法及系统 |
Citations (5)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
CN103294897A (zh) * | 2013-05-09 | 2013-09-11 | 哈尔滨工程大学 | 一种用于船舶动力定位位置参考系统的自适应滤波方法 |
CN106767837A (zh) * | 2017-02-23 | 2017-05-31 | 哈尔滨工业大学 | 基于容积四元数估计的航天器姿态估计方法 |
CN108304612A (zh) * | 2017-12-26 | 2018-07-20 | 南京邮电大学 | 基于噪声补偿的迭代平方根ckf的汽车雷达目标跟踪方法 |
CN109556636A (zh) * | 2019-01-14 | 2019-04-02 | 杭州电子科技大学 | 一种应用于传递对准上的可观测度智能自适应滤波方法 |
CN109829938A (zh) * | 2019-01-28 | 2019-05-31 | 杭州电子科技大学 | 一种应用在目标跟踪的自适应容错容积卡尔曼滤波方法 |
-
2020
- 2020-03-24 CN CN202010211107.6A patent/CN111444474B/zh active Active
Patent Citations (5)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
CN103294897A (zh) * | 2013-05-09 | 2013-09-11 | 哈尔滨工程大学 | 一种用于船舶动力定位位置参考系统的自适应滤波方法 |
CN106767837A (zh) * | 2017-02-23 | 2017-05-31 | 哈尔滨工业大学 | 基于容积四元数估计的航天器姿态估计方法 |
CN108304612A (zh) * | 2017-12-26 | 2018-07-20 | 南京邮电大学 | 基于噪声补偿的迭代平方根ckf的汽车雷达目标跟踪方法 |
CN109556636A (zh) * | 2019-01-14 | 2019-04-02 | 杭州电子科技大学 | 一种应用于传递对准上的可观测度智能自适应滤波方法 |
CN109829938A (zh) * | 2019-01-28 | 2019-05-31 | 杭州电子科技大学 | 一种应用在目标跟踪的自适应容错容积卡尔曼滤波方法 |
Non-Patent Citations (8)
Title |
---|
SISI WANG等: "Performance Comparisons of Adaptive Cubature Kalman Filters", 2015 FIFTH INTERNATIONAL CONFERENCE ON INSTRUMENTATION AND MEASUREMENT, COMPUTER, COMMUNICATION AND CONTROL, vol. 978, pages 1 - 110 * |
XIAOHANG WU等: "Improved Cubature Kalman Filter for High-Dimensional Systems with Multiplicative Noises", JOURNAL OFAEROSPACE INFORMATION SYSTEMS, vol. 16, no. 12 * |
YULONG HUANG: "A Novel Adaptive Kalman Filter With Inaccurate Process and Measurement Noise Covariance Matrices", TRANSACTIONS ON AUTOMATIC CONTROL, vol. 63, no. 2, XP055961658, DOI: 10.1109/TAC.2017.2730480 * |
ZHENBING QIU等: "Adaptive robust cubature Kalman filtering for satellite attitude estimation", CHINESE JOURNAL OF AERONAUTICS, vol. 31, no. 4 * |
何美光: "复合自适应Kalman滤波及其应用研究", 中国优秀硕士学位论文全文数据库, no. 01 * |
张旭等: "一种鲁棒自适应容积卡尔曼滤波方法 及其在相对导航中的应用", 兵工学报, vol. 39, no. 1 * |
杨衍波: "不确定参数耦合系统状态估计与融合研究", 中国博士学位论文全文数据库, no. 05, pages 002 - 17 * |
黄硕;李冠男;荆涛;曹洁;: "新型自适应容积卡尔曼滤波算法及其在目标跟踪中的应用", 现代信息科技, no. 02 * |
Cited By (5)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
CN112034713A (zh) * | 2020-09-07 | 2020-12-04 | 山东大学 | 非理想网络环境下移动目标的最优状态估计方法及系统 |
CN112034713B (zh) * | 2020-09-07 | 2021-10-19 | 山东大学 | 非理想网络环境下移动目标的最优状态估计方法及系统 |
CN112284384A (zh) * | 2020-10-26 | 2021-01-29 | 东南大学 | 考虑量测异常的集群式多深海潜航器的协同定位方法 |
CN112284384B (zh) * | 2020-10-26 | 2023-11-17 | 东南大学 | 考虑量测异常的集群式多深海潜航器的协同定位方法 |
CN115450858A (zh) * | 2022-10-18 | 2022-12-09 | 山东大学 | 基于数字孪生的风机叶片状态检测方法及系统 |
Also Published As
Publication number | Publication date |
---|---|
CN111444474B (zh) | 2024-02-27 |
Similar Documents
Publication | Publication Date | Title |
---|---|---|
CN111985093B (zh) | 一种带噪声估计器的自适应无迹卡尔曼滤波状态估计方法 | |
CN111444474A (zh) | 一种基于乘性噪声相关自适应ckf的目标跟踪方法 | |
CN109163720A (zh) | 基于渐消记忆指数加权的卡尔曼滤波跟踪方法 | |
CN112418051B (zh) | 一种用于非线性动态系统非高斯噪声下的状态估计方法 | |
CN103389094B (zh) | 一种改进的粒子滤波方法 | |
KR100816269B1 (ko) | 언센티드 필터를 적용한 강인한 동시 위치 추정 및 지도작성 방법 | |
CN111291319B (zh) | 一种应用于非高斯噪声环境下的移动机器人状态估计方法 | |
CN108717174B (zh) | 基于信息论的预测快速协方差交互融合无源协同定位方法 | |
CN109061686B (zh) | 基于递归广义最大互熵的自适应多径估计方法 | |
CN108871365B (zh) | 一种航向约束下的状态估计方法及系统 | |
CN111693984A (zh) | 一种改进的ekf-ukf动目标跟踪方法 | |
CN109687844A (zh) | 一种智能机动目标跟踪方法 | |
CN105701292B (zh) | 一种机动目标转弯角速度的解析辨识方法 | |
CN114063131A (zh) | 一种gnss/ins/轮速组合定位实时平滑的方法 | |
Huang et al. | A bank of maximum a posteriori estimators for single-sensor range-only target tracking | |
CN113779497A (zh) | 一种解决量测信息存在随机时延和丢包的目标跟踪方法 | |
CN114995403B (zh) | 相关噪声及非高斯干扰下轮式移动机器人轨迹跟踪方法 | |
CN115498980A (zh) | 一种基于M估计的递归最小p阶自适应滤波定位方法 | |
CN115859626A (zh) | 针对周期运动目标的自适应无迹卡尔曼滤波器设计方法 | |
CN112489075B (zh) | 基于特征函数的序惯式多传感器融合滤波方法 | |
CN113654554B (zh) | 一种快速自适应的动态惯性导航实时解算去噪方法 | |
CN113391285A (zh) | 一种量测随机延迟下带闪烁噪声的目标跟踪平滑方法 | |
CN113048979A (zh) | 一种组合导航滤波方法 | |
CN112631130A (zh) | 一种面向时延和噪声的ilc系统输入信号最优估计方法 | |
CN112241583A (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 |