卡尔曼滤波原理(简单易懂) 过程方程: X(k+1)=AX(k)+BU(k)+W(k)>>>>式1 量测方程: Z(k+1)=HX(k+1)+V(k+1)>>>>式2