diff --git a/components/esp_lcd/src/esp_lcd_panel_rgb.c b/components/esp_lcd/src/esp_lcd_panel_rgb.c index 49dcfd57ee..1d129ecdbd 100644 --- a/components/esp_lcd/src/esp_lcd_panel_rgb.c +++ b/components/esp_lcd/src/esp_lcd_panel_rgb.c @@ -533,6 +533,12 @@ static esp_err_t rgb_panel_init(esp_lcd_panel_t *panel) return ret; } +__attribute__((always_inline)) +static inline void copy_pixel_8bpp(uint8_t *to, const uint8_t *from) +{ + *to++ = *from++; +} + __attribute__((always_inline)) static inline void copy_pixel_16bpp(uint8_t *to, const uint8_t *from) { @@ -548,6 +554,119 @@ static inline void copy_pixel_24bpp(uint8_t *to, const uint8_t *from) *to++ = *from++; } +#define COPY_PIXEL_CODE_BLOCK(_bpp) \ + switch (rgb_panel->rotate_mask) \ + { \ + case 0: \ + { \ + uint8_t *to = fb + (y_start * h_res + x_start) * bytes_per_pixel; \ + for (int y = y_start; y < y_end; y++) \ + { \ + memcpy(to, from, copy_bytes_per_line); \ + to += bytes_per_line; \ + from += copy_bytes_per_line; \ + } \ + bytes_to_flush = (y_end - y_start) * bytes_per_line; \ + flush_ptr = fb + y_start * bytes_per_line; \ + } \ + break; \ + case ROTATE_MASK_MIRROR_X: \ + for (int y = y_start; y < y_end; y++) \ + { \ + uint32_t index = (y * h_res + (h_res - 1 - x_start)) * bytes_per_pixel; \ + for (size_t x = x_start; x < x_end; x++) \ + { \ + copy_pixel_##_bpp##bpp(to + index, from); \ + index -= bytes_per_pixel; \ + from += bytes_per_pixel; \ + } \ + } \ + bytes_to_flush = (y_end - y_start) * bytes_per_line; \ + flush_ptr = fb + y_start * bytes_per_line; \ + break; \ + case ROTATE_MASK_MIRROR_Y: \ + { \ + uint8_t *to = fb + ((v_res - 1 - y_start) * h_res + x_start) * bytes_per_pixel; \ + for (int y = y_start; y < y_end; y++) \ + { \ + memcpy(to, from, copy_bytes_per_line); \ + to -= bytes_per_line; \ + from += copy_bytes_per_line; \ + } \ + bytes_to_flush = (y_end - y_start) * bytes_per_line; \ + flush_ptr = fb + (v_res - y_end) * bytes_per_line; \ + } \ + break; \ + case ROTATE_MASK_MIRROR_X | ROTATE_MASK_MIRROR_Y: \ + for (int y = y_start; y < y_end; y++) \ + { \ + uint32_t index = ((v_res - 1 - y) * h_res + (h_res - 1 - x_start)) * bytes_per_pixel; \ + for (size_t x = x_start; x < x_end; x++) \ + { \ + copy_pixel_##_bpp##bpp(to + index, from); \ + index -= bytes_per_pixel; \ + from += bytes_per_pixel; \ + } \ + } \ + bytes_to_flush = (y_end - y_start) * bytes_per_line; \ + flush_ptr = fb + (v_res - y_end) * bytes_per_line; \ + break; \ + case ROTATE_MASK_SWAP_XY: \ + for (int y = y_start; y < y_end; y++) \ + { \ + for (int x = x_start; x < x_end; x++) \ + { \ + uint32_t j = y * copy_bytes_per_line + x * bytes_per_pixel - offset; \ + uint32_t i = (x * h_res + y) * bytes_per_pixel; \ + copy_pixel_##_bpp##bpp(to + i, from + j); \ + } \ + } \ + bytes_to_flush = (x_end - x_start) * bytes_per_line; \ + flush_ptr = fb + x_start * bytes_per_line; \ + break; \ + case ROTATE_MASK_SWAP_XY | ROTATE_MASK_MIRROR_X: \ + for (int y = y_start; y < y_end; y++) \ + { \ + for (int x = x_start; x < x_end; x++) \ + { \ + uint32_t j = y * copy_bytes_per_line + x * bytes_per_pixel - offset; \ + uint32_t i = (x * h_res + h_res - 1 - y) * bytes_per_pixel; \ + copy_pixel_##_bpp##bpp(to + i, from + j); \ + } \ + } \ + bytes_to_flush = (x_end - x_start) * bytes_per_line; \ + flush_ptr = fb + x_start * bytes_per_line; \ + break; \ + case ROTATE_MASK_SWAP_XY | ROTATE_MASK_MIRROR_Y: \ + for (int y = y_start; y < y_end; y++) \ + { \ + for (int x = x_start; x < x_end; x++) \ + { \ + uint32_t j = y * copy_bytes_per_line + x * bytes_per_pixel - offset; \ + uint32_t i = ((v_res - 1 - x) * h_res + y) * bytes_per_pixel; \ + copy_pixel_##_bpp##bpp(to + i, from + j); \ + } \ + } \ + bytes_to_flush = (x_end - x_start) * bytes_per_line; \ + flush_ptr = fb + (v_res - x_end) * bytes_per_line; \ + break; \ + case ROTATE_MASK_SWAP_XY | ROTATE_MASK_MIRROR_X | ROTATE_MASK_MIRROR_Y: \ + for (int y = y_start; y < y_end; y++) \ + { \ + for (int x = x_start; x < x_end; x++) \ + { \ + uint32_t j = y * copy_bytes_per_line + x * bytes_per_pixel - offset; \ + uint32_t i = ((v_res - 1 - x) * h_res + h_res - 1 - y) * bytes_per_pixel; \ + copy_pixel_##_bpp##bpp(to + i, from + j); \ + } \ + } \ + bytes_to_flush = (x_end - x_start) * bytes_per_line; \ + flush_ptr = fb + (v_res - x_end) * bytes_per_line; \ + break; \ + default: \ + break; \ + } + static esp_err_t rgb_panel_draw_bitmap(esp_lcd_panel_t *panel, int x_start, int y_start, int x_end, int y_end, const void *color_data) { esp_rgb_panel_t *rgb_panel = __containerof(panel, esp_rgb_panel_t, base); @@ -600,198 +719,13 @@ static esp_err_t rgb_panel_draw_bitmap(esp_lcd_panel_t *panel, int x_start, int uint32_t copy_bytes_per_line = (x_end - x_start) * bytes_per_pixel; size_t offset = y_start * copy_bytes_per_line + x_start * bytes_per_pixel; uint8_t *to = fb; - if (2 == bytes_per_pixel) { - switch (rgb_panel->rotate_mask) { - case 0: { - uint8_t *to = fb + (y_start * h_res + x_start) * bytes_per_pixel; - for (int y = y_start; y < y_end; y++) { - memcpy(to, from, copy_bytes_per_line); - to += bytes_per_line; - from += copy_bytes_per_line; - } - bytes_to_flush = (y_end - y_start) * bytes_per_line; - flush_ptr = fb + y_start * bytes_per_line; - } - break; - case ROTATE_MASK_MIRROR_X: - for (int y = y_start; y < y_end; y++) { - uint32_t index = (y * h_res + (h_res - 1 - x_start)) * bytes_per_pixel; - for (size_t x = x_start; x < x_end; x++) { - copy_pixel_16bpp(to + index, from); - index -= bytes_per_pixel; - from += bytes_per_pixel; - } - } - bytes_to_flush = (y_end - y_start) * bytes_per_line; - flush_ptr = fb + y_start * bytes_per_line; - break; - case ROTATE_MASK_MIRROR_Y: { - uint8_t *to = fb + ((v_res - 1 - y_start) * h_res + x_start) * bytes_per_pixel; - for (int y = y_start; y < y_end; y++) { - memcpy(to, from, copy_bytes_per_line); - to -= bytes_per_line; - from += copy_bytes_per_line; - } - bytes_to_flush = (y_end - y_start) * bytes_per_line; - flush_ptr = fb + (v_res - y_end) * bytes_per_line; - } - break; - case ROTATE_MASK_MIRROR_X | ROTATE_MASK_MIRROR_Y: - for (int y = y_start; y < y_end; y++) { - uint32_t index = ((v_res - 1 - y) * h_res + (h_res - 1 - x_start)) * bytes_per_pixel; - for (size_t x = x_start; x < x_end; x++) { - copy_pixel_16bpp(to + index, from); - index -= bytes_per_pixel; - from += bytes_per_pixel; - } - } - bytes_to_flush = (y_end - y_start) * bytes_per_line; - flush_ptr = fb + (v_res - y_end) * bytes_per_line; - break; - case ROTATE_MASK_SWAP_XY: - for (int y = y_start; y < y_end; y++) { - for (int x = x_start; x < x_end; x++) { - uint32_t j = y * copy_bytes_per_line + x * bytes_per_pixel - offset; - uint32_t i = (x * h_res + y) * bytes_per_pixel; - copy_pixel_16bpp(to + i, from + j); - } - } - bytes_to_flush = (x_end - x_start) * bytes_per_line; - flush_ptr = fb + x_start * bytes_per_line; - break; - case ROTATE_MASK_SWAP_XY | ROTATE_MASK_MIRROR_X: - for (int y = y_start; y < y_end; y++) { - for (int x = x_start; x < x_end; x++) { - uint32_t j = y * copy_bytes_per_line + x * bytes_per_pixel - offset; - uint32_t i = (x * h_res + h_res - 1 - y) * bytes_per_pixel; - copy_pixel_16bpp(to + i, from + j); - } - } - bytes_to_flush = (x_end - x_start) * bytes_per_line; - flush_ptr = fb + x_start * bytes_per_line; - break; - case ROTATE_MASK_SWAP_XY | ROTATE_MASK_MIRROR_Y: - for (int y = y_start; y < y_end; y++) { - for (int x = x_start; x < x_end; x++) { - uint32_t j = y * copy_bytes_per_line + x * bytes_per_pixel - offset; - uint32_t i = ((v_res - 1 - x) * h_res + y) * bytes_per_pixel; - copy_pixel_16bpp(to + i, from + j); - } - } - bytes_to_flush = (x_end - x_start) * bytes_per_line; - flush_ptr = fb + (v_res - x_end) * bytes_per_line; - break; - case ROTATE_MASK_SWAP_XY | ROTATE_MASK_MIRROR_X | ROTATE_MASK_MIRROR_Y: - for (int y = y_start; y < y_end; y++) { - for (int x = x_start; x < x_end; x++) { - uint32_t j = y * copy_bytes_per_line + x * bytes_per_pixel - offset; - uint32_t i = ((v_res - 1 - x) * h_res + h_res - 1 - y) * bytes_per_pixel; - copy_pixel_16bpp(to + i, from + j); - } - } - bytes_to_flush = (x_end - x_start) * bytes_per_line; - flush_ptr = fb + (v_res - x_end) * bytes_per_line; - break; - default: - break; - } + if (1 == bytes_per_pixel) { + COPY_PIXEL_CODE_BLOCK(8) + } else if (2 == bytes_per_pixel) { + COPY_PIXEL_CODE_BLOCK(16) } else if (3 == bytes_per_pixel) { - switch (rgb_panel->rotate_mask) { - case 0: { - uint8_t *to = fb + (y_start * h_res + x_start) * bytes_per_pixel; - for (int y = y_start; y < y_end; y++) { - memcpy(to, from, copy_bytes_per_line); - to += bytes_per_line; - from += copy_bytes_per_line; - } - bytes_to_flush = (y_end - y_start) * bytes_per_line; - flush_ptr = fb + y_start * bytes_per_line; - } - break; - case ROTATE_MASK_MIRROR_X: - for (int y = y_start; y < y_end; y++) { - uint32_t index = (y * h_res + (h_res - 1 - x_start)) * bytes_per_pixel; - for (size_t x = x_start; x < x_end; x++) { - copy_pixel_24bpp(to + index, from); - index -= bytes_per_pixel; - from += bytes_per_pixel; - } - } - bytes_to_flush = (y_end - y_start) * bytes_per_line; - flush_ptr = fb + y_start * bytes_per_line; - break; - case ROTATE_MASK_MIRROR_Y: { - uint8_t *to = fb + ((v_res - 1 - y_start) * h_res + x_start) * bytes_per_pixel; - for (int y = y_start; y < y_end; y++) { - memcpy(to, from, copy_bytes_per_line); - to -= bytes_per_line; - from += copy_bytes_per_line; - } - bytes_to_flush = (y_end - y_start) * bytes_per_line; - flush_ptr = fb + (v_res - y_end) * bytes_per_line; - } - break; - case ROTATE_MASK_MIRROR_X | ROTATE_MASK_MIRROR_Y: - for (int y = y_start; y < y_end; y++) { - uint32_t index = ((v_res - 1 - y) * h_res + (h_res - 1 - x_start)) * bytes_per_pixel; - for (size_t x = x_start; x < x_end; x++) { - copy_pixel_24bpp(to + index, from); - index -= bytes_per_pixel; - from += bytes_per_pixel; - } - } - bytes_to_flush = (y_end - y_start) * bytes_per_line; - flush_ptr = fb + (v_res - y_end) * bytes_per_line; - break; - case ROTATE_MASK_SWAP_XY: - for (int y = y_start; y < y_end; y++) { - for (int x = x_start; x < x_end; x++) { - uint32_t j = y * copy_bytes_per_line + x * bytes_per_pixel - offset; - uint32_t i = (x * h_res + y) * bytes_per_pixel; - copy_pixel_24bpp(to + i, from + j); - } - } - bytes_to_flush = (x_end - x_start) * bytes_per_line; - flush_ptr = fb + x_start * bytes_per_line; - break; - case ROTATE_MASK_SWAP_XY | ROTATE_MASK_MIRROR_X: - for (int y = y_start; y < y_end; y++) { - for (int x = x_start; x < x_end; x++) { - uint32_t j = y * copy_bytes_per_line + x * bytes_per_pixel - offset; - uint32_t i = (x * h_res + h_res - 1 - y) * bytes_per_pixel; - copy_pixel_24bpp(to + i, from + j); - } - } - bytes_to_flush = (x_end - x_start) * bytes_per_line; - flush_ptr = fb + x_start * bytes_per_line; - break; - case ROTATE_MASK_SWAP_XY | ROTATE_MASK_MIRROR_Y: - for (int y = y_start; y < y_end; y++) { - for (int x = x_start; x < x_end; x++) { - uint32_t j = y * copy_bytes_per_line + x * bytes_per_pixel - offset; - uint32_t i = ((v_res - 1 - x) * h_res + y) * bytes_per_pixel; - copy_pixel_24bpp(to + i, from + j); - } - } - bytes_to_flush = (x_end - x_start) * bytes_per_line; - flush_ptr = fb + (v_res - x_end) * bytes_per_line; - break; - case ROTATE_MASK_SWAP_XY | ROTATE_MASK_MIRROR_X | ROTATE_MASK_MIRROR_Y: - for (int y = y_start; y < y_end; y++) { - for (int x = x_start; x < x_end; x++) { - uint32_t j = y * copy_bytes_per_line + x * bytes_per_pixel - offset; - uint32_t i = ((v_res - 1 - x) * h_res + h_res - 1 - y) * bytes_per_pixel; - copy_pixel_24bpp(to + i, from + j); - } - } - bytes_to_flush = (x_end - x_start) * bytes_per_line; - flush_ptr = fb + (v_res - x_end) * bytes_per_line; - break; - default: - break; - } + COPY_PIXEL_CODE_BLOCK(24) } - } // Note that if we use a bounce buffer, the data gets read by the CPU as well so no need to write back