fildata.m

实现KALMAN滤波算法

%filterh初始数据
order=2;
Af=[1 1 
    0 1];
Bf=[.1 .3
    .2 .2];
Qf=[.1 0
    0 .1];
Cf=[.1 2
    .3 .4];
Rf=[.1 .1
    .1 .1];
P0=[3 0
    0 3];
x0_=[0 0]';