大家好,我听了DR_CAN的B站博主的卡尔曼增益的详细推导,全网最详细的推到课程之后,
自己仔细的总结,在借鉴CSDN其他的博主,得到了现在的推导过程
一。状态空间方程
用状态方程的形式描述系统的动态响应。
二。卡尔曼增益的推导过程
由于过程噪声是不确定的,于是状态估计值先验为
根据先验估计和测量估计可得出后验估计
我们的目标是求得合理的Kk值使得估计误差最小,有
当后验估计值越接近真实值 Xk, 则说明 ek 的方差越小,即 ek 越接近于期望值0 00。于是有
先验误差协方差矩阵
ek的协方差矩阵Pk
由之前的推导可得
总结: