Filter emg 7-10-15 v1
Dependencies: HIDScope mbed MODSERIAL
Kalibratie.cpp@20:11e1244ad2ad, 2015-10-14 (annotated)
- Committer:
- Bartvaart
- Date:
- Wed Oct 14 12:36:42 2015 +0000
- Revision:
- 20:11e1244ad2ad
- Parent:
- 19:6c0245063b96
- Child:
- 21:8fe8419de3e9
Kabel ruis lijkt nog niet weg te zijn, we gaan het nu aan een pro iemand vragen
Who changed what in which revision?
User | Revision | Line number | New contents of line |
---|---|---|---|
Bartvaart | 16:8f175d2a472f | 1 | #include "Kalibratie.h" |
Bartvaart | 17:cfe44346645c | 2 | #include "Filterdesigns.h" |
Bartvaart | 20:11e1244ad2ad | 3 | #include "MODSERIAL.h" //bugfix |
Bartvaart | 17:cfe44346645c | 4 | |
Bartvaart | 17:cfe44346645c | 5 | Timer Timermax; |
Bartvaart | 17:cfe44346645c | 6 | Timer Timermin; |
Bartvaart | 17:cfe44346645c | 7 | AnalogIn emg2(A0); //Analog input van emg kabels |
Bartvaart | 20:11e1244ad2ad | 8 | MODSERIAL pc2(USBTX, USBRX); //bugfix |
Bartvaart | 17:cfe44346645c | 9 | DigitalOut LedGreen(LED2); |
Bartvaart | 17:cfe44346645c | 10 | DigitalOut LedRed(LED1); |
Bartvaart | 17:cfe44346645c | 11 | |
Bartvaart | 17:cfe44346645c | 12 | void Init() |
Bartvaart | 17:cfe44346645c | 13 | { |
Bartvaart | 17:cfe44346645c | 14 | LedGreen = 1; |
Bartvaart | 17:cfe44346645c | 15 | LedRed = 1; |
Bartvaart | 17:cfe44346645c | 16 | } |
Bartvaart | 17:cfe44346645c | 17 | |
Bartvaart | 17:cfe44346645c | 18 | double KalibratieMax(bool &readymax) //Kalibratie van de maximum waarde |
Bartvaart | 17:cfe44346645c | 19 | { |
Bartvaart | 19:6c0245063b96 | 20 | Timermax.reset(); |
Bartvaart | 17:cfe44346645c | 21 | Timermax.start(); //Start de timer |
Bartvaart | 17:cfe44346645c | 22 | |
Bartvaart | 17:cfe44346645c | 23 | LedGreen.write(0); //Led aan |
Bartvaart | 17:cfe44346645c | 24 | double ymax = 0; |
Bartvaart | 16:8f175d2a472f | 25 | |
Bartvaart | 20:11e1244ad2ad | 26 | while(Timermax <= 5) { //Als timer onder de 5 seconden is dit uitvoeren |
Bartvaart | 17:cfe44346645c | 27 | double u = emg2.read(); |
Bartvaart | 20:11e1244ad2ad | 28 | double y = Filterdesigns(u); |
Bartvaart | 20:11e1244ad2ad | 29 | if (y > ymax && Timermax >= 1) { //Als de gemeten waarde groter is dan de opgeslagen waarde wordt dit de nieuwe opgeslagen waarde |
Bartvaart | 17:cfe44346645c | 30 | ymax = y; |
Bartvaart | 17:cfe44346645c | 31 | } |
Bartvaart | 17:cfe44346645c | 32 | else { |
Bartvaart | 17:cfe44346645c | 33 | } |
Bartvaart | 20:11e1244ad2ad | 34 | pc2.printf("y = %f en ymax = %f \n",y,ymax); //bugfix |
Bartvaart | 17:cfe44346645c | 35 | } |
Bartvaart | 19:6c0245063b96 | 36 | |
Bartvaart | 17:cfe44346645c | 37 | Timermax.stop(); |
Bartvaart | 17:cfe44346645c | 38 | LedGreen.write(1); //Led aan |
Bartvaart | 17:cfe44346645c | 39 | readymax = 1; // Zodat systeem weet wanneer kalibratie voltooid is |
Bartvaart | 17:cfe44346645c | 40 | return ymax; |
Bartvaart | 17:cfe44346645c | 41 | } |
Bartvaart | 17:cfe44346645c | 42 | |
Bartvaart | 17:cfe44346645c | 43 | double KalibratieMin(bool &readymin) //Kalibratie van de minimum waarde |
Bartvaart | 17:cfe44346645c | 44 | { |
Bartvaart | 19:6c0245063b96 | 45 | Timermin.reset(); |
Bartvaart | 17:cfe44346645c | 46 | Timermin.start(); |
Bartvaart | 17:cfe44346645c | 47 | |
Bartvaart | 17:cfe44346645c | 48 | LedRed.write(0); |
Bartvaart | 17:cfe44346645c | 49 | double ymin = 10; |
Bartvaart | 17:cfe44346645c | 50 | |
Bartvaart | 20:11e1244ad2ad | 51 | while(Timermin <= 5) { |
Bartvaart | 17:cfe44346645c | 52 | double u = emg2.read(); |
Bartvaart | 20:11e1244ad2ad | 53 | double y = Filterdesigns(u); |
Bartvaart | 17:cfe44346645c | 54 | |
Bartvaart | 20:11e1244ad2ad | 55 | if (y < ymin && Timermin >= 1) { |
Bartvaart | 17:cfe44346645c | 56 | ymin = y; |
Bartvaart | 17:cfe44346645c | 57 | } |
Bartvaart | 17:cfe44346645c | 58 | else { |
Bartvaart | 17:cfe44346645c | 59 | } |
Bartvaart | 20:11e1244ad2ad | 60 | pc2.printf("y = %f en ymax = %f \n",y,ymin); //bugfix |
Bartvaart | 17:cfe44346645c | 61 | } |
Bartvaart | 17:cfe44346645c | 62 | |
Bartvaart | 17:cfe44346645c | 63 | Timermin.stop(); |
Bartvaart | 17:cfe44346645c | 64 | LedRed.write(1); |
Bartvaart | 17:cfe44346645c | 65 | readymin = 1; |
Bartvaart | 17:cfe44346645c | 66 | return ymin; |
Bartvaart | 17:cfe44346645c | 67 | } |