85 lines
2.0 KiB
C++
85 lines
2.0 KiB
C++
// Basic Config
|
|
#include "main.h"
|
|
#include "globals.h"
|
|
|
|
#ifdef HAS_RGB_LED
|
|
|
|
// RGB Led instance
|
|
SmartLed rgb_led(LED_WS2812, 1, HAS_RGB_LED);
|
|
|
|
float rgb_CalcColor(float p, float q, float t)
|
|
{
|
|
if (t < 0.0f)
|
|
t += 1.0f;
|
|
if (t > 1.0f)
|
|
t -= 1.0f;
|
|
|
|
if (t < 1.0f / 6.0f)
|
|
return p + (q - p) * 6.0f * t;
|
|
|
|
if (t < 0.5f)
|
|
return q;
|
|
|
|
if (t < 2.0f / 3.0f)
|
|
return p + ((q - p) * (2.0f / 3.0f - t) * 6.0f);
|
|
|
|
return p;
|
|
}
|
|
|
|
// ------------------------------------------------------------------------
|
|
// Hue, Saturation, Lightness color members
|
|
// HslColor using H, S, L values (0.0 - 1.0)
|
|
// L should be limited to between (0.0 - 0.5)
|
|
// ------------------------------------------------------------------------
|
|
RGBColor rgb_hsl2rgb(float h, float s, float l)
|
|
{
|
|
RGBColor RGB_color;
|
|
float r;
|
|
float g;
|
|
float b;
|
|
|
|
if (s == 0.0f || l == 0.0f)
|
|
{
|
|
r = g = b = l; // achromatic or black
|
|
}
|
|
else
|
|
{
|
|
float q = l < 0.5f ? l * (1.0f + s) : l + s - (l * s);
|
|
float p = 2.0f * l - q;
|
|
r = rgb_CalcColor(p, q, h + 1.0f / 3.0f);
|
|
g = rgb_CalcColor(p, q, h);
|
|
b = rgb_CalcColor(p, q, h - 1.0f / 3.0f);
|
|
}
|
|
|
|
RGB_color.R = (uint8_t)(r * 255.0f);
|
|
RGB_color.G = (uint8_t)(g * 255.0f);
|
|
RGB_color.B = (uint8_t)(b * 255.0f);
|
|
|
|
return RGB_color;
|
|
}
|
|
|
|
void rgb_set_color(uint16_t hue) {
|
|
if (hue == COLOR_NONE) {
|
|
// Off
|
|
rgb_led[0] = Rgb(0,0,0);
|
|
} else {
|
|
// see http://www.workwithcolor.com/blue-color-hue-range-01.htm
|
|
// H (is color from 0..360) should be between 0.0 and 1.0
|
|
// S is saturation keep it to 1
|
|
// L is brightness should be between 0.0 and 0.5
|
|
// cfg.rgblum is between 0 and 100 (percent)
|
|
RGBColor target = rgb_hsl2rgb( hue / 360.0f, 1.0f, 0.005f * cfg.rgblum);
|
|
//uint32_t color = target.R<<16 | target.G<<8 | target.B;
|
|
rgb_led[0] = Rgb(target.R, target.G, target.B);
|
|
}
|
|
// Show
|
|
rgb_led.show();
|
|
}
|
|
|
|
#else
|
|
|
|
// No RGB LED empty functions
|
|
void rgb_set_color(uint16_t hue) {}
|
|
|
|
#endif
|