Werkcollege opgave 23 september BMT K9
Dependencies: Encoder HIDScope MODSERIAL mbed QEI biquadFilter
Diff: main.cpp
- Revision:
- 18:68067ffd169e
- Parent:
- 17:a69df9645074
- Child:
- 19:bd453bee03f6
--- a/main.cpp Thu Oct 08 12:08:12 2015 +0000 +++ b/main.cpp Thu Oct 08 13:31:56 2015 +0000 @@ -4,23 +4,26 @@ #include "biquadFilter.h" //Filter direct form II //Define inputs -AnalogIn emgL(PTB0); //Analog input left arm -AnalogIn emgR(PTB1); //Analog input right arm +//AnalogIn emgL(A0); //Analog input left arm +//AnalogIn emgR(PTB1); //Analog input right arm +DigitalOut led1(LED_RED); +MODSERIAL pc(USBTX,USBRX); //Define constants -float emgL_L; +//float emgL_L; + Ticker looptimer; volatile bool looptimerflag; -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); +//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 +HIDScope scope(2); // 1 HIDScope kanaal void setlooptimerflag(void) { @@ -29,14 +32,18 @@ int main() { - looptimer.attach(setlooptimerflag,0.01); + pc.baud(9600); + led1 = 1; + looptimer.attach(setlooptimerflag, 0.1); while(true) { - - while (looptimerflag == false) { + + while (looptimerflag != true) { looptimerflag = false; - emgL_L = Lowpassfilter.step(emgL); //emgL_L Linker bicep met lowpass filter - scope.set(0,emgL_L); - scope.send(); + //emgL_L = Lowpassfilter.step(emgL.read()); //emgL_L Linker bicep met lowpass filter + //scope.set(0,emgL.read()); +// scope.set(1,emgL.read()); +// scope.send(); + led1 = !led1; } } } \ No newline at end of file