kalman滤波 怎样用matlab编程实现？ 急用！

sunnyshore

[em28]

happy

帖子http://forum.vibunion.com/thread-10289-1-1.html中有

sunnyshore

1. clear
   
2. N=200;
   
3. w(1)=0;
   
4. w=randn(1,N)
   
5. x(1)=0;
   
6. a=1;
   
7. for k=2:N;
   
8. x(k)=a*x(k-1)+w(k-1);
   
9. end
   
10. 
    
11. V=randn(1,N);
    
12. q1=std(V);
    
13. Rvv=q1.^2;
    
14. q2=std(x);
    
15. Rxx=q2.^2;
    
16. q3=std(w);
    
17. Rww=q3.^2;
    
18. c=0.2;
    
19. Y=c*x+V;
    
20. 
    
21. p(1)=0;
    
22. s(1)=0;
    
23. for t=2:N;
    
24. p1(t)=a.^2*p(t-1)+Rww;
    
25. b(t)=c*p1(t)/(c.^2*p1(t)+Rvv);
    
26. s(t)=a*s(t-1)+b(t)*(Y(t)-a*c*s(t-1));
    
27. p(t)=p1(t)-c*b(t)*p1(t);
    
28. end
    
29. 
    
30. t=1:N;
    
31. plot(t,s,'r',t,Y,'g',t,x,'b');

复制代码

这个程序的确编的挺好！但是咋没体现出真实温度值25度呢？我得出的图像远不如那篇文章中的原图像好。我是初学者，请勿见笑