+#include "emulator.h"
+#include "rtg.h"
+
+#include <pthread.h>
#include <SDL2/SDL.h>
-#include <stdio.h>
#include <stdint.h>
+#include <stdio.h>
+#include <stdlib.h>
+#include <string.h>
#include <unistd.h>
-#include <pthread.h>
#define RTG_INIT_ERR(a) { printf(a); *data->running = 0; }
-uint8_t busy = 0, rtg_on = 0;
+uint8_t busy = 0, rtg_on = 0, rtg_initialized = 0;
extern uint8_t *rtg_mem;
extern uint32_t framebuffer_addr;
+extern uint32_t framebuffer_addr_adj;
extern uint16_t rtg_display_width, rtg_display_height;
extern uint16_t rtg_display_format;
SDL_Texture *img = NULL;
struct rtg_shared_data rtg_share_data;
+static uint32_t palette[256];
void rtg_update_screen() {}
+uint32_t rtg_to_sdl2[RTGFMT_NUM] = {
+ SDL_PIXELFORMAT_ARGB8888,
+ SDL_PIXELFORMAT_RGB565,
+ SDL_PIXELFORMAT_ARGB8888,
+ SDL_PIXELFORMAT_RGB555,
+};
+
void *rtgThread(void *args) {
printf("RTG thread running\n");
fflush(stdout);
- int err;
+ int reinit = 0;
rtg_on = 1;
+ uint32_t *indexed_buf = NULL;
+
rtg_share_data.format = &rtg_display_format;
rtg_share_data.width = &rtg_display_width;
rtg_share_data.height = &rtg_display_height;
rtg_share_data.offset_y = &rtg_offset_y;
rtg_share_data.memory = rtg_mem;
rtg_share_data.running = &rtg_on;
- rtg_share_data.addr = &framebuffer_addr;
+ rtg_share_data.addr = &framebuffer_addr_adj;
struct rtg_shared_data *data = &rtg_share_data;
+ uint16_t width = rtg_display_width;
+ uint16_t height = rtg_display_height;
+ uint16_t format = rtg_display_format;
+ uint16_t pitch = rtg_pitch;
+
printf("Initializing SDL2...\n");
if (SDL_Init(0) < 0) {
printf("Failed to initialize SDL2.\n");
printf("Failed to initialize SDL2 Video..\n");
}
- printf("Creating %dx%d SDL2 window...\n", *data->width, *data->height);
- win = SDL_CreateWindow("Pistorm RTG", 0, 0, *data->width, *data->height, 0);
+reinit_sdl:;
+ if (reinit) {
+ printf("Reinitializing SDL2...\n");
+ width = rtg_display_width;
+ height = rtg_display_height;
+ format = rtg_display_format;
+ pitch = rtg_pitch;
+ if (indexed_buf) {
+ free(indexed_buf);
+ indexed_buf = NULL;
+ }
+ reinit = 0;
+ }
+
+ printf("Creating %dx%d SDL2 window...\n", width, height);
+ win = SDL_CreateWindow("Pistorm RTG", 0, 0, width, height, 0);
if (!win) {
RTG_INIT_ERR("Failed create SDL2 window.\n");
}
else {
- printf("Created %dx%d window.\n", *data->width, *data->height);
+ printf("Created %dx%d window.\n", width, height);
}
printf("Creating SDL2 renderer...\n");
}
printf("Creating SDL2 texture...\n");
- img = SDL_CreateTexture(renderer, SDL_PIXELFORMAT_RGB565, SDL_TEXTUREACCESS_TARGET, *data->width, *data->height);
+ img = SDL_CreateTexture(renderer, rtg_to_sdl2[format], SDL_TEXTUREACCESS_TARGET, width, height);
if (!img) {
RTG_INIT_ERR("Failed create SDL2 texture.\n");
}
else {
- printf("Created %dx%d texture.\n", *data->width, *data->height);
+ printf("Created %dx%d texture.\n", width, height);
+ }
+
+ switch (format) {
+ case RTGFMT_8BIT:
+ indexed_buf = calloc(1, width * height * 4);
+ break;
+ case RTGFMT_RBG565:
+ indexed_buf = calloc(1, width * height * 2);
+ break;
+ default:
+ break;
}
+ uint64_t frame_start = 0, frame_end = 0;
+ float elapsed = 0.0f;
+
while (1) {
if (renderer && win && img) {
- SDL_UpdateTexture(img, NULL, &data->memory[*data->addr + (*data->offset_x << *data->format) + (*data->offset_y * *data->pitch)], *data->pitch);
+ frame_start = SDL_GetPerformanceCounter();
SDL_RenderClear(renderer);
- SDL_RenderCopy(renderer, img, NULL, NULL);
+ if (*data->running) {
+ switch (format) {
+ case RTGFMT_RGB32:
+ SDL_UpdateTexture(img, NULL, &data->memory[*data->addr], pitch);
+ break;
+ case RTGFMT_RBG565:
+ SDL_UpdateTexture(img, NULL, (uint8_t *)indexed_buf, width * 2);
+ break;
+ case RTGFMT_8BIT:
+ SDL_UpdateTexture(img, NULL, (uint8_t *)indexed_buf, width * 4);
+ break;
+ }
+ SDL_RenderCopy(renderer, img, NULL, NULL);
+ }
SDL_RenderPresent(renderer);
- usleep(16667); //ghetto 60hz
+ //usleep(16667); //ghetto 60hz
+ if (height != *data->height || width != *data->width || format != *data->format) {
+ printf("Reinitializing due to something change.\n");
+ reinit = 1;
+ goto shutdown_sdl;
+ }
+ switch (format) {
+ case RTGFMT_8BIT:
+ for (int y = 0; y < height; y++) {
+ for (int x = 0; x < width; x++) {
+ indexed_buf[x + (y * width)] = palette[data->memory[*data->addr + x + (y * pitch)]];
+ }
+ }
+ break;
+ case RTGFMT_RBG565:
+ for (int y = 0; y < height; y++) {
+ for (int x = 0; x < width; x++) {
+ ((uint16_t *)indexed_buf)[x + (y * width)] = be16toh(((uint16_t *)data->memory)[(*data->addr / 2) + x + (y * (pitch / 2))]);
+ }
+ }
+ break;
+ }
+ frame_end = SDL_GetPerformanceCounter();
+ elapsed = (frame_end - frame_start) / (float)SDL_GetPerformanceFrequency() * 1000.0f;
+ pitch = rtg_pitch;
+ SDL_Delay(floor(16.66666f - elapsed));
}
else
break;
}
+ rtg_initialized = 0;
printf("RTG thread shut down.\n");
+shutdown_sdl:;
+ if (img) SDL_DestroyTexture(img);
+ if (renderer) SDL_DestroyRenderer(renderer);
+ if (win) SDL_DestroyWindow(win);
+
+ win = NULL;
+ img = NULL;
+ renderer = NULL;
+
+ if (reinit)
+ goto reinit_sdl;
+
+ if (indexed_buf)
+ free(indexed_buf);
+
+ SDL_QuitSubSystem(SDL_INIT_VIDEO);
+ SDL_Quit();
+
return args;
}
-void rtg_set_clut_entry(uint8_t index, uint8_t r, uint8_t g, uint8_t b) {
-
+void rtg_set_clut_entry(uint8_t index, uint32_t xrgb) {
+ palette[index] = xrgb;
}
void rtg_init_display() {
int err;
rtg_on = 1;
- err = pthread_create(&thread_id, NULL, &rtgThread, (void *)&rtg_share_data);
- if (err != 0) {
- rtg_on = 0;
- printf("can't create RTG thread :[%s]", strerror(err));
- }
- else {
- printf("RTG Thread created successfully\n");
- printf("RTG display enabled.\n");
+ if (!rtg_initialized) {
+ err = pthread_create(&thread_id, NULL, &rtgThread, (void *)&rtg_share_data);
+ if (err != 0) {
+ rtg_on = 0;
+ printf("can't create RTG thread :[%s]", strerror(err));
+ }
+ else {
+ rtg_initialized = 1;
+ pthread_setname_np(thread_id, "pistorm: rtg");
+ printf("RTG Thread created successfully\n");
+ }
}
+ printf("RTG display enabled.\n");
}
void rtg_shutdown_display() {
printf("RTG display disabled.\n");
rtg_on = 0;
-
- if (img) SDL_DestroyTexture(img);
- if (renderer) SDL_DestroyRenderer(renderer);
- if (win) SDL_DestroyWindow(win);
}
projects / pistorm / blobdiff