35 lines
1.0 KiB
C
35 lines
1.0 KiB
C
|
#include <smoothled.h>
|
||
|
|
|
||
|
|
static uint32_t sourceColor = 0x000000;
|
||
|
|
static uint32_t currentColor = 0x000000;
|
||
|
|
static uint32_t targetColor = 0x000000;
|
||
|
|
static int32_t smoothledTimer = -1;
|
||
|
|
|
||
|
|
void smoothled_set(uint32_t color) {
|
||
|
|
smoothledTimer = timer_read32();
|
||
|
|
sourceColor = currentColor;
|
||
|
|
targetColor = color;
|
||
|
|
}
|
||
|
|
|
||
|
|
void smoothled_process(void) {
|
||
|
|
if (smoothledTimer < 0) {
|
||
|
|
return;
|
||
|
|
}
|
||
|
|
int32_t kb = timer_elapsed32(smoothledTimer);
|
||
|
|
int32_t ka = SMOOTH_DURATION - kb;
|
||
|
|
if (kb > SMOOTH_DURATION) {
|
||
|
|
kb = SMOOTH_DURATION;
|
||
|
|
ka = 0;
|
||
|
|
smoothledTimer = -1;
|
||
|
|
}
|
||
|
|
currentColor = 0;
|
||
|
|
for (int i = 2; i >= 0; i--) {
|
||
|
|
uint32_t shift = i * 8;
|
||
|
|
currentColor |= (ka * ((uint32_t)(sourceColor >> shift) & 0xFF) + kb * ((uint32_t)(targetColor >> shift) & 0xFF)) / SMOOTH_DURATION;
|
||
|
|
/*currentColor |= ((targetColor >> shift) & 0xFF);*/
|
||
|
|
currentColor <<= 8;
|
||
|
|
}
|
||
|
|
currentColor >>= 8;
|
||
|
|
rgblight_setrgb((currentColor >> 16) & 0xFF, (currentColor >> 8) & 0xFF, currentColor & 0xFF);
|
||
|
|
}
|