summaryrefslogtreecommitdiff
path: root/keyboards/ergodox_ez/led_i2c.c
diff options
context:
space:
mode:
Diffstat (limited to 'keyboards/ergodox_ez/led_i2c.c')
-rw-r--r--keyboards/ergodox_ez/led_i2c.c35
1 files changed, 25 insertions, 10 deletions
diff --git a/keyboards/ergodox_ez/led_i2c.c b/keyboards/ergodox_ez/led_i2c.c
index 23ef91b74f..80dabf4815 100644
--- a/keyboards/ergodox_ez/led_i2c.c
+++ b/keyboards/ergodox_ez/led_i2c.c
@@ -21,35 +21,50 @@ along with this program. If not, see <http://www.gnu.org/licenses/>.
#ifdef RGBLIGHT_ENABLE
# include "ergodox_ez.h"
+# include "ws2812.h"
-void rgblight_call_driver(rgb_led_t *led, uint8_t led_num) {
- i2c_init();
- i2c_start(0x84, ERGODOX_EZ_I2C_TIMEOUT);
+void setleds_custom(rgb_led_t *led, uint16_t led_num) {
+ uint16_t length = 0;
int i = 0;
+ int j = 0;
+# ifdef RGBW
+ int bytes_per_led = 4;
+# else
+ int bytes_per_led = 3;
+# endif
# if defined(ERGODOX_LED_30)
// prevent right-half code from trying to bitbang all 30
// so with 30 LEDs, we count from 29 to 15 here, and the
// other half does 0 to 14.
- uint8_t half_led_num = RGBLED_NUM / 2;
+ uint8_t half_led_num = RGBLIGHT_LED_COUNT / 2;
+ length = half_led_num * bytes_per_led;
+ uint8_t data[length];
for (i = half_led_num + half_led_num - 1; i >= half_led_num; --i)
# elif defined(ERGODOX_LED_15_MIRROR)
+ length = led_num * bytes_per_led;
+ uint8_t data[length];
for (i = 0; i < led_num; ++i)
# else // ERGDOX_LED_15 non-mirrored
+ length = led_num * bytes_per_led;
+ uint8_t data[length];
for (i = led_num - 1; i >= 0; --i)
# endif
{
- uint8_t *data = (uint8_t *)(led + i);
- i2c_write(*data++, ERGODOX_EZ_I2C_TIMEOUT);
- i2c_write(*data++, ERGODOX_EZ_I2C_TIMEOUT);
- i2c_write(*data++, ERGODOX_EZ_I2C_TIMEOUT);
+ uint8_t *data_byte = (uint8_t *)(led + i);
+ data[j++] = data_byte[0];
+ data[j++] = data_byte[1];
+ data[j++] = data_byte[2];
#ifdef RGBW
- i2c_write(*data++, ERGODOX_EZ_I2C_TIMEOUT);
+ data[j++] = data_byte[3];
#endif
}
- i2c_stop();
+ i2c_transmit(0x84, data, sizeof(data), ERGODOX_EZ_I2C_TIMEOUT);
ws2812_setleds(led, led_num);
}
+const rgblight_driver_t rgblight_driver = {
+ .setleds = setleds_custom,
+};
#endif // RGBLIGHT_ENABLE