Werkcollege opgave 23 september BMT K9
Dependencies: Encoder HIDScope MODSERIAL mbed QEI biquadFilter
Diff: main.cpp
- Revision:
- 14:57d38789bff2
- Parent:
- 13:04e10692e239
- Child:
- 15:7870f7912904
--- a/main.cpp Wed Oct 07 14:14:54 2015 +0000 +++ b/main.cpp Wed Oct 07 14:25:55 2015 +0000 @@ -4,19 +4,16 @@ #include "biquadFilter.h" //Filter direct form II //Define objects -AnalogIn emgB(PTB0); //Analog input left -AnalogIn emgT(PTB1); //Analog input right +AnalogIn emgL(PTB0); //Analog input left arm +AnalogIn emgR(PTB1); //Analog input right arm Ticker looptimer; - -biquadFilter Lowpassfilter; -biquadFilter Highpassfilter; - -output = Lowpassfilter.step(input); +volatile bool looptimerflag; +biquadFilter Lowpassfilter(0 ,0.17156822136, 0.2928920553, 0.5857841107, 0.2928920554); //biquadfilter naam(a1,a2,bo,b1,b2) void setlooptimerflag(void) { - looptimerflag = 1; + looptimerflag = true; } int main() @@ -24,10 +21,9 @@ looptimer.attach(setlooptimerflag,0.01); while(1) { - { - while(looptimerflag !=1) { - loopterimerflag 0; - output = Lowpassfilter.step(input); - } + while (looptimerflag !=1) { + looptertimerflag = 0; + output = Lowpassfilter.step(emgL); } - } \ No newline at end of file + } +} \ No newline at end of file