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

   1 // SPDX-License-Identifier: MIT
   2
   3 #include <stdint.h>
   4 #include <endian.h>
   5 #include <stdio.h>
   6 #include <stdlib.h>
   7 #include <string.h>
   8 #include <time.h>
   9 #include "config_file/config_file.h"
  10 #include "gpio/ps_protocol.h"
  11 #include "platforms/amiga/rtg/irtg_structs.h"
  12 #include "rtg.h"
  13
  14 #include "m68k.h"
  15
  16 void rtg_p2c_ex(int16_t sx, int16_t sy, int16_t dx, int16_t dy, int16_t w, int16_t h, uint8_t minterm, struct BitMap *bm, uint8_t mask, uint16_t dst_pitch, uint16_t src_pitch);
  17
  18 uint8_t rtg_u8[4];
  19 uint16_t rtg_x[8], rtg_y[8];
  20 uint16_t rtg_user[8];
  21 uint16_t rtg_format;
  22 uint32_t rtg_address[8];
  23 uint32_t rtg_address_adj[8];
  24 uint32_t rtg_rgb[8];
  25
  26 uint8_t display_enabled = 0xFF;
  27
  28 uint16_t rtg_display_width, rtg_display_height;
  29 uint16_t rtg_display_format;
  30 uint16_t rtg_pitch, rtg_total_rows;
  31 uint16_t rtg_offset_x, rtg_offset_y;
  32
  33 uint8_t *rtg_mem; // FIXME
  34
  35 uint32_t framebuffer_addr = 0;
  36 uint32_t framebuffer_addr_adj = 0;
  37
  38 static void handle_rtg_command(uint32_t cmd);
  39 static void handle_irtg_command(uint32_t cmd);
  40
  41 uint8_t realtime_graphics_debug = 0;
  42 extern int cpu_emulation_running;
  43 extern struct emulator_config *cfg;
  44 extern uint8_t rtg_on, rtg_enabled, rtg_output_in_vblank;
  45
  46 //#define DEBUG_RTG
  47
  48 #ifdef DEBUG_RTG
  49 /*static const char *op_type_names[OP_TYPE_NUM] = {
  50     "BYTE",
  51     "WORD",
  52     "LONGWORD",
  53     "MEM",
  54 };*/
  55
  56 static const char *rtg_format_names[RTGFMT_NUM] = {
  57     "8BPP CLUT",
  58     "16BPP RGB (565)",
  59     "32BPP RGB (RGBA)",
  60     "15BPP RGB (555)",
  61 };
  62 #define DEBUG printf
  63 #else
  64 #define DEBUG(...)
  65 #endif
  66
  67 int init_rtg_data(struct emulator_config *cfg_) {
  68     rtg_mem = calloc(1, 40 * SIZE_MEGA);
  69     if (!rtg_mem) {
  70         printf("Failed to allocate RTG video memory.\n");
  71         return 0;
  72     }
  73
  74     m68k_add_ram_range(PIGFX_RTG_BASE + PIGFX_REG_SIZE, 32 * SIZE_MEGA - PIGFX_REG_SIZE, rtg_mem);
  75     add_mapping(cfg_, MAPTYPE_RAM_NOALLOC, PIGFX_RTG_BASE + PIGFX_REG_SIZE, 40 * SIZE_MEGA - PIGFX_REG_SIZE, -1, (char *)rtg_mem, "rtg_mem", 0);
  76     return 1;
  77 }
  78
  79 void shutdown_rtg() {
  80     printf("[RTG] Shutting down RTG.\n");
  81     if (rtg_on) {
  82         display_enabled = 0xFF;
  83         rtg_on = 0;
  84     }
  85     if (rtg_mem) {
  86         free(rtg_mem);
  87         rtg_mem = NULL;
  88     }
  89 }
  90
  91 unsigned int rtg_get_fb() {
  92     return PIGFX_RTG_BASE + PIGFX_REG_SIZE + framebuffer_addr_adj;
  93 }
  94
  95 uint8_t wait_vblank = 0;
  96 uint32_t wait_rtg_frame = 0;
  97 extern uint32_t cur_rtg_frame;
  98
  99 unsigned int rtg_read(uint32_t address, uint8_t mode) {
 100     //printf("%s read from RTG: %.8X\n", op_type_names[mode], address);
 101     if (address >= PIGFX_REG_SIZE) {
 102         if (rtg_mem && (address - PIGFX_REG_SIZE) < PIGFX_UPPER) {
 103             switch (mode) {
 104                 case OP_TYPE_BYTE:
 105                     return (rtg_mem[address - PIGFX_REG_SIZE]);
 106                     break;
 107                 case OP_TYPE_WORD:
 108                     return be16toh(*(( uint16_t *) (&rtg_mem[address - PIGFX_REG_SIZE])));
 109                     break;
 110                 case OP_TYPE_LONGWORD:
 111                     return be32toh(*(( uint32_t *) (&rtg_mem[address - PIGFX_REG_SIZE])));
 112                     break;
 113                 default:
 114                     return 0;
 115             }
 116         }
 117     }
 118     switch (address) {
 119         case RTG_COMMAND:
 120             return rtg_enabled ? 0xFFCF : 0x0000;
 121         case RTG_WAITVSYNC:
 122             if (rtg_on) {
 123                 if (!wait_vblank && cur_rtg_frame != wait_rtg_frame) {
 124                     wait_rtg_frame = cur_rtg_frame;
 125                     if (wait_rtg_frame == 0) {
 126                         wait_rtg_frame = cur_rtg_frame;
 127                     }
 128                     if (wait_rtg_frame == 0)
 129                         printf("Wait RTG frame was zero!\n");
 130                     wait_vblank = 1;
 131                 }
 132                 if (cur_rtg_frame != wait_rtg_frame && wait_vblank) {
 133                     wait_vblank = 0;
 134                     return 1;
 135                 }
 136                 else
 137                     return 0;
 138             }
 139             // fallthrough
 140         case RTG_INVBLANK:
 141             return !rtg_on || rtg_output_in_vblank;
 142         default:
 143             break;
 144     }
 145
 146     return 0;
 147 }
 148
 149 struct timespec diff(struct timespec start, struct timespec end)
 150 {
 151     struct timespec temp;
 152     if ((end.tv_nsec-start.tv_nsec)<0) {
 153         temp.tv_sec = end.tv_sec-start.tv_sec-1;
 154         temp.tv_nsec = 1000000000+end.tv_nsec-start.tv_nsec;
 155     } else {
 156         temp.tv_sec = end.tv_sec-start.tv_sec;
 157         temp.tv_nsec = end.tv_nsec-start.tv_nsec;
 158     }
 159     return temp;
 160 }
 161
 162 #define CHKREG(a, b) case a: b = value; break;
 163
 164 void rtg_write(uint32_t address, uint32_t value, uint8_t mode) {
 165     //printf("%s write to RTG: %.8X (%.8X)\n", op_type_names[mode], address, value);
 166     if (address >= PIGFX_REG_SIZE) {
 167         /*if ((address - PIGFX_REG_SIZE) < framebuffer_addr) {// || (address - PIGFX_REG_SIZE) > framebuffer_addr + ((rtg_display_width << rtg_display_format) * rtg_display_height)) {
 168             printf("Write to RTG memory outside frame buffer %.8X (%.8X).\n", (address - PIGFX_REG_SIZE), framebuffer_addr);
 169         }*/
 170         if (rtg_mem && (address - PIGFX_REG_SIZE) < PIGFX_UPPER) {
 171             switch (mode) {
 172                 case OP_TYPE_BYTE:
 173                     rtg_mem[address - PIGFX_REG_SIZE] = value;
 174                     break;
 175                 case OP_TYPE_WORD:
 176                     *(( uint16_t *) (&rtg_mem[address - PIGFX_REG_SIZE])) = htobe16(value);
 177                     break;
 178                 case OP_TYPE_LONGWORD:
 179                     *(( uint32_t *) (&rtg_mem[address - PIGFX_REG_SIZE])) = htobe32(value);
 180                     break;
 181                 default:
 182                     return;
 183             }
 184         }
 185     } else if (address == RTG_DEBUGME) {
 186         printf("RTG DEBUGME WRITE: %d.\n", value);
 187     } else {
 188         switch (mode) {
 189             case OP_TYPE_BYTE:
 190                 switch (address) {
 191                     CHKREG(RTG_U81, rtg_u8[0]);
 192                     CHKREG(RTG_U82, rtg_u8[1]);
 193                     CHKREG(RTG_U83, rtg_u8[2]);
 194                     CHKREG(RTG_U84, rtg_u8[3]);
 195                 }
 196                 break;
 197             case OP_TYPE_WORD:
 198                 switch (address) {
 199                     CHKREG(RTG_X1, rtg_x[0]);
 200                     CHKREG(RTG_X2, rtg_x[1]);
 201                     CHKREG(RTG_X3, rtg_x[2]);
 202                     CHKREG(RTG_X4, rtg_x[3]);
 203                     CHKREG(RTG_X5, rtg_x[4]);
 204                     CHKREG(RTG_Y1, rtg_y[0]);
 205                     CHKREG(RTG_Y2, rtg_y[1]);
 206                     CHKREG(RTG_Y3, rtg_y[2]);
 207                     CHKREG(RTG_Y4, rtg_y[3]);
 208                     CHKREG(RTG_Y5, rtg_y[4]);
 209                     CHKREG(RTG_U1, rtg_user[0]);
 210                     CHKREG(RTG_U2, rtg_user[1]);
 211                     CHKREG(RTG_FORMAT, rtg_format);
 212                     case RTG_COMMAND:
 213                         handle_rtg_command(value);
 214                         break;
 215                     case IRTG_COMMAND:
 216                         handle_irtg_command(value);
 217                         break;
 218                 }
 219                 break;
 220             case OP_TYPE_LONGWORD:
 221                 switch (address) {
 222                     case RTG_ADDR1:
 223                         rtg_address[0] = value;
 224                         rtg_address_adj[0] = value - (PIGFX_RTG_BASE + PIGFX_REG_SIZE);
 225                         break;
 226                     case RTG_ADDR2:
 227                         rtg_address[1] = value;
 228                         rtg_address_adj[1] = value - (PIGFX_RTG_BASE + PIGFX_REG_SIZE);
 229                         break;
 230                     CHKREG(RTG_ADDR3, rtg_address[2]);
 231                     CHKREG(RTG_ADDR4, rtg_address[3]);
 232                     CHKREG(RTG_RGB1, rtg_rgb[0]);
 233                     CHKREG(RTG_RGB2, rtg_rgb[1]);
 234                 }
 235                 break;
 236         }
 237     }
 238
 239     return;
 240 }
 241
 242 #define gdebug(a) if (realtime_graphics_debug) { printf(a); m68k_end_timeslice(); cpu_emulation_running = 0; }
 243 #define M68KR(a) m68k_get_reg(NULL, a)
 244 #define RGBF_D7 rgbf_to_rtg[M68KR(M68K_REG_D7)]
 245 #define CMD_PITCH be16toh(r->BytesPerRow)
 246
 247 static struct P96RenderInfo *r;
 248 static struct P96BoardInfo *b;
 249 static struct P96Line *ln;
 250 static uint8_t cmd_mask;
 251
 252 static void handle_irtg_command(uint32_t cmd) {
 253     b = (struct P96BoardInfo *)get_mapped_data_pointer_by_address(cfg, M68KR(M68K_REG_A0));
 254     r = (struct P96RenderInfo *)get_mapped_data_pointer_by_address(cfg, M68KR(M68K_REG_A1));
 255
 256     switch (cmd) {
 257         case RTGCMD_SETPAN: {
 258             // A0: struct BoardInfo *b, A1: UBYTE *addr, D0 UWORD width, D1: WORD x_offset, D2: WORD y_offset, D7: RGBFTYPE format
 259 #ifdef DEBUG_RTG
 260             if (realtime_graphics_debug) {
 261                 printf("iSetPanning begin\n");
 262                 printf("IRTGCmd SetPanning\n");
 263                 printf("IRTGCmd x: %d y: %d w: %d (%d)\n", M68KR(M68K_REG_D1), M68KR(M68K_REG_D2), M68KR(M68K_REG_D0) << RGBF_D7, M68KR(M68K_REG_D0));
 264                 printf("BoardInfo: %.8X Addr: %.8X\n", M68KR(M68K_REG_A0), M68KR(M68K_REG_A1));
 265                 printf("BoardInfo Xoffs: %d Yoffs: %d\n", be16toh(b->XOffset), be16toh(b->YOffset));
 266             }
 267 #endif
 268             if (!b) break;
 269
 270             b->XOffset = (int16_t)htobe16(M68KR(M68K_REG_D1));
 271             b->YOffset = (int16_t)htobe16(M68KR(M68K_REG_D2));
 272
 273             rtg_offset_x = M68KR(M68K_REG_D1);
 274             rtg_offset_y = M68KR(M68K_REG_D2);
 275             rtg_pitch = (M68KR(M68K_REG_D0) << RGBF_D7);
 276             framebuffer_addr = M68KR(M68K_REG_A1) - (PIGFX_RTG_BASE + PIGFX_REG_SIZE);
 277             framebuffer_addr_adj = framebuffer_addr + (rtg_offset_x << RGBF_D7) + (rtg_offset_y * rtg_pitch);
 278
 279 #ifdef DEBUG_RTG
 280             if (realtime_graphics_debug) {
 281                 printf("RTG OffsetX/Y: %d/%d\n", rtg_offset_x, rtg_offset_y);
 282                 printf("RTG Pitch: %d\n", rtg_pitch);
 283                 printf("RTG FBAddr/Adj: %.8X (%.8X)/%.8X\n", framebuffer_addr, M68KR(M68K_REG_A1), framebuffer_addr_adj);
 284                 printf("iSetPanning End\n");
 285             }
 286 #endif
 287
 288             break;
 289         }
 290         case RTGCMD_DRAWLINE: {
 291             // A0: struct BoardInfo *b, A1: RenderInfo *r A2: struct Line *l, D0: UBYTE mask, D7: RGBFTYPE format
 292             gdebug("iDrawLine begin\n");
 293             ln = (struct P96Line *)get_mapped_data_pointer_by_address(cfg, M68KR(M68K_REG_A2));
 294
 295             if (!ln || !r) break;
 296
 297             cmd_mask = (uint8_t)M68KR(M68K_REG_D0);
 298             rtg_address_adj[0] = be32toh(r->_p_Memory) - (PIGFX_RTG_BASE + PIGFX_REG_SIZE);
 299
 300             if (cmd_mask == 0xFF && be16toh(ln->LinePtrn) == 0xFFFF) {
 301                 rtg_drawline_solid(be16toh(ln->X), be16toh(ln->Y), be16toh(ln->dX), be16toh(ln->dY),
 302                                    be16toh(ln->Length), be32toh(ln->FgPen), CMD_PITCH, RGBF_D7);
 303             } else {
 304                 rtg_drawline(be16toh(ln->X), be16toh(ln->Y), be16toh(ln->dX), be16toh(ln->dY),
 305                              be16toh(ln->Length), be16toh(ln->LinePtrn), be16toh(ln->PatternShift),
 306                              be32toh(ln->FgPen), be32toh(ln->BgPen), CMD_PITCH,
 307                              RGBF_D7, cmd_mask, ln->DrawMode);
 308             }
 309             gdebug("iDrawLine end\n");
 310             break;
 311         }
 312         case RTGCMD_FILLRECT: {
 313             // A0: BoardInfo *b, A1: RenderInfo *r
 314             // D0 WORD x, D1: WORD y, D2: WORD w, D3: WORD h
 315             // D4: ULONG color, D5: UBYTE mask, D7: RGBFTYPE format
 316             gdebug("iFillRect begin\n");
 317 #ifdef DEBUG_RTG
 318             if (realtime_graphics_debug) {
 319                 DEBUG("X1/X2: %d/%d-> X2/Y2: %d/%d\n", (int16_t)M68KR(M68K_REG_D0), (int16_t)M68KR(M68K_REG_D1), (int16_t)M68KR(M68K_REG_D2), (int16_t)M68KR(M68K_REG_D3));
 320                 DEBUG("R: %.8X B: %.8X\n", M68KR(M68K_REG_A0), M68KR(M68K_REG_A1));
 321             }
 322 #endif
 323
 324             if (!b || !r) break;
 325
 326             cmd_mask = (uint8_t)M68KR(M68K_REG_D5);
 327             rtg_address_adj[0] = be32toh(r->_p_Memory) - (PIGFX_RTG_BASE + PIGFX_REG_SIZE);
 328
 329             if (cmd_mask == 0xFF) {
 330                 rtg_fillrect_solid((int16_t)M68KR(M68K_REG_D0), (int16_t)M68KR(M68K_REG_D1), (int16_t)M68KR(M68K_REG_D2), (int16_t)M68KR(M68K_REG_D3),
 331                                    M68KR(M68K_REG_D4), CMD_PITCH, RGBF_D7);
 332             } else {
 333                 rtg_fillrect((int16_t)M68KR(M68K_REG_D0), (int16_t)M68KR(M68K_REG_D1), (int16_t)M68KR(M68K_REG_D2), (int16_t)M68KR(M68K_REG_D3),
 334                              M68KR(M68K_REG_D4), CMD_PITCH, RGBF_D7, cmd_mask);
 335             }
 336             gdebug("iFillRect end\n");
 337             break;
 338         }
 339         case RTGCMD_INVERTRECT: {
 340             // A0: BoardInfo *b, A1: RenderInfo *r
 341             // D0 WORD x, D1: WORD y, D2: WORD w, D3: WORD h
 342             // D4: UBYTE mask, D7: RGBFTYPE format
 343             gdebug("iInvertRect begin\n");
 344             if (!b || !r) break;
 345
 346             cmd_mask = (uint8_t)M68KR(M68K_REG_D4);
 347             rtg_address_adj[0] = be32toh(r->_p_Memory) - (PIGFX_RTG_BASE + PIGFX_REG_SIZE);
 348
 349             rtg_invertrect((int16_t)M68KR(M68K_REG_D0), (int16_t)M68KR(M68K_REG_D1), (int16_t)M68KR(M68K_REG_D2), (int16_t)M68KR(M68K_REG_D3), CMD_PITCH, RGBF_D7, cmd_mask);
 350             gdebug("iInvertRect end\n");
 351             break;
 352         }
 353         case RTGCMD_BLITRECT: {
 354             // A0: BoardInfo *b, A1: RenderInfo *r)
 355             // D0: WORD x, D1: WORD y, D2: WORD dx, D3: WORD dy, D4: WORD w, D5: WORD h,
 356             // D6: UBYTE mask, D7: RGBFTYPE format
 357             gdebug("iBlitRect begin\n");
 358
 359             cmd_mask = (uint8_t)M68KR(M68K_REG_D6);
 360             rtg_address_adj[0] = be32toh(r->_p_Memory) - (PIGFX_RTG_BASE + PIGFX_REG_SIZE);
 361
 362             if (cmd_mask == 0xFF) {
 363                 rtg_blitrect_solid(M68KR(M68K_REG_D0), M68KR(M68K_REG_D1), M68KR(M68K_REG_D2), M68KR(M68K_REG_D3), M68KR(M68K_REG_D4), M68KR(M68K_REG_D5), CMD_PITCH, RGBF_D7);
 364             } else {
 365                 rtg_blitrect(M68KR(M68K_REG_D0), M68KR(M68K_REG_D1), M68KR(M68K_REG_D2), M68KR(M68K_REG_D3), M68KR(M68K_REG_D4), M68KR(M68K_REG_D5), CMD_PITCH, RGBF_D7, cmd_mask);
 366             }
 367
 368             gdebug("iBlitRect end\n");
 369             break;
 370         }
 371         case RTGCMD_BLITRECT_NOMASK_COMPLETE: {
 372             // A0: BoardInfo *b, A1: RenderInfo *rs, A2: RenderInfo *rt,
 373             // D0: WORD x, D1: WORD y, D2: WORD dx, D3: WORD dy, D4: WORD w, D5: WORD h,
 374             // D6: UBYTE minterm, D7: RGBFTYPE format
 375             gdebug("iBlitRectNoMaskComplete begin\n");
 376
 377             uint8_t minterm = (uint8_t)M68KR(M68K_REG_D6);
 378             struct P96RenderInfo *rt = (struct P96RenderInfo *)get_mapped_data_pointer_by_address(cfg, M68KR(M68K_REG_A2));
 379
 380             uint32_t src_addr = be32toh(r->_p_Memory);
 381             uint32_t dst_addr = be32toh(rt->_p_Memory);
 382
 383             rtg_blitrect_nomask_complete(M68KR(M68K_REG_D0), M68KR(M68K_REG_D1), M68KR(M68K_REG_D2), M68KR(M68K_REG_D3), M68KR(M68K_REG_D4), M68KR(M68K_REG_D5),
 384                                          CMD_PITCH, be16toh(rt->BytesPerRow), src_addr, dst_addr, RGBF_D7, minterm);
 385
 386             gdebug("iBlitRectNoMaskComplete end\n");
 387             break;
 388         }
 389         case RTGCMD_BLITTEMPLATE: {
 390             // A0: BoardInfo *b, A1: RenderInfo *r, A2: Template *t
 391             // D0: WORD x, D1: WORD y, D2: WORD w, D3: WORD h
 392             // D4: UBYTE mask, D7: RGBFTYPE format
 393             if (!r || !M68KR(M68K_REG_A2))
 394                 break;
 395             gdebug("iBlitTemplate begin\n");
 396
 397             uint16_t t_pitch = 0, x_offset = 0;
 398             uint32_t src_addr = M68KR(M68K_REG_A2);
 399             uint32_t fgcol = 0, bgcol = 0;
 400             uint8_t draw_mode = 0;
 401
 402             struct P96Template *t = (struct P96Template *)get_mapped_data_pointer_by_address(cfg, M68KR(M68K_REG_A2));
 403             if (t) {
 404                 t_pitch = be16toh(t->BytesPerRow);
 405                 fgcol = be32toh(t->FgPen);
 406                 bgcol = be32toh(t->BgPen);
 407                 x_offset = t->XOffset;
 408                 draw_mode = t->DrawMode;
 409                 src_addr = be32toh(t->_p_Memory);
 410             } else {
 411                 t_pitch = be16toh(ps_read_16(src_addr + (uint32_t)&t->BytesPerRow));
 412                 fgcol = be32toh(ps_read_32(src_addr + (uint32_t)&t->FgPen));
 413                 bgcol = be32toh(ps_read_32(src_addr + (uint32_t)&t->BgPen));
 414                 x_offset = ps_read_8(src_addr + (uint32_t)&t->XOffset);
 415                 draw_mode = ps_read_8(src_addr + (uint32_t)&t->DrawMode);
 416                 src_addr = be32toh(ps_read_32(src_addr + (uint32_t)&t->_p_Memory));
 417             }
 418
 419             cmd_mask = (uint8_t)M68KR(M68K_REG_D4);
 420             rtg_address[1] = be32toh(r->_p_Memory);
 421             rtg_address_adj[1] = rtg_address[1] - (PIGFX_RTG_BASE + PIGFX_REG_SIZE);
 422
 423             rtg_blittemplate(M68KR(M68K_REG_D0), M68KR(M68K_REG_D1), M68KR(M68K_REG_D2), M68KR(M68K_REG_D3), src_addr, fgcol, bgcol, CMD_PITCH, t_pitch, RGBF_D7, x_offset, cmd_mask, draw_mode);
 424             gdebug("iBlitTemplate end\n");
 425             break;
 426         }
 427         case RTGCMD_BLITPATTERN: {
 428             // A0: BoardInfo *b, A1: RenderInfo *r, A2: Pattern *p
 429             // D0: WORD x, D1: WORD y, D2: WORD w, D3: WORD h
 430             // D4: UBYTE mask, D7: RGBFTYPE format
 431             if (!r || !M68KR(M68K_REG_A2))
 432                 break;
 433             gdebug("iBlitPattern begin\n");
 434
 435             uint16_t x_offset = 0, y_offset = 0;
 436             uint32_t src_addr = M68KR(M68K_REG_A2);
 437             uint32_t fgcol = 0, bgcol = 0;
 438             uint8_t draw_mode = 0, loop_rows = 0;
 439
 440             struct P96Pattern *p = (struct P96Pattern *)get_mapped_data_pointer_by_address(cfg, M68KR(M68K_REG_A2));
 441             if (p) {
 442                 fgcol = be32toh(p->FgPen);
 443                 bgcol = be32toh(p->BgPen);
 444                 x_offset = be16toh(p->XOffset);
 445                 y_offset = be16toh(p->YOffset);
 446                 draw_mode = p->DrawMode;
 447                 loop_rows = 1 << p->Size;
 448                 src_addr = be32toh(p->_p_Memory);
 449             } else {
 450                 fgcol = be32toh(ps_read_32(src_addr + (uint32_t)&p->FgPen));
 451                 bgcol = be32toh(ps_read_32(src_addr + (uint32_t)&p->BgPen));
 452                 x_offset = be16toh(ps_read_16(src_addr + (uint32_t)&p->XOffset));
 453                 y_offset = be16toh(ps_read_16(src_addr + (uint32_t)&p->YOffset));
 454                 draw_mode = ps_read_8(src_addr + (uint32_t)&p->DrawMode);
 455                 loop_rows = 1 << ps_read_8(src_addr + (uint32_t)&p->Size);
 456                 src_addr = be32toh(p->_p_Memory);
 457             }
 458
 459             cmd_mask = (uint8_t)M68KR(M68K_REG_D4);
 460             rtg_address[1] = be32toh(r->_p_Memory);
 461             rtg_address_adj[1] = rtg_address[1] - (PIGFX_RTG_BASE + PIGFX_REG_SIZE);
 462
 463             rtg_blitpattern(M68KR(M68K_REG_D0), M68KR(M68K_REG_D1), M68KR(M68K_REG_D2), M68KR(M68K_REG_D3), src_addr, fgcol, bgcol, CMD_PITCH, RGBF_D7, x_offset, y_offset, cmd_mask, draw_mode, loop_rows);
 464             gdebug("iBlitPattern end\n");
 465             break;
 466         }
 467         case RTGCMD_P2C: {
 468             // A0: BoardInfo, A1: BitMap *bm, A2: RenderInfo *r,
 469             // D0: SHORT x, D1: SHORT y, D2: SHORT dx, D3: SHORT dy, D4: SHORT w, D5: SHORT h,
 470             // D6: UBYTE minterm, D7: UBYTE mask
 471             r = (struct P96RenderInfo *)get_mapped_data_pointer_by_address(cfg, M68KR(M68K_REG_A2));
 472             struct BitMap *bm = (struct BitMap *)get_mapped_data_pointer_by_address(cfg, M68KR(M68K_REG_A1));
 473             if (!r || !bm)
 474                 break;
 475
 476             gdebug("iP2C begin\n");
 477
 478             if (!bm) {
 479                 printf ("Help! BitMap not in mapped memory.\n");
 480                 break;
 481             } else {
 482                 gdebug("Data is available in mapped memory.\n");
 483             }
 484
 485             if (realtime_graphics_debug) {
 486                 printf("bm: %.8X r: %.8X\n", (uint32_t)bm, (uint32_t)r);
 487                 if (bm)
 488                     printf("bm pitch: %d\n", be16toh(bm->BytesPerRow));
 489                 if (r)
 490                     printf("r pitch: %d\n", be16toh(r->BytesPerRow));
 491             }
 492
 493             uint16_t bmp_pitch = be16toh(bm->BytesPerRow);
 494             uint16_t line_pitch = be16toh(r->BytesPerRow);
 495             rtg_address_adj[0] = be32toh(r->_p_Memory) - (PIGFX_RTG_BASE + PIGFX_REG_SIZE);
 496
 497             uint8_t minterm = (uint8_t)M68KR(M68K_REG_D6);
 498             cmd_mask = (uint8_t)M68KR(M68K_REG_D7);
 499
 500             rtg_p2c_ex(M68KR(M68K_REG_D0), M68KR(M68K_REG_D1), M68KR(M68K_REG_D2), M68KR(M68K_REG_D3), M68KR(M68K_REG_D4), M68KR(M68K_REG_D5), minterm, bm, cmd_mask, line_pitch, bmp_pitch);
 501             gdebug("iP2C end\n");
 502             break;
 503         }
 504         default:
 505             printf("[!!!IRTG] Unnkonw/unhandled iRTG command %d.\n", cmd);
 506             break;
 507     }
 508 }
 509
 510 static void handle_rtg_command(uint32_t cmd) {
 511   //printf("Handling RTG command %d (%.8X)\n", cmd, cmd);
 512     switch (cmd) {
 513         case RTGCMD_SETGC:
 514             gdebug("SetGC\n");
 515             rtg_display_format = rtg_format;
 516             rtg_display_width = rtg_x[0];
 517             rtg_display_height = rtg_y[0];
 518             if (rtg_u8[0]) {
 519                 //rtg_pitch = rtg_display_width << rtg_format;
 520                 framebuffer_addr_adj = framebuffer_addr + (rtg_offset_x << rtg_display_format) + (rtg_offset_y * rtg_pitch);
 521                 rtg_total_rows = rtg_y[1];
 522             }
 523             else {
 524                 //rtg_pitch = rtg_display_width << rtg_format;
 525                 framebuffer_addr_adj = framebuffer_addr + (rtg_offset_x << rtg_display_format) + (rtg_offset_y * rtg_pitch);
 526                 rtg_total_rows = rtg_y[1];
 527             }
 528             if (realtime_graphics_debug) {
 529                 printf("Set RTG mode:\n");
 530                 printf("%dx%d pixels\n", rtg_display_width, rtg_display_height);
 531 #ifdef DEBUG_RTG
 532                 printf("Pixel format: %s\n", rtg_format_names[rtg_display_format]);
 533 #endif
 534             }
 535             break;
 536         case RTGCMD_SETPAN:
 537             //printf("Command: SetPan.\n");
 538             rtg_offset_x = rtg_x[1];
 539             rtg_offset_y = rtg_y[1];
 540             rtg_pitch = (rtg_x[0] << rtg_display_format);
 541             framebuffer_addr = rtg_address[0] - (PIGFX_RTG_BASE + PIGFX_REG_SIZE);
 542             framebuffer_addr_adj = framebuffer_addr + (rtg_offset_x << rtg_display_format) + (rtg_offset_y * rtg_pitch);
 543             break;
 544         case RTGCMD_SETCLUT: {
 545             //printf("Command: SetCLUT.\n");
 546             //printf("Set palette entry %d to %d, %d, %d\n", rtg_u8[0], rtg_u8[1], rtg_u8[2], rtg_u8[3]);
 547             //printf("Set palette entry %d to 32-bit palette color: %.8X\n", rtg_u8[0], rtg_rgb[0]);
 548             rtg_set_clut_entry(rtg_u8[0], rtg_rgb[0]);
 549             break;
 550         }
 551         case RTGCMD_SETDISPLAY:
 552             gdebug("SetDisplay\n");
 553             if (realtime_graphics_debug) {
 554                 printf("RTG SetDisplay %s\n", (rtg_u8[1]) ? "enabled" : "disabled");
 555             }
 556             break;
 557         case RTGCMD_ENABLE:
 558         case RTGCMD_SETSWITCH:
 559             gdebug("SetSwitch\n");
 560             if (realtime_graphics_debug) {
 561                 printf("RTG SetSwitch %s\n", ((rtg_x[0]) & 0x01) ? "enabled" : "disabled");
 562                 printf("LAL: %.4X\n", rtg_x[0]);
 563             }
 564             display_enabled = ((rtg_x[0]) & 0x01);
 565             if (display_enabled != rtg_on) {
 566                 rtg_on = display_enabled;
 567                 if (rtg_on)
 568                     rtg_init_display();
 569                 else
 570                     rtg_shutdown_display();
 571             }
 572             break;
 573         case RTGCMD_FILLRECT:
 574             if (rtg_u8[0] == 0xFF || rtg_format != RTGFMT_8BIT) {
 575                 rtg_fillrect_solid(rtg_x[0], rtg_y[0], rtg_x[1], rtg_y[1], rtg_rgb[0], rtg_x[2], rtg_format);
 576                 gdebug("FillRect Solid\n");
 577             }
 578             else {
 579                 rtg_fillrect(rtg_x[0], rtg_y[0], rtg_x[1], rtg_y[1], rtg_rgb[0], rtg_x[2], rtg_format, rtg_u8[0]);
 580                 gdebug("FillRect Masked\n");
 581             }
 582             break;
 583         case RTGCMD_INVERTRECT:
 584             rtg_invertrect(rtg_x[0], rtg_y[0], rtg_x[1], rtg_y[1], rtg_x[2], rtg_format, rtg_u8[0]);
 585             gdebug("InvertRect\n");
 586             break;
 587         case RTGCMD_BLITRECT:
 588             if (rtg_u8[0] == 0xFF || rtg_format != RTGFMT_8BIT) {
 589                 rtg_blitrect_solid(rtg_x[0], rtg_y[0], rtg_x[1], rtg_y[1], rtg_x[2], rtg_y[2], rtg_x[3], rtg_format);
 590                 gdebug("BlitRect Solid\n");
 591             }
 592             else {
 593                 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, rtg_u8[0]);
 594                 gdebug("BlitRect Masked\n");
 595             }
 596             break;
 597         case RTGCMD_BLITRECT_NOMASK_COMPLETE:
 598             rtg_blitrect_nomask_complete(rtg_x[0], rtg_y[0], rtg_x[1], rtg_y[1], rtg_x[2], rtg_y[2], rtg_x[3], rtg_x[4], rtg_address[0], rtg_address[1], rtg_format, rtg_u8[0]);
 599             gdebug("BlitRectNoMaskComplete\n");
 600             break;
 601         case RTGCMD_BLITPATTERN:
 602             rtg_blitpattern(rtg_x[0], rtg_y[0], rtg_x[1], rtg_y[1], rtg_address[0], rtg_rgb[0], rtg_rgb[1], rtg_x[3], rtg_format, rtg_x[2], rtg_y[2], rtg_u8[0], rtg_u8[1], rtg_u8[2]);
 603             gdebug("BlitPattern\n");
 604             return;
 605         case RTGCMD_BLITTEMPLATE:
 606             rtg_blittemplate(rtg_x[0], rtg_y[0], rtg_x[1], rtg_y[1], rtg_address[0], rtg_rgb[0], rtg_rgb[1], rtg_x[3], rtg_x[4], rtg_format, rtg_x[2], rtg_u8[0], rtg_u8[1]);
 607             gdebug("BlitTemplate\n");
 608             break;
 609         case RTGCMD_DRAWLINE:
 610             if (rtg_u8[0] == 0xFF && rtg_y[2] == 0xFFFF)
 611                 rtg_drawline_solid(rtg_x[0], rtg_y[0], rtg_x[1], rtg_y[1], rtg_x[2], rtg_rgb[0], rtg_x[3], rtg_format);
 612             else
 613                 rtg_drawline(rtg_x[0], rtg_y[0], rtg_x[1], rtg_y[1], rtg_x[2], rtg_y[2], rtg_x[4], rtg_rgb[0], rtg_rgb[1], rtg_x[3], rtg_format, rtg_u8[0], rtg_u8[1]);
 614             gdebug("DrawLine\n");
 615             break;
 616         case RTGCMD_P2C:
 617             rtg_p2c(rtg_x[0], rtg_y[0], rtg_x[1], rtg_y[1], rtg_x[2], rtg_y[2], rtg_u8[1], rtg_u8[2], rtg_u8[0], (rtg_user[0] >> 0x8), rtg_x[4], (uint8_t *)&rtg_mem[rtg_address_adj[1]]);
 618             gdebug("Planar2Chunky\n");
 619             break;
 620         case RTGCMD_P2D:
 621             rtg_p2d(rtg_x[0], rtg_y[0], rtg_x[1], rtg_y[1], rtg_x[2], rtg_y[2], rtg_u8[1], rtg_u8[2], rtg_u8[0], (rtg_user[0] >> 0x8), rtg_x[4], (uint8_t *)&rtg_mem[rtg_address_adj[1]]);
 622             gdebug("Planar2Direct\n");
 623             break;
 624         case RTGCMD_SETSPRITE:
 625             rtg_enable_mouse_cursor();
 626             gdebug("SetSprite\n");
 627             break;
 628         case RTGCMD_SETSPRITECOLOR:
 629             rtg_set_cursor_clut_entry(rtg_u8[0], rtg_u8[1], rtg_u8[2], rtg_u8[3]);
 630             gdebug("SetSpriteColor\n");
 631             break;
 632         case RTGCMD_SETSPRITEPOS:
 633             rtg_set_mouse_cursor_pos((int16_t)rtg_x[0], (int16_t)rtg_y[0]);
 634             gdebug("SetSpritePos\n");
 635             break;
 636         case RTGCMD_SETSPRITEIMAGE:
 637             rtg_set_mouse_cursor_image(&rtg_mem[rtg_address_adj[1]], rtg_u8[0], rtg_u8[1]);
 638             gdebug("SetSpriteImage\n");
 639             break;
 640         case RTGCMD_DEBUGME:
 641             printf ("[RTG] DebugMe!\n");
 642             break;
 643         default:
 644             printf("[!!!RTG] Unknown/unhandled RTG command %d ($%.4X)\n", cmd, cmd);
 645             break;
 646     }
 647 }