full ym2612 save/load for 940

[picodrive.git] / platform / gp2x / code940 / 940.c

diff --git a/platform/gp2x/code940/940.c b/platform/gp2x/code940/940.c
index 4a1e718..0df1945 100644 (file)
--- a/platform/gp2x/code940/940.c
+++ b/platform/gp2x/code940/940.c
@@ -1,8 +1,11 @@
+// The top-level functions for the ARM940\r
+// (c) Copyright 2006-2007, Grazvydas "notaz" Ignotas\r
+\r
 #include "940shared.h"\r
 \r
 static _940_data_t *shared_data = (_940_data_t *)   0x00100000;\r
 static _940_ctl_t  *shared_ctl  = (_940_ctl_t *)    0x00200000;\r
-static unsigned char *mp3_data  = (unsigned char *) 0x01000000;\r
+static unsigned char *mp3_data  = (unsigned char *) 0x00400000;\r
 YM2612 *ym2612_940;\r
 \r
 // from init.s\r
@@ -15,6 +18,8 @@ void drain_wb(void);
 // is changed by other core just before we update it\r
 void set_if_not_changed(int *val, int oldval, int newval);\r
 \r
+void _memcpy(void *dst, const void *src, int count);\r
+\r
 //     asm volatile ("mov r0, #0" ::: "r0");\r
 //     asm volatile ("mcr p15, 0, r0, c7, c6,  0" ::: "r0"); /* flush dcache */\r
 //     asm volatile ("mcr p15, 0, r0, c7, c10, 4" ::: "r0"); /* drain write buffer */\r
@@ -55,6 +60,26 @@ static void mp3_decode(void)
        set_if_not_changed(&shared_ctl->mp3_offs, mp3_offs, readPtr - mp3_data);\r
 }\r
 \r
+static void ym_flush_writes(void)\r
+{\r
+       UINT16 *wbuff;\r
+       int i;\r
+\r
+       if (shared_ctl->writebuffsel == 1) {\r
+               wbuff = shared_ctl->writebuff1;\r
+       } else {\r
+               wbuff = shared_ctl->writebuff0;\r
+       }\r
+\r
+       /* playback all writes */\r
+       for (i = 2048; i > 0; i--) {\r
+               UINT16 d = *wbuff++;\r
+               if (d == 0xffff) break;\r
+               if (d == 0xfffe) continue;\r
+               YM2612Write_(d >> 8, d);\r
+       }\r
+}\r
+\r
 static void ym_update(int *ym_buffer)\r
 {\r
        int i, dw;\r
@@ -83,7 +108,8 @@ static void ym_update(int *ym_buffer)
                YM2612Write_(d >> 8, d);\r
        }\r
 \r
-       if (two_upds) {\r
+       if (two_upds)\r
+       {\r
                int len1 = shared_ctl->length / 2;\r
                shared_ctl->ym_active_chs =\r
                        YM2612UpdateOne_(ym_buffer, len1, shared_ctl->stereo, 1);\r
@@ -142,6 +168,20 @@ void Main940(void)
                                YM2612PicoStateLoad_();\r
                                break;\r
 \r
+                       case JOB940_PICOSTATESAVE2:\r
+                               YM2612PicoStateSave2(0, 0);\r
+                               _memcpy(shared_ctl->writebuff0, ym2612_940->REGS, 0x200);\r
+                               break;\r
+\r
+                       case JOB940_PICOSTATELOAD2_PREP:\r
+                               ym_flush_writes();\r
+                               break;\r
+\r
+                       case JOB940_PICOSTATELOAD2:\r
+                               _memcpy(ym2612_940->REGS, shared_ctl->writebuff0, 0x200);\r
+                               YM2612PicoStateLoad2(0, 0);\r
+                               break;\r
+\r
                        case JOB940_YM2612UPDATEONE:\r
                                ym_update(ym_buffer);\r
                                break;\r