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 uint8_t rtg_u8[4];
  11 static uint16_t rtg_x[8], rtg_y[8];
  12 static uint16_t rtg_user[8];
  13 static uint16_t rtg_format;
  14 static uint32_t rtg_address[2];
  15 static uint32_t rtg_rgb[2];
  16
  17 static uint8_t display_enabled = 0xFF;
  18
  19 uint16_t rtg_display_width, rtg_display_height;
  20 uint16_t rtg_display_format;
  21 uint16_t rtg_pitch, rtg_total_rows;
  22 uint16_t rtg_offset_x, rtg_offset_y;
  23
  24 uint8_t *rtg_mem; // FIXME
  25
  26 uint32_t framebuffer_addr;
  27 uint32_t framebuffer_addr_adj;
  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 be16toh(*(( uint16_t *) (&rtg_mem[address - PIGFX_REG_SIZE])));
  69                     break;
  70                 case OP_TYPE_LONGWORD:
  71                     return be32toh(*(( 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 #define CHKREG(a, b) case a: b = value; break;
  96
  97 void rtg_write(uint32_t address, uint32_t value, uint8_t mode) {
  98     //printf("%s write to RTG: %.8X (%.8X)\n", op_type_names[mode], address, value);
  99     if (address >= PIGFX_REG_SIZE) {
 100         /*if ((address - PIGFX_REG_SIZE) < framebuffer_addr) {// || (address - PIGFX_REG_SIZE) > framebuffer_addr + ((rtg_display_width << rtg_display_format) * rtg_display_height)) {
 101             printf("Write to RTG memory outside frame buffer %.8X (%.8X).\n", (address - PIGFX_REG_SIZE), framebuffer_addr);
 102         }*/
 103         if (rtg_mem) {
 104             switch (mode) {
 105                 case OP_TYPE_BYTE:
 106                     rtg_mem[address - PIGFX_REG_SIZE] = value;
 107                     break;
 108                 case OP_TYPE_WORD:
 109                     *(( uint16_t *) (&rtg_mem[address - PIGFX_REG_SIZE])) = htobe16(value);
 110                     break;
 111                 case OP_TYPE_LONGWORD:
 112                     *(( uint32_t *) (&rtg_mem[address - PIGFX_REG_SIZE])) = htobe32(value);
 113                     break;
 114                 default:
 115                     return;
 116             }
 117         }
 118     }
 119     else {
 120         switch (mode) {
 121             case OP_TYPE_BYTE:
 122                 switch (address) {
 123                     CHKREG(RTG_U81, rtg_u8[0]);
 124                     CHKREG(RTG_U82, rtg_u8[1]);
 125                     CHKREG(RTG_U83, rtg_u8[2]);
 126                     CHKREG(RTG_U84, rtg_u8[3]);
 127                 }
 128                 break;
 129             case OP_TYPE_WORD:
 130                 switch (address) {
 131                     CHKREG(RTG_X1, rtg_x[0]);
 132                     CHKREG(RTG_X2, rtg_x[1]);
 133                     CHKREG(RTG_X3, rtg_x[2]);
 134                     CHKREG(RTG_X4, rtg_x[3]);
 135                     CHKREG(RTG_X5, rtg_x[4]);
 136                     CHKREG(RTG_Y1, rtg_y[0]);
 137                     CHKREG(RTG_Y2, rtg_y[1]);
 138                     CHKREG(RTG_Y3, rtg_y[2]);
 139                     CHKREG(RTG_Y4, rtg_y[3]);
 140                     CHKREG(RTG_Y5, rtg_y[4]);
 141                     CHKREG(RTG_U1, rtg_user[0]);
 142                     CHKREG(RTG_U2, rtg_user[1]);
 143                     CHKREG(RTG_FORMAT, rtg_format);
 144                     case RTG_COMMAND:
 145                         handle_rtg_command(value);
 146                         break;
 147                 }
 148                 break;
 149             case OP_TYPE_LONGWORD:
 150                 switch (address) {
 151                     case RTG_ADDR1:
 152                         rtg_address[0] = value;
 153                         break;
 154                     case RTG_ADDR2:
 155                         rtg_address[1] = value;
 156                         break;
 157                     case RTG_RGB1:
 158                         rtg_rgb[0] = value;
 159                         break;
 160                     case RTG_RGB2:
 161                         rtg_rgb[1] = value;
 162                         break;
 163                 }
 164                 break;
 165         }
 166     }
 167
 168     return;
 169 }
 170
 171 static void handle_rtg_command(uint32_t cmd) {
 172     //printf("Handling RTG command %d (%.8X)\n", cmd, cmd);
 173     switch (cmd) {
 174         case RTGCMD_SETGC:
 175             rtg_display_format = rtg_format;
 176             rtg_display_width = rtg_x[0];
 177             rtg_display_height = rtg_y[0];
 178             if (rtg_u8[0]) {
 179                 //rtg_pitch = rtg_display_width << rtg_format;
 180                 framebuffer_addr_adj = framebuffer_addr + (rtg_offset_x << rtg_display_format) + (rtg_offset_y * rtg_pitch);
 181                 rtg_total_rows = rtg_y[1];
 182             }
 183             else {
 184                 //rtg_pitch = rtg_display_width << rtg_format;
 185                 framebuffer_addr_adj = framebuffer_addr + (rtg_offset_x << rtg_display_format) + (rtg_offset_y * rtg_pitch);
 186                 rtg_total_rows = rtg_y[1];
 187             }
 188             printf("Set RTG mode:\n");
 189             printf("%dx%d pixels\n", rtg_display_width, rtg_display_height);
 190             printf("Pixel format: %s\n", rtg_format_names[rtg_display_format]);
 191             break;
 192         case RTGCMD_SETPAN:
 193             //printf("Command: SetPan.\n");
 194             rtg_offset_x = rtg_x[1];
 195             rtg_offset_y = rtg_y[1];
 196             rtg_pitch = (rtg_x[0] << rtg_display_format);
 197             framebuffer_addr = rtg_address[0] - (PIGFX_RTG_BASE + PIGFX_REG_SIZE);
 198             framebuffer_addr_adj = framebuffer_addr + (rtg_offset_x << rtg_display_format) + (rtg_offset_y * rtg_pitch);
 199             printf("Set panning to $%.8X (%.8X)\n", framebuffer_addr, rtg_address[0]);
 200             printf("(Panned: $%.8X)\n", framebuffer_addr_adj);
 201             printf("Offset X/Y: %d/%d\n", rtg_offset_x, rtg_offset_y);
 202             printf("Pitch: %d (%d bytes)\n", rtg_x[0], rtg_pitch);
 203             break;
 204         case RTGCMD_SETCLUT: {
 205             //printf("Command: SetCLUT.\n");
 206             //printf("Set palette entry %d to %d, %d, %d\n", rtg_u8[0], rtg_u8[1], rtg_u8[2], rtg_u8[3]);
 207             //printf("Set palette entry %d to 32-bit palette color: %.8X\n", rtg_u8[0], rtg_rgb[0]);
 208             rtg_set_clut_entry(rtg_u8[0], rtg_rgb[0]);
 209             break;
 210         }
 211         case RTGCMD_SETDISPLAY:
 212             //printf("RTG SetDisplay %s\n", (rtg_u8[1]) ? "enabled" : "disabled");
 213             // I remeber wrongs.
 214             //printf("Command: SetDisplay.\n");
 215             break;
 216         case RTGCMD_ENABLE:
 217         case RTGCMD_SETSWITCH:
 218             //printf("RTG SetSwitch %s\n", ((rtg_x[0]) & 0x01) ? "enabled" : "disabled");
 219             //printf("LAL: %.4X\n", rtg_x[0]);
 220             if (display_enabled != ((rtg_x[0]) & 0x01)) {
 221                 display_enabled = ((rtg_x[0]) & 0x01);
 222                 if (display_enabled) {
 223                     rtg_init_display();
 224                 }
 225                 else
 226                     rtg_shutdown_display();
 227             }
 228             break;
 229         case RTGCMD_FILLRECT:
 230             rtg_fillrect(rtg_x[0], rtg_y[0], rtg_x[1], rtg_y[1], rtg_rgb[0], rtg_x[2], rtg_format, 0xFF);
 231             break;
 232         case RTGCMD_BLITRECT:
 233             rtg_blitrect(rtg_x[0], rtg_y[0], rtg_x[1], rtg_y[1], rtg_x[2], rtg_y[2], rtg_x[3], rtg_format, 0xFF);
 234     }
 235 }
 236
 237 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) {
 238     if (mask) {}
 239     uint8_t *dptr = &rtg_mem[framebuffer_addr + (x << format) + (y * pitch)];
 240     //printf("FillRect: %d,%d to %d,%d C%.8X, p:%d dp: %d m:%.2X\n", x, y, x+w, y+h, color, pitch, rtg_pitch, mask);
 241     //printf("%.8X - %.8X (%p)\n", framebuffer_addr, framebuffer_addr_adj, dptr);
 242     switch(format) {
 243         case RTGFMT_8BIT: {
 244             //printf("Incoming 8-bit color: %.8X\n", color);
 245             for (int xs = 0; xs < w; xs++) {
 246                 dptr[xs] = color & 0xFF;
 247             }
 248             break;
 249         }
 250         case RTGFMT_RBG565: {
 251             //printf("Incoming raw 16-bit color: %.8X\n", htobe32(color));
 252             color = htobe16((color & 0xFFFF));
 253             //printf("Incoming 16-bit color: %.8X\n", color);
 254             uint16_t *ptr = (uint16_t *)dptr;
 255             for (int xs = 0; xs < w; xs++) {
 256                 ptr[xs] = color;
 257             }
 258             break;
 259         }
 260         case RTGFMT_RGB32: {
 261             color = htobe32(color);
 262             //printf("Incoming 32-bit color: %.8X\n", color);
 263             uint32_t *ptr = (uint32_t *)dptr;
 264             for (int xs = 0; xs < w; xs++) {
 265                 ptr[xs] = color;
 266             }
 267             break;
 268         }
 269     }
 270     for (int ys = 1; ys < h; ys++) {
 271         dptr += pitch;
 272         memcpy(dptr, (void *)(size_t)(dptr - pitch), (w << format));
 273     }
 274 }
 275
 276 void rtg_blitrect(uint16_t x, uint16_t y, uint16_t dx, uint16_t dy, uint16_t w, uint16_t h, uint16_t pitch, uint16_t format, uint8_t mask) {
 277     if (mask) {}
 278     uint8_t *sptr = &rtg_mem[framebuffer_addr + (x << format) + (y * pitch)];
 279     uint8_t *dptr = &rtg_mem[framebuffer_addr + (dx << format) + (dy * pitch)];
 280 }