remove gpu vblank callbacks
[pcsx_rearmed.git] / plugins / gpu_neon / gpu.c
index 4541b02..12417e6 100644 (file)
  */
 
 #include <stdio.h>
-#include <stdint.h>
 #include <string.h>
+#include "gpu.h"
 
 #define ARRAY_SIZE(x) (sizeof(x) / sizeof((x)[0]))
 #define unlikely(x) __builtin_expect((x), 0)
+#define noinline __attribute__((noinline))
 
-#define CMD_BUFFER_LEN          1024
-
-static struct __attribute__((aligned(64))) {
-  uint16_t vram[1024 * 512];
-  uint16_t guard[1024 * 512]; // overdraw guard
-  uint32_t cmd_buffer[CMD_BUFFER_LEN];
-  uint32_t regs[16];
-  union {
-    uint32_t reg;
-    struct {
-      uint32_t tx:4;        //  0 texture page
-      uint32_t ty:1;
-      uint32_t abr:2;
-      uint32_t tp:2;        //  7 t.p. mode (4,8,15bpp)
-      uint32_t dtd:1;       //  9 dither
-      uint32_t dfe:1;
-      uint32_t md:1;        // 11 set mask bit when drawing
-      uint32_t me:1;        // 12 no draw on mask
-      uint32_t unkn:3;
-      uint32_t width1:1;    // 16
-      uint32_t width0:2;
-      uint32_t dheight:1;   // 19 double height
-      uint32_t video:1;     // 20 NTSC,PAL
-      uint32_t rgb24:1;
-      uint32_t interlace:1; // 22 interlace on
-      uint32_t blanking:1;  // 23 display not enabled
-      uint32_t unkn2:2;
-      uint32_t busy:1;      // 26 !busy drawing
-      uint32_t img:1;       // 27 ready to DMA image data
-      uint32_t com:1;       // 28 ready for commands
-      uint32_t dma:2;       // 29 off, ?, to vram, from vram
-      uint32_t lcf:1;       // 31
-    };
-  } status;
-  struct {
-    int x, y, w, h;
-    int y1, y2;
-  } screen;
-  struct {
-    int x, y, w, h;
-    int offset;
-  } dma;
-  int cmd_len;
-  const uint32_t *lcf_hc;
-  uint32_t zero;
-} gpu;
+#define gpu_log(fmt, ...) \
+  printf("%d:%03d: " fmt, gpu.state.frame_count, *gpu.state.hcnt, ##__VA_ARGS__)
 
-long GPUinit(void)
+//#define log_io gpu_log
+#define log_io(...)
+//#define log_anomaly gpu_log
+#define log_anomaly(...)
+
+struct psx_gpu gpu __attribute__((aligned(64)));
+
+static noinline void do_reset(void)
 {
+  memset(gpu.regs, 0, sizeof(gpu.regs));
   gpu.status.reg = 0x14802000;
-  return 0;
+  gpu.gp0 = 0;
+  gpu.regs[3] = 1;
+  gpu.screen.hres = gpu.screen.w = 256;
+  gpu.screen.vres = gpu.screen.h = 240;
+}
+
+static noinline void update_width(void)
+{
+  int sw = gpu.screen.x2 - gpu.screen.x1;
+  if (sw <= 0 || sw >= 2560)
+    // full width
+    gpu.screen.w = gpu.screen.hres;
+  else
+    gpu.screen.w = sw * gpu.screen.hres / 2560;
+}
+
+static noinline void update_height(void)
+{
+  int sh = gpu.screen.y2 - gpu.screen.y1;
+  if (gpu.status.dheight)
+    sh *= 2;
+  if (sh <= 0)
+    sh = gpu.screen.vres;
+
+  gpu.screen.h = sh;
+}
+
+static noinline void decide_frameskip(void)
+{
+  gpu.frameskip.frame_ready = !gpu.frameskip.active;
+
+  if (!gpu.frameskip.active && (*gpu.frameskip.advice || gpu.frameskip.set == 1))
+    gpu.frameskip.active = 1;
+  else
+    gpu.frameskip.active = 0;
+}
+
+static noinline void get_gpu_info(uint32_t data)
+{
+  switch (data & 0x0f) {
+    case 0x02:
+    case 0x03:
+    case 0x04:
+    case 0x05:
+      gpu.gp0 = gpu.ex_regs[data & 7] & 0xfffff;
+      break;
+    case 0x06:
+      gpu.gp0 = gpu.ex_regs[5] & 0xfffff;
+      break;
+    case 0x07:
+      gpu.gp0 = 2;
+      break;
+    default:
+      gpu.gp0 = 0;
+      break;
+  }
+}
+
+long GPUinit(void)
+{
+  int ret;
+  ret  = vout_init();
+  ret |= renderer_init();
+
+  gpu.state.frame_count = 0;
+  gpu.state.hcnt = &gpu.zero;
+  do_reset();
+  return ret;
 }
 
 long GPUshutdown(void)
 {
-  return 0;
+  return vout_finish();
 }
 
 void GPUwriteStatus(uint32_t data)
@@ -79,9 +111,17 @@ void GPUwriteStatus(uint32_t data)
   static const short vres[4] = { 240, 480, 256, 480 };
   uint32_t cmd = data >> 24;
 
-  switch (data >> 24) {
+  if (cmd < ARRAY_SIZE(gpu.regs)) {
+    if (cmd != 0 && cmd != 5 && gpu.regs[cmd] == data)
+      return;
+    gpu.regs[cmd] = data;
+  }
+
+  gpu.state.fb_dirty = 1;
+
+  switch (cmd) {
     case 0x00:
-      gpu.status.reg = 0x14802000;
+      do_reset();
       break;
     case 0x03:
       gpu.status.blanking = data & 1;
@@ -92,23 +132,34 @@ void GPUwriteStatus(uint32_t data)
     case 0x05:
       gpu.screen.x = data & 0x3ff;
       gpu.screen.y = (data >> 10) & 0x3ff;
+      if (gpu.frameskip.set)
+        decide_frameskip();
+      break;
+    case 0x06:
+      gpu.screen.x1 = data & 0xfff;
+      gpu.screen.x2 = (data >> 12) & 0xfff;
+      update_width();
       break;
     case 0x07:
       gpu.screen.y1 = data & 0x3ff;
       gpu.screen.y2 = (data >> 10) & 0x3ff;
+      update_height();
       break;
     case 0x08:
       gpu.status.reg = (gpu.status.reg & ~0x7f0000) | ((data & 0x3F) << 17) | ((data & 0x40) << 10);
-      gpu.screen.w = hres[(gpu.status.reg >> 16) & 7];
-      gpu.screen.h = vres[(gpu.status.reg >> 19) & 3];
+      gpu.screen.hres = hres[(gpu.status.reg >> 16) & 7];
+      gpu.screen.vres = vres[(gpu.status.reg >> 19) & 3];
+      update_width();
+      update_height();
+      break;
+    default:
+      if ((cmd & 0xf0) == 0x10)
+        get_gpu_info(data);
       break;
   }
-
-  if (cmd < ARRAY_SIZE(gpu.regs))
-    gpu.regs[cmd] = data;
 }
 
-static const unsigned char cmd_lengths[256] =
+const unsigned char cmd_lengths[256] =
 {
        0, 0, 2, 0, 0, 0, 0, 0, 0, 0, 0, 0, 0, 0, 0, 0,
        0, 0, 0, 0, 0, 0, 0, 0, 0, 0, 0, 0, 0, 0, 0, 0,
@@ -128,39 +179,6 @@ static const unsigned char cmd_lengths[256] =
        0, 0, 0, 0, 0, 0, 0, 0, 0, 0, 0, 0, 0, 0, 0, 0
 };
 
-void do_cmd(uint32_t *list, int count)
-{
-  uint32_t *list_end = list + count;
-  int cmd;
-  //printf("do_cmd    %p, %d\n", data, count);
-
-  for (; list < list_end; list += 1 + cmd_lengths[cmd])
-  {
-    cmd = list[0] >> 24;
-    switch (cmd)
-    {
-      case 0xe1:
-        gpu.status.reg &= ~0x7ff;
-        gpu.status.reg |= list[0] & 0x7ff;
-        break;
-      case 0xe6:
-        gpu.status.reg &= ~0x1800;
-        gpu.status.reg |= (list[0] & 3) << 11;
-        break;
-    }
-    if ((cmd & 0xf4) == 0x24) {
-      // flat textured prim
-      gpu.status.reg &= ~0x1ff;
-      gpu.status.reg |= list[4] & 0x1ff;
-    }
-    else if ((cmd & 0xf4) == 0x34) {
-      // shaded textured prim
-      gpu.status.reg &= ~0x1ff;
-      gpu.status.reg |= list[5] & 0x1ff;
-    }
-  }
-}
-
 #define VRAM_MEM_XY(x, y) &gpu.vram[(y) * 1024 + (x)]
 
 static inline void do_vram_line(int x, int y, uint16_t *mem, int l, int is_read)
@@ -178,18 +196,26 @@ static int do_vram_io(uint32_t *data, int count, int is_read)
   uint16_t *sdata = (uint16_t *)data;
   int x = gpu.dma.x, y = gpu.dma.y;
   int w = gpu.dma.w, h = gpu.dma.h;
+  int o = gpu.dma.offset;
   int l;
   count *= 2; // operate in 16bpp pixels
 
   if (gpu.dma.offset) {
     l = w - gpu.dma.offset;
-    if (l > count)
+    if (count < l)
       l = count;
-    do_vram_line(x + gpu.dma.offset, y, sdata, l, is_read);
+
+    do_vram_line(x + o, y, sdata, l, is_read);
+
+    if (o + l < w)
+      o += l;
+    else {
+      o = 0;
+      y++;
+      h--;
+    }
     sdata += l;
     count -= l;
-    y++;
-    h--;
   }
 
   for (; h > 0 && count >= w; sdata += w, count -= w, y++, h--) {
@@ -200,19 +226,21 @@ static int do_vram_io(uint32_t *data, int count, int is_read)
   if (h > 0 && count > 0) {
     y &= 511;
     do_vram_line(x, y, sdata, count, is_read);
-    gpu.dma.offset = count;
+    o = count;
     count = 0;
   }
-  else
-    gpu.dma.offset = 0;
   gpu.dma.y = y;
   gpu.dma.h = h;
+  gpu.dma.offset = o;
 
-  return count_initial - (count + 1) / 2;
+  return count_initial - count / 2;
 }
 
 static void start_vram_transfer(uint32_t pos_word, uint32_t size_word, int is_read)
 {
+  if (gpu.dma.h)
+    log_anomaly("start_vram_transfer while old unfinished\n");
+
   gpu.dma.x = pos_word & 1023;
   gpu.dma.y = (pos_word >> 16) & 511;
   gpu.dma.w = size_word & 0xffff; // ?
@@ -221,32 +249,64 @@ static void start_vram_transfer(uint32_t pos_word, uint32_t size_word, int is_re
 
   if (is_read)
     gpu.status.img = 1;
+  else
+    renderer_invalidate_caches(gpu.dma.x, gpu.dma.y, gpu.dma.w, gpu.dma.h);
 
-  //printf("start_vram_transfer %c (%d, %d) %dx%d\n", is_read ? 'r' : 'w',
-  //  gpu.dma.x, gpu.dma.y, gpu.dma.w, gpu.dma.h);
+  log_io("start_vram_transfer %c (%d, %d) %dx%d\n", is_read ? 'r' : 'w',
+    gpu.dma.x, gpu.dma.y, gpu.dma.w, gpu.dma.h);
 }
 
 static int check_cmd(uint32_t *data, int count)
 {
   int len, cmd, start, pos;
-
-  //printf("check_cmd %p, %d\n", data, count);
+  int vram_dirty = 0;
 
   // process buffer
-  for (start = pos = 0;; )
+  for (start = pos = 0; pos < count; )
   {
     cmd = -1;
     len = 0;
 
     if (gpu.dma.h) {
       pos += do_vram_io(data + pos, count - pos, 0);
+      if (pos == count)
+        break;
       start = pos;
     }
 
+    // do look-ahead pass to detect SR changes and VRAM i/o
     while (pos < count) {
-      cmd = data[pos] >> 24;
+      uint32_t *list = data + pos;
+      cmd = list[0] >> 24;
       len = 1 + cmd_lengths[cmd];
+
       //printf("  %3d: %02x %d\n", pos, cmd, len);
+      if ((cmd & 0xf4) == 0x24) {
+        // flat textured prim
+        gpu.status.reg &= ~0x1ff;
+        gpu.status.reg |= list[4] & 0x1ff;
+      }
+      else if ((cmd & 0xf4) == 0x34) {
+        // shaded textured prim
+        gpu.status.reg &= ~0x1ff;
+        gpu.status.reg |= list[5] & 0x1ff;
+      }
+      else switch (cmd)
+      {
+        case 0xe1:
+          gpu.status.reg &= ~0x7ff;
+          gpu.status.reg |= list[0] & 0x7ff;
+          break;
+        case 0xe6:
+          gpu.status.reg &= ~0x1800;
+          gpu.status.reg |= (list[0] & 3) << 11;
+          break;
+      }
+      if (2 <= cmd && cmd < 0xc0)
+        vram_dirty = 1;
+      else if ((cmd & 0xf8) == 0xe0)
+        gpu.ex_regs[cmd & 7] = list[0];
+
       if (pos + len > count) {
         cmd = -1;
         break; // incomplete cmd
@@ -257,7 +317,8 @@ static int check_cmd(uint32_t *data, int count)
     }
 
     if (pos - start > 0) {
-      do_cmd(data + start, pos - start);
+      if (!gpu.frameskip.active)
+        do_cmd_list(data + start, pos - start);
       start = pos;
     }
 
@@ -266,15 +327,15 @@ static int check_cmd(uint32_t *data, int count)
       start_vram_transfer(data[pos + 1], data[pos + 2], cmd == 0xc0);
       pos += len;
     }
+    else if (cmd == -1)
+      break;
+  }
 
-    if (pos == count)
-      return 0;
+  if (gpu.frameskip.active)
+    renderer_sync_ecmds(gpu.ex_regs);
+  gpu.state.fb_dirty |= vram_dirty;
 
-    if (pos + len > count) {
-      //printf("discarding %d words\n", pos + len - count);
-      return pos + len - count;
-    }
-  }
+  return count - pos;
 }
 
 static void flush_cmd_buffer(void)
@@ -289,60 +350,121 @@ void GPUwriteDataMem(uint32_t *mem, int count)
 {
   int left;
 
+  log_io("gpu_dma_write %p %d\n", mem, count);
+
   if (unlikely(gpu.cmd_len > 0))
     flush_cmd_buffer();
+
   left = check_cmd(mem, count);
   if (left)
-    printf("GPUwriteDataMem: discarded %d/%d words\n", left, count);
+    log_anomaly("GPUwriteDataMem: discarded %d/%d words\n", left, count);
 }
 
 void GPUwriteData(uint32_t data)
 {
+  log_io("gpu_write %08x\n", data);
   gpu.cmd_buffer[gpu.cmd_len++] = data;
   if (gpu.cmd_len >= CMD_BUFFER_LEN)
     flush_cmd_buffer();
 }
 
-long GPUdmaChain(uint32_t *base, uint32_t addr)
+long GPUdmaChain(uint32_t *rambase, uint32_t start_addr)
 {
-  uint32_t *list;
-  int len;
+  uint32_t addr, *list;
+  uint32_t *llist_entry = NULL;
+  int len, left, count;
+  long dma_words = 0;
 
   if (unlikely(gpu.cmd_len > 0))
     flush_cmd_buffer();
 
-  while (addr != 0xffffff) {
-    list = base + (addr & 0x1fffff) / 4;
+  // ff7 sends it's main list twice, detect this
+  if (gpu.state.frame_count == gpu.state.last_list.frame &&
+     *gpu.state.hcnt - gpu.state.last_list.hcnt <= 1 &&
+      gpu.state.last_list.words > 1024)
+  {
+    llist_entry = rambase + (gpu.state.last_list.addr & 0x1fffff) / 4;
+    *llist_entry |= 0x800000;
+  }
+
+  log_io("gpu_dma_chain\n");
+  addr = start_addr & 0xffffff;
+  for (count = 0; addr != 0xffffff; count++)
+  {
+    list = rambase + (addr & 0x1fffff) / 4;
     len = list[0] >> 24;
     addr = list[0] & 0xffffff;
-    if (len)
-      GPUwriteDataMem(list + 1, len);
+    dma_words += 1 + len;
+
+    log_io(".chain %08x #%d\n", (list - rambase) * 4, len);
+
+    // loop detection marker
+    // (bit23 set causes DMA error on real machine, so
+    //  unlikely to be ever set by the game)
+    list[0] |= 0x800000;
+
+    if (len) {
+      left = check_cmd(list + 1, len);
+      if (left)
+        log_anomaly("GPUdmaChain: discarded %d/%d words\n", left, len);
+    }
+
+    if (addr & 0x800000)
+      break;
+  }
+
+  // remove loop detection markers
+  addr = start_addr & 0x1fffff;
+  while (count-- > 0) {
+    list = rambase + addr / 4;
+    addr = list[0] & 0x1fffff;
+    list[0] &= ~0x800000;
   }
+  if (llist_entry)
+    *llist_entry &= ~0x800000;
+
+  gpu.state.last_list.frame = gpu.state.frame_count;
+  gpu.state.last_list.hcnt = *gpu.state.hcnt;
+  gpu.state.last_list.words = dma_words;
+  gpu.state.last_list.addr = start_addr;
 
-  return 0;
+  return dma_words;
 }
 
 void GPUreadDataMem(uint32_t *mem, int count)
 {
+  log_io("gpu_dma_read  %p %d\n", mem, count);
+
   if (unlikely(gpu.cmd_len > 0))
     flush_cmd_buffer();
+
   if (gpu.dma.h)
     do_vram_io(mem, count, 1);
 }
 
 uint32_t GPUreadData(void)
 {
-  uint32_t v = 0;
-  GPUreadDataMem(&v, 1);
-  return v;
+  log_io("gpu_read\n");
+
+  if (unlikely(gpu.cmd_len > 0))
+    flush_cmd_buffer();
+
+  if (gpu.dma.h)
+    do_vram_io(&gpu.gp0, 1, 1);
+
+  return gpu.gp0;
 }
 
 uint32_t GPUreadStatus(void)
 {
+  uint32_t ret;
+
   if (unlikely(gpu.cmd_len > 0))
     flush_cmd_buffer();
 
-  return gpu.status.reg | (*gpu.lcf_hc << 31);
+  ret = gpu.status.reg;
+  log_io("gpu_read_status %08x\n", ret);
+  return ret;
 }
 
 typedef struct GPUFREEZETAG
@@ -355,123 +477,32 @@ typedef struct GPUFREEZETAG
 
 long GPUfreeze(uint32_t type, GPUFreeze_t *freeze)
 {
+  int i;
+
   switch (type) {
     case 1: // save
       if (gpu.cmd_len > 0)
         flush_cmd_buffer();
       memcpy(freeze->psxVRam, gpu.vram, sizeof(gpu.vram));
       memcpy(freeze->ulControl, gpu.regs, sizeof(gpu.regs));
+      memcpy(freeze->ulControl + 0xe0, gpu.ex_regs, sizeof(gpu.ex_regs));
       freeze->ulStatus = gpu.status.reg;
       break;
     case 0: // load
+      renderer_invalidate_caches(0, 0, 1024, 512);
       memcpy(gpu.vram, freeze->psxVRam, sizeof(gpu.vram));
       memcpy(gpu.regs, freeze->ulControl, sizeof(gpu.regs));
+      memcpy(gpu.ex_regs, freeze->ulControl + 0xe0, sizeof(gpu.ex_regs));
       gpu.status.reg = freeze->ulStatus;
-      GPUwriteStatus((5 << 24) | gpu.regs[5]);
-      GPUwriteStatus((7 << 24) | gpu.regs[7]);
-      GPUwriteStatus((8 << 24) | gpu.regs[8]);
+      for (i = 8; i > 0; i--) {
+        gpu.regs[i] ^= 1; // avoid reg change detection
+        GPUwriteStatus((i << 24) | (gpu.regs[i] ^ 1));
+      }
+      renderer_sync_ecmds(gpu.ex_regs);
       break;
   }
 
   return 1;
 }
 
-void GPUvBlank(int val, uint32_t *hcnt)
-{
-  gpu.lcf_hc = &gpu.zero;
-  if (gpu.status.interlace) {
-    if (val)
-      gpu.status.lcf ^= 1;
-  }
-  else {
-    gpu.status.lcf = 0;
-    if (!val)
-      gpu.lcf_hc = hcnt;
-  }
-}
-
-// rearmed specific
-
-#include "../../frontend/plugin_lib.h"
-#include "../../frontend/arm_utils.h"
-
-static const struct rearmed_cbs *cbs;
-static void *screen_buf;
-
-static void blit(void)
-{
-  static uint32_t old_status, old_h;
-  int x = gpu.screen.x & ~3; // alignment needed by blitter
-  int y = gpu.screen.y;
-  int w = gpu.screen.w;
-  int h;
-  uint16_t *srcs;
-  uint8_t  *dest;
-
-  srcs = &gpu.vram[y * 1024 + x];
-
-  h = gpu.screen.y2 - gpu.screen.y1;
-  if (gpu.status.dheight)
-    h *= 2;
-
-  if (h <= 0)
-    return;
-
-  if ((gpu.status.reg ^ old_status) & ((7<<16)|(1<<21)) || h != old_h) // width|rgb24 change?
-  {
-    old_status = gpu.status.reg;
-    old_h = h;
-    screen_buf = cbs->pl_fbdev_set_mode(w, h, gpu.status.rgb24 ? 24 : 16);
-  }
-  dest = screen_buf;
-
-  if (gpu.status.rgb24)
-  {
-#ifndef MAEMO
-    for (; h-- > 0; dest += w * 3, srcs += 1024)
-    {
-      bgr888_to_rgb888(dest, srcs, w * 3);
-    }
-#else
-    for (; h-- > 0; dest += w * 2, srcs += 1024)
-    {
-      bgr888_to_rgb565(dest, srcs, w * 3);
-    }
-#endif
-  }
-  else
-  {
-    for (; h-- > 0; dest += w * 2, srcs += 1024)
-    {
-      bgr555_to_rgb565(dest, srcs, w * 2);
-    }
-  }
-
-  screen_buf = cbs->pl_fbdev_flip();
-}
-
-void GPUupdateLace(void)
-{
-  if (!gpu.status.blanking)
-    blit();
-}
-
-long GPUopen(void)
-{
-  cbs->pl_fbdev_open();
-  screen_buf = cbs->pl_fbdev_flip();
-  return 0;
-}
-
-long GPUclose(void)
-{
-  cbs->pl_fbdev_close();
-  return 0;
-}
-
-void GPUrearmedCallbacks(const struct rearmed_cbs *cbs_)
-{
-  cbs = cbs_;
-}
-
 // vim:shiftwidth=2:expandtab