qmk_firmware/keyboards/oddforge/vea/ws2812_custom.c

42 lines
1.1 KiB
C
Raw Normal View History

2023-03-30 01:21:02 +00:00
#include "ws2812.h"
#include "i2c_master.h"
#ifdef WS2812_RGBW
2023-03-30 01:21:02 +00:00
# error "RGBW not supported"
#endif
#ifndef WS2812_I2C_ADDRESS
# define WS2812_I2C_ADDRESS 0xB0
#endif
#ifndef WS2812_I2C_ADDRESS_RIGHT
# define WS2812_I2C_ADDRESS_RIGHT 0xB8
#endif
#ifndef WS2812_I2C_TIMEOUT
# define WS2812_I2C_TIMEOUT 100
#endif
ws2812_led_t ws2812_leds[WS2812_LED_COUNT];
2023-03-30 01:21:02 +00:00
void ws2812_init(void) {
i2c_init();
}
void ws2812_set_color(int index, uint8_t red, uint8_t green, uint8_t blue) {
ws2812_leds[index].r = red;
ws2812_leds[index].g = green;
ws2812_leds[index].b = blue;
}
void ws2812_set_color_all(uint8_t red, uint8_t green, uint8_t blue) {
for (int i = 0; i < WS2812_LED_COUNT; i++) {
ws2812_set_color(i, red, green, blue);
}
}
void ws2812_flush(void) {
i2c_transmit(WS2812_I2C_ADDRESS, (uint8_t *)ws2812_leds, sizeof(ws2812_led_t) * (WS2812_LED_COUNT >> 1), WS2812_I2C_TIMEOUT);
i2c_transmit(WS2812_I2C_ADDRESS_RIGHT, (uint8_t *)ws2812_leds + (sizeof(ws2812_led_t) * (WS2812_LED_COUNT >> 1)), sizeof(ws2812_led_t) * (WS2812_LED_COUNT - (WS2812_LED_COUNT >> 1)), WS2812_I2C_TIMEOUT);
2023-03-30 01:21:02 +00:00
}