git.sesse.net Git - pistorm/blob - platforms/amiga/rtg/rtg-output.c

   1 #include "emulator.h"
   2 #include "rtg.h"
   3
   4 #include <pthread.h>
   5 #include <SDL2/SDL.h>
   6 #include <stdint.h>
   7 #include <stdio.h>
   8 #include <stdlib.h>
   9 #include <string.h>
  10 #include <unistd.h>
  11
  12 #define RTG_INIT_ERR(a) { printf(a); *data->running = 0; }
  13
  14 uint8_t busy = 0, rtg_on = 0, rtg_initialized = 0;
  15 extern uint8_t *rtg_mem;
  16 extern uint32_t framebuffer_addr;
  17 extern uint32_t framebuffer_addr_adj;
  18
  19 extern uint16_t rtg_display_width, rtg_display_height;
  20 extern uint16_t rtg_display_format;
  21 extern uint16_t rtg_pitch, rtg_total_rows;
  22 extern uint16_t rtg_offset_x, rtg_offset_y;
  23
  24 static pthread_t thread_id;
  25
  26 struct rtg_shared_data {
  27     uint16_t *width, *height;
  28     uint16_t *format, *pitch;
  29     uint16_t *offset_x, *offset_y;
  30     uint8_t *memory;
  31     uint32_t *addr;
  32     uint8_t *running;
  33 };
  34
  35 SDL_Window *win = NULL;
  36 SDL_Renderer *renderer = NULL;
  37 SDL_Texture *img = NULL;
  38
  39 struct rtg_shared_data rtg_share_data;
  40 static uint32_t palette[256];
  41
  42 void rtg_update_screen() {}
  43
  44 uint32_t rtg_to_sdl2[RTGFMT_NUM] = {
  45     SDL_PIXELFORMAT_ARGB8888,
  46     SDL_PIXELFORMAT_RGB565,
  47     SDL_PIXELFORMAT_ARGB8888,
  48     SDL_PIXELFORMAT_RGB555,
  49 };
  50
  51 void *rtgThread(void *args) {
  52
  53     printf("RTG thread running\n");
  54     fflush(stdout);
  55
  56     int reinit = 0;
  57     rtg_on = 1;
  58
  59     uint32_t *indexed_buf = NULL;
  60
  61     rtg_share_data.format = &rtg_display_format;
  62     rtg_share_data.width = &rtg_display_width;
  63     rtg_share_data.height = &rtg_display_height;
  64     rtg_share_data.pitch = &rtg_pitch;
  65     rtg_share_data.offset_x = &rtg_offset_x;
  66     rtg_share_data.offset_y = &rtg_offset_y;
  67     rtg_share_data.memory = rtg_mem;
  68     rtg_share_data.running = &rtg_on;
  69     rtg_share_data.addr = &framebuffer_addr_adj;
  70     struct rtg_shared_data *data = &rtg_share_data;
  71
  72     uint16_t width = rtg_display_width;
  73     uint16_t height = rtg_display_height;
  74     uint16_t format = rtg_display_format;
  75     uint16_t pitch = rtg_pitch;
  76
  77     printf("Initializing SDL2...\n");
  78     if (SDL_Init(0) < 0) {
  79         printf("Failed to initialize SDL2.\n");
  80     }
  81
  82     printf("Initializing SDL2 Video...\n");
  83     if (SDL_Init(SDL_INIT_VIDEO) < 0) {
  84         printf("Failed to initialize SDL2 Video..\n");
  85     }
  86
  87 reinit_sdl:;
  88     if (reinit) {
  89         printf("Reinitializing SDL2...\n");
  90         width = rtg_display_width;
  91         height = rtg_display_height;
  92         format = rtg_display_format;
  93         pitch = rtg_pitch;
  94         if (indexed_buf) {
  95             free(indexed_buf);
  96             indexed_buf = NULL;
  97         }
  98         reinit = 0;
  99     }
 100
 101     printf("Creating %dx%d SDL2 window...\n", width, height);
 102     win = SDL_CreateWindow("Pistorm RTG", 0, 0, width, height, 0);
 103     if (!win) {
 104         RTG_INIT_ERR("Failed create SDL2 window.\n");
 105     }
 106     else {
 107         printf("Created %dx%d window.\n", width, height);
 108     }
 109
 110     printf("Creating SDL2 renderer...\n");
 111     renderer = SDL_CreateRenderer(win, -1, SDL_RENDERER_ACCELERATED);
 112     if (!renderer) {
 113         RTG_INIT_ERR("Failed create SDL2 renderer.\n");
 114     }
 115     else {
 116         printf("Created SDL2 renderer.\n");
 117     }
 118
 119     printf("Creating SDL2 texture...\n");
 120     img = SDL_CreateTexture(renderer, rtg_to_sdl2[format], SDL_TEXTUREACCESS_TARGET, width, height);
 121     if (!img) {
 122         RTG_INIT_ERR("Failed create SDL2 texture.\n");
 123     }
 124     else {
 125         printf("Created %dx%d texture.\n", width, height);
 126     }
 127
 128     switch (format) {
 129         case RTGFMT_8BIT:
 130             indexed_buf = calloc(1, width * height * 4);
 131             break;
 132         case RTGFMT_RBG565:
 133             indexed_buf = calloc(1, width * height * 2);
 134             break;
 135         default:
 136             break;
 137     }
 138
 139     uint64_t frame_start = 0, frame_end = 0;
 140     float elapsed = 0.0f;
 141
 142     while (1) {
 143         if (renderer && win && img) {
 144             frame_start = SDL_GetPerformanceCounter();
 145             SDL_RenderClear(renderer);
 146             if (*data->running) {
 147                 switch (format) {
 148                     case RTGFMT_RGB32:
 149                         SDL_UpdateTexture(img, NULL, &data->memory[*data->addr], pitch);
 150                         break;
 151                     case RTGFMT_RBG565:
 152                         SDL_UpdateTexture(img, NULL, (uint8_t *)indexed_buf, width * 2);
 153                         break;
 154                     case RTGFMT_8BIT:
 155                         SDL_UpdateTexture(img, NULL, (uint8_t *)indexed_buf, width * 4);
 156                         break;
 157                 }
 158                 SDL_RenderCopy(renderer, img, NULL, NULL);
 159             }
 160             SDL_RenderPresent(renderer);
 161             //usleep(16667); //ghetto 60hz
 162             if (height != *data->height || width != *data->width || format != *data->format) {
 163                 printf("Reinitializing due to something change.\n");
 164                 reinit = 1;
 165                 goto shutdown_sdl;
 166             }
 167             switch (format) {
 168                 case RTGFMT_8BIT:
 169                     for (int y = 0; y < height; y++) {
 170                         for (int x = 0; x < width; x++) {
 171                             indexed_buf[x + (y * width)] = palette[data->memory[*data->addr + x + (y * pitch)]];
 172                         }
 173                     }
 174                     break;
 175                 case RTGFMT_RBG565:
 176                     for (int y = 0; y < height; y++) {
 177                         for (int x = 0; x < width; x++) {
 178                             ((uint16_t *)indexed_buf)[x + (y * width)] = be16toh(((uint16_t *)data->memory)[(*data->addr / 2) + x + (y * (pitch / 2))]);
 179                         }
 180                     }
 181                     break;
 182             }
 183             frame_end = SDL_GetPerformanceCounter();
 184             elapsed = (frame_end - frame_start) / (float)SDL_GetPerformanceFrequency() * 1000.0f;
 185             pitch = rtg_pitch;
 186             SDL_Delay(floor(16.66666f - elapsed));
 187         }
 188         else
 189             break;
 190     }
 191
 192     rtg_initialized = 0;
 193     printf("RTG thread shut down.\n");
 194
 195 shutdown_sdl:;
 196     if (img) SDL_DestroyTexture(img);
 197     if (renderer) SDL_DestroyRenderer(renderer);
 198     if (win) SDL_DestroyWindow(win);
 199
 200     win = NULL;
 201     img = NULL;
 202     renderer = NULL;
 203
 204     if (reinit)
 205         goto reinit_sdl;
 206
 207     if (indexed_buf)
 208         free(indexed_buf);
 209
 210     SDL_QuitSubSystem(SDL_INIT_VIDEO);
 211     SDL_Quit();
 212
 213     return args;
 214 }
 215
 216 void rtg_set_clut_entry(uint8_t index, uint32_t xrgb) {
 217     palette[index] = xrgb;
 218 }
 219
 220 void rtg_init_display() {
 221     int err;
 222     rtg_on = 1;
 223
 224     if (!rtg_initialized) {
 225         err = pthread_create(&thread_id, NULL, &rtgThread, (void *)&rtg_share_data);
 226         if (err != 0) {
 227             rtg_on = 0;
 228             printf("can't create RTG thread :[%s]", strerror(err));
 229         }
 230         else {
 231             rtg_initialized = 1;
 232             pthread_setname_np(thread_id, "pistorm: rtg");
 233             printf("RTG Thread created successfully\n");
 234         }
 235     }
 236     printf("RTG display enabled.\n");
 237 }
 238
 239 void rtg_shutdown_display() {
 240     printf("RTG display disabled.\n");
 241     rtg_on = 0;
 242 }