#include "MultiColorLight.h"

MultiColorLight::MultiColorLight():rgbLeds(ledAmount,ledPin){

};

void MultiColorLight::begin(void){
    rgbLeds.begin();
};

void MultiColorLight::setLed(uint8_t index , uint32_t color){
    if (index > ledAmount-1){
        //TODO: logging
    }
    rgbLeds.setPixelColor(index, normalizeColor(color));
    rgbLeds.show();
};


void MultiColorLight::setLed(leds leds, uint32_t color){
    switch (leds){
        case TOP_LEFT:
            MultiColorLight::setLed(1,color);break;
        case TOP_RIGHT:
            MultiColorLight::setLed(0,color);break;
        case TOP_RIGHT:
            MultiColorLight::setLed(1,color);break;
        case BOTTOM:
            MultiColorLight::setLed(2,color);break;
        case TOP:
            for (int index = 0; index<2; index++){
                MultiColorLight::setLed(index,color);
            }break;
        case ALL:
            for (int index = 0; index<ledAmount; index++){
                MultiColorLight::setLed(index,color);
            }break;
        default:
            //TODO logging
            break;
    }

};


void MultiColorLight::setTopLeds(uint32_t color){
    MultiColorLight::setLed(TOP,color);
}; 

void MultiColorLight::blink(uint16_t amount,uint32_t color, leds leds, uint32_t interval){
    for(uint16_t index = 0; index < amount;index++){
        MultiColorLight::setLed(leds, color);
        vTaskDelay(interval);
        MultiColorLight::turnOff(leds);
        vTaskDelay(interval);
    }

};

void MultiColorLight::turnOff(leds leds){
    switch (leds){
        case TOP_LEFT:
            MultiColorLight::setLed(1,0);break;
        case TOP_RIGHT:
            MultiColorLight::setLed(0,0);break;
        case TOP_RIGHT:
            MultiColorLight::setLed(1,0);break;
        case BOTTOM:
            MultiColorLight::setLed(2,0);break;
        case TOP:
            for (int index = 0; index<2; index++){
                MultiColorLight::setLed(index,0);
            }break;
        case ALL:
            for (int index = 0; index<3; index++){
                MultiColorLight::setLed(index,0);
            }break;
        default:
            //TODO logging
            break;
    }
};

uint32_t MultiColorLight::color(uint8_t r, uint8_t g, uint8_t b){
    return rgbLeds.Color(r,g,b);
};

//PRIVATE
uint32_t MultiColorLight::normalizeColor(uint32_t color,uint8_t maxBrightness){
    uint8_t red = (color&0x00FF0000)>>16;
    uint8_t green = (color&0x0000FF00)>>8;
    uint8_t blue = (color&0x000000FF);
    if (red > maxBrightness){
        red = maxBrightness;
    }
    if(green > maxBrightness-70){
        green = maxBrightness-70;
    }
    if(blue > maxBrightness-50){
        blue = maxBrightness-50;
    }
    return MultiColorLight::color(red,green,blue);
}