Mathieu Garivet
Filtre passe bas simple
Diff: FiltrePB.cpp
- Revision:
- 0:a5c9e3376d19
- Child:
- 1:999ae031e7c1
--- /dev/null Thu Jan 01 00:00:00 1970 +0000
+++ b/FiltrePB.cpp Mon Feb 15 15:10:52 2016 +0000
@@ -0,0 +1,25 @@
+
+#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;
+}
+