卡尔曼滤波matlab 代码

legend('x2(k)的估计值','x2(k)的真实值') figure (3)

subplot(2,1,1) plot(k,e1)

title('x1(k)的估计值和真实值误差曲线') subplot(2,1,2) plot(k,e2)

title('x2(k)的估计值和真实值误差曲线')

figure (4) plot(k,z)

title('输出z的观测值曲线')