文件名称:卡尔曼滤波程序
文件大小: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
【文件预览】:
Kalman
----Kalman()
--------Filter_kalman.c(1KB)
--------Kalman.dsp(4KB)
--------Kalman.ncb(41KB)
--------Kalman.dsw(537B)
--------说明.txt(20B)
--------Kalman.plg(923B)
--------kalman_main.c(856B)
--------Debug()
--------Kalman.opt(53KB)