Basic funcitonality

Dependencies:   mbed mbed-rtos SevenSegmentSerial HC_SR04_Ultrasonic_Library

Revision:
7:04c8f6b7a42a
Parent:
6:c8f14de0e3f4
Child:
8:88cf71c84e04
Child:
9:1d973bd9786c
--- a/main.cpp	Tue Apr 27 17:12:52 2021 +0000
+++ b/main.cpp	Wed Apr 28 16:05:30 2021 +0000
@@ -30,7 +30,7 @@
 
 int width[3];           //width of each checkpoint, mm
 int threshold[3];       //how much distance has to change, mm
-int sensitivity[3] = {0.05,0.05,0.05};
+float sensitivity[3] = {0.1,0.1,0.1};
 int total_laps = 3;
 int current_lap = 0;
 int i = 500;
@@ -76,7 +76,7 @@
     start_done = 1;
     speaker.period(1.0/E5NOTE);
     speaker =0.5;
-    Thread::wait(500);
+    Thread::wait(1500);
     speaker = 0;
     rgbCtrl1 = 0;
     rgbCtrl2 = 0;
@@ -109,9 +109,19 @@
         led1 = 0;
         led2 = 0;
         current_lap++;
-        pc.printf("%d\n",current_lap);
+        //pc.printf("%d\n",current_lap);
         track_state = past_start;
-        pc.putc('0');
+        switch (current_lap) {
+            case 1 :
+                pc.putc('0');
+                break;
+            case 2 :
+                pc.putc('3');
+                break;
+            case 3 :
+                pc.putc('6');
+                break;
+        }
         thread1.start(&play_audio);
     }
 }
@@ -131,7 +141,17 @@
         //pc.printf("Past Checkpoint 1\n");
         led1 = 1;
         track_state = past_cp1;
-        pc.putc('1');
+        switch (current_lap) {
+            case 1 :
+                pc.putc('1');
+                break;
+            case 2 :
+                pc.putc('4');
+                break;
+            case 3 :
+                pc.putc('7');
+                break;
+        }
         thread1.start(&play_audio);
     }
 }
@@ -151,7 +171,17 @@
         //pc.printf("Past Checkpoint 2\n");
         led2 = 1;
         track_state = past_cp2;
-        pc.putc('2');
+        switch (current_lap) {
+            case 1 :
+                pc.putc('2');
+                break;
+            case 2 :
+                pc.putc('5');
+                break;
+            case 3 :
+                pc.putc('8');
+                break;
+        }
         thread1.start(&play_audio);
     }
 }
@@ -180,7 +210,7 @@
         Thread::wait(50);
     }
 
-    //starting countdown
+    //starting countdown sequence
     thread2.start(&start_race);
 
     //false start detect