87 lines
2.4 KiB
C
87 lines
2.4 KiB
C
|
/*
|
||
|
|
* light weight WS2812 lib V2.0b
|
||
|
|
*
|
||
|
|
* Controls WS2811/WS2812/WS2812B RGB-LEDs
|
||
|
|
* Author: Tim (cpldcpu@gmail.com)
|
||
|
|
*
|
||
|
|
* Jan 18th, 2014 v2.0b Initial Version
|
||
|
|
* Nov 29th, 2015 v2.3 Added SK6812RGBW support
|
||
|
|
*
|
||
|
|
* This program is free software: you can redistribute it and/or modify
|
||
|
|
* it under the terms of the GNU General Public License as published by
|
||
|
|
* the Free Software Foundation, either version 2 of the License, or
|
||
|
|
* (at your option) any later version.
|
||
|
|
*
|
||
|
|
* This program is distributed in the hope that it will be useful,
|
||
|
|
* but WITHOUT ANY WARRANTY; without even the implied warranty of
|
||
|
|
* MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE. See the
|
||
|
|
* GNU General Public License for more details.
|
||
|
|
*
|
||
|
|
* You should have received a copy of the GNU General Public License
|
||
|
|
* along with this program. If not, see <http://www.gnu.org/licenses/>.
|
||
|
|
*/
|
||
|
|
#ifdef RGBLIGHT_ENABLE
|
||
|
|
|
||
|
|
# include "ws2812.c"
|
||
|
|
# include "ergodox_ez.h"
|
||
|
|
|
||
|
|
extern rgblight_config_t rgblight_config;
|
||
|
|
|
||
|
|
/*
|
||
|
|
* Forward declare internal functions
|
||
|
|
*
|
||
|
|
* The functions take a byte-array and send to the data output as WS2812 bitstream.
|
||
|
|
* The length is the number of bytes to send - three per LED.
|
||
|
|
*/
|
||
|
|
|
||
|
|
void ws2812_sendarray(uint8_t *array, uint16_t length);
|
||
|
|
void ws2812_sendarray_mask(uint8_t *array, uint16_t length, uint8_t pinmask);
|
||
|
|
|
||
|
|
|
||
|
|
|
||
|
|
|
||
|
|
void rgblight_set(void) {
|
||
|
|
if (!rgblight_config.enable) {
|
||
|
|
for (uint8_t i = 0; i < RGBLED_NUM; i++) {
|
||
|
|
led[i].r = 0;
|
||
|
|
led[i].g = 0;
|
||
|
|
led[i].b = 0;
|
||
|
|
#ifdef RGBW
|
||
|
|
led[i].w = 0;
|
||
|
|
#endif
|
||
|
|
}
|
||
|
|
}
|
||
|
|
|
||
|
|
|
||
|
|
uint8_t led_num = RGBLED_NUM;
|
||
|
|
i2c_init();
|
||
|
|
i2c_start(0x84, ERGODOX_EZ_I2C_TIMEOUT);
|
||
|
|
int i = 0;
|
||
|
|
# 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.
|
||
|
|
led_num = RGBLED_NUM / 2;
|
||
|
|
for (i = led_num + led_num - 1; i >= led_num; --i)
|
||
|
|
# elif defined(ERGODOX_LED_15_MIRROR)
|
||
|
|
for (i = 0; i < led_num; ++i)
|
||
|
|
# else // ERGDOX_LED_15 non-mirrored
|
||
|
|
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);
|
||
|
|
#ifdef RGBW
|
||
|
|
i2c_write(*data++, ERGODOX_EZ_I2C_TIMEOUT);
|
||
|
|
#endif
|
||
|
|
}
|
||
|
|
i2c_stop();
|
||
|
|
|
||
|
|
ws2812_setleds(led, RGBLED_NUM);
|
||
|
|
}
|
||
|
|
|
||
|
|
|
||
|
|
#endif // RGBLIGHT_ENABLE
|