fix various logging issues
[picodrive.git] / pico / carthw / svp / memory.c
index 5e69962..c721611 100644 (file)
@@ -1,31 +1,65 @@
-// The SVP chip emulator, mem I/O stuff
-
-// (c) Copyright 2008, Grazvydas "notaz" Ignotas
-// Free for non-commercial use.
-
-// For commercial use, separate licencing terms must be obtained.
-
+/*
+ * The SVP chip emulator, mem I/O stuff
+ *
+ * Copyright (c) GraÅžvydas "notaz" Ignotas, 2008
+ *
+ * Redistribution and use in source and binary forms, with or without
+ * modification, are permitted provided that the following conditions are met:
+ *     * Redistributions of source code must retain the above copyright
+ *       notice, this list of conditions and the following disclaimer.
+ *     * Redistributions in binary form must reproduce the above copyright
+ *       notice, this list of conditions and the following disclaimer in the
+ *       documentation and/or other materials provided with the distribution.
+ *     * Neither the name of the organization nor the
+ *       names of its contributors may be used to endorse or promote products
+ *       derived from this software without specific prior written permission.
+ *
+ * THIS SOFTWARE IS PROVIDED BY THE COPYRIGHT HOLDERS AND CONTRIBUTORS "AS IS"
+ * AND ANY EXPRESS OR IMPLIED WARRANTIES, INCLUDING, BUT NOT LIMITED TO, THE
+ * IMPLIED WARRANTIES OF MERCHANTABILITY AND FITNESS FOR A PARTICULAR PURPOSE
+ * ARE DISCLAIMED. IN NO EVENT SHALL COPYRIGHT HOLDER OR CONTRIBUTORS BE LIABLE
+ * FOR ANY DIRECT, INDIRECT, INCIDENTAL, SPECIAL, EXEMPLARY, OR CONSEQUENTIAL
+ * DAMAGES (INCLUDING, BUT NOT LIMITED TO, PROCUREMENT OF SUBSTITUTE GOODS OR
+ * SERVICES; LOSS OF USE, DATA, OR PROFITS; OR BUSINESS INTERRUPTION) HOWEVER
+ * CAUSED AND ON ANY THEORY OF LIABILITY, WHETHER IN CONTRACT, STRICT LIABILITY,
+ * OR TORT (INCLUDING NEGLIGENCE OR OTHERWISE) ARISING IN ANY WAY OUT OF THE USE
+ * OF THIS SOFTWARE, EVEN IF ADVISED OF THE POSSIBILITY OF SUCH DAMAGE.
+ */
 
 #include "../../pico_int.h"
 #include "../../memory.h"
 
-/*
-  // "cell arrange" 1: 390000-39ffff
-  else if ((a & 0xff0000) == 0x390000) {
-    // this is rewritten 68k code
-    unsigned int a1 = a >> 1;
-    a1 = (a1 & 0x7001) | ((a1 & 0x3e) << 6) | ((a1 & 0xfc0) >> 5);
-    d = ((u16 *)svp->dram)[a1];
-  }
+// for wait loop det
+static void PicoWrite16_dram(u32 a, u32 d)
+{
+  a &= ~0xfe0000;
 
-  // "cell arrange" 2: 3a0000-3affff
-  else if ((a & 0xff0000) == 0x3a0000) {
-    // this is rewritten 68k code
-    unsigned int a1 = a >> 1;
-    a1 = (a1 & 0x7801) | ((a1 & 0x1e) << 6) | ((a1 & 0x7e0) >> 4);
-    d = ((u16 *)svp->dram)[a1];
+  if (d != 0) {
+    if      (a == 0xfe06) // 30fe06
+      svp->ssp1601.emu_status &= ~SSP_WAIT_30FE06;
+    else if (a == 0xfe08)
+      svp->ssp1601.emu_status &= ~SSP_WAIT_30FE08;
   }
-*/
+
+  ((u16 *)svp->dram)[a / 2] = d;
+}
+
+// "cell arrange" 1: 390000-39ffff
+static u32 PicoRead16_svpca1(u32 a)
+{
+  // this is 68k code rewritten
+  u32 a1 = a >> 1;
+  a1 = (a1 & 0x7001) | ((a1 & 0x3e) << 6) | ((a1 & 0xfc0) >> 5);
+  return ((u16 *)svp->dram)[a1];
+}
+
+// "cell arrange" 2: 3a0000-3affff
+static u32 PicoRead16_svpca2(u32 a)
+{
+  u32 a1 = a >> 1;
+  a1 = (a1 & 0x7801) | ((a1 & 0x1e) << 6) | ((a1 & 0x7e0) >> 4);
+  return ((u16 *)svp->dram)[a1];
+}
 
 // IO/control area (0xa10000 - 0xa1ffff)
 static u32 PicoRead16_svpr(u32 a)
