EMG script met 2e signaal, invalid build system
Dependencies: HIDScope MODSERIAL biquadFilter mbed
Fork of EMG by
main.cpp@19:34456a1effc4, 2015-10-07 (annotated)
- Committer:
- Margreeth95
- Date:
- Wed Oct 07 18:26:10 2015 +0000
- Revision:
- 19:34456a1effc4
- Parent:
- 18:12250e88037f
- Child:
- 20:a0642e983da9
Aansturen lampje met EMG signaal werkt, laagdoorlaatfilter moet nog worden aangepast
Who changed what in which revision?
User | Revision | Line number | New contents of line |
---|---|---|---|
vsluiter | 0:32bb76391d89 | 1 | #include "mbed.h" |
vsluiter | 11:ce72ec658a95 | 2 | #include "HIDScope.h" |
Margreeth95 | 19:34456a1effc4 | 3 | #include "MODSERIAL.h" |
Margreeth95 | 19:34456a1effc4 | 4 | #include "biquadFilter.h" |
vsluiter | 0:32bb76391d89 | 5 | |
vsluiter | 4:8b298dfada81 | 6 | //Define objects |
Margreeth95 | 18:12250e88037f | 7 | AnalogIn EMG_left(A0); //Analog input |
Margreeth95 | 18:12250e88037f | 8 | AnalogIn EMG_right(A1); |
Margreeth95 | 18:12250e88037f | 9 | Ticker SampleEMG; |
Margreeth95 | 18:12250e88037f | 10 | Ticker ScopeTimer; |
Margreeth95 | 19:34456a1effc4 | 11 | Ticker serial; |
Margreeth95 | 19:34456a1effc4 | 12 | HIDScope scope(3); |
Margreeth95 | 19:34456a1effc4 | 13 | DigitalOut led(LED_RED); |
Margreeth95 | 19:34456a1effc4 | 14 | MODSERIAL pc(USBTX, USBRX); |
Margreeth95 | 19:34456a1effc4 | 15 | |
Margreeth95 | 18:12250e88037f | 16 | |
Margreeth95 | 19:34456a1effc4 | 17 | // Declaring variables |
Margreeth95 | 18:12250e88037f | 18 | double EMG_L_f_v1 = 0, EMG_L_f_v2 = 0; |
Margreeth95 | 19:34456a1effc4 | 19 | double EMG_L_fh=0; |
Margreeth95 | 19:34456a1effc4 | 20 | double EMG_left_value; |
Margreeth95 | 19:34456a1effc4 | 21 | double EMG_f1; |
Margreeth95 | 19:34456a1effc4 | 22 | double EMG_f2; |
Margreeth95 | 18:12250e88037f | 23 | |
Margreeth95 | 18:12250e88037f | 24 | // coëfficiënten |
Margreeth95 | 19:34456a1effc4 | 25 | const double BiGainEMG_Lh = 0.723601, BiGainEMG_Ll=0.983892; |
Margreeth95 | 19:34456a1effc4 | 26 | const double EMGh_a1 = -1.74355513773*BiGainEMG_Lh, EMGh_a2 = 0.80079826172*BiGainEMG_Lh, EMGh_b0 = 1.0*BiGainEMG_Lh, EMGh_b1 = -1.99697722433*BiGainEMG_Lh, EMGh_b2 = 1.0*BiGainEMG_Lh; //coefficients for high-pass filter |
Margreeth95 | 19:34456a1effc4 | 27 | const double EMGl_a1 = 1.96775103303*BiGainEMG_Ll, EMGl_a2 = 0.96827054038*BiGainEMG_Ll, EMGl_b0 = 1.0*BiGainEMG_Ll, EMGl_b1 = 1.99999993582*BiGainEMG_Ll, EMGl_b2 = 1.0*BiGainEMG_Ll; // coefficients for low-pass filter |
Margreeth95 | 19:34456a1effc4 | 28 | biquadFilter EMG_highpass (EMGh_a1, EMGh_a2, EMGh_b0, EMGh_b1, EMGh_b2); // creates the high pass filter |
Margreeth95 | 19:34456a1effc4 | 29 | biquadFilter EMG_lowpass (EMGl_a1, EMGl_a2, EMGl_b0, EMGl_b1, EMGl_b2); // creates the low pass filter |
Margreeth95 | 19:34456a1effc4 | 30 | |
Margreeth95 | 19:34456a1effc4 | 31 | // EMG filtering function |
Margreeth95 | 19:34456a1effc4 | 32 | void EMGfilter() |
Margreeth95 | 19:34456a1effc4 | 33 | { |
Margreeth95 | 19:34456a1effc4 | 34 | EMG_left_value = EMG_left.read(); |
Margreeth95 | 19:34456a1effc4 | 35 | EMG_f1 = EMG_highpass.step(EMG_left_value); |
Margreeth95 | 19:34456a1effc4 | 36 | EMG_f2 = EMG_lowpass.step(EMG_f1); |
Margreeth95 | 19:34456a1effc4 | 37 | } |
vsluiter | 2:e314bb3b2d99 | 38 | |
Margreeth95 | 18:12250e88037f | 39 | // HIDScope |
Margreeth95 | 18:12250e88037f | 40 | void ScopeSend() |
Margreeth95 | 18:12250e88037f | 41 | { |
Margreeth95 | 19:34456a1effc4 | 42 | scope.set(0, EMG_left_value); |
Margreeth95 | 19:34456a1effc4 | 43 | scope.set(1, EMG_f1); |
Margreeth95 | 19:34456a1effc4 | 44 | scope.set(2, EMG_f2); |
Margreeth95 | 18:12250e88037f | 45 | scope.send(); |
Margreeth95 | 18:12250e88037f | 46 | } |
Margreeth95 | 18:12250e88037f | 47 | |
Margreeth95 | 19:34456a1effc4 | 48 | // Serial communication |
Margreeth95 | 19:34456a1effc4 | 49 | void serial_() |
Margreeth95 | 18:12250e88037f | 50 | { |
Margreeth95 | 19:34456a1effc4 | 51 | pc.baud(115200); |
Margreeth95 | 19:34456a1effc4 | 52 | pc.printf("%d\n", EMG_L_fh); |
Margreeth95 | 18:12250e88037f | 53 | } |
Margreeth95 | 19:34456a1effc4 | 54 | |
vsluiter | 0:32bb76391d89 | 55 | int main() |
vsluiter | 0:32bb76391d89 | 56 | { |
Margreeth95 | 18:12250e88037f | 57 | SampleEMG.attach(&EMGfilter, 0.002); |
Margreeth95 | 18:12250e88037f | 58 | ScopeTimer.attach(&ScopeSend, 0.002); |
Margreeth95 | 19:34456a1effc4 | 59 | while(1) |
Margreeth95 | 19:34456a1effc4 | 60 | { |
Margreeth95 | 19:34456a1effc4 | 61 | if (EMG_f2 > 0.08) |
Margreeth95 | 19:34456a1effc4 | 62 | { |
Margreeth95 | 19:34456a1effc4 | 63 | led.write(0); |
Margreeth95 | 19:34456a1effc4 | 64 | } |
Margreeth95 | 19:34456a1effc4 | 65 | |
Margreeth95 | 19:34456a1effc4 | 66 | else |
Margreeth95 | 19:34456a1effc4 | 67 | { |
Margreeth95 | 19:34456a1effc4 | 68 | led.write(1); |
Margreeth95 | 19:34456a1effc4 | 69 | } |
Margreeth95 | 19:34456a1effc4 | 70 | } |
vsluiter | 0:32bb76391d89 | 71 | } |