Diff: main.cpp

Revision:

24:6427b144b17c

Parent:

23:7e9505da7f48

Child:

25:d17a7d3ed6f6

--- a/main.cpp	Tue Oct 11 11:42:16 2022 +0000
+++ b/main.cpp	Tue Oct 11 11:49:31 2022 +0000
@@ -68,7 +68,7 @@
     
     while (1) {
         /* If cycle count divided by 100 does not have a rest. test if pit */
-        if (ccount % 100 == 0 && gotoPit == 0)
+        if (ccount % 300 == 0 && gotoPit == 0)
         {
             TE_LogVoltage(ccount);
             gotoPit = PitTest();
@@ -148,6 +148,12 @@
     wait(1.0);
     m3pi.cls();
     m3pi.printf("** 2 **");
+    wait(1.0);
+    m3pi.cls();
+    m3pi.printf("** 1 **");
+    wait(1.0);
+    m3pi.cls();
+    m3pi.printf("** Go **");
     
     
     
@@ -155,7 +161,7 @@
 int PitTest(void){
 /* Test the batteri voltage if the robot is not headed for pit */ 
     
-    const float BATVOLTTRESHOLD = 4.64; // Treshold i volt
+    const float BATVOLTTRESHOLD = 4.50; // Treshold i volt
     int result = 0;
     
     /*Test if the voltage is below the threshold if so turn on go to pit mode*/