Jan-Willem Bisschop
/
EMG_filter
EMG filter. Waarden nog niet perfekt.
Filter.cpp@0:2956e3501f8a, 2016-10-21 (annotated)
- Committer:
- janwillembisschop
- Date:
- Fri Oct 21 12:11:52 2016 +0000
- Revision:
- 0:2956e3501f8a
EMG filter. Waarde nog niet perfekt.
Who changed what in which revision?
User | Revision | Line number | New contents of line |
---|---|---|---|
janwillembisschop | 0:2956e3501f8a | 1 | #include "Filter.h" |
janwillembisschop | 0:2956e3501f8a | 2 | |
janwillembisschop | 0:2956e3501f8a | 3 | 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) |
janwillembisschop | 0:2956e3501f8a | 4 | { |
janwillembisschop | 0:2956e3501f8a | 5 | |
janwillembisschop | 0:2956e3501f8a | 6 | double v = u - a1*v1 - a2*v2; |
janwillembisschop | 0:2956e3501f8a | 7 | double y = gain * (b0*v + b1*v1 + b2*v2); |
janwillembisschop | 0:2956e3501f8a | 8 | |
janwillembisschop | 0:2956e3501f8a | 9 | v2 = v1; |
janwillembisschop | 0:2956e3501f8a | 10 | v1 = v; |
janwillembisschop | 0:2956e3501f8a | 11 | |
janwillembisschop | 0:2956e3501f8a | 12 | return y; |
janwillembisschop | 0:2956e3501f8a | 13 | |
janwillembisschop | 0:2956e3501f8a | 14 | } |