spu: handle stop better, split main func more
[pcsx_rearmed.git] / frontend / plat_pollux.c
index 32af9a6..33e9417 100644 (file)
@@ -1,8 +1,22 @@
 /*
- * (C) Gražvydas "notaz" Ignotas, 2009-2011
+ * (C) Gražvydas "notaz" Ignotas, 2009-2012
  *
  * This work is licensed under the terms of the GNU GPLv2 or later.
  * See the COPYING file in the top-level directory.
+ *
+ * GPH claims:
+ *  Main Memory  : Wiz = 0       ~ 2A00000,      Caanoo = 0       ~ 5600000 (86M)
+ *  Frame Buffer : Wiz = 2A00000 ~ 2E00000 (4M), Caanoo = 5600000 ~ 5700000 (1M)
+ *  Sound Buffer : Wiz = 2E00000 ~ 3000000 (2M), Caanoo = 5700000 ~ 5800000 (1M)
+ *  YUV Buffer   :                               Caanoo = 5800000 ~ 6000000 (8M)
+ *  3D Buffer    : Wiz = 3000000 ~ 4000000 (16M),Caanoo = 6000000 ~ 8000000 (32M)
+ *
+ * Caanoo dram column (or row?) is 1024 bytes?
+ *
+ * pollux display array:
+ * 27:24 |  23:18  |  17:11  |  10:6  |  5:0
+ *  seg  | y[11:5] | x[11:6] | y[4:0] | x[5:0]
+ *       |  blk_index[12:0]  |   block[10:0]
  */
 
 #include <stdio.h>
@@ -32,8 +46,8 @@
 #include "main.h"
 #include "menu.h"
 #include "plat.h"
-#include "pcnt.h"
-#include "../plugins/gpulib/cspace.h"
+#include "cspace.h"
+#include "../libpcsxcore/psxmem_map.h"
 
 
 static int fbdev = -1;
@@ -42,9 +56,9 @@ static unsigned int fb_paddrs[2];
 static int fb_work_buf;
 static int have_warm;
 #define FB_VRAM_SIZE (320*240*2*2*2) // 2 buffers with space for 24bpp mode
+static unsigned int uppermem_pbase, vram_pbase;
 
 static unsigned short *psx_vram;
-static unsigned int psx_vram_padds[512];
 static int psx_step, psx_width, psx_height, psx_bpp;
 static int psx_offset_x, psx_offset_y, psx_src_width, psx_src_height;
 static int fb_offset_x, fb_offset_y;
@@ -70,6 +84,36 @@ static const struct in_default_bind in_evdev_defbinds[] = {
        { 0, 0, 0 },
 };
 
