Werkcollege opgave 23 september BMT K9
Dependencies: Encoder HIDScope MODSERIAL mbed QEI biquadFilter
main.cpp@19:bd453bee03f6, 2015-10-08 (annotated)
- Committer:
- bscheltinga
- Date:
- Thu Oct 08 13:35:04 2015 +0000
- Revision:
- 19:bd453bee03f6
- Parent:
- 18:68067ffd169e
- Child:
- 20:d5f5c60adc43
EMG ZAAD ZOOI
Who changed what in which revision?
User | Revision | Line number | New contents of line |
---|---|---|---|
bscheltinga | 0:fe3896c6eeb0 | 1 | #include "mbed.h" |
bscheltinga | 12:0a079e86348e | 2 | #include "HIDScope.h" |
bscheltinga | 0:fe3896c6eeb0 | 3 | #include "MODSERIAL.h" |
bscheltinga | 13:04e10692e239 | 4 | #include "biquadFilter.h" //Filter direct form II |
bscheltinga | 0:fe3896c6eeb0 | 5 | |
bscheltinga | 15:7870f7912904 | 6 | //Define inputs |
bscheltinga | 18:68067ffd169e | 7 | //AnalogIn emgL(A0); //Analog input left arm |
bscheltinga | 18:68067ffd169e | 8 | //AnalogIn emgR(PTB1); //Analog input right arm |
bscheltinga | 19:bd453bee03f6 | 9 | DigitalOut led1(LED_GREEN); |
bscheltinga | 18:68067ffd169e | 10 | MODSERIAL pc(USBTX,USBRX); |
bscheltinga | 4:96e47998d495 | 11 | |
bscheltinga | 15:7870f7912904 | 12 | //Define constants |
bscheltinga | 18:68067ffd169e | 13 | //float emgL_L; |
bscheltinga | 18:68067ffd169e | 14 | |
bscheltinga | 15:7870f7912904 | 15 | |
bscheltinga | 13:04e10692e239 | 16 | Ticker looptimer; |
bscheltinga | 14:57d38789bff2 | 17 | volatile bool looptimerflag; |
bscheltinga | 15:7870f7912904 | 18 | |
bscheltinga | 18:68067ffd169e | 19 | //const float a1 = 0; |
bscheltinga | 18:68067ffd169e | 20 | //const float a2 = 0.17156822136; |
bscheltinga | 18:68067ffd169e | 21 | //const float b0 = 0.2928920553; |
bscheltinga | 18:68067ffd169e | 22 | //const float b1 = 0.5857841107; |
bscheltinga | 18:68067ffd169e | 23 | //const float b2 = 0.2928920554; // Waarde van biquads via groep 1 2014 |
bscheltinga | 18:68067ffd169e | 24 | //biquadFilter Lowpassfilter (a1, a2, b0, b1, b2); |
bscheltinga | 15:7870f7912904 | 25 | |
bscheltinga | 18:68067ffd169e | 26 | HIDScope scope(2); // 1 HIDScope kanaal |
bscheltinga | 0:fe3896c6eeb0 | 27 | |
bscheltinga | 19:bd453bee03f6 | 28 | void setlooptimerflag (void) |
bscheltinga | 13:04e10692e239 | 29 | { |
bscheltinga | 14:57d38789bff2 | 30 | looptimerflag = true; |
bscheltinga | 13:04e10692e239 | 31 | } |
bscheltinga | 11:73817c9df1e5 | 32 | |
bscheltinga | 13:04e10692e239 | 33 | int main() |
bscheltinga | 13:04e10692e239 | 34 | { |
bscheltinga | 18:68067ffd169e | 35 | pc.baud(9600); |
bscheltinga | 18:68067ffd169e | 36 | led1 = 1; |
bscheltinga | 18:68067ffd169e | 37 | looptimer.attach(setlooptimerflag, 0.1); |
bscheltinga | 15:7870f7912904 | 38 | while(true) { |
bscheltinga | 18:68067ffd169e | 39 | |
bscheltinga | 18:68067ffd169e | 40 | while (looptimerflag != true) { |
bscheltinga | 15:7870f7912904 | 41 | looptimerflag = false; |
bscheltinga | 18:68067ffd169e | 42 | //emgL_L = Lowpassfilter.step(emgL.read()); //emgL_L Linker bicep met lowpass filter |
bscheltinga | 18:68067ffd169e | 43 | //scope.set(0,emgL.read()); |
bscheltinga | 18:68067ffd169e | 44 | // scope.set(1,emgL.read()); |
bscheltinga | 18:68067ffd169e | 45 | // scope.send(); |
bscheltinga | 18:68067ffd169e | 46 | led1 = !led1; |
bscheltinga | 13:04e10692e239 | 47 | } |
bscheltinga | 14:57d38789bff2 | 48 | } |
bscheltinga | 14:57d38789bff2 | 49 | } |