(DA) Internet of Things and Smart Electronics- ELE3006M2122 / Mbed OS 18689004Coursework

Coursework

main.cpp@35:36c7605dda06, 2022-02-01 (annotated)

Committer:
sesa514652
Date:
Tue Feb 01 20:58:40 2022 +0000
Revision:
35:36c7605dda06
Parent:
34:dfe7f5799582
Child:
36:3e975536e8d7
Changes to the way in what data is stored in array

Who changed what in which revision?

UserRevisionLine numberNew contents of line
sesa514652 28:aab0aa846cf6 1 /**
sesa514652 28:aab0aa846cf6 2 *.....Kory Hamill
sesa514652 28:aab0aa846cf6 3 *.....IOT Smart Electronics Coursework
sesa514652 35:36c7605dda06 4 *.....Acknowlegements Library Makers
sesa514652 28:aab0aa846cf6 5 *.....18689004
sesa514652 28:aab0aa846cf6 6 */
sesa514652 28:aab0aa846cf6 7 /**
sesa514652 28:aab0aa846cf6 8 * Section of code to bring in the #includes
sesa514652 28:aab0aa846cf6 9 */
sesa514652 0:1f799c7cce2b 10 #include "mbed.h"
sesa514652 0:1f799c7cce2b 11 #include "Joystick.h"
sesa514652 0:1f799c7cce2b 12 #include "N5110.h"
sesa514652 0:1f799c7cce2b 13 #include "hcsr04.h"
sesa514652 3:6ecb75a2675c 14 #include "Piezo.h"
sesa514652 8:770d168713cc 15 #include "string"
sesa514652 20:4e1f2917a857 16 #include "array"
sesa514652 22:82b01fdfc61f 17 #include <iostream>
sesa514652 35:36c7605dda06 18
sesa514652 28:aab0aa846cf6 19 /**
sesa514652 28:aab0aa846cf6 20 *...This Section of the code is used to bring in volatile Varible's, These can be wrote to throught the code.
sesa514652 28:aab0aa846cf6 21 *...The Varibles are used to track button press's on the board.
sesa514652 28:aab0aa846cf6 22 */
sesa514652 28:aab0aa846cf6 23 volatile int g_ButtonAPress;
sesa514652 28:aab0aa846cf6 24 volatile int g_ButtonBPress;
sesa514652 33:3717bc4e2fa8 25 volatile int LoopCountScan1;
sesa514652 33:3717bc4e2fa8 26 volatile int LoopCountScan2;
sesa514652 33:3717bc4e2fa8 27 volatile int LoopCountScan3;
sesa514652 33:3717bc4e2fa8 28 volatile int LoopCountScan4;
sesa514652 33:3717bc4e2fa8 29 volatile int LoopCountScan5;
sesa514652 28:aab0aa846cf6 30 volatile int g_buttonA_flag = 0;
sesa514652 28:aab0aa846cf6 31 volatile int g_buttonB_flag = 0;
sesa514652 28:aab0aa846cf6 32 volatile int g_buttonX_flag = 0;
sesa514652 28:aab0aa846cf6 33 volatile int g_buttonY_flag = 0;
sesa514652 28:aab0aa846cf6 34 volatile int g_buttonStart_flag = 0;
sesa514652 28:aab0aa846cf6 35 volatile int g_buttonBack_flag = 0;
sesa514652 28:aab0aa846cf6 36 volatile int g_buttonLeft_flag = 0;
sesa514652 28:aab0aa846cf6 37 volatile int g_buttonRight_flag = 0;
sesa514652 31:91a3c61d33e6 38 /**
sesa514652 31:91a3c61d33e6 39 *..Bring in 5 arrays of 5 for each of the 5 required scans.
sesa514652 31:91a3c61d33e6 40 *..array Ref starts at 0,
sesa514652 31:91a3c61d33e6 41 */
sesa514652 31:91a3c61d33e6 42 volatile int Scan1[5];
sesa514652 31:91a3c61d33e6 43 volatile int Scan2[5];
sesa514652 31:91a3c61d33e6 44 volatile int Scan3[5];
sesa514652 31:91a3c61d33e6 45 volatile int Scan4[5];
sesa514652 31:91a3c61d33e6 46 volatile int Scan5[5];
sesa514652 33:3717bc4e2fa8 47 volatile int wall[5];
sesa514652 28:aab0aa846cf6 48 /**
sesa514652 28:aab0aa846cf6 49 *... Section of code to assign names to IO pins on the K64f
sesa514652 28:aab0aa846cf6 50 */
sesa514652 8:770d168713cc 51 InterruptIn buttonA(PTB9);
sesa514652 8:770d168713cc 52 InterruptIn buttonB(PTD0);
sesa514652 8:770d168713cc 53 InterruptIn buttonX(PTC17);
sesa514652 8:770d168713cc 54 InterruptIn buttonY(PTC12);
sesa514652 11:1dec05b7d1c1 55 InterruptIn buttonStart(PTC5);
sesa514652 11:1dec05b7d1c1 56 InterruptIn buttonBack(PTB19);
sesa514652 11:1dec05b7d1c1 57 InterruptIn buttonLeft(PTB18);
sesa514652 11:1dec05b7d1c1 58 InterruptIn buttonRight(PTB3);
sesa514652 28:aab0aa846cf6 59 Joystick joystick(PTB10,PTB11,PTC16);
sesa514652 28:aab0aa846cf6 60 HCSR04 sensor(D14, D15);
sesa514652 28:aab0aa846cf6 61 Piezo Buzzer(PTC10);
sesa514652 28:aab0aa846cf6 62 N5110 lcd(PTC9,PTC0,PTC7,PTD2,PTD1,PTC11);
sesa514652 28:aab0aa846cf6 63
sesa514652 28:aab0aa846cf6 64 /**
sesa514652 28:aab0aa846cf6 65 *...For used with the LCD Screen. rows,cols
sesa514652 28:aab0aa846cf6 66 */
sesa514652 0:1f799c7cce2b 67 int sprite[8][5] = {
sesa514652 28:aab0aa846cf6 68 { 0,0,1,0,0 },
sesa514652 28:aab0aa846cf6 69 { 0,1,1,1,0 },
sesa514652 28:aab0aa846cf6 70 { 0,0,1,0,0 },
sesa514652 28:aab0aa846cf6 71 { 0,1,1,1,0 },
sesa514652 28:aab0aa846cf6 72 { 1,1,1,1,1 },
sesa514652 28:aab0aa846cf6 73 { 1,1,1,1,1 },
sesa514652 28:aab0aa846cf6 74 { 1,1,0,1,1 },
sesa514652 28:aab0aa846cf6 75 { 1,1,0,1,1 },
sesa514652 28:aab0aa846cf6 76 };
sesa514652 28:aab0aa846cf6 77 /**
sesa514652 28:aab0aa846cf6 78 *...Section for starting the board and seeting up interrupt routines
sesa514652 28:aab0aa846cf6 79 *...Along with other functions to be called later
sesa514652 28:aab0aa846cf6 80 */
sesa514652 11:1dec05b7d1c1 81 void init_K64F(); // Start K64fBoard
sesa514652 11:1dec05b7d1c1 82 void buttonA_isr(); // Button A interrupt service routine
sesa514652 11:1dec05b7d1c1 83 void buttonB_isr(); // Button B interrupt service routine
sesa514652 11:1dec05b7d1c1 84 void buttonX_isr(); // Button X interrupt service routine
sesa514652 11:1dec05b7d1c1 85 void buttonY_isr(); // Button Y interrupt service routine
sesa514652 11:1dec05b7d1c1 86 void buttonStart_isr(); // Button Start interrupt service routine
sesa514652 11:1dec05b7d1c1 87 void buttonBack_isr(); // Button Back interrupt service routine
sesa514652 11:1dec05b7d1c1 88 void buttonLeft_isr(); // Button Left interrupt service routine
sesa514652 11:1dec05b7d1c1 89 void buttonRight_isr(); // Button Right interrupt service routine
sesa514652 31:91a3c61d33e6 90 void inputScan1();
sesa514652 31:91a3c61d33e6 91 void inputScan2();
sesa514652 31:91a3c61d33e6 92 void inputScan3();
sesa514652 31:91a3c61d33e6 93 void inputScan4();
sesa514652 31:91a3c61d33e6 94 void inputScan5();
sesa514652 33:3717bc4e2fa8 95 int NoContinueExit();
sesa514652 18:bb36d96142dd 96 int buttonCountA();
sesa514652 18:bb36d96142dd 97 int buttonCountB();
sesa514652 35:36c7605dda06 98 void isArrEqual();
sesa514652 35:36c7605dda06 99 /*
sesa514652 35:36c7605dda06 100 {
sesa514652 35:36c7605dda06 101 if (lenA != lenB)
sesa514652 35:36c7605dda06 102 return false;
sesa514652 35:36c7605dda06 103 sort(A, A + lenA);
sesa514652 35:36c7605dda06 104 sort(B, B + lenB);
sesa514652 35:36c7605dda06 105 for (int i = 0; i < lenA; i++)
sesa514652 35:36c7605dda06 106 if (A[i] != B[i])
sesa514652 35:36c7605dda06 107 return false; /* Elements are not same */
sesa514652 35:36c7605dda06 108
sesa514652 35:36c7605dda06 109 /* All elements are same */
sesa514652 35:36c7605dda06 110 // return true;
sesa514652 35:36c7605dda06 111 //}
sesa514652 33:3717bc4e2fa8 112
sesa514652 33:3717bc4e2fa8 113
sesa514652 33:3717bc4e2fa8 114
sesa514652 33:3717bc4e2fa8 115
sesa514652 28:aab0aa846cf6 116 EventQueue queue; /**< Required to get around issues with printing onto LCD and the Printf */
sesa514652 28:aab0aa846cf6 117
sesa514652 28:aab0aa846cf6 118
sesa514652 28:aab0aa846cf6 119 /** Code which was never used
sesa514652 28:aab0aa846cf6 120 *
sesa514652 28:aab0aa846cf6 121 *.. was for initial learning of C++
sesa514652 11:1dec05b7d1c1 122 //volatile int g_buttonA_counter = 0; // Global counter
sesa514652 8:770d168713cc 123 //Test function after research C++ lanuage 05/01/22
sesa514652 4:167ce930c9d5 124 int cube(int num){
sesa514652 11:1dec05b7d1c1 125 return num*num;
sesa514652 5:9b2c976ca318 126 };
sesa514652 10:42e70b596099 127 // Menu Items
sesa514652 10:42e70b596099 128 int page1;
sesa514652 10:42e70b596099 129 int page2;
sesa514652 10:42e70b596099 130 int page3;
sesa514652 28:aab0aa846cf6 131 string Listitem1 = "Game"; //
sesa514652 28:aab0aa846cf6 132 string Listitem2 = "Measure"; //
sesa514652 28:aab0aa846cf6 133 string Listitem3 = "Detect"; //
sesa514652 28:aab0aa846cf6 134 / Test of the interup an operating the buzzer this kills the board
sesa514652 9:cdd7d9a123f9 135 void buzzme(){
sesa514652 9:cdd7d9a123f9 136 Buzzer.play(200,120);
sesa514652 9:cdd7d9a123f9 137 wait_ms(5);
sesa514652 9:cdd7d9a123f9 138 Buzzer.play(200,120);;
sesa514652 9:cdd7d9a123f9 139 }
sesa514652 26:8826ed43fad2 140 int Scan1[5];
sesa514652 26:8826ed43fad2 141 int Scan2[5];
sesa514652 24:a88c4941a25e 142 int Scan1Input(){;
sesa514652 25:9798017b837d 143 Scan1[0] = sensor.distance();
sesa514652 25:9798017b837d 144 Scan1[1] = sensor.distance();;
sesa514652 25:9798017b837d 145 Scan1[2] = sensor.distance();;
sesa514652 26:8826ed43fad2 146 Scan1[3] = sensor.distance();;
sesa514652 26:8826ed43fad2 147 Scan1[4] = sensor.distance();;
sesa514652 26:8826ed43fad2 148 return Scan1[0,1,2,3,4];}
sesa514652 28:aab0aa846cf6 149 //void returnme(){
sesa514652 10:42e70b596099 150 //int num;
sesa514652 10:42e70b596099 151 // return num*num;
sesa514652 10:42e70b596099 152 // };
sesa514652 28:aab0aa846cf6 153 */
sesa514652 28:aab0aa846cf6 154
sesa514652 0:1f799c7cce2b 155 int main() {
sesa514652 28:aab0aa846cf6 156 /**
sesa514652 28:aab0aa846cf6 157 *.. Intialise joystick and Lcd
sesa514652 28:aab0aa846cf6 158 */
sesa514652 5:9b2c976ca318 159 joystick.init();
sesa514652 28:aab0aa846cf6 160 lcd.init();
sesa514652 28:aab0aa846cf6 161 lcd.setContrast(0.5);
sesa514652 28:aab0aa846cf6 162 /**
sesa514652 28:aab0aa846cf6 163 *.. Issues were found with the LCd and printf while using interrupts, to get around
sesa514652 28:aab0aa846cf6 164 *.. this issue these queue's to the event thread were added.
sesa514652 28:aab0aa846cf6 165 */
sesa514652 11:1dec05b7d1c1 166 Thread eventThread;
sesa514652 28:aab0aa846cf6 167 eventThread.start(callback(&queue, &EventQueue::dispatch_forever));
sesa514652 28:aab0aa846cf6 168 buttonA.rise(queue.event(&buttonA_isr));
sesa514652 11:1dec05b7d1c1 169 buttonB.rise(queue.event(&buttonB_isr));
sesa514652 11:1dec05b7d1c1 170 buttonX.rise(queue.event(&buttonX_isr));
sesa514652 11:1dec05b7d1c1 171 buttonY.rise(queue.event(&buttonY_isr));
sesa514652 28:aab0aa846cf6 172 buttonStart.rise(queue.event(&buttonStart_isr));
sesa514652 11:1dec05b7d1c1 173 buttonBack.rise(queue.event(&buttonBack_isr));
sesa514652 11:1dec05b7d1c1 174 buttonLeft.rise(queue.event(&buttonLeft_isr));
sesa514652 11:1dec05b7d1c1 175 buttonRight.rise(queue.event(&buttonRight_isr));
sesa514652 28:aab0aa846cf6 176 /**
sesa514652 28:aab0aa846cf6 177 *..Buttons were connected to IO pins which required a pull down resistor to be active.
sesa514652 28:aab0aa846cf6 178 */
sesa514652 8:770d168713cc 179 buttonA.mode(PullDown);
sesa514652 10:42e70b596099 180 buttonB.mode(PullDown);
sesa514652 10:42e70b596099 181 buttonX.mode(PullDown);
sesa514652 10:42e70b596099 182 buttonY.mode(PullDown);
sesa514652 11:1dec05b7d1c1 183 buttonStart.mode(PullDown);
sesa514652 11:1dec05b7d1c1 184 buttonBack.mode(PullDown);
sesa514652 11:1dec05b7d1c1 185 buttonLeft.mode(PullDown);
sesa514652 11:1dec05b7d1c1 186 buttonRight.mode(PullDown);
sesa514652 5:9b2c976ca318 187
sesa514652 28:aab0aa846cf6 188 /**
sesa514652 28:aab0aa846cf6 189 *.. Section of code not used in main program.
sesa514652 28:aab0aa846cf6 190 *
sesa514652 28:aab0aa846cf6 191 Buzzer.period(10.0f);
sesa514652 5:9b2c976ca318 192 //Buzzer.pulsewidth(1);
sesa514652 28:aab0aa846cf6 193 Test Struct after research 05/01/22
sesa514652 6:f7f30e0e3bed 194 struct ObjectDefine{
sesa514652 7:ce70a873aa70 195 int qwer;
sesa514652 6:f7f30e0e3bed 196 float Distance;
sesa514652 7:ce70a873aa70 197 char te;
sesa514652 7:ce70a873aa70 198 double dubs;
sesa514652 7:ce70a873aa70 199 string namestruct;
sesa514652 8:770d168713cc 200 // string ;
sesa514652 6:f7f30e0e3bed 201 };
sesa514652 7:ce70a873aa70 202 // Test Class 06/01/22
sesa514652 10:42e70b596099 203 class myClass{
sesa514652 7:ce70a873aa70 204 public:
sesa514652 7:ce70a873aa70 205 string nameclass ;
sesa514652 7:ce70a873aa70 206 double dubss;
sesa514652 7:ce70a873aa70 207 int inty;
sesa514652 7:ce70a873aa70 208 };
sesa514652 7:ce70a873aa70 209 myClass Class1;
sesa514652 7:ce70a873aa70 210 Class1.nameclass ="firstclass";
sesa514652 10:42e70b596099 211 ObjectDefine Object1;
sesa514652 10:42e70b596099 212 Object1.qwer = 12;
sesa514652 6:f7f30e0e3bed 213 Object1.Distance = 34;
sesa514652 7:ce70a873aa70 214 Object1.te = 'A';
sesa514652 7:ce70a873aa70 215 Object1.dubs = 23;
sesa514652 10:42e70b596099 216 Object1.namestruct = "name";
sesa514652 28:aab0aa846cf6 217 */
sesa514652 0:1f799c7cce2b 218 while(1) {
sesa514652 31:91a3c61d33e6 219
sesa514652 31:91a3c61d33e6 220
sesa514652 31:91a3c61d33e6 221
sesa514652 35:36c7605dda06 222 int Decide[5];
sesa514652 35:36c7605dda06 223
sesa514652 35:36c7605dda06 224 int Decide2[5];
sesa514652 35:36c7605dda06 225 int Decide3[5];
sesa514652 35:36c7605dda06 226 int Decide4[5];
sesa514652 35:36c7605dda06 227 int Decide5[5];
sesa514652 27:d48bf4e8f1a0 228
sesa514652 28:aab0aa846cf6 229 /**
sesa514652 28:aab0aa846cf6 230 *.. It was found Cout was not working as expected.
sesa514652 28:aab0aa846cf6 231 cout << "Test value collection";
sesa514652 28:aab0aa846cf6 232 Scan1Input();
sesa514652 28:aab0aa846cf6 233
sesa514652 27:d48bf4e8f1a0 234 cout << Scan1[0];cout <<"/n";
sesa514652 27:d48bf4e8f1a0 235 cout << Scan1[1];"/n";
sesa514652 27:d48bf4e8f1a0 236 cout << Scan1[2];"/n";
sesa514652 27:d48bf4e8f1a0 237 cout << Scan1[3];"/n";
sesa514652 27:d48bf4e8f1a0 238 cout << Scan1[4];"/n";
sesa514652 27:d48bf4e8f1a0 239 cout << Scan1[5];"/n";
sesa514652 27:d48bf4e8f1a0 240 cout << Scan1[6];"/n";
sesa514652 27:d48bf4e8f1a0 241 cout << Scan1[7];"/n";
sesa514652 27:d48bf4e8f1a0 242 cout << Scan1[8];"/n";
sesa514652 27:d48bf4e8f1a0 243 cout << Scan1[9];"/n";
sesa514652 27:d48bf4e8f1a0 244 */
sesa514652 33:3717bc4e2fa8 245 printf("Debug : LoopCount1 : %i\n",LoopCountScan1);
sesa514652 33:3717bc4e2fa8 246 printf("Debug : LoopCount2 : %i\n",LoopCountScan2);
sesa514652 33:3717bc4e2fa8 247 printf("Debug : LoopCount3 : %i\n",LoopCountScan3);
sesa514652 33:3717bc4e2fa8 248 printf("Debug : LoopCount4 : %i\n",LoopCountScan4);
sesa514652 33:3717bc4e2fa8 249 printf("Debug : LoopCount5 : %i\n",LoopCountScan5);
sesa514652 28:aab0aa846cf6 250 printf("press count = %i\n",g_ButtonAPress);
sesa514652 26:8826ed43fad2 251 printf("Scan1 1 : %d cm\n", Scan1[0]);
sesa514652 26:8826ed43fad2 252 printf("Scan1 2 : %d cm\n", Scan1[1]);
sesa514652 26:8826ed43fad2 253 printf("Scan1 3 : %d cm\n", Scan1[2]);
sesa514652 26:8826ed43fad2 254 printf("Scan1 4 : %d cm\n", Scan1[3]);
sesa514652 26:8826ed43fad2 255 printf("Scan1 5 : %d cm\n", Scan1[4]);
sesa514652 35:36c7605dda06 256 /*
sesa514652 26:8826ed43fad2 257 printf("Scan2 1 : %d cm\n", Scan2[0]);
sesa514652 26:8826ed43fad2 258 printf("Scan2 2 : %d cm\n", Scan2[1]);
sesa514652 26:8826ed43fad2 259 printf("Scan2 3 : %d cm\n", Scan2[2]);
sesa514652 26:8826ed43fad2 260 printf("Scan2 4 : %d cm\n", Scan2[3]);
sesa514652 26:8826ed43fad2 261 printf("Scan2 5 : %d cm\n", Scan2[4]);
sesa514652 26:8826ed43fad2 262 printf("Scan3 1 : %d cm\n", Scan3[0]);
sesa514652 26:8826ed43fad2 263 printf("Scan3 2 : %d cm\n", Scan3[1]);
sesa514652 26:8826ed43fad2 264 printf("Scan3 3 : %d cm\n", Scan3[2]);
sesa514652 26:8826ed43fad2 265 printf("Scan3 4 : %d cm\n", Scan3[3]);
sesa514652 26:8826ed43fad2 266 printf("Scan3 5 : %d cm\n", Scan3[4]);
sesa514652 26:8826ed43fad2 267 printf("Scan4 1 : %d cm\n", Scan4[0]);
sesa514652 26:8826ed43fad2 268 printf("Scan4 2 : %d cm\n", Scan4[1]);
sesa514652 26:8826ed43fad2 269 printf("Scan4 3 : %d cm\n", Scan4[2]);
sesa514652 26:8826ed43fad2 270 printf("Scan4 4 : %d cm\n", Scan4[3]);
sesa514652 26:8826ed43fad2 271 printf("Scan4 5 : %d cm\n", Scan4[4]);
sesa514652 26:8826ed43fad2 272 printf("Scan5 1 : %d cm\n", Scan5[0]);
sesa514652 26:8826ed43fad2 273 printf("Scan5 2 : %d cm\n", Scan5[1]);
sesa514652 26:8826ed43fad2 274 printf("Scan5 3 : %d cm\n", Scan5[2]);
sesa514652 26:8826ed43fad2 275 printf("Scan5 4 : %d cm\n", Scan5[3]);
sesa514652 35:36c7605dda06 276 printf("Scan5 5 : %d cm\n", Scan5[4]);
sesa514652 35:36c7605dda06 277 */
sesa514652 25:9798017b837d 278 printf("I always Get printed \n");
sesa514652 24:a88c4941a25e 279 // cout << Scan1[2];
sesa514652 24:a88c4941a25e 280 // cout << Scan1[6];
sesa514652 28:aab0aa846cf6 281 printf("I Should Be printed always \n");
sesa514652 28:aab0aa846cf6 282 /**
sesa514652 28:aab0aa846cf6 283 *..Code section on Comparing data Cout was causing issue
sesa514652 28:aab0aa846cf6 284 *
sesa514652 24:a88c4941a25e 285 if (Scan1[1] > Scan1[2]){
sesa514652 24:a88c4941a25e 286 cout <<'+';
sesa514652 24:a88c4941a25e 287 }else if (Scan1[1]=Scan1[2]){
sesa514652 24:a88c4941a25e 288 cout <<'=';}
sesa514652 24:a88c4941a25e 289 else {
sesa514652 24:a88c4941a25e 290 cout <<'-';}
sesa514652 24:a88c4941a25e 291 if (Scan1[2] > Scan1[3]){
sesa514652 24:a88c4941a25e 292 cout <<'+';
sesa514652 24:a88c4941a25e 293 }else if (Scan1[2]=Scan1[3]){
sesa514652 24:a88c4941a25e 294 cout <<'=';}
sesa514652 23:f72175fb49ed 295 else {
sesa514652 23:f72175fb49ed 296 cout <<'-';}
sesa514652 24:a88c4941a25e 297
sesa514652 24:a88c4941a25e 298 if (Scan1[3] > Scan1[4]){
sesa514652 24:a88c4941a25e 299 cout <<'+';
sesa514652 24:a88c4941a25e 300 }else if (Scan1[3]=Scan1[4]){
sesa514652 24:a88c4941a25e 301 cout <<'=';}
sesa514652 24:a88c4941a25e 302 else {
sesa514652 24:a88c4941a25e 303 cout <<'-';}
sesa514652 24:a88c4941a25e 304 if (Scan1[4] > Scan1[5]){
sesa514652 24:a88c4941a25e 305 cout <<'+';
sesa514652 24:a88c4941a25e 306 }else if (Scan1[4]=Scan1[5]){
sesa514652 24:a88c4941a25e 307 cout <<'=';}
sesa514652 24:a88c4941a25e 308 else {
sesa514652 24:a88c4941a25e 309 cout <<'-';}
sesa514652 24:a88c4941a25e 310 if (Scan1[5] > Scan1[6]){
sesa514652 24:a88c4941a25e 311 cout <<'+';
sesa514652 24:a88c4941a25e 312 }else if (Scan1[5]=Scan1[6]){
sesa514652 24:a88c4941a25e 313 cout <<'=';}
sesa514652 24:a88c4941a25e 314 else {
sesa514652 24:a88c4941a25e 315 cout <<'-';}
sesa514652 24:a88c4941a25e 316 if (Scan1[6] > Scan1[7]){
sesa514652 24:a88c4941a25e 317 cout <<'+';
sesa514652 24:a88c4941a25e 318 }else if (Scan1[6]=Scan1[7]){
sesa514652 24:a88c4941a25e 319 cout <<'=';}
sesa514652 24:a88c4941a25e 320 else {
sesa514652 24:a88c4941a25e 321 cout <<'-';}
sesa514652 24:a88c4941a25e 322 if (Scan1[7] > Scan1[8]){
sesa514652 24:a88c4941a25e 323 cout <<'+';
sesa514652 24:a88c4941a25e 324 }else if (Scan1[7]=Scan1[8]){
sesa514652 24:a88c4941a25e 325 cout <<'=';}
sesa514652 24:a88c4941a25e 326 else {
sesa514652 24:a88c4941a25e 327 cout <<'-';}
sesa514652 24:a88c4941a25e 328
sesa514652 24:a88c4941a25e 329 if (Scan1[8] > Scan1[9]){
sesa514652 24:a88c4941a25e 330 cout <<'+';
sesa514652 24:a88c4941a25e 331 }else if (Scan1[8]=Scan1[9]){
sesa514652 24:a88c4941a25e 332 cout <<'=';}
sesa514652 24:a88c4941a25e 333 else {
sesa514652 24:a88c4941a25e 334 cout <<'-';}
sesa514652 24:a88c4941a25e 335 if (Scan1[9] > Scan1[10]){
sesa514652 24:a88c4941a25e 336 cout <<'+';
sesa514652 24:a88c4941a25e 337 }else if (Scan1[9]=Scan1[10]){
sesa514652 24:a88c4941a25e 338 cout <<'=';}
sesa514652 24:a88c4941a25e 339 else {
sesa514652 24:a88c4941a25e 340 cout <<'-';}
sesa514652 28:aab0aa846cf6 341 */
sesa514652 21:2e37f80e8b5b 342
sesa514652 26:8826ed43fad2 343 /////////////////////////////////////////////////////////////////////////////////////////////////////
sesa514652 28:aab0aa846cf6 344 /**
sesa514652 28:aab0aa846cf6 345 *..Initial state when starting the Board.
sesa514652 28:aab0aa846cf6 346 */
sesa514652 28:aab0aa846cf6 347 switch(g_ButtonAPress){
sesa514652 21:2e37f80e8b5b 348 default:
sesa514652 29:1aef0ecf9840 349 lcd.clear();
sesa514652 21:2e37f80e8b5b 350 lcd.printString("Main Menu",0,0);
sesa514652 28:aab0aa846cf6 351 lcd.drawLine(0,10,80,10,2);
sesa514652 31:91a3c61d33e6 352 lcd.printString("Press A",0,2);
sesa514652 31:91a3c61d33e6 353 lcd.printString("New Scan",0,3);
sesa514652 31:91a3c61d33e6 354 lcd.printString("Press B",0,4);
sesa514652 27:d48bf4e8f1a0 355 lcd.printString("Kory 18689004",0,5);
sesa514652 35:36c7605dda06 356 /**
sesa514652 35:36c7605dda06 357 *..Setting loop counters back to zero so each will loop 5 times upon next press.
sesa514652 35:36c7605dda06 358 */
sesa514652 33:3717bc4e2fa8 359 LoopCountScan1 =0;
sesa514652 33:3717bc4e2fa8 360 LoopCountScan2 =0;
sesa514652 33:3717bc4e2fa8 361 LoopCountScan3 =0;
sesa514652 33:3717bc4e2fa8 362 LoopCountScan4 =0;
sesa514652 33:3717bc4e2fa8 363 LoopCountScan5 =0;
sesa514652 29:1aef0ecf9840 364
sesa514652 33:3717bc4e2fa8 365 for(int i=0; i<5; i++){
sesa514652 33:3717bc4e2fa8 366
sesa514652 35:36c7605dda06 367 printf("hello Scan %i reading: %i The value of : %i \n",i,i, Scan1[i]);
sesa514652 33:3717bc4e2fa8 368 if (Scan1[i]>95){
sesa514652 35:36c7605dda06 369 Decide[i]= 1;
sesa514652 35:36c7605dda06 370 printf("no wall%i\n",Decide[i]);}
sesa514652 33:3717bc4e2fa8 371 else if (Scan1[i]<85){
sesa514652 35:36c7605dda06 372 Decide[i]= 2;
sesa514652 35:36c7605dda06 373 printf("OBJECT ABOUT%i\n",Decide[i]);}
sesa514652 33:3717bc4e2fa8 374 else if (Scan1[i]>85<95){
sesa514652 35:36c7605dda06 375 Decide[i]= 3;
sesa514652 35:36c7605dda06 376 printf("No Object %i\n",Decide[i]);}
sesa514652 35:36c7605dda06 377
sesa514652 35:36c7605dda06 378
sesa514652 35:36c7605dda06 379 for(int i=0; i<5; i++){
sesa514652 35:36c7605dda06 380 printf("hello Scan 2 reading: %i The value of : %i \n",i, Scan2[i]);
sesa514652 35:36c7605dda06 381 if (Scan2[i]>95){
sesa514652 35:36c7605dda06 382 Decide2[i]= 1;
sesa514652 35:36c7605dda06 383 printf("no wall%i\n",Decide2[i]);}
sesa514652 35:36c7605dda06 384 else if (Scan2[i]<85){
sesa514652 35:36c7605dda06 385 Decide2[i]= 2;
sesa514652 35:36c7605dda06 386 printf("OBJECT ABOUT%i\n",Decide2[i]);}
sesa514652 35:36c7605dda06 387 else if (Scan2[i]>85<95){
sesa514652 35:36c7605dda06 388 Decide2[i]= 3;
sesa514652 35:36c7605dda06 389 printf("No Object %i\n",Decide2[i]);
sesa514652 35:36c7605dda06 390 }
sesa514652 35:36c7605dda06 391 }
sesa514652 35:36c7605dda06 392 for(int i=0; i<5; i++){
sesa514652 35:36c7605dda06 393
sesa514652 35:36c7605dda06 394 printf("hello Scan 3 reading: %i The value of : %i \n",i, Scan3[i]);
sesa514652 35:36c7605dda06 395 if (Scan3[i]>95){
sesa514652 35:36c7605dda06 396 Decide3[i]= 1;
sesa514652 35:36c7605dda06 397 printf("no wall%i\n",Decide3[i]);}
sesa514652 35:36c7605dda06 398 else if (Scan3[i]<85){
sesa514652 35:36c7605dda06 399 Decide3[i]= 2;
sesa514652 35:36c7605dda06 400 printf("OBJECT ABOUT%i\n",Decide3[i]);}
sesa514652 35:36c7605dda06 401 else if (Scan3[i]>85<95){
sesa514652 35:36c7605dda06 402 Decide3[i]= 3;
sesa514652 35:36c7605dda06 403 printf("No Object %i\n",Decide3[i]);}
sesa514652 35:36c7605dda06 404 }
sesa514652 35:36c7605dda06 405
sesa514652 35:36c7605dda06 406 for(int i=0; i<5; i++){
sesa514652 35:36c7605dda06 407
sesa514652 35:36c7605dda06 408 printf("hello Scan 4 reading: %i The value of : %i \n",i, Scan4[i]);
sesa514652 35:36c7605dda06 409 if (Scan4[i]>95){
sesa514652 35:36c7605dda06 410 Decide4[i]= 1;
sesa514652 35:36c7605dda06 411 printf("no wall%i\n",Decide4[i]);}
sesa514652 35:36c7605dda06 412 else if (Scan4[i]<85){
sesa514652 35:36c7605dda06 413 Decide4[i]= 2;
sesa514652 35:36c7605dda06 414 printf("OBJECT ABOUT%i\n",Decide4[i]);}
sesa514652 35:36c7605dda06 415 else if (Scan4[i]>85<95){
sesa514652 35:36c7605dda06 416 Decide4[i]= 3;
sesa514652 35:36c7605dda06 417 printf("No Object %i\n",Decide4[i]);}
sesa514652 33:3717bc4e2fa8 418 }
sesa514652 35:36c7605dda06 419
sesa514652 35:36c7605dda06 420 for(int i=0; i<5; i++){
sesa514652 29:1aef0ecf9840 421
sesa514652 35:36c7605dda06 422 printf("hello Scan 5 reading: %i The value of : %i \n",i, Scan5[i]);
sesa514652 35:36c7605dda06 423 if (Scan5[i]>95){
sesa514652 35:36c7605dda06 424 Decide5[i]= 1;
sesa514652 35:36c7605dda06 425 printf("no wall%i\n",Decide5[i]);}
sesa514652 35:36c7605dda06 426 else if (Scan5[i]<85){
sesa514652 35:36c7605dda06 427 Decide5[i]= 2;
sesa514652 35:36c7605dda06 428 printf("OBJECT ABOUT%i\n",Decide5[i]);}
sesa514652 35:36c7605dda06 429 else if (Scan5[i]>85<95){
sesa514652 35:36c7605dda06 430 Decide5[i]= 3;
sesa514652 35:36c7605dda06 431 printf("No Object %i\n",Decide5[i]);}
sesa514652 35:36c7605dda06 432
sesa514652 35:36c7605dda06 433 if(Scan1==Scan2)
sesa514652 35:36c7605dda06 434 {
sesa514652 35:36c7605dda06 435 printf("HWFG");}
sesa514652 35:36c7605dda06 436 else{
sesa514652 35:36c7605dda06 437 printf("NHWFG");}
sesa514652 35:36c7605dda06 438
sesa514652 35:36c7605dda06 439 /*
sesa514652 35:36c7605dda06 440
sesa514652 35:36c7605dda06 441 if (Decide[1] == 1)
sesa514652 35:36c7605dda06 442 {
sesa514652 35:36c7605dda06 443 printf("we are on the wall\n");}
sesa514652 35:36c7605dda06 444 else{
sesa514652 35:36c7605dda06 445 printf("no wall");
sesa514652 35:36c7605dda06 446 };
sesa514652 35:36c7605dda06 447
sesa514652 35:36c7605dda06 448 */
sesa514652 35:36c7605dda06 449
sesa514652 35:36c7605dda06 450 //isArrEqual(Scan1, wall, 5, 5)
sesa514652 35:36c7605dda06 451
sesa514652 35:36c7605dda06 452 // for(int j=0; j<WIDTH; j++){
sesa514652 35:36c7605dda06 453 // if(j<5){
sesa514652 35:36c7605dda06 454 // lcd.setPixel(j,Scan1[1],true);
sesa514652 35:36c7605dda06 455 // lcd.refresh();}
sesa514652 35:36c7605dda06 456 //else if (j>4<10){
sesa514652 35:36c7605dda06 457 // lcd.setPixel(j,10,true);
sesa514652 35:36c7605dda06 458 //lcd.refresh();}
sesa514652 35:36c7605dda06 459 // else if (j>10<20){
sesa514652 35:36c7605dda06 460 // lcd.setPixel(j,50,true);
sesa514652 35:36c7605dda06 461 ///lcd.refresh();}
sesa514652 35:36c7605dda06 462 }
sesa514652 35:36c7605dda06 463
sesa514652 29:1aef0ecf9840 464 /** IF Statement to decide on shape to draw
sesa514652 29:1aef0ecf9840 465 *.. This section of code compares the each array element with the one proceding it and makes a logical decision if higher lower or equal.
sesa514652 29:1aef0ecf9840 466 */
sesa514652 34:dfe7f5799582 467 /*
sesa514652 29:1aef0ecf9840 468 if (Scan1[0] > Scan1[1])
sesa514652 29:1aef0ecf9840 469 {
sesa514652 29:1aef0ecf9840 470 printf("+");
sesa514652 29:1aef0ecf9840 471 Decide[0]= 'x';
sesa514652 29:1aef0ecf9840 472 printf( "chosen 1 %c\n",Decide[0]);
sesa514652 29:1aef0ecf9840 473 }
sesa514652 31:91a3c61d33e6 474 else if (Scan1[0] == Scan1[1])
sesa514652 29:1aef0ecf9840 475 {
sesa514652 29:1aef0ecf9840 476 printf("=");
sesa514652 29:1aef0ecf9840 477 Decide[0]='=';
sesa514652 29:1aef0ecf9840 478 printf( "chosen2 %c\n",Decide[0]);
sesa514652 29:1aef0ecf9840 479 }
sesa514652 29:1aef0ecf9840 480 else if (Scan1[0] < Scan1[1])
sesa514652 29:1aef0ecf9840 481 {
sesa514652 29:1aef0ecf9840 482 printf("-");
sesa514652 29:1aef0ecf9840 483 Decide[0]='-';
sesa514652 29:1aef0ecf9840 484 printf( "chosen3 %c\n",Decide[0]);
sesa514652 29:1aef0ecf9840 485 }
sesa514652 29:1aef0ecf9840 486 if (Scan1[1] > Scan1[2])
sesa514652 29:1aef0ecf9840 487 {
sesa514652 29:1aef0ecf9840 488 printf("+");
sesa514652 29:1aef0ecf9840 489 Decide[1]= 'x';
sesa514652 29:1aef0ecf9840 490 printf( "chosen 1 %c\n",Decide[1]);
sesa514652 29:1aef0ecf9840 491 }
sesa514652 31:91a3c61d33e6 492 else if (Scan1[1] == Scan1[2])
sesa514652 29:1aef0ecf9840 493 {
sesa514652 29:1aef0ecf9840 494 printf("=");
sesa514652 29:1aef0ecf9840 495 Decide[1]='=';
sesa514652 29:1aef0ecf9840 496 printf( "chosen2 %c\n",Decide[1]);
sesa514652 29:1aef0ecf9840 497 }
sesa514652 29:1aef0ecf9840 498 else if (Scan1[1] < Scan1[2])
sesa514652 29:1aef0ecf9840 499 {
sesa514652 29:1aef0ecf9840 500 printf("-");
sesa514652 29:1aef0ecf9840 501 Decide[1]='-';
sesa514652 29:1aef0ecf9840 502 printf( "chosen3 %c\n",Decide[1]);
sesa514652 29:1aef0ecf9840 503 }
sesa514652 29:1aef0ecf9840 504
sesa514652 29:1aef0ecf9840 505 if (Scan1[2] > Scan1[3])
sesa514652 29:1aef0ecf9840 506 {
sesa514652 29:1aef0ecf9840 507 printf("+");
sesa514652 29:1aef0ecf9840 508 Decide[2]= 'x';
sesa514652 29:1aef0ecf9840 509 printf( "chosen 1 %c\n",Decide[2]);
sesa514652 29:1aef0ecf9840 510 }
sesa514652 31:91a3c61d33e6 511 else if (Scan1[2] == Scan1[3])
sesa514652 29:1aef0ecf9840 512 {
sesa514652 29:1aef0ecf9840 513 printf("=");
sesa514652 29:1aef0ecf9840 514 Decide[2]='=';
sesa514652 29:1aef0ecf9840 515 printf( "chosen2 %c\n",Decide[2]);
sesa514652 29:1aef0ecf9840 516 }
sesa514652 29:1aef0ecf9840 517 else if (Scan1[2] < Scan1[3])
sesa514652 29:1aef0ecf9840 518 {
sesa514652 29:1aef0ecf9840 519 printf("-");
sesa514652 29:1aef0ecf9840 520 Decide[2]='-';
sesa514652 29:1aef0ecf9840 521 printf( "chosen3 %c\n",Decide[2]);
sesa514652 29:1aef0ecf9840 522 }
sesa514652 29:1aef0ecf9840 523 if (Scan1[3] > Scan1[4])
sesa514652 29:1aef0ecf9840 524 {
sesa514652 29:1aef0ecf9840 525 printf("+");
sesa514652 29:1aef0ecf9840 526 Decide[3]= 'x';
sesa514652 29:1aef0ecf9840 527 printf( "chosen 1 %c\n",Decide[3]);
sesa514652 29:1aef0ecf9840 528 }
sesa514652 31:91a3c61d33e6 529 else if (Scan1[3] == Scan1[4])
sesa514652 29:1aef0ecf9840 530 {
sesa514652 29:1aef0ecf9840 531 printf("=");
sesa514652 29:1aef0ecf9840 532 Decide[3]='=';
sesa514652 29:1aef0ecf9840 533 printf( "chosen2 %c\n",Decide[3]);
sesa514652 29:1aef0ecf9840 534 }
sesa514652 29:1aef0ecf9840 535 else if (Scan1[3] < Scan1[4])
sesa514652 29:1aef0ecf9840 536 {
sesa514652 29:1aef0ecf9840 537 printf("-");
sesa514652 29:1aef0ecf9840 538 Decide[3]='-';
sesa514652 29:1aef0ecf9840 539 printf( "chosen3 %c\n",Decide[3]);
sesa514652 29:1aef0ecf9840 540 }
sesa514652 29:1aef0ecf9840 541
sesa514652 29:1aef0ecf9840 542 if (Scan2[0] > Scan2[1])
sesa514652 29:1aef0ecf9840 543 {
sesa514652 29:1aef0ecf9840 544 printf("+");
sesa514652 29:1aef0ecf9840 545 Decide2[0]= 'x';
sesa514652 29:1aef0ecf9840 546 printf( "chosen 1 %c\n",Decide2[0]);
sesa514652 29:1aef0ecf9840 547 }
sesa514652 31:91a3c61d33e6 548 else if (Scan2[0] == Scan2[1])
sesa514652 29:1aef0ecf9840 549 {
sesa514652 29:1aef0ecf9840 550 printf("=");
sesa514652 29:1aef0ecf9840 551 Decide2[0]='=';
sesa514652 29:1aef0ecf9840 552 printf( "chosen2 %c\n",Decide2[0]);
sesa514652 29:1aef0ecf9840 553 }
sesa514652 29:1aef0ecf9840 554 else if (Scan2[0] < Scan2[1])
sesa514652 29:1aef0ecf9840 555 {
sesa514652 29:1aef0ecf9840 556 printf("-");
sesa514652 29:1aef0ecf9840 557 Decide2[0]='-';
sesa514652 29:1aef0ecf9840 558 printf( "chosen3 %c\n",Decide2[0]);
sesa514652 29:1aef0ecf9840 559 }
sesa514652 29:1aef0ecf9840 560 if (Scan2[1] > Scan2[2])
sesa514652 29:1aef0ecf9840 561 {
sesa514652 29:1aef0ecf9840 562 printf("+");
sesa514652 29:1aef0ecf9840 563 Decide2[1]= 'x';
sesa514652 29:1aef0ecf9840 564 printf( "chosen 1 %c\n",Decide2[1]);
sesa514652 29:1aef0ecf9840 565 }
sesa514652 31:91a3c61d33e6 566 else if (Scan2[1] == Scan2[2])
sesa514652 29:1aef0ecf9840 567 {
sesa514652 29:1aef0ecf9840 568 printf("=");
sesa514652 29:1aef0ecf9840 569 Decide2[1]='=';
sesa514652 29:1aef0ecf9840 570 printf( "chosen2 %c\n",Decide2[1]);
sesa514652 29:1aef0ecf9840 571 }
sesa514652 29:1aef0ecf9840 572 else if (Scan2[1] < Scan2[2])
sesa514652 29:1aef0ecf9840 573 {
sesa514652 29:1aef0ecf9840 574 printf("-");
sesa514652 29:1aef0ecf9840 575 Decide2[1]='-';
sesa514652 29:1aef0ecf9840 576 printf( "chosen3 %c\n",Decide2[1]);
sesa514652 29:1aef0ecf9840 577 }
sesa514652 29:1aef0ecf9840 578
sesa514652 29:1aef0ecf9840 579 if (Scan2[2] > Scan2[3])
sesa514652 29:1aef0ecf9840 580 {
sesa514652 29:1aef0ecf9840 581 printf("+");
sesa514652 29:1aef0ecf9840 582 Decide2[2]= 'x';
sesa514652 29:1aef0ecf9840 583 printf( "chosen 1 %c\n",Decide2[2]);
sesa514652 29:1aef0ecf9840 584 }
sesa514652 31:91a3c61d33e6 585 else if (Scan2[2] == Scan2[3])
sesa514652 29:1aef0ecf9840 586 {
sesa514652 29:1aef0ecf9840 587 printf("=");
sesa514652 29:1aef0ecf9840 588 Decide2[2]='=';
sesa514652 29:1aef0ecf9840 589 printf( "chosen2 %c\n",Decide2[2]);
sesa514652 29:1aef0ecf9840 590 }
sesa514652 29:1aef0ecf9840 591 else if (Scan2[2] < Scan2[3])
sesa514652 29:1aef0ecf9840 592 {
sesa514652 29:1aef0ecf9840 593 printf("-");
sesa514652 29:1aef0ecf9840 594 Decide2[2]='-';
sesa514652 29:1aef0ecf9840 595 printf( "chosen3 %c\n",Decide2[2]);
sesa514652 29:1aef0ecf9840 596 }
sesa514652 29:1aef0ecf9840 597 if (Scan2[3] > Scan2[4])
sesa514652 29:1aef0ecf9840 598 {
sesa514652 29:1aef0ecf9840 599 printf("+");
sesa514652 29:1aef0ecf9840 600 Decide2[3]= 'x';
sesa514652 29:1aef0ecf9840 601 printf( "chosen 1 %c\n",Decide2[3]);
sesa514652 29:1aef0ecf9840 602 }
sesa514652 31:91a3c61d33e6 603 else if (Scan2[3] == Scan2[4])
sesa514652 29:1aef0ecf9840 604 {
sesa514652 29:1aef0ecf9840 605 printf("=");
sesa514652 29:1aef0ecf9840 606 Decide2[3]='=';
sesa514652 29:1aef0ecf9840 607 printf( "chosen2 %c\n",Decide2[3]);
sesa514652 29:1aef0ecf9840 608 }
sesa514652 29:1aef0ecf9840 609 else if (Scan2[3] < Scan2[4])
sesa514652 29:1aef0ecf9840 610 {
sesa514652 29:1aef0ecf9840 611 printf("-");
sesa514652 29:1aef0ecf9840 612 Decide2[3]='-';
sesa514652 29:1aef0ecf9840 613 printf( "chosen3 %c\n",Decide2[3]);
sesa514652 29:1aef0ecf9840 614 }
sesa514652 29:1aef0ecf9840 615
sesa514652 29:1aef0ecf9840 616 if (Scan3[0] > Scan3[1])
sesa514652 29:1aef0ecf9840 617 {
sesa514652 29:1aef0ecf9840 618 printf("+");
sesa514652 29:1aef0ecf9840 619 Decide3[0]= 'x';
sesa514652 29:1aef0ecf9840 620 printf( "chosen 1 %c\n",Decide3[0]);
sesa514652 29:1aef0ecf9840 621 }
sesa514652 31:91a3c61d33e6 622 else if (Scan3[0] == Scan3[1])
sesa514652 29:1aef0ecf9840 623 {
sesa514652 29:1aef0ecf9840 624 printf("=");
sesa514652 29:1aef0ecf9840 625 Decide3[0]='=';
sesa514652 29:1aef0ecf9840 626 printf( "chosen2 %c\n",Decide3[0]);
sesa514652 29:1aef0ecf9840 627 }
sesa514652 29:1aef0ecf9840 628 else if (Scan3[0] < Scan3[1])
sesa514652 29:1aef0ecf9840 629 {
sesa514652 29:1aef0ecf9840 630 printf("-");
sesa514652 29:1aef0ecf9840 631 Decide3[0]='-';
sesa514652 29:1aef0ecf9840 632 printf( "chosen3 %c\n",Decide3[0]);
sesa514652 29:1aef0ecf9840 633 }
sesa514652 29:1aef0ecf9840 634 if (Scan3[1] > Scan3[2])
sesa514652 29:1aef0ecf9840 635 {
sesa514652 29:1aef0ecf9840 636 printf("+");
sesa514652 29:1aef0ecf9840 637 Decide3[1]= 'x';
sesa514652 29:1aef0ecf9840 638 printf( "chosen 1 %c\n",Decide3[1]);
sesa514652 29:1aef0ecf9840 639 }
sesa514652 31:91a3c61d33e6 640 else if (Scan3[1] == Scan3[2])
sesa514652 29:1aef0ecf9840 641 {
sesa514652 29:1aef0ecf9840 642 printf("=");
sesa514652 29:1aef0ecf9840 643 Decide3[1]='=';
sesa514652 29:1aef0ecf9840 644 printf( "chosen2 %c\n",Decide3[1]);
sesa514652 29:1aef0ecf9840 645 }
sesa514652 29:1aef0ecf9840 646 else if (Scan3[1] < Scan3[2])
sesa514652 29:1aef0ecf9840 647 {
sesa514652 29:1aef0ecf9840 648 printf("-");
sesa514652 29:1aef0ecf9840 649 Decide3[1]='-';
sesa514652 29:1aef0ecf9840 650 printf( "chosen3 %c\n",Decide3[1]);
sesa514652 29:1aef0ecf9840 651 }
sesa514652 29:1aef0ecf9840 652
sesa514652 29:1aef0ecf9840 653 if (Scan3[2] > Scan3[3])
sesa514652 29:1aef0ecf9840 654 {
sesa514652 29:1aef0ecf9840 655 printf("+");
sesa514652 29:1aef0ecf9840 656 Decide3[2]= 'x';
sesa514652 29:1aef0ecf9840 657 printf( "chosen 1 %c\n",Decide3[2]);
sesa514652 29:1aef0ecf9840 658 }
sesa514652 31:91a3c61d33e6 659 else if (Scan3[2] == Scan3[3])
sesa514652 29:1aef0ecf9840 660 {
sesa514652 29:1aef0ecf9840 661 printf("=");
sesa514652 29:1aef0ecf9840 662 Decide3[2]='=';
sesa514652 29:1aef0ecf9840 663 printf( "chosen2 %c\n",Decide3[2]);
sesa514652 29:1aef0ecf9840 664 }
sesa514652 29:1aef0ecf9840 665 else if (Scan3[2] < Scan3[3])
sesa514652 29:1aef0ecf9840 666 {
sesa514652 29:1aef0ecf9840 667 printf("-");
sesa514652 29:1aef0ecf9840 668 Decide3[2]='-';
sesa514652 29:1aef0ecf9840 669 printf( "chosen3 %c\n",Decide3[2]);
sesa514652 29:1aef0ecf9840 670 }
sesa514652 29:1aef0ecf9840 671 if (Scan3[3] > Scan3[4])
sesa514652 29:1aef0ecf9840 672 {
sesa514652 29:1aef0ecf9840 673 printf("+");
sesa514652 29:1aef0ecf9840 674 Decide3[3]= 'x';
sesa514652 29:1aef0ecf9840 675 printf( "chosen 1 %c\n",Decide3[3]);
sesa514652 29:1aef0ecf9840 676 }
sesa514652 31:91a3c61d33e6 677 else if (Scan3[3] == Scan3[4])
sesa514652 29:1aef0ecf9840 678 {
sesa514652 29:1aef0ecf9840 679 printf("=");
sesa514652 29:1aef0ecf9840 680 Decide3[3]='=';
sesa514652 29:1aef0ecf9840 681 printf( "chosen2 %c\n",Decide3[3]);
sesa514652 29:1aef0ecf9840 682 }
sesa514652 29:1aef0ecf9840 683 else if (Scan3[3] < Scan3[4])
sesa514652 29:1aef0ecf9840 684 {
sesa514652 29:1aef0ecf9840 685 printf("-");
sesa514652 29:1aef0ecf9840 686 Decide3[3]='-';
sesa514652 29:1aef0ecf9840 687 printf( "chosen3 %c\n",Decide3[3]);
sesa514652 29:1aef0ecf9840 688 }
sesa514652 29:1aef0ecf9840 689
sesa514652 29:1aef0ecf9840 690 if (Scan4[0] > Scan4[1])
sesa514652 29:1aef0ecf9840 691 {
sesa514652 29:1aef0ecf9840 692 printf("+");
sesa514652 29:1aef0ecf9840 693 Decide4[0]= 'x';
sesa514652 29:1aef0ecf9840 694 printf( "chosen 1 %c\n",Decide4[0]);
sesa514652 29:1aef0ecf9840 695 }
sesa514652 31:91a3c61d33e6 696 else if (Scan4[0] == Scan4[1])
sesa514652 29:1aef0ecf9840 697 {
sesa514652 29:1aef0ecf9840 698 printf("=");
sesa514652 29:1aef0ecf9840 699 Decide4[0]='=';
sesa514652 29:1aef0ecf9840 700 printf( "chosen2 %c\n",Decide4[0]);
sesa514652 29:1aef0ecf9840 701 }
sesa514652 29:1aef0ecf9840 702 else if (Scan4[0] < Scan4[1])
sesa514652 29:1aef0ecf9840 703 {
sesa514652 29:1aef0ecf9840 704 printf("-");
sesa514652 29:1aef0ecf9840 705 Decide4[0]='-';
sesa514652 29:1aef0ecf9840 706 printf( "chosen3 %c\n",Decide4[0]);
sesa514652 29:1aef0ecf9840 707 }
sesa514652 29:1aef0ecf9840 708 if (Scan4[1] > Scan4[2])
sesa514652 29:1aef0ecf9840 709 {
sesa514652 29:1aef0ecf9840 710 printf("+");
sesa514652 29:1aef0ecf9840 711 Decide4[1]= 'x';
sesa514652 29:1aef0ecf9840 712 printf( "chosen 1 %c\n",Decide4[1]);
sesa514652 29:1aef0ecf9840 713 }
sesa514652 31:91a3c61d33e6 714 else if (Scan4[1] == Scan4[2])
sesa514652 29:1aef0ecf9840 715 {
sesa514652 29:1aef0ecf9840 716 printf("=");
sesa514652 29:1aef0ecf9840 717 Decide4[1]='=';
sesa514652 29:1aef0ecf9840 718 printf( "chosen2 %c\n",Decide4[1]);
sesa514652 29:1aef0ecf9840 719 }
sesa514652 29:1aef0ecf9840 720 else if (Scan4[1] < Scan4[2])
sesa514652 29:1aef0ecf9840 721 {
sesa514652 29:1aef0ecf9840 722 printf("-");
sesa514652 29:1aef0ecf9840 723 Decide4[1]='-';
sesa514652 29:1aef0ecf9840 724 printf( "chosen3 %c\n",Decide4[1]);
sesa514652 29:1aef0ecf9840 725 }
sesa514652 29:1aef0ecf9840 726
sesa514652 29:1aef0ecf9840 727 if (Scan4[2] > Scan4[3])
sesa514652 29:1aef0ecf9840 728 {
sesa514652 29:1aef0ecf9840 729 printf("+");
sesa514652 29:1aef0ecf9840 730 Decide4[2]= 'x';
sesa514652 29:1aef0ecf9840 731 printf( "chosen 1 %c\n",Decide4[2]);
sesa514652 29:1aef0ecf9840 732 }
sesa514652 31:91a3c61d33e6 733 else if (Scan4[2] == Scan4[3])
sesa514652 29:1aef0ecf9840 734 {
sesa514652 29:1aef0ecf9840 735 printf("=");
sesa514652 29:1aef0ecf9840 736 Decide4[2]='=';
sesa514652 29:1aef0ecf9840 737 printf( "chosen2 %c\n",Decide4[2]);
sesa514652 29:1aef0ecf9840 738 }
sesa514652 29:1aef0ecf9840 739 else if (Scan4[2] < Scan4[3])
sesa514652 29:1aef0ecf9840 740 {
sesa514652 29:1aef0ecf9840 741 printf("-");
sesa514652 29:1aef0ecf9840 742 Decide4[2]='-';
sesa514652 29:1aef0ecf9840 743 printf( "chosen3 %c\n",Decide4[2]);
sesa514652 29:1aef0ecf9840 744 }
sesa514652 29:1aef0ecf9840 745 if (Scan4[3] > Scan4[4])
sesa514652 29:1aef0ecf9840 746 {
sesa514652 29:1aef0ecf9840 747 printf("+");
sesa514652 29:1aef0ecf9840 748 Decide4[3]= 'x';
sesa514652 29:1aef0ecf9840 749 printf( "chosen 1 %c\n",Decide4[3]);
sesa514652 29:1aef0ecf9840 750 }
sesa514652 31:91a3c61d33e6 751 else if (Scan4[3] == Scan4[4])
sesa514652 29:1aef0ecf9840 752 {
sesa514652 29:1aef0ecf9840 753 printf("=");
sesa514652 29:1aef0ecf9840 754 Decide4[3]='=';
sesa514652 29:1aef0ecf9840 755 printf( "chosen2 %c\n",Decide4[3]);
sesa514652 29:1aef0ecf9840 756 }
sesa514652 29:1aef0ecf9840 757 else if (Scan4[3] < Scan4[4])
sesa514652 29:1aef0ecf9840 758 {
sesa514652 29:1aef0ecf9840 759 printf("-");
sesa514652 29:1aef0ecf9840 760 Decide4[3]='-';
sesa514652 29:1aef0ecf9840 761 printf( "chosen3 %c\n",Decide4[3]);
sesa514652 29:1aef0ecf9840 762 }
sesa514652 29:1aef0ecf9840 763 if (Scan5[0] > Scan5[1])
sesa514652 29:1aef0ecf9840 764 {
sesa514652 29:1aef0ecf9840 765 printf("+");
sesa514652 29:1aef0ecf9840 766 Decide5[0]= 'x';
sesa514652 29:1aef0ecf9840 767 printf( "chosen 1 %c\n",Decide5[0]);
sesa514652 29:1aef0ecf9840 768 }
sesa514652 31:91a3c61d33e6 769 else if (Scan5[0] == Scan5[1])
sesa514652 29:1aef0ecf9840 770 {
sesa514652 29:1aef0ecf9840 771 printf("=");
sesa514652 29:1aef0ecf9840 772 Decide5[0]='=';
sesa514652 29:1aef0ecf9840 773 printf( "chosen2 %c\n",Decide5[0]);
sesa514652 29:1aef0ecf9840 774 }
sesa514652 29:1aef0ecf9840 775 else if (Scan5[0] < Scan5[1])
sesa514652 29:1aef0ecf9840 776 {
sesa514652 29:1aef0ecf9840 777 printf("-");
sesa514652 29:1aef0ecf9840 778 Decide5[0]='-';
sesa514652 29:1aef0ecf9840 779 printf( "chosen3 %c\n",Decide5[0]);
sesa514652 29:1aef0ecf9840 780 }
sesa514652 29:1aef0ecf9840 781 if (Scan5[1] > Scan5[2])
sesa514652 29:1aef0ecf9840 782 {
sesa514652 29:1aef0ecf9840 783 printf("+");
sesa514652 29:1aef0ecf9840 784 Decide5[1]= 'x';
sesa514652 29:1aef0ecf9840 785 printf( "chosen 1 %c\n",Decide5[1]);
sesa514652 29:1aef0ecf9840 786 }
sesa514652 31:91a3c61d33e6 787 else if (Scan5[1] == Scan5[2])
sesa514652 29:1aef0ecf9840 788 {
sesa514652 29:1aef0ecf9840 789 printf("=");
sesa514652 29:1aef0ecf9840 790 Decide5[1]='=';
sesa514652 29:1aef0ecf9840 791 printf( "chosen2 %c\n",Decide5[1]);
sesa514652 29:1aef0ecf9840 792 }
sesa514652 29:1aef0ecf9840 793 else if (Scan5[1] < Scan5[2])
sesa514652 29:1aef0ecf9840 794 {
sesa514652 29:1aef0ecf9840 795 printf("-");
sesa514652 29:1aef0ecf9840 796 Decide5[1]='-';
sesa514652 29:1aef0ecf9840 797 printf( "chosen3 %c\n",Decide5[1]);
sesa514652 29:1aef0ecf9840 798 }
sesa514652 29:1aef0ecf9840 799
sesa514652 29:1aef0ecf9840 800 if (Scan5[2] > Scan5[3])
sesa514652 29:1aef0ecf9840 801 {
sesa514652 29:1aef0ecf9840 802 printf("+");
sesa514652 29:1aef0ecf9840 803 Decide5[2]= 'x';
sesa514652 29:1aef0ecf9840 804 printf( "chosen 1 %c\n",Decide5[2]);
sesa514652 29:1aef0ecf9840 805 }
sesa514652 31:91a3c61d33e6 806 else if (Scan5[2] == Scan5[3])
sesa514652 29:1aef0ecf9840 807 {
sesa514652 29:1aef0ecf9840 808 printf("=");
sesa514652 29:1aef0ecf9840 809 Decide5[2]='=';
sesa514652 29:1aef0ecf9840 810 printf( "chosen2 %c\n",Decide5[2]);
sesa514652 29:1aef0ecf9840 811 }
sesa514652 29:1aef0ecf9840 812 else if (Scan5[2] < Scan5[3])
sesa514652 29:1aef0ecf9840 813 {
sesa514652 29:1aef0ecf9840 814 printf("-");
sesa514652 29:1aef0ecf9840 815 Decide5[2]='-';
sesa514652 29:1aef0ecf9840 816 printf( "chosen3 %c\n",Decide5[2]);
sesa514652 29:1aef0ecf9840 817 }
sesa514652 29:1aef0ecf9840 818 if (Scan5[3] > Scan5[4])
sesa514652 29:1aef0ecf9840 819 {
sesa514652 29:1aef0ecf9840 820 printf("+");
sesa514652 29:1aef0ecf9840 821 Decide5[3]= 'x';
sesa514652 29:1aef0ecf9840 822 printf( "chosen 1 %c\n",Decide5[3]);
sesa514652 29:1aef0ecf9840 823 }
sesa514652 31:91a3c61d33e6 824 else if (Scan5[3] == Scan5[4])
sesa514652 29:1aef0ecf9840 825 {
sesa514652 29:1aef0ecf9840 826 printf("=");
sesa514652 29:1aef0ecf9840 827 Decide5[3]='=';
sesa514652 29:1aef0ecf9840 828 printf( "chosen2 %c\n",Decide5[3]);
sesa514652 29:1aef0ecf9840 829 }
sesa514652 29:1aef0ecf9840 830 else if (Scan5[3] < Scan5[4])
sesa514652 29:1aef0ecf9840 831 {
sesa514652 29:1aef0ecf9840 832 printf("-");
sesa514652 29:1aef0ecf9840 833 Decide5[3]='-';
sesa514652 29:1aef0ecf9840 834 printf( "chosen3 %c\n",Decide5[3]);
sesa514652 34:dfe7f5799582 835 } */
sesa514652 27:d48bf4e8f1a0 836
sesa514652 21:2e37f80e8b5b 837 lcd.refresh();
sesa514652 21:2e37f80e8b5b 838 wait_ms(50);
sesa514652 21:2e37f80e8b5b 839
sesa514652 21:2e37f80e8b5b 840 break;
sesa514652 28:aab0aa846cf6 841
sesa514652 22:82b01fdfc61f 842 //////////////////////////////////////////////////////////////////////////////////////////////////
sesa514652 28:aab0aa846cf6 843 /**
sesa514652 28:aab0aa846cf6 844 *.. When Button A is pressed this section of code is ran to collect data points of the object.
sesa514652 28:aab0aa846cf6 845 *..Scanning takes marks the LCD with locationof points which data has been collected for.
sesa514652 28:aab0aa846cf6 846 */
sesa514652 21:2e37f80e8b5b 847 case 1:
sesa514652 28:aab0aa846cf6 848 g_ButtonAPress =1;
sesa514652 33:3717bc4e2fa8 849 /*
sesa514652 33:3717bc4e2fa8 850 *..Section used for power saving, if the user has not continued after 5 scans
sesa514652 33:3717bc4e2fa8 851 */
sesa514652 33:3717bc4e2fa8 852 if(LoopCountScan1==5){
sesa514652 33:3717bc4e2fa8 853 g_ButtonAPress=0;
sesa514652 33:3717bc4e2fa8 854 LoopCountScan1=0;
sesa514652 33:3717bc4e2fa8 855 break;}
sesa514652 33:3717bc4e2fa8 856 else;
sesa514652 31:91a3c61d33e6 857 inputScan1();
sesa514652 33:3717bc4e2fa8 858 break;
sesa514652 32:9c206f993cf5 859 /*
sesa514652 30:9d39318ef584 860 wait_ms(5); // required to stop Black screen issue}
sesa514652 31:91a3c61d33e6 861 inputScan2();
sesa514652 31:91a3c61d33e6 862 wait_ms(5); // required to stop Black screen issue}
sesa514652 31:91a3c61d33e6 863 inputScan3();
sesa514652 28:aab0aa846cf6 864
sesa514652 30:9d39318ef584 865 wait_ms(5); // required to stop Black screen issue}
sesa514652 31:91a3c61d33e6 866 inputScan4();
sesa514652 28:aab0aa846cf6 867
sesa514652 30:9d39318ef584 868 wait_ms(5);
sesa514652 31:91a3c61d33e6 869 inputScan5();
sesa514652 30:9d39318ef584 870
sesa514652 30:9d39318ef584 871
sesa514652 30:9d39318ef584 872
sesa514652 28:aab0aa846cf6 873 g_ButtonAPress=0;
sesa514652 32:9c206f993cf5 874 */
sesa514652 33:3717bc4e2fa8 875
sesa514652 22:82b01fdfc61f 876 ////////////////////////////////////////////////////////////////////////////
sesa514652 20:4e1f2917a857 877 case 2:
sesa514652 28:aab0aa846cf6 878 g_ButtonAPress= 2;
sesa514652 33:3717bc4e2fa8 879 if(LoopCountScan2==5){
sesa514652 33:3717bc4e2fa8 880 g_ButtonAPress=0;
sesa514652 33:3717bc4e2fa8 881 LoopCountScan2=0;
sesa514652 33:3717bc4e2fa8 882 break;}
sesa514652 33:3717bc4e2fa8 883 else;
sesa514652 32:9c206f993cf5 884 /*int secondScan[10];
sesa514652 22:82b01fdfc61f 885
sesa514652 22:82b01fdfc61f 886 secondScan[5] = sensor.distance();
sesa514652 22:82b01fdfc61f 887 printf("Distance : %d cm", secondScan[5]);
sesa514652 22:82b01fdfc61f 888 lcd.clear();
sesa514652 22:82b01fdfc61f 889 lcd.printString("2nd Scan up down",0,0);
sesa514652 32:9c206f993cf5 890 lcd.drawLine(0,10,80,10,2); */
sesa514652 32:9c206f993cf5 891 inputScan2();
sesa514652 20:4e1f2917a857 892 break;
sesa514652 22:82b01fdfc61f 893 ////////////////////////////////////////////////////////////////////
sesa514652 20:4e1f2917a857 894 case 3:
sesa514652 28:aab0aa846cf6 895 g_ButtonAPress= 3;
sesa514652 33:3717bc4e2fa8 896 if(LoopCountScan3==5){
sesa514652 33:3717bc4e2fa8 897 g_ButtonAPress=0;
sesa514652 33:3717bc4e2fa8 898 LoopCountScan3=0;
sesa514652 33:3717bc4e2fa8 899 break;}
sesa514652 33:3717bc4e2fa8 900 else;
sesa514652 32:9c206f993cf5 901 /* lcd.clear();
sesa514652 20:4e1f2917a857 902 lcd.printString("Menu 3",0,0);
sesa514652 31:91a3c61d33e6 903 int us = sensor.distance();
sesa514652 21:2e37f80e8b5b 904 printf("Distance : %d cm",us);
sesa514652 20:4e1f2917a857 905 lcd.refresh();
sesa514652 32:9c206f993cf5 906 wait_ms(50); //required to stop Black screen issue*/
sesa514652 32:9c206f993cf5 907 inputScan3();
sesa514652 20:4e1f2917a857 908 break;
sesa514652 32:9c206f993cf5 909
sesa514652 32:9c206f993cf5 910 /////////////////////////////////////////////////////////////////////////
sesa514652 32:9c206f993cf5 911
sesa514652 32:9c206f993cf5 912 case 4:
sesa514652 32:9c206f993cf5 913 g_ButtonAPress= 4;
sesa514652 33:3717bc4e2fa8 914 if(LoopCountScan4==5){
sesa514652 33:3717bc4e2fa8 915 g_ButtonAPress=0;
sesa514652 33:3717bc4e2fa8 916 LoopCountScan4=0;
sesa514652 33:3717bc4e2fa8 917 break;}
sesa514652 33:3717bc4e2fa8 918 else;
sesa514652 32:9c206f993cf5 919 /* lcd.clear();
sesa514652 32:9c206f993cf5 920 lcd.printString("Menu 3",0,0);
sesa514652 32:9c206f993cf5 921 int us = sensor.distance();
sesa514652 32:9c206f993cf5 922 printf("Distance : %d cm",us);
sesa514652 32:9c206f993cf5 923 lcd.refresh();
sesa514652 32:9c206f993cf5 924 wait_ms(50); //required to stop Black screen issue*/
sesa514652 32:9c206f993cf5 925 inputScan4();
sesa514652 32:9c206f993cf5 926 break;
sesa514652 32:9c206f993cf5 927 ///////////////////////////////////////////////////////////////////
sesa514652 32:9c206f993cf5 928 case 5:
sesa514652 32:9c206f993cf5 929 g_ButtonAPress= 5;
sesa514652 33:3717bc4e2fa8 930 if(LoopCountScan5==5){
sesa514652 33:3717bc4e2fa8 931 g_ButtonAPress=0;
sesa514652 33:3717bc4e2fa8 932 LoopCountScan5=0;
sesa514652 33:3717bc4e2fa8 933 break;}
sesa514652 33:3717bc4e2fa8 934 else;
sesa514652 32:9c206f993cf5 935 /* lcd.clear();
sesa514652 32:9c206f993cf5 936 lcd.printString("Menu 3",0,0);
sesa514652 32:9c206f993cf5 937 int us = sensor.distance();
sesa514652 32:9c206f993cf5 938 printf("Distance : %d cm",us);
sesa514652 32:9c206f993cf5 939 lcd.refresh();
sesa514652 32:9c206f993cf5 940 wait_ms(50); //required to stop Black screen issue*/
sesa514652 32:9c206f993cf5 941 inputScan5();
sesa514652 32:9c206f993cf5 942 break;
sesa514652 32:9c206f993cf5 943 /////////////////////////////////////////////////////////////////
sesa514652 20:4e1f2917a857 944 }
sesa514652 23:f72175fb49ed 945
sesa514652 20:4e1f2917a857 946 /*
sesa514652 11:1dec05b7d1c1 947 int button_counter;
sesa514652 10:42e70b596099 948 if (g_buttonA_flag){
sesa514652 11:1dec05b7d1c1 949 button_counter = button_counter +1;
sesa514652 11:1dec05b7d1c1 950 //case (test)
sesa514652 10:42e70b596099 951 g_buttonA_flag = 0; // if it has, clear the flag
sesa514652 10:42e70b596099 952
sesa514652 10:42e70b596099 953 // send message over serial port - can observe in CoolTerm etc.
sesa514652 11:1dec05b7d1c1 954 printf("Button A pressed %f\n", button_counter);
sesa514652 10:42e70b596099 955 }
sesa514652 10:42e70b596099 956 if (g_buttonB_flag){
sesa514652 10:42e70b596099 957 g_buttonB_flag = 0; // if it has, clear the flag
sesa514652 8:770d168713cc 958
sesa514652 10:42e70b596099 959 // send message over serial port - can observe in CoolTerm etc.
sesa514652 10:42e70b596099 960 printf("Button B pressed\n");
sesa514652 10:42e70b596099 961 }
sesa514652 10:42e70b596099 962 if (g_buttonX_flag){
sesa514652 10:42e70b596099 963 g_buttonX_flag = 0; // if it has, clear the flag
sesa514652 12:ceea378d5691 964 // swap direction when button has been pressed
sesa514652 12:ceea378d5691 965 // (could just use ! but want this to be explicit to aid understanding)
sesa514652 12:ceea378d5691 966 if (direction == UP) {
sesa514652 12:ceea378d5691 967 direction = DOWN;
sesa514652 12:ceea378d5691 968 }
sesa514652 12:ceea378d5691 969 else {
sesa514652 12:ceea378d5691 970 direction = UP;
sesa514652 12:ceea378d5691 971 }
sesa514652 10:42e70b596099 972
sesa514652 10:42e70b596099 973 // send message over serial port - can observe in CoolTerm etc.
sesa514652 10:42e70b596099 974 printf("Button X pressed\n");
sesa514652 10:42e70b596099 975 lcd.clear();
sesa514652 10:42e70b596099 976 lcd.printString("Button Pressed!",0,0);
sesa514652 10:42e70b596099 977 lcd.refresh();
sesa514652 11:1dec05b7d1c1 978 wait(1);
sesa514652 10:42e70b596099 979 }
sesa514652 10:42e70b596099 980 if (g_buttonY_flag){
sesa514652 10:42e70b596099 981 g_buttonY_flag = 0; // if it has, clear the flag
sesa514652 10:42e70b596099 982
sesa514652 10:42e70b596099 983 // send message over serial port - can observe in CoolTerm etc.
sesa514652 10:42e70b596099 984 printf("Button Y pressed\n");
sesa514652 10:42e70b596099 985 }
sesa514652 5:9b2c976ca318 986 Buzzer.play(200,120);
sesa514652 5:9b2c976ca318 987 wait_ms(5);
sesa514652 5:9b2c976ca318 988 Buzzer.play(200,120);
sesa514652 1:757728321abd 989 long distanced = sensor.distance();
sesa514652 1:757728321abd 990 if (distanced >= 400 || distanced <= 2)
sesa514652 5:9b2c976ca318 991 {
sesa514652 1:757728321abd 992 printf("Out of range");
sesa514652 5:9b2c976ca318 993 //Calling dummy function 05/01/22
sesa514652 4:167ce930c9d5 994 int answer = cube(2);
sesa514652 5:9b2c976ca318 995 printf("%f\n",answer);
sesa514652 1:757728321abd 996 wait(1.0);
sesa514652 5:9b2c976ca318 997 }
sesa514652 5:9b2c976ca318 998 else
sesa514652 5:9b2c976ca318 999 {
sesa514652 5:9b2c976ca318 1000 printf("Distance : %d cm",distanced);
sesa514652 5:9b2c976ca318 1001 wait(1.0); // 1 sec
sesa514652 1:757728321abd 1002 }
sesa514652 5:9b2c976ca318 1003 lcd.drawCircle(WIDTH/2,HEIGHT/2,distanced,FILL_BLACK);
sesa514652 5:9b2c976ca318 1004 //lcd.refresh must be used to update the lcd Display
sesa514652 5:9b2c976ca318 1005 lcd.refresh();
sesa514652 5:9b2c976ca318 1006 wait(5.0);
sesa514652 5:9b2c976ca318 1007 //these are default settings so not strictly needed
sesa514652 0:1f799c7cce2b 1008 lcd.normalMode(); // normal colour mode
sesa514652 5:9b2c976ca318 1009 lcd.setBrightness(0.5); // put LED backlight on 50%
sesa514652 0:1f799c7cce2b 1010 lcd.clear();
sesa514652 0:1f799c7cce2b 1011 lcd.printString("Hello, World!",0,0);
sesa514652 0:1f799c7cce2b 1012 Vector2D coord = joystick.get_coord();
sesa514652 0:1f799c7cce2b 1013 lcd.refresh();
sesa514652 0:1f799c7cce2b 1014 printf("Coord = %f,%f\n",coord.x,coord.y);
sesa514652 0:1f799c7cce2b 1015 char buffer[14];
sesa514652 0:1f799c7cce2b 1016 Vector2D mapped_coord = joystick.get_mapped_coord();
sesa514652 0:1f799c7cce2b 1017 printf("Mapped coord = %f,%f\n",mapped_coord.x,mapped_coord.y);
sesa514652 0:1f799c7cce2b 1018
sesa514652 5:9b2c976ca318 1019 int length = sprintf(buffer,"T = %2f",coord.x);
sesa514652 5:9b2c976ca318 1020 //it is important the format specifier ensures the length will fit in the buffer
sesa514652 0:1f799c7cce2b 1021 if (length <= 14) // if string will fit on display (assuming printing at x=0)
sesa514652 5:9b2c976ca318 1022 lcd.printString(buffer,0,1); // display on screen
sesa514652 0:1f799c7cce2b 1023 lcd.refresh();
sesa514652 5:9b2c976ca318 1024 lcd.clear();
sesa514652 5:9b2c976ca318 1025 //times by 50 to try get the point moving across screen
sesa514652 0:1f799c7cce2b 1026 float x50 = mapped_coord.x*5;
sesa514652 0:1f799c7cce2b 1027 float y50 = mapped_coord.y*8;
sesa514652 5:9b2c976ca318 1028 //to see what the values are
sesa514652 5:9b2c976ca318 1029 printf(" *50 = %f,%f\n",x50,y50);
sesa514652 5:9b2c976ca318 1030 //example of how to draw circles
sesa514652 1:757728321abd 1031 lcd.printChar('o',WIDTH/2,HEIGHT/2);
sesa514652 5:9b2c976ca318 1032 lcd.refresh();
sesa514652 0:1f799c7cce2b 1033 float mag = joystick.get_mag();
sesa514652 0:1f799c7cce2b 1034 float angle = joystick.get_angle();
sesa514652 0:1f799c7cce2b 1035 printf("Mag = %f Angle = %f\n",mag,angle);
sesa514652 0:1f799c7cce2b 1036 Direction d = joystick.get_direction();
sesa514652 0:1f799c7cce2b 1037 printf("Direction = %i\n",d);
sesa514652 0:1f799c7cce2b 1038 if (joystick.button_pressed() ) {
sesa514652 0:1f799c7cce2b 1039 printf("Button Pressed\n");
sesa514652 9:cdd7d9a123f9 1040 wait(5);
sesa514652 0:1f799c7cce2b 1041 }
sesa514652 8:770d168713cc 1042
sesa514652 8:770d168713cc 1043 }
sesa514652 16:2646c1c4e62e 1044 }
sesa514652 20:4e1f2917a857 1045 */
sesa514652 23:f72175fb49ed 1046 }
sesa514652 32:9c206f993cf5 1047 }
sesa514652 35:36c7605dda06 1048 }
sesa514652 18:bb36d96142dd 1049 int buttonCountA(){
sesa514652 28:aab0aa846cf6 1050 g_ButtonAPress++;
sesa514652 32:9c206f993cf5 1051 if (g_ButtonAPress>5){
sesa514652 28:aab0aa846cf6 1052 g_ButtonAPress= 0;
sesa514652 18:bb36d96142dd 1053 }
sesa514652 28:aab0aa846cf6 1054 return g_ButtonAPress;
sesa514652 18:bb36d96142dd 1055 }
sesa514652 18:bb36d96142dd 1056 int buttonCountB(){
sesa514652 28:aab0aa846cf6 1057 g_ButtonBPress++;
sesa514652 28:aab0aa846cf6 1058 if (g_ButtonBPress>3){
sesa514652 28:aab0aa846cf6 1059 g_ButtonBPress= 0;
sesa514652 18:bb36d96142dd 1060 }
sesa514652 28:aab0aa846cf6 1061 return g_ButtonBPress;
sesa514652 18:bb36d96142dd 1062 }
sesa514652 33:3717bc4e2fa8 1063 int NoContinueExitScan1(){
sesa514652 33:3717bc4e2fa8 1064 LoopCountScan1++;
sesa514652 33:3717bc4e2fa8 1065 if (LoopCountScan1>5){
sesa514652 33:3717bc4e2fa8 1066 LoopCountScan1= 0;
sesa514652 33:3717bc4e2fa8 1067 }
sesa514652 33:3717bc4e2fa8 1068 return LoopCountScan1;
sesa514652 33:3717bc4e2fa8 1069 }
sesa514652 33:3717bc4e2fa8 1070 int NoContinueExitScan2(){
sesa514652 33:3717bc4e2fa8 1071 LoopCountScan2++;
sesa514652 33:3717bc4e2fa8 1072 if (LoopCountScan2>5){
sesa514652 33:3717bc4e2fa8 1073 LoopCountScan2= 0;
sesa514652 33:3717bc4e2fa8 1074 }
sesa514652 33:3717bc4e2fa8 1075 return LoopCountScan2;
sesa514652 33:3717bc4e2fa8 1076 }
sesa514652 33:3717bc4e2fa8 1077 int NoContinueExitScan3(){
sesa514652 33:3717bc4e2fa8 1078 LoopCountScan3++;
sesa514652 33:3717bc4e2fa8 1079 if (LoopCountScan3>5){
sesa514652 33:3717bc4e2fa8 1080 LoopCountScan3= 0;
sesa514652 33:3717bc4e2fa8 1081 }
sesa514652 33:3717bc4e2fa8 1082 return LoopCountScan3;
sesa514652 33:3717bc4e2fa8 1083 }
sesa514652 33:3717bc4e2fa8 1084 int NoContinueExitScan4(){
sesa514652 33:3717bc4e2fa8 1085 LoopCountScan4++;
sesa514652 33:3717bc4e2fa8 1086 if (LoopCountScan4>5){
sesa514652 33:3717bc4e2fa8 1087 LoopCountScan4= 0;
sesa514652 33:3717bc4e2fa8 1088 }
sesa514652 33:3717bc4e2fa8 1089 return LoopCountScan4;
sesa514652 33:3717bc4e2fa8 1090 }
sesa514652 33:3717bc4e2fa8 1091 int NoContinueExitScan5(){
sesa514652 33:3717bc4e2fa8 1092 LoopCountScan5++;
sesa514652 33:3717bc4e2fa8 1093 if (LoopCountScan5>5){
sesa514652 33:3717bc4e2fa8 1094 LoopCountScan5= 0;
sesa514652 33:3717bc4e2fa8 1095 }
sesa514652 33:3717bc4e2fa8 1096 return LoopCountScan5;
sesa514652 33:3717bc4e2fa8 1097 }
sesa514652 33:3717bc4e2fa8 1098
sesa514652 15:234321e80678 1099
sesa514652 12:ceea378d5691 1100 //Button A event-triggered interrupt
sesa514652 10:42e70b596099 1101 void buttonA_isr()
sesa514652 10:42e70b596099 1102 {
sesa514652 12:ceea378d5691 1103
sesa514652 18:bb36d96142dd 1104 long distanced = sensor.distance();
sesa514652 18:bb36d96142dd 1105 buttonCountA();
sesa514652 18:bb36d96142dd 1106
sesa514652 16:2646c1c4e62e 1107
sesa514652 12:ceea378d5691 1108
sesa514652 12:ceea378d5691 1109 g_buttonA_flag = 1; // set flag in ISR
sesa514652 12:ceea378d5691 1110
sesa514652 28:aab0aa846cf6 1111 printf("press count = %i\n",g_ButtonAPress);
sesa514652 12:ceea378d5691 1112
sesa514652 12:ceea378d5691 1113 // lcd.clear();
sesa514652 15:234321e80678 1114 //lcd.printString("Button A Pressed",0,0);
sesa514652 12:ceea378d5691 1115
sesa514652 15:234321e80678 1116 // lcd.refresh(); // set flag in ISR
sesa514652 12:ceea378d5691 1117 }
sesa514652 12:ceea378d5691 1118
sesa514652 11:1dec05b7d1c1 1119
sesa514652 10:42e70b596099 1120 //Button B event-triggered interrupt
sesa514652 10:42e70b596099 1121 void buttonB_isr()
sesa514652 10:42e70b596099 1122 {
sesa514652 18:bb36d96142dd 1123 buttonCountB();
sesa514652 10:42e70b596099 1124 g_buttonB_flag = 1; // set flag in ISR
sesa514652 11:1dec05b7d1c1 1125 lcd.clear();
sesa514652 11:1dec05b7d1c1 1126 lcd.printString("Button B Pressed",0,0);
sesa514652 11:1dec05b7d1c1 1127 lcd.refresh(); // set flag in ISR
sesa514652 28:aab0aa846cf6 1128 printf("press count = %i\n",g_ButtonBPress);
sesa514652 10:42e70b596099 1129 }
sesa514652 10:42e70b596099 1130 //Button X event-triggered interrupt
sesa514652 10:42e70b596099 1131 void buttonX_isr()
sesa514652 10:42e70b596099 1132 {
sesa514652 10:42e70b596099 1133 g_buttonX_flag = 1; // set flag in ISR
sesa514652 11:1dec05b7d1c1 1134 lcd.clear();
sesa514652 11:1dec05b7d1c1 1135 lcd.printString("Button X Pressed",0,0);
sesa514652 11:1dec05b7d1c1 1136 lcd.refresh(); // set flag in ISR
sesa514652 10:42e70b596099 1137 }
sesa514652 10:42e70b596099 1138 //Button Y event-triggered interrupt
sesa514652 10:42e70b596099 1139 void buttonY_isr()
sesa514652 10:42e70b596099 1140 {
sesa514652 10:42e70b596099 1141 g_buttonY_flag = 1; // set flag in ISR
sesa514652 11:1dec05b7d1c1 1142 lcd.clear();
sesa514652 11:1dec05b7d1c1 1143 lcd.printString("Button Y Pressed",0,0);
sesa514652 11:1dec05b7d1c1 1144 lcd.refresh(); // set flag in ISR
sesa514652 10:42e70b596099 1145 }
sesa514652 11:1dec05b7d1c1 1146 //Button Start event-triggered interrupt
sesa514652 11:1dec05b7d1c1 1147 void buttonStart_isr()
sesa514652 11:1dec05b7d1c1 1148 {
sesa514652 11:1dec05b7d1c1 1149 g_buttonStart_flag = 1; // set flag in ISR
sesa514652 11:1dec05b7d1c1 1150 lcd.clear();
sesa514652 11:1dec05b7d1c1 1151 lcd.printString("Button Start Pressed",0,0);
sesa514652 11:1dec05b7d1c1 1152 lcd.refresh(); // set flag in ISR
sesa514652 29:1aef0ecf9840 1153
sesa514652 11:1dec05b7d1c1 1154 }
sesa514652 11:1dec05b7d1c1 1155 //Button Back event-triggered interrupt
sesa514652 11:1dec05b7d1c1 1156 void buttonBack_isr()
sesa514652 11:1dec05b7d1c1 1157 {
sesa514652 11:1dec05b7d1c1 1158 g_buttonBack_flag = 1; // set flag in ISR
sesa514652 11:1dec05b7d1c1 1159 lcd.clear();
sesa514652 11:1dec05b7d1c1 1160 lcd.printString("Button Back Pressed",0,0);
sesa514652 11:1dec05b7d1c1 1161 lcd.refresh(); // set flag in ISR
sesa514652 11:1dec05b7d1c1 1162 }
sesa514652 11:1dec05b7d1c1 1163 //Button Left event-triggered interrupt
sesa514652 11:1dec05b7d1c1 1164 void buttonLeft_isr()
sesa514652 11:1dec05b7d1c1 1165 {
sesa514652 11:1dec05b7d1c1 1166 g_buttonLeft_flag = 1; // set flag in ISR
sesa514652 11:1dec05b7d1c1 1167 lcd.clear();
sesa514652 11:1dec05b7d1c1 1168 lcd.printString("Button Left Pressed",0,0);
sesa514652 11:1dec05b7d1c1 1169 lcd.refresh(); // set flag in ISR
sesa514652 11:1dec05b7d1c1 1170 }
sesa514652 11:1dec05b7d1c1 1171 //Button Right event-triggered interrupt
sesa514652 11:1dec05b7d1c1 1172 void buttonRight_isr()
sesa514652 11:1dec05b7d1c1 1173 {
sesa514652 11:1dec05b7d1c1 1174 g_buttonRight_flag = 1; // set flag in ISR
sesa514652 11:1dec05b7d1c1 1175 lcd.clear();
sesa514652 31:91a3c61d33e6 1176 lcd.printString("Button Right Pressed",0,0);
sesa514652 11:1dec05b7d1c1 1177 lcd.refresh(); // set flag in ISR
sesa514652 31:91a3c61d33e6 1178 }
sesa514652 31:91a3c61d33e6 1179 void inputScan1()
sesa514652 31:91a3c61d33e6 1180 {
sesa514652 31:91a3c61d33e6 1181 lcd.clear();
sesa514652 31:91a3c61d33e6 1182 lcd.printString("First Scan",0,0);
sesa514652 31:91a3c61d33e6 1183 lcd.refresh();
sesa514652 33:3717bc4e2fa8 1184 NoContinueExitScan1();
sesa514652 31:91a3c61d33e6 1185
sesa514652 31:91a3c61d33e6 1186 Buzzer.play(300,120); lcd.printString("X",0,1); lcd.refresh(); Scan1[0] = sensor.distance();
sesa514652 35:36c7605dda06 1187 wait_ms(5);/*
sesa514652 31:91a3c61d33e6 1188 Buzzer.play(200,120); lcd.printString("X",0,2);lcd.refresh(); Scan1[1] = sensor.distance();
sesa514652 31:91a3c61d33e6 1189 wait_ms(5);
sesa514652 31:91a3c61d33e6 1190 Buzzer.play(200,120); lcd.printString("X",0,3);lcd.refresh(); Scan1[2] = sensor.distance();
sesa514652 31:91a3c61d33e6 1191 wait_ms(5);
sesa514652 31:91a3c61d33e6 1192 Buzzer.play(200,120); lcd.printString("X",0,4);lcd.refresh(); Scan1[3] = sensor.distance();;
sesa514652 31:91a3c61d33e6 1193 wait_ms(5);
sesa514652 31:91a3c61d33e6 1194 Buzzer.play(200,120); lcd.printString("X",0,5);lcd.refresh(); Scan1[4] = sensor.distance();;
sesa514652 35:36c7605dda06 1195 wait_ms(5);*/
sesa514652 35:36c7605dda06 1196 lcd.printString("Scan 1 Done",0,0); lcd.refresh();
sesa514652 31:91a3c61d33e6 1197 }
sesa514652 31:91a3c61d33e6 1198
sesa514652 31:91a3c61d33e6 1199 void inputScan2()
sesa514652 31:91a3c61d33e6 1200 {
sesa514652 31:91a3c61d33e6 1201 lcd.clear();
sesa514652 31:91a3c61d33e6 1202 lcd.printString("Second Scan",0,0);
sesa514652 31:91a3c61d33e6 1203 lcd.refresh();
sesa514652 33:3717bc4e2fa8 1204 NoContinueExitScan2();
sesa514652 35:36c7605dda06 1205
sesa514652 35:36c7605dda06 1206 lcd.printString("X",0,1);//,lcd.printString("X",0,2),lcd.printString("X",0,3),lcd.printString("X",0,4),lcd.printString("X",0,5); lcd.refresh();
sesa514652 35:36c7605dda06 1207 Buzzer.play(300,120); lcd.printString("X",15,1); lcd.refresh(); Scan1[1] = sensor.distance();
sesa514652 35:36c7605dda06 1208 wait_ms(5);/*
sesa514652 31:91a3c61d33e6 1209 Buzzer.play(200,120); lcd.printString("X",15,2);lcd.refresh(); Scan2[1] = sensor.distance();
sesa514652 31:91a3c61d33e6 1210 wait_ms(5);
sesa514652 31:91a3c61d33e6 1211 Buzzer.play(200,120); lcd.printString("X",15,3);lcd.refresh(); Scan2[2] = sensor.distance();
sesa514652 31:91a3c61d33e6 1212 wait_ms(5);
sesa514652 31:91a3c61d33e6 1213 Buzzer.play(200,120); lcd.printString("X",15,4);lcd.refresh(); Scan2[3] = sensor.distance();
sesa514652 31:91a3c61d33e6 1214 wait_ms(5);
sesa514652 35:36c7605dda06 1215 Buzzer.play(200,120); lcd.printString("X",15,5);lcd.refresh(); Scan2[4] = sensor.distance(); */
sesa514652 31:91a3c61d33e6 1216 lcd.printString("Scan 2 Done",0,0); lcd.refresh();
sesa514652 31:91a3c61d33e6 1217
sesa514652 31:91a3c61d33e6 1218 }
sesa514652 31:91a3c61d33e6 1219 void inputScan3()
sesa514652 31:91a3c61d33e6 1220 {
sesa514652 31:91a3c61d33e6 1221 lcd.clear();
sesa514652 31:91a3c61d33e6 1222 lcd.printString("Third Scan",0,0);
sesa514652 31:91a3c61d33e6 1223 lcd.refresh();
sesa514652 33:3717bc4e2fa8 1224 NoContinueExitScan3();
sesa514652 35:36c7605dda06 1225 lcd.printString("X",0,1);//,lcd.printString("X",0,2),lcd.printString("X",0,3),lcd.printString("X",0,4),lcd.printString("X",0,5); lcd.refresh();
sesa514652 35:36c7605dda06 1226 lcd.printString("X",15,1);//,lcd.printString("X",15,2),lcd.printString("X",15,3),lcd.printString("X",15,4),lcd.printString("X",15,5); lcd.refresh();
sesa514652 35:36c7605dda06 1227 Buzzer.play(300,120); lcd.printString("X",30,1); lcd.refresh(); Scan1[2] = sensor.distance();
sesa514652 35:36c7605dda06 1228 wait_ms(5);/*
sesa514652 31:91a3c61d33e6 1229 Buzzer.play(200,120); lcd.printString("X",30,2);lcd.refresh(); Scan3[1] = sensor.distance();
sesa514652 31:91a3c61d33e6 1230 wait_ms(5);
sesa514652 31:91a3c61d33e6 1231 Buzzer.play(200,120); lcd.printString("X",30,3);lcd.refresh(); Scan3[2] = sensor.distance();
sesa514652 31:91a3c61d33e6 1232 wait_ms(5);
sesa514652 31:91a3c61d33e6 1233 Buzzer.play(200,120); lcd.printString("X",30,4);lcd.refresh(); Scan3[3] = sensor.distance();
sesa514652 31:91a3c61d33e6 1234 wait_ms(5);
sesa514652 35:36c7605dda06 1235 Buzzer.play(200,120); lcd.printString("X",30,5);lcd.refresh(); Scan3[4] = sensor.distance();*/
sesa514652 31:91a3c61d33e6 1236 lcd.printString("Scan 3 Done",0,0); lcd.refresh();
sesa514652 31:91a3c61d33e6 1237 }
sesa514652 31:91a3c61d33e6 1238 void inputScan4()
sesa514652 31:91a3c61d33e6 1239 {
sesa514652 33:3717bc4e2fa8 1240 lcd.clear();
sesa514652 33:3717bc4e2fa8 1241 lcd.printString("Fourth Scan",0,0);
sesa514652 33:3717bc4e2fa8 1242 lcd.refresh();
sesa514652 33:3717bc4e2fa8 1243 NoContinueExitScan4();
sesa514652 35:36c7605dda06 1244 lcd.printString("X",0,1);//,lcd.printString("X",0,2),lcd.printString("X",0,3),lcd.printString("X",0,4),lcd.printString("X",0,5); lcd.refresh();
sesa514652 35:36c7605dda06 1245 lcd.printString("X",15,1);//,lcd.printString("X",15,2),lcd.printString("X",15,3),lcd.printString("X",15,4),lcd.printString("X",15,5); lcd.refresh();
sesa514652 35:36c7605dda06 1246 lcd.printString("X",30,1);//,lcd.printString("X",30,2),lcd.printString("X",30,3),lcd.printString("X",30,4),lcd.printString("X",30,5); lcd.refresh();
sesa514652 35:36c7605dda06 1247 Buzzer.play(300,120); lcd.printString("X",45,1); lcd.refresh(); Scan1[3] = sensor.distance();
sesa514652 35:36c7605dda06 1248 wait_ms(5);/*
sesa514652 31:91a3c61d33e6 1249 Buzzer.play(200,120); lcd.printString("X",45,2);lcd.refresh(); Scan4[1] = sensor.distance();
sesa514652 31:91a3c61d33e6 1250 wait_ms(5);
sesa514652 31:91a3c61d33e6 1251 Buzzer.play(200,120); lcd.printString("X",45,3);lcd.refresh(); Scan4[2] = sensor.distance();
sesa514652 31:91a3c61d33e6 1252 wait_ms(5);
sesa514652 31:91a3c61d33e6 1253 Buzzer.play(200,120); lcd.printString("X",45,4);lcd.refresh(); Scan4[3] = sensor.distance();
sesa514652 31:91a3c61d33e6 1254 wait_ms(5);
sesa514652 35:36c7605dda06 1255 Buzzer.play(200,120); lcd.printString("X",45,5);lcd.refresh(); Scan4[4] = sensor.distance();*/
sesa514652 31:91a3c61d33e6 1256 lcd.printString("Scan 4 Done",0,0); lcd.refresh();
sesa514652 31:91a3c61d33e6 1257 }
sesa514652 31:91a3c61d33e6 1258 void inputScan5()
sesa514652 31:91a3c61d33e6 1259 {
sesa514652 31:91a3c61d33e6 1260 lcd.clear();
sesa514652 31:91a3c61d33e6 1261 lcd.printString("Fifth Scan",0,0);
sesa514652 31:91a3c61d33e6 1262 lcd.refresh();
sesa514652 33:3717bc4e2fa8 1263 NoContinueExitScan5();
sesa514652 35:36c7605dda06 1264 lcd.printString("X",0,1);//,lcd.printString("X",0,2),lcd.printString("X",0,3),lcd.printString("X",0,4),lcd.printString("X",0,5); lcd.refresh();
sesa514652 35:36c7605dda06 1265 lcd.printString("X",15,1);//,lcd.printString("X",15,2),lcd.printString("X",15,3),lcd.printString("X",15,4),lcd.printString("X",15,5); lcd.refresh();
sesa514652 35:36c7605dda06 1266 lcd.printString("X",30,1);//,lcd.printString("X",30,2),lcd.printString("X",30,3),lcd.printString("X",30,4),lcd.printString("X",30,5); lcd.refresh();
sesa514652 35:36c7605dda06 1267 lcd.printString("X",45,1);//,lcd.printString("X",45,2),lcd.printString("X",45,3),lcd.printString("X",45,4),lcd.printString("X",45,5); lcd.refresh();
sesa514652 35:36c7605dda06 1268 Buzzer.play(300,120); lcd.printString("X",60,1); lcd.refresh(); Scan1[4] = sensor.distance();
sesa514652 35:36c7605dda06 1269 wait_ms(5);/*
sesa514652 31:91a3c61d33e6 1270 Buzzer.play(200,120); lcd.printString("X",60,2);lcd.refresh(); Scan5[1] = sensor.distance();
sesa514652 31:91a3c61d33e6 1271 wait_ms(5);
sesa514652 31:91a3c61d33e6 1272 Buzzer.play(200,120); lcd.printString("X",60,3);lcd.refresh(); Scan5[2] = sensor.distance();
sesa514652 31:91a3c61d33e6 1273 wait_ms(5);
sesa514652 31:91a3c61d33e6 1274 Buzzer.play(200,120); lcd.printString("X",60,4);lcd.refresh(); Scan5[3] = sensor.distance();
sesa514652 31:91a3c61d33e6 1275 wait_ms(5);
sesa514652 35:36c7605dda06 1276 Buzzer.play(200,120); lcd.printString("X",60,5);lcd.refresh(); Scan5[4] = sensor.distance(); */
sesa514652 31:91a3c61d33e6 1277 lcd.printString("Scan 5 Done",0,0); lcd.refresh();
sesa514652 31:91a3c61d33e6 1278 }