教你在单片机上套公式实现卡尔曼滤波器

`

逛博客看到的一篇讲解卡尔曼滤波的文章，发现程序十分简洁易懂，而且使用效果不错，是一个学习的典范，在此分享了！

下面附上代码

1. #ifndef _KALMAN_H_
   
2. #define _KALMAN_H_
   
3. 
   
4. extern  KalmanGain;//  卡尔曼增益
   
5. extern  EstimateCovariance;//估计协方差
   
6. extern  MeasureCovariance;//测量协方差
   
7. extern  EstimateValue;//估计值
   
8. extern void KalmanFilterInit(void);
   
9. extern      KalmanFilter(   Measure);
   
10. #endif
    
11. 
    
12. 
    
13. 
    
14. #include "config.h"
    
15. #include "math.h"
    
16. 
    
17.   KalmanGain;//  卡尔曼增益
    
18.   EstimateCovariance;//估计协方差
    
19.   MeasureCovariance;//测量协方差
    
20.   EstimateValue;//估计值
    
21. 
    
22. void KalmanFilterInit(void);
    
23. 
    
24. extern    float  KalmanFilter(float   Measure);
    
25. 
    
26. 
    
27. void KalmanFilterInit(void)
    
28. {
    
29. EstimateValue=0;
    
30. 
    
31. EstimateCovariance=0.1;
    
32. MeasureCovariance=0.02;
    
33. 
    
34. 
    
35. }
    
36. 
    
37. KalmanFilter(   Measure)
    
38. {
    
39. 
    
40. //计算卡尔曼增益
    
41. KalmanGain=EstimateCovariance*sqrt(1/(EstimateCovariance*EstimateCovariance+MeasureCovariance*MeasureCovariance))；
    
42. 
    
43. //计算本次滤波估计值
    
44. EstimateValue=EstimateValue+KalmanGain*（Measure-EstimateValue）；
    
45. //更新估计协方差
    
46. 
    
47. EstimateCovariance=sqrt(1-KalmanGain)*EstimateCovariance;
    
48. //更新测量方差
    
49. MeasureCovariance=sqrt(1-KalmanGain)*MeasureCovariance;
    
50. //返回估计值
    
51. return EstimateValue;
    
52. }

复制代码

转自：http://blog.163.com/tianjunqiang666@126/blog/static/87259119201131314343274/`

不错不错，学习了！

好东西，支持一下

支持支持

谢谢楼主谢谢楼主。。。。。。。。。。。。。。。。。。。。

非常好，大赞。

                                         谢谢分享谢谢分享谢谢分享
      谢谢分享谢谢分享                       谢谢分享
      谢谢分享谢谢分享                谢谢分享         
            谢谢分享              谢谢分享谢谢分享谢谢分享
            谢谢分享              谢谢分享        谢                谢
            谢谢分享              谢谢分享        谢                谢
            谢谢分享              谢谢分享        分                分
            谢谢分享              谢谢分享        享                享
            谢谢分享              谢谢分享        谢                谢
            谢谢分享              谢谢分享        谢                谢
谢        谢谢分享               谢谢分享       分                分
谢谢     谢谢分享              谢谢分享        享                享
谢谢分 谢谢分享              谢谢分享        谢                谢
谢谢分 谢谢分享                               谢       谢
谢谢分谢谢分享                         谢                 谢
        谢谢谢谢                    分                               分
            谢谢                   享                                      享

加到LabVIEW里面试试！

木有看懂，，，有时间慢慢看，，，

谢楼主我加到32上试试

楼主真牛，大神。膜拜！

终于找到可以用的了。。。谢谢分享

非常不错非常不错非常不错非常不错非常不错非常不错非常不错非常不错非常不错非常不错

小鬼加油 发表于 2015-6-1 15:29
谢楼主我加到32上试试

移植好了么？我移植到STM32上采样AD怎么不输出数值呢？

呵呵，很不错，理解了卡尔曼滤波的精髓，编程就很简单了！！！

谢谢楼主分享！！！！！！！！！！！！！！！

好东西啊一定要顶

好东西，学习了

楼主真是好人啊；感谢奉献

这个必须顶，好东西值得收藏。。。