Werkcollege opgave 23 september BMT K9

Dependencies:   Encoder HIDScope MODSERIAL mbed QEI biquadFilter

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