Optimize libSDL driver for RGB565

This commit is contained in:
Fred 2020-12-07 22:18:16 +01:00 committed by Niccolò Izzo
parent a38d3d2486
commit 1a11ff8401
1 changed files with 37 additions and 41 deletions

View File

@ -48,6 +48,14 @@
#define PIX_FMT_RGB565 #define PIX_FMT_RGB565
#endif #endif
#ifdef PIX_FMT_RGB565
#define PIXEL_FORMAT SDL_PIXELFORMAT_RGB565
#define PIXEL_SIZE uint16_t
#else
#define PIXEL_FORMAT SDL_PIXELFORMAT_ARGB8888
#define PIXEL_SIZE uint32_t
#endif
SDL_Renderer *renderer; /* SDL renderer */ SDL_Renderer *renderer; /* SDL renderer */
SDL_Window *window; /* SDL window */ SDL_Window *window; /* SDL window */
SDL_Texture *displayTexture; /* SDL rendering surface */ SDL_Texture *displayTexture; /* SDL rendering surface */
@ -59,7 +67,8 @@ bool inProgress; /* Flag to signal when rendering is in progress */
* Internal helper function which fetches pixel at position (x, y) from framebuffer * Internal helper function which fetches pixel at position (x, y) from framebuffer
* and returns it in SDL-compatible format, which is ARGB8888. * and returns it in SDL-compatible format, which is ARGB8888.
*/ */
uint32_t fetchPixelFromFb(unsigned int x, unsigned int y) { uint32_t fetchPixelFromFb(unsigned int x, unsigned int y)
{
uint32_t pixel = 0; uint32_t pixel = 0;
#ifdef PIX_FMT_BW #ifdef PIX_FMT_BW
@ -83,43 +92,18 @@ uint32_t fetchPixelFromFb(unsigned int x, unsigned int y) {
pixel = 0xFF000000 | (px << 16) | (px << 8) | px; pixel = 0xFF000000 | (px << 16) | (px << 8) | px;
#endif #endif
#ifdef PIX_FMT_RGB565
/*
* SDL pixel format is ARGB8888, while ours is RGB565, thus we need
* to do some conversions when writing framebuffer content to the
* window. We also set alpha value to its maximum.
*/
uint16_t *fb = (uint16_t *) (frameBuffer);
uint32_t r = (fb[x + y * SCREEN_WIDTH] & 0xF800) >> 11;
uint32_t g = (fb[x + y * SCREEN_WIDTH] & 0x07E0) >> 5;
uint32_t b = (fb[x + y * SCREEN_WIDTH] & 0x001F) & 0x1F;
/*
* Here we do conversions by multiplying by some scaling factors,
* we use ints just because the precision of floats is not really
* needed.
* Conversion factors:
* - five bit to eight bit: 8.226
* - six bit to eight bit: 4.0476
*/
r = (r * 8) + (r * 226) / 1000;
g = (g * 4) + (g * 476) / 10000;
b = (b * 8) + (b * 226) / 1000;
pixel = 0xFF000000 | (r << 16) | (g << 8) | b;
#endif
return pixel; return pixel;
} }
void display_init() { void display_init()
if (SDL_Init(SDL_INIT_VIDEO) < 0) { {
if (SDL_Init(SDL_INIT_VIDEO) < 0)
{
printf("SDL video init error!!\n"); printf("SDL video init error!!\n");
} else { } else
{
window = SDL_CreateWindow("OpenRTX", window = SDL_CreateWindow("OpenRTX",
SDL_WINDOWPOS_UNDEFINED, SDL_WINDOWPOS_UNDEFINED,
@ -129,7 +113,7 @@ void display_init() {
renderer = SDL_CreateRenderer(window, -1, 0); renderer = SDL_CreateRenderer(window, -1, 0);
SDL_RenderSetLogicalSize(renderer, SCREEN_WIDTH, SCREEN_HEIGHT); SDL_RenderSetLogicalSize(renderer, SCREEN_WIDTH, SCREEN_HEIGHT);
displayTexture = SDL_CreateTexture(renderer, SDL_PIXELFORMAT_ARGB8888, SDL_TEXTUREACCESS_STREAMING, displayTexture = SDL_CreateTexture(renderer, PIXEL_FORMAT, SDL_TEXTUREACCESS_STREAMING,
SCREEN_WIDTH, SCREEN_HEIGHT); SCREEN_WIDTH, SCREEN_HEIGHT);
SDL_RenderClear(renderer); SDL_RenderClear(renderer);
SDL_RenderCopy(renderer, displayTexture, NULL, NULL); SDL_RenderCopy(renderer, displayTexture, NULL, NULL);
@ -168,40 +152,52 @@ void display_init() {
} }
} }
void display_terminate() { void display_terminate()
while (inProgress) {} /* Wait until current render finishes */ {
while (inProgress)
{} /* Wait until current render finishes */
printf("Terminating SDL display emulator, goodbye!\n"); printf("Terminating SDL display emulator, goodbye!\n");
free(frameBuffer); free(frameBuffer);
SDL_DestroyWindow(window); SDL_DestroyWindow(window);
SDL_Quit(); SDL_Quit();
} }
void display_renderRows(uint8_t startRow, uint8_t endRow) { void display_renderRows(uint8_t startRow, uint8_t endRow)
Uint32 *pixels; {
PIXEL_SIZE *pixels;
int pitch = 0; int pitch = 0;
if (SDL_LockTexture(displayTexture, NULL, (void **) &pixels, &pitch) < 0) { if (SDL_LockTexture(displayTexture, NULL, (void **) &pixels, &pitch) < 0)
{
printf("SDL_lock failed: %s\n", SDL_GetError()); printf("SDL_lock failed: %s\n", SDL_GetError());
} }
inProgress = true; inProgress = true;
#ifdef PIX_FMT_RGB565
uint16_t *fb = (uint16_t *) (frameBuffer);
memcpy(pixels, fb, sizeof(uint16_t) * SCREEN_HEIGHT * SCREEN_WIDTH);
#else
for (unsigned int x = 0; x < SCREEN_WIDTH; x++) { for (unsigned int x = 0; x < SCREEN_WIDTH; x++) {
for (unsigned int y = startRow; y < endRow; y++) { for (unsigned int y = startRow; y < endRow; y++) {
pixels[x + y * SCREEN_WIDTH] = fetchPixelFromFb(x, y); pixels[x + y * SCREEN_WIDTH] = fetchPixelFromFb(x, y);
} }
} }
#endif
SDL_UnlockTexture(displayTexture); SDL_UnlockTexture(displayTexture);
SDL_RenderCopy(renderer, displayTexture, NULL, NULL); SDL_RenderCopy(renderer, displayTexture, NULL, NULL);
SDL_RenderPresent(renderer); SDL_RenderPresent(renderer);
inProgress = false; inProgress = false;
} }
void display_render() { void display_render()
{
display_renderRows(0, SCREEN_HEIGHT); display_renderRows(0, SCREEN_HEIGHT);
} }
bool display_renderingInProgress() { bool display_renderingInProgress()
{
return inProgress; return inProgress;
} }
void *display_getFrameBuffer() { void *display_getFrameBuffer()
{
return (void *) (frameBuffer); return (void *) (frameBuffer);
} }