Algorithmus

Dependencies:   mbed

Revision:
14:2926932e26df
Parent:
13:845e49f20426
Child:
15:0ae61d3d199f
--- a/Motion.cpp	Fri May 04 19:10:36 2018 +0000
+++ b/Motion.cpp	Fri May 04 19:56:05 2018 +0000
@@ -39,8 +39,8 @@
         speedLeft = MOVE_SPEED;
         speedRight = -MOVE_SPEED;
         
-        controller.setDesiredSpeedLeft(MOVE_SPEED);
-        controller.setDesiredSpeedRight(-MOVE_SPEED);
+        controller.setDesiredSpeedLeft(actSpeed);
+        controller.setDesiredSpeedRight(-actSpeed);
         
         t.start();
         
@@ -55,6 +55,7 @@
             if (enableMotorDriver == 0) {enableMotorDriver = 1;}
             
             control();
+            accel(MOVE_SPEED);
             /*
             accel(MOVE_SPEED);
             controller.setDesiredSpeedLeft(actSpeed);