1 files changed, 34 insertions, 0 deletions

diff --git a/users/anderson/smoothled.c b/users/anderson/smoothled.c
new file mode 100644
index 000000000..3af729563
--- /dev/null
+++ b/users/anderson/smoothled.c
@@ -0,0 +1,34 @@
+#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);
+}