Ivelin Kozarev / Mbed 2 deprecated TDP_main_fork

Team Design project 3 main file

Dependencies:   LocalPositionSystem MMA8451Q Motor_Driver Sensors mbed

Fork of TDP_main by Yelfie

Diff: main.cpp

Revision:
33:60bd40e9839e
Parent:
32:d1dc27f4a18d
Child:
34:9e7d192ee06c
--- a/main.cpp	Tue Mar 24 12:29:58 2015 +0000
+++ b/main.cpp	Tue Mar 24 12:43:44 2015 +0000
@@ -89,19 +89,21 @@
 //            printBluetooth();
 //        }
         if (sensorsCheckSum == 94) {
+            motors.setSpeed (normalSpeed*2);
+            wait(0.4);
         }
         else if (sensorsCheckSum < 96) {
             motors.setSpeed (0.0);
             motors.setLeftSpeed(normalSpeed*2);
-            wait(0.01);
+            wait(0.2);
         }
         else if (sensorsCheckSum > 96) {
             motors.setSpeed (0.0);
             motors.setRightSpeed(normalSpeed*2);
-            wait(0.01);
+            wait(0.2);
         }
-        motors.setSpeed (normalSpeed);
-        wait(0.1);
+        motors.setSpeed(0.0);
+        wait(0.2);
     }
 
 /*