Script voor aansturen motoren

Dependencies:   Encoder HIDScope MODSERIAL mbed-dsp mbed

Revision:
13:7fe679538649
Parent:
12:795657e66960
Child:
14:affdb0636f24
--- a/main.cpp	Tue Oct 28 00:52:08 2014 +0000
+++ b/main.cpp	Tue Oct 28 11:21:09 2014 +0000
@@ -104,18 +104,18 @@
     wait(1);
     speed2 = 1;
     motordir1=1;
-    pwm_motor1.write(speed2); //Deze snelheid kan lager worden ingesteld om accurator te zijn.
-    wait(0.11);             //naar 90 graden
-    pwm_motor1.write(0);
+    pwm_motor1.write(0.1); //Deze snelheid kan lager worden ingesteld om accurator te zijn.
+    wait(2.7);             //naar 140 graden
+    pwm_motor1.write(0);    //CCW
     wait(1);
     motordir1=0;
     pwm_motor1.write(speed2); //Deze snelheid moet maximaal om het balletje te slaan.
-    wait(0.19);             //balletje slaan
+    wait(0.2);             //balletje slaan, 160 graden
     pwm_motor1.write(0);
     wait(1);
-    motordir1=1;
-    pwm_motor1.write(speed2); //Deze kan lager worden ingesteld om accurater terug te gaan.
-    wait(0.06);            //terug naar begin positie
+    motordir1=1;            //CW
+    pwm_motor1.write(0.1); //Deze kan lager worden ingesteld om accurater terug te gaan.
+    wait(0.5);            //terug naar begin positie, 20 graden
     pwm_motor1.write(0);
 
     Ticker log_timer;
@@ -125,7 +125,7 @@
 
     pc.baud(115200);
     while(1) {
-        wait(1);
+        wait(0.2);
         pc.printf("%d, %f \r\n", motor1.getPosition(), motor1.getSpeed());
     }
 }