From 72f63cf06ca04f5619205d9b0cedebd84037f969 Mon Sep 17 00:00:00 2001
From: notaz <notasas@gmail.com>
Date: Thu, 15 Oct 2009 21:31:34 +0000
Subject: [PATCH] SVP: fix ARM breakage, re-add missing stuff

git-svn-id: file:///home/notaz/opt/svn/PicoDrive@818 be3aeb3a-fb24-0410-a615-afba39da0efa
---
 cpu/drc/cmn.c              |  2 +-
 pico/carthw/svp/compiler.c | 12 +++---
 pico/carthw/svp/memory.c   | 76 +++++++++++++++++++++++++-------------
 pico/carthw/svp/ssp16.c    |  4 +-
 pico/carthw/svp/svp.c      |  6 +++
 platform/linux/gp2x.c      |  2 +
 6 files changed, 67 insertions(+), 35 deletions(-)

diff --git a/cpu/drc/cmn.c b/cpu/drc/cmn.c
index 66003255..e286ccf6 100644
--- a/cpu/drc/cmn.c
+++ b/cpu/drc/cmn.c
@@ -5,7 +5,7 @@
 
 #include "cmn.h"
 
-u32 tcache[DRC_TCACHE_SIZE/4];
+u32 __attribute__((aligned(4096))) tcache[DRC_TCACHE_SIZE/4];
 
 
 void drc_cmn_init(void)
diff --git a/pico/carthw/svp/compiler.c b/pico/carthw/svp/compiler.c
index 32f7e3e5..da25ea96 100644
--- a/pico/carthw/svp/compiler.c
+++ b/pico/carthw/svp/compiler.c
@@ -1834,12 +1834,12 @@ int ssp1601_dyn_startup(void)
 	// hle'd blocks
 	ssp_block_table[0x800/2] = (void *) ssp_hle_800;
 	ssp_block_table[0x902/2] = (void *) ssp_hle_902;
-	ssp_block_table_iram[ 7 * SSP_BLOCKTAB_IRAM_ENTS + 0x030/2] = (void *) ssp_hle_07_030;
-	ssp_block_table_iram[ 7 * SSP_BLOCKTAB_IRAM_ENTS + 0x036/2] = (void *) ssp_hle_07_036;
-	ssp_block_table_iram[ 7 * SSP_BLOCKTAB_IRAM_ENTS + 0x6d6/2] = (void *) ssp_hle_07_6d6;
-	ssp_block_table_iram[11 * SSP_BLOCKTAB_IRAM_ENTS + 0x12c/2] = (void *) ssp_hle_11_12c;
-	ssp_block_table_iram[11 * SSP_BLOCKTAB_IRAM_ENTS + 0x384/2] = (void *) ssp_hle_11_384;
-	ssp_block_table_iram[11 * SSP_BLOCKTAB_IRAM_ENTS + 0x38a/2] = (void *) ssp_hle_11_38a;
+	ssp_block_table_iram[ 7 * SSP_BLOCKTAB_IRAM_ONE + 0x030/2] = (void *) ssp_hle_07_030;
+	ssp_block_table_iram[ 7 * SSP_BLOCKTAB_IRAM_ONE + 0x036/2] = (void *) ssp_hle_07_036;
+	ssp_block_table_iram[ 7 * SSP_BLOCKTAB_IRAM_ONE + 0x6d6/2] = (void *) ssp_hle_07_6d6;
+	ssp_block_table_iram[11 * SSP_BLOCKTAB_IRAM_ONE + 0x12c/2] = (void *) ssp_hle_11_12c;
+	ssp_block_table_iram[11 * SSP_BLOCKTAB_IRAM_ONE + 0x384/2] = (void *) ssp_hle_11_384;
+	ssp_block_table_iram[11 * SSP_BLOCKTAB_IRAM_ONE + 0x38a/2] = (void *) ssp_hle_11_38a;
 #endif
 
 	return 0;
diff --git a/pico/carthw/svp/memory.c b/pico/carthw/svp/memory.c
index 5e69962d..f7426c32 100644
--- a/pico/carthw/svp/memory.c
+++ b/pico/carthw/svp/memory.c
@@ -9,23 +9,37 @@
 #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 +47,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:
@@ -73,11 +87,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 +118,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 +128,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);
diff --git a/pico/carthw/svp/ssp16.c b/pico/carthw/svp/ssp16.c
index 71187276..4fe7c03a 100644
--- a/pico/carthw/svp/ssp16.c
+++ b/pico/carthw/svp/ssp16.c
@@ -647,14 +647,14 @@ static void write_XST(u32 d)
 static u32 read_PM4(void)
 {
 	u32 d = pm_io(4, 0, 0);
-/* TODO?
+
 	if (d == 0) {
 		switch (GET_PPC_OFFS()) {
 			case 0x0854: ssp->emu_status |= SSP_WAIT_30FE08; elprintf(EL_SVP, "det TIGHT loop: [30fe08]"); break;
 			case 0x4f12: ssp->emu_status |= SSP_WAIT_30FE06; elprintf(EL_SVP, "det TIGHT loop: [30fe06]"); break;
 		}
 	}
-*/
+
 	if (d != (u32)-1) return d;
 	// can be removed?
 	elprintf(EL_SVP|EL_ANOMALY, "PM4 raw r %04x @ %04x", rPM4, GET_PPC_OFFS());
diff --git a/pico/carthw/svp/svp.c b/pico/carthw/svp/svp.c
index d1e7f8f2..76904ae1 100644
--- a/pico/carthw/svp/svp.c
+++ b/pico/carthw/svp/svp.c
@@ -7,6 +7,7 @@
 
 
 #include "../../pico_int.h"
+#include "../../cpu/drc/cmn.h"
 #include "compiler.h"
 
 svp_t *svp = NULL;
@@ -97,6 +98,11 @@ static int PicoSVPDma(unsigned int source, int len, unsigned short **srcp, unsig
 
 void PicoSVPInit(void)
 {
+#ifndef PSP
+	// this is to unmap tcache and make
+	// mem available for large ROMs, MCD, etc.
+	drc_cmn_cleanup();
+#endif
 }
 
 static void PicoSVPExit(void)
diff --git a/platform/linux/gp2x.c b/platform/linux/gp2x.c
index e1b8c970..4da98a53 100644
--- a/platform/linux/gp2x.c
+++ b/platform/linux/gp2x.c
@@ -388,7 +388,9 @@ void plat_video_menu_end(void)
 
 void plat_validate_config(void)
 {
+	extern int PicoOpt;
 //	PicoOpt &= ~POPT_EXT_FM;
+	PicoOpt &= ~(1<<17); // POPT_EN_SVP_DRC
 }
 
 void plat_early_init(void)
-- 
2.39.5