Jason Chang / Mbed OS 9v1

Add I2CSlave to ov580 master.

Dependencies:   MorseGenerator2

main.cpp@17:908ca409cb33, 2019-03-11 (annotated)

Committer:
claytonk
Date:
Mon Mar 11 01:25:35 2019 +0000
Revision:
17:908ca409cb33
Parent:
16:8d45d7451ffe
Child:
18:a78e878a4971
latest

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