
卡尔曼滤波器原理
更多知识请关注【钒煋】公众号

卡尔曼滤波器原理
引言:
卡尔曼滤波器出现的背景:处理不确定性。
系统不确定性体现:
1、不存在完美的数学模型;
2、系统的扰动不可控,也很难建模;
3、测量传感器存在误差。
引入部分:
Eg:假设测一枚硬币,第 1 个人测量结果为
1
z
,第 2 人测量结果为
2
z
,……,第 k 个人测
量结果为
k
z
,第 k+1 个人的测量结果为
1k
z
+
。估计硬币的真实值是多少?
估计硬币的真实值:取平均值
定义:
ˆ
k
x
为第 k 的估计值。按照取平均值的方法,定义第 k 次平均值如下:
12
1
1
ˆ
k
k
ki
i
z z z
xz
kk
=
+ + +
==
(1)
根据式(1)进行处理:
( )
12
12
12
1 2 1
1
1
1
11
ˆ
1
1
1
1
1
11
1
ˆ
1
ˆ
ˆ
1
ˆ ˆ
k
k
k
k
kk
k
k
kk
k
k k k
z z z
x
k
z z z
k
kk
z z z
k
kk
z z z z
k
k k k
z
k
x
kk
xz
x
kk
x z x
k
−
−
−
−
−−
+ + +
=
+ + +
−
=
−
+ + +
−
=
−
+ + +
−
=+
−−
−
=+
−
= − +
= + −
(2)
得:
( )
11
1
ˆ ˆ ˆ
k k k k
x x z x
k
−−
= + −
(3)
根据(3)可知:
1)当
1k →
,
ˆ
kk
xz=
。说明测量结果起到较大作用。
2)当
k →
,
1
ˆ ˆ
kk
xx
−
=
。说明测量结果已不重要。