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