极客工坊

 找回密码
 注册

QQ登录

只需一步,快速开始

查看: 18987|回复: 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|联系我们|极客工坊

GMT+8, 2024-3-28 16:38 , Processed in 0.048396 second(s), 18 queries .

Powered by Discuz! X3.4 Licensed

Copyright © 2001-2021, Tencent Cloud.

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