Edgar Buchanan / Mbed 2 deprecated Programmable_IR_Beacon

Predfined parameters

Dependencies:   mbed

Fork of Programmable_IR_Beacon by James Hilder

main.cpp@1:0c6b12a40074, 2014-09-04 (annotated)

Committer:
edgarbuchanan
Date:
Thu Sep 04 14:28:17 2014 +0000
Revision:
1:0c6b12a40074
Parent:
0:d88fd55a27a6 
Programmamble_IR_Beacon

Who changed what in which revision?

UserRevisionLine numberNew contents of line
jah128 0:d88fd55a27a6 1 /* University of York Robot Lab
jah128 0:d88fd55a27a6 2 *
jah128 0:d88fd55a27a6 3 * Programmable IR Beacon with Display Example Code
jah128 0:d88fd55a27a6 4 *
jah128 0:d88fd55a27a6 5 * This file is intended for use exclusively with the high-power IR Beacon with display
jah128 0:d88fd55a27a6 6 *
jah128 0:d88fd55a27a6 7 *
jah128 0:d88fd55a27a6 8 *
jah128 0:d88fd55a27a6 9 * (C) Dr James Hilder, Dept. Electronics & Computer Science, University of York
jah128 0:d88fd55a27a6 10 *
jah128 0:d88fd55a27a6 11 * March 2014
jah128 0:d88fd55a27a6 12 *
jah128 0:d88fd55a27a6 13 */
jah128 0:d88fd55a27a6 14
jah128 0:d88fd55a27a6 15 #include "mbed.h"
jah128 0:d88fd55a27a6 16 #include "display.h" //Display driver for the Midas 16x2 I2C Display
jah128 0:d88fd55a27a6 17
jah128 0:d88fd55a27a6 18 DigitalIn button1(p23); //"SET" Push-button
jah128 0:d88fd55a27a6 19 DigitalIn button2(p24); //"SELECT" Push-button
jah128 0:d88fd55a27a6 20 PwmOut out_narrow(p21); //PWM Output for the narrow (high intensity) LED driver
jah128 0:d88fd55a27a6 21 PwmOut out_wide(p22); //PWM Output for the wide-angle LED driver
edgarbuchanan 1:0c6b12a40074 22 //DigitalOut out_narrow(p21); //PWM Output for the narrow (high intensity) LED driver
edgarbuchanan 1:0c6b12a40074 23 //DigitalOut out_wide(p22); //PWM Output for the wide-angle LED driver
jah128 0:d88fd55a27a6 24
jah128 0:d88fd55a27a6 25 Display display;
jah128 0:d88fd55a27a6 26 Timer system_timer; //System timer is used for timer the on-off periods for the LEDs
jah128 0:d88fd55a27a6 27 Timer button_timer; //Button timer is used for debouncing the push buttons and pausing for entering 'SET' mode
jah128 0:d88fd55a27a6 28
jah128 0:d88fd55a27a6 29 char adjust = 0;
jah128 0:d88fd55a27a6 30 char mode = 0;
jah128 0:d88fd55a27a6 31 char power = 1;
jah128 0:d88fd55a27a6 32 char duty = 2;
edgarbuchanan 1:0c6b12a40074 33 char frequency = 7;
jah128 0:d88fd55a27a6 34
jah128 0:d88fd55a27a6 35 int on_period;
jah128 0:d88fd55a27a6 36 int off_period;
jah128 0:d88fd55a27a6 37 int total_period;
jah128 0:d88fd55a27a6 38 char phase;
jah128 0:d88fd55a27a6 39
jah128 0:d88fd55a27a6 40 int get_period()
jah128 0:d88fd55a27a6 41 {
jah128 0:d88fd55a27a6 42 switch(frequency) {
jah128 0:d88fd55a27a6 43 case 0:
jah128 0:d88fd55a27a6 44 return 1000000;
jah128 0:d88fd55a27a6 45 case 1:
jah128 0:d88fd55a27a6 46 return 500000;
jah128 0:d88fd55a27a6 47 case 2:
jah128 0:d88fd55a27a6 48 return 200000;
jah128 0:d88fd55a27a6 49 case 3:
jah128 0:d88fd55a27a6 50 return 100000;
jah128 0:d88fd55a27a6 51 case 4:
jah128 0:d88fd55a27a6 52 return 50000;
jah128 0:d88fd55a27a6 53 case 5:
jah128 0:d88fd55a27a6 54 return 33333;
jah128 0:d88fd55a27a6 55 case 6:
jah128 0:d88fd55a27a6 56 return 25000;
jah128 0:d88fd55a27a6 57 case 7:
jah128 0:d88fd55a27a6 58 return 20000;
jah128 0:d88fd55a27a6 59 }
jah128 0:d88fd55a27a6 60 return 0;
jah128 0:d88fd55a27a6 61 }
jah128 0:d88fd55a27a6 62
jah128 0:d88fd55a27a6 63 void update_cycles()
jah128 0:d88fd55a27a6 64 {
jah128 0:d88fd55a27a6 65 total_period = get_period();
jah128 0:d88fd55a27a6 66 switch(duty){
jah128 0:d88fd55a27a6 67 case 0: on_period=total_period/10;break;
jah128 0:d88fd55a27a6 68 case 1: on_period=total_period/4;break;
jah128 0:d88fd55a27a6 69 case 2: on_period=total_period/2;break;
jah128 0:d88fd55a27a6 70 case 3: on_period=(total_period*3)/4;break;
jah128 0:d88fd55a27a6 71 case 4: on_period=total_period-(total_period/10);break;
jah128 0:d88fd55a27a6 72 }
jah128 0:d88fd55a27a6 73 off_period = total_period - on_period;
jah128 0:d88fd55a27a6 74 phase = 0;
jah128 0:d88fd55a27a6 75 system_timer.reset();
jah128 0:d88fd55a27a6 76 }
jah128 0:d88fd55a27a6 77
jah128 0:d88fd55a27a6 78 void init()
jah128 0:d88fd55a27a6 79 {
jah128 0:d88fd55a27a6 80 display.init_display();
jah128 0:d88fd55a27a6 81 display.set_position(0,2);
jah128 0:d88fd55a27a6 82 display.write_string("YORK ROBOTICS",13);
jah128 0:d88fd55a27a6 83 display.set_position(1,3);
jah128 0:d88fd55a27a6 84 display.write_string("LABORATORY",10);
jah128 0:d88fd55a27a6 85 wait(0.45);
jah128 0:d88fd55a27a6 86 display.clear_display();
jah128 0:d88fd55a27a6 87 display.set_position(0,2);
jah128 0:d88fd55a27a6 88 display.write_string("Programmable",12);
jah128 0:d88fd55a27a6 89 display.set_position(1,3);
jah128 0:d88fd55a27a6 90 display.write_string("IR Beacon",9);
jah128 0:d88fd55a27a6 91 wait(0.45);
jah128 0:d88fd55a27a6 92 }
jah128 0:d88fd55a27a6 93
jah128 0:d88fd55a27a6 94 char * mode_string()
jah128 0:d88fd55a27a6 95 {
jah128 0:d88fd55a27a6 96 switch(mode) {
jah128 0:d88fd55a27a6 97 case 1:
jah128 0:d88fd55a27a6 98 return "WIDE ";
jah128 0:d88fd55a27a6 99 case 2:
jah128 0:d88fd55a27a6 100 return "NARROW";
jah128 0:d88fd55a27a6 101 }
jah128 0:d88fd55a27a6 102 return "BOTH ";
jah128 0:d88fd55a27a6 103 }
jah128 0:d88fd55a27a6 104
jah128 0:d88fd55a27a6 105 char * duty_string()
jah128 0:d88fd55a27a6 106 {
jah128 0:d88fd55a27a6 107 switch(duty) {
jah128 0:d88fd55a27a6 108 case 0:
jah128 0:d88fd55a27a6 109 return " 10%";
jah128 0:d88fd55a27a6 110 case 1:
jah128 0:d88fd55a27a6 111 return " 25%";
jah128 0:d88fd55a27a6 112 case 2:
jah128 0:d88fd55a27a6 113 return " 50%";
jah128 0:d88fd55a27a6 114 case 3:
jah128 0:d88fd55a27a6 115 return " 75%";
jah128 0:d88fd55a27a6 116 case 4:
jah128 0:d88fd55a27a6 117 return " 90%";
jah128 0:d88fd55a27a6 118 }
jah128 0:d88fd55a27a6 119 return"???";
jah128 0:d88fd55a27a6 120 }
jah128 0:d88fd55a27a6 121
jah128 0:d88fd55a27a6 122 char * power_string()
jah128 0:d88fd55a27a6 123 {
jah128 0:d88fd55a27a6 124 switch(power) {
jah128 0:d88fd55a27a6 125 case 0:
jah128 0:d88fd55a27a6 126 return " 25%";
jah128 0:d88fd55a27a6 127 case 1:
jah128 0:d88fd55a27a6 128 return " 50%";
jah128 0:d88fd55a27a6 129 case 2:
jah128 0:d88fd55a27a6 130 return " 75%";
jah128 0:d88fd55a27a6 131 case 3:
jah128 0:d88fd55a27a6 132 return "100%";
jah128 0:d88fd55a27a6 133 }
jah128 0:d88fd55a27a6 134 return"????";
jah128 0:d88fd55a27a6 135 }
jah128 0:d88fd55a27a6 136
jah128 0:d88fd55a27a6 137 char * freq_string()
jah128 0:d88fd55a27a6 138 {
jah128 0:d88fd55a27a6 139 switch(frequency) {
jah128 0:d88fd55a27a6 140 case 0:
jah128 0:d88fd55a27a6 141 return " 1Hz";
jah128 0:d88fd55a27a6 142 case 1:
jah128 0:d88fd55a27a6 143 return " 2Hz";
jah128 0:d88fd55a27a6 144 case 2:
jah128 0:d88fd55a27a6 145 return " 5Hz";
jah128 0:d88fd55a27a6 146 case 3:
jah128 0:d88fd55a27a6 147 return "10Hz";
jah128 0:d88fd55a27a6 148 case 4:
jah128 0:d88fd55a27a6 149 return "20Hz";
jah128 0:d88fd55a27a6 150 case 5:
jah128 0:d88fd55a27a6 151 return "30Hz";
jah128 0:d88fd55a27a6 152 case 6:
jah128 0:d88fd55a27a6 153 return "40Hz";
jah128 0:d88fd55a27a6 154 case 7:
jah128 0:d88fd55a27a6 155 return "50Hz";
jah128 0:d88fd55a27a6 156 }
jah128 0:d88fd55a27a6 157 return "????";
jah128 0:d88fd55a27a6 158 }
jah128 0:d88fd55a27a6 159
jah128 0:d88fd55a27a6 160 // The normal mode display output: shows the frequency, power, duty-cycle and output mode (ie wide, narrow or both)
jah128 0:d88fd55a27a6 161 void display_status()
jah128 0:d88fd55a27a6 162 {
jah128 0:d88fd55a27a6 163 display.clear_display();
jah128 0:d88fd55a27a6 164 display.set_position(0,0);
jah128 0:d88fd55a27a6 165 char line1[15] ;
jah128 0:d88fd55a27a6 166 strcpy(line1, "F:");
jah128 0:d88fd55a27a6 167 strcat(line1, freq_string());
jah128 0:d88fd55a27a6 168 strcat(line1, " P:");
jah128 0:d88fd55a27a6 169 strcat(line1, power_string());
jah128 0:d88fd55a27a6 170 display.write_string(line1,13);
jah128 0:d88fd55a27a6 171 char line2[17];
jah128 0:d88fd55a27a6 172 strcpy(line2, "D:");
jah128 0:d88fd55a27a6 173 strcat(line2, duty_string());
jah128 0:d88fd55a27a6 174 strcat(line2, " M:");
jah128 0:d88fd55a27a6 175 strcat(line2, mode_string());
jah128 0:d88fd55a27a6 176 display.set_position(1,0);
jah128 0:d88fd55a27a6 177 display.write_string(line2,16);
jah128 0:d88fd55a27a6 178 }
jah128 0:d88fd55a27a6 179
jah128 0:d88fd55a27a6 180 // The configuration mode; entered by holding the 'set' button for one second. In this mode the user can through the options
jah128 0:d88fd55a27a6 181 // by pressing 'set' and change a setting by pressing 'select'. The final screen in the loop allows the user to return to
jah128 0:d88fd55a27a6 182 // normal operation, this will also happen with no user input for 5 seconds.
jah128 0:d88fd55a27a6 183 void change_settings()
jah128 0:d88fd55a27a6 184 {
jah128 0:d88fd55a27a6 185 //Switch off LEDs whilst in configuration mode
jah128 0:d88fd55a27a6 186 out_wide.pulsewidth_us(0);
jah128 0:d88fd55a27a6 187 out_narrow.pulsewidth_us(0);
jah128 0:d88fd55a27a6 188 display.clear_display();
jah128 0:d88fd55a27a6 189 display.set_position(0,0);
jah128 0:d88fd55a27a6 190 display.write_string("CONFIGURATION",13);
jah128 0:d88fd55a27a6 191 display.set_position(1,0);
jah128 0:d88fd55a27a6 192 display.write_string("MODE",4);
jah128 0:d88fd55a27a6 193 while(button1 == 1);
jah128 0:d88fd55a27a6 194 char screen = 0;
jah128 0:d88fd55a27a6 195 char active = 1;
jah128 0:d88fd55a27a6 196 Timer settings_timer;
jah128 0:d88fd55a27a6 197 settings_timer.start();
jah128 0:d88fd55a27a6 198 while(active) {
jah128 0:d88fd55a27a6 199 display.clear_display();
jah128 0:d88fd55a27a6 200 display.set_position(0,0);
jah128 0:d88fd55a27a6 201 char line2[17];
jah128 0:d88fd55a27a6 202 switch(screen) {
jah128 0:d88fd55a27a6 203 case 0:
jah128 0:d88fd55a27a6 204 display.write_string("Set Frequency:",14);
jah128 0:d88fd55a27a6 205 display.set_position(1,0);
jah128 0:d88fd55a27a6 206 strcpy(line2,freq_string());
jah128 0:d88fd55a27a6 207 display.write_string(line2,4);
jah128 0:d88fd55a27a6 208 break;
jah128 0:d88fd55a27a6 209 case 1:
jah128 0:d88fd55a27a6 210 display.write_string("Set Power: ",14);
jah128 0:d88fd55a27a6 211 display.set_position(1,0);
jah128 0:d88fd55a27a6 212 strcpy(line2,power_string());
jah128 0:d88fd55a27a6 213 display.write_string(line2,4);
jah128 0:d88fd55a27a6 214 break;
jah128 0:d88fd55a27a6 215 case 2:
jah128 0:d88fd55a27a6 216 display.write_string("Set Duty Cycle:",15);
jah128 0:d88fd55a27a6 217 display.set_position(1,0);
jah128 0:d88fd55a27a6 218 strcpy(line2,duty_string());
jah128 0:d88fd55a27a6 219 display.write_string(line2,4);
jah128 0:d88fd55a27a6 220 break;
jah128 0:d88fd55a27a6 221 case 3:
jah128 0:d88fd55a27a6 222 display.write_string("Set Mode: ",14);
jah128 0:d88fd55a27a6 223 display.set_position(1,0);
jah128 0:d88fd55a27a6 224 strcpy(line2,mode_string());
jah128 0:d88fd55a27a6 225 display.write_string(line2,6);
jah128 0:d88fd55a27a6 226 break;
jah128 0:d88fd55a27a6 227 case 4:
jah128 0:d88fd55a27a6 228 display.write_string("End Setup",9);
jah128 0:d88fd55a27a6 229 break;
jah128 0:d88fd55a27a6 230 }
jah128 0:d88fd55a27a6 231 char button_pressed = 0;
jah128 0:d88fd55a27a6 232
jah128 0:d88fd55a27a6 233 while(button_pressed < 2 && settings_timer.read_ms() < 5000){
jah128 0:d88fd55a27a6 234 if(button1 == 1 || button2 == 1){
jah128 0:d88fd55a27a6 235 if(button_pressed == 1){
jah128 0:d88fd55a27a6 236 if(button_timer.read_ms() > 50) button_pressed = 2;
jah128 0:d88fd55a27a6 237 } else {button_pressed = 1; button_timer.reset();}
jah128 0:d88fd55a27a6 238 } else button_pressed = 0;
jah128 0:d88fd55a27a6 239 }
jah128 0:d88fd55a27a6 240 if(button1==1){
jah128 0:d88fd55a27a6 241 screen++;
jah128 0:d88fd55a27a6 242 if(screen == 5)screen=0;
jah128 0:d88fd55a27a6 243 while(button1 == 1);
jah128 0:d88fd55a27a6 244 }else{
jah128 0:d88fd55a27a6 245 if(button2==1){
jah128 0:d88fd55a27a6 246 switch(screen){
jah128 0:d88fd55a27a6 247 case 0: frequency ++;
jah128 0:d88fd55a27a6 248 if(frequency == 8) frequency = 0;
jah128 0:d88fd55a27a6 249 break;
jah128 0:d88fd55a27a6 250 case 1: power++;
jah128 0:d88fd55a27a6 251 if(power == 4) power=0;
jah128 0:d88fd55a27a6 252 break;
jah128 0:d88fd55a27a6 253 case 2: duty++;
jah128 0:d88fd55a27a6 254 if(duty == 5) duty=0;
jah128 0:d88fd55a27a6 255 break;
jah128 0:d88fd55a27a6 256 case 3: mode++;
jah128 0:d88fd55a27a6 257 if(mode == 3) mode = 0;
jah128 0:d88fd55a27a6 258 break;
jah128 0:d88fd55a27a6 259 case 4: active=0; break;
jah128 0:d88fd55a27a6 260 }
jah128 0:d88fd55a27a6 261 while(button2 == 1);
jah128 0:d88fd55a27a6 262 }
jah128 0:d88fd55a27a6 263 }
jah128 0:d88fd55a27a6 264 if(settings_timer > 5000) active=0;
jah128 0:d88fd55a27a6 265 settings_timer.reset();
jah128 0:d88fd55a27a6 266 }
jah128 0:d88fd55a27a6 267 }
jah128 0:d88fd55a27a6 268
jah128 0:d88fd55a27a6 269 int main()
jah128 0:d88fd55a27a6 270 {
jah128 0:d88fd55a27a6 271 init();
jah128 0:d88fd55a27a6 272 display_status();
jah128 0:d88fd55a27a6 273 char b_p = 0;
jah128 0:d88fd55a27a6 274 system_timer.start();
jah128 0:d88fd55a27a6 275 button_timer.start();
jah128 0:d88fd55a27a6 276 update_cycles();
jah128 0:d88fd55a27a6 277 out_narrow.period_us(1000);
jah128 0:d88fd55a27a6 278 out_wide.period_us(1000);
jah128 0:d88fd55a27a6 279 out_narrow.pulsewidth_us(0);
jah128 0:d88fd55a27a6 280 out_wide.pulsewidth_us(0);
jah128 0:d88fd55a27a6 281
jah128 0:d88fd55a27a6 282
jah128 0:d88fd55a27a6 283 while(1) {
jah128 0:d88fd55a27a6 284 if(phase==0){
jah128 0:d88fd55a27a6 285 if(system_timer.read_us() > off_period){
jah128 0:d88fd55a27a6 286 system_timer.reset();
jah128 0:d88fd55a27a6 287 int pw = 250;
jah128 0:d88fd55a27a6 288 if(power==1) pw=500;
jah128 0:d88fd55a27a6 289 if(power==2) pw=750;
jah128 0:d88fd55a27a6 290 if(power==3) pw=1000;
jah128 0:d88fd55a27a6 291 if(mode<2){
jah128 0:d88fd55a27a6 292 out_wide.pulsewidth_us(pw);
jah128 0:d88fd55a27a6 293 }
jah128 0:d88fd55a27a6 294 if(mode!=1){
jah128 0:d88fd55a27a6 295 out_narrow.pulsewidth_us(pw);
jah128 0:d88fd55a27a6 296 }
jah128 0:d88fd55a27a6 297 phase = 1;
jah128 0:d88fd55a27a6 298 }
jah128 0:d88fd55a27a6 299 }else{
jah128 0:d88fd55a27a6 300 if(system_timer.read_us() > on_period){
jah128 0:d88fd55a27a6 301 system_timer.reset();
jah128 0:d88fd55a27a6 302 phase = 0;
jah128 0:d88fd55a27a6 303 out_wide.pulsewidth_us(0);
jah128 0:d88fd55a27a6 304 out_narrow.pulsewidth_us(0);
jah128 0:d88fd55a27a6 305 }
jah128 0:d88fd55a27a6 306 }
jah128 0:d88fd55a27a6 307
jah128 0:d88fd55a27a6 308
jah128 0:d88fd55a27a6 309 if(button1 == 1) {
jah128 0:d88fd55a27a6 310 if(b_p == 0) {
jah128 0:d88fd55a27a6 311 b_p=1;
jah128 0:d88fd55a27a6 312 button_timer.reset();
jah128 0:d88fd55a27a6 313 }
jah128 0:d88fd55a27a6 314 if(b_p == 1) {
jah128 0:d88fd55a27a6 315 if(button_timer.read_ms() > 100) {
jah128 0:d88fd55a27a6 316 b_p=2;
jah128 0:d88fd55a27a6 317 display.clear_display();
jah128 0:d88fd55a27a6 318 display.set_position(0,0);
jah128 0:d88fd55a27a6 319 display.write_string("Hold to change",14);
jah128 0:d88fd55a27a6 320 display.set_position(1,0);
jah128 0:d88fd55a27a6 321 display.write_string("settings",8);
jah128 0:d88fd55a27a6 322 }
jah128 0:d88fd55a27a6 323 }
jah128 0:d88fd55a27a6 324 if(b_p == 2) {
jah128 0:d88fd55a27a6 325 if(button_timer.read_ms() > 1000) {
jah128 0:d88fd55a27a6 326 change_settings();
jah128 0:d88fd55a27a6 327 update_cycles();
jah128 0:d88fd55a27a6 328 display_status();
jah128 0:d88fd55a27a6 329 b_p=0;
jah128 0:d88fd55a27a6 330 }
jah128 0:d88fd55a27a6 331 }
jah128 0:d88fd55a27a6 332 } else {
jah128 0:d88fd55a27a6 333 if (b_p > 0) {
jah128 0:d88fd55a27a6 334 if(b_p == 2) display_status();
jah128 0:d88fd55a27a6 335 b_p=0;
jah128 0:d88fd55a27a6 336 }
jah128 0:d88fd55a27a6 337 }
jah128 0:d88fd55a27a6 338 }
jah128 0:d88fd55a27a6 339 }