| /* |
| * Copyright (c) 2018 Jan Van Winkel <jan.van_winkel@dxplore.eu> |
| * Copyright (c) 2021 Nordic Semiconductor |
| * |
| * SPDX-License-Identifier: Apache-2.0 |
| */ |
| |
| #define DT_DRV_COMPAT zephyr_sdl_dc |
| |
| #include <zephyr/drivers/display.h> |
| |
| #include <string.h> |
| #include <soc.h> |
| #include <zephyr/sys/byteorder.h> |
| #include "display_sdl_bottom.h" |
| |
| #define LOG_LEVEL CONFIG_DISPLAY_LOG_LEVEL |
| #include <zephyr/logging/log.h> |
| LOG_MODULE_REGISTER(display_sdl); |
| |
| struct sdl_display_config { |
| uint16_t height; |
| uint16_t width; |
| }; |
| |
| struct sdl_display_data { |
| void *window; |
| void *renderer; |
| void *texture; |
| bool display_on; |
| enum display_pixel_format current_pixel_format; |
| uint8_t *buf; |
| }; |
| |
| static int sdl_display_init(const struct device *dev) |
| { |
| const struct sdl_display_config *config = dev->config; |
| struct sdl_display_data *disp_data = dev->data; |
| LOG_DBG("Initializing display driver"); |
| |
| disp_data->current_pixel_format = |
| #if defined(CONFIG_SDL_DISPLAY_DEFAULT_PIXEL_FORMAT_RGB_888) |
| PIXEL_FORMAT_RGB_888 |
| #elif defined(CONFIG_SDL_DISPLAY_DEFAULT_PIXEL_FORMAT_MONO01) |
| PIXEL_FORMAT_MONO01 |
| #elif defined(CONFIG_SDL_DISPLAY_DEFAULT_PIXEL_FORMAT_MONO10) |
| PIXEL_FORMAT_MONO10 |
| #elif defined(CONFIG_SDL_DISPLAY_DEFAULT_PIXEL_FORMAT_RGB_565) |
| PIXEL_FORMAT_RGB_565 |
| #elif defined(CONFIG_SDL_DISPLAY_DEFAULT_PIXEL_FORMAT_BGR_565) |
| PIXEL_FORMAT_BGR_565 |
| #else /* SDL_DISPLAY_DEFAULT_PIXEL_FORMAT */ |
| PIXEL_FORMAT_ARGB_8888 |
| #endif /* SDL_DISPLAY_DEFAULT_PIXEL_FORMAT */ |
| ; |
| |
| int rc = sdl_display_init_bottom(config->height, config->width, &disp_data->window, |
| &disp_data->renderer, &disp_data->texture); |
| |
| if (rc != 0) { |
| LOG_ERR("Failed to create SDL display"); |
| return -EIO; |
| } |
| |
| disp_data->display_on = false; |
| |
| return 0; |
| } |
| |
| static void sdl_display_write_argb8888(void *disp_buf, |
| const struct display_buffer_descriptor *desc, const void *buf) |
| { |
| __ASSERT((desc->pitch * 4U * desc->height) <= desc->buf_size, |
| "Input buffer to small"); |
| |
| memcpy(disp_buf, buf, desc->pitch * 4U * desc->height); |
| } |
| |
| static void sdl_display_write_rgb888(uint8_t *disp_buf, |
| const struct display_buffer_descriptor *desc, const void *buf) |
| { |
| uint32_t w_idx; |
| uint32_t h_idx; |
| uint32_t pixel; |
| const uint8_t *byte_ptr; |
| |
| __ASSERT((desc->pitch * 3U * desc->height) <= desc->buf_size, |
| "Input buffer to small"); |
| |
| for (h_idx = 0U; h_idx < desc->height; ++h_idx) { |
| for (w_idx = 0U; w_idx < desc->width; ++w_idx) { |
| byte_ptr = (const uint8_t *)buf + |
| ((h_idx * desc->pitch) + w_idx) * 3U; |
| pixel = *byte_ptr << 16; |
| pixel |= *(byte_ptr + 1) << 8; |
| pixel |= *(byte_ptr + 2); |
| *((uint32_t *)disp_buf) = pixel; |
| disp_buf += 4; |
| } |
| } |
| } |
| |
| static void sdl_display_write_rgb565(uint8_t *disp_buf, |
| const struct display_buffer_descriptor *desc, const void *buf) |
| { |
| uint32_t w_idx; |
| uint32_t h_idx; |
| uint32_t pixel; |
| const uint16_t *pix_ptr; |
| uint16_t rgb565; |
| |
| __ASSERT((desc->pitch * 2U * desc->height) <= desc->buf_size, |
| "Input buffer to small"); |
| |
| for (h_idx = 0U; h_idx < desc->height; ++h_idx) { |
| for (w_idx = 0U; w_idx < desc->width; ++w_idx) { |
| pix_ptr = (const uint16_t *)buf + |
| ((h_idx * desc->pitch) + w_idx); |
| rgb565 = sys_be16_to_cpu(*pix_ptr); |
| pixel = (((rgb565 >> 11) & 0x1F) * 255 / 31) << 16; |
| pixel |= (((rgb565 >> 5) & 0x3F) * 255 / 63) << 8; |
| pixel |= (rgb565 & 0x1F) * 255 / 31; |
| *((uint32_t *)disp_buf) = pixel; |
| disp_buf += 4; |
| } |
| } |
| } |
| |
| static void sdl_display_write_bgr565(uint8_t *disp_buf, |
| const struct display_buffer_descriptor *desc, const void *buf) |
| { |
| uint32_t w_idx; |
| uint32_t h_idx; |
| uint32_t pixel; |
| const uint16_t *pix_ptr; |
| |
| __ASSERT((desc->pitch * 2U * desc->height) <= desc->buf_size, |
| "Input buffer to small"); |
| |
| for (h_idx = 0U; h_idx < desc->height; ++h_idx) { |
| for (w_idx = 0U; w_idx < desc->width; ++w_idx) { |
| pix_ptr = (const uint16_t *)buf + |
| ((h_idx * desc->pitch) + w_idx); |
| pixel = (((*pix_ptr >> 11) & 0x1F) * 255 / 31) << 16; |
| pixel |= (((*pix_ptr >> 5) & 0x3F) * 255 / 63) << 8; |
| pixel |= (*pix_ptr & 0x1F) * 255 / 31; |
| *((uint32_t *)disp_buf) = pixel; |
| disp_buf += 4; |
| } |
| } |
| } |
| |
| static void sdl_display_write_mono(uint8_t *disp_buf, |
| const struct display_buffer_descriptor *desc, const void *buf, |
| const bool one_is_black) |
| { |
| uint32_t w_idx; |
| uint32_t h_idx; |
| uint32_t tile_idx; |
| uint32_t pixel; |
| const uint8_t *byte_ptr; |
| uint32_t one_color; |
| uint8_t *disp_buf_start; |
| |
| __ASSERT((desc->pitch * desc->height) <= (desc->buf_size * 8U), |
| "Input buffer to small"); |
| __ASSERT((desc->height % 8) == 0U, |
| "Input buffer height not aligned per 8 pixels"); |
| |
| if (one_is_black) { |
| one_color = 0U; |
| } else { |
| one_color = 0x00FFFFFF; |
| } |
| |
| for (tile_idx = 0U; tile_idx < desc->height/8U; ++tile_idx) { |
| for (w_idx = 0U; w_idx < desc->width; ++w_idx) { |
| byte_ptr = (const uint8_t *)buf + |
| ((tile_idx * desc->pitch) + w_idx); |
| disp_buf_start = disp_buf; |
| for (h_idx = 0U; h_idx < 8; ++h_idx) { |
| if ((*byte_ptr & BIT(7-h_idx)) != 0U) { |
| pixel = one_color; |
| } else { |
| pixel = (~one_color) & 0x00FFFFFF; |
| } |
| *((uint32_t *)disp_buf) = pixel; |
| disp_buf += (desc->width * 4U); |
| } |
| disp_buf = disp_buf_start; |
| disp_buf += 4; |
| } |
| disp_buf += 7 * (desc->width * 4U); |
| } |
| } |
| |
| static int sdl_display_write(const struct device *dev, const uint16_t x, |
| const uint16_t y, |
| const struct display_buffer_descriptor *desc, |
| const void *buf) |
| { |
| const struct sdl_display_config *config = dev->config; |
| struct sdl_display_data *disp_data = dev->data; |
| |
| LOG_DBG("Writing %dx%d (w,h) bitmap @ %dx%d (x,y)", desc->width, |
| desc->height, x, y); |
| |
| __ASSERT(desc->width <= desc->pitch, "Pitch is smaller then width"); |
| __ASSERT(desc->pitch <= config->width, |
| "Pitch in descriptor is larger than screen size"); |
| __ASSERT(desc->height <= config->height, |
| "Height in descriptor is larger than screen size"); |
| __ASSERT(x + desc->pitch <= config->width, |
| "Writing outside screen boundaries in horizontal direction"); |
| __ASSERT(y + desc->height <= config->height, |
| "Writing outside screen boundaries in vertical direction"); |
| |
| if (desc->width > desc->pitch || |
| x + desc->pitch > config->width || |
| y + desc->height > config->height) { |
| return -EINVAL; |
| } |
| |
| if (disp_data->current_pixel_format == PIXEL_FORMAT_ARGB_8888) { |
| sdl_display_write_argb8888(disp_data->buf, desc, buf); |
| } else if (disp_data->current_pixel_format == PIXEL_FORMAT_RGB_888) { |
| sdl_display_write_rgb888(disp_data->buf, desc, buf); |
| } else if (disp_data->current_pixel_format == PIXEL_FORMAT_MONO10) { |
| sdl_display_write_mono(disp_data->buf, desc, buf, true); |
| } else if (disp_data->current_pixel_format == PIXEL_FORMAT_MONO01) { |
| sdl_display_write_mono(disp_data->buf, desc, buf, false); |
| } else if (disp_data->current_pixel_format == PIXEL_FORMAT_RGB_565) { |
| sdl_display_write_rgb565(disp_data->buf, desc, buf); |
| } else if (disp_data->current_pixel_format == PIXEL_FORMAT_BGR_565) { |
| sdl_display_write_bgr565(disp_data->buf, desc, buf); |
| } |
| |
| sdl_display_write_bottom(desc->height, desc->width, x, y, |
| disp_data->renderer, disp_data->texture, |
| disp_data->buf, disp_data->display_on); |
| |
| return 0; |
| } |
| |
| static int sdl_display_read(const struct device *dev, const uint16_t x, |
| const uint16_t y, |
| const struct display_buffer_descriptor *desc, |
| void *buf) |
| { |
| struct sdl_display_data *disp_data = dev->data; |
| |
| LOG_DBG("Reading %dx%d (w,h) bitmap @ %dx%d (x,y)", desc->width, |
| desc->height, x, y); |
| |
| __ASSERT(desc->width <= desc->pitch, "Pitch is smaller then width"); |
| __ASSERT((desc->pitch * 3U * desc->height) <= desc->buf_size, |
| "Input buffer to small"); |
| |
| return sdl_display_read_bottom(desc->height, desc->width, x, y, |
| disp_data->renderer, buf, desc->pitch); |
| } |
| |
| static void *sdl_display_get_framebuffer(const struct device *dev) |
| { |
| return NULL; |
| } |
| |
| static int sdl_display_blanking_off(const struct device *dev) |
| { |
| struct sdl_display_data *disp_data = dev->data; |
| |
| LOG_DBG("Turning display blacking off"); |
| |
| disp_data->display_on = true; |
| |
| sdl_display_blanking_off_bottom(disp_data->renderer, disp_data->texture); |
| |
| return 0; |
| } |
| |
| static int sdl_display_blanking_on(const struct device *dev) |
| { |
| struct sdl_display_data *disp_data = dev->data; |
| |
| LOG_DBG("Turning display blanking on"); |
| |
| disp_data->display_on = false; |
| |
| sdl_display_blanking_on_bottom(disp_data->renderer); |
| return 0; |
| } |
| |
| static int sdl_display_set_brightness(const struct device *dev, |
| const uint8_t brightness) |
| { |
| return -ENOTSUP; |
| } |
| |
| static int sdl_display_set_contrast(const struct device *dev, |
| const uint8_t contrast) |
| { |
| return -ENOTSUP; |
| } |
| |
| static void sdl_display_get_capabilities( |
| const struct device *dev, struct display_capabilities *capabilities) |
| { |
| const struct sdl_display_config *config = dev->config; |
| struct sdl_display_data *disp_data = dev->data; |
| |
| memset(capabilities, 0, sizeof(struct display_capabilities)); |
| capabilities->x_resolution = config->width; |
| capabilities->y_resolution = config->height; |
| capabilities->supported_pixel_formats = PIXEL_FORMAT_ARGB_8888 | |
| PIXEL_FORMAT_RGB_888 | |
| PIXEL_FORMAT_MONO01 | |
| PIXEL_FORMAT_MONO10 | |
| PIXEL_FORMAT_RGB_565 | |
| PIXEL_FORMAT_BGR_565; |
| capabilities->current_pixel_format = disp_data->current_pixel_format; |
| capabilities->screen_info = SCREEN_INFO_MONO_VTILED | |
| SCREEN_INFO_MONO_MSB_FIRST; |
| } |
| |
| static int sdl_display_set_pixel_format(const struct device *dev, |
| const enum display_pixel_format pixel_format) |
| { |
| struct sdl_display_data *disp_data = dev->data; |
| |
| switch (pixel_format) { |
| case PIXEL_FORMAT_ARGB_8888: |
| case PIXEL_FORMAT_RGB_888: |
| case PIXEL_FORMAT_MONO01: |
| case PIXEL_FORMAT_MONO10: |
| case PIXEL_FORMAT_RGB_565: |
| case PIXEL_FORMAT_BGR_565: |
| disp_data->current_pixel_format = pixel_format; |
| return 0; |
| default: |
| LOG_ERR("Pixel format not supported"); |
| return -ENOTSUP; |
| } |
| } |
| |
| static void sdl_display_cleanup(struct sdl_display_data *disp_data) |
| { |
| sdl_display_cleanup_bottom(&disp_data->window, &disp_data->renderer, &disp_data->texture); |
| } |
| |
| static const struct display_driver_api sdl_display_api = { |
| .blanking_on = sdl_display_blanking_on, |
| .blanking_off = sdl_display_blanking_off, |
| .write = sdl_display_write, |
| .read = sdl_display_read, |
| .get_framebuffer = sdl_display_get_framebuffer, |
| .set_brightness = sdl_display_set_brightness, |
| .set_contrast = sdl_display_set_contrast, |
| .get_capabilities = sdl_display_get_capabilities, |
| .set_pixel_format = sdl_display_set_pixel_format, |
| }; |
| |
| #define DISPLAY_SDL_DEFINE(n) \ |
| static const struct sdl_display_config sdl_config_##n = { \ |
| .height = DT_INST_PROP(n, height), \ |
| .width = DT_INST_PROP(n, width), \ |
| }; \ |
| \ |
| static uint8_t sdl_buf_##n[4 * DT_INST_PROP(n, height) \ |
| * DT_INST_PROP(n, width)]; \ |
| static struct sdl_display_data sdl_data_##n = { \ |
| .buf = sdl_buf_##n, \ |
| }; \ |
| \ |
| DEVICE_DT_INST_DEFINE(n, &sdl_display_init, NULL, \ |
| &sdl_data_##n, \ |
| &sdl_config_##n, \ |
| POST_KERNEL, \ |
| CONFIG_DISPLAY_INIT_PRIORITY, \ |
| &sdl_display_api); \ |
| \ |
| static void sdl_display_cleanup_##n(void) \ |
| { \ |
| sdl_display_cleanup(&sdl_data_##n); \ |
| } \ |
| \ |
| NATIVE_TASK(sdl_display_cleanup_##n, ON_EXIT, 1); |
| |
| DT_INST_FOREACH_STATUS_OKAY(DISPLAY_SDL_DEFINE) |