Combination code of movement and emg code with small changes for 2 motors.

Dependencies:   HIDScope MODSERIAL QEI biquadFilter mbed

Fork of EMG_converter_code by Gerlinde van de Haar

Revision:
2:83659da3e5fe
Parent:
1:9913e3886643
Child:
3:a69f041108d4
diff -r 9913e3886643 -r 83659da3e5fe main.cpp
--- a/main.cpp	Fri Oct 23 08:36:59 2015 +0000
+++ b/main.cpp	Mon Oct 26 13:22:32 2015 +0000
@@ -6,6 +6,8 @@
 AnalogIn    emg(A0); //Analog of EMG input
 Ticker      sample_timer;
 HIDScope    scope(2);        // Instantize a 2-channel HIDScope object
+DigitalIn button1(PTA4);//test button for starting motor 1
+DigitalOut led1(LED_RED);
 /*The biquad filters required to transform the EMG signal into an usable signal*/
 biquadFilter filterhigh1(-1.1430, 0.4128, 0.6389, -1.2779, 0.6389);
 biquadFilter filterlow1(1.9556, 0.9565, 0.9780, 1.9561, 0.9780);
@@ -17,38 +19,43 @@
 double signalpart3;
 double signalpart4;
 double signalfinal;
-        
+double onoffsignal;
+double maxcal=1;        
 /* 
  */
-void filter()
-{
+void filter(){
         emg_value = emg.read();//read the emg value from the elektrodes
         signalpart1 = filterhigh1.step(emg_value);//Highpass filter for removing offset and artifacts
         signalpart2 = abs(signalpart1);//rectify the filtered signal
         signalpart3 = filterlow1.step(signalpart2);//low pass filter to envelope the emg
         signalpart4 = notch.step(signalpart3);//notch filter to remove 50Hz signal
         signalfinal = filterlow2.step(signalpart4);//2nd low pass filter to envelope the emg
+        onoffsignal=signalfinal/maxcal;//divide the emg signal by the max EMG to calibrate the signal per person
         scope.set(0,emg_value);//set emg signal to scope in channel 1
-        scope.set(1,signalfinal);//set filtered signal to scope in channel 2
+        scope.set(1,onoffsignal);//set filtered signal to scope in channel 2
     scope.send();//send the signals to the scope
 }
-
+double normalcal(){
+    double signalmeasure =emg.read();
+    if (signalmeasure > maxcal){
+        signalmeasure = maxcal;
+        }
+    return maxcal;
+}
+const int button_pressed = 0;
+bool caldone =0;
 int main()
 {
-    int caldone=0;
-    double maxValue = 0;//define the max value to start with
-    while(1){
-    while(PTC6){//as long as the button is pressed record the emg signal
-        double signalmeasure=emg.read();//read the emg values to check for max
-        if(signalmeasure > maxValue){
-            maxValue = signalmeasure;
+    
+    if(button1.read() == button_pressed){//as long as the button is pressed record the emg signal
+    led1.write(!led1.read());
+    }   /* double signalmeasure=emg.read();//read the emg values to check for max
+        if(signalmeasure > maxcal){
+            maxcal = signalmeasure;
             }
-            caldone=1;
-        }
-    double maxcal=maxValue;
+            caldone=1; */
+    
     if(caldone==1){
         sample_timer.attach(&filter, 0.002);//continously execute the EMG reader and filter
-        double onoffsignal=signalfinal/maxcal;//divide the emg signal by the max EMG to calibrate the signal per person
-}
-}
+        }
 }
\ No newline at end of file