卡尔曼滤波算法，zip压缩包中包含头文件和源文件，使用时只用调用一个函数即可。要加入方差来判断数据的稳定性。