initial 32x tests

[megadrive.git] / testpico / sh2_main.c

diff --git a/testpico/sh2_main.c b/testpico/sh2_main.c
new file mode 100644 (file)
index 0000000..eaa69a9
--- /dev/null
+++ b/testpico/sh2_main.c
@@ -0,0 +1,36 @@
+#include "common.h"
+
+void spin(int loops);
+
+void main_c(u32 is_slave)
+{
+    u16 v, *r = (u16 *)0x20004000;
+
+    for (;;)
+    {
+        u16 cmd;
+
+        mem_barrier();
+        cmd = read16(&r[0x20/2]);
+        if ((cmd & 0x8000) ^ (is_slave << 15)) {
+            spin(64);
+            continue;
+        }
+        cmd &= 0x7fff;
+        switch (cmd)
+        {
+        case 0:
+        case 0x4d5f:    // 'M_' from BIOS
+        case 0x535f:    // 'S_' from BIOS
+            spin(64);
+            continue;
+        case CMD_ECHO:
+            v = read16(&r[0x22/2]) ^ (is_slave << 15);
+            write16(&r[0x24/2], v);
+            break;
+        }
+        write16(&r[0x20/2], 0);
+    }
+}
+
+// vim:ts=4:sw=4:expandtab