![](/media/cache/group/default_image.jpg.50x50_q85.jpg)
Resit Target Localisation Ciaran Kane 18689005
Dependencies: mbed
Diff: main.cpp
- Revision:
- 5:5351ab7d9132
- Parent:
- 4:95b13ca0550e
- Child:
- 6:466f54c00c50
--- 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);