svp compiler direct calls

[picodrive.git] / Pico / carthw / svp / svp.c

diff --git a/Pico/carthw/svp/svp.c b/Pico/carthw/svp/svp.c
index 444a4c9..e76c7ce 100644 (file)
--- a/Pico/carthw/svp/svp.c
+++ b/Pico/carthw/svp/svp.c
@@ -1,6 +1,35 @@
+// The SVP chip emulator
+
+// (c) Copyright 2008, Grazvydas "notaz" Ignotas
+// Free for non-commercial use.
+
+// For commercial use, separate licencing terms must be obtained.
+
+
 #include "../../PicoInt.h"
+#include "compiler.h"
+#ifdef __GP2X__
+#include <sys/mman.h>
+#endif
 
 svp_t *svp = NULL;
+int PicoSVPCycles = 1000; // cycles/line
+
+/* save state stuff */
+typedef enum {
+       CHUNK_IRAM = CHUNK_CARTHW,
+       CHUNK_DRAM,
+       CHUNK_SSP
+} chunk_name_e;
+
+static carthw_state_chunk svp_states[] =
+{
+       { CHUNK_IRAM, 0x800,                 NULL },
+       { CHUNK_DRAM, sizeof(svp->dram),     NULL },
+       { CHUNK_SSP,  sizeof(svp->ssp1601),  NULL },
+       { 0,          0,                     NULL }
+};
+
 
 static void PicoSVPReset(void)
 {
@@ -8,21 +37,38 @@ static void PicoSVPReset(void)
 
        memcpy(svp->iram_rom + 0x800, Pico.rom + 0x800, 0x20000 - 0x800);
        ssp1601_reset(&svp->ssp1601);
+       if (!(PicoOpt&0x20000))
+               ssp1601_dyn_reset(&svp->ssp1601);
 }
 
 
-static void PicoSVPLine(void)
+static void PicoSVPLine(int count)
 {
+       static int inited = 0;
+       if (!(svp->ssp1601.gr[SSP_PM0].h & 2) && !inited) return;
+       inited = 1;
+
        // ???
-       // OSC_NTSC / 3.0 / 60.0 / 262.0 ~= 1139
-       // OSC_PAL  / 3.0 / 50.0 / 312.0 ~= 1137
-       ssp1601_run(800);
+       if (PicoOpt&0x20000)
+               ssp1601_run(PicoSVPCycles * count);
+       else
+               ssp1601_dyn_run(PicoSVPCycles * count);
+
+       // test mode
+       //if (Pico.m.frame_count == 13) PicoPad[0] |= 0xff;
 }
 
 
 static int PicoSVPDma(unsigned int source, int len, unsigned short **srcp, unsigned short **limitp)
 {
-       if ((source & 0xfe0000) == 0x300000)
+       if (source < Pico.romsize) // Rom
+       {
+               source -= 2;
+               *srcp = (unsigned short *)(Pico.rom + (source&~1));
+               *limitp = (unsigned short *)(Pico.rom + Pico.romsize);
+               return 1;
+       }
+       else if ((source & 0xfe0000) == 0x300000)
        {
                elprintf(EL_VDPDMA|EL_SVP, "SVP DmaSlow from %06x, len=%i", source, len);
                source &= 0x1fffe;
@@ -31,12 +77,33 @@ static int PicoSVPDma(unsigned int source, int len, unsigned short **srcp, unsig
                *limitp = (unsigned short *)(svp->dram + sizeof(svp->dram));
                return 1;
        }
+       else
+               elprintf(EL_VDPDMA|EL_SVP|EL_ANOMALY, "SVP FIXME unhandled DmaSlow from %06x, len=%i", source, len);
 
        return 0;
 }
 
 
 void PicoSVPInit(void)
+{
+#ifdef __GP2X__
+       int ret;
+       ret = munmap(tcache, TCACHE_SIZE);
+       printf("munmap tcache: %i\n", ret);
+#endif
+}
+
+
+static void PicoSVPShutdown(void)
+{
+#ifdef __GP2X__
+       // also unmap tcache
+       PicoSVPInit();
+#endif
+}
+
+
+void PicoSVPStartup(void)
 {
        void *tmp;
 
@@ -53,6 +120,16 @@ void PicoSVPInit(void)
        svp = (void *) ((char *)tmp + 0x200000);
        memset(svp, 0, sizeof(*svp));
 
+#ifdef __GP2X__
+       tmp = mmap(tcache, TCACHE_SIZE, PROT_READ|PROT_WRITE|PROT_EXEC, MAP_SHARED|MAP_ANONYMOUS, -1, 0);
+       printf("mmap tcache: %p, asked %p\n", tmp, tcache);
+#endif
+
+       // init SVP compiler
+       if (!(PicoOpt&0x20000)) {
+               if (ssp1601_dyn_startup()) return;
+       }
+
        // init ok, setup hooks..
        PicoRead16Hook = PicoSVPRead16;
        PicoWrite8Hook = PicoSVPWrite8;
@@ -60,5 +137,13 @@ void PicoSVPInit(void)
        PicoDmaHook = PicoSVPDma;
        PicoResetHook = PicoSVPReset;
        PicoLineHook = PicoSVPLine;
+       PicoCartUnloadHook = PicoSVPShutdown;
+
+       // save state stuff
+       svp_states[0].ptr = svp->iram_rom;
+       svp_states[1].ptr = svp->dram;
+       svp_states[2].ptr = &svp->ssp1601;
+       carthw_chunks = svp_states;
 }
 
+