even versimpelen
Dependencies: HIDScope MODSERIAL PID QEI biquadFilter mbed
Fork of cpfromralph1 by
Diff: main.cpp
- Revision:
- 28:ec0763106a2e
- Parent:
- 27:ca07f895f999
- Child:
- 29:09c1567d6148
diff -r ca07f895f999 -r ec0763106a2e main.cpp --- a/main.cpp Tue Oct 10 13:46:49 2017 +0000 +++ b/main.cpp Tue Oct 10 14:17:03 2017 +0000 @@ -2,6 +2,7 @@ #include "HIDScope.h" #include "BiQuad.h" #include "MODSERIAL.h" +#include "Calibration.h" //Define objects AnalogIn emg1_in( A0 ); /* read out the signal */ @@ -82,43 +83,6 @@ BiQuad filterlow4(1.368e-03,2.737e-03,1.369e-03,-1.9219,9.274e-01); // -// Finding max values for correct motor switch if the button is pressed -void get_max1(){ - if (max_reader12==0){ - green = !green; - red = 1; - blue = 1; - for(int n=0;n<2000;n++){ /* measure 2000 samples and filter it */ - - emg1 = emg1_in.read(); /* read out emg */ - emg1highfilter = filterhigh1.step(emg1); /* high pass filtered */ - emg1notchfilter = filternotch1.step(emg1highfilter); /* notch filtered */ - emg1abs = fabs(emg1notchfilter); /* take the absolute value */ - emg1lowfilter = filterlow1.step(emg1abs); /* low pass filtered */ - emg1peak = filterpeak1.step(emg1lowfilter); /* 4dB gain peak */ - - emg2 = emg2_in.read(); /* read out emg */ - emg2highfilter = filterhigh2.step(emg2); /* high pass filtered */ - emg2notchfilter = filternotch2.step(emg2highfilter); /* notch filtered */ - emg2abs = fabs(emg2notchfilter); /* take the absolute value */ - emg2lowfilter = filterlow2.step(emg2abs); /* low pass filtered */ - emg2peak = filterpeak2.step(emg2lowfilter); /* 4dB gain peak */ - - if (max1<emg1peak){ - max1 = emg1peak; /* set the max value at the highest measured value */ - } - if (max2<emg2peak){ - max2 = emg2peak; /* set the max value at the highest measured value */ - } - wait(0.001f); /* measure at 1000Hz */ - } - wait(0.2f); - green = 1; - } - maxpart1 = 0.15*max1; /* set cut off voltage at 15% of max for right biceps */ - maxpart2 = 0.15*max1; /* set cut off votage at 15% of max for left biceps */ -} - void get_max3(){ if (max_reader34==0){ green = 1; @@ -151,8 +115,8 @@ wait(0.2f); red = 1; } - maxpart3 = 0.25*max3; /* set cut off voltage at 25% of max for left lower arm */ - maxpart4 = 0.25*max4; /* set cut off voltage at 25% of max for right lower arm */ + maxpart3 = 0.2*max3; /* set cut off voltage at 25% of max for left lower arm */ + maxpart4 = 0.2*max4; /* set cut off voltage at 25% of max for right lower arm */ } // Filtering & Scope