关于卡尔曼滤波中卡尔曼增益的计算

[复制链接]
2486|0
 楼主| 忘川 发表于 2013-12-7 10:10 | 显示全部楼层 |阅读模式
本帖最后由 忘川 于 2013-12-7 16:18 编辑

最近在学习卡尔曼滤波在单片机中的应用,发现有些地方不太懂,因此发帖请各路大牛解疑,谢谢!

下面是我在某个网站上看到的简化版卡尔曼滤波主要计算公式,应用于单输入单输出系统:





按照highgear老师的帖子中https://bbs.21ic.com/icview-292853-1-1.html,卡尔曼增益的计算公式为:   K = P *C’ * (C * P * C’ + R) -1
(这里 R = E{ Vj^2 }, 是测量噪声的协方差(),  即系统框图中的 Vj 的协方差, 为了简化,也当作一个常数矩阵。由于我们的系统一般是单输入单输出,所以 R是一个 1x1的矩阵,即一个常数,上面的公式可以简化为:
K = P *C’ / (C * P * C’ + R)


可是上述为何会带有开平方根这种运算?一直没弄懂它的推导公式,略感奇怪。


您需要登录后才可以回帖 登录 | 注册

本版积分规则

4

主题

13

帖子

0

粉丝
快速回复 在线客服 返回列表 返回顶部