极客工坊

 找回密码
 注册

QQ登录

只需一步,快速开始

查看: 2760|回复: 0

【疑问】关于卡尔曼滤波滤波器

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

//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;
回复

使用道具 举报

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

本版积分规则

Archiver|联系我们|极客工坊 ( 浙ICP备09023225号 )

GMT+8, 2019-7-17 05:28 , Processed in 0.092686 second(s), 24 queries .

Powered by Discuz! X3.4 Licensed

© 2001-2017 Comsenz Inc.

快速回复 返回顶部 返回列表