kaer.h

基于DSP的卡尔曼滤波器的设计

#include "math.h"
#define PI 3.1415926
int a=0, b=100;
float f1(float x) /*定义被积函数*/
{
    return sin(PI*3*x/5)*sin(PI*3*x/5);
}

float integrate1(float  a,float  b) /*定义积分公式函数*/
{
      double W,h;
      int i,n=100;
       W=0.5*(f(a)+f(b));
       h=fabs(a-b)/n;
       for(i=1;i<n;i++)
       W+=f(a+i*h);
       W=W*h;
       return W;
}
float f2(float x) /*定义被积函数*/
{
    return cos(PI*3*x/5)*cos(PI*3*x/5);
}

float integrate2(float  a,float  b) /*定义积分公式函数*/
{
      double R,h;
      int i,n=100;
       R=0.5*(f(a)+f(b));
       h=fabs(a-b)/n;
       for(i=1;i<n;i++)
       R+=f(a+i*h);
       R=R*h;
       return R;
}