X-Git-Url: https://notaz.gp2x.de/cgi-bin/gitweb.cgi?a=blobdiff_plain;f=Pico%2Fcarthw%2Fsvp%2Fsvp.c;h=31a81b7e3a85f13c564ff81f4e585357cd5f05eb;hb=4fd5325d6261aad2cc072c563b7cc2798184c830;hp=a5de987ab366e09c5f929a34d9d1e0eeb0556510;hpb=f53f286a8b48d19c65e83f90d00aa47e8e87c889;p=picodrive.git

diff --git a/Pico/carthw/svp/svp.c b/Pico/carthw/svp/svp.c
index a5de987..31a81b7 100644
--- a/Pico/carthw/svp/svp.c
+++ b/Pico/carthw/svp/svp.c
@@ -1,7 +1,71 @@
 #include "../../PicoInt.h"
 
+svp_t *svp = NULL;
+
+static void PicoSVPReset(void)
+{
+	elprintf(EL_SVP, "SVP reset");
+
+	memcpy(svp->iram_rom + 0x800, Pico.rom + 0x800, 0x20000 - 0x800);
+	ssp1601_reset(&svp->ssp1601);
+}
+
+
+static void PicoSVPLine(void)
+{
+	// ???
+	// OSC_NTSC / 3.0 / 60.0 / 262.0 ~= 1139
+	// OSC_PAL  / 3.0 / 50.0 / 312.0 ~= 1137
+	ssp1601_run(800);
+
+	// test mode
+	//if (Pico.m.frame_count == 13) PicoPad[0] |= 0xff;
+	// pushing start
+	//if (Pico.m.frame_count & 4) PicoPad[0] |= 0x80;
+}
+
+
+static int PicoSVPDma(unsigned int source, int len, unsigned short **srcp, unsigned short **limitp)
+{
+	if ((source & 0xfe0000) == 0x300000)
+	{
+		elprintf(EL_VDPDMA|EL_SVP, "SVP DmaSlow from %06x, len=%i", source, len);
+		source &= 0x1fffe;
+		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)
 {
-  elprintf(0xffff, "SVP");
+	void *tmp;
+
+	elprintf(EL_SVP, "SVP init");
+
+	tmp = realloc(Pico.rom, 0x200000 + sizeof(*svp));
+	if (tmp == NULL)
+	{
+		elprintf(EL_STATUS|EL_SVP, "OOM for SVP data");
+		return;
+	}
+
+	Pico.rom = tmp;
+	svp = (void *) ((char *)tmp + 0x200000);
+	memset(svp, 0, sizeof(*svp));
+
+	// init ok, setup hooks..
+	PicoRead16Hook = PicoSVPRead16;
+	PicoWrite8Hook = PicoSVPWrite8;
+	PicoWrite16Hook = PicoSVPWrite16;
+	PicoDmaHook = PicoSVPDma;
+	PicoResetHook = PicoSVPReset;
+	PicoLineHook = PicoSVPLine;
 }