emg_mk
Dependencies: HIDScope MODSERIAL mbed-dsp mbed
Diff: main.cpp
- Revision:
- 0:abe0bc5c43b7
- Child:
- 1:6a8b45298e54
diff -r 000000000000 -r abe0bc5c43b7 main.cpp --- /dev/null Thu Jan 01 00:00:00 1970 +0000 +++ b/main.cpp Tue Oct 21 13:51:54 2014 +0000 @@ -0,0 +1,95 @@ +#include "mbed.h" +#include "HIDScope.h" +#include "MODSERIAL.h" +#include "arm_math.h" + +HIDScope scope(2);//is dit 4 voor 2 spieren? en hoe zit het met scope.set? + +AnalogIn emgB(PTB0); + +//*** OBJECTS *** +float (filtered_emgB); +float drempelwaardeB1, drempelwaardeB2, drempelwaardeB3;//B1=snelheidsstand 1, B2=snelheidsstand 2, B3=snelheidsstand 3 +int yB1, yB2, yB3; +float B0, B1, B2, B3, B4, B5, B6, B7, B8, B9, MOVAVG_B;//moving average objects + + +//*** FILTERS *** +arm_biquad_casd_df1_inst_f32 lowpass; +//constants for 50Hz lowpass +float lowpass_const[] = {0.2928920553, 0.5857841107, 0.2928920554, -0, -0.17156822136};//{a0 a1 a2 -b1 -b2} van online calculator +float lowpass_states[4]; + +arm_biquad_casd_df1_inst_f32 highpass; +//constants for 10Hz highpass +float highpass_const[] = {0.8005910267, -1.6011820533, 0.8005910267, 1.5610153913, -0.6413487154};//{a0 a1 a2 -b1 -b2} +float highpass_states[4]; + +//*** CALIBRATIE *** + +// + +//*** BICEP EMG *** +void Biceps() +{ + uint16_t emg_valueB; + float emg_value_f32B; + + + //lezen + emg_valueB = emgB.read_u16(); // read direct ADC result, converted to 16 bit integer (0..2^16 = 0..65536 = 0..3.3V) + emg_value_f32B = emgB.read(); + + + //filteren + arm_biquad_cascade_df1_f32(&highpass, &emg_value_f32B, &filtered_emgB, 1 ); + + arm_biquad_cascade_df1_f32(&lowpass, &filtered_emgB, &filtered_emgB, 1 ); + + filtered_emgB = fabs(filtered_emgB); + + + //moving average + B0=filtered_emgB; + + MOVAVG_B=B0*0.1+B1*0.1+B2*0.1+B3*0.1+B4*0.1+B5*0.1+B6*0.1+B7*0.1+B8*0.1+B9*0.1; + + B9=B8; + B8=B7; + B7=B6; + B6=B5; + B5=B4; + B4=B3; + B3=B2; + B2=B1; + B1=B0; + + //naar scherm sturen + scope.set(0,emg_valueB); + scope.set(1,MOVAVG_B); + scope.send(); + + +// *** MAIN *** + int main() { + + + + + if (filtered_emgB >= drempelwaardeB1) { + yB1=1; + if (filtered_emgB >= drempelwaardeB2) { + yB2=1; + if (filtered_emgB >= drempelwaardeB3) { + yB3=1; + } else { + yB3=0; + } + } else { + yB2=0; + } + } else { + yB1=0; + } + +