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=79ea68d5e611bdf535e629800cf919eafc5e9586;hpb=f8ef8ff7100baa0ac0ecfcacb47aea3a9e24bc38;p=picodrive.git

diff --git a/Pico/carthw/svp/svp.c b/Pico/carthw/svp/svp.c
index 79ea68d..31a81b7 100644
--- a/Pico/carthw/svp/svp.c
+++ b/Pico/carthw/svp/svp.c
@@ -2,16 +2,57 @@
 
 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)
 {
 	void *tmp;
 
-	elprintf(0xffff, "SVP init");
+	elprintf(EL_SVP, "SVP init");
 
 	tmp = realloc(Pico.rom, 0x200000 + sizeof(*svp));
 	if (tmp == NULL)
 	{
-		elprintf(EL_STATUS, "OOM for SVP data");
+		elprintf(EL_STATUS|EL_SVP, "OOM for SVP data");
 		return;
 	}
 
@@ -24,28 +65,7 @@ void PicoSVPInit(void)
 	PicoWrite8Hook = PicoSVPWrite8;
 	PicoWrite16Hook = PicoSVPWrite16;
 	PicoDmaHook = PicoSVPDma;
-}
-
-
-void PicoSVPReset(void)
-{
-	elprintf(0xffff, "SVP reset");
-
-	ssp1601_reset(&svp->ssp1601);
-}
-
-
-int PicoSVPDma(unsigned int source, unsigned short **srcp, unsigned short **limitp)
-{
-	if ((source & 0xfe0000) == 0x300000)
-	{
-		elprintf(EL_VDPDMA|0xffff, "SVP DmaSlow from %06x", source);
-		source &= 0x1fffe;
-		*srcp = (unsigned short *)(svp->ram + source);
-		*limitp = (unsigned short *)(svp->ram + sizeof(svp->ram));
-		return 1;
-	}
-
-	return 0;
+	PicoResetHook = PicoSVPReset;
+	PicoLineHook = PicoSVPLine;
 }