Coursework

Committer:
sesa514652
Date:
Tue Jan 18 23:12:23 2022 +0000
Revision:
22:82b01fdfc61f
Parent:
21:2e37f80e8b5b
Child:
23:f72175fb49ed
Addition of cin,cout,  and if statement to simulate sensor reads to try to begin object recognition

Who changed what in which revision?

UserRevisionLine numberNew contents of line
sesa514652 0:1f799c7cce2b 1 #include "mbed.h"
sesa514652 0:1f799c7cce2b 2 #include "Joystick.h"
sesa514652 0:1f799c7cce2b 3 #include "N5110.h"
sesa514652 0:1f799c7cce2b 4 #include "hcsr04.h"
sesa514652 3:6ecb75a2675c 5 #include "Piezo.h"
sesa514652 8:770d168713cc 6 #include "string"
sesa514652 20:4e1f2917a857 7 #include "array"
sesa514652 22:82b01fdfc61f 8 #include <iostream>
sesa514652 12:ceea378d5691 9 // FSM Menu
sesa514652 12:ceea378d5691 10 // defines directions as 0/1. Note UPPERCASE
sesa514652 12:ceea378d5691 11 #define UP 0
sesa514652 12:ceea378d5691 12 #define DOWN 1
sesa514652 12:ceea378d5691 13 // set inital state
sesa514652 12:ceea378d5691 14 volatile int state = 0;
sesa514652 12:ceea378d5691 15 // set initial direction
sesa514652 12:ceea378d5691 16 int direction = UP;
sesa514652 12:ceea378d5691 17 // array of states in the FSM, each element is the output of the counter
sesa514652 12:ceea378d5691 18 // set the output in binary to make it easier, 0 is LED on, 1 is LED off
sesa514652 12:ceea378d5691 19 string fsm[4] = {"buttonA_isr","buttonB_isr","buttonAsss_isr","buttonA_isr"};
sesa514652 18:bb36d96142dd 20 volatile int PressA;
sesa514652 18:bb36d96142dd 21 volatile int PressB;
sesa514652 10:42e70b596099 22
sesa514652 5:9b2c976ca318 23 // y x button
sesa514652 0:1f799c7cce2b 24 Joystick joystick(PTB10,PTB11,PTC16);
sesa514652 0:1f799c7cce2b 25 HCSR04 sensor(D14, D15);
sesa514652 3:6ecb75a2675c 26 Piezo Buzzer(PTC10);
sesa514652 8:770d168713cc 27 //Bringing in buttons
sesa514652 8:770d168713cc 28 InterruptIn buttonA(PTB9);
sesa514652 8:770d168713cc 29 InterruptIn buttonB(PTD0);
sesa514652 8:770d168713cc 30 InterruptIn buttonX(PTC17);
sesa514652 8:770d168713cc 31 InterruptIn buttonY(PTC12);
sesa514652 11:1dec05b7d1c1 32 InterruptIn buttonStart(PTC5);
sesa514652 11:1dec05b7d1c1 33 InterruptIn buttonBack(PTB19);
sesa514652 11:1dec05b7d1c1 34 InterruptIn buttonLeft(PTB18);
sesa514652 11:1dec05b7d1c1 35 InterruptIn buttonRight(PTB3);
sesa514652 0:1f799c7cce2b 36
sesa514652 11:1dec05b7d1c1 37 // create an event queue
sesa514652 11:1dec05b7d1c1 38 EventQueue queue; // events are needed to get arround the printf issue
sesa514652 5:9b2c976ca318 39 //rows,cols
sesa514652 0:1f799c7cce2b 40 int sprite[8][5] = {
sesa514652 0:1f799c7cce2b 41 { 0,0,1,0,0 },
sesa514652 0:1f799c7cce2b 42 { 0,1,1,1,0 },
sesa514652 0:1f799c7cce2b 43 { 0,0,1,0,0 },
sesa514652 0:1f799c7cce2b 44 { 0,1,1,1,0 },
sesa514652 0:1f799c7cce2b 45 { 1,1,1,1,1 },
sesa514652 0:1f799c7cce2b 46 { 1,1,1,1,1 },
sesa514652 0:1f799c7cce2b 47 { 1,1,0,1,1 },
sesa514652 0:1f799c7cce2b 48 { 1,1,0,1,1 },
sesa514652 5:9b2c976ca318 49 };
sesa514652 11:1dec05b7d1c1 50 void init_K64F(); // Start K64fBoard
sesa514652 11:1dec05b7d1c1 51
sesa514652 11:1dec05b7d1c1 52 void buttonA_isr(); // Button A interrupt service routine
sesa514652 11:1dec05b7d1c1 53 void buttonB_isr(); // Button B interrupt service routine
sesa514652 11:1dec05b7d1c1 54 void buttonX_isr(); // Button X interrupt service routine
sesa514652 11:1dec05b7d1c1 55 void buttonY_isr(); // Button Y interrupt service routine
sesa514652 11:1dec05b7d1c1 56 void buttonStart_isr(); // Button Start interrupt service routine
sesa514652 11:1dec05b7d1c1 57 void buttonBack_isr(); // Button Back interrupt service routine
sesa514652 11:1dec05b7d1c1 58 void buttonLeft_isr(); // Button Left interrupt service routine
sesa514652 11:1dec05b7d1c1 59 void buttonRight_isr(); // Button Right interrupt service routine
sesa514652 11:1dec05b7d1c1 60 volatile int g_buttonA_flag = 0; // Global Flag
sesa514652 11:1dec05b7d1c1 61 volatile int g_buttonB_flag = 0; // Global Flag
sesa514652 11:1dec05b7d1c1 62 volatile int g_buttonX_flag = 0; // Global Flag
sesa514652 11:1dec05b7d1c1 63 volatile int g_buttonY_flag = 0; // Global Flag
sesa514652 11:1dec05b7d1c1 64 volatile int g_buttonStart_flag = 0; // Global Flag
sesa514652 11:1dec05b7d1c1 65 volatile int g_buttonBack_flag = 0; // Global Flag
sesa514652 11:1dec05b7d1c1 66 volatile int g_buttonLeft_flag = 0; // Global Flag
sesa514652 11:1dec05b7d1c1 67 volatile int g_buttonRight_flag = 0; // Global Flag
sesa514652 18:bb36d96142dd 68 int buttonCountA();
sesa514652 18:bb36d96142dd 69 int buttonCountB();
sesa514652 11:1dec05b7d1c1 70 //volatile int g_buttonA_counter = 0; // Global counter
sesa514652 8:770d168713cc 71 //Test function after research C++ lanuage 05/01/22
sesa514652 4:167ce930c9d5 72 int cube(int num){
sesa514652 11:1dec05b7d1c1 73 return num*num;
sesa514652 5:9b2c976ca318 74 };
sesa514652 10:42e70b596099 75 // Menu Items
sesa514652 10:42e70b596099 76 int page1;
sesa514652 10:42e70b596099 77 int page2;
sesa514652 10:42e70b596099 78 int page3;
sesa514652 10:42e70b596099 79 string Listitem1 = "Game"; // guess distance
sesa514652 10:42e70b596099 80 string Listitem2 = "Measure"; // measure distance of object
sesa514652 10:42e70b596099 81 string Listitem3 = "Detect"; // alarm when object is dectected
sesa514652 5:9b2c976ca318 82 N5110 lcd(PTC9,PTC0,PTC7,PTD2,PTD1,PTC11);
sesa514652 9:cdd7d9a123f9 83 /* Test of the interup an operating the buzzer this kills the board
sesa514652 9:cdd7d9a123f9 84 void buzzme(){
sesa514652 9:cdd7d9a123f9 85 Buzzer.play(200,120);
sesa514652 9:cdd7d9a123f9 86 wait_ms(5);
sesa514652 9:cdd7d9a123f9 87 Buzzer.play(200,120);;
sesa514652 9:cdd7d9a123f9 88 }
sesa514652 9:cdd7d9a123f9 89 */
sesa514652 11:1dec05b7d1c1 90 void printme(){
sesa514652 9:cdd7d9a123f9 91
sesa514652 11:1dec05b7d1c1 92 volatile double x ;
sesa514652 11:1dec05b7d1c1 93 x = 1;
sesa514652 10:42e70b596099 94 printf("%f\n",x);
sesa514652 11:1dec05b7d1c1 95 // return 0;
sesa514652 9:cdd7d9a123f9 96 }
sesa514652 10:42e70b596099 97
sesa514652 10:42e70b596099 98
sesa514652 10:42e70b596099 99 //void returnme(){
sesa514652 10:42e70b596099 100 //int num;
sesa514652 10:42e70b596099 101 // return num*num;
sesa514652 10:42e70b596099 102 // };
sesa514652 0:1f799c7cce2b 103 int main() {
sesa514652 18:bb36d96142dd 104 //initialise Joystick
sesa514652 5:9b2c976ca318 105 joystick.init();
sesa514652 5:9b2c976ca318 106
sesa514652 11:1dec05b7d1c1 107 // create a thread that'll run the event queue's dispatch function
sesa514652 11:1dec05b7d1c1 108 Thread eventThread;
sesa514652 11:1dec05b7d1c1 109 eventThread.start(callback(&queue, &EventQueue::dispatch_forever));
sesa514652 11:1dec05b7d1c1 110
sesa514652 11:1dec05b7d1c1 111 buttonA.rise(queue.event(&buttonA_isr)); // This is used to call the function putting it in queue allowing the screen toupdat no muxt error
sesa514652 11:1dec05b7d1c1 112 buttonB.rise(queue.event(&buttonB_isr));
sesa514652 11:1dec05b7d1c1 113 buttonX.rise(queue.event(&buttonX_isr));
sesa514652 11:1dec05b7d1c1 114 buttonY.rise(queue.event(&buttonY_isr));
sesa514652 11:1dec05b7d1c1 115 buttonStart.rise(queue.event(&buttonStart_isr)); // This is used to call the function putting it in queue allowing the screen toupdat no muxt error
sesa514652 11:1dec05b7d1c1 116 buttonBack.rise(queue.event(&buttonBack_isr));
sesa514652 11:1dec05b7d1c1 117 buttonLeft.rise(queue.event(&buttonLeft_isr));
sesa514652 11:1dec05b7d1c1 118 buttonRight.rise(queue.event(&buttonRight_isr));
sesa514652 5:9b2c976ca318 119 //first need to initialise display
sesa514652 5:9b2c976ca318 120 lcd.init();
sesa514652 8:770d168713cc 121
sesa514652 12:ceea378d5691 122 // Button A is connected between the pin and 3.3 V, we therefore need to turn on the internal pull-down resister
sesa514652 8:770d168713cc 123 buttonA.mode(PullDown);
sesa514652 10:42e70b596099 124 // Button B is connected between the pin and 3.3 V, we therefore need to turn on the internal pull-down resister
sesa514652 10:42e70b596099 125 buttonB.mode(PullDown);
sesa514652 10:42e70b596099 126 // Button X is connected between the pin and 3.3 V, we therefore need to turn on the internal pull-down resister
sesa514652 10:42e70b596099 127 buttonX.mode(PullDown);
sesa514652 10:42e70b596099 128 // Button Y is connected between the pin and 3.3 V, we therefore need to turn on the internal pull-down resister
sesa514652 10:42e70b596099 129 buttonY.mode(PullDown);
sesa514652 11:1dec05b7d1c1 130 // Button Start is connected between the pin and 3.3 V, we therefore need to turn on the internal pull-down resister
sesa514652 11:1dec05b7d1c1 131 buttonStart.mode(PullDown);
sesa514652 11:1dec05b7d1c1 132 // Button Back is connected between the pin and 3.3 V, we therefore need to turn on the internal pull-down resister
sesa514652 11:1dec05b7d1c1 133 buttonBack.mode(PullDown);
sesa514652 11:1dec05b7d1c1 134 // Button Left is connected between the pin and 3.3 V, we therefore need to turn on the internal pull-down resister
sesa514652 11:1dec05b7d1c1 135 buttonLeft.mode(PullDown);
sesa514652 11:1dec05b7d1c1 136 // Button Right is connected between the pin and 3.3 V, we therefore need to turn on the internal pull-down resister
sesa514652 11:1dec05b7d1c1 137 buttonRight.mode(PullDown);
sesa514652 8:770d168713cc 138
sesa514652 18:bb36d96142dd 139
sesa514652 8:770d168713cc 140
sesa514652 8:770d168713cc 141
sesa514652 5:9b2c976ca318 142
sesa514652 5:9b2c976ca318 143 //change set contrast in range 0.0 to 1.0
sesa514652 5:9b2c976ca318 144 //0.5 appears to be a good starting point
sesa514652 5:9b2c976ca318 145 lcd.setContrast(0.5);
sesa514652 5:9b2c976ca318 146
sesa514652 5:9b2c976ca318 147 //Buzzer.period(10.0f);
sesa514652 5:9b2c976ca318 148 //Buzzer.pulsewidth(1);
sesa514652 6:f7f30e0e3bed 149 //Test Struct after research 05/01/22
sesa514652 6:f7f30e0e3bed 150 struct ObjectDefine{
sesa514652 7:ce70a873aa70 151 int qwer;
sesa514652 6:f7f30e0e3bed 152 float Distance;
sesa514652 7:ce70a873aa70 153 char te;
sesa514652 7:ce70a873aa70 154 double dubs;
sesa514652 7:ce70a873aa70 155 string namestruct;
sesa514652 8:770d168713cc 156 // string ;
sesa514652 6:f7f30e0e3bed 157 };
sesa514652 7:ce70a873aa70 158 // Test Class 06/01/22
sesa514652 10:42e70b596099 159 class myClass{
sesa514652 7:ce70a873aa70 160 public:
sesa514652 7:ce70a873aa70 161 string nameclass ;
sesa514652 7:ce70a873aa70 162 double dubss;
sesa514652 7:ce70a873aa70 163 int inty;
sesa514652 7:ce70a873aa70 164 };
sesa514652 7:ce70a873aa70 165 myClass Class1;
sesa514652 7:ce70a873aa70 166 Class1.nameclass ="firstclass";
sesa514652 10:42e70b596099 167 ObjectDefine Object1;
sesa514652 10:42e70b596099 168 Object1.qwer = 12;
sesa514652 6:f7f30e0e3bed 169 Object1.Distance = 34;
sesa514652 7:ce70a873aa70 170 Object1.te = 'A';
sesa514652 7:ce70a873aa70 171 Object1.dubs = 23;
sesa514652 10:42e70b596099 172 Object1.namestruct = "name";
sesa514652 18:bb36d96142dd 173
sesa514652 0:1f799c7cce2b 174 while(1) {
sesa514652 22:82b01fdfc61f 175 // section to try to get POC of number comparitor without using the US for repeatablity// to get if statements correct possibly change to switch
sesa514652 22:82b01fdfc61f 176 int num1;
sesa514652 22:82b01fdfc61f 177 int num2;
sesa514652 22:82b01fdfc61f 178 int num3;
sesa514652 22:82b01fdfc61f 179 int num4;
sesa514652 22:82b01fdfc61f 180 cout << "Test value collection";
sesa514652 22:82b01fdfc61f 181 cin >> num1;
sesa514652 22:82b01fdfc61f 182 cin >> num2;
sesa514652 22:82b01fdfc61f 183 cin >> num3;
sesa514652 22:82b01fdfc61f 184 cin >> num4;
sesa514652 22:82b01fdfc61f 185 cout << num1;
sesa514652 22:82b01fdfc61f 186 if (num1 >num2){
sesa514652 22:82b01fdfc61f 187 cout <<'x';
sesa514652 22:82b01fdfc61f 188 }else {
sesa514652 22:82b01fdfc61f 189 cout <<'-';}
sesa514652 22:82b01fdfc61f 190 if (num2 >num3){
sesa514652 22:82b01fdfc61f 191 cout <<'x';
sesa514652 22:82b01fdfc61f 192 }else {
sesa514652 22:82b01fdfc61f 193 cout <<'-';}
sesa514652 22:82b01fdfc61f 194 if (num3 >num4){
sesa514652 22:82b01fdfc61f 195 cout <<'x';
sesa514652 22:82b01fdfc61f 196 }else {
sesa514652 22:82b01fdfc61f 197 cout <<'-';}
sesa514652 21:2e37f80e8b5b 198
sesa514652 22:82b01fdfc61f 199 /////////////////////////////////////////////////////////////////
sesa514652 20:4e1f2917a857 200 switch(PressA){
sesa514652 21:2e37f80e8b5b 201 default:
sesa514652 21:2e37f80e8b5b 202 lcd.clear();
sesa514652 21:2e37f80e8b5b 203 lcd.printString("Main Menu",0,0);
sesa514652 21:2e37f80e8b5b 204 lcd.drawLine(0,10,80,10,2);
sesa514652 21:2e37f80e8b5b 205
sesa514652 21:2e37f80e8b5b 206 lcd.printString("A to begin new Scan",0,2);
sesa514652 21:2e37f80e8b5b 207 lcd.printString("B to Display last object",0,3);
sesa514652 21:2e37f80e8b5b 208 lcd.refresh();
sesa514652 21:2e37f80e8b5b 209 wait_ms(50);
sesa514652 21:2e37f80e8b5b 210
sesa514652 21:2e37f80e8b5b 211 break;
sesa514652 22:82b01fdfc61f 212 //////////////////////////////////////////////////////////////////////////////////////////////////
sesa514652 21:2e37f80e8b5b 213 case 1:
sesa514652 21:2e37f80e8b5b 214 PressA =1;
sesa514652 21:2e37f80e8b5b 215 lcd.clear();
sesa514652 21:2e37f80e8b5b 216 long firstScan[10];
sesa514652 21:2e37f80e8b5b 217 lcd.printString("First Scan Left Right",0,0);
sesa514652 21:2e37f80e8b5b 218 lcd.refresh();
sesa514652 21:2e37f80e8b5b 219 for (int i = 0; i < 5; i++) {
sesa514652 21:2e37f80e8b5b 220 printf(" i is: %d cm",i);
sesa514652 21:2e37f80e8b5b 221 }
sesa514652 20:4e1f2917a857 222 wait_ms(50); // required to stop Black screen issue
sesa514652 20:4e1f2917a857 223 break;
sesa514652 22:82b01fdfc61f 224 ////////////////////////////////////////////////////////////////////////////
sesa514652 20:4e1f2917a857 225 case 2:
sesa514652 20:4e1f2917a857 226 PressA= 2;
sesa514652 22:82b01fdfc61f 227 long secondScan[10];
sesa514652 22:82b01fdfc61f 228
sesa514652 22:82b01fdfc61f 229 secondScan[5] = sensor.distance();
sesa514652 22:82b01fdfc61f 230 printf("Distance : %d cm", secondScan[5]);
sesa514652 22:82b01fdfc61f 231 lcd.clear();
sesa514652 22:82b01fdfc61f 232 lcd.printString("2nd Scan up down",0,0);
sesa514652 22:82b01fdfc61f 233 lcd.drawLine(0,10,80,10,2);
sesa514652 20:4e1f2917a857 234 break;
sesa514652 22:82b01fdfc61f 235
sesa514652 22:82b01fdfc61f 236 ////////////////////////////////////////////////////////////////////
sesa514652 20:4e1f2917a857 237 case 3:
sesa514652 20:4e1f2917a857 238 PressA= 3;
sesa514652 20:4e1f2917a857 239 lcd.clear();
sesa514652 20:4e1f2917a857 240 lcd.printString("Menu 3",0,0);
sesa514652 21:2e37f80e8b5b 241 long us = sensor.distance();
sesa514652 21:2e37f80e8b5b 242 printf("Distance : %d cm",us);
sesa514652 20:4e1f2917a857 243 lcd.refresh();
sesa514652 20:4e1f2917a857 244 wait_ms(50); //required to stop Black screen issue
sesa514652 20:4e1f2917a857 245 break;
sesa514652 20:4e1f2917a857 246 }
sesa514652 20:4e1f2917a857 247
sesa514652 20:4e1f2917a857 248 }
sesa514652 20:4e1f2917a857 249 }
sesa514652 20:4e1f2917a857 250 /*
sesa514652 11:1dec05b7d1c1 251 int button_counter;
sesa514652 10:42e70b596099 252 if (g_buttonA_flag){
sesa514652 11:1dec05b7d1c1 253 button_counter = button_counter +1;
sesa514652 11:1dec05b7d1c1 254 //case (test)
sesa514652 10:42e70b596099 255 g_buttonA_flag = 0; // if it has, clear the flag
sesa514652 10:42e70b596099 256
sesa514652 10:42e70b596099 257 // send message over serial port - can observe in CoolTerm etc.
sesa514652 11:1dec05b7d1c1 258 printf("Button A pressed %f\n", button_counter);
sesa514652 10:42e70b596099 259 }
sesa514652 10:42e70b596099 260 if (g_buttonB_flag){
sesa514652 10:42e70b596099 261 g_buttonB_flag = 0; // if it has, clear the flag
sesa514652 8:770d168713cc 262
sesa514652 10:42e70b596099 263 // send message over serial port - can observe in CoolTerm etc.
sesa514652 10:42e70b596099 264 printf("Button B pressed\n");
sesa514652 10:42e70b596099 265 }
sesa514652 10:42e70b596099 266 if (g_buttonX_flag){
sesa514652 10:42e70b596099 267 g_buttonX_flag = 0; // if it has, clear the flag
sesa514652 12:ceea378d5691 268 // swap direction when button has been pressed
sesa514652 12:ceea378d5691 269 // (could just use ! but want this to be explicit to aid understanding)
sesa514652 12:ceea378d5691 270 if (direction == UP) {
sesa514652 12:ceea378d5691 271 direction = DOWN;
sesa514652 12:ceea378d5691 272 }
sesa514652 12:ceea378d5691 273 else {
sesa514652 12:ceea378d5691 274 direction = UP;
sesa514652 12:ceea378d5691 275 }
sesa514652 10:42e70b596099 276
sesa514652 10:42e70b596099 277 // send message over serial port - can observe in CoolTerm etc.
sesa514652 10:42e70b596099 278 printf("Button X pressed\n");
sesa514652 10:42e70b596099 279 lcd.clear();
sesa514652 10:42e70b596099 280 lcd.printString("Button Pressed!",0,0);
sesa514652 10:42e70b596099 281 lcd.refresh();
sesa514652 11:1dec05b7d1c1 282 wait(1);
sesa514652 10:42e70b596099 283 }
sesa514652 10:42e70b596099 284 if (g_buttonY_flag){
sesa514652 10:42e70b596099 285 g_buttonY_flag = 0; // if it has, clear the flag
sesa514652 10:42e70b596099 286
sesa514652 10:42e70b596099 287 // send message over serial port - can observe in CoolTerm etc.
sesa514652 10:42e70b596099 288 printf("Button Y pressed\n");
sesa514652 10:42e70b596099 289 }
sesa514652 5:9b2c976ca318 290 Buzzer.play(200,120);
sesa514652 5:9b2c976ca318 291 wait_ms(5);
sesa514652 5:9b2c976ca318 292 Buzzer.play(200,120);
sesa514652 1:757728321abd 293 long distanced = sensor.distance();
sesa514652 1:757728321abd 294 if (distanced >= 400 || distanced <= 2)
sesa514652 5:9b2c976ca318 295 {
sesa514652 1:757728321abd 296 printf("Out of range");
sesa514652 5:9b2c976ca318 297 //Calling dummy function 05/01/22
sesa514652 4:167ce930c9d5 298 int answer = cube(2);
sesa514652 5:9b2c976ca318 299 printf("%f\n",answer);
sesa514652 1:757728321abd 300 wait(1.0);
sesa514652 5:9b2c976ca318 301 }
sesa514652 5:9b2c976ca318 302 else
sesa514652 5:9b2c976ca318 303 {
sesa514652 5:9b2c976ca318 304 printf("Distance : %d cm",distanced);
sesa514652 5:9b2c976ca318 305 wait(1.0); // 1 sec
sesa514652 1:757728321abd 306 }
sesa514652 5:9b2c976ca318 307 lcd.drawCircle(WIDTH/2,HEIGHT/2,distanced,FILL_BLACK);
sesa514652 5:9b2c976ca318 308 //lcd.refresh must be used to update the lcd Display
sesa514652 5:9b2c976ca318 309 lcd.refresh();
sesa514652 5:9b2c976ca318 310 wait(5.0);
sesa514652 5:9b2c976ca318 311 //these are default settings so not strictly needed
sesa514652 0:1f799c7cce2b 312 lcd.normalMode(); // normal colour mode
sesa514652 5:9b2c976ca318 313 lcd.setBrightness(0.5); // put LED backlight on 50%
sesa514652 0:1f799c7cce2b 314 lcd.clear();
sesa514652 0:1f799c7cce2b 315 lcd.printString("Hello, World!",0,0);
sesa514652 0:1f799c7cce2b 316 Vector2D coord = joystick.get_coord();
sesa514652 0:1f799c7cce2b 317 lcd.refresh();
sesa514652 0:1f799c7cce2b 318 printf("Coord = %f,%f\n",coord.x,coord.y);
sesa514652 0:1f799c7cce2b 319 char buffer[14];
sesa514652 0:1f799c7cce2b 320 Vector2D mapped_coord = joystick.get_mapped_coord();
sesa514652 0:1f799c7cce2b 321 printf("Mapped coord = %f,%f\n",mapped_coord.x,mapped_coord.y);
sesa514652 0:1f799c7cce2b 322
sesa514652 5:9b2c976ca318 323 int length = sprintf(buffer,"T = %2f",coord.x);
sesa514652 5:9b2c976ca318 324 //it is important the format specifier ensures the length will fit in the buffer
sesa514652 0:1f799c7cce2b 325 if (length <= 14) // if string will fit on display (assuming printing at x=0)
sesa514652 5:9b2c976ca318 326 lcd.printString(buffer,0,1); // display on screen
sesa514652 0:1f799c7cce2b 327 lcd.refresh();
sesa514652 5:9b2c976ca318 328 lcd.clear();
sesa514652 5:9b2c976ca318 329 //times by 50 to try get the point moving across screen
sesa514652 0:1f799c7cce2b 330 float x50 = mapped_coord.x*5;
sesa514652 0:1f799c7cce2b 331 float y50 = mapped_coord.y*8;
sesa514652 5:9b2c976ca318 332 //to see what the values are
sesa514652 5:9b2c976ca318 333 printf(" *50 = %f,%f\n",x50,y50);
sesa514652 5:9b2c976ca318 334 //example of how to draw circles
sesa514652 1:757728321abd 335 lcd.printChar('o',WIDTH/2,HEIGHT/2);
sesa514652 5:9b2c976ca318 336 lcd.refresh();
sesa514652 0:1f799c7cce2b 337 float mag = joystick.get_mag();
sesa514652 0:1f799c7cce2b 338 float angle = joystick.get_angle();
sesa514652 0:1f799c7cce2b 339 printf("Mag = %f Angle = %f\n",mag,angle);
sesa514652 0:1f799c7cce2b 340 Direction d = joystick.get_direction();
sesa514652 0:1f799c7cce2b 341 printf("Direction = %i\n",d);
sesa514652 0:1f799c7cce2b 342 if (joystick.button_pressed() ) {
sesa514652 0:1f799c7cce2b 343 printf("Button Pressed\n");
sesa514652 9:cdd7d9a123f9 344 wait(5);
sesa514652 0:1f799c7cce2b 345 }
sesa514652 8:770d168713cc 346
sesa514652 8:770d168713cc 347 }
sesa514652 16:2646c1c4e62e 348 }
sesa514652 20:4e1f2917a857 349 */
sesa514652 18:bb36d96142dd 350
sesa514652 18:bb36d96142dd 351
sesa514652 18:bb36d96142dd 352 int buttonCountA(){
sesa514652 18:bb36d96142dd 353 PressA++;
sesa514652 18:bb36d96142dd 354 if (PressA>3){
sesa514652 18:bb36d96142dd 355 PressA= 0;
sesa514652 18:bb36d96142dd 356 }
sesa514652 18:bb36d96142dd 357 return PressA;
sesa514652 18:bb36d96142dd 358 }
sesa514652 18:bb36d96142dd 359 int buttonCountB(){
sesa514652 18:bb36d96142dd 360 PressB++;
sesa514652 18:bb36d96142dd 361 if (PressB>3){
sesa514652 18:bb36d96142dd 362 PressB= 0;
sesa514652 18:bb36d96142dd 363 }
sesa514652 18:bb36d96142dd 364 return PressB;
sesa514652 18:bb36d96142dd 365 }
sesa514652 15:234321e80678 366
sesa514652 12:ceea378d5691 367 //Button A event-triggered interrupt
sesa514652 10:42e70b596099 368 void buttonA_isr()
sesa514652 10:42e70b596099 369 {
sesa514652 12:ceea378d5691 370
sesa514652 18:bb36d96142dd 371 long distanced = sensor.distance();
sesa514652 18:bb36d96142dd 372 buttonCountA();
sesa514652 18:bb36d96142dd 373
sesa514652 16:2646c1c4e62e 374
sesa514652 12:ceea378d5691 375
sesa514652 12:ceea378d5691 376 g_buttonA_flag = 1; // set flag in ISR
sesa514652 12:ceea378d5691 377
sesa514652 18:bb36d96142dd 378 printf("press count = %i\n",PressA);
sesa514652 12:ceea378d5691 379
sesa514652 12:ceea378d5691 380 // lcd.clear();
sesa514652 15:234321e80678 381 //lcd.printString("Button A Pressed",0,0);
sesa514652 12:ceea378d5691 382
sesa514652 15:234321e80678 383 // lcd.refresh(); // set flag in ISR
sesa514652 12:ceea378d5691 384 }
sesa514652 12:ceea378d5691 385
sesa514652 11:1dec05b7d1c1 386
sesa514652 10:42e70b596099 387 //Button B event-triggered interrupt
sesa514652 10:42e70b596099 388 void buttonB_isr()
sesa514652 10:42e70b596099 389 {
sesa514652 18:bb36d96142dd 390 buttonCountB();
sesa514652 10:42e70b596099 391 g_buttonB_flag = 1; // set flag in ISR
sesa514652 11:1dec05b7d1c1 392 lcd.clear();
sesa514652 11:1dec05b7d1c1 393 lcd.printString("Button B Pressed",0,0);
sesa514652 11:1dec05b7d1c1 394 lcd.refresh(); // set flag in ISR
sesa514652 18:bb36d96142dd 395 printf("press count = %i\n",PressB);
sesa514652 10:42e70b596099 396 }
sesa514652 10:42e70b596099 397 //Button X event-triggered interrupt
sesa514652 10:42e70b596099 398 void buttonX_isr()
sesa514652 10:42e70b596099 399 {
sesa514652 10:42e70b596099 400 g_buttonX_flag = 1; // set flag in ISR
sesa514652 11:1dec05b7d1c1 401 lcd.clear();
sesa514652 11:1dec05b7d1c1 402 lcd.printString("Button X Pressed",0,0);
sesa514652 11:1dec05b7d1c1 403 lcd.refresh(); // set flag in ISR
sesa514652 10:42e70b596099 404 }
sesa514652 10:42e70b596099 405 //Button Y event-triggered interrupt
sesa514652 10:42e70b596099 406 void buttonY_isr()
sesa514652 10:42e70b596099 407 {
sesa514652 10:42e70b596099 408 g_buttonY_flag = 1; // set flag in ISR
sesa514652 11:1dec05b7d1c1 409 lcd.clear();
sesa514652 11:1dec05b7d1c1 410 lcd.printString("Button Y Pressed",0,0);
sesa514652 11:1dec05b7d1c1 411 lcd.refresh(); // set flag in ISR
sesa514652 10:42e70b596099 412 }
sesa514652 11:1dec05b7d1c1 413 //Button Start event-triggered interrupt
sesa514652 11:1dec05b7d1c1 414 void buttonStart_isr()
sesa514652 11:1dec05b7d1c1 415 {
sesa514652 11:1dec05b7d1c1 416 g_buttonStart_flag = 1; // set flag in ISR
sesa514652 11:1dec05b7d1c1 417 lcd.clear();
sesa514652 11:1dec05b7d1c1 418 lcd.printString("Button Start Pressed",0,0);
sesa514652 11:1dec05b7d1c1 419 lcd.refresh(); // set flag in ISR
sesa514652 11:1dec05b7d1c1 420 }
sesa514652 11:1dec05b7d1c1 421 //Button Back event-triggered interrupt
sesa514652 11:1dec05b7d1c1 422 void buttonBack_isr()
sesa514652 11:1dec05b7d1c1 423 {
sesa514652 11:1dec05b7d1c1 424 g_buttonBack_flag = 1; // set flag in ISR
sesa514652 11:1dec05b7d1c1 425 lcd.clear();
sesa514652 11:1dec05b7d1c1 426 lcd.printString("Button Back Pressed",0,0);
sesa514652 11:1dec05b7d1c1 427 lcd.refresh(); // set flag in ISR
sesa514652 11:1dec05b7d1c1 428 }
sesa514652 11:1dec05b7d1c1 429 //Button Left event-triggered interrupt
sesa514652 11:1dec05b7d1c1 430 void buttonLeft_isr()
sesa514652 11:1dec05b7d1c1 431 {
sesa514652 11:1dec05b7d1c1 432 g_buttonLeft_flag = 1; // set flag in ISR
sesa514652 11:1dec05b7d1c1 433 lcd.clear();
sesa514652 11:1dec05b7d1c1 434 lcd.printString("Button Left Pressed",0,0);
sesa514652 11:1dec05b7d1c1 435 lcd.refresh(); // set flag in ISR
sesa514652 11:1dec05b7d1c1 436 }
sesa514652 11:1dec05b7d1c1 437 //Button Right event-triggered interrupt
sesa514652 11:1dec05b7d1c1 438 void buttonRight_isr()
sesa514652 11:1dec05b7d1c1 439 {
sesa514652 11:1dec05b7d1c1 440 g_buttonRight_flag = 1; // set flag in ISR
sesa514652 11:1dec05b7d1c1 441 lcd.clear();
sesa514652 11:1dec05b7d1c1 442 lcd.printString("Button Right Pressed",0,0);
sesa514652 11:1dec05b7d1c1 443 lcd.refresh(); // set flag in ISR
sesa514652 11:1dec05b7d1c1 444 }