Het EMG verwerkingsdeel
Dependencies: mbed
Revision 2:dc387d9de7c4, committed 2018-10-26
- Comitter:
- keeswieriks
- Date:
- Fri Oct 26 10:28:22 2018 +0000
- Parent:
- 1:3cc91fc2fb1c
- Commit message:
- notch erbij;
Changed in this revision
main.cpp | Show annotated file Show diff for this revision Revisions of this file |
diff -r 3cc91fc2fb1c -r dc387d9de7c4 main.cpp --- a/main.cpp Fri Oct 26 10:19:17 2018 +0000 +++ b/main.cpp Fri Oct 26 10:28:22 2018 +0000 @@ -6,6 +6,11 @@ AnalogIn emg3( A2 ); // Variabelen EMG +const double m1 =0.5000; +const double m2 =-0.8090; +const double n0 =0.5000; +const double n1 =-0.8090; +const double n2 =0; const double a1 =0.9565; const double a2 =-1.9131; const double b0 =0.9565; @@ -25,11 +30,14 @@ // Filteren void filterEMG() { -highpassFilter1 = fabs(biquad(emg0.read(), a1, a2, b0, b1, b2)); +notchFilter1 = biquad(emg0.read(), m1, m2, n0, n1, n2); +highpassFilter1 = fabs(biquad(notchFilter1, a1, a2, b0, b1, b2)); lowpassFilter1 = biquad(highpassFilter1, c1, c2, d0, d1, d2); -highpassFilter2 = fabs(biquad(emg1.read(), a1, a2, b0, b1, b2)); +notchFilter2 = biquad(emg1.read(), m1, m2, n0, n1, n2); +highpassFilter2 = fabs(biquad(notchFilter2, a1, a2, b0, b1, b2)); lowpassFilter2 = biquad(highpassFilter2, c1, c2, d0, d1, d2); -highpassFilter3 = fabs(biquad(emg2.read(), a1, a2, b0, b1, b2)); +notchFilter3 = biquad(emg2.read(), m1, m2, n0, n1, n2); +highpassFilter3 = fabs(biquad(notchFilter2, a1, a2, b0, b1, b2)); lowpassFilter3 = biquad(highpassFilter3, c1, c2, d0, d1, d2); }