svp bugfixes
[picodrive.git] / Pico / carthw / svp / svp.c
CommitLineData
f53f286a 1#include "../../PicoInt.h"
2
f8ef8ff7 3svp_t *svp = NULL;
4
017512f2 5static void PicoSVPReset(void)
6{
7 elprintf(EL_SVP, "SVP reset");
8
5de27868 9 memcpy(svp->iram_rom + 0x800, Pico.rom + 0x800, 0x20000 - 0x800);
017512f2 10 ssp1601_reset(&svp->ssp1601);
11}
12
13
14static void PicoSVPLine(void)
15{
16 // ???
17 // OSC_NTSC / 3.0 / 60.0 / 262.0 ~= 1139
18 // OSC_PAL / 3.0 / 50.0 / 312.0 ~= 1137
30752975 19 ssp1601_run(800);
d26dc685 20
21 // test mode
22 //if (Pico.m.frame_count == 13) PicoPad[0] |= 0xff;
017512f2 23}
24
25
5de27868 26static int PicoSVPDma(unsigned int source, int len, unsigned short **srcp, unsigned short **limitp)
017512f2 27{
28 if ((source & 0xfe0000) == 0x300000)
29 {
5de27868 30 elprintf(EL_VDPDMA|EL_SVP, "SVP DmaSlow from %06x, len=%i", source, len);
017512f2 31 source &= 0x1fffe;
30752975 32 source -= 2;
5de27868 33 *srcp = (unsigned short *)(svp->dram + source);
34 *limitp = (unsigned short *)(svp->dram + sizeof(svp->dram));
017512f2 35 return 1;
36 }
d26dc685 37 else
38 elprintf(EL_VDPDMA|EL_SVP|EL_ANOMALY, "SVP FIXME unhandled DmaSlow from %06x, len=%i", source, len);
017512f2 39
40 return 0;
41}
42
43
f53f286a 44void PicoSVPInit(void)
45{
f8ef8ff7 46 void *tmp;
47
017512f2 48 elprintf(EL_SVP, "SVP init");
f8ef8ff7 49
50 tmp = realloc(Pico.rom, 0x200000 + sizeof(*svp));
51 if (tmp == NULL)
52 {
017512f2 53 elprintf(EL_STATUS|EL_SVP, "OOM for SVP data");
f8ef8ff7 54 return;
55 }
56
57 Pico.rom = tmp;
58 svp = (void *) ((char *)tmp + 0x200000);
59 memset(svp, 0, sizeof(*svp));
60
61 // init ok, setup hooks..
62 PicoRead16Hook = PicoSVPRead16;
63 PicoWrite8Hook = PicoSVPWrite8;
64 PicoWrite16Hook = PicoSVPWrite16;
65 PicoDmaHook = PicoSVPDma;
017512f2 66 PicoResetHook = PicoSVPReset;
67 PicoLineHook = PicoSVPLine;
f53f286a 68}
69