//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;
}
