Jan-Willem Bisschop
/
EMG_filter
EMG filter. Waarden nog niet perfekt.
Filter2.cpp@1:70dc835f3a37, 2016-10-28 (annotated)
- 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?
User | Revision | Line number | New 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 | } |