X-Git-Url: https://notaz.gp2x.de/cgi-bin/gitweb.cgi?a=blobdiff_plain;f=Pico%2Fcarthw%2Fsvp%2Fsvp.c;h=0c7585aa597b106d8fbe514e73ba2731e6dcdcf7;hb=0fc0e24180bc89d8a5be33464669de0691720e9d;hp=7b916ff58339dd2ab45872a7397339a132201857;hpb=017512f2823405ea2d02fa04b4c0754d7c4cba65;p=picodrive.git

diff --git a/Pico/carthw/svp/svp.c b/Pico/carthw/svp/svp.c
index 7b916ff..0c7585a 100644
--- a/Pico/carthw/svp/svp.c
+++ b/Pico/carthw/svp/svp.c
@@ -1,41 +1,112 @@
+// 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 = 850; // cycles/line, just a guess
+static int svp_dyn_ready = 0;
+
+/* 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) - sizeof(svp->ssp1601.drc),  NULL },
+	{ 0,          0,                     NULL }
+};
+
 
 static void PicoSVPReset(void)
 {
 	elprintf(EL_SVP, "SVP reset");
 
+	memcpy(svp->iram_rom + 0x800, Pico.rom + 0x800, 0x20000 - 0x800);
 	ssp1601_reset(&svp->ssp1601);
+#ifndef PSP
+	if ((PicoOpt&POPT_EN_SVP_DRC) && svp_dyn_ready)
+		ssp1601_dyn_reset(&svp->ssp1601);
+#endif
 }
 
 
-static void PicoSVPLine(void)
+static void PicoSVPLine(int count)
 {
-	// ???
-	// OSC_NTSC / 3.0 / 60.0 / 262.0 ~= 1139
-	// OSC_PAL  / 3.0 / 50.0 / 312.0 ~= 1137
-	ssp1601_run(100);
-	exit(1);
+#ifndef PSP
+	if ((PicoOpt&POPT_EN_SVP_DRC) && svp_dyn_ready)
+		ssp1601_dyn_run(PicoSVPCycles * count);
+	else
+#endif
+	{
+		ssp1601_run(PicoSVPCycles * count);
+		svp_dyn_ready = 0; // just in case
+	}
+
+	// test mode
+	//if (Pico.m.frame_count == 13) PicoPad[0] |= 0xff;
 }
 
 
-static int PicoSVPDma(unsigned int source, unsigned short **srcp, unsigned short **limitp)
+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", source);
+		elprintf(EL_VDPDMA|EL_SVP, "SVP DmaSlow from %06x, len=%i", source, len);
 		source &= 0x1fffe;
-		*srcp = (unsigned short *)(svp->ram + source);
-		*limitp = (unsigned short *)(svp->ram + sizeof(svp->ram));
+		source -= 2;
+		*srcp = (unsigned short *)(svp->dram + source);
+		*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, SSP_DRC_SIZE);
+	printf("munmap tcache: %i\n", ret);
+#endif
+}
+
+
+static void PicoSVPShutdown(void)
+{
+#ifdef __GP2X__
+	// also unmap tcache
+	PicoSVPInit();
+#endif
+}
+
+
+void PicoSVPStartup(void)
 {
 	void *tmp;
 
@@ -48,10 +119,25 @@ void PicoSVPInit(void)
 		return;
 	}
 
+	//PicoOpt &= ~0x20000;
 	Pico.rom = tmp;
 	svp = (void *) ((char *)tmp + 0x200000);
 	memset(svp, 0, sizeof(*svp));
 
+#ifdef __GP2X__
+	tmp = mmap(tcache, SSP_DRC_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
+	svp_dyn_ready = 0;
+#ifndef PSP
+	if (PicoOpt&POPT_EN_SVP_DRC) {
+		if (ssp1601_dyn_startup()) return;
+		svp_dyn_ready = 1;
+	}
+#endif
+
 	// init ok, setup hooks..
 	PicoRead16Hook = PicoSVPRead16;
 	PicoWrite8Hook = PicoSVPWrite8;
@@ -59,5 +145,14 @@ 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;
+	PicoAHW |= PAHW_SVP;
 }
 
+