This is with minumum of 10 milliseconds threshold delay 00:53

Dependencies:   biquadFilter MODSERIAL QEI Servo mbed

Fork of StateMachine_EMg_RKI_PID_MOTOR_metklikenalles by Gaston Gabriël

Revision:
5:19f59a855475
Parent:
4:c7be673eb4a1
Child:
6:f55ab7e38a7f
--- a/main.cpp	Thu Nov 01 15:08:05 2018 +0000
+++ b/main.cpp	Thu Nov 01 15:29:32 2018 +0000
@@ -101,6 +101,7 @@
                 if(emg1_filtered>temp_highest_emg1)
                     {
                     temp_highest_emg1= emg1_filtered;
+                    pc.printf("Temp1 = %f \r\n",temp_highest_emg1);
                     }
                 }
             if(timer_calibration>10 && timer_calibration<15)
@@ -130,6 +131,7 @@
                 if(emg3_filtered>temp_highest_emg3)
                     {
                     temp_highest_emg3= emg3_filtered;
+                    pc.printf("Temp3 = %f \r\n",temp_highest_emg3);
                     }
                 }
             if(timer_calibration>40 && timer_calibration<45)
@@ -142,9 +144,10 @@
                 {
                 led2=!led2;
                 led3=!led3;
-                if(emg3_filtered>temp_highest_emg3)
+                if(emg4_filtered>temp_highest_emg4)
                     {
-                    temp_highest_emg3= emg3_filtered;
+                    temp_highest_emg4= emg4_filtered;
+                    pc.printf("Temp4 = %f \r\n",temp_highest_emg4);
                     }
                 }
     led1=1;