[libpicofe.git] / gp2x / 940.c

#include "940shared.h"\r
\r
static _940_data_t *shared_data = (_940_data_t *) 0x100000;\r
static _940_ctl_t  *shared_ctl  = (_940_ctl_t *)  0x200000;\r
YM2612 *ym2612_940;\r
int *mix_buffer;\r
\r
// from init.s\r
void wait_irq(void);\r
void spend_cycles(int c);\r
void cache_clean(void);\r
void cache_clean_flush(void);\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
\r
void Main940(int startvector)\r
{\r
	ym2612_940 = &shared_data->ym2612;\r
	mix_buffer = shared_data->mix_buffer;\r
\r
	// debug\r
	shared_ctl->vstarts[startvector]++;\r
	asm volatile ("mcr p15, 0, r0, c7, c10, 4" ::: "r0");\r
\r
\r
	for (;; shared_ctl->loopc++)\r
	{\r
		int job_num;\r
/*\r
		while (!shared_ctl->busy)\r
		{\r
			//shared_ctl->waitc++;\r
			spend_cycles(256);\r
		}\r
*/\r
		if (!shared_ctl->busy)\r
		{\r
			wait_irq();\r
		}\r
\r
		for (job_num = 0; job_num < MAX_940JOBS; job_num++)\r
		{\r
			switch (shared_ctl->jobs[job_num])\r
			{\r
				case JOB940_YM2612INIT:\r
					shared_ctl->writebuff0[0] = shared_ctl->writebuff1[0] = 0xffff;\r
					YM2612Init_(shared_ctl->baseclock, shared_ctl->rate);\r
					break;\r
\r
				case JOB940_YM2612RESETCHIP:\r
					YM2612ResetChip_();\r
					break;\r
\r
				case JOB940_PICOSTATELOAD:\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
					YM2612UpdateOne_(0, shared_ctl->length, shared_ctl->stereo);\r
					break;\r
				}\r
			}\r
		}\r
\r
		shared_ctl->busy = 0;\r
//		cache_clean_flush();\r
		cache_clean();\r
//		asm volatile ("mov r0, #0" ::: "r0");\r
//		asm volatile ("mcr p15, 0, r0, c7, c10, 4" ::: "r0"); /* drain write buffer, should be done on nonbuffered write */\r
	}\r
}\r
\r
Commit	Line	Data
720ee7f6	1	#include "940shared.h"\r
720ee7f6	2	\r
720ee7f6	3	static _940_data_t shared_data = (_940_data_t ) 0x100000;\r
	4	static _940_ctl_t shared_ctl = (_940_ctl_t ) 0x200000;\r
	5	YM2612 *ym2612_940;\r
	6	int *mix_buffer;\r
	7	\r
	8	// from init.s\r
	9	void wait_irq(void);\r
	10	void spend_cycles(int c);\r
	11	void cache_clean(void);\r
	12	void cache_clean_flush(void);\r
	13	\r
	14	// asm volatile ("mov r0, #0" ::: "r0");\r
	15	// asm volatile ("mcr p15, 0, r0, c7, c6, 0" ::: "r0"); /* flush dcache */\r
	16	// asm volatile ("mcr p15, 0, r0, c7, c10, 4" ::: "r0"); /* drain write buffer */\r
	17	\r
	18	void Main940(int startvector)\r
	19	{\r
	20	ym2612_940 = &shared_data->ym2612;\r
	21	mix_buffer = shared_data->mix_buffer;\r
	22	\r
	23	// debug\r
	24	shared_ctl->vstarts[startvector]++;\r
	25	asm volatile ("mcr p15, 0, r0, c7, c10, 4" ::: "r0");\r
	26	\r
720ee7f6	27	\r
	28	for (;; shared_ctl->loopc++)\r
	29	{\r
8dfb9fd5	30	int job_num;\r
720ee7f6	31	/*\r
	32	while (!shared_ctl->busy)\r
	33	{\r
	34	//shared_ctl->waitc++;\r
	35	spend_cycles(256);\r
	36	}\r
	37	*/\r
	38	if (!shared_ctl->busy)\r
	39	{\r
	40	wait_irq();\r
	41	}\r
	42	\r
8dfb9fd5	43	for (job_num = 0; job_num < MAX_940JOBS; job_num++)\r
720ee7f6	44	{\r
8dfb9fd5	45	switch (shared_ctl->jobs[job_num])\r
	46	{\r
	47	case JOB940_YM2612INIT:\r
	48	shared_ctl->writebuff0[0] = shared_ctl->writebuff1[0] = 0xffff;\r
	49	YM2612Init_(shared_ctl->baseclock, shared_ctl->rate);\r
	50	break;\r
720ee7f6	51	\r
8dfb9fd5	52	case JOB940_YM2612RESETCHIP:\r
	53	YM2612ResetChip_();\r
	54	break;\r
720ee7f6	55	\r
8dfb9fd5	56	case JOB940_PICOSTATELOAD:\r
	57	YM2612PicoStateLoad_();\r
	58	break;\r
720ee7f6	59	\r
8dfb9fd5	60	case JOB940_YM2612UPDATEONE: {\r
	61	int i, dw, *wbuff;\r
	62	if (shared_ctl->writebuffsel == 1) {\r
	63	wbuff = (int *) shared_ctl->writebuff1;\r
	64	} else {\r
	65	wbuff = (int *) shared_ctl->writebuff0;\r
	66	}\r
720ee7f6	67	\r
8dfb9fd5	68	/* playback all writes */\r
	69	for (i = 2048/2; i > 0; i--) {\r
	70	UINT16 d;\r
	71	dw = *wbuff++;\r
	72	d = dw;\r
	73	if (d == 0xffff) break;\r
	74	YM2612Write_(d >> 8, d);\r
	75	d = (dw>>16);\r
	76	if (d == 0xffff) break;\r
	77	YM2612Write_(d >> 8, d);\r
	78	}\r
720ee7f6	79	\r
8dfb9fd5	80	YM2612UpdateOne_(0, shared_ctl->length, shared_ctl->stereo);\r
	81	break;\r
	82	}\r
720ee7f6	83	}\r
	84	}\r
	85	\r
	86	shared_ctl->busy = 0;\r
8dfb9fd5	87	// cache_clean_flush();\r
	88	cache_clean();\r
	89	// asm volatile ("mov r0, #0" ::: "r0");\r
	90	// asm volatile ("mcr p15, 0, r0, c7, c10, 4" ::: "r0"); /* drain write buffer, should be done on nonbuffered write */\r
720ee7f6	91	}\r
720ee7f6	92	}\r
8dfb9fd5	93	\r