Mathieu Garivet / FiltrePB

Filtre passe bas simple

FiltrePB.cpp

Committer:
garivetm
Date:
2016-02-15
Revision:
0:a5c9e3376d19
Child:
1:999ae031e7c1

File content as of revision 0:a5c9e3376d19:


#include "FiltrePB.h"
#define NOFFSET 100
#define HUBLEXR
#define r2d 57.295779513082320876798154814105
#define PI 3.1415926535897932384626433832795

FiltrePB::FiltrePB(float fc)
{
    dt=0.01;
    vep=vsp=0.0;
    tau=1.0/(fc*2*PI);            //calcul de la constante de temps
    a=1.0/(1+(2*tau/dt));   //calcul du coefficient a du filtre
    b=(1-(2*tau/dt))*a;    //calcul du coefficient b du filtre
    
}

float FiltrePB::FiltreExe(float ve)
{
    vs=a*ve+a*vep+b*vsp;       
    vep=ve;
    vsp=vs;      
    return vs;
}