Jason Chang
/
9v1
Add I2CSlave to ov580 master.
Diff: main.cpp
- Revision:
- 2:afc300c4f8e4
- Parent:
- 1:ffffa383ba7e
- Child:
- 3:6b14862f5f51
--- a/main.cpp Fri Oct 19 01:54:34 2018 +0000 +++ b/main.cpp Fri Oct 19 16:45:09 2018 +0000 @@ -87,17 +87,6 @@ //static uint8_t level_dot_max = 0x15 //0.257 A static uint8_t level_dot_max = 0x1F; // = 352mA -//size_t write_size 2; -bool err; -bool on = false; -bool stacked_error = false; -bool in_app = false; -uint64_t stacked_counter = 0; -bool flip = false; -bool dot_on = false; -bool flood_on = false; -bool pulsed = false; - char lmInit[2] = {enable_reg,enable_ir}; char lmOff[2] = {enable_reg,disable_ir}; char lmSafety[2] = {configuration_reg,enable_flash_timeout}; @@ -117,57 +106,12 @@ // functions void lightsOn() { - // set on true if stacked error isn't present - if(in_app) { - - if(!pulsed && dot_on) { - // set driver current - dot_I2C.write(LM36011_addr, lmInit, 2, false); - wait_us(2); - } else if (pulsed && flip) { - dot_I2C.write(LM36011_addr, lmInit, 2, false); - wait_us(2); - } else { - dot_I2C.write(LM36011_addr, lmOff, 2, false); - wait_us(2); - } - - if(!pulsed && flood_on) { - flood_I2C.write(LM36011_addr, lmInit, 2, false); - wait_us(2); - } else if (pulsed && !flip) { - flood_I2C.write(LM36011_addr, lmInit, 2, false); - wait_us(2); - } else { - flood_I2C.write(LM36011_addr, lmOff, 2, false); - wait_us(2); - } - } + } void stack_check() { - // check strobe 1 for high, and if high set stacked_error - stacked_error = strobe_1.read(); - if(stacked_error) { - stacked_counter++; - } else { - in_app = false; - stacked_counter = 0; - } - if(stacked_counter > 30) { - in_app = true; - } - flood_on = pwm_0; - dot_on = pwm_1; - if(flood_on && dot_on) { - pulsed = true; - } else { - pulsed = false; - } - - flip = !flip; } // main() runs in its own thread in the OS @@ -187,8 +131,9 @@ dot_I2C.write(LM36011_addr,flashBrightness_dot,2,false); // set interrupts + strobe_0.rise(stack_check); strobe_0.fall(lightsOn); - strobe_0.rise(stack_check); + while (true) {