文章目录
一 State update Equation 状态更新方程:计算得到可以用于计算的x
x
^
\hat{x}
x^ n,n=
x
^
\hat{x}
x^ n,n-1 + Kn(Zn -
x
^
\hat{x}
x^ n,n-1 )
1.Kn是卡尔曼增益 Kalman Gain,测量的精度越高,Kn越大
2. Zn 是第N次测量的值
3.
x
^
\hat{x}
x^ n,n-1 )是上一轮对本轮的预测值