+static const struct menu_keymap key_pbtn_map[] =
+{
+       { KEY_UP,       PBTN_UP },
+       { KEY_DOWN,     PBTN_DOWN },
+       { KEY_LEFT,     PBTN_LEFT },
+       { KEY_RIGHT,    PBTN_RIGHT },
+       /* Caanoo */
+       { BTN_THUMB2,   PBTN_MOK },
+       { BTN_THUMB,    PBTN_MBACK },
+       { BTN_TRIGGER,  PBTN_MA2 },
+       { BTN_TOP,      PBTN_MA3 },
+       { BTN_BASE,     PBTN_MENU },
+       { BTN_TOP2,     PBTN_L },
+       { BTN_PINKIE,   PBTN_R },
+       /* "normal" keyboards */
+       { KEY_ENTER,    PBTN_MOK },
+       { KEY_ESC,      PBTN_MBACK },
+       { KEY_SEMICOLON,  PBTN_MA2 },
+       { KEY_APOSTROPHE, PBTN_MA3 },
+       { KEY_BACKSLASH,  PBTN_MENU },
+       { KEY_LEFTBRACE,  PBTN_L },
+       { KEY_RIGHTBRACE, PBTN_R },
+};
+
+static const struct in_pdata gp2x_evdev_pdata = {
+       .defbinds = in_evdev_defbinds,
+       .key_map = key_pbtn_map,
+       .kmap_size = sizeof(key_pbtn_map) / sizeof(key_pbtn_map[0]),
+};
+
 static void *fb_flip(void)
 {
        memregl[0x406C>>2] = memregl[0x446C>>2] = fb_paddrs[fb_work_buf];
@@ -195,24 +239,6 @@ void plat_minimize(void)
 {
 }
 
-static void pl_vout_set_raw_vram(void *vram)
-{
-       int i;
-
-       psx_vram = vram;
-
-       if (vram == NULL)
-               return;
-
-       if ((long)psx_vram & 0x7ff)
-               fprintf(stderr, "GPU plugin did not align vram\n");
-
-       for (i = 0; i < 512; i++) {
-               psx_vram[i * 1024] = 0; // touch
-               psx_vram_padds[i] = warm_virt2phys(&psx_vram[i * 1024]);
-       }
-}
-
 static void spend_cycles(int loops)
 {
        asm volatile (
@@ -226,19 +252,20 @@ static void spend_cycles(int loops)
 #define DMA_REG(x) memregl[(DMA_BASE6 + x) >> 2]
 
 /* this takes ~1.5ms, while ldm/stm ~1.95ms */
-static void raw_flip_dma(const void *vram, int stride, int bgr24, int w, int h)
+static void raw_blit_dma(int doffs, const void *vram, int w, int h,
+                        int sstride, int bgr24)
 {
-       unsigned int pixel_offset = psx_vram - (unsigned short *)vram;
+       unsigned int pixel_offset = (unsigned short *)vram - psx_vram;
        unsigned int dst = fb_paddrs[fb_work_buf] +
                        (fb_offset_y * 320 + fb_offset_x) * psx_bpp / 8;
        int spsx_line = pixel_offset / 1024 + psx_offset_y;
        int spsx_offset = (pixel_offset + psx_offset_x) & 0x3f8;
+       unsigned int vram_byte_pos, vram_byte_step;
        int dst_stride = 320 * psx_bpp / 8;
        int len = psx_src_width * psx_bpp / 8;
        int i;
 
-       warm_cache_op_all(WOP_D_CLEAN);
-       pcnt_start(PCNT_BLIT);
+       //warm_cache_op_all(WOP_D_CLEAN);
 
        dst &= ~7;
        len &= ~7;
@@ -252,31 +279,27 @@ static void raw_flip_dma(const void *vram, int stride, int bgr24, int w, int h)
                DMA_REG(0x24) = 1;
        }
 
-       for (i = psx_src_height; i > 0; i--, spsx_line += psx_step, dst += dst_stride) {
+       vram_byte_pos = vram_pbase;
+       vram_byte_pos += (spsx_line & 511) * 2 * 1024 + spsx_offset * 2;
+       vram_byte_step = psx_step * 2 * 1024;
+
+       for (i = psx_src_height; i > 0;
+            i--, vram_byte_pos += vram_byte_step, dst += dst_stride)
+       {
                while ((DMA_REG(0x2c) & 0x0f) < 4)
                        spend_cycles(10);
 
                // XXX: it seems we must always set all regs, what is autoincrement there for?
                DMA_REG(0x20) = 1;              // queue wait cmd
-               DMA_REG(0x10) = psx_vram_padds[spsx_line & 511] + spsx_offset * 2; // DMA src
+               DMA_REG(0x10) = vram_byte_pos;  // DMA src
                DMA_REG(0x14) = dst;            // DMA dst
                DMA_REG(0x18) = len - 1;        // len
                DMA_REG(0x1c) = 0x80000;        // go
        }
-
-       if (psx_bpp == 16) {
-               pl_vout_buf = g_menuscreen_ptr;
-               pl_print_hud(w, h, fb_offset_x);
-       }
-
-       g_menuscreen_ptr = fb_flip();
-       pl_rearmed_cbs.flip_cnt++;
-
-       pcnt_end(PCNT_BLIT);
 }
 
 #define make_flip_func(name, blitfunc)                                                  \
-static void name(const void *vram_, int stride, int bgr24, int w, int h)                \
+static void name(int doffs, const void *vram_, int w, int h, int sstride, int bgr24)    \
 {                                                                                       \
         const unsigned short *vram = vram_;                                             \
         unsigned char *dst = (unsigned char *)g_menuscreen_ptr +                        \
@@ -285,27 +308,15 @@ static void name(const void *vram_, int stride, int bgr24, int w, int h)
         int len = psx_src_width * psx_bpp / 8;                                          \
         int i;                                                                          \
                                                                                         \
-        pcnt_start(PCNT_BLIT);                                                          \
-                                                                                        \
         vram += psx_offset_y * 1024 + psx_offset_x;                                     \
         for (i = psx_src_height; i > 0; i--, vram += psx_step * 1024, dst += dst_stride)\
                 blitfunc(dst, vram, len);                                               \
-                                                                                        \
-        if (psx_bpp == 16) {                                                            \
-                pl_vout_buf = g_menuscreen_ptr;                                         \
-                pl_print_hud(w, h, fb_offset_x);                                        \
-        }                                                                               \
-                                                                                        \
-        g_menuscreen_ptr = fb_flip();                                                   \
-        pl_rearmed_cbs.flip_cnt++;                                                      \
-                                                                                        \
-        pcnt_end(PCNT_BLIT);                                                            \
 }
 
-make_flip_func(raw_flip_soft, memcpy)
-make_flip_func(raw_flip_soft_368, blit320_368)
-make_flip_func(raw_flip_soft_512, blit320_512)
-make_flip_func(raw_flip_soft_640, blit320_640)
+make_flip_func(raw_blit_soft, memcpy)
+make_flip_func(raw_blit_soft_368, blit320_368)
+make_flip_func(raw_blit_soft_512, blit320_512)
+make_flip_func(raw_blit_soft_640, blit320_640)
 
 void *plat_gvideo_set_mode(int *w_, int *h_, int *bpp_)
 {
@@ -322,20 +333,20 @@ void *plat_gvideo_set_mode(int *w_, int *h_, int *bpp_)
 
        switch (w + (bpp != 16) + !soft_scaling) {
        case 640:
-               pl_rearmed_cbs.pl_vout_flip = raw_flip_soft_640;
+               pl_plat_blit = raw_blit_soft_640;
                w_max = 640;
                break;
        case 512:
-               pl_rearmed_cbs.pl_vout_flip = raw_flip_soft_512;
+               pl_plat_blit = raw_blit_soft_512;
                w_max = 512;
                break;
        case 384:
        case 368:
-               pl_rearmed_cbs.pl_vout_flip = raw_flip_soft_368;
+               pl_plat_blit = raw_blit_soft_368;
                w_max = 368;
                break;
        default:
-               pl_rearmed_cbs.pl_vout_flip = have_warm ? raw_flip_dma : raw_flip_soft;
+               pl_plat_blit = have_warm ? raw_blit_dma : raw_blit_soft;
                w_max = 320;
                break;
        }
@@ -380,7 +391,7 @@ void *plat_gvideo_set_mode(int *w_, int *h_, int *bpp_)
        *w_ = 320;
        *h_ = fb_offset_y + psx_src_height;
 
-       return NULL;
+       return g_menuscreen_ptr;
 }
 
 /* not really used, we do raw_flip */
@@ -390,13 +401,100 @@ void plat_gvideo_open(int is_pal)
 
 void *plat_gvideo_flip(void)
 {
-       return NULL;
+       g_menuscreen_ptr = fb_flip();
+       return g_menuscreen_ptr;
 }
 
 void plat_gvideo_close(void)
 {
 }
 
+static void *pl_emu_mmap(unsigned long addr, size_t size, int is_fixed,
+       enum psxMapTag tag)
+{
+       unsigned int pbase;
+       void *retval;
+       int ret;
+
+       if (!have_warm)
+               goto basic_map;
+
+       switch (tag) {
+       case MAP_TAG_RAM:
+               if (size > 0x400000) {
+                       fprintf(stderr, "unexpected ram map request: %08lx %x\n",
+                               addr, size);
+                       exit(1);
+               }
+               pbase = (uppermem_pbase + 0xffffff) & ~0xffffff;
+               pbase += 0x400000;
+               retval = (void *)addr;
+               ret = warm_mmap_section(retval, pbase, size, WCB_C_BIT);
+               if (ret != 0) {
+                       fprintf(stderr, "ram section map failed\n");
+                       exit(1);
+               }
+               goto out;
+       case MAP_TAG_VRAM:
+               if (size > 0x400000) {
+                       fprintf(stderr, "unexpected vram map request: %08lx %x\n",
+                               addr, size);
+                       exit(1);
+               }
+               if (addr == 0)
+                       addr = 0x60000000;
+               vram_pbase = (uppermem_pbase + 0xffffff) & ~0xffffff;
+               retval = (void *)addr;
+
+               ret = warm_mmap_section(retval, vram_pbase, size, WCB_C_BIT);
+               if (ret != 0) {
+                       fprintf(stderr, "vram section map failed\n");
+                       exit(1);
+               }
+               goto out;
+       case MAP_TAG_LUTS:
+               // mostly for Wiz to not run out of RAM
+               if (size > 0x800000) {
+                       fprintf(stderr, "unexpected LUT map request: %08lx %x\n",
+                               addr, size);
+                       exit(1);
+               }
+               pbase = (uppermem_pbase + 0xffffff) & ~0xffffff;
+               pbase += 0x800000;
+               retval = (void *)addr;
+               ret = warm_mmap_section(retval, pbase, size, WCB_C_BIT);
+               if (ret != 0) {
+                       fprintf(stderr, "LUT section map failed\n");
+                       exit(1);
+               }
+               goto out;
+       default:
+               break;
+       }
+
+basic_map:
+       retval = plat_mmap(addr, size, 0, is_fixed);
+
+out:
+       if (tag == MAP_TAG_VRAM)
+               psx_vram = retval;
+       return retval;
+}
+
+static void pl_emu_munmap(void *ptr, size_t size, enum psxMapTag tag)
+{
+       switch (tag) {
+       case MAP_TAG_RAM:
+       case MAP_TAG_VRAM:
+       case MAP_TAG_LUTS:
+               warm_munmap_section(ptr, size);
+               break;
+       default:
+               plat_munmap(ptr, size);
+               break;
+       }
+}
+
 void plat_init(void)
 {
        const char *main_fb_name = "/dev/fb0";
@@ -417,16 +515,41 @@ void plat_init(void)
                perror("ioctl(fbdev) failed");
                exit(1);
        }
+       uppermem_pbase = fbfix.smem_start;
+
        printf("framebuffer: \"%s\" @ %08lx\n", fbfix.id, fbfix.smem_start);
        fb_paddrs[0] = fbfix.smem_start;
        fb_paddrs[1] = fb_paddrs[0] + 320*240*4; // leave space for 24bpp
 
-       fb_vaddrs[0] = mmap(0, FB_VRAM_SIZE, PROT_READ|PROT_WRITE,
+       ret = warm_init();
+       have_warm = (ret == 0);
+
+       if (have_warm) {
+               // map fb as write-through cached section
+               fb_vaddrs[0] = (void *)0x7fe00000;
+               ret = warm_mmap_section(fb_vaddrs[0], fb_paddrs[0],
+                       FB_VRAM_SIZE, WCB_C_BIT);
+               if (ret != 0) {
+                       fprintf(stderr, "fb section map failed\n");
+                       fb_vaddrs[0] = NULL;
+
+                       // we could continue but it would just get messy
+                       exit(1);
+               }
+       }
+       if (fb_vaddrs[0] == NULL) {
+               fb_vaddrs[0] = mmap(0, FB_VRAM_SIZE, PROT_READ|PROT_WRITE,
                                MAP_SHARED, memdev, fb_paddrs[0]);
-       if (fb_vaddrs[0] == MAP_FAILED) {
-               perror("mmap(fb_vaddrs) failed");
-               exit(1);
+               if (fb_vaddrs[0] == MAP_FAILED) {
+                       perror("mmap(fb_vaddrs) failed");
+                       exit(1);
+               }
+
+               memset(fb_vaddrs[0], 0, FB_VRAM_SIZE);
+               warm_change_cb_range(WCB_C_BIT, 1, fb_vaddrs[0], FB_VRAM_SIZE);
        }
+       printf("  mapped @%p\n", fb_vaddrs[0]);
+
        fb_vaddrs[1] = (char *)fb_vaddrs[0] + 320*240*4;
 
        memset(fb_vaddrs[0], 0, FB_VRAM_SIZE);
@@ -436,22 +559,17 @@ void plat_init(void)
        g_menuscreen_h = 240;
        g_menuscreen_ptr = fb_flip();
 
-       ret = warm_init();
-       have_warm = (ret == 0);
-       warm_change_cb_upper(WCB_B_BIT, 1);
-
        /* setup DMA */
        DMA_REG(0x0c) = 0x20000; // pending IRQ clear
 
        in_tsbutton_init();
-       in_evdev_init(in_evdev_defbinds);
+       in_evdev_init(&gp2x_evdev_pdata);
        if (gp2x_dev_id == GP2X_DEV_CAANOO)
                caanoo_init();
        else
                wiz_init();
 
-       pl_rearmed_cbs.pl_vout_flip = have_warm ? raw_flip_dma : raw_flip_soft;
-       pl_rearmed_cbs.pl_vout_set_raw_vram = pl_vout_set_raw_vram;
+       pl_plat_blit = have_warm ? raw_blit_dma : raw_blit_soft;
 
        psx_src_width = 320;
        psx_src_height = 240;
@@ -463,6 +581,9 @@ void plat_init(void)
        plat_target_setup_input();
 
        plat_target.cpu_clock_set = cpu_clock_wrapper;
+
+       psxMapHook = pl_emu_mmap;
+       psxUnmapHook = pl_emu_munmap;
 }
 
 void plat_finish(void)
@@ -474,22 +595,6 @@ void plat_finish(void)
        plat_target_finish();
 }
 
-/* WIZ RAM lack workaround */
-void *memtab_mmap(void *addr, size_t size)
-{
-       void *ret;
-
-       if (gp2x_dev_id != GP2X_DEV_WIZ)
-               return mmap(addr, size, PROT_READ | PROT_WRITE,
-                       MAP_PRIVATE | MAP_ANONYMOUS | MAP_FIXED, -1, 0);
-
-       ret = mmap(addr, size, PROT_READ | PROT_WRITE,
-               MAP_SHARED | MAP_FIXED, memdev, 0x03000000);
-       if (ret != MAP_FAILED)
-               warm_change_cb_range(WCB_C_BIT | WCB_B_BIT, 1, ret, size);
-       return ret;
-}
-
 /* Caanoo stuff, perhaps move later */
 static const char * const caanoo_keys[KEY_MAX + 1] = {
        [0 ... KEY_MAX] = NULL,
@@ -599,10 +704,15 @@ static int haptic_init(void)
        return 0;
 }
 
-void plat_trigger_vibrate(int is_strong)
+void plat_trigger_vibrate(int pad, int low, int high)
 {
+       int is_strong;
        int ret;
 
+       if (low == 0 && high == 0)
+               return;
+       is_strong = (high >= 0xf0);
+
        if (hapticdev == -2)
                return; // it's broken
        if (hapticdev < 0) {