- //先验估计误差协方差的微分
- Kalman_Struct -> Pdot[0 = Q_angle - Kalman_Struct -> PP[0[1 - Kalman_Struct -> PP[1[0;
- Kalman_Struct -> Pdot[1 = - Kalman_Struct -> PP[1[1;
- Kalman_Struct -> Pdot[2 = - Kalman_Struct -> PP[1[1;
- Kalman_Struct -> Pdot[3 = Q_gyro;
- //先验估计误差协方差的积分
- Kalman_Struct -> PP[0[0 += Kalman_Struct -> Pdot[0 * dt;
- Kalman_Struct -> PP[0[1 += Kalman_Struct -> Pdot[1 * dt;
- Kalman_Struct -> PP[1[0 += Kalman_Struct -> Pdot[2 * dt;
- Kalman_Struct -> PP[1[1 += Kalman_Struct -> Pdot[3 * dt;
- 谁能解析一下这8句的意思,本人实在理解不了。
友情提示: 此问题已得到解决,问题已经关闭,关闭后问题禁止继续编辑,回答。
这个我整理了遍,基本上理解了。图片:https://yunpan.cn/OckxZcYM8LtuNH 访问密码 3ad3
一周热门 更多>