keyboard/qmk/users/anderson/smoothled.c

35 lines
1 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);
}