没有合适的资源?快使用搜索试试~ 我知道了~
资源推荐
资源详情
资源评论





























说明
致敬 DR_CAN 博士!
笔记是本人根据 B 站 DR_CAN 博士视频编写,每个公式都是用 Mathtype 逐个编辑的,基本
为逐字稿。
笔记仅供参考和查阅,可作为参考文本和 DR_CAN 博士视频一起学习,读者朋友也可以此为
笔记模板进行补充,形成自己的笔记,方便后续使用。
如有错误,欢迎指正,邮箱:[email protected]
更多内容输出,请关注公众号“钒煋”二维码,同 B 站“钒煋”:

卡尔曼滤波器
引言:
卡尔曼滤波器出现的背景:处理不确定性。
系统不确定性体现:
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
−
=
。说明测量结果已不重要。
对式(3)进行总结:令
1
k
K
k
=
,得
( )
11
ˆ ˆ ˆ
k k k k k
x x K z x
−−
= + −
(4)
解释公式(4):
当前估计值
ˆ
k
x
= 上次估计值
1
ˆ
k
x
−
+ 卡尔曼增益
k
K
*(当前测量值
k
z
-上次估计值
1
ˆ
k
x
−
)
k
K
:卡尔曼增益。
公式体现了:递推思想,当前估计值只和上一次估计值及当前测量值相关。
基本卡尔曼滤波器:
基本公式:
( )
11
ˆ ˆ ˆ
k k k k k
x x K z x
−−
= + −
(5)
定义:
估计误差:
EST
e
测量误差:
MEA
e
卡尔曼增益
k
K
(核心公式)为:
1
1
k
k
k
EST
k
EST MEA
e
K
ee
−
−
=
+
(6)
分析 k 时刻:
1)
1
k
k
EST MEA
ee
−
:
1
k
K
,
ˆ
kk
xz
。
2)
1
k
k
MEA EST
ee
−
:
0
k
K
,
1
ˆ ˆ
kk
xx
−
。
实现步骤:
Step1:计算卡尔曼增益
1
1
k
k
k
EST
k
EST MEA
e
K
ee
−
−
=
+
;
Step2:计算
( )
11
ˆ ˆ ˆ
k k k k k
x x K z x
−−
= + −
;
Step3:更新
1
(1 )
kk
EST k EST
e K e
−
=−
。(后面详细推导)

假定所测量真实为 50,测量误差为 3,测量实际结果(47~53)。初始设定估计值 40,估
计误差为 5。
表 1 卡尔曼滤波典型计算案例
k
zk
eMEAk
x^k
Kk
eESTk
平均值
0
0
0
40
0
5
0
1
51
3
46.875
0.625
1.875
51
2
48
3
47.30769
0.384615
1.153846
49.5
3
52
3
48.61111
0.277778
0.833333
50.33333
4
49
3
48.69565
0.217391
0.652174
50
5
50
3
48.92857
0.178571
0.535714
50
6
53
3
49.54545
0.151515
0.454545
50.5
7
52
3
49.86842
0.131579
0.394737
50.71429
8
47
3
49.53488
0.116279
0.348837
50.25
9
52
3
49.79167
0.104167
0.3125
50.44444
10
49
3
49.71698
0.09434
0.283019
50.3
11
51
3
49.82759
0.086207
0.258621
50.36364
12
53
3
50.07937
0.079365
0.238095
50.58333
13
47
3
49.85294
0.073529
0.220588
50.30769
14
49
3
49.79452
0.068493
0.205479
50.21429
15
48
3
49.67949
0.064103
0.192308
50.06667
16
52
3
49.81928
0.060241
0.180723
50.1875
17
47
3
49.65909
0.056818
0.170455
50
18
53
3
49.83871
0.053763
0.16129
50.16667
19
51
3
49.89796
0.05102
0.153061
50.21053
20
47
3
49.75728
0.048544
0.145631
50.05
图 1 各曲线对比说明图
46
47
48
49
50
51
52
53
54
0 5 10 15 20 25
信号对比
采样值 卡尔曼滤波值 平均值
剩余22页未读,继续阅读
资源评论


FanXing_zl
- 粉丝: 494
上传资源 快速赚钱
我的内容管理 展开
我的资源 快来上传第一个资源
我的收益
登录查看自己的收益我的积分 登录查看自己的积分
我的C币 登录后查看C币余额
我的收藏
我的下载
下载帮助


最新资源
- 电气工程及其自动化专业就业前景.doc
- 无线传感器网络节点太阳能电源系统设计方案.doc
- 高中物理教学中促进学生深度学习的实践与思考.docx
- 小程序 商城 -Java 商城-C++资源
- 计算机与电子通信类人才的创新实践.docx
- 软件工程项目师简历模板.doc
- PLC程序设计与工作分析.doc
- 计算机网络试卷A计算机科学与技术(专升本).docx
- CnSTD-Python资源
- 数据库技术与应用杨金民答案.docx
- 电力工程中电气自动化技术探索.docx
- CADCAM及数控加工技术综合实践.docx
- 深圳金威计算机机房招标资料.doc
- MAPGIS工程师认证培训.ppt
- 对消防信息化建设中网络安全的思考和分析.doc
- EFIconFont-Swift资源
资源上传下载、课程学习等过程中有任何疑问或建议,欢迎提出宝贵意见哦~我们会及时处理!
点击此处反馈



安全验证
文档复制为VIP权益,开通VIP直接复制
