Jan-Willem Bisschop / Mbed 2 deprecated EMG_filter

EMG filter. Waarden nog niet perfekt.

Dependencies:   HIDScope mbed

Filter.cpp

Committer:
janwillembisschop
Date:
2016-10-28
Revision:
1:70dc835f3a37
Parent:
0:2956e3501f8a

File content as of revision 1:70dc835f3a37:

#include "Filter.h"

double Filter(double u, double &v1, double &v2, const double a1, const double a2, const double b0, const double b1, const double b2, const double gain)
{
    
    double v = u - a1*v1 - a2*v2;
    double y = gain * (b0*v + b1*v1 + b2*v2);
    
    v2 = v1;
    v1 = v;
    
    return y;
    
}