@@ -33,7 +67,7 @@ static u32 PicoRead16_svpr(u32 a)
   u32 d = 0;
 
   // regs
-  if ((a & 0xfffff0) == 0xa15000) {
+  if ((a & ~0x0f) == 0xa15000) {
     switch (a & 0xf) {
       case 0:
       case 2:
@@ -53,7 +87,7 @@ static u32 PicoRead16_svpr(u32 a)
         a15004_looping = 0;
 
       if (!a15004_looping)
-        elprintf(EL_SVP, "SVP r%i: [%06x] %04x @%06x", realsize, a, d, SekPc);
+        elprintf(EL_SVP, "SVP r: [%06x] %04x @%06x", a, d, SekPc);
 
       if (a == 0xa15004 && !(d&1)) {
         if (!a15004_looping)
@@ -73,11 +107,25 @@ static u32 PicoRead16_svpr(u32 a)
   return PicoRead16_io(a);
 }
 
+// used in VR test mode
+static u32 PicoRead8_svpr(u32 a)
+{
+  u32 d;
+
+  if ((a & ~0x0f) != 0xa15000)
+    return PicoRead8_io(a);
+
+  d = PicoRead16_svpr(a & ~1);
+  if (!(a & 1))
+    d >>= 8;
+  return d;
+}
+
 static void PicoWrite16_svpr(u32 a, u32 d)
 {
   elprintf(EL_SVP, "SVP w16: [%06x] %04x @%06x", a, d, SekPc);
 
-  if ((a & 0xfffff0) == 0xa15000) {
+  if ((a & ~0x0f) == 0xa15000) {
     if (a == 0xa15000 || a == 0xa15002) {
       // just guessing here
       svp->ssp1601.gr[SSP_XST].h = d;
@@ -90,13 +138,6 @@ static void PicoWrite16_svpr(u32 a, u32 d)
   }
 
   PicoWrite16_io(a, d);
-/*
-  if (a == 0x30fe06 && d != 0)
-    svp->ssp1601.emu_status &= ~SSP_WAIT_30FE06;
-
-  if (a == 0x30fe08 && d != 0)
-    svp->ssp1601.emu_status &= ~SSP_WAIT_30FE08;
-*/
 }
 
 void PicoSVPMemSetup(void)
@@ -107,11 +148,14 @@ void PicoSVPMemSetup(void)
   cpu68k_map_set(m68k_read16_map,  0x300000, 0x31ffff, svp->dram, 0);
   cpu68k_map_set(m68k_write8_map,  0x300000, 0x31ffff, svp->dram, 0);
   cpu68k_map_set(m68k_write16_map, 0x300000, 0x31ffff, svp->dram, 0);
+  cpu68k_map_set(m68k_write16_map, 0x300000, 0x30ffff, PicoWrite16_dram, 1);
 
-  // DRAM (cell arrange) - TODO
+  // DRAM (cell arrange)
+  cpu68k_map_set(m68k_read16_map,  0x390000, 0x39ffff, PicoRead16_svpca1, 1);
+  cpu68k_map_set(m68k_read16_map,  0x3a0000, 0x3affff, PicoRead16_svpca2, 1);
 
   // regs
-  cpu68k_map_set(m68k_read8_map,   0xa10000, 0xa1ffff, PicoRead8_io, 1); // PicoRead8_svpr
+  cpu68k_map_set(m68k_read8_map,   0xa10000, 0xa1ffff, PicoRead8_svpr, 1);
   cpu68k_map_set(m68k_read16_map,  0xa10000, 0xa1ffff, PicoRead16_svpr, 1);
   cpu68k_map_set(m68k_write8_map,  0xa10000, 0xa1ffff, PicoWrite8_io, 1); // PicoWrite8_svpr
   cpu68k_map_set(m68k_write16_map, 0xa10000, 0xa1ffff, PicoWrite16_svpr, 1);