Diff: main.cpp

Revision:

5:5351ab7d9132

Parent:

4:95b13ca0550e

Child:

6:466f54c00c50

diff -r 95b13ca0550e -r 5351ab7d9132 main.cpp
--- a/main.cpp	Wed Aug 24 20:18:03 2022 +0000
+++ b/main.cpp	Thu Aug 25 13:39:03 2022 +0000
@@ -14,6 +14,7 @@
 volatile int g_bumperR_flag = 0;
 volatile int g_BACK_flag = 0;
 volatile int g_START_flag = 0; 
+int Target;
 
 /**Voids for N5110 Menu Display*/
 void initialiseMbed();
@@ -22,6 +23,8 @@
 void initUltrasonic();
 void dist(int distance);
 void techSupport();
+void TargetDistance();
+
 
 /**I/O definition*/
 InterruptIn bumperL_btn(PTB18);
@@ -64,7 +67,6 @@
     // printf ("LCD intialise");
     lcd.setContrast(0.4);
     // printf ("LCD Contrast set");
-    lcd.setBrightness(0.5);
     // printf ("LCD Brightness Set");
     initialiseMbed();
     // printf ("MBED K64f Initialise");
@@ -73,9 +75,11 @@
     }
 
 void initialiseMbed() {
-    
+    //printf ( Initialise MBED)
     greenleds= 1;
     redleds=0;
+    //printf(green LED on)
+    //printf(red led off)
     lcd.clear();
     lcd.printString("MBED",0,0);
     lcd.printString("Controller",0,1);
@@ -90,6 +94,7 @@
     lcd.refresh();
     wait(5.0);
     lcd.clear();
+    //printf (Intialised. Call for menu void)
     lcd.printString("Initialised",0,0);
     lcd.printString("Press Start",0,1);
     lcd.printString("For",0,2);
@@ -98,13 +103,16 @@
     lcd.printString("Ciaran Kane",0,5);
     lcd.refresh();
     greenleds=0;
+    //printf (green led off)
     redleds=1;
+    //printf (red led on)
     wait(5.0);
     
     while(1)
     {
         wait(0.5);
         if (g_START_flag==1) {
+            //printf (start flag)
             menu();
             }
             }
@@ -122,12 +130,15 @@
     {
         wait(0.5);
         if (g_bumperL_flag==1) {
+            //printf (Left bumper flag)
             initUltrasonic();
             }
         else if(g_START_flag==1) { 
+        //printf (Start flag)
           targetLocate();
             }
             else if(g_bumperR_flag==1) { 
+            //printf (right bumper flag)
           techSupport();
             }
             }
@@ -138,7 +149,9 @@
 {
       
     greenleds= 1;
+    //printf ( green led on)
     redleds=0;
+    //printf(red led off)
     lcd.clear();
     lcd.printString("Ultrasonic",0,0);
     lcd.printString("Sesnor",0,1);
@@ -153,6 +166,7 @@
     lcd.refresh();
     wait(5.0);
     lcd.clear();
+    //printf(Sensor initialised)
     lcd.printString("Initialised",0,0);
     lcd.printString("Press Start",0,1);
     lcd.printString("For",0,2);
@@ -161,47 +175,62 @@
     lcd.printString("Ciaran Kane",0,5);
     lcd.refresh();
     greenleds=0;
+    //printf( green led off)
     redleds=1;
+    //printf( red led on)
     wait(5.0);
     
     while(1)
     {
         wait(0.5);
         if (g_START_flag==1) {
+            //printf( start flag)
             menu();
             }
             }
             }
 void dist(int distance)
 {
-     //printf("sense = %d\n", sense);
-    // printf("Distance changed to %dmm\r\n", distance);
+    // printf("sense = %d\n", sense);
+     //printf("Distance changed to %dmm\r\n", distance);
     
             lcd.clear();
      
-            char buffer[14];
-            int length = sprintf(buffer,"%dmm", distance);
+            char targetD[14];
+            int length = sprintf(targetD,"%dmm", distance);
             if (length <= 14)
     
-            lcd.printString("set object to",0,0);
-            lcd.printString("    200mm",0,1);
-            lcd.printString(buffer,24,3);
+            lcd.printString("Localising Target",0,0);
+            lcd.printString(targetD,24,3);
             lcd.refresh();
      
     }
 
 void targetLocate()
 {  
+//printf( Target locating)
     lcd.printString("Searching",0,1);
     lcd.printString("For",0,2);
     lcd.printString("Target",0,3);
+    TargetDistance();
+    //printf( Target distance)
     lcd.clear();
     lcd.printString("Target",0,0); 
     lcd.printString("Found!",0,1);
     }
-    
+
+void TargetDistance()
+{
+        //sense;
+     
+        Target= Sensor.getCurrentDistance();
+        
+        //printf("distance at sense 1 = %d\r\n", Distance1);
+
+        }
 void techSupport()
     {  
+    //printf(Tech support screen)
     lcd.printString("Ciaran Kane",0,1);
     lcd.printString("Main engineer",0,2);
     lcd.printString("Ciaran.kane@se.com",0,3);