+// 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
// 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
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
+ int two_upds = 0;\r
+ UINT16 *wbuff;\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/2; i > 0; i--) {\r
+ UINT16 d;\r
+ dw = *(int *)wbuff;\r
+ d = dw;\r
+ wbuff++;\r
+ if (d == 0xffff) break;\r
+ if (d == 0xfffe) { two_upds=1; break; }\r
+ YM2612Write_(d >> 8, d);\r
+ d = (dw>>16);\r
+ wbuff++;\r
+ if (d == 0xffff) break;\r
+ if (d == 0xfffe) { two_upds=1; break; }\r
+ YM2612Write_(d >> 8, d);\r
+ }\r
+\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
+\r
+ for (i *= 2; i > 0; i--) {\r
+ UINT16 d = *wbuff++;\r
+ if (d == 0xffff) break;\r
+ YM2612Write_(d >> 8, d);\r
+ }\r
+\r
+ ym_buffer += shared_ctl->stereo ? len1*2 : len1;\r
+ len1 = shared_ctl->length - len1;\r
+\r
+ shared_ctl->ym_active_chs =\r
+ YM2612UpdateOne_(ym_buffer, len1, shared_ctl->stereo, 1);\r
+ } else {\r
+ shared_ctl->ym_active_chs =\r
+ YM2612UpdateOne_(ym_buffer, shared_ctl->length, shared_ctl->stereo, 1);\r
+ }\r
+}\r
+\r
\r
void Main940(void)\r
{\r
YM2612PicoStateLoad_();\r
break;\r
\r
- case JOB940_YM2612UPDATEONE: {\r
- int i, dw, *wbuff;\r
- if (shared_ctl->writebuffsel == 1) {\r
- wbuff = (int *) shared_ctl->writebuff1;\r
- } else {\r
- wbuff = (int *) shared_ctl->writebuff0;\r
- }\r
-\r
- /* playback all writes */\r
- for (i = 2048/2; i > 0; i--) {\r
- UINT16 d;\r
- dw = *wbuff++;\r
- d = dw;\r
- if (d == 0xffff) break;\r
- YM2612Write_(d >> 8, d);\r
- d = (dw>>16);\r
- if (d == 0xffff) break;\r
- YM2612Write_(d >> 8, d);\r
- }\r
-\r
- shared_ctl->ym_active_chs =\r
- YM2612UpdateOne_(ym_buffer, shared_ctl->length, shared_ctl->stereo, 1);\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
- }\r
\r
case JOB940_MP3DECODE:\r
mp3_decode();\r