Pico/carthw/svp/Memory.c

   1 #include "../../PicoInt.h"
   2
   3 #ifndef UTYPES_DEFINED
   4 typedef unsigned char  u8;
   5 typedef unsigned short u16;
   6 typedef unsigned int   u32;
   7 #define UTYPES_DEFINED
   8 #endif
   9
  10 #define CLEAR_DETECT(pc_start,pc_end,text) \
  11   if (d == 0 && SekPc >= pc_start && SekPc < pc_end) \
  12   { \
  13     if (!clearing_ram) \
  14       elprintf(EL_UIO, text); \
  15     clearing_ram = 1; \
  16     return; \
  17   }
  18
  19 unsigned int PicoSVPRead16(unsigned int a, int realsize)
  20 {
  21   unsigned int d = 0;
  22   static int a15004_looping = 0;
  23
  24   // dram: 300000-31ffff
  25   if      ((a & 0xfe0000) == 0x300000)
  26     d = *(u16 *)(svp->dram + (a&0x1fffe));
  27
  28   // "cell arrange" 1: 390000-39ffff
  29   else if ((a & 0xff0000) == 0x390000) {
  30     // this is rewritten 68k code
  31     unsigned int a1 = a >> 1;
  32     a1 = (a1 & 0x7001) | ((a1 & 0x3e) << 6) | ((a1 & 0xfc0) >> 5);
  33     d = ((u16 *)svp->dram)[a1];
  34   }
  35
  36   // "cell arrange" 2: 3a0000-3affff
  37   else if ((a & 0xff0000) == 0x3a0000) {
  38     // this is rewritten 68k code
  39     unsigned int a1 = a >> 1;
  40     a1 = (a1 & 0x7801) | ((a1 & 0x1e) << 6) | ((a1 & 0x7e0) >> 4);
  41     d = ((u16 *)svp->dram)[a1];
  42   }
  43
  44   // regs
  45   else if ((a & 0xfffff0) == 0xa15000) {
  46     switch (a & 0xf) {
  47       case 0:
  48       case 2:
  49         d = svp->ssp1601.gr[SSP_XST].h;
  50         break;
  51
  52       case 4:
  53         d = svp->ssp1601.gr[SSP_PM0].h;
  54         svp->ssp1601.gr[SSP_PM0].h &= ~1;
  55         if (d&1) a15004_looping = 0;
  56         break;
  57     }
  58   }
  59   else
  60     elprintf(EL_UIO|EL_ANOMALY, "SVP FIXME: unhandled r%i: [%06x] %04x @%06x", realsize, a&0xffffff, d, SekPc);
  61
  62   if (!a15004_looping)
  63     elprintf(EL_UIO, "SVP r%i: [%06x] %04x @%06x", realsize, a&0xffffff, d, SekPc);
  64
  65   if (a == 0xa15004 && !(d&1)) {
  66     if (!a15004_looping)
  67       elprintf(EL_SVP, "SVP det TIGHT loop: a15004");
  68     a15004_looping = 1;
  69   }
  70   else a15004_looping = 0;
  71
  72   // if (a == 0x30fe02) d = 1;
  73
  74   return d;
  75 }
  76
  77 void PicoSVPWrite8(unsigned int a, unsigned int d, int realsize)
  78 {
  79   elprintf(EL_UIO, "!!! SVP w%i: [%06x], %08x @%06x", realsize, a&0xffffff, d, SekPc);
  80 }
  81
  82 void PicoSVPWrite16(unsigned int a, unsigned int d, int realsize)
  83 {
  84   static int clearing_ram = 0;
  85
  86   // DRAM
  87   if      ((a & 0xfe0000) == 0x300000)
  88     *(u16 *)(svp->dram + (a&0x1fffe)) = d;
  89
  90   // regs
  91   else if ((a & 0xfffff0) == 0xa15000) {
  92     if (a == 0xa15000 || a == 0xa15002) {
  93       // just guessing here
  94       svp->ssp1601.gr[SSP_XST].h = d;
  95       svp->ssp1601.gr[SSP_PM0].h |= 2;
  96       svp->ssp1601.emu_status &= ~SSP_WAIT_PM0;
  97     }
  98     //else if (a == 0xa15006) svp->ssp1601.gr[SSP_PM0].h = d | (d << 1);
  99     // 0xa15006 probably has 'halt'
 100   }
 101
 102
 103   if (a == 0x30fe06 && d != 0)
 104     svp->ssp1601.emu_status &= ~SSP_WAIT_30FE06;
 105
 106   if (a == 0x30fe08 && d != 0)
 107     svp->ssp1601.emu_status &= ~SSP_WAIT_30FE08;
 108
 109   // debug: detect RAM clears..
 110   CLEAR_DETECT(0x0221dc, 0x0221f0, "SVP RAM CLEAR (full) @ 0221C2");
 111   CLEAR_DETECT(0x02204c, 0x022068, "SVP RAM CLEAR 300000-31ffbf (1) @ 022032");
 112   CLEAR_DETECT(0x021900, 0x021ff0, "SVP RAM CLEAR 300000-305fff");
 113   CLEAR_DETECT(0x0220b0, 0x0220cc, "SVP RAM CLEAR 300000-31ffbf (2) @ 022096");
 114   clearing_ram = 0;
 115
 116   elprintf(EL_UIO, "SVP w%i: [%06x] %04x @%06x", realsize, a&0xffffff, d, SekPc);
 117 }
 118