[四轴技术交流] 【疑问】关于卡尔曼滤波滤波器

[复制链接]
1424|3
 楼主| JK_alvin 发表于 2016-7-15 10:32 | 显示全部楼层 |阅读模式
根据先验估计值差分方程以及过程方程可以推导出先验误差的均方差,先验估计的协方差矩阵的正对角线就是其均方差,另外一条对角线上是其协方差,但是先验估计的协方差矩阵是如何推导出来的呢?

//Step 2 :先验估计  更新误差协方差矩阵 P
   P[0][0] += dt * (dt*P[1][1] - P[0][1] - P[1][0] + Q_angle);
   P[0][1] -= dt * P[1][1];
   P[1][0] -= dt * P[1][1];
   P[1][1] += Q_bias * dt;
 楼主| JK_alvin 发表于 2016-8-1 19:55 | 显示全部楼层
个人理解,线性卡尔曼滤波器应该是求后验估计均方差最小(优)情况下的解(卡尔曼增益),而先验估计均方差是通过先验估计协方差矩阵求得的,很多C语言写的先验估计协方差矩阵如上面列举的一样,希望高人指点该如何来理解呢?
谢谢~
飞思捷芯 发表于 2016-8-2 22:10 | 显示全部楼层
我之前是尝试用卡尔曼对一维数据滤波用的,状态矩阵也是一维的,很简单,至于多维的没考虑,看了你的问题,我感觉帮不到你,不好意思
 楼主| JK_alvin 发表于 2016-8-4 13:16 | 显示全部楼层
飞思捷芯 发表于 2016-8-2 22:10
我之前是尝试用卡尔曼对一维数据滤波用的,状态矩阵也是一维的,很简单,至于多维的没考虑,看了你的问题, ...

还是感谢了
您需要登录后才可以回帖 登录 | 注册

本版积分规则

8

主题

63

帖子

3

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