Werkcollege opgave 23 september BMT K9

Dependencies:   Encoder HIDScope MODSERIAL mbed QEI biquadFilter

Revision:
18:68067ffd169e
Parent:
17:a69df9645074
Child:
19:bd453bee03f6
diff -r a69df9645074 -r 68067ffd169e main.cpp
--- 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