Diff: main.cpp

Revision:

21:2c26b74a3e48

Parent:

20:97059009a491

Child:

22:08b3cd7bec7f

--- a/main.cpp	Thu Sep 22 08:53:50 2016 +0000
+++ b/main.cpp	Tue Oct 29 09:51:59 2019 +0000
@@ -1,37 +1,101 @@
 #include "mbed.h"
 #include "HIDScope.h"
+#include "FilterDesign.h"
+#include "BiQuad.h"
+#include "BiQuad4.h"
+#include "MODSERIAL.h"
+
+Serial pc(USBTX,USBRX);
+DigitalIn button(SW3) ;
+
 
 //Define objects
 AnalogIn    emg0( A0 );
 AnalogIn    emg1( A1 );
+AnalogIn potmeter1(PTC11);          // Input of two potmeters
+AnalogIn potmeter2(PTC10);
 
-Ticker      sample_timer;
+
+Ticker      ticker_calibration;   // Ticker to send the EMG signals to screen
+Ticker      sample_timer;           // Ticker for reading out EMG
 HIDScope    scope( 2 );
 DigitalOut  led(LED1);
 
-/** Sample function
- * this function samples the emg and sends it to HIDScope
- **/
-void sample()
-{
-    /* Set the sampled emg values in channel 0 (the first channel) and 1 (the second channel) in the 'HIDScope' instance named 'scope' */
-    scope.set(0, emg0.read() );
-    scope.set(1, emg1.read() );
-    /* Repeat the step above if required for more channels of required (channel 0 up to 5 = 6 channels) 
-    *  Ensure that enough channels are available (HIDScope scope( 2 ))
-    *  Finally, send all channels to the PC at once */
-    scope.send();
-    /* To indicate that the function is working, the LED is toggled */
-    led = !led;
-}
+volatile double emg1_filtered;      //measured value of the first emg
+volatile double emg2_filtered;      //measured value of the second emg
+volatile double emg1_max ;           // calibrated value of first emg
+volatile double emg2_max ;
+volatile double emg1_cal = 0.1;
+ 
+ // Read EMG
+//void EMGread()
+//{
+//    emg1_filtered = FilterDesign(emg0.read());
+//    emg2_filtered = FilterDesign(emg1.read());
+    //pc.printf("emg1_cal = %f, emg2_cal = %f \n\r", emg1_filtered, emg2_filtered);
+//}
+
+
+ 
+
+void sample() ;
+void EMGcalibration () ;
+
+
+
 
 int main()
 {   
     /**Attach the 'sample' function to the timer 'sample_timer'.
     * this ensures that 'sample' is executed every... 0.002 seconds = 500 Hz
     */
+    
+    pc.baud(115200);
+    //EMGcalibration();
     sample_timer.attach(&sample, 0.002);
-
+    
+   
     /*empty loop, sample() is executed periodically*/
-    while(1) {}
+    while(true) {
+        if(SW3==0){
+            EMGcalibration();
+            }
+        if(emg1_filtered >= 0.8){
+            led = !led;
+        }
+        }
+}
+
+
+
+
+
+
+void sample() 
+{
+    emg1_filtered = FilterDesign(emg0.read());
+    emg2_filtered = FilterDesign(emg1.read());
+    /* Set the sampled emg values in channel 0 (the first channel) and 1 (the second channel) in the 'HIDScope' instance named 'scope' */
+    scope.set(0, emg1_filtered ) ;
+    scope.set(1, emg2_filtered );
+    /* Repeat the step above if required for more channels of required (channel 0 up to 5 = 6 channels) 
+    *  Ensure that enough channels are available (HIDScope scope( 2 ))
+    *  Finally, send all channels to the PC at once */
+    scope.send();
+    /* To indicate that the function is working, the LED is toggled */
+    //pc.printf("%f", emg1_filtered)
+    //led = !led;
+}
+
+void EMGcalibration ()
+{
+    
+Timer t;
+t.start();
+    do { 
+    ticker_calibration.attach(&sample, 0.002);
+    if(emg1_cal < emg1_filtered){
+        emg1_cal = emg1_filtered ;
+        }
+        }while(t<10);
 }
\ No newline at end of file