EMG filter. Waarden nog niet perfekt.

Dependencies:   HIDScope mbed

Committer:
janwillembisschop
Date:
Fri Oct 28 08:55:20 2016 +0000
Revision:
1:70dc835f3a37
EMG filter met goede waarden

Who changed what in which revision?

UserRevisionLine numberNew contents of line
janwillembisschop 1:70dc835f3a37 1 #include "Filter2.h"
janwillembisschop 1:70dc835f3a37 2
janwillembisschop 1:70dc835f3a37 3 double Filter2(double u, double &w1, double &w2, const double a1, const double a2, const double b0, const double b1, const double b2, const double gain)
janwillembisschop 1:70dc835f3a37 4 {
janwillembisschop 1:70dc835f3a37 5
janwillembisschop 1:70dc835f3a37 6 double w = u - a1*w1 - a2*w2;
janwillembisschop 1:70dc835f3a37 7 double y = gain * (b0*w + b1*w1 + b2*w2);
janwillembisschop 1:70dc835f3a37 8
janwillembisschop 1:70dc835f3a37 9 w2 = w1;
janwillembisschop 1:70dc835f3a37 10 w1 = w;
janwillembisschop 1:70dc835f3a37 11
janwillembisschop 1:70dc835f3a37 12 return y;
janwillembisschop 1:70dc835f3a37 13
janwillembisschop 1:70dc835f3a37 14 }