zephyr/drivers/display/display_renesas_lcdc.c

682 lines
21 KiB
C

/*
* Copyright (c) 2023 Renesas Electronics Corporation
*
* SPDX-License-Identifier: Apache-2.0
*/
#define DT_DRV_COMPAT renesas_smartbond_display
#include <zephyr/drivers/pinctrl.h>
#include <zephyr/drivers/gpio.h>
#include <zephyr/irq.h>
#include <zephyr/kernel.h>
#include <zephyr/device.h>
#include <zephyr/drivers/clock_control.h>
#include <zephyr/drivers/clock_control/smartbond_clock_control.h>
#include <zephyr/drivers/display.h>
#include <zephyr/sys/util.h>
#include <zephyr/drivers/dma.h>
#include <da1469x_lcdc.h>
#include <DA1469xAB.h>
#include <da1469x_pd.h>
#include <zephyr/linker/devicetree_regions.h>
#include <zephyr/pm/device.h>
#include <zephyr/pm/policy.h>
#include <zephyr/logging/log.h>
LOG_MODULE_REGISTER(smartbond_display, CONFIG_DISPLAY_LOG_LEVEL);
#define SMARTBOND_IRQN DT_INST_IRQN(0)
#define SMARTBOND_IRQ_PRIO DT_INST_IRQ(0, priority)
#define LCDC_SMARTBOND_CLK_DIV(_freq) \
((32000000U % (_freq)) ? (96000000U / (_freq)) : (32000000U / (_freq)))
#define LCDC_SMARTBOND_IS_PLL_REQUIRED \
!!(32000000U % DT_PROP(DT_INST_CHILD(0, display_timings), clock_frequency))
#define DISPLAY_SMARTBOND_IS_DMA_PREFETCH_ENABLED \
DT_INST_ENUM_IDX_OR(0, dma_prefetch, 0)
#define LCDC_LAYER0_OFFSETX_REG_SET_FIELD(_field, _var, _val)\
((_var)) = \
((_var) & ~(LCDC_LCDC_LAYER0_OFFSETX_REG_ ## _field ## _Msk)) | \
(((_val) << LCDC_LCDC_LAYER0_OFFSETX_REG_ ## _field ## _Pos) & \
LCDC_LCDC_LAYER0_OFFSETX_REG_ ## _field ## _Msk)
#define DISPLAY_SMARTBOND_PIXEL_SIZE(inst) \
(DISPLAY_BITS_PER_PIXEL(DT_INST_PROP(inst, pixel_format)) / 8)
#if CONFIG_DISPLAY_RENESAS_LCDC_BUFFER_PSRAM
#define DISPLAY_BUFFER_LINKER_SECTION \
Z_GENERIC_SECTION(LINKER_DT_NODE_REGION_NAME(DT_NODELABEL(psram)))
#else
#define DISPLAY_BUFFER_LINKER_SECTION
#endif
struct display_smartbond_data {
/* Provide mutual exclusion when a display operation is requested. */
struct k_sem device_sem;
/* Frame update synchronization token */
struct k_sem sync_sem;
/* Flag indicating whether or not an underflow took place */
volatile bool underflow_flag;
/* Layer settings */
lcdc_smartbond_layer_cfg layer;
/* Frame buffer */
uint8_t *buffer;
/* DMA device */
const struct device *dma;
/* DMA configuration structures */
struct dma_config dma_cfg;
struct dma_block_config dma_block_cfg;
/* DMA memory transfer synchronization token */
struct k_sem dma_sync_sem;
/* Granted DMA channel used for memory transfers */
int dma_channel;
#if defined(CONFIG_PM_DEVICE)
ATOMIC_DEFINE(pm_policy_state_flag, 1);
#endif
};
struct display_smartbond_config {
/* Reference to device instance's pinctrl configurations */
const struct pinctrl_dev_config *pcfg;
/* Display ON/OFF GPIO */
const struct gpio_dt_spec disp;
/* Host controller's timing settings */
lcdc_smartbond_timing_cfg timing_cfg;
/* Parallel interface settings */
lcdc_smartbond_mode_cfg mode;
/* Background default color configuration */
lcdc_smartbond_bgcolor_cfg bgcolor_cfg;
/* Display dimensions */
const uint16_t x_res;
const uint16_t y_res;
/* Pixel size in bytes */
uint8_t pixel_size;
enum display_pixel_format pixel_format;
};
static inline void lcdc_smartbond_pm_policy_state_lock_get(struct display_smartbond_data *data)
{
#ifdef CONFIG_PM_DEVICE
if (atomic_test_and_set_bit(data->pm_policy_state_flag, 0) == 0) {
/*
* Prevent the SoC from etering the normal sleep state as PDC does not support
* waking up the application core following LCDC events.
*/
pm_policy_state_lock_get(PM_STATE_STANDBY, PM_ALL_SUBSTATES);
}
#endif
}
static inline void lcdc_smartbond_pm_policy_state_lock_put(struct display_smartbond_data *data)
{
#ifdef CONFIG_PM_DEVICE
if (atomic_test_and_clear_bit(data->pm_policy_state_flag, 0) == 1) {
/* Allow the SoC to enter the nornmal sleep state once LCDC is inactive */
pm_policy_state_lock_put(PM_STATE_STANDBY, PM_ALL_SUBSTATES);
}
#endif
}
/* Display pixel to layer color format translation */
static uint8_t lcdc_smartbond_pixel_to_lcm(enum display_pixel_format pixel_format)
{
switch (pixel_format) {
case PIXEL_FORMAT_RGB_565:
return (uint8_t)LCDC_SMARTBOND_L0_RGB565;
case PIXEL_FORMAT_ARGB_8888:
return (uint8_t)LCDC_SMARTBOND_L0_ARGB8888;
default:
LOG_ERR("Unsupported pixel format");
return 0;
};
}
static int display_smartbond_configure(const struct device *dev)
{
uint8_t clk_div =
LCDC_SMARTBOND_CLK_DIV(DT_PROP(DT_INST_CHILD(0, display_timings), clock_frequency));
const struct display_smartbond_config *config = dev->config;
struct display_smartbond_data *data = dev->data;
int ret = 0;
/* First enable the controller so registers can be written. */
da1469x_lcdc_set_status(true, LCDC_SMARTBOND_IS_PLL_REQUIRED, clk_div);
if (!da1469x_lcdc_check_id()) {
LOG_ERR("Invalid LCDC ID");
da1469x_lcdc_set_status(false, false, 0);
return -EINVAL;
}
da1469x_lcdc_parallel_interface_configure((lcdc_smartbond_mode_cfg *)&config->mode);
da1469x_lcdc_bgcolor_configure((lcdc_smartbond_bgcolor_cfg *)&config->bgcolor_cfg);
/*
* Partial update is not supported and so timing and layer settings can be configured
* once at initialization.
*/
ret = da1469x_lcdc_timings_configure(config->x_res, config->y_res,
(lcdc_smartbond_timing_cfg *)&config->timing_cfg);
if (ret < 0) {
LOG_ERR("Unable to configure timing settings");
da1469x_lcdc_set_status(false, false, 0);
return ret;
}
/*
* Stride should be updated at the end of a frame update (typically in ISR context).
* It's OK to update stride here as continuous mode should not be enabled yet.
*/
data->layer.color_format =
lcdc_smartbond_pixel_to_lcm(config->pixel_format);
data->layer.stride =
da1469x_lcdc_stride_calculation(data->layer.color_format, config->x_res);
ret = da1469x_lcdc_layer_configure(&data->layer);
if (ret < 0) {
LOG_ERR("Unable to configure layer settings");
da1469x_lcdc_set_status(false, false, 0);
}
LCDC_LAYER0_OFFSETX_REG_SET_FIELD(LCDC_L0_DMA_PREFETCH,
LCDC->LCDC_LAYER0_OFFSETX_REG, DISPLAY_SMARTBOND_IS_DMA_PREFETCH_ENABLED);
LCDC->LCDC_MODE_REG |= LCDC_LCDC_MODE_REG_LCDC_MODE_EN_Msk;
return ret;
}
static void smartbond_display_isr(const void *arg)
{
struct display_smartbond_data *data = ((const struct device *)arg)->data;
data->underflow_flag = LCDC_STATUS_REG_GET_FIELD(LCDC_STICKY_UNDERFLOW);
/*
* Underflow sticky bit will remain high until cleared by writing
* any value to LCDC_INTERRUPT_REG.
*/
LCDC->LCDC_INTERRUPT_REG &= ~LCDC_LCDC_INTERRUPT_REG_LCDC_VSYNC_IRQ_EN_Msk;
/* Notify that current frame update is completed */
k_sem_give(&data->sync_sem);
}
static void display_smartbond_dma_cb(const struct device *dma, void *arg,
uint32_t id, int status)
{
struct display_smartbond_data *data = arg;
if (status < 0) {
LOG_WRN("DMA transfer did not complete");
}
k_sem_give(&data->dma_sync_sem);
}
static int display_smartbond_dma_config(const struct device *dev)
{
struct display_smartbond_data *data = dev->data;
data->dma = DEVICE_DT_GET(DT_NODELABEL(dma));
if (!device_is_ready(data->dma)) {
LOG_ERR("DMA device is not ready");
return -ENODEV;
}
data->dma_cfg.channel_direction = MEMORY_TO_MEMORY;
data->dma_cfg.user_data = data;
data->dma_cfg.dma_callback = display_smartbond_dma_cb;
data->dma_cfg.block_count = 1;
data->dma_cfg.head_block = &data->dma_block_cfg;
data->dma_cfg.error_callback_dis = 1;
/* Request an arbitrary DMA channel */
data->dma_channel = dma_request_channel(data->dma, NULL);
if (data->dma_channel < 0) {
LOG_ERR("Could not acquire a DMA channel");
return -EIO;
}
return 0;
}
static int display_smartbond_resume(const struct device *dev)
{
const struct display_smartbond_config *config = dev->config;
int ret;
/* Select default state */
ret = pinctrl_apply_state(config->pcfg, PINCTRL_STATE_DEFAULT);
if (ret < 0) {
LOG_ERR("Could not apply LCDC pins' default state (%d)", ret);
return -EIO;
}
#if LCDC_SMARTBOND_IS_PLL_REQUIRED
const struct device *clock_dev = DEVICE_DT_GET(DT_NODELABEL(osc));
if (!device_is_ready(clock_dev)) {
LOG_WRN("Clock device is not ready");
return -ENODEV;
}
ret = z_smartbond_select_sys_clk(SMARTBOND_CLK_PLL96M);
if (ret < 0) {
LOG_WRN("Could not switch to PLL");
return -EIO;
}
#endif
ret = display_smartbond_dma_config(dev);
if (ret < 0) {
return ret;
}
return display_smartbond_configure(dev);
}
#if defined(CONFIG_PM_DEVICE)
static void display_smartbond_dma_deconfig(const struct device *dev)
{
struct display_smartbond_data *data = dev->data;
__ASSERT(data->dma, "DMA should be already initialized");
dma_release_channel(data->dma, data->dma_channel);
}
static int display_smartbond_suspend(const struct device *dev)
{
const struct display_smartbond_config *config = dev->config;
int ret;
/* Select sleep state; it's OK if settings fails for any reason */
ret = pinctrl_apply_state(config->pcfg, PINCTRL_STATE_SLEEP);
if (ret < 0) {
LOG_WRN("Could not apply DISPLAY pins' sleep state");
}
/* Disable host controller to minimize power consumption */
da1469x_lcdc_set_status(false, false, 0);
display_smartbond_dma_deconfig(dev);
return 0;
}
#endif
static int display_smartbond_init(const struct device *dev)
{
const struct display_smartbond_config *config = dev->config;
struct display_smartbond_data *data = dev->data;
int ret;
/* Device should be ready to be acquired */
k_sem_init(&data->device_sem, 1, 1);
/* Event should be signaled by LCDC ISR */
k_sem_init(&data->sync_sem, 0, 1);
/* Event should be signaled by DMA ISR */
k_sem_init(&data->dma_sync_sem, 0, 1);
/* As per docs, display port should be enabled by default. */
if (gpio_is_ready_dt(&config->disp)) {
ret = gpio_pin_configure_dt(&config->disp, GPIO_OUTPUT_ACTIVE);
if (ret < 0) {
LOG_ERR("Could not activate display port");
return -EIO;
}
}
IRQ_CONNECT(SMARTBOND_IRQN, SMARTBOND_IRQ_PRIO, smartbond_display_isr,
DEVICE_DT_INST_GET(0), 0);
/*
* Currently, there is no API to explicitly enable/disable the display controller.
* At the same time, the controller is set to continuous mode meaning that
* as long as a display panel is turned on, frame updates should happen all
* the time (otherwise contents on the display pane will be lost as the latter
* does not integrate an SDRAM memory to keep its frame).
* As such, resume/suspend operations are bound to blanking operations.
* That is, when the display is blanked on we can safely consider that display
* is no longer functional and thus, the controller can be suspended (allowing the
* SoC to enter the sleep state). Once the display is blanked off, then we consider
* that the controller should be resumed and sleep should be prevented at all
* (this is because the controller is powered by the same power domain used to
* power the application core). Side effect of the above is that the controller
* should be configured at initialization phase as display operations might
* be requested before the display is blanked off for the very first time.
*/
ret = display_smartbond_resume(dev);
if (ret == 0) {
/* Display port should be enabled at this moment and so sleep is not allowed. */
lcdc_smartbond_pm_policy_state_lock_get(data);
}
return ret;
}
static int display_smartbond_blanking_on(const struct device *dev)
{
const struct display_smartbond_config *config = dev->config;
struct display_smartbond_data *data = dev->data;
int ret = 0;
k_sem_take(&data->device_sem, K_FOREVER);
/*
* This bit will force LCD controller's output to blank that is,
* the controller will keep operating without outputting any
* pixel data.
*/
LCDC->LCDC_MODE_REG |= LCDC_LCDC_MODE_REG_LCDC_FORCE_BLANK_Msk;
/* If enabled, disable display port. */
if (gpio_is_ready_dt(&config->disp)) {
ret = gpio_pin_configure_dt(&config->disp, GPIO_OUTPUT_INACTIVE);
if (ret < 0) {
LOG_WRN("Display port could not be de-activated");
}
}
/*
* At this moment the display panel should be turned off and so the device
* can enter the suspend state.
*/
lcdc_smartbond_pm_policy_state_lock_put(data);
k_sem_give(&data->device_sem);
return ret;
}
static int display_smartbond_blanking_off(const struct device *dev)
{
const struct display_smartbond_config *config = dev->config;
struct display_smartbond_data *data = dev->data;
int ret = 0;
k_sem_take(&data->device_sem, K_FOREVER);
/* If used, enable display port */
if (gpio_is_ready_dt(&config->disp)) {
ret = gpio_pin_configure_dt(&config->disp, GPIO_OUTPUT_ACTIVE);
if (ret < 0) {
LOG_WRN("Display port could not be activated");
}
}
/*
* This bit will force LCD controller's output to blank that is,
* the controller will keep operating without outputting any
* pixel data.
*/
LCDC->LCDC_MODE_REG &= ~LCDC_LCDC_MODE_REG_LCDC_FORCE_BLANK_Msk;
/*
* At this moment the display should be turned on and so the device
* cannot enter the suspend state.
*/
lcdc_smartbond_pm_policy_state_lock_get(data);
k_sem_give(&data->device_sem);
return ret;
}
static void *display_smartbond_get_framebuffer(const struct device *dev)
{
struct display_smartbond_data *data = dev->data;
return ((void *)data->buffer);
}
static void display_smartbond_get_capabilities(const struct device *dev,
struct display_capabilities *capabilities)
{
memset(capabilities, 0, sizeof(*capabilities));
/*
* Multiple color formats should be supported by LCDC. Currently, RGB56 and ARGB888
* exposed by display API are supported. In the future we should consider supporting
* more color formats which should require changes in LVGL porting.
* Here, only one color format should be supported as the frame buffer is accessed
* directly by LCDC and is allocated statically during device initialization. The color
* format is defined based on the pixel-format property dictated by lcd-controller
* bindings.
*/
capabilities->supported_pixel_formats = DT_INST_PROP(0, pixel_format);
capabilities->current_orientation = DISPLAY_ORIENTATION_NORMAL;
capabilities->current_pixel_format = DT_INST_PROP(0, pixel_format);
capabilities->x_resolution = DT_INST_PROP(0, width);
capabilities->y_resolution = DT_INST_PROP(0, height);
}
static int display_smartbond_read(const struct device *dev,
const uint16_t x, const uint16_t y,
const struct display_buffer_descriptor *desc,
void *buf)
{
struct display_smartbond_data *data = dev->data;
const struct display_smartbond_config *config = dev->config;
uint8_t *dst = buf;
const uint8_t *src = data->buffer;
k_sem_take(&data->device_sem, K_FOREVER);
/* pointer to upper left pixel of the rectangle */
src += (x * config->pixel_size);
src += (y * data->layer.stride);
data->dma_block_cfg.block_size = desc->width * config->pixel_size;
/*
* Source and destination base address is word aligned.
* Data size should be selected based on color depth as
* cursor is shifted multiple of pixel color depth.
*/
data->dma_cfg.source_data_size = data->dma_cfg.dest_data_size =
!(config->pixel_size & 3) ? 4 :
!(config->pixel_size & 1) ? 2 : 1;
data->dma_cfg.dest_burst_length = data->dma_cfg.source_burst_length =
!((data->dma_block_cfg.block_size / data->dma_cfg.source_data_size) & 7) ? 8 :
!((data->dma_block_cfg.block_size / data->dma_cfg.source_data_size) & 3) ? 4 : 1;
for (int row = 0; row < desc->height; row++) {
data->dma_block_cfg.dest_address = (uint32_t)dst;
data->dma_block_cfg.source_address = (uint32_t)src;
if (dma_config(data->dma, data->dma_channel, &data->dma_cfg)) {
LOG_ERR("Could not configure DMA");
k_sem_give(&data->device_sem);
return -EIO;
}
if (dma_start(data->dma, data->dma_channel)) {
LOG_ERR("Could not start DMA");
k_sem_give(&data->device_sem);
return -EIO;
}
k_sem_take(&data->dma_sync_sem, K_FOREVER);
src += data->layer.stride;
dst += (desc->pitch * config->pixel_size);
}
if (dma_stop(data->dma, data->dma_channel)) {
LOG_WRN("Could not stop DMA");
}
k_sem_give(&data->device_sem);
return 0;
}
static int display_smartbond_write(const struct device *dev,
const uint16_t x, const uint16_t y,
const struct display_buffer_descriptor *desc,
const void *buf)
{
struct display_smartbond_data *data = dev->data;
const struct display_smartbond_config *config = dev->config;
uint8_t *dst = data->buffer;
const uint8_t *src = buf;
k_sem_take(&data->device_sem, K_FOREVER);
/* pointer to upper left pixel of the rectangle */
dst += (x * config->pixel_size);
dst += (y * data->layer.stride);
/*
* Wait for the current frame to finish. Do not disable continuous mode as this
* will have visual artifacts.
*/
LCDC->LCDC_INTERRUPT_REG |= LCDC_LCDC_INTERRUPT_REG_LCDC_VSYNC_IRQ_EN_Msk;
k_sem_take(&data->sync_sem, K_FOREVER);
data->dma_block_cfg.block_size = desc->width * config->pixel_size;
/*
* Source and destination base address is word aligned.
* Data size should be selected based on color depth as
* cursor is shifted multiple of pixel color depth.
*/
data->dma_cfg.source_data_size = data->dma_cfg.dest_data_size =
!(config->pixel_size & 3) ? 4 :
!(config->pixel_size & 1) ? 2 : 1;
data->dma_cfg.dest_burst_length = data->dma_cfg.source_burst_length =
!((data->dma_block_cfg.block_size / data->dma_cfg.source_data_size) & 7) ? 8 :
!((data->dma_block_cfg.block_size / data->dma_cfg.source_data_size) & 3) ? 4 : 1;
for (int row = 0; row < desc->height; row++) {
data->dma_block_cfg.dest_address = (uint32_t)dst;
data->dma_block_cfg.source_address = (uint32_t)src;
if (dma_config(data->dma, data->dma_channel, &data->dma_cfg)) {
LOG_ERR("Could not configure DMA");
k_sem_give(&data->device_sem);
return -EIO;
}
if (dma_start(data->dma, data->dma_channel)) {
LOG_ERR("Could not start DMA");
k_sem_give(&data->device_sem);
return -EIO;
}
k_sem_take(&data->dma_sync_sem, K_FOREVER);
dst += data->layer.stride;
src += (desc->pitch * config->pixel_size);
}
if (dma_stop(data->dma, data->dma_channel)) {
LOG_WRN("Could not stop DMA");
}
k_sem_give(&data->device_sem);
return 0;
}
#if defined(CONFIG_PM_DEVICE)
static int display_smartbond_pm_action(const struct device *dev, enum pm_device_action action)
{
int ret = 0;
switch (action) {
case PM_DEVICE_ACTION_SUSPEND:
/* A non-zero value should not affect sleep */
(void)display_smartbond_suspend(dev);
break;
case PM_DEVICE_ACTION_RESUME:
/*
* The resume error code should not be taken into consideration
* by the PM subsystem
*/
ret = display_smartbond_resume(dev);
break;
default:
ret = -ENOTSUP;
}
return ret;
}
#endif
static const struct display_driver_api display_smartbond_driver_api = {
.write = display_smartbond_write,
.read = display_smartbond_read,
.get_framebuffer = display_smartbond_get_framebuffer,
.get_capabilities = display_smartbond_get_capabilities,
.blanking_off = display_smartbond_blanking_off,
.blanking_on = display_smartbond_blanking_on
};
#define SMARTBOND_DISPLAY_INIT(inst) \
PINCTRL_DT_INST_DEFINE(inst); \
PM_DEVICE_DT_INST_DEFINE(inst, display_smartbond_pm_action); \
\
__aligned(4) static uint8_t buffer_ ## inst[(((DT_INST_PROP(inst, width) * \
DISPLAY_SMARTBOND_PIXEL_SIZE(inst)) + 0x3) & ~0x3) * \
DT_INST_PROP(inst, height)] DISPLAY_BUFFER_LINKER_SECTION; \
\
static const struct display_smartbond_config display_smartbond_config_## inst = { \
.pcfg = PINCTRL_DT_INST_DEV_CONFIG_GET(inst), \
.disp = GPIO_DT_SPEC_INST_GET_OR(inst, disp_gpios, {}), \
.timing_cfg.vsync_len = \
DT_PROP(DT_INST_CHILD(inst, display_timings), vsync_len), \
.timing_cfg.hsync_len = \
DT_PROP(DT_INST_CHILD(inst, display_timings), hsync_len), \
.timing_cfg.hfront_porch = \
DT_PROP(DT_INST_CHILD(inst, display_timings), hfront_porch), \
.timing_cfg.vfront_porch = \
DT_PROP(DT_INST_CHILD(inst, display_timings), vfront_porch), \
.timing_cfg.hback_porch = \
DT_PROP(DT_INST_CHILD(inst, display_timings), hback_porch), \
.timing_cfg.vback_porch = \
DT_PROP(DT_INST_CHILD(inst, display_timings), vback_porch), \
.bgcolor_cfg = {0xFF, 0xFF, 0xFF, 0}, \
.x_res = DT_INST_PROP(inst, width), \
.y_res = DT_INST_PROP(inst, height), \
.pixel_size = DISPLAY_SMARTBOND_PIXEL_SIZE(inst), \
.pixel_format = DT_INST_PROP(0, pixel_format), \
.mode.vsync_pol = \
DT_PROP(DT_INST_CHILD(inst, display_timings), vsync_active) ? 0 : 1, \
.mode.hsync_pol = \
DT_PROP(DT_INST_CHILD(inst, display_timings), vsync_active) ? 0 : 1, \
.mode.de_pol = \
DT_PROP(DT_INST_CHILD(inst, display_timings), de_active) ? 0 : 1, \
.mode.pixelclk_pol = \
DT_PROP(DT_INST_CHILD(inst, display_timings), pixelclk_active) ? 0 : 1, \
}; \
\
static struct display_smartbond_data display_smartbond_data_## inst = { \
.buffer = buffer_ ##inst, \
.layer.start_x = 0, \
.layer.start_y = 0, \
.layer.size_x = DT_INST_PROP(inst, width), \
.layer.size_y = DT_INST_PROP(inst, height), \
.layer.frame_buf = (uint32_t)buffer_ ## inst, \
}; \
\
\
DEVICE_DT_INST_DEFINE(inst, display_smartbond_init, PM_DEVICE_DT_INST_GET(inst), \
&display_smartbond_data_## inst, \
&display_smartbond_config_## inst, \
POST_KERNEL, \
CONFIG_DISPLAY_INIT_PRIORITY, \
&display_smartbond_driver_api);
SMARTBOND_DISPLAY_INIT(0);