From fc1874de8af2fb53449bcfa931e025071f188b3e Mon Sep 17 00:00:00 2001
From: notaz <notasas@gmail.com>
Date: Mon, 14 Sep 2009 20:29:36 +0000
Subject: [PATCH] Cyclone: direct memhandler calls option + reset function

git-svn-id: file:///home/notaz/opt/svn/PicoDrive@778 be3aeb3a-fb24-0410-a615-afba39da0efa
---
 cpu/Cyclone/Cyclone.h     |   3 ++
 cpu/Cyclone/Main.cpp      | 108 +++++++++++++++++++++++++++++---------
 cpu/Cyclone/OpBranch.cpp  |   4 ++
 cpu/Cyclone/config.h      |  11 ++++
 cpu/Cyclone/config_pico.h |   2 +
 5 files changed, 102 insertions(+), 26 deletions(-)

diff --git a/cpu/Cyclone/Cyclone.h b/cpu/Cyclone/Cyclone.h
index 9ef7090..fc7695e 100644
--- a/cpu/Cyclone/Cyclone.h
+++ b/cpu/Cyclone/Cyclone.h
@@ -52,6 +52,9 @@ struct Cyclone
 // Initialize. Used only if Cyclone was compiled with compressed jumptable, see config.h
 void CycloneInit(void);
 
+// Reset
+void CycloneReset(struct Cyclone *pcy);
+
 // Run cyclone. Cycles should be specified in context (pcy->cycles)
 void CycloneRun(struct Cyclone *pcy);
 
diff --git a/cpu/Cyclone/Main.cpp b/cpu/Cyclone/Main.cpp
index 1093160..9871437 100644
--- a/cpu/Cyclone/Main.cpp
+++ b/cpu/Cyclone/Main.cpp
@@ -300,6 +300,32 @@ static void PrintFramework()
 #endif
   ot("\n");
 
+  // --------------
+  ot("CycloneReset%s\n", ms?"":":");
+  ot("  stmfd sp!,{r7,lr}\n");
+  ot("  mov r7,r0\n");
+  ot("  mov r0,#0\n");
+  ot("  str r0,[r7,#0x58] ;@ state_flags\n");
+  ot("  str r0,[r7,#0x48] ;@ OSP\n");
+  ot("  mov r1,#0x27 ;@ Supervisor mode\n");
+  ot("  strb r1,[r7,#0x44] ;@ set SR high\n");
+  ot("  strb r0,[r7,#0x47] ;@ IRQ\n");
+  MemHandler(0,2);
+  ot("  str r0,[r7,#0x3c] ;@ Stack pointer\n");
+  ot("  mov r0,#0\n");
+  ot("  str r0,[r7,#0x60] ;@ Membase\n");
+  ot("  mov r0,#4\n");
+  MemHandler(0,2);
+#ifdef MEMHANDLERS_DIRECT_PREFIX
+  ot("  bl %scheckpc ;@ Call checkpc()\n", MEMHANDLERS_DIRECT_PREFIX);
+#else
+  ot("  mov lr,pc\n");
+  ot("  ldr pc,[r7,#0x64] ;@ Call checkpc()\n");
+#endif
+  ot("  str r0,[r7,#0x40] ;@ PC + base\n");
+  ot("  ldmfd sp!,{r7,pc}\n");
+  ot("\n");
+
   // --------------
   // 68k: XNZVC, ARM: NZCV
   ot("CycloneSetSr%s\n", ms?"":":");
@@ -375,9 +401,10 @@ static void PrintFramework()
 
   // --------------
   ot("CycloneUnpack%s\n", ms?"":":");
-  ot("  stmfd sp!,{r4,r5,lr}\n");
-  ot("  mov r4,r0\n");
-  ot("  mov r5,r1\n");
+  ot("  stmfd sp!,{r5,r7,lr}\n");
+  ot("  mov r7,r0\n");
+  ot("  movs r5,r1\n");
+  ot("  beq c_unpack_do_pc\n");
   ot("  mov r3,#16\n");
   ot(";@ 0x00-0x3f: DA registers\n");
   ot("c_unpack_loop%s\n",ms?"":":");
@@ -387,30 +414,37 @@ static void PrintFramework()
   ot("  bne c_unpack_loop\n");
   ot(";@ 0x40: PC\n");
   ot("  ldr r0,[r5],#4 ;@ PC\n");
-#if USE_CHECKPC_CALLBACK
-  ot("  mov r1,#0\n");
-  ot("  str r1,[r4,#0x60] ;@ Memory base\n");
-  ot("  mov lr,pc\n");
-  ot("  ldr pc,[r4,#0x64] ;@ Call checkpc()\n");
-#else
-  ot("  ldr r1,[r4,#0x60] ;@ Memory base\n");
-  ot("  add r0,r0,r1 ;@ r0 = Memory Base + New PC\n");
-#endif
-  ot("  str r0,[r4,#0x40] ;@ PC + Memory Base\n");
+  ot("  str r0,[r7,#0x40] ;@ handle later\n");
   ot(";@ 0x44: SR\n");
   ot("  ldrh r1,[r5],#2\n");
-  ot("  mov r0,r4\n");
+  ot("  mov r0,r7\n");
   ot("  bl CycloneSetSr\n");
   ot(";@ 0x46: IRQ level\n");
   ot("  ldrb r0,[r5],#2\n");
-  ot("  strb r0,[r4,#0x47]\n");
+  ot("  strb r0,[r7,#0x47]\n");
   ot(";@ 0x48: other SP\n");
   ot("  ldr r0,[r5],#4\n");
-  ot("  str r0,[r4,#0x48]\n");
+  ot("  str r0,[r7,#0x48]\n");
   ot(";@ 0x4c: CPU state flags\n");
   ot("  ldr r0,[r5],#4\n");
-  ot("  str r0,[r4,#0x58]\n");
-  ot("  ldmfd sp!,{r4,r5,pc}\n");
+  ot("  str r0,[r7,#0x58]\n");
+  ot("c_unpack_do_pc%s\n",ms?"":":");
+  ot("  ldr r0,[r7,#0x40] ;@ unbased PC\n");
+#if USE_CHECKPC_CALLBACK
+  ot("  mov r1,#0\n");
+  ot("  str r1,[r7,#0x60] ;@ Memory base\n");
+ #ifdef MEMHANDLERS_DIRECT_PREFIX
+  ot("  bl %scheckpc ;@ Call checkpc()\n", MEMHANDLERS_DIRECT_PREFIX);
+ #else
+  ot("  mov lr,pc\n");
+  ot("  ldr pc,[r7,#0x64] ;@ Call checkpc()\n");
+ #endif
+#else
+  ot("  ldr r1,[r7,#0x60] ;@ Memory base\n");
+  ot("  add r0,r0,r1 ;@ r0 = Memory Base + New PC\n");
+#endif
+  ot("  str r0,[r7,#0x40] ;@ PC + Memory Base\n");
+  ot("  ldmfd sp!,{r5,r7,pc}\n");
   ot("\n");
 
   // --------------
@@ -549,12 +583,20 @@ static void PrintFramework()
   MemHandler(0,2,0,0);
   ot("  tst r0,r0 ;@ uninitialized int vector?\n");
   ot("  moveq r0,#0x3c\n");
+ #ifdef MEMHANDLERS_DIRECT_PREFIX
+  ot("  bleq %sread32 ;@ Call read32(r0) handler\n", MEMHANDLERS_DIRECT_PREFIX);
+ #else
   ot("  moveq lr,pc\n");
   ot("  ldreq pc,[r7,#0x70] ;@ Call read32(r0) handler\n");
+ #endif
 #if USE_CHECKPC_CALLBACK
   ot("  add lr,pc,#4\n");
   ot("  add r0,r0,r11 ;@ r0 = Memory Base + New PC\n");
+ #ifdef MEMHANDLERS_DIRECT_PREFIX
+  ot("  bl %scheckpc ;@ Call checkpc()\n", MEMHANDLERS_DIRECT_PREFIX);
+ #else
   ot("  ldr pc,[r7,#0x64] ;@ Call checkpc()\n");
+ #endif
  #if EMULATE_ADDRESS_ERRORS_JUMP
   ot("  mov r4,r0\n");
  #else
@@ -636,7 +678,11 @@ static void PrintFramework()
 #if USE_CHECKPC_CALLBACK
   ot("  add lr,pc,#4\n");
   ot("  add r0,r0,r3 ;@ r0 = Memory Base + New PC\n");
+ #ifdef MEMHANDLERS_DIRECT_PREFIX
+  ot("  bl %scheckpc ;@ Call checkpc()\n", MEMHANDLERS_DIRECT_PREFIX);
+ #else
   ot("  ldr pc,[r7,#0x64] ;@ Call checkpc()\n");
+ #endif
  #if EMULATE_ADDRESS_ERRORS_JUMP
   ot("  mov r4,r0\n");
  #else
@@ -763,7 +809,11 @@ static void PrintFramework()
 #if USE_CHECKPC_CALLBACK
   ot("  add lr,pc,#4\n");
   ot("  add r0,r0,r3 ;@ r0 = Memory Base + New PC\n");
+ #ifdef MEMHANDLERS_DIRECT_PREFIX
+  ot("  bl %scheckpc ;@ Call checkpc()\n", MEMHANDLERS_DIRECT_PREFIX);
+ #else
   ot("  ldr pc,[r7,#0x64] ;@ Call checkpc()\n");
+ #endif
   ot("  mov r4,r0\n");
 #else
   ot("  add r4,r0,r3 ;@ r4 = Memory Base + New PC\n");
@@ -854,8 +904,8 @@ static void PrintFramework()
 // Trashes r0-r3,r12,lr
 int MemHandler(int type,int size,int addrreg,int need_addrerr_check)
 {
-  int func=0;
-  func=0x68+type*0xc+(size<<2); // Find correct offset
+  int func=0x68+type*0xc+(size<<2); // Find correct offset
+  char what[32];
 
 #if MEMHANDLERS_NEED_FLAGS
   ot("  mov r3,r10,lsr #28\n");
@@ -894,6 +944,14 @@ int MemHandler(int type,int size,int addrreg,int need_addrerr_check)
   }
   else
 #endif
+
+  sprintf(what, "%s%d", type==0 ? "read" : (type==1 ? "write" : "fetch"), 8<<size);
+#ifdef MEMHANDLERS_DIRECT_PREFIX
+  if (addrreg != 0)
+    ot("  mov r0,r%i\n", addrreg);
+  ot("  bl %s%s ;@ Call ", MEMHANDLERS_DIRECT_PREFIX, what);
+  (void)func; // avoid warning
+#else
   if (addrreg != 0)
   {
     ot("  add lr,pc,#4\n");
@@ -902,14 +960,11 @@ int MemHandler(int type,int size,int addrreg,int need_addrerr_check)
   else
     ot("  mov lr,pc\n");
   ot("  ldr pc,[r7,#0x%x] ;@ Call ",func);
+#endif
 
   // Document what we are calling:
-  if (type==0) ot("read");
-  if (type==1) ot("write");
-  if (type==2) ot("fetch");
-
-  if (type==1) ot("%d(r0,r1)",8<<size);
-  else         ot("%d(r0)",   8<<size);
+  if (type==1) ot("%s(r0,r1)",what);
+  else         ot("%s(r0)",   what);
   ot(" handler\n");
 
 #if MEMHANDLERS_CHANGE_FLAGS
@@ -1185,6 +1240,7 @@ static int CycloneMake()
 
   ot(ms?"  area |.text|, code\n":"  .text\n  .align 4\n\n");
   ot("  %s CycloneInit\n",globl);
+  ot("  %s CycloneReset\n",globl);
   ot("  %s CycloneRun\n",globl);
   ot("  %s CycloneSetSr\n",globl);
   ot("  %s CycloneGetSr\n",globl);
diff --git a/cpu/Cyclone/OpBranch.cpp b/cpu/Cyclone/OpBranch.cpp
index 804aa91..63569da 100644
--- a/cpu/Cyclone/OpBranch.cpp
+++ b/cpu/Cyclone/OpBranch.cpp
@@ -5,10 +5,14 @@
 static void CheckPc(void)
 {
 #if USE_CHECKPC_CALLBACK
+ #ifdef MEMHANDLERS_DIRECT_PREFIX
+  ot("  bl %scheckpc ;@ Call checkpc()\n", MEMHANDLERS_DIRECT_PREFIX);
+ #else
   ot(";@ Check Memory Base+pc\n");
   ot("  mov lr,pc\n");
   ot("  ldr pc,[r7,#0x64] ;@ Call checkpc()\n");
   ot("\n");
+ #endif
 #endif
 }
 
diff --git a/cpu/Cyclone/config.h b/cpu/Cyclone/config.h
index e180490..d73b5b5 100644
--- a/cpu/Cyclone/config.h
+++ b/cpu/Cyclone/config.h
@@ -65,6 +65,17 @@
 #define MEMHANDLERS_CHANGE_FLAGS    0
 #define MEMHANDLERS_CHANGE_CYCLES   0
 
+/*
+ * If the following macro is defined, Cyclone no longer calls read*, write*,
+ * fetch* and checkpc from it's context, it calls these functions directly
+ * instead, prefixed with prefix selected below. For example, if
+ * MEMHANDLERS_DIRECT_PREFIX is set to cyclone_, it will call cyclone_read8
+ * on byte reads.
+ * This is to avoid indirect jumps, which are slower. It also saves one ARM
+ * instruction.
+ */
+/* MEMHANDLERS_DIRECT_PREFIX "cyclone_" */
+
 /*
  * If enabled, Cyclone will call .IrqCallback routine from it's context whenever it
  * acknowledges an IRQ. IRQ level (.irq) is not cleared automatically, do this in your
diff --git a/cpu/Cyclone/config_pico.h b/cpu/Cyclone/config_pico.h
index 8607070..af9ab5e 100644
--- a/cpu/Cyclone/config_pico.h
+++ b/cpu/Cyclone/config_pico.h
@@ -21,6 +21,8 @@
 #define MEMHANDLERS_CHANGE_FLAGS    0
 #define MEMHANDLERS_CHANGE_CYCLES   0
 
+#define MEMHANDLERS_DIRECT_PREFIX   "cyclone_"
+
 #define USE_INT_ACK_CALLBACK        1
 
 #define INT_ACK_NEEDS_STUFF         0
-- 
2.39.2