Pico/carthw/svp/svp.c

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