Werkcollege opgave 23 september BMT K9
Dependencies: Encoder HIDScope MODSERIAL mbed QEI biquadFilter
Diff: main.cpp
- Revision:
- 15:7870f7912904
- Parent:
- 14:57d38789bff2
- Child:
- 16:ca457fa8257f
- Child:
- 17:a69df9645074
--- a/main.cpp Wed Oct 07 14:25:55 2015 +0000 +++ b/main.cpp Wed Oct 07 15:34:30 2015 +0000 @@ -3,13 +3,24 @@ #include "MODSERIAL.h" #include "biquadFilter.h" //Filter direct form II -//Define objects +//Define inputs AnalogIn emgL(PTB0); //Analog input left arm AnalogIn emgR(PTB1); //Analog input right arm +//Define constants +float emgL_L; + Ticker looptimer; volatile bool looptimerflag; -biquadFilter Lowpassfilter(0 ,0.17156822136, 0.2928920553, 0.5857841107, 0.2928920554); //biquadfilter naam(a1,a2,bo,b1,b2) + +const float a1 = 0; +const float a2 = 0.17156822136; +const float b0 = 0.2928920553; +const float b1 = 0.5857841107; +const float b2 = 0.2928920554; // Waarde van biquads via groep 1 2014 +biquadFilter Lowpassfilter (a1, a2, b0, b1, b2); + +HIDScope scope(1); // 1 HIDScope kanaal void setlooptimerflag(void) { @@ -19,11 +30,13 @@ int main() { looptimer.attach(setlooptimerflag,0.01); - while(1) { + while(true) { - while (looptimerflag !=1) { - looptertimerflag = 0; - output = Lowpassfilter.step(emgL); + while (looptimerflag !=true) { + looptimerflag = false; + emgL_L = Lowpassfilter.step(emgL); //emgL_L Linker bicep met lowpass filter } + scope.set(0,emgL_L); + scope.send(); } } \ No newline at end of file