atoombom

Dependencies:   Encoder HIDScope mbed

Fork of EMG by Tom Tom

Embed: (wiki syntax)

« Back to documentation index

Show/hide line numbers LowPassFilter.cpp Source File

LowPassFilter.cpp

00001 #include "encoder.h"
00002 #include "LowPassFilter.h"
00003 
00004 // Define a Ticker, variables for storage, input and output
00005 Ticker biquadTicker;
00006 double v1 = 0, v2 = 0, u = 0, y = 0;
00007 const double a1 = 1.2, a2 = 2.3, b0 = 1.2, b1 = 2.2, b2 = 0.3;
00008 // Implement the computation function
00009 double computeBiquad()
00010 {
00011     double v = u - a1*v1 - a2*v2;
00012     y = b0*v + b1*v1 + b2*2;
00013     v2 = v1;
00014     v1 = v;
00015     return y;
00016 }