X-Git-Url: https://notaz.gp2x.de/cgi-bin/gitweb.cgi?a=blobdiff_plain;f=platform%2Fgp2x%2Fcode940%2F940.c;h=97a3b5c91f3c1d130935e41192850d824cffd224;hb=d6114368e1ee2cc4e6f0eb2785a1fce626987897;hp=b242603ba52dae21bf1e4d1ff6a05d786a04d0fc;hpb=abe0ea43b561e2def84cf921b1d6d8c82819ea69;p=picodrive.git

diff --git a/platform/gp2x/code940/940.c b/platform/gp2x/code940/940.c
index b242603..97a3b5c 100644
--- a/platform/gp2x/code940/940.c
+++ b/platform/gp2x/code940/940.c
@@ -1,8 +1,11 @@
+// The top-level functions for the ARM940
+// (c) Copyright 2006-2007, Grazvydas "notaz" Ignotas
+
 #include "940shared.h"
 
 static _940_data_t *shared_data = (_940_data_t *)   0x00100000;
 static _940_ctl_t  *shared_ctl  = (_940_ctl_t *)    0x00200000;
-static unsigned char *mp3_data  = (unsigned char *) 0x01000000;
+static unsigned char *mp3_data  = (unsigned char *) 0x00400000;
 YM2612 *ym2612_940;
 
 // from init.s
@@ -55,6 +58,56 @@ static void mp3_decode(void)
 	set_if_not_changed(&shared_ctl->mp3_offs, mp3_offs, readPtr - mp3_data);
 }
 
+static void ym_update(int *ym_buffer)
+{
+	int i, dw;
+	int two_upds = 0;
+	UINT16 *wbuff;
+
+	if (shared_ctl->writebuffsel == 1) {
+		wbuff = shared_ctl->writebuff1;
+	} else {
+		wbuff = shared_ctl->writebuff0;
+	}
+
+	/* playback all writes */
+	for (i = 2048/2; i > 0; i--) {
+		UINT16 d;
+		dw = *(int *)wbuff;
+		d = dw;
+		wbuff++;
+		if (d == 0xffff) break;
+		if (d == 0xfffe) { two_upds=1; break; }
+		YM2612Write_(d >> 8, d);
+		d = (dw>>16);
+		wbuff++;
+		if (d == 0xffff) break;
+		if (d == 0xfffe) { two_upds=1; break; }
+		YM2612Write_(d >> 8, d);
+	}
+
+	if (two_upds) {
+		int len1 = shared_ctl->length / 2;
+		shared_ctl->ym_active_chs =
+			YM2612UpdateOne_(ym_buffer, len1, shared_ctl->stereo, 1);
+
+		for (i *= 2; i > 0; i--) {
+			UINT16 d = *wbuff++;
+			if (d == 0xffff) break;
+			YM2612Write_(d >> 8, d);
+		}
+
+		ym_buffer += shared_ctl->stereo ? len1*2 : len1;
+		len1 = shared_ctl->length - len1;
+
+		shared_ctl->ym_active_chs =
+			YM2612UpdateOne_(ym_buffer, len1, shared_ctl->stereo, 1);
+	} else {
+		shared_ctl->ym_active_chs =
+			YM2612UpdateOne_(ym_buffer, shared_ctl->length, shared_ctl->stereo, 1);
+	}
+}
+
 
 void Main940(void)
 {
@@ -92,29 +145,9 @@ void Main940(void)
 				YM2612PicoStateLoad_();
 				break;
 
-			case JOB940_YM2612UPDATEONE: {
-				int i, dw, *wbuff;
-				if (shared_ctl->writebuffsel == 1) {
-					wbuff = (int *) shared_ctl->writebuff1;
-				} else {
-					wbuff = (int *) shared_ctl->writebuff0;
-				}
-
-				/* playback all writes */
-				for (i = 2048/2; i > 0; i--) {
-					UINT16 d;
-					dw = *wbuff++;
-					d = dw;
-					if (d == 0xffff) break;
-					YM2612Write_(d >> 8, d);
-					d = (dw>>16);
-					if (d == 0xffff) break;
-					YM2612Write_(d >> 8, d);
-				}
-
-				YM2612UpdateOne_(ym_buffer, shared_ctl->length, shared_ctl->stereo, 1);
+			case JOB940_YM2612UPDATEONE:
+				ym_update(ym_buffer);
 				break;
-			}
 
 			case JOB940_MP3DECODE:
 				mp3_decode();