卡尔曼滤波一维
C
float kalman1_filter(kalman1_state *state, float z_measure)
{
/* Predict 预测
状态方程:
X(k)=A*X(k-1)+B*U(k)+W(k)
测量方程:
Z(k)=H*X(k)+V(k)
预测下一状态:
x(k/k-1)=A*X(k-1|k-1...
6-24 2,202PVs
阅读全文 26-24 2,202PVs
阅读全文 2