123 lines
4.7 KiB
C
123 lines
4.7 KiB
C
/*
|
|
* SPDX-FileCopyrightText: 2022 Espressif Systems (Shanghai) CO LTD
|
|
*
|
|
* SPDX-License-Identifier: Apache-2.0
|
|
*/
|
|
#include <stdlib.h>
|
|
#include <string.h>
|
|
#include <sys/cdefs.h>
|
|
#include "esp_log.h"
|
|
#include "esp_check.h"
|
|
#include "driver/rmt_tx.h"
|
|
#include "led_strip.h"
|
|
#include "led_strip_interface.h"
|
|
#include "led_strip_rmt_encoder.h"
|
|
|
|
#define LED_STRIP_RMT_DEFAULT_RESOLUTION 10000000 // 10MHz resolution
|
|
|
|
static const char *TAG = "led_strip_rmt";
|
|
|
|
typedef struct {
|
|
led_strip_t base;
|
|
rmt_channel_handle_t rmt_chan;
|
|
rmt_encoder_handle_t strip_encoder;
|
|
uint32_t strip_len;
|
|
uint8_t pixel_buf[];
|
|
} led_strip_rmt_obj;
|
|
|
|
static esp_err_t led_strip_rmt_set_pixel(led_strip_t *strip, uint32_t index, uint32_t red, uint32_t green, uint32_t blue)
|
|
{
|
|
led_strip_rmt_obj *rmt_strip = __containerof(strip, led_strip_rmt_obj, base);
|
|
ESP_RETURN_ON_FALSE(index < rmt_strip->strip_len, ESP_ERR_INVALID_ARG, TAG, "index out of maximum number of LEDs");
|
|
uint32_t start = index * 3;
|
|
// In thr order of GRB, as LED strip like WS2812 sends out pixels in this order
|
|
rmt_strip->pixel_buf[start + 0] = green & 0xFF;
|
|
rmt_strip->pixel_buf[start + 1] = red & 0xFF;
|
|
rmt_strip->pixel_buf[start + 2] = blue & 0xFF;
|
|
return ESP_OK;
|
|
}
|
|
|
|
static esp_err_t led_strip_rmt_refresh(led_strip_t *strip)
|
|
{
|
|
led_strip_rmt_obj *rmt_strip = __containerof(strip, led_strip_rmt_obj, base);
|
|
rmt_transmit_config_t tx_conf = {
|
|
.loop_count = 0,
|
|
};
|
|
|
|
ESP_RETURN_ON_ERROR(rmt_enable(rmt_strip->rmt_chan), TAG, "enable RMT channel failed");
|
|
ESP_RETURN_ON_ERROR(rmt_transmit(rmt_strip->rmt_chan, rmt_strip->strip_encoder, rmt_strip->pixel_buf,
|
|
rmt_strip->strip_len * 3, &tx_conf), TAG, "transmit pixels by RMT failed");
|
|
ESP_RETURN_ON_ERROR(rmt_tx_wait_all_done(rmt_strip->rmt_chan, -1), TAG, "flush RMT channel failed");
|
|
ESP_RETURN_ON_ERROR(rmt_disable(rmt_strip->rmt_chan), TAG, "disable RMT channel failed");
|
|
return ESP_OK;
|
|
}
|
|
|
|
static esp_err_t led_strip_rmt_clear(led_strip_t *strip)
|
|
{
|
|
led_strip_rmt_obj *rmt_strip = __containerof(strip, led_strip_rmt_obj, base);
|
|
// Write zero to turn off all leds
|
|
memset(rmt_strip->pixel_buf, 0, rmt_strip->strip_len * 3);
|
|
return led_strip_rmt_refresh(strip);
|
|
}
|
|
|
|
static esp_err_t led_strip_rmt_del(led_strip_t *strip)
|
|
{
|
|
led_strip_rmt_obj *rmt_strip = __containerof(strip, led_strip_rmt_obj, base);
|
|
ESP_RETURN_ON_ERROR(rmt_del_channel(rmt_strip->rmt_chan), TAG, "delete RMT channel failed");
|
|
ESP_RETURN_ON_ERROR(rmt_del_encoder(rmt_strip->strip_encoder), TAG, "delete strip encoder failed");
|
|
free(rmt_strip);
|
|
return ESP_OK;
|
|
}
|
|
|
|
esp_err_t led_strip_new_rmt_device(const led_strip_config_t *led_config, const led_strip_rmt_config_t *rmt_config, led_strip_handle_t *ret_strip)
|
|
{
|
|
led_strip_rmt_obj *rmt_strip = NULL;
|
|
esp_err_t ret = ESP_OK;
|
|
ESP_GOTO_ON_FALSE(led_config && rmt_config && ret_strip, ESP_ERR_INVALID_ARG, err, TAG, "invalid argument");
|
|
rmt_strip = calloc(1, sizeof(led_strip_rmt_obj) + led_config->max_leds * 3);
|
|
ESP_GOTO_ON_FALSE(rmt_strip, ESP_ERR_NO_MEM, err, TAG, "no mem for rmt strip");
|
|
uint32_t resolution = rmt_config->resolution_hz ? rmt_config->resolution_hz : LED_STRIP_RMT_DEFAULT_RESOLUTION;
|
|
|
|
// for backward compatibility, if the user does not set the clk_src, use the default value
|
|
rmt_clock_source_t clk_src = RMT_CLK_SRC_DEFAULT;
|
|
if (rmt_config->clk_src) {
|
|
clk_src = rmt_config->clk_src;
|
|
}
|
|
rmt_tx_channel_config_t rmt_chan_config = {
|
|
.clk_src = clk_src,
|
|
.gpio_num = led_config->strip_gpio_num,
|
|
.mem_block_symbols = 64,
|
|
.resolution_hz = resolution,
|
|
.trans_queue_depth = 4,
|
|
.flags.with_dma = rmt_config->flags.with_dma,
|
|
.flags.invert_out = led_config->flags.invert_out,
|
|
};
|
|
ESP_GOTO_ON_ERROR(rmt_new_tx_channel(&rmt_chan_config, &rmt_strip->rmt_chan), err, TAG, "create RMT TX channel failed");
|
|
|
|
led_strip_encoder_config_t strip_encoder_conf = {
|
|
.resolution = resolution,
|
|
};
|
|
ESP_GOTO_ON_ERROR(rmt_new_led_strip_encoder(&strip_encoder_conf, &rmt_strip->strip_encoder), err, TAG, "create LED strip encoder failed");
|
|
|
|
|
|
rmt_strip->strip_len = led_config->max_leds;
|
|
rmt_strip->base.set_pixel = led_strip_rmt_set_pixel;
|
|
rmt_strip->base.refresh = led_strip_rmt_refresh;
|
|
rmt_strip->base.clear = led_strip_rmt_clear;
|
|
rmt_strip->base.del = led_strip_rmt_del;
|
|
|
|
*ret_strip = &rmt_strip->base;
|
|
return ESP_OK;
|
|
err:
|
|
if (rmt_strip) {
|
|
if (rmt_strip->rmt_chan) {
|
|
rmt_del_channel(rmt_strip->rmt_chan);
|
|
}
|
|
if (rmt_strip->strip_encoder) {
|
|
rmt_del_encoder(rmt_strip->strip_encoder);
|
|
}
|
|
free(rmt_strip);
|
|
}
|
|
return ret;
|
|
}
|