Kalman Filter: 线性系统估计状态后验概率分布。
正态分布经过线性变换仍为正态分布, 估计其均值和协方差矩阵。
x_t = F * x_t-1 + B * u + w
y_t = H * x_t + n
预测:根据状态转移预测先验概率分布
更新:根据观测方程更新后验概率分布
https://github.com/ApolloAuto/apollo/blob/master/modules/common/math/kalman_filter.h
融合感知基础
于 2024-03-20 21:32:58 首次发布
![](https://img-home.csdnimg.cn/images/20240611030827.png)