https://www.cnblogs.com/xmphoenix/p/3634536.html
https://blog.csdn.net/heyijia0327/article/details/17487467
卡尔曼滤波属于一种软件滤波方法,其基本思想是:
以最小均方误差为最佳估计准则,采用信号与噪声的状态空间模型,利用前一时刻的估计值和当前时刻的观测值来更新对状态变量的估计,求出当前时刻的估计值。算法根据建立的系统方程和观测方程对需要处理的信号做出满足最小均方误差的估计。
卡尔曼滤波器的五大公式: