//Multiplies tempLeds to leds void multiplyLeds(odd_led_t* leds[NUM_LEDS], odd_led_t* tempLeds[NUM_LEDS]) { for(int i = 0; i < NUM_LEDS; i++) { if(getLED(i, 'r') * getTempLED(i, 'r') > 4095) setLED(i, 'r', 4095); else setLED(i, 'r', getLED(i, 'r') * getTempLED(i, 'r')); if(getLED(i, 'g') * getTempLED(i, 'g') > 4095) setLED(i, 'g', 4095); else setLED(i, 'g', getLED(i, 'g') * getTempLED(i, 'g')); if(getLED(i, 'b') * getTempLED(i, 'b') > 4095) setLED(i, 'b', 4095); else setLED(i, 'b', getLED(i, 'b') * getTempLED(i, 'b')); } }
//Subtracts the current modifications to the LEDs from the led array void subtractLeds(odd_led_t* leds[NUM_LEDS], odd_led_t* tempLeds[NUM_LEDS]) { for(int i = 0; i < NUM_LEDS; i++) { if(getLED(i, 'r') - getTempLED(i, 'r') < 0) setLED(i, 'r', 0); else setLED(i, 'r', getLED(i, 'r') - getTempLED(i, 'r')); if(getLED(i, 'g') - getTempLED(i, 'g') < 0) setLED(i, 'g', 0); else setLED(i, 'g', getLED(i, 'g') - getTempLED(i, 'g')); if(getLED(i, 'b') - getTempLED(i, 'b') < 0) setLED(i, 'b', 0); else setLED(i, 'b', getLED(i, 'b') - getTempLED(i, 'b')); } }
int botBlocked() { return getLED(5); }
int botAtNode() { if(getLED(1)&&getLED(2)&&getLED(3)&&getLED(4)) return 1; return 0; }