Tim Luten / Mbed 2 deprecated DEMO_TEST_LIJN

Dependencies:   Demo_TEST3 QEI biquadFilter mbed

Fork of Demo_TEST3 by Biorobotica TIC

Revision:
7:b53f0c4cf2b9
Parent:
6:1f722bf6a89b
Child:
8:1efebfebe733
--- a/main.cpp	Fri Oct 26 08:53:26 2018 +0000
+++ b/main.cpp	Fri Oct 26 10:24:09 2018 +0000
@@ -17,7 +17,7 @@
 DigitalIn   zeromax(PTC6);                                                      // Button used for switching between zero and max
 Ticker      emgSampleTicker;                                                    // Ticker for sample frequency           
                                           
-Servo myservo(D13);
+Servo myservo(D9);
 
 DigitalOut motor1direction(D7);
 PwmOut motor1control(D6);
@@ -250,17 +250,21 @@
             
             
         if (movagL > thresholdL)
-        {   motor1control.write(0.8);
+        {   motor1control.write(0.12);
+            wait(0.1);
             }
         else {
             motor1control.write(0);
+            wait(0.1);
             }
             
         if (movagR > thresholdR)
         {   motor2control.write(0.8);
+             wait(0.1);
             }
         else {
             motor2control.write(0);
+            wait(0.1);
             }