esp_ws28xx/esp_ws28xx.c

117 lines
3.8 KiB
C
Raw Normal View History

2023-07-16 12:06:00 +03:00
#include "esp_ws28xx.h"
2023-09-21 13:50:26 +03:00
uint16_t *dma_buffer;
CRGB *ws28xx_pixels;
2023-09-21 03:04:42 +03:00
static int n_of_leds, reset_delay, dma_buf_size;
2023-07-16 12:06:00 +03:00
led_strip_model_t led_model;
2023-09-21 13:50:26 +03:00
static spi_settings_t spi_settings = {
.host = SPI2_HOST,
.dma_chan = SPI_DMA_CH_AUTO,
.buscfg =
{
.miso_io_num = -1,
.sclk_io_num = -1,
.quadwp_io_num = -1,
.quadhd_io_num = -1,
},
.devcfg =
{
.clock_speed_hz = 3.2 * 1000 * 1000, // Clock out at 3.2 MHz
.mode = 0, // SPI mode 0
.spics_io_num = -1, // CS pin
.queue_size = 1,
.command_bits = 0,
.address_bits = 0,
.flags = SPI_DEVICE_TXBIT_LSBFIRST,
},
};
2023-07-16 12:06:00 +03:00
2023-09-21 13:50:26 +03:00
static const uint16_t timing_bits[16] = {
0x1111, 0x7111, 0x1711, 0x7711, 0x1171, 0x7171, 0x1771, 0x7771,
0x1117, 0x7117, 0x1717, 0x7717, 0x1177, 0x7177, 0x1777, 0x7777};
esp_err_t ws28xx_init(int pin, led_strip_model_t model, int num_of_leds,
CRGB **led_buffer_ptr) {
2023-09-21 05:04:24 +03:00
esp_err_t err = ESP_OK;
n_of_leds = num_of_leds;
led_model = model;
// Insrease if something breaks. values are less than recommended in
// datasheets but seem stable
reset_delay = (model == WS2812B) ? 3 : 30;
2023-09-21 13:50:26 +03:00
// 12 bytes for each led + bytes for initial zero and reset state
dma_buf_size = n_of_leds * 12 + (reset_delay + 1) * 2;
2023-09-21 05:04:24 +03:00
ws28xx_pixels = malloc(sizeof(CRGB) * n_of_leds);
if (ws28xx_pixels == NULL) {
return ESP_ERR_NO_MEM;
}
*led_buffer_ptr = ws28xx_pixels;
spi_settings.buscfg.mosi_io_num = pin;
spi_settings.buscfg.max_transfer_sz = dma_buf_size;
2023-09-21 13:50:26 +03:00
err = spi_bus_initialize(spi_settings.host, &spi_settings.buscfg,
spi_settings.dma_chan);
2023-09-21 05:04:24 +03:00
if (err != ESP_OK) {
free(ws28xx_pixels);
return err;
}
2023-09-21 13:50:26 +03:00
err = spi_bus_add_device(spi_settings.host, &spi_settings.devcfg,
&spi_settings.spi);
2023-09-21 05:04:24 +03:00
if (err != ESP_OK) {
free(ws28xx_pixels);
return err;
}
2023-09-21 13:50:26 +03:00
// Critical to be DMA memory.
dma_buffer = heap_caps_malloc(dma_buf_size, MALLOC_CAP_DMA);
2023-09-21 05:04:24 +03:00
if (dma_buffer == NULL) {
free(ws28xx_pixels);
return ESP_ERR_NO_MEM;
}
return ESP_OK;
2023-07-16 12:06:00 +03:00
}
2023-09-21 03:04:42 +03:00
void ws28xx_fill_all(CRGB color) {
2023-09-21 05:04:24 +03:00
for (int i = 0; i < n_of_leds; i++) {
ws28xx_pixels[i] = color;
}
2023-07-16 12:06:00 +03:00
}
esp_err_t ws28xx_update() {
2023-09-21 05:04:24 +03:00
esp_err_t err;
int n = 0;
memset(dma_buffer, 0, dma_buf_size);
dma_buffer[n++] = 0;
for (int i = 0; i < n_of_leds; i++) {
2023-09-21 13:50:26 +03:00
// Data you want to write to each LEDs
uint32_t temp = ws28xx_pixels[i].num;
2023-09-21 05:04:24 +03:00
if (led_model == WS2815) {
// Red
dma_buffer[n++] = timing_bits[0x0f & (temp >> 4)];
dma_buffer[n++] = timing_bits[0x0f & (temp)];
2023-07-16 12:06:00 +03:00
2023-09-21 05:04:24 +03:00
// Green
dma_buffer[n++] = timing_bits[0x0f & (temp >> 12)];
dma_buffer[n++] = timing_bits[0x0f & (temp) >> 8];
} else {
// Green
dma_buffer[n++] = timing_bits[0x0f & (temp >> 12)];
dma_buffer[n++] = timing_bits[0x0f & (temp) >> 8];
2023-07-16 12:06:00 +03:00
2023-09-21 05:04:24 +03:00
// Red
dma_buffer[n++] = timing_bits[0x0f & (temp >> 4)];
dma_buffer[n++] = timing_bits[0x0f & (temp)];
}
// Blue
dma_buffer[n++] = timing_bits[0x0f & (temp >> 20)];
dma_buffer[n++] = timing_bits[0x0f & (temp) >> 16];
}
for (int i = 0; i < reset_delay; i++) {
dma_buffer[n++] = 0;
2023-09-21 03:04:42 +03:00
}
2023-07-16 12:06:00 +03:00
2023-09-21 05:04:24 +03:00
err = spi_device_transmit(spi_settings.spi, &(spi_transaction_t){
.length = dma_buf_size * 8,
.tx_buffer = dma_buffer,
});
return err;
2023-07-16 12:06:00 +03:00
}