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

   1 #include <stdint.h>
   2 #include <endian.h>
   3 #include <stdio.h>
   4 #include <stdlib.h>
   5 #include <string.h>
   6 #include <time.h>
   7 #include "rtg.h"
   8 #include "../../../config_file/config_file.h"
   9
  10 static uint16_t palette[256];
  11
  12 static uint8_t rtg_u8[4];
  13 static uint16_t rtg_x[3], rtg_y[3];
  14 static uint16_t rtg_format;
  15 static uint32_t rtg_address[2];
  16 static uint32_t rtg_rgb[2];
  17
  18 static uint8_t display_enabled;
  19
  20 uint16_t rtg_display_width, rtg_display_height;
  21 uint16_t rtg_display_format;
  22 uint16_t rtg_pitch, rtg_total_rows;
  23 uint16_t rtg_offset_x, rtg_offset_y;
  24
  25 uint8_t *rtg_mem; // FIXME
  26
  27 uint32_t framebuffer_addr;
  28
  29 static void handle_rtg_command(uint32_t cmd);
  30 static struct timespec f1, f2;
  31
  32 static const char *op_type_names[OP_TYPE_NUM] = {
  33     "BYTE",
  34     "WORD",
  35     "LONGWORD",
  36     "MEM",
  37 };
  38
  39 static const char *rtg_format_names[RTGFMT_NUM] = {
  40     "8BPP CLUT",
  41     "16BPP RGB (565)",
  42     "32BPP RGB (RGBA)",
  43     "15BPP RGB (555)",
  44 };
  45
  46 int init_rtg_data() {
  47     rtg_mem = calloc(1, 32 * SIZE_MEGA);
  48     if (!rtg_mem) {
  49         printf("Failed to allocate RTG video memory.\n");
  50         return 0;
  51     }
  52
  53     return 1;
  54 }
  55
  56 extern uint8_t busy, rtg_on;
  57 void rtg_update_screen();
  58
  59 unsigned int rtg_read(uint32_t address, uint8_t mode) {
  60     //printf("%s read from RTG: %.8X\n", op_type_names[mode], address);
  61     if (address >= PIGFX_REG_SIZE) {
  62         if (rtg_mem) {
  63             switch (mode) {
  64                 case OP_TYPE_BYTE:
  65                     return (rtg_mem[address - PIGFX_REG_SIZE]);
  66                     break;
  67                 case OP_TYPE_WORD:
  68                     return *(( uint16_t *) (&rtg_mem[address - PIGFX_REG_SIZE]));
  69                     break;
  70                 case OP_TYPE_LONGWORD:
  71                     return *(( uint32_t *) (&rtg_mem[address - PIGFX_REG_SIZE]));
  72                     break;
  73                 default:
  74                     return 0;
  75             }
  76         }
  77     }
  78
  79     return 0;
  80 }
  81
  82 struct timespec diff(struct timespec start, struct timespec end)
  83 {
  84     struct timespec temp;
  85     if ((end.tv_nsec-start.tv_nsec)<0) {
  86         temp.tv_sec = end.tv_sec-start.tv_sec-1;
  87         temp.tv_nsec = 1000000000+end.tv_nsec-start.tv_nsec;
  88     } else {
  89         temp.tv_sec = end.tv_sec-start.tv_sec;
  90         temp.tv_nsec = end.tv_nsec-start.tv_nsec;
  91     }
  92     return temp;
  93 }
  94
  95 void rtg_write(uint32_t address, uint32_t value, uint8_t mode) {
  96     //printf("%s write to RTG: %.8X (%.8X)\n", op_type_names[mode], address, value);
  97     if (address >= PIGFX_REG_SIZE) {
  98         if (rtg_mem) {
  99             switch (mode) {
 100                 case OP_TYPE_BYTE:
 101                     rtg_mem[address - PIGFX_REG_SIZE] = value;
 102                     break;
 103                 case OP_TYPE_WORD:
 104                     *(( uint16_t *) (&rtg_mem[address - PIGFX_REG_SIZE])) = value;
 105                     break;
 106                 case OP_TYPE_LONGWORD:
 107                     *(( uint32_t *) (&rtg_mem[address - PIGFX_REG_SIZE])) = value;
 108                     break;
 109                 default:
 110                     return;
 111             }
 112         }
 113     }
 114     else {
 115         switch (mode) {
 116             case OP_TYPE_BYTE:
 117                 switch (address) {
 118                     case RTG_U81:
 119                     case RTG_U82:
 120                     case RTG_U83:
 121                     case RTG_U84:
 122                         rtg_u8[address - RTG_U81] = value;
 123                 }
 124                 break;
 125             case OP_TYPE_WORD:
 126                 switch (address) {
 127                     case RTG_X1:
 128                         rtg_x[0] = value;
 129                         break;
 130                     case RTG_X2:
 131                         rtg_x[1] = value;
 132                         break;
 133                     case RTG_X3:
 134                         rtg_x[2] = value;
 135                         break;
 136                     case RTG_Y1:
 137                         rtg_y[0] = value;
 138                         break;
 139                     case RTG_Y2:
 140                         rtg_y[1] = value;
 141                         break;
 142                     case RTG_Y3:
 143                         rtg_y[2] = value;
 144                         break;
 145                     case RTG_FORMAT:
 146                         rtg_format = value;
 147                         break;
 148                     case RTG_COMMAND:
 149                         handle_rtg_command(value);
 150                         break;
 151                 }
 152                 break;
 153             case OP_TYPE_LONGWORD:
 154                 switch (address) {
 155                     case RTG_ADDR1:
 156                         rtg_address[0] = value;
 157                         break;
 158                     case RTG_ADDR2:
 159                         rtg_address[1] = value;
 160                         break;
 161                     case RTG_RGB1:
 162                         rtg_rgb[0] = value;
 163                         break;
 164                     case RTG_RGB2:
 165                         rtg_rgb[1] = value;
 166                         break;
 167                 }
 168                 break;
 169         }
 170     }
 171
 172     if (rtg_on) {
 173         clock_gettime(CLOCK_PROCESS_CPUTIME_ID, &f2);
 174         if (diff(f1,f2).tv_nsec / 1000000.0 > 100.00) {
 175             rtg_update_screen();
 176             f1 = f2;
 177         }
 178     }
 179
 180     return;
 181 }
 182
 183 static void handle_rtg_command(uint32_t cmd) {
 184     //printf("Handling RTG command %d (%.8X)\n", cmd, cmd);
 185     switch (cmd) {
 186         case RTGCMD_SETGC:
 187             rtg_display_format = rtg_format;
 188             rtg_display_width = rtg_x[0];
 189             rtg_display_height = rtg_y[0];
 190             if (rtg_u8[0]) {
 191                 rtg_pitch = rtg_x[1];
 192                 rtg_total_rows = rtg_y[1];
 193             }
 194             else {
 195                 rtg_pitch = rtg_x[1];
 196                 rtg_total_rows = rtg_y[1];
 197             }
 198             //printf("Set RTG mode:\n");
 199             //printf("%dx%d pixels\n", rtg_display_width, rtg_display_height);
 200             //printf("Pixel format: %s\n", rtg_format_names[rtg_display_format]);
 201             break;
 202         case RTGCMD_SETPAN:
 203             //printf("Command: SetPan.\n");
 204             framebuffer_addr = rtg_address[0] - (PIGFX_RTG_BASE + PIGFX_REG_SIZE);
 205             rtg_offset_x = rtg_x[1];
 206             rtg_offset_y = rtg_y[1];
 207             rtg_pitch = (rtg_x[0] << rtg_display_format);
 208             //printf("Set panning to $%.8X\n", framebuffer_addr);
 209             //printf("Offset X/Y: %d/%d\n", rtg_offset_x, rtg_offset_y);
 210             //printf("Pitch: %d (%d bytes)\n", rtg_x[0], rtg_pitch);
 211             break;
 212         case RTGCMD_SETCLUT: {
 213             //printf("Command: SetCLUT.\n");
 214             //printf("Set palette entry %d to %d, %d, %d\n", rtg_u8[0], rtg_u8[1], rtg_u8[2], rtg_u8[3]);
 215             /*int r = (int)((float)rtg_u8[1] / 255.0f * 31.0f);
 216             int g = (int)((float)rtg_u8[2] / 255.0f * 63.0f);
 217             int b = (int)((float)rtg_u8[3] / 255.0f * 31.0f);
 218             palette[rtg_u8[0]] = ((r & 0x1F) << 11) | ((g & 0x3F) << 6) | (b & 0x1F);*/
 219             rtg_set_clut_entry(rtg_u8[0], rtg_u8[1], rtg_u8[2], rtg_u8[3]);
 220             break;
 221         }
 222         case RTGCMD_SETDISPLAY:
 223             // I remeber wrongs.
 224             //printf("Command: SetDisplay.\n");
 225             break;
 226         case RTGCMD_ENABLE:
 227         case RTGCMD_SETSWITCH:
 228             if (display_enabled != rtg_u8[1]) {
 229                 //printf("RTG Display %s\n", (rtg_u8[1]) ? "enabled" : "disabled");
 230                 display_enabled = rtg_u8[1];
 231                 if (display_enabled) {
 232                     rtg_init_display();
 233                     clock_gettime(CLOCK_PROCESS_CPUTIME_ID, &f1);
 234                 }
 235                 else
 236                     rtg_shutdown_display();
 237             }
 238             break;
 239         case RTGCMD_FILLRECT:
 240             rtg_fillrect(rtg_x[0], rtg_y[0], rtg_x[1], rtg_y[1], rtg_rgb[0], rtg_x[2], rtg_format, 0xFF);
 241             break;
 242     }
 243 }
 244
 245 void rtg_fillrect(uint16_t x, uint16_t y, uint16_t w, uint16_t h, uint32_t color, uint16_t pitch, uint16_t format, uint8_t mask) {
 246     if (mask) {}
 247     switch(format) {
 248         case RTGFMT_8BIT:
 249             break;
 250         case RTGFMT_RBG565: {
 251             uint16_t *ptr = (uint16_t *)&rtg_mem[framebuffer_addr + (x << format) + (y * pitch)];
 252             for (int xs = 0; xs < w; xs++) {
 253                 ptr[xs] = (color >> 16);
 254             }
 255             for (int ys = 1; ys < h; ys++) {
 256                 ptr += (rtg_pitch >> format);
 257                 memcpy(ptr, (void *)(size_t)(ptr - (rtg_pitch >> format)), rtg_pitch);
 258             }
 259             break;
 260         }
 261         case RTGFMT_RGB32:
 262             break;
 263     }
 264 }