学习痴狂 发表于 2016-11-20 10:07:53

mpu6050卡尔曼滤波的疑问

    Klm_angle += (omega - bias) * dt;          // 先验估计
    P_00 += -(P_10 + P_01) * dt + Q_angle *dt;
    P_01 += -P_11 * dt;
    P_10 += -P_11 * dt;
    P_11 += +Q_omega * dt;                     // 先验估计误差协方差
   
    float K_0 = P_00 / (P_00 + R_angle);
    float K_1 = P_10 / (P_00 + R_angle);
   
    bias += K_1 * (angleA - Klm_angle);
    Klm_angle += K_0 * (angleA - Klm_angle);   // 后验估计
    P_00 -= K_0 * P_00;
    P_01 -= K_0 * P_01;
    P_10 -= K_1 * P_00;
    P_11 -= K_1 * P_01;                        // 后验估计误差协方差
先验和后验估计误差协方差为什么这样计算？协方差计算方法不是E{}吗？如果是P协方差矩阵的话主对角线是方差，次对角线是协方差，也不是这么计算的额。还请指点。我的自平衡小车D3——滤波算法
http://www.geek-workshop.com/thread-681-1-1.html
(出处: 极客工坊)

peter001 发表于 2016-11-20 10:17:59

坐个沙发，等高手解答

学习痴狂 发表于 2017-1-23 15:16:38

我在别的地方找的，问题解决了

海迹天涯 发表于 2017-1-24 08:41:57

学习了:lol

plj213 发表于 2017-8-20 18:27:55

学习学习:lol

五哥1 发表于 2017-8-21 07:50:57


学习学习

天涯浪子123 发表于 2017-8-21 09:49:17

一直没弄挺明白的这种算法

Eagle-365385 发表于 2018-4-11 19:56:07

这个主要是要推导按照递推方式推导，我大体看了一下，似乎最终就是这个结果。

じ☆ve沫上，蘤開。灬 发表于 2018-8-22 17:10:31

看了楼主找的的文档，才看了个大致明白 看一天了其他的都写的不明不白
页: [1]
查看完整版本: mpu6050卡尔曼滤波的疑问