CN112859004A - 基于改进卡尔曼滤波的野值剔除方法 - Google Patents
基于改进卡尔曼滤波的野值剔除方法 Download PDFInfo
- Publication number
- CN112859004A CN112859004A CN202110005005.3A CN202110005005A CN112859004A CN 112859004 A CN112859004 A CN 112859004A CN 202110005005 A CN202110005005 A CN 202110005005A CN 112859004 A CN112859004 A CN 112859004A
- Authority
- CN
- China
- Prior art keywords
- innovation
- covariance
- value
- measurement
- time
- 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 31
- 238000001914 filtration Methods 0.000 title claims abstract description 27
- 238000005259 measurement Methods 0.000 claims abstract description 41
- 239000011159 matrix material Substances 0.000 claims abstract description 9
- 238000012937 correction Methods 0.000 claims description 6
- 238000012545 processing Methods 0.000 claims description 4
- 238000004364 calculation method Methods 0.000 claims description 2
- 230000000694 effects Effects 0.000 abstract description 5
- 230000008030 elimination Effects 0.000 abstract description 2
- 238000003379 elimination reaction Methods 0.000 abstract description 2
- 230000008569 process Effects 0.000 description 7
- 238000005070 sampling Methods 0.000 description 2
- 230000001133 acceleration Effects 0.000 description 1
- 230000009286 beneficial effect Effects 0.000 description 1
- 238000004422 calculation algorithm Methods 0.000 description 1
- 230000008859 change Effects 0.000 description 1
- 238000010586 diagram Methods 0.000 description 1
- 230000006872 improvement Effects 0.000 description 1
- 238000012986 modification Methods 0.000 description 1
- 230000004048 modification Effects 0.000 description 1
- 230000001105 regulatory effect Effects 0.000 description 1
- 238000004088 simulation 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
- 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
- G01—MEASURING; TESTING
- G01C—MEASURING DISTANCES, LEVELS OR BEARINGS; SURVEYING; NAVIGATION; GYROSCOPIC INSTRUMENTS; PHOTOGRAMMETRY OR VIDEOGRAMMETRY
- G01C23/00—Combined instruments indicating more than one navigational value, e.g. for aircraft; Combined measuring devices for measuring two or more variables of movement, e.g. distance, speed or acceleration
-
- 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
- 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
-
- G—PHYSICS
- G06—COMPUTING; CALCULATING OR COUNTING
- G06T—IMAGE DATA PROCESSING OR GENERATION, IN GENERAL
- G06T5/00—Image enhancement or restoration
- G06T5/70—Denoising; Smoothing
-
- G—PHYSICS
- G06—COMPUTING; CALCULATING OR COUNTING
- G06T—IMAGE DATA PROCESSING OR GENERATION, IN GENERAL
- G06T7/00—Image analysis
- G06T7/20—Analysis of motion
- G06T7/277—Analysis of motion involving stochastic approaches, e.g. using Kalman filters
-
- G—PHYSICS
- G06—COMPUTING; CALCULATING OR COUNTING
- G06T—IMAGE DATA PROCESSING OR GENERATION, IN GENERAL
- G06T2207/00—Indexing scheme for image analysis or image enhancement
- G06T2207/20—Special algorithmic details
- G06T2207/20076—Probabilistic image processing
Landscapes
- Engineering & Computer Science (AREA)
- Physics & Mathematics (AREA)
- General Physics & Mathematics (AREA)
- Radar, Positioning & Navigation (AREA)
- Remote Sensing (AREA)
- Theoretical Computer Science (AREA)
- Data Mining & Analysis (AREA)
- Computer Networks & Wireless Communication (AREA)
- Pure & Applied Mathematics (AREA)
- Mathematical Optimization (AREA)
- Computational Mathematics (AREA)
- Mathematical Physics (AREA)
- Mathematical Analysis (AREA)
- Evolutionary Biology (AREA)
- Databases & Information Systems (AREA)
- Operations Research (AREA)
- Probability & Statistics with Applications (AREA)
- Bioinformatics & Cheminformatics (AREA)
- Algebra (AREA)
- Life Sciences & Earth Sciences (AREA)
- Bioinformatics & Computational Biology (AREA)
- Software Systems (AREA)
- General Engineering & Computer Science (AREA)
- Aviation & Aerospace Engineering (AREA)
- Multimedia (AREA)
- Computer Vision & Pattern Recognition (AREA)
- Image Analysis (AREA)
Abstract
本发明公开了一种基于改进卡尔曼滤波的野值剔除方法,包括:通过开窗估计法得到k‑N+1时刻至k时刻的新息值v,并以此计算新息协方差的数学期望;通过比较当前预测新息协方差和新息协方差数学期望矩阵的迹,得到调节因子λ;根据调节因子动态修正真实量测,得到调整后的量测,并用其进行状态估计。本发明所用方法是根据以往获得的量测新息,计算其新息协方差的数学期望,并与当前预测的新息协方差值进行比较得到比值,利用该比值动态的修正真实量测,从而达到自适应调整的效果,而无需人为的设置。
Description
技术领域
本发明涉及一种野值剔除方法,具体是一种基于改进卡尔曼滤波的野值剔除方法。
背景技术
在多目标跟踪领域中,由于观测背景存在大量杂波和噪声,以及传感器本身的观测误差。所获取的量测会存在与实际情况不符合的“野值”。而这样“野值”目标如果不加以去除,会对后面的数据处理带来很大的误差,甚至导致后续数据关联错误、滤波发散等。
因此,在对量测数据进行处理时首先需要根据工程需求,以及传感器本身参数对一些不可能的“野值”目标进行剔除。
祝转民等学者提出了一种动态剔除野值的方法,利用新息协方差设定置信区间,再用一个常量因子乘以预测误差协方差矩阵,判断其值是否在置信区间内,从而达到剔除野值的目的,但常量因子依然需要预先人为设置。
发明内容
本发明的目的在于提供一种基于改进的卡尔曼滤波的野值剔除办法。
实现本发明目的的技术解决方案为:一种基于改进卡尔曼滤波的野值剔除方法,包括:
步骤1、通过开窗估计法得到k-N+1时刻至k时刻的新息值v,并以此计算新息协方差的数学期望;
步骤2、通过比较当前预测新息协方差和新息协方差数学期望矩阵的迹,得到调节因子λ;
步骤3、根据调节因子动态修正真实量测,得到调整后的量测,并用其进行状态估计。
进一步的,步骤1具体为:
(1)量测预测
Z(k|k-1)=H(k)*X(k|k-1)
H(k)为观测矩阵,X(k|k-1)为k时刻的状态预测值,Z(k|k-1)为量测预测值;
(2)量测预测协方差
S(k)=H(k)*P(k|k-1)*H(k)+R(k)
P(k|k-1)为状态协方差预测值,R(k)为k时刻噪声方差;
(3)卡尔曼增益
K=P(k|k-1)*H(k)'*S(k)-1
S(k)为k时刻新息协方差,K为卡尔曼增益;
(4)状态更新方程
X(k|k)=X(k|k-1)+K*(Z(k)-Z(k|k-1))
X(k|k)为k时刻的状态滤波值;
假设在k时刻出现野值
Zf=Z+Δv
Δv是野值相较于真实量测的误差值,那么新息也将有着Δv的偏移;最终导致状态估计值X(k|k-1)有着K*Δv误差,这一误差将被传递至下一轮的迭代滤波;
采用开窗估计法,获得当前时刻的新息协方差的数学期望:
进一步的,步骤2具体为:
进一步的,步骤3具体为:
Z_real为修正之后的量测值;
最终的状态估计为:
X(k)=X(k|k-1)+K*(Z_real-Z(k|k-1))
=X(k|k-1)+K*λ*(Z(k)-Z(k|k-1))
本发明与现有技术相比,具有以下有益效果:(1)本发明所用方法是根据以往获得的量测新息,计算其新息协方差的数学期望,并与当前预测的新息协方差值进行比较得到比值,利用该比值动态的修正真实量测。从而达到自适应调整的效果,而无需人为的设置;(2)本发明原理简单,实时性好,可以实时进行状态估计并剔除野值;并且只需要保留前N帧的新息值,具有常量级的空间复杂度。
下面结合附图对本发明作进一步详细描述。
附图说明
图1为基于改进卡尔曼滤波的野值剔除方法流程图。
图2为正常卡尔曼滤波与该进后卡尔曼滤波轨迹图。
图3为滤波结果对比图。
图4为滤波误差曲线图。
具体实施方式
本发明针对在目标跟踪过程中的状态滤波部分,提出一种动态改进新息的方法,本发明所述的新息为目标在距离上的真实测量值与预测值之间的差值。目标的真实量测可表示为Z(k)=[x,y]',其中x,y代表目标在二维空间坐标下的距离值,该值由实际工程中各类传感器如雷达、超声波传感器、摄像头等获得。目标的状态可表示为X(k)=[x,vx,ax,y,vy,ay]'。前三项和后三项分别代表在x、y方向的目标距离、速度、加速度,是目标的真实运动属性。通过传感器对目标真实状态X进行观测得到量测值Z。然后利用本发明在卡尔曼滤波框架下对量测进行实时地判断修正,并保证在递推滤波过程中卡尔滤波器稳定。
首先给出卡尔曼滤波的部分公式:
(1)量测预测
Z(k|k-1)=H(k)*X(k|k-1)
X(k|k-1)为k时刻的状态预测值
(2)量测预测协方差(新息协方差)
S(k)=H(k)*P(k|k-1)*H(k)+R(k)
(3)卡尔曼增益
K=P(k|k-1)*H'*S(k)-1
(4)状态更新方程
X(k|k)=X(k|k-1)+K*(Z(k)-Z(k|k-1))
一个稳态的卡尔曼滤波器,在完整的跟踪流程中能够保证其收敛。而在滤波过程中,一旦将错误的量测纳入计算,那么极有可能会导致滤波器的发散。滤波的目的就是得出该时刻目标的最优估计。由上述公式可得,目标的最终估计值是预测值加上一个增益之后新息。新息是当前的量测与量测的预测值之间的差异。一个稳态的卡尔曼滤波其新息协方差应该满足“式(2)”,而当量测出现野值时,必然会导致该关系遭到破坏。
假设在k时刻出现野值
Zf=Z+Δv
Δv是野值相较于真实量测的误差值。那么新息也将有着Δv的偏移。最终致状态估计值X(k|k-1)有着K*Δv误差,这一误差将被传递至下一轮的迭代滤波,并最终导致滤波器的发散。
基于这一点对卡尔曼滤波量测预测部分进行改进,我们假设在k时刻之前的估计和预测都是准确的,那么在k时刻的新息协方差则是理想的。采用开窗估计法,获得当前时刻的新息协方差的数学期望:
vj是j时刻的新息,为k-N+1至当前k时刻的新息的平方均值,作为当前时刻新息协方差的数学期望。量测预测协方差的值越小,越加反映量测的准确性。因此当的值小于等于的相应值时,我们认为此时的量测是有效的,而当的值大于相应的值时,量测具有不确定性,需要对当前的量测进行修正,具体修正措施如下:
其中
Z_real为修正之后的量测值,λ为调节因子,该值由理论新息协方差S(k)和新息协方差数学期望矩阵的迹之比组成。从上式可以看出,当新息协方差数学期望值小于等于理想预测的新息协方差值tr(S(k))时,此时我们认为该量测是有效的,不做任何处理;当时,根据两者的比值作为调节因子来修正真实的量测。可以看出当与S(k)相差越大时,实际量测的准确性越遭到质疑,作用也更小,相应的量测预测值的作用更大。理想情况下当量测数据完全不合实际时,此时采用量测预测值作为真实量测。最终可以得到最终的状态估计为
X(k)=X(k|k-1)+K*(Z_pre-Z(k|k-1))
=X(k|k-1)+K*λ*(Z(k)-Z(k|k-1))
最终的算法过程如图1所示。
为了验证算法的有效性,假设一目标初始状态为X(0)=[-5m,0m/s,50m,-5m/s]做匀速直线运动,假设采样间隔为50ms。采样时间为10s。假设过程噪声和量测噪声均为高斯白噪声,过程噪声标准差为qx=0.5m,qy=0.1m;量测噪声标准差为rx=0.2m,ry=0.2m。假设分别在第45次、第123次、第176次扫描时误将野值目标作为真实量测。应用标准卡尔曼和改进过的卡尔曼滤波进行仿真。
图2包含目标的真实轨迹,改进后的卡尔曼滤波器滤波后的轨迹图,以及经典卡尔曼滤波滤波后的轨迹图。
图3为图2在野值出现处的局部放大图。从图3可以看出,当量测值明显不合实际时,标准的卡尔曼滤波器的滤波轨迹出现了“毛刺”,从图4也可以看出,在野值出现处标准卡尔曼滤波误差变化较大。而用改进后的卡尔曼滤波,则能够有较好的滤波效果。
以上所述实施例仅表达了本申请的几种实施方式,其描述较为具体和详细,但并不能因此而理解为对发明专利范围的限制。应当指出的是,对于本领域的普通技术人员来说,在不脱离本申请构思的前提下,还可以做出若干变形和改进,这些都属于本申请的保护范围。因此,本申请专利的保护范围应以所附权利要求为准。
Claims (4)
1.一种基于改进卡尔曼滤波的野值剔除方法,其特征在于,包括:
步骤1、通过开窗估计法得到k-N+1时刻至k时刻的新息值v,并以此计算新息协方差的数学期望;
步骤2、通过比较当前预测新息协方差和新息协方差数学期望矩阵的迹,得到调节因子λ;
步骤3、根据调节因子动态修正真实量测,得到调整后的量测,并用其进行状态估计。
2.根据权利要求1所述的基于改进卡尔曼滤波的野值剔除方法,其特征在于,步骤1具体为:
(1)量测预测
Z(k|k-1)=H(k)*X(k|k-1)
H(k)为观测矩阵,X(k|k-1)为k时刻的状态预测值,Z(k|k-1)为量测预测值;
(2)量测预测协方差
S(k)=H(k)*P(k|k-1)*H(k)+R(k)
P(k|k-1)为状态协方差预测值,R(k)为k时刻噪声方差;
(3)卡尔曼增益
K=P(k|k-1)*H(k)'*S(k)-1
S(k)为k时刻新息协方差,K为卡尔曼增益;
(4)状态更新方程
X(k|k)=X(k|k-1)+K*(Z(k)-Z(k|k-1))
X(k|k)为k时刻的状态滤波值;
假设在k时刻出现野值
Zf=Z+Δv
Δv是野值相较于真实量测的误差值,那么新息也将有Δv的偏移;最终导致状态估计值X(k|k-1)有着K*Δv误差,这一误差将被传递至下一轮的迭代滤波;
采用开窗估计法,获得当前时刻的新息协方差的数学期望:
Priority Applications (1)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
CN202110005005.3A CN112859004A (zh) | 2021-01-04 | 2021-01-04 | 基于改进卡尔曼滤波的野值剔除方法 |
Applications Claiming Priority (1)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
CN202110005005.3A CN112859004A (zh) | 2021-01-04 | 2021-01-04 | 基于改进卡尔曼滤波的野值剔除方法 |
Publications (1)
Publication Number | Publication Date |
---|---|
CN112859004A true CN112859004A (zh) | 2021-05-28 |
Family
ID=76001559
Family Applications (1)
Application Number | Title | Priority Date | Filing Date |
---|---|---|---|
CN202110005005.3A Pending CN112859004A (zh) | 2021-01-04 | 2021-01-04 | 基于改进卡尔曼滤波的野值剔除方法 |
Country Status (1)
Country | Link |
---|---|
CN (1) | CN112859004A (zh) |
Citations (9)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
CN106021194A (zh) * | 2016-05-19 | 2016-10-12 | 哈尔滨工业大学 | 一种多传感器多目标跟踪偏差估计方法 |
CN108225373A (zh) * | 2017-12-22 | 2018-06-29 | 东南大学 | 一种基于改进的5阶容积卡尔曼的大失准角对准方法 |
CN108759870A (zh) * | 2018-07-03 | 2018-11-06 | 哈尔滨工业大学 | 一种基于新型鲁棒广义高阶容积卡尔曼滤波的传递对准方法 |
CN109163720A (zh) * | 2018-08-27 | 2019-01-08 | 广西科技大学 | 基于渐消记忆指数加权的卡尔曼滤波跟踪方法 |
CN109633628A (zh) * | 2019-01-07 | 2019-04-16 | 西安电子科技大学 | 基于分布式组网雷达数据融合的抗rgpo干扰的方法 |
CN109724599A (zh) * | 2019-03-12 | 2019-05-07 | 哈尔滨工程大学 | 一种抗野值的鲁棒卡尔曼滤波sins/dvl组合导航方法 |
CN110196443A (zh) * | 2019-06-06 | 2019-09-03 | 中国人民解放军战略支援部队信息工程大学 | 一种飞行器的容错组合导航方法及系统 |
CN110247396A (zh) * | 2019-07-17 | 2019-09-17 | 国网山东省电力公司青岛供电公司 | 基于自适应抗差无迹卡尔曼滤波的配电网状态估计方法及系统 |
CN110907911A (zh) * | 2019-11-29 | 2020-03-24 | 厦门金龙联合汽车工业有限公司 | 基于Sage-Husa卡尔曼滤波的车辆目标跟踪算法 |
-
2021
- 2021-01-04 CN CN202110005005.3A patent/CN112859004A/zh active Pending
Patent Citations (9)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
CN106021194A (zh) * | 2016-05-19 | 2016-10-12 | 哈尔滨工业大学 | 一种多传感器多目标跟踪偏差估计方法 |
CN108225373A (zh) * | 2017-12-22 | 2018-06-29 | 东南大学 | 一种基于改进的5阶容积卡尔曼的大失准角对准方法 |
CN108759870A (zh) * | 2018-07-03 | 2018-11-06 | 哈尔滨工业大学 | 一种基于新型鲁棒广义高阶容积卡尔曼滤波的传递对准方法 |
CN109163720A (zh) * | 2018-08-27 | 2019-01-08 | 广西科技大学 | 基于渐消记忆指数加权的卡尔曼滤波跟踪方法 |
CN109633628A (zh) * | 2019-01-07 | 2019-04-16 | 西安电子科技大学 | 基于分布式组网雷达数据融合的抗rgpo干扰的方法 |
CN109724599A (zh) * | 2019-03-12 | 2019-05-07 | 哈尔滨工程大学 | 一种抗野值的鲁棒卡尔曼滤波sins/dvl组合导航方法 |
CN110196443A (zh) * | 2019-06-06 | 2019-09-03 | 中国人民解放军战略支援部队信息工程大学 | 一种飞行器的容错组合导航方法及系统 |
CN110247396A (zh) * | 2019-07-17 | 2019-09-17 | 国网山东省电力公司青岛供电公司 | 基于自适应抗差无迹卡尔曼滤波的配电网状态估计方法及系统 |
CN110907911A (zh) * | 2019-11-29 | 2020-03-24 | 厦门金龙联合汽车工业有限公司 | 基于Sage-Husa卡尔曼滤波的车辆目标跟踪算法 |
Non-Patent Citations (2)
Title |
---|
杨利斌;赵建军;季勤超;: "基于扩展卡尔曼滤波的雷测数据实时剔野方法", 舰船电子工程, no. 04 * |
罗志斌;刘先省;胡振涛;周林;: "基于新息特性抗野值Kalman预测算法", 河南大学学报(自然科学版), no. 04 * |
Similar Documents
Publication | Publication Date | Title |
---|---|---|
CN110061716B (zh) | 一种基于最小二乘和多重渐消因子的改进kalman滤波方法 | |
CN107728138B (zh) | 一种基于当前统计模型的机动目标跟踪方法 | |
CN107688179B (zh) | 基于多普勒信息辅助的综合概率数据互联方法 | |
CN109802656B (zh) | 基于幅度信息的卡尔曼滤波方法 | |
CN110555398B (zh) | 一种基于滤波最优平滑确定故障首达时刻的故障诊断方法 | |
CN108120452B (zh) | Mems陀螺仪动态数据的滤波方法 | |
CN108226887B (zh) | 一种观测量短暂丢失情况下的水面目标救援状态估计方法 | |
CN116047498A (zh) | 基于最大相关熵扩展卡尔曼滤波的机动目标跟踪方法 | |
CN112328959A (zh) | 一种基于自适应扩展卡尔曼概率假设密度滤波器的多目标跟踪方法 | |
CN112068092A (zh) | 一种用于高精度弹道实时定轨的抗差加权观测融合平方根ukf滤波方法 | |
CN112305513B (zh) | 一种传感器测量参数修正方法及系统 | |
CN112859004A (zh) | 基于改进卡尔曼滤波的野值剔除方法 | |
CN112986977A (zh) | 一种克服雷达扩展卡尔曼航迹滤波发散的方法 | |
JP2002181926A (ja) | 目標追尾方法およびその装置 | |
CN110736459B (zh) | 惯性量匹配对准的角形变测量误差评估方法 | |
CA2675310A1 (en) | Method for evaluation of sensor measured values | |
CN115685128B (zh) | 一种机动目标场景下的雷达目标跟踪算法及电子设备 | |
CN116224320B (zh) | 一种极坐标系下处理多普勒量测的雷达目标跟踪方法 | |
CN114895298B (zh) | 一种雷达慢速弱机动目标量测修正伯努利滤波方法及装置 | |
CN110595470A (zh) | 一种基于外定界椭球集员估计的纯方位目标跟踪方法 | |
CN109856624B (zh) | 一种针对单雷达直线航迹线的目标状态估计方法 | |
CN111865268A (zh) | 一种简易快速的卡尔曼滤波方法 | |
CN115616511B (zh) | 一种地基雷达形变量气象补偿方法和系统 | |
Narasimhappa et al. | An improved adaptive unscented Kalman Filter for denoising the FOG signal | |
Kumar et al. | Performance comparision of α-β-γ filter and kalman filter for CA, NCA target tracking using bistatic range and range rate measurements |
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 |