Jason Chang / Mbed OS 9v1

Add I2CSlave to ov580 master.

Dependencies:   MorseGenerator2

main.cpp@22:d1b0a16d8d03, 2019-04-03 (annotated)

Committer:
claytonk
Date:
Wed Apr 03 21:11:41 2019 +0000
Revision:
22:d1b0a16d8d03
Parent:
21:eb8cbbb18958
Child:
24:8664847e79d2
updated to add morse generator

Who changed what in which revision?

UserRevisionLine numberNew contents of line
claytonk 7:9c77eaad5102 1 #define TWIS1_ENABLED 1
claytonk 7:9c77eaad5102 2 #define TWIS0_ENABLED 0
claytonk 7:9c77eaad5102 3 #define TWIS_ENABLED 1
claytonk 7:9c77eaad5102 4 #define TWI0_ENABLED 1
claytonk 7:9c77eaad5102 5 #define TWI1_ENABLED 0
claytonk 7:9c77eaad5102 6 #define TWI0_USE_EASY_DMA 1
claytonk 7:9c77eaad5102 7 #define TWI1_USE_EASY_DMA 1
claytonk 7:9c77eaad5102 8 #define TWI_DEFAULT_CONFIG_FREQUENCY 104857600
claytonk 7:9c77eaad5102 9 #define ARDUINO_A4_PIN 14
claytonk 7:9c77eaad5102 10 #define ARDUINO_A5_PIN 15
claytonk 7:9c77eaad5102 11
claytonk 7:9c77eaad5102 12
claytonk 0:605fe136b7ea 13 #include "mbed.h"
claytonk 22:d1b0a16d8d03 14 #include "MorseGenerator.h"
claytonk 7:9c77eaad5102 15 //#include <nrfx_config.h> need SDK config instead
claytonk 7:9c77eaad5102 16 //#include "sdk_config.h" not needed now
claytonk 0:605fe136b7ea 17
claytonk 0:605fe136b7ea 18 /*
claytonk 0:605fe136b7ea 19 FEATURE REQUIREMENTS
claytonk 0:605fe136b7ea 20
claytonk 3:6b14862f5f51 21 - I2C write occurs on falling edge of strobe pulse to prevent unknown states
claytonk 3:6b14862f5f51 22
claytonk 3:6b14862f5f51 23 - Stack check occurs on leading edge of strobe pulse to ensure strobes are
claytonk 3:6b14862f5f51 24 set correctly
claytonk 0:605fe136b7ea 25
claytonk 3:6b14862f5f51 26 - Reoccuring enable from app that will prevent the emitters from remaining
claytonk 3:6b14862f5f51 27 on if the app crashes and a turn off command isn't sent
claytonk 0:605fe136b7ea 28 - Can be a counter on the emitter enable > threshold
claytonk 3:6b14862f5f51 29 - Better if it's a counter based on reads from the fault register
claytonk 0:605fe136b7ea 30
claytonk 9:69e0bbfdb62b 31 -Flood/Dot tagging indicated on GPIO3 / PWM0
claytonk 0:605fe136b7ea 32 - 0 Flood
claytonk 0:605fe136b7ea 33 - 1 DOT
claytonk 0:605fe136b7ea 34
claytonk 9:69e0bbfdb62b 35 -Fault indication on GPIO4 / PWM1 to indicate to app to reboot
claytonk 0:605fe136b7ea 36 - 0 OK
claytonk 0:605fe136b7ea 37 - 1 Fault/Reboot
claytonk 0:605fe136b7ea 38
claytonk 0:605fe136b7ea 39 I2C write commands
claytonk 0:605fe136b7ea 40 Reg: Information Condition
claytonk 4:fc0c93cb0197 41 0x0000 Emitter enable 0x00 Emitters off
claytonk 0:605fe136b7ea 42 0x01 Dot on
claytonk 0:605fe136b7ea 43 0x10 Flood on
claytonk 0:605fe136b7ea 44 0x11 Flood / Dot on
claytonk 0:605fe136b7ea 45
claytonk 4:fc0c93cb0197 46 0x0001 Dot fault Read from LM36011
claytonk 0:605fe136b7ea 47
claytonk 4:fc0c93cb0197 48 0x0002 Dot Current 0x00 - level_dot_max
claytonk 3:6b14862f5f51 49
claytonk 4:fc0c93cb0197 50 0x0003 Flood Fault Read from LM36011
claytonk 3:6b14862f5f51 51
claytonk 4:fc0c93cb0197 52 0x0004 Flood Current 0x00 - level_flood_max
claytonk 0:605fe136b7ea 53
claytonk 4:fc0c93cb0197 54 0x0005 Fault register bit[0] KILL_VCSEL fault
claytonk 3:6b14862f5f51 55 bit[1] dot fault
claytonk 3:6b14862f5f51 56 bit[2] flood fault
claytonk 3:6b14862f5f51 57 bit[3] unstacked fault
claytonk 3:6b14862f5f51 58 bit[4] ?not in app fault?
claytonk 3:6b14862f5f51 59 bit[5-7] unused
claytonk 3:6b14862f5f51 60
claytonk 3:6b14862f5f51 61
claytonk 4:fc0c93cb0197 62 0x0006 Version number 0x70 = version 7.0
claytonk 0:605fe136b7ea 63
claytonk 13:2b83989d136c 64 */
claytonk 9:69e0bbfdb62b 65 /* ERROR CHECKING */
claytonk 0:605fe136b7ea 66
claytonk 7:9c77eaad5102 67 #if (TWIS0_ENABLED == 1)
claytonk 7:9c77eaad5102 68 #error TWIS0 is congigured wrong
claytonk 7:9c77eaad5102 69 #endif
claytonk 7:9c77eaad5102 70
claytonk 7:9c77eaad5102 71 #if (TWIS1_ENABLED == 0)
claytonk 7:9c77eaad5102 72 #error TWIS1 is off
claytonk 7:9c77eaad5102 73 #endif
claytonk 6:85d9ad912c14 74
claytonk 7:9c77eaad5102 75 #if (TWIS_ENABLED == 0)
claytonk 7:9c77eaad5102 76 #error TWIS is off
claytonk 7:9c77eaad5102 77 #endif
claytonk 6:85d9ad912c14 78
claytonk 7:9c77eaad5102 79 #if (TWI0_ENABLED == 0)
claytonk 7:9c77eaad5102 80 #error TWI0 is off
claytonk 7:9c77eaad5102 81 #endif
claytonk 7:9c77eaad5102 82
claytonk 7:9c77eaad5102 83 #if (TWI1_ENABLED == 1)
claytonk 7:9c77eaad5102 84 #error TWI1 is congigured wrong
claytonk 7:9c77eaad5102 85 #endif
claytonk 6:85d9ad912c14 86
claytonk 3:6b14862f5f51 87 /* DEFINES */
claytonk 3:6b14862f5f51 88
claytonk 22:d1b0a16d8d03 89 static string version_number = "9";
claytonk 3:6b14862f5f51 90
claytonk 13:2b83989d136c 91
claytonk 13:2b83989d136c 92
claytonk 0:605fe136b7ea 93 // define pins for I2C
claytonk 0:605fe136b7ea 94 #define dot_sda p2
claytonk 0:605fe136b7ea 95 #define dot_scl p4
claytonk 0:605fe136b7ea 96 #define flood_sda p28
claytonk 0:605fe136b7ea 97 #define flood_scl p3
claytonk 0:605fe136b7ea 98 #define ov580_sda p30
claytonk 0:605fe136b7ea 99 #define ov580_scl p31
claytonk 3:6b14862f5f51 100
claytonk 3:6b14862f5f51 101 // define strobe pins
claytonk 9:69e0bbfdb62b 102 #define strobe_flood p23 // strobe0
claytonk 9:69e0bbfdb62b 103 #define strobe_dot p24 // strobe1
claytonk 3:6b14862f5f51 104
claytonk 3:6b14862f5f51 105 // define pmw pins
claytonk 0:605fe136b7ea 106 #define pwm_1_pin p29
claytonk 0:605fe136b7ea 107 #define pwm_0_pin p5
claytonk 0:605fe136b7ea 108
claytonk 13:2b83989d136c 109 // define stacked irq pin
claytonk 13:2b83989d136c 110 #define stacked_irq_pin p11
claytonk 13:2b83989d136c 111
claytonk 13:2b83989d136c 112 // define silego enable pin
claytonk 13:2b83989d136c 113 #define silego_en_pin p26 // needs to be pulled high for Silego
claytonk 13:2b83989d136c 114
claytonk 13:2b83989d136c 115 // define dot/flood status pin
claytonk 13:2b83989d136c 116 #define dot_flood_status_pin p27
claytonk 13:2b83989d136c 117
claytonk 13:2b83989d136c 118 // define VCSEL Fault
claytonk 13:2b83989d136c 119 #define vcselFault_pin p25
claytonk 13:2b83989d136c 120
claytonk 0:605fe136b7ea 121 // define LED pins
claytonk 13:2b83989d136c 122 #define ledRed_pin p12
claytonk 13:2b83989d136c 123 #define ledGreen_pin p17
claytonk 13:2b83989d136c 124 #define ledBlue_pin p13
claytonk 13:2b83989d136c 125
claytonk 13:2b83989d136c 126
claytonk 20:8115f90949b4 127 static float dot_zero_ms = 295;
claytonk 16:8d45d7451ffe 128 static float dot_one_ms = 410;
claytonk 13:2b83989d136c 129 static float dot_two_ms = 354;
claytonk 19:ee0f51cc981e 130 static float dot_three_ms = 295;
claytonk 19:ee0f51cc981e 131 static float dot_four_ms = 295;
claytonk 19:ee0f51cc981e 132 static float dot_five_ms = 295;
claytonk 20:8115f90949b4 133 static float flood_zero_ms = 360;
claytonk 21:eb8cbbb18958 134 static float flood_one_ms = 900;
claytonk 21:eb8cbbb18958 135 static float flood_two_ms = 540;
claytonk 20:8115f90949b4 136 static float flood_three_ms = 360;
claytonk 20:8115f90949b4 137 static float flood_four_ms = 360;
claytonk 20:8115f90949b4 138 static float flood_five_ms = 360;
claytonk 0:605fe136b7ea 139
claytonk 4:fc0c93cb0197 140 /* THREAD */
claytonk 4:fc0c93cb0197 141 EventQueue queue;
claytonk 4:fc0c93cb0197 142
claytonk 6:85d9ad912c14 143 /* TIMOUT */
claytonk 8:10ffd42a3921 144 Timeout dot_timeout;
claytonk 8:10ffd42a3921 145 Timeout flood_timeout;
claytonk 9:69e0bbfdb62b 146 Timeout app_timeout;
claytonk 6:85d9ad912c14 147
claytonk 13:2b83989d136c 148 /* Timers */
claytonk 13:2b83989d136c 149 Timer dot_timer;
claytonk 13:2b83989d136c 150 Timer flood_timer;
claytonk 13:2b83989d136c 151
claytonk 4:fc0c93cb0197 152 /* INTERRUPTS */
claytonk 4:fc0c93cb0197 153 //create interupts
claytonk 4:fc0c93cb0197 154 InterruptIn int_strobe_dot(strobe_dot);
claytonk 13:2b83989d136c 155 InterruptIn int_strobe_flood(strobe_flood);
claytonk 3:6b14862f5f51 156
claytonk 3:6b14862f5f51 157 /* I/O */
claytonk 0:605fe136b7ea 158 // initialize LEDs
claytonk 13:2b83989d136c 159 DigitalOut red(ledRed_pin,1);
claytonk 13:2b83989d136c 160 DigitalOut green(ledGreen_pin,1);
claytonk 13:2b83989d136c 161 DigitalOut blue(ledBlue_pin,1);
claytonk 0:605fe136b7ea 162
claytonk 0:605fe136b7ea 163 // Initialize outputs
claytonk 3:6b14862f5f51 164 DigitalOut pwm_0_output(pwm_0_pin,0); // GPIO 3
claytonk 3:6b14862f5f51 165 DigitalOut pwm_1_output(pwm_1_pin,0); // GPIO 4
claytonk 0:605fe136b7ea 166
claytonk 13:2b83989d136c 167 // Silego
claytonk 13:2b83989d136c 168 DigitalOut silego(silego_en_pin,1); // initialize on
claytonk 13:2b83989d136c 169
claytonk 0:605fe136b7ea 170 // Initialize inputs
claytonk 7:9c77eaad5102 171 DigitalIn strobe0(strobe_flood,PullNone);
claytonk 7:9c77eaad5102 172 DigitalIn strobe1(strobe_dot,PullNone);
claytonk 13:2b83989d136c 173 DigitalIn vcselFault(vcselFault_pin, PullNone);
claytonk 13:2b83989d136c 174 //DigitalIn killVcsel(p26,PullNone);
claytonk 0:605fe136b7ea 175
claytonk 7:9c77eaad5102 176
claytonk 3:6b14862f5f51 177 /* REGISTERS */
claytonk 0:605fe136b7ea 178 static uint8_t LM36011_addr = 0x64 << 1; //0xC8
claytonk 0:605fe136b7ea 179
claytonk 0:605fe136b7ea 180 // register names
claytonk 0:605fe136b7ea 181 static uint8_t enable_reg = 0x01;
claytonk 0:605fe136b7ea 182 static uint8_t configuration_reg = 0x02;
claytonk 0:605fe136b7ea 183 static uint8_t brightness_reg = 0x03;
claytonk 13:2b83989d136c 184 static uint8_t torch_reg = 0x04;
claytonk 13:2b83989d136c 185 static uint8_t flags_reg = 0x05;
claytonk 3:6b14862f5f51 186 //static uint8_t device_id_reset_reg = 0x06;
claytonk 0:605fe136b7ea 187
claytonk 0:605fe136b7ea 188 // register settings
claytonk 0:605fe136b7ea 189 static uint8_t enable_ir = 0x05;
claytonk 0:605fe136b7ea 190 static uint8_t disable_ir = 0x20;
claytonk 0:605fe136b7ea 191 static uint8_t enable_flash_timeout = 0x01;
claytonk 13:2b83989d136c 192 const int thermal_scale_back = 0x08;
claytonk 13:2b83989d136c 193 const int thermal_shutdown = 0x10;
claytonk 0:605fe136b7ea 194
claytonk 0:605fe136b7ea 195 // level settings
claytonk 13:2b83989d136c 196 float divisor = 11.7; // Current / 11.7 = Decimal
claytonk 13:2b83989d136c 197 float dot_current_setting = dot_five_ms;
claytonk 13:2b83989d136c 198 float flood_current_setting = flood_five_ms;
claytonk 13:2b83989d136c 199 uint32_t level_dot_max_dec = uint32_t(dot_current_setting/divisor);
claytonk 13:2b83989d136c 200 uint32_t level_flood_max_dec = uint32_t(flood_current_setting/divisor);
claytonk 13:2b83989d136c 201
claytonk 13:2b83989d136c 202 uint8_t level_dot_max =
claytonk 13:2b83989d136c 203 (((level_dot_max_dec / 16) << 4) & 0xf0) |
claytonk 13:2b83989d136c 204 ((level_dot_max_dec % 16) & 0x0f);
claytonk 13:2b83989d136c 205 uint8_t level_flood_max =
claytonk 13:2b83989d136c 206 (((level_flood_max_dec / 16) << 4) & 0xf0) |
claytonk 13:2b83989d136c 207 ((level_flood_max_dec % 16) & 0x0f);
claytonk 13:2b83989d136c 208
claytonk 0:605fe136b7ea 209
claytonk 3:6b14862f5f51 210 char lm_on[2] = {enable_reg,enable_ir};
claytonk 3:6b14862f5f51 211 char lm_off[2] = {enable_reg,disable_ir};
claytonk 0:605fe136b7ea 212 char lmSafety[2] = {configuration_reg,enable_flash_timeout};
claytonk 0:605fe136b7ea 213
claytonk 16:8d45d7451ffe 214 //char data_read[6];
claytonk 13:2b83989d136c 215
claytonk 0:605fe136b7ea 216 char flashBrightness_dot[2] = {brightness_reg,level_dot_max};
claytonk 0:605fe136b7ea 217 char flashBrightness_flood[2] = {brightness_reg,level_flood_max};
claytonk 13:2b83989d136c 218 char torchBrightness_both[2] = {torch_reg,0x5F};
claytonk 0:605fe136b7ea 219
claytonk 3:6b14862f5f51 220 /* I2C */
claytonk 9:69e0bbfdb62b 221 //I2CSlave ov_I2C(ov580_sda,ov580_scl);
claytonk 0:605fe136b7ea 222 I2C flood_I2C(flood_sda,flood_scl);
claytonk 0:605fe136b7ea 223 I2C dot_I2C(dot_sda,dot_scl);
claytonk 6:85d9ad912c14 224
claytonk 0:605fe136b7ea 225
claytonk 3:6b14862f5f51 226 /* VARIABLES */
claytonk 3:6b14862f5f51 227 bool stacked = false;
claytonk 3:6b14862f5f51 228 bool emitter_status_dot = false;
claytonk 7:9c77eaad5102 229 char rcv_buffer[3] = {0,0,0};
claytonk 8:10ffd42a3921 230 int dot_counter = 0;
claytonk 6:85d9ad912c14 231 bool dot_on = false;
claytonk 8:10ffd42a3921 232 int flood_counter = 0;
claytonk 6:85d9ad912c14 233 bool flood_on = false;
claytonk 6:85d9ad912c14 234 bool once = false;
claytonk 8:10ffd42a3921 235 bool in_app = false;
claytonk 8:10ffd42a3921 236 int app_counts_required = 10;
claytonk 8:10ffd42a3921 237 int stacked_counter = 0;
claytonk 13:2b83989d136c 238 bool read_fail;
claytonk 13:2b83989d136c 239
claytonk 13:2b83989d136c 240 int dot_timer_number;
claytonk 13:2b83989d136c 241 int flood_timer_number;
claytonk 3:6b14862f5f51 242
claytonk 3:6b14862f5f51 243 /* FUNCTIONS */
claytonk 13:2b83989d136c 244 void silego_check_status()
claytonk 13:2b83989d136c 245 {
claytonk 13:2b83989d136c 246 if(pwm_1_output) {
claytonk 13:2b83989d136c 247 silego = 0;
claytonk 13:2b83989d136c 248 wait(.5);
claytonk 13:2b83989d136c 249 silego = 1;
claytonk 13:2b83989d136c 250 }
claytonk 13:2b83989d136c 251 }
claytonk 13:2b83989d136c 252
claytonk 17:908ca409cb33 253 /*
claytonk 13:2b83989d136c 254 void flood_check_status()
claytonk 13:2b83989d136c 255 {
claytonk 17:908ca409cb33 256 //int read_fail = flood_I2C.read(LM36011_addr,data_read,6,false);
claytonk 17:908ca409cb33 257 //if(read_fail) {
claytonk 17:908ca409cb33 258 // red = 0;
claytonk 17:908ca409cb33 259 //} else {
claytonk 17:908ca409cb33 260
claytonk 13:2b83989d136c 261 if ((data_read[5]&thermal_shutdown) != 0) {
claytonk 13:2b83989d136c 262 red = 0;
claytonk 13:2b83989d136c 263 } else if((data_read[5]&thermal_scale_back) != 0) {
claytonk 13:2b83989d136c 264 red = !red;
claytonk 17:908ca409cb33 265 } else {
claytonk 17:908ca409cb33 266 // red = 1;
claytonk 17:908ca409cb33 267 // }
claytonk 17:908ca409cb33 268 //}
claytonk 17:908ca409cb33 269 //silego_check_status();
claytonk 13:2b83989d136c 270 }
claytonk 13:2b83989d136c 271
claytonk 13:2b83989d136c 272 void dot_check_status()
claytonk 13:2b83989d136c 273 {
claytonk 17:908ca409cb33 274 //int read_fail = dot_I2C.read(LM36011_addr,data_read,6,false);
claytonk 17:908ca409cb33 275 //if(read_fail) {
claytonk 17:908ca409cb33 276 // green = 0;
claytonk 17:908ca409cb33 277 //} else {
claytonk 17:908ca409cb33 278
claytonk 13:2b83989d136c 279 if ((data_read[5]&thermal_shutdown) != 0) {
claytonk 13:2b83989d136c 280 green = 0;
claytonk 13:2b83989d136c 281 } else if((data_read[5]&thermal_scale_back) != 0) {
claytonk 13:2b83989d136c 282 green = !green;
claytonk 17:908ca409cb33 283 } else {
claytonk 17:908ca409cb33 284 // green = 1;
claytonk 17:908ca409cb33 285 // }
claytonk 17:908ca409cb33 286 //}
claytonk 17:908ca409cb33 287 //silego_check_status();
claytonk 13:2b83989d136c 288 }
claytonk 17:908ca409cb33 289 */
claytonk 1:ffffa383ba7e 290
claytonk 6:85d9ad912c14 291 // WAI
claytonk 6:85d9ad912c14 292 void write_off()
claytonk 6:85d9ad912c14 293 {
claytonk 6:85d9ad912c14 294 dot_I2C.write(LM36011_addr,lm_off,2,false);
claytonk 6:85d9ad912c14 295 flood_I2C.write(LM36011_addr,lm_off,2,false);
claytonk 6:85d9ad912c14 296 }
claytonk 6:85d9ad912c14 297
claytonk 8:10ffd42a3921 298 // WAI
claytonk 6:85d9ad912c14 299 void write_dot()
claytonk 1:ffffa383ba7e 300 {
claytonk 6:85d9ad912c14 301 flood_I2C.write(LM36011_addr,lm_off,2,false);
claytonk 16:8d45d7451ffe 302 //flood_check_status();
claytonk 6:85d9ad912c14 303 dot_I2C.write(LM36011_addr,lm_on,2,false);
claytonk 6:85d9ad912c14 304 }
claytonk 6:85d9ad912c14 305
claytonk 8:10ffd42a3921 306 // WAI
claytonk 6:85d9ad912c14 307 void write_flood()
claytonk 6:85d9ad912c14 308 {
claytonk 6:85d9ad912c14 309 dot_I2C.write(LM36011_addr,lm_off,2,false);
claytonk 16:8d45d7451ffe 310 //dot_check_status();
claytonk 6:85d9ad912c14 311 flood_I2C.write(LM36011_addr,lm_on,2,false);
claytonk 6:85d9ad912c14 312 }
claytonk 6:85d9ad912c14 313
claytonk 8:10ffd42a3921 314 // WAI
claytonk 6:85d9ad912c14 315 void write_pulsed()
claytonk 6:85d9ad912c14 316 {
claytonk 6:85d9ad912c14 317 if(emitter_status_dot) {
claytonk 6:85d9ad912c14 318 write_dot();
claytonk 6:85d9ad912c14 319 } else {
claytonk 6:85d9ad912c14 320 write_flood();
claytonk 6:85d9ad912c14 321 }
claytonk 1:ffffa383ba7e 322 }
claytonk 1:ffffa383ba7e 323
claytonk 8:10ffd42a3921 324 // WAI
claytonk 4:fc0c93cb0197 325 void write_once()
claytonk 4:fc0c93cb0197 326 {
claytonk 8:10ffd42a3921 327 if(in_app) {
claytonk 8:10ffd42a3921 328 if(stacked_counter > app_counts_required) {
claytonk 8:10ffd42a3921 329 write_pulsed();
claytonk 8:10ffd42a3921 330 write_pulsed();
claytonk 4:fc0c93cb0197 331 } else {
claytonk 8:10ffd42a3921 332 if(dot_on) {
claytonk 8:10ffd42a3921 333 write_dot();
claytonk 8:10ffd42a3921 334 write_dot();
claytonk 8:10ffd42a3921 335 } else if(flood_on) {
claytonk 8:10ffd42a3921 336 write_flood();
claytonk 8:10ffd42a3921 337 write_flood();
claytonk 8:10ffd42a3921 338 } else {
claytonk 8:10ffd42a3921 339 write_off();
claytonk 8:10ffd42a3921 340 write_off();
claytonk 8:10ffd42a3921 341 }
claytonk 4:fc0c93cb0197 342 }
claytonk 8:10ffd42a3921 343 } else {
claytonk 8:10ffd42a3921 344 write_off();
claytonk 8:10ffd42a3921 345 write_off();
claytonk 6:85d9ad912c14 346 }
claytonk 6:85d9ad912c14 347 }
claytonk 6:85d9ad912c14 348
claytonk 8:10ffd42a3921 349 void dot_watchdog()
claytonk 6:85d9ad912c14 350 {
claytonk 8:10ffd42a3921 351 dot_on = false;
claytonk 8:10ffd42a3921 352 dot_counter = 0;
claytonk 8:10ffd42a3921 353 stacked_counter = 0;
claytonk 8:10ffd42a3921 354 stacked = false;
claytonk 8:10ffd42a3921 355 queue.call(&write_once);
claytonk 8:10ffd42a3921 356 }
claytonk 8:10ffd42a3921 357
claytonk 8:10ffd42a3921 358 void flood_watchdog()
claytonk 8:10ffd42a3921 359 {
claytonk 8:10ffd42a3921 360 flood_on = false;
claytonk 8:10ffd42a3921 361 flood_counter = 0;
claytonk 8:10ffd42a3921 362 stacked_counter = 0;
claytonk 8:10ffd42a3921 363 stacked = false;
claytonk 8:10ffd42a3921 364 queue.call(&write_once);
claytonk 8:10ffd42a3921 365 }
claytonk 8:10ffd42a3921 366
claytonk 9:69e0bbfdb62b 367 void app_watchdog()
claytonk 9:69e0bbfdb62b 368 {
claytonk 9:69e0bbfdb62b 369 in_app = false;
claytonk 9:69e0bbfdb62b 370 dot_watchdog();
claytonk 9:69e0bbfdb62b 371 flood_watchdog();
claytonk 9:69e0bbfdb62b 372 }
claytonk 9:69e0bbfdb62b 373
claytonk 8:10ffd42a3921 374 void dot_falling_edge()
claytonk 8:10ffd42a3921 375 {
claytonk 13:2b83989d136c 376 dot_timer_number = dot_timer.read_us();
claytonk 6:85d9ad912c14 377
claytonk 6:85d9ad912c14 378 if(stacked) {
claytonk 6:85d9ad912c14 379 emitter_status_dot = !emitter_status_dot;
claytonk 4:fc0c93cb0197 380 } else {
claytonk 6:85d9ad912c14 381 emitter_status_dot = dot_on;
claytonk 4:fc0c93cb0197 382 }
claytonk 8:10ffd42a3921 383 // indicate status dot
claytonk 8:10ffd42a3921 384 pwm_0_output = emitter_status_dot;
claytonk 8:10ffd42a3921 385 // indicate VCSEL fault if it exists
claytonk 8:10ffd42a3921 386 pwm_1_output = !vcselFault.read();
claytonk 8:10ffd42a3921 387
claytonk 8:10ffd42a3921 388 // write once
claytonk 8:10ffd42a3921 389 queue.call(&write_once);
claytonk 8:10ffd42a3921 390
claytonk 9:69e0bbfdb62b 391 // timeout for dot
claytonk 8:10ffd42a3921 392 dot_timeout.attach(&dot_watchdog,.05);
claytonk 9:69e0bbfdb62b 393 // timout for app
claytonk 9:69e0bbfdb62b 394 app_timeout.detach();
claytonk 9:69e0bbfdb62b 395 app_timeout.attach(&app_watchdog,1);
claytonk 4:fc0c93cb0197 396 }
claytonk 4:fc0c93cb0197 397
claytonk 8:10ffd42a3921 398 void flood_falling_edge()
claytonk 4:fc0c93cb0197 399 {
claytonk 13:2b83989d136c 400 flood_timer_number = flood_timer.read_us();
claytonk 13:2b83989d136c 401
claytonk 8:10ffd42a3921 402 if (!stacked) {
claytonk 8:10ffd42a3921 403 emitter_status_dot = dot_on;
claytonk 6:85d9ad912c14 404 }
claytonk 8:10ffd42a3921 405 // indicate status dot
claytonk 8:10ffd42a3921 406 pwm_0_output = emitter_status_dot;
claytonk 8:10ffd42a3921 407 // indicate VCSEL fault if it exists
claytonk 8:10ffd42a3921 408 pwm_1_output = !vcselFault.read();
claytonk 8:10ffd42a3921 409 // timeout for app exit
claytonk 8:10ffd42a3921 410 //timeout.attach(&write_off,.5);
claytonk 8:10ffd42a3921 411 // write once
claytonk 8:10ffd42a3921 412 queue.call(&write_once);
claytonk 4:fc0c93cb0197 413
claytonk 9:69e0bbfdb62b 414 // timeout for flood
claytonk 8:10ffd42a3921 415 flood_timeout.attach(&flood_watchdog,.05);
claytonk 9:69e0bbfdb62b 416 // timout for app
claytonk 9:69e0bbfdb62b 417 app_timeout.detach();
claytonk 9:69e0bbfdb62b 418 app_timeout.attach(&app_watchdog,1);
claytonk 8:10ffd42a3921 419 }
claytonk 4:fc0c93cb0197 420
claytonk 18:a78e878a4971 421
claytonk 6:85d9ad912c14 422 void dot_check()
claytonk 6:85d9ad912c14 423 {
claytonk 8:10ffd42a3921 424 dot_timeout.detach();
claytonk 13:2b83989d136c 425 dot_timer.reset();
claytonk 6:85d9ad912c14 426
claytonk 8:10ffd42a3921 427 dot_counter ++;
claytonk 8:10ffd42a3921 428 if(dot_counter > app_counts_required) {
claytonk 8:10ffd42a3921 429 dot_on = true;
claytonk 10:c757bd889ed1 430 in_app = true;
claytonk 8:10ffd42a3921 431 } else {
claytonk 8:10ffd42a3921 432 dot_on = false;
claytonk 8:10ffd42a3921 433 }
claytonk 8:10ffd42a3921 434 stacked = strobe0.read();
claytonk 8:10ffd42a3921 435 if(stacked) {
claytonk 8:10ffd42a3921 436 stacked_counter++;
claytonk 8:10ffd42a3921 437 } else {
claytonk 8:10ffd42a3921 438 stacked_counter = 0;
claytonk 8:10ffd42a3921 439 flood_counter = 0;
claytonk 8:10ffd42a3921 440 flood_on = false;
claytonk 8:10ffd42a3921 441 }
claytonk 8:10ffd42a3921 442 if(!in_app) {
claytonk 8:10ffd42a3921 443 if (stacked_counter > app_counts_required) {
claytonk 8:10ffd42a3921 444 in_app = true;
claytonk 8:10ffd42a3921 445 }
claytonk 8:10ffd42a3921 446 }
claytonk 6:85d9ad912c14 447 }
claytonk 6:85d9ad912c14 448
claytonk 6:85d9ad912c14 449
claytonk 6:85d9ad912c14 450 void flood_check()
claytonk 6:85d9ad912c14 451 {
claytonk 8:10ffd42a3921 452 flood_timeout.detach();
claytonk 13:2b83989d136c 453 flood_timer.reset();
claytonk 6:85d9ad912c14 454
claytonk 8:10ffd42a3921 455 flood_counter ++;
claytonk 8:10ffd42a3921 456 if(flood_counter > app_counts_required) {
claytonk 8:10ffd42a3921 457 flood_on = true;
claytonk 10:c757bd889ed1 458 in_app = true;
claytonk 8:10ffd42a3921 459 } else {
claytonk 8:10ffd42a3921 460 flood_on = false;
claytonk 8:10ffd42a3921 461 }
claytonk 8:10ffd42a3921 462 stacked = strobe1.read();
claytonk 8:10ffd42a3921 463 if(stacked) {
claytonk 8:10ffd42a3921 464 stacked_counter++;
claytonk 8:10ffd42a3921 465 } else {
claytonk 8:10ffd42a3921 466 stacked_counter = 0;
claytonk 8:10ffd42a3921 467 dot_counter = 0;
claytonk 8:10ffd42a3921 468 dot_on = false;
claytonk 8:10ffd42a3921 469 }
claytonk 8:10ffd42a3921 470 if(!in_app) {
claytonk 8:10ffd42a3921 471 if (stacked_counter > app_counts_required) {
claytonk 8:10ffd42a3921 472 in_app = true;
claytonk 8:10ffd42a3921 473 }
claytonk 8:10ffd42a3921 474 }
claytonk 6:85d9ad912c14 475 }
claytonk 6:85d9ad912c14 476
claytonk 13:2b83989d136c 477 void test_function()
claytonk 13:2b83989d136c 478 {
claytonk 13:2b83989d136c 479
claytonk 13:2b83989d136c 480 }
claytonk 13:2b83989d136c 481
claytonk 22:d1b0a16d8d03 482 void morse_callback(int val)
claytonk 22:d1b0a16d8d03 483 {
claytonk 22:d1b0a16d8d03 484 red = !val;
claytonk 22:d1b0a16d8d03 485 }
claytonk 22:d1b0a16d8d03 486
claytonk 6:85d9ad912c14 487 // TODOS //
claytonk 7:9c77eaad5102 488 // DONE P0 Get illumination working
claytonk 8:10ffd42a3921 489 // P0 Get OV580 I2C to look correct. Suspect open drain culprit
claytonk 9:69e0bbfdb62b 490 // DONE P0 Ensure that current implementation meets the needs of data collection
claytonk 8:10ffd42a3921 491 // DONE P0 Get in app working
claytonk 8:10ffd42a3921 492 // DONE P0 Get watchdog time working
claytonk 8:10ffd42a3921 493 // DONE P0 Check watchdog for working on dot and flood
claytonk 6:85d9ad912c14 494 // P1 Bluetooth OTA updates
claytonk 6:85d9ad912c14 495 // P2 Get writing working
claytonk 6:85d9ad912c14 496 // P2 Get reading working
claytonk 6:85d9ad912c14 497 //
claytonk 6:85d9ad912c14 498
claytonk 0:605fe136b7ea 499 // main() runs in its own thread in the OS
claytonk 1:ffffa383ba7e 500 int main()
claytonk 1:ffffa383ba7e 501 {
claytonk 4:fc0c93cb0197 502 Thread eventThread(osPriorityHigh);;
claytonk 4:fc0c93cb0197 503 eventThread.start(callback(&queue, &EventQueue::dispatch_forever));
claytonk 4:fc0c93cb0197 504
claytonk 4:fc0c93cb0197 505 // set interrupts
claytonk 6:85d9ad912c14 506 int_strobe_dot.rise(&dot_check);
claytonk 6:85d9ad912c14 507 int_strobe_flood.rise(&flood_check);
claytonk 8:10ffd42a3921 508 int_strobe_dot.fall(&dot_falling_edge);
claytonk 8:10ffd42a3921 509 int_strobe_flood.fall(&flood_falling_edge);
claytonk 8:10ffd42a3921 510
claytonk 13:2b83989d136c 511 dot_timer.start();
claytonk 13:2b83989d136c 512 flood_timer.start();
claytonk 22:d1b0a16d8d03 513
claytonk 22:d1b0a16d8d03 514 MorseGenerator morse = MorseGenerator(morse_callback);
claytonk 22:d1b0a16d8d03 515 morse.transmit(version_number);
claytonk 13:2b83989d136c 516
claytonk 8:10ffd42a3921 517 while(!in_app) {
claytonk 9:69e0bbfdb62b 518 wait(.1);
claytonk 8:10ffd42a3921 519 }
claytonk 1:ffffa383ba7e 520
claytonk 13:2b83989d136c 521 silego = 1;
claytonk 13:2b83989d136c 522
claytonk 0:605fe136b7ea 523 // write safety
claytonk 0:605fe136b7ea 524 flood_I2C.write(LM36011_addr,lmSafety,2,false);
claytonk 0:605fe136b7ea 525 dot_I2C.write(LM36011_addr,lmSafety,2,false);
claytonk 3:6b14862f5f51 526
claytonk 13:2b83989d136c 527 // write torch
claytonk 13:2b83989d136c 528 flood_I2C.write(LM36011_addr,torchBrightness_both,2,false);
claytonk 13:2b83989d136c 529 dot_I2C.write(LM36011_addr,torchBrightness_both,2,false);
claytonk 13:2b83989d136c 530
claytonk 1:ffffa383ba7e 531 // write brightness
claytonk 1:ffffa383ba7e 532 flood_I2C.write(LM36011_addr,flashBrightness_flood,2,false);
claytonk 3:6b14862f5f51 533 dot_I2C.write(LM36011_addr,flashBrightness_dot,2,false);
claytonk 1:ffffa383ba7e 534
claytonk 0:605fe136b7ea 535 while (true) {
claytonk 13:2b83989d136c 536
claytonk 13:2b83989d136c 537 if(dot_timer_number > 700 && dot_timer_number < 1499) {
claytonk 13:2b83989d136c 538 dot_current_setting = dot_one_ms;
claytonk 13:2b83989d136c 539
claytonk 13:2b83989d136c 540 } else if(dot_timer_number > 1500 && dot_timer_number < 2499) {
claytonk 13:2b83989d136c 541 dot_current_setting = dot_two_ms;
claytonk 13:2b83989d136c 542
claytonk 13:2b83989d136c 543 } else if(dot_timer_number > 2500 && dot_timer_number < 3499) {
claytonk 13:2b83989d136c 544 dot_current_setting = dot_three_ms;
claytonk 13:2b83989d136c 545
claytonk 13:2b83989d136c 546 } else if(dot_timer_number > 3500 && dot_timer_number < 4499) {
claytonk 13:2b83989d136c 547 dot_current_setting = dot_four_ms;
claytonk 13:2b83989d136c 548
claytonk 13:2b83989d136c 549 } else if(dot_timer_number > 4500) {
claytonk 13:2b83989d136c 550 dot_current_setting = dot_five_ms;
claytonk 13:2b83989d136c 551
claytonk 13:2b83989d136c 552 } else {
claytonk 13:2b83989d136c 553 dot_current_setting = dot_zero_ms;
claytonk 13:2b83989d136c 554 }
claytonk 13:2b83989d136c 555
claytonk 13:2b83989d136c 556 level_dot_max_dec = uint32_t(dot_current_setting/divisor);
claytonk 13:2b83989d136c 557 level_dot_max = (((level_dot_max_dec / 16) << 4) & 0xf0) |
claytonk 13:2b83989d136c 558 ((level_dot_max_dec % 16) & 0x0f);
claytonk 13:2b83989d136c 559
claytonk 13:2b83989d136c 560 flashBrightness_dot[1] = level_dot_max;
claytonk 13:2b83989d136c 561
claytonk 16:8d45d7451ffe 562 dot_I2C.write(LM36011_addr,flashBrightness_dot,2,false);
claytonk 16:8d45d7451ffe 563 wait(.01);
claytonk 13:2b83989d136c 564
claytonk 13:2b83989d136c 565 if(flood_timer_number > 700 && flood_timer_number < 1499) {
claytonk 13:2b83989d136c 566 flood_current_setting = flood_one_ms;
claytonk 13:2b83989d136c 567
claytonk 13:2b83989d136c 568 } else if(flood_timer_number > 1500 && flood_timer_number < 2499) {
claytonk 13:2b83989d136c 569 flood_current_setting = flood_two_ms;
claytonk 13:2b83989d136c 570
claytonk 13:2b83989d136c 571 } else if(flood_timer_number > 2500 && flood_timer_number < 3499) {
claytonk 13:2b83989d136c 572 flood_current_setting = flood_three_ms;
claytonk 13:2b83989d136c 573
claytonk 13:2b83989d136c 574 } else if(flood_timer_number > 3500 && flood_timer_number < 4499) {
claytonk 13:2b83989d136c 575 flood_current_setting = flood_four_ms;
claytonk 13:2b83989d136c 576
claytonk 13:2b83989d136c 577 } else if(flood_timer_number > 4500) {
claytonk 13:2b83989d136c 578 flood_current_setting = flood_five_ms;
claytonk 13:2b83989d136c 579
claytonk 13:2b83989d136c 580 } else {
claytonk 13:2b83989d136c 581 flood_current_setting = flood_zero_ms;
claytonk 13:2b83989d136c 582 }
claytonk 13:2b83989d136c 583
claytonk 13:2b83989d136c 584 level_flood_max_dec = uint32_t(flood_current_setting/divisor);
claytonk 13:2b83989d136c 585 level_flood_max = (((level_flood_max_dec / 16) << 4) & 0xf0) |
claytonk 13:2b83989d136c 586 ((level_flood_max_dec % 16) & 0x0f);
claytonk 13:2b83989d136c 587
claytonk 13:2b83989d136c 588
claytonk 13:2b83989d136c 589 flashBrightness_flood[1] = level_flood_max;
claytonk 13:2b83989d136c 590
claytonk 16:8d45d7451ffe 591 flood_I2C.write(LM36011_addr,flashBrightness_flood,2,false);
claytonk 13:2b83989d136c 592
claytonk 16:8d45d7451ffe 593 wait(.01);
claytonk 16:8d45d7451ffe 594
claytonk 16:8d45d7451ffe 595 silego_check_status();
claytonk 0:605fe136b7ea 596 }
claytonk 0:605fe136b7ea 597 }
claytonk 0:605fe136b7ea 598