You can not select more than 25 topics Topics must start with a letter or number, can include dashes ('-') and can be up to 35 characters long.

46 lines
1.5 KiB

  1. #include "dmc12.h"
  2. static uint32_t dmc12_color = 0;
  3. static uint16_t dmc12_timer = 0;
  4. static int8_t dmc12_current = 0;
  5. static uint8_t dmc12_direction = 1;
  6. void dmc12_start(uint32_t color, bool reset) {
  7. dmc12_color = color;
  8. if (reset) {
  9. dmc12_timer = 0;
  10. dmc12_current = 0;
  11. dmc12_direction = 1;
  12. }
  13. }
  14. void dmc12_process(void) {
  15. if (!dmc12_timer) {
  16. dmc12_timer = timer_read();
  17. return;
  18. }
  19. float dist_from_center = ((float)abs(dmc12_current - RGBLED_NUM / 2)) / ((float)RGBLED_NUM);
  20. if (timer_elapsed(dmc12_timer) > dist_from_center * LED_INTERVAL) {
  21. dmc12_current += dmc12_direction;
  22. if (dmc12_current == 0 || dmc12_current == RGBLED_NUM - 1) {
  23. dmc12_direction *= -1;
  24. }
  25. dmc12_timer = timer_read();
  26. for (int i = 0; i < RGBLED_NUM; i++) {
  27. if (i > dmc12_current - LED_RADIUS && i < dmc12_current + LED_RADIUS) {
  28. float intensity = (LED_RADIUS - abs(i - dmc12_current)) / ((float)LED_RADIUS);
  29. if (i != dmc12_current) {
  30. intensity /= 4.0;
  31. }
  32. rgblight_setrgb_at(
  33. ((dmc12_color >> 16) & 0xFF) * intensity,
  34. ((dmc12_color >> 8) & 0xFF) * intensity,
  35. (dmc12_color & 0xFF) * intensity,
  36. i
  37. );
  38. } else {
  39. rgblight_setrgb_at(0, 0, 0, i);
  40. }
  41. }
  42. }
  43. }