Werkcollege opgave 23 september BMT K9

Dependencies:   Encoder HIDScope MODSERIAL mbed QEI biquadFilter

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