Diff: main.cpp

Revision:

0:9033b790f263

Child:

1:83f7e225f7a4

diff -r 000000000000 -r 9033b790f263 main.cpp
--- /dev/null	Thu Jan 01 00:00:00 1970 +0000
+++ b/main.cpp	Tue Nov 01 10:35:26 2016 +0000
@@ -0,0 +1,173 @@
+#include "mbed.h"
+#include "HIDScope.h"
+#include "BiQuad.h"
+#include "math.h"
+#include "MODSERIAL.h"
+
+//Define EMG input 
+AnalogIn        emg0( A0 );
+AnalogIn        emg1( A1 );
+AnalogIn        emg2( A2 );
+MODSERIAL pc    (USBTX, USBRX);
+InterruptIn     knopje1 (D2);
+
+Ticker          sample_timer;
+HIDScope        scope( 3 );     // 3-channel HIDScope object
+
+double signaal;
+double maximum;
+double Spier1Max;
+double Spier2Max;
+double Spier3Max;
+int x = 0;
+bool y = true;
+
+// Filter coordinates of lowpass/highpass filter before rectifier and lowpassfilter for the envelope
+const double b0_low = 0.2929, b1_low = 0.5858, b2_low = 0.2929, a1_low = 0, a2_low = 0.1716;
+const double b0_high = 0.9978, b1_high = -1.9956, b2_high = 0.9978, a1_high = -1.9956, a2_high = 0.9956;
+const double b0_envelope = 2.2059E-5, b1_envelope = 4.4119E-4, b2_envelope = 2.2059E-5, a1_envelope = -1.9867, a2_envelope = 0.9868;
+
+double Spier1, Spier2, Spier3;          // Gefilterde output
+
+// Biquad filters (lowpass and highpass become a chain in the int main)
+BiQuad lowpass1(b0_low, b1_low , b2_low, a1_low, a2_low);
+BiQuad lowpass2(b0_low, b1_low , b2_low, a1_low, a2_low);
+BiQuad lowpass3(b0_low, b1_low , b2_low, a1_low, a2_low);
+BiQuad highpass1(b0_high, b1_high , b2_high, a1_high, a2_high);
+BiQuad highpass2(b0_high, b1_high , b2_high, a1_high, a2_high);
+BiQuad highpass3(b0_high, b1_high , b2_high, a1_high, a2_high);
+BiQuad envelope1(b0_envelope, b1_envelope , b2_envelope, a1_envelope, a2_envelope);
+BiQuad envelope2(b0_envelope, b1_envelope , b2_envelope, a1_envelope, a2_envelope);
+BiQuad envelope3(b0_envelope, b1_envelope , b2_envelope, a1_envelope, a2_envelope);
+BiQuadChain bandpass1;
+BiQuadChain bandpass2;
+BiQuadChain bandpass3;
+
+// Sample function, this function samples the emg and sends it to HIDScope
+void filtering()
+{
+   Spier1 = bandpass1.step(emg0);
+   Spier2 = bandpass2.step(emg1);
+   Spier3 = bandpass3.step(emg2);
+   Spier1 = fabs(Spier1);
+   Spier2 = fabs(Spier2);
+   Spier3 = fabs(Spier3);
+   Spier1 = envelope1.step(Spier1); 
+   Spier2 = envelope2.step(Spier2); 
+   Spier3 = envelope3.step(Spier3); 
+    
+    // Set the sampled and filtered emg values in channel 0/1/2 in the 'HIDScope' instance named 'scope' 
+    scope.set(0, Spier1 );
+    scope.set(1, Spier2 );
+    scope.set(2, Spier3 );
+    
+    scope.send();                               // Sends all channels to the PC at once
+}
+
+float GetMaximumSpier1()
+{
+    maximum = Spier1;
+    for(int i = 0; i<250000;i++)
+    {
+        signaal = Spier1;
+        if(signaal>maximum)
+        {
+            maximum = signaal;
+        }
+        else
+        {
+            maximum = maximum;  
+        }            
+    }
+    return maximum;    
+}
+
+float GetMaximumSpier2()
+{
+    maximum = Spier2;
+    for(int i = 0; i<250000;i++)
+    {
+        signaal = Spier2;
+        if(signaal>maximum)
+        {
+            maximum = signaal;
+        }
+        else
+        {
+            maximum = maximum;  
+        }            
+    }
+    return maximum;    
+}
+
+float GetMaximumSpier3()
+{
+    maximum = Spier3;
+    for(int i = 0; i<250000;i++)
+    {
+        signaal = Spier3;
+        if(signaal>maximum)
+        {
+            maximum = signaal;
+        }
+        else
+        {
+            maximum = maximum;  
+        }            
+    }
+    return maximum;    
+}
+
+void GoOn()
+{
+    x++;
+    y = false;
+}
+
+void StartMeting()
+{
+    switch(x)
+    {
+        case 0:
+            pc.printf("case 0\n\r");
+            y = true;
+            while(y == true) {}
+        case 1:
+            pc.printf("case 1\n\r");
+            Spier1Max = GetMaximumSpier1();
+            pc.printf("Spier1Max = %f\n\r",Spier1Max);
+            y = true;
+            while(y == true) {}
+        case 2:
+            pc.printf("case 2\n\r");
+            Spier2Max = GetMaximumSpier2();
+            pc.printf("Spier2Max = %f\n\r",Spier2Max);
+            y = true;
+            while (y == true) {}
+        case 3:
+            pc.printf("case 3\n\r");
+            Spier3Max = GetMaximumSpier3();
+            pc.printf("Spier3Max = %f\n\r",Spier3Max);
+            y = true;
+            while (y == true) {}
+        case 4:
+            pc.printf("case 4\n\r");
+            break;
+    }
+}    
+
+int main()
+{   
+    bandpass1.add(&lowpass1).add(&highpass1);
+    bandpass2.add(&lowpass2).add(&highpass2);
+    bandpass3.add(&lowpass3).add(&highpass3);
+    sample_timer.attach(&filtering, 0.001);     // Attach the 'sample' function to the timer 'sample_timer'. This ensures that 'sample' is executed every 0.001 seconds = 1000 Hz
+    
+    pc.baud(115200);
+    pc.printf("START\n\r");
+    knopje1.fall(GoOn);
+    StartMeting();
+    pc.printf("Spiermax1 = %f\n\rSpiermax2 = %f\n\rSpier3max = %f\n\r\n\n",Spier1Max,Spier2Max,Spier3Max);
+    
+    while(1) {}                                 // Empty loop, sample() is executed periodically
+}
\ No newline at end of file