文件名称:卡尔曼滤波程序
文件大小:159KB
文件格式:RAR
更新时间:2016-05-28 10:42:54
卡尔曼滤波 kalman KF 卡尔曼滤波程序 主函片段数如下 include "math.h" #include "stdio.h" void kalman(n,m,len,f,d,u,b,q,h,r,z,x,p,g); main() {int i,j,m,n,len; static double f[4]={1.0,1.0,0.0,1.0}; static double b[4]={0.0,0.0,0.0,0.0}; static double d[2]={0.0,0.0}; static double h[2]={1.0,0.0}; static double q[4]={0.0,0.0,0.0,0.0}; static double x[2]={0.0,0.0}; static double p[4]={10.0,0.0,0.0,10.0}; static double u[150]={0.0,0.0,0.0,0.0}; static double z[150]={1.1,2.0,3.2,3.8}; double g[2],r=0.1; m=2; n=2; len=4; kalman(n,m,len,f,d,u,b,q,h,r,z,x,p,g); printf("The Error Variance Matrix of Kalman Filter\n"); for(i=0;i