*/
#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.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.lcf_hc = &gpu.zero;
+ 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)
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;
case 0x05:
gpu.screen.x = data & 0x3ff;
gpu.screen.y = (data >> 10) & 0x3ff;
+ if (gpu.frameskip.enabled)
+ 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,
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)
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--) {
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; // ?
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
}
if (pos - start > 0) {
- do_cmd(data + start, pos - start);
+ if (!gpu.frameskip.active)
+ do_cmd_list(data + start, pos - start);
start = pos;
}
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)
{
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 | (*gpu.lcf_hc << 31);
+ log_io("gpu_read_status %08x\n", ret);
+ return ret;
}
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;
}
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 (!val)
+ gpu.state.frame_count++;
- 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_;
+ gpu.state.hcnt = hcnt;
}
// vim:shiftwidth=2:expandtab