A code with functions for turning right and left.

Dependencies:   btbee m3pi_ng mbed

Revision:
17:4e63e8eacad7
Parent:
16:ee3b36038b6b
Child:
18:acc404d8488c
--- a/main.cpp	Mon Jun 08 11:12:40 2015 +0000
+++ b/main.cpp	Mon Jun 08 11:27:29 2015 +0000
@@ -33,6 +33,7 @@
     float s1, s2, s3, s4, s5;
     Timer TurnTime;
     Timer LapTime;
+    Timer TotalTime;
     int counter = 0;
     string path;
     char dir;
@@ -174,7 +175,6 @@
     int stuff;
     char things[1];
     int k = 1;
-    
     btbee.printf("Enter a command string: \n");
 
 while(1) {
@@ -364,6 +364,8 @@
     
     LapTime.start();
     
+    TotalTime.start();
+        
     path = rga.at(location-1).at(goal-1);
     
 while (1) {
@@ -464,14 +466,17 @@
                         
                         goal = command.at(i);
                         
-                         if(goal == 7) {
-                        
-                        command.clear();
-                        i = 0;
-                        command = GetLocation();
-                        location = command.at(i);
-                        i++;
-                        goal = command.at(i);
+                        if(goal == 7) {
+                            TotalTime.stop();
+                            m3pi.printf("%f",TotalTime.read());
+                            command.clear();
+                            i = 0;
+                            command = GetLocation();
+                            m3pi.cls();
+                            location = command.at(i);
+                            i++;
+                            goal = command.at(i);
+                            
                         
                         }