DevSB16.cpp@ 13416

最後變更在這個檔案從13416是 12978,由 vboxsync 提交於 16 年前
PDM: PDM_DEVREG_FLAGS_DEFAULT_BITS convenience.
屬性 svn:eol-style 設為 `native` 屬性 svn:keywords 設為 `Author Date Id Revision`
檔案大小: 47.2 KB

行
1	/* $Id: DevSB16.cpp 12978 2008-10-03 23:28:44Z vboxsync $ */
2	/** @file
3	* DevSB16 - VBox SB16 Audio Controller.
4	*
5	* (r3917 sb16.c)
6	*
7	* @todo hiccups on NT4 and Win98.
8	*/
9
10	/*
11	* QEMU Soundblaster 16 emulation
12	*
13	* Copyright (c) 2003-2005 Vassili Karpov (malc)
14	*
15	* Permission is hereby granted, free of charge, to any person obtaining a copy
16	* of this software and associated documentation files (the "Software"), to deal
17	* in the Software without restriction, including without limitation the rights
18	* to use, copy, modify, merge, publish, distribute, sublicense, and/or sell
19	* copies of the Software, and to permit persons to whom the Software is
20	* furnished to do so, subject to the following conditions:
21	*
22	* The above copyright notice and this permission notice shall be included in
23	* all copies or substantial portions of the Software.
24	*
25	* THE SOFTWARE IS PROVIDED "AS IS", WITHOUT WARRANTY OF ANY KIND, EXPRESS OR
26	* IMPLIED, INCLUDING BUT NOT LIMITED TO THE WARRANTIES OF MERCHANTABILITY,
27	* FITNESS FOR A PARTICULAR PURPOSE AND NONINFRINGEMENT. IN NO EVENT SHALL
28	* THE AUTHORS OR COPYRIGHT HOLDERS BE LIABLE FOR ANY CLAIM, DAMAGES OR OTHER
29	* LIABILITY, WHETHER IN AN ACTION OF CONTRACT, TORT OR OTHERWISE, ARISING FROM,
30	* OUT OF OR IN CONNECTION WITH THE SOFTWARE OR THE USE OR OTHER DEALINGS IN
31	* THE SOFTWARE.
32	*/
33
34	#define LOG_GROUP LOG_GROUP_DEV_AUDIO
35	#include <VBox/pdmdev.h>
36	#include <iprt/assert.h>
37	#include <iprt/string.h>
38	#include "../vl_vbox.h"
39
40	extern "C" {
41	#include "audio.h"
42	}
43
44	#define SB16_SSM_VERSION 1
45
46	#ifndef VBOX
47
48	#define LENOFA(a) ((int) (sizeof(a)/sizeof(a[0])))
49
50	#define dolog(...) AUD_log ("sb16", __VA_ARGS__)
51
52	/* #define DEBUG */
53	/* #define DEBUG_SB16_MOST */
54
55	#ifdef DEBUG
56	#define ldebug(...) dolog (__VA_ARGS__)
57	#else
58	#define ldebug(...)
59	#endif
60
61	#else /* VBOX */
62
63	DECLINLINE(void) dolog (const char *fmt, ...)
64	{
65	va_list ap;
66	va_start (ap, fmt);
67	AUD_vlog ("sb16", fmt, ap);
68	va_end (ap);
69	}
70
71	# ifdef DEBUG
72	static void ldebug (const char *fmt, ...)
73	{
74	va_list ap;
75
76	va_start (ap, fmt);
77	AUD_vlog ("sb16", fmt, ap);
78	va_end (ap);
79	}
80	# else
81	DECLINLINE(void) ldebug (const char *fmt, ...)
82	{
83	(void)fmt;
84	}
85	# endif
86
87	#endif /* VBOX */
88
89	#ifndef VBOX
90	#define IO_READ_PROTO(name) \
91	uint32_t name (void *opaque, uint32_t nport)
92	#define IO_WRITE_PROTO(name) \
93	void name (void *opaque, uint32_t nport, uint32_t val)
94	#else /* VBOX */
95	#define IO_READ_PROTO(name) \
96	DECLCALLBACK(int) name (PPDMDEVINS pDevIns, void *opaque, \
97	RTIOPORT nport, uint32_t *pu32, unsigned cb)
98
99	#define IO_WRITE_PROTO(name) \
100	DECLCALLBACK(int) name (PPDMDEVINS pDevIns, void *opaque, \
101	RTIOPORT nport, uint32_t val, unsigned cb)
102	#endif /* VBOX */
103
104	static const char e3[] = "COPYRIGHT (C) CREATIVE TECHNOLOGY LTD, 1992.";
105
106	#ifndef VBOX
107	static struct {
108	int ver_lo;
109	int ver_hi;
110	int irq;
111	int dma;
112	int hdma;
113	int port;
114	} conf = {5, 4, 5, 1, 5, 0x220};
115	#endif /* !VBOX */
116
117	typedef struct SB16State {
118	#ifdef VBOX
119	PPDMDEVINSR3 pDevIns;
120	#endif
121	QEMUSoundCard card;
122	#ifndef VBOX
123	qemu_irq *pic;
124	#endif
125	int irq;
126	int dma;
127	int hdma;
128	int port;
129	int ver;
130
131	int in_index;
132	int out_data_len;
133	int fmt_stereo;
134	int fmt_signed;
135	int fmt_bits;
136	audfmt_e fmt;
137	int dma_auto;
138	int block_size;
139	int fifo;
140	int freq;
141	int time_const;
142	int speaker;
143	int needed_bytes;
144	int cmd;
145	int use_hdma;
146	int highspeed;
147	int can_write;
148
149	int v2x6;
150
151	uint8_t csp_param;
152	uint8_t csp_value;
153	uint8_t csp_mode;
154	uint8_t csp_regs[256];
155	uint8_t csp_index;
156	uint8_t csp_reg83[4];
157	int csp_reg83r;
158	int csp_reg83w;
159
160	uint8_t in2_data[10];
161	uint8_t out_data[50];
162	uint8_t test_reg;
163	uint8_t last_read_byte;
164	int nzero;
165
166	int left_till_irq;
167
168	int dma_running;
169	int bytes_per_second;
170	int align;
171	int audio_free;
172	SWVoiceOut *voice;
173
174	#ifndef VBOX
175	QEMUTimer *aux_ts;
176	#else
177	PTMTIMER pTimer;
178	PPDMIBASE pDrvBase;
179	PDMIBASE IBase;
180	#endif
181	/* mixer state */
182	int mixer_nreg;
183	uint8_t mixer_regs[256];
184	} SB16State;
185
186	static void SB_audio_callback (void *opaque, int free);
187
188	static int magic_of_irq (int irq)
189	{
190	switch (irq) {
191	case 5:
192	return 2;
193	case 7:
194	return 4;
195	case 9:
196	return 1;
197	case 10:
198	return 8;
199	default:
200	dolog ("bad irq %d\n", irq);
201	return 2;
202	}
203	}
204
205	static int irq_of_magic (int magic)
206	{
207	switch (magic) {
208	case 1:
209	return 9;
210	case 2:
211	return 5;
212	case 4:
213	return 7;
214	case 8:
215	return 10;
216	default:
217	dolog ("bad irq magic %d\n", magic);
218	return -1;
219	}
220	}
221
222	#if 0
223	static void log_dsp (SB16State *dsp)
224	{
225	ldebug ("%s:%s:%d:%s:dmasize=%d:freq=%d:const=%d:speaker=%d\n",
226	dsp->fmt_stereo ? "Stereo" : "Mono",
227	dsp->fmt_signed ? "Signed" : "Unsigned",
228	dsp->fmt_bits,
229	dsp->dma_auto ? "Auto" : "Single",
230	dsp->block_size,
231	dsp->freq,
232	dsp->time_const,
233	dsp->speaker);
234	}
235	#endif
236
237	static void speaker (SB16State *s, int on)
238	{
239	s->speaker = on;
240	/* AUD_enable (s->voice, on); */
241	}
242
243	static void control (SB16State *s, int hold)
244	{
245	int dma = s->use_hdma ? s->hdma : s->dma;
246	s->dma_running = hold;
247
248	ldebug ("hold %d high %d dma %d\n", hold, s->use_hdma, dma);
249
250	#ifndef VBOX
251	if (hold) {
252	DMA_hold_DREQ (dma);
253	AUD_set_active_out (s->voice, 1);
254	}
255	else {
256	DMA_release_DREQ (dma);
257	AUD_set_active_out (s->voice, 0);
258	}
259	#else /* VBOX */
260	if (hold)
261	{
262	PDMDevHlpDMASetDREQ (s->pDevIns, dma, 1);
263	PDMDevHlpDMASchedule (s->pDevIns);
264	AUD_set_active_out (s->voice, 1);
265	}
266	else
267	{
268	PDMDevHlpDMASetDREQ (s->pDevIns, dma, 0);
269	AUD_set_active_out (s->voice, 0);
270	}
271	#endif /* VBOX */
272	}
273
274	#ifndef VBOX
275	static void aux_timer (void *opaque)
276	{
277	SB16State *s = opaque;
278	s->can_write = 1;
279	qemu_irq_raise (s->pic[s->irq]);
280	}
281	#else /* VBOX */
282	static DECLCALLBACK(void) sb16Timer(PPDMDEVINS pDevIns, PTMTIMER pTimer)
283	{
284	SB16State s = PDMINS_2_DATA(pDevIns, SB16State );
285	s->can_write = 1;
286	PDMDevHlpISASetIrq(s->pDevIns, s->irq, 1);
287	}
288	#endif /* VBOX */
289
290	#define DMA8_AUTO 1
291	#define DMA8_HIGH 2
292
293	static void continue_dma8 (SB16State *s)
294	{
295	if (s->freq > 0) {
296	audsettings_t as;
297
298	s->audio_free = 0;
299
300	as.freq = s->freq;
301	as.nchannels = 1 << s->fmt_stereo;
302	as.fmt = s->fmt;
303	as.endianness = 0;
304
305	s->voice = AUD_open_out (
306	&s->card,
307	s->voice,
308	"sb16",
309	s,
310	SB_audio_callback,
311	&as
312	);
313	}
314
315	control (s, 1);
316	}
317
318	static void dma_cmd8 (SB16State *s, int mask, int dma_len)
319	{
320	s->fmt = AUD_FMT_U8;
321	s->use_hdma = 0;
322	s->fmt_bits = 8;
323	s->fmt_signed = 0;
324	s->fmt_stereo = (s->mixer_regs[0x0e] & 2) != 0;
325	if (-1 == s->time_const) {
326	if (s->freq <= 0)
327	s->freq = 11025;
328	}
329	else {
330	int tmp = (256 - s->time_const);
331	s->freq = (1000000 + (tmp / 2)) / tmp;
332	}
333
334	if (dma_len != -1) {
335	s->block_size = dma_len << s->fmt_stereo;
336	}
337	else {
338	/* This is apparently the only way to make both Act1/PL
339	and SecondReality/FC work
340
341	Act1 sets block size via command 0x48 and it's an odd number
342	SR does the same with even number
343	Both use stereo, and Creatives own documentation states that
344	0x48 sets block size in bytes less one.. go figure */
345	s->block_size &= ~s->fmt_stereo;
346	}
347
348	s->freq >>= s->fmt_stereo;
349	s->left_till_irq = s->block_size;
350	s->bytes_per_second = (s->freq << s->fmt_stereo);
351	/* s->highspeed = (mask & DMA8_HIGH) != 0; */
352	s->dma_auto = (mask & DMA8_AUTO) != 0;
353	s->align = (1 << s->fmt_stereo) - 1;
354
355	if (s->block_size & s->align) {
356	dolog ("warning: misaligned block size %d, alignment %d\n",
357	s->block_size, s->align + 1);
358	}
359
360	ldebug ("freq %d, stereo %d, sign %d, bits %d, "
361	"dma %d, auto %d, fifo %d, high %d\n",
362	s->freq, s->fmt_stereo, s->fmt_signed, s->fmt_bits,
363	s->block_size, s->dma_auto, s->fifo, s->highspeed);
364
365	continue_dma8 (s);
366	speaker (s, 1);
367	}
368
369	static void dma_cmd (SB16State *s, uint8_t cmd, uint8_t d0, int dma_len)
370	{
371	s->use_hdma = cmd < 0xc0;
372	s->fifo = (cmd >> 1) & 1;
373	s->dma_auto = (cmd >> 2) & 1;
374	s->fmt_signed = (d0 >> 4) & 1;
375	s->fmt_stereo = (d0 >> 5) & 1;
376
377	switch (cmd >> 4) {
378	case 11:
379	s->fmt_bits = 16;
380	break;
381
382	case 12:
383	s->fmt_bits = 8;
384	break;
385	}
386
387	if (-1 != s->time_const) {
388	#if 1
389	int tmp = 256 - s->time_const;
390	s->freq = (1000000 + (tmp / 2)) / tmp;
391	#else
392	/* s->freq = 1000000 / ((255 - s->time_const) << s->fmt_stereo); */
393	s->freq = 1000000 / ((255 - s->time_const));
394	#endif
395	s->time_const = -1;
396	}
397
398	s->block_size = dma_len + 1;
399	s->block_size <<= ((s->fmt_bits == 16) ? 1 : 0);
400	if (!s->dma_auto) {
401	/* It is clear that for DOOM and auto-init this value
402	shouldn't take stereo into account, while Miles Sound Systems
403	setsound.exe with single transfer mode wouldn't work without it
404	wonders of SB16 yet again */
405	s->block_size <<= s->fmt_stereo;
406	}
407
408	ldebug ("freq %d, stereo %d, sign %d, bits %d, "
409	"dma %d, auto %d, fifo %d, high %d\n",
410	s->freq, s->fmt_stereo, s->fmt_signed, s->fmt_bits,
411	s->block_size, s->dma_auto, s->fifo, s->highspeed);
412
413	if (16 == s->fmt_bits) {
414	if (s->fmt_signed) {
415	s->fmt = AUD_FMT_S16;
416	}
417	else {
418	s->fmt = AUD_FMT_U16;
419	}
420	}
421	else {
422	if (s->fmt_signed) {
423	s->fmt = AUD_FMT_S8;
424	}
425	else {
426	s->fmt = AUD_FMT_U8;
427	}
428	}
429
430	s->left_till_irq = s->block_size;
431
432	s->bytes_per_second = (s->freq << s->fmt_stereo) << ((s->fmt_bits == 16) ? 1 : 0);
433	s->highspeed = 0;
434	s->align = (1 << (s->fmt_stereo + (s->fmt_bits == 16))) - 1;
435	if (s->block_size & s->align) {
436	dolog ("warning: misaligned block size %d, alignment %d\n",
437	s->block_size, s->align + 1);
438	}
439
440	if (s->freq) {
441	audsettings_t as;
442
443	s->audio_free = 0;
444
445	as.freq = s->freq;
446	as.nchannels = 1 << s->fmt_stereo;
447	as.fmt = s->fmt;
448	as.endianness = 0;
449
450	s->voice = AUD_open_out (
451	&s->card,
452	s->voice,
453	"sb16",
454	s,
455	SB_audio_callback,
456	&as
457	);
458	}
459
460	control (s, 1);
461	speaker (s, 1);
462	}
463
464	static inline void dsp_out_data (SB16State *s, uint8_t val)
465	{
466	ldebug ("outdata %#x\n", val);
467	if ((size_t) s->out_data_len < sizeof (s->out_data)) {
468	s->out_data[s->out_data_len++] = val;
469	}
470	}
471
472	static inline uint8_t dsp_get_data (SB16State *s)
473	{
474	if (s->in_index) {
475	return s->in2_data[--s->in_index];
476	}
477	else {
478	dolog ("buffer underflow\n");
479	return 0;
480	}
481	}
482
483	static void command (SB16State *s, uint8_t cmd)
484	{
485	ldebug ("command %#x\n", cmd);
486
487	if (cmd > 0xaf && cmd < 0xd0) {
488	if (cmd & 8) {
489	dolog ("ADC not yet supported (command %#x)\n", cmd);
490	}
491
492	switch (cmd >> 4) {
493	case 11:
494	case 12:
495	break;
496	default:
497	dolog ("%#x wrong bits\n", cmd);
498	}
499	s->needed_bytes = 3;
500	}
501	else {
502	s->needed_bytes = 0;
503
504	switch (cmd) {
505	case 0x03:
506	dsp_out_data (s, 0x10); /* s->csp_param); */
507	goto warn;
508
509	case 0x04:
510	s->needed_bytes = 1;
511	goto warn;
512
513	case 0x05:
514	s->needed_bytes = 2;
515	goto warn;
516
517	case 0x08:
518	/* __asm__ ("int3"); */
519	goto warn;
520
521	case 0x0e:
522	s->needed_bytes = 2;
523	goto warn;
524
525	case 0x09:
526	dsp_out_data (s, 0xf8);
527	goto warn;
528
529	case 0x0f:
530	s->needed_bytes = 1;
531	goto warn;
532
533	case 0x10:
534	s->needed_bytes = 1;
535	goto warn;
536
537	case 0x14:
538	s->needed_bytes = 2;
539	s->block_size = 0;
540	break;
541
542	case 0x1c: /* Auto-Initialize DMA DAC, 8-bit */
543	dma_cmd8 (s, DMA8_AUTO, -1);
544	break;
545
546	case 0x20: /* Direct ADC, Juice/PL */
547	dsp_out_data (s, 0xff);
548	goto warn;
549
550	case 0x35:
551	dolog ("0x35 - MIDI command not implemented\n");
552	break;
553
554	case 0x40:
555	s->freq = -1;
556	s->time_const = -1;
557	s->needed_bytes = 1;
558	break;
559
560	case 0x41:
561	s->freq = -1;
562	s->time_const = -1;
563	s->needed_bytes = 2;
564	break;
565
566	case 0x42:
567	s->freq = -1;
568	s->time_const = -1;
569	s->needed_bytes = 2;
570	goto warn;
571
572	case 0x45:
573	dsp_out_data (s, 0xaa);
574	goto warn;
575
576	case 0x47: /* Continue Auto-Initialize DMA 16bit */
577	break;
578
579	case 0x48:
580	s->needed_bytes = 2;
581	break;
582
583	case 0x74:
584	s->needed_bytes = 2; /* DMA DAC, 4-bit ADPCM */
585	dolog ("0x75 - DMA DAC, 4-bit ADPCM not implemented\n");
586	break;
587
588	case 0x75: /* DMA DAC, 4-bit ADPCM Reference */
589	s->needed_bytes = 2;
590	dolog ("0x74 - DMA DAC, 4-bit ADPCM Reference not implemented\n");
591	break;
592
593	case 0x76: /* DMA DAC, 2.6-bit ADPCM */
594	s->needed_bytes = 2;
595	dolog ("0x74 - DMA DAC, 2.6-bit ADPCM not implemented\n");
596	break;
597
598	case 0x77: /* DMA DAC, 2.6-bit ADPCM Reference */
599	s->needed_bytes = 2;
600	dolog ("0x74 - DMA DAC, 2.6-bit ADPCM Reference not implemented\n");
601	break;
602
603	case 0x7d:
604	dolog ("0x7d - Autio-Initialize DMA DAC, 4-bit ADPCM Reference\n");
605	dolog ("not implemented\n");
606	break;
607
608	case 0x7f:
609	dolog (
610	"0x7d - Autio-Initialize DMA DAC, 2.6-bit ADPCM Reference\n"
611	);
612	dolog ("not implemented\n");
613	break;
614
615	case 0x80:
616	s->needed_bytes = 2;
617	break;
618
619	case 0x90:
620	case 0x91:
621	dma_cmd8 (s, (((cmd & 1) == 0) ? 1 : 0) \| DMA8_HIGH, -1);
622	break;
623
624	case 0xd0: /* halt DMA operation. 8bit */
625	control (s, 0);
626	break;
627
628	case 0xd1: /* speaker on */
629	speaker (s, 1);
630	break;
631
632	case 0xd3: /* speaker off */
633	speaker (s, 0);
634	break;
635
636	case 0xd4: /* continue DMA operation. 8bit */
637	/* KQ6 (or maybe Sierras audblst.drv in general) resets
638	the frequency between halt/continue */
639	continue_dma8 (s);
640	break;
641
642	case 0xd5: /* halt DMA operation. 16bit */
643	control (s, 0);
644	break;
645
646	case 0xd6: /* continue DMA operation. 16bit */
647	control (s, 1);
648	break;
649
650	case 0xd9: /* exit auto-init DMA after this block. 16bit */
651	s->dma_auto = 0;
652	break;
653
654	case 0xda: /* exit auto-init DMA after this block. 8bit */
655	s->dma_auto = 0;
656	break;
657
658	case 0xe0: /* DSP identification */
659	s->needed_bytes = 1;
660	break;
661
662	case 0xe1:
663	dsp_out_data (s, s->ver & 0xff);
664	dsp_out_data (s, s->ver >> 8);
665	break;
666
667	case 0xe2:
668	s->needed_bytes = 1;
669	goto warn;
670
671	case 0xe3:
672	{
673	int i;
674	for (i = sizeof (e3) - 1; i >= 0; --i)
675	dsp_out_data (s, e3[i]);
676	}
677	break;
678
679	case 0xe4: /* write test reg */
680	s->needed_bytes = 1;
681	break;
682
683	case 0xe7:
684	dolog ("Attempt to probe for ESS (0xe7)?\n");
685	break;
686
687	case 0xe8: /* read test reg */
688	dsp_out_data (s, s->test_reg);
689	break;
690
691	case 0xf2:
692	case 0xf3:
693	dsp_out_data (s, 0xaa);
694	s->mixer_regs[0x82] \|= (cmd == 0xf2) ? 1 : 2;
695	#ifndef VBOX
696	qemu_irq_raise (s->pic[s->irq]);
697	#else
698	PDMDevHlpISASetIrq(s->pDevIns, s->irq, 1);
699	#endif
700	break;
701
702	case 0xf9:
703	s->needed_bytes = 1;
704	goto warn;
705
706	case 0xfa:
707	dsp_out_data (s, 0);
708	goto warn;
709
710	case 0xfc: /* FIXME */
711	dsp_out_data (s, 0);
712	goto warn;
713
714	default:
715	dolog ("Unrecognized command %#x\n", cmd);
716	break;
717	}
718	}
719
720	if (!s->needed_bytes) {
721	ldebug ("\n");
722	}
723
724	exit:
725	if (!s->needed_bytes) {
726	s->cmd = -1;
727	}
728	else {
729	s->cmd = cmd;
730	}
731	return;
732
733	warn:
734	dolog ("warning: command %#x,%d is not truly understood yet\n",
735	cmd, s->needed_bytes);
736	goto exit;
737
738	}
739
740	static uint16_t dsp_get_lohi (SB16State *s)
741	{
742	uint8_t hi = dsp_get_data (s);
743	uint8_t lo = dsp_get_data (s);
744	return (hi << 8) \| lo;
745	}
746
747	static uint16_t dsp_get_hilo (SB16State *s)
748	{
749	uint8_t lo = dsp_get_data (s);
750	uint8_t hi = dsp_get_data (s);
751	return (hi << 8) \| lo;
752	}
753
754	static void complete (SB16State *s)
755	{
756	int d0, d1, d2;
757	ldebug ("complete command %#x, in_index %d, needed_bytes %d\n",
758	s->cmd, s->in_index, s->needed_bytes);
759
760	if (s->cmd > 0xaf && s->cmd < 0xd0) {
761	d2 = dsp_get_data (s);
762	d1 = dsp_get_data (s);
763	d0 = dsp_get_data (s);
764
765	if (s->cmd & 8) {
766	dolog ("ADC params cmd = %#x d0 = %d, d1 = %d, d2 = %d\n",
767	s->cmd, d0, d1, d2);
768	}
769	else {
770	ldebug ("cmd = %#x d0 = %d, d1 = %d, d2 = %d\n",
771	s->cmd, d0, d1, d2);
772	dma_cmd (s, s->cmd, d0, d1 + (d2 << 8));
773	}
774	}
775	else {
776	switch (s->cmd) {
777	case 0x04:
778	s->csp_mode = dsp_get_data (s);
779	s->csp_reg83r = 0;
780	s->csp_reg83w = 0;
781	ldebug ("CSP command 0x04: mode=%#x\n", s->csp_mode);
782	break;
783
784	case 0x05:
785	s->csp_param = dsp_get_data (s);
786	s->csp_value = dsp_get_data (s);
787	ldebug ("CSP command 0x05: param=%#x value=%#x\n",
788	s->csp_param,
789	s->csp_value);
790	break;
791
792	case 0x0e:
793	d0 = dsp_get_data (s);
794	d1 = dsp_get_data (s);
795	ldebug ("write CSP register %d <- %#x\n", d1, d0);
796	if (d1 == 0x83) {
797	ldebug ("0x83[%d] <- %#x\n", s->csp_reg83r, d0);
798	s->csp_reg83[s->csp_reg83r % 4] = d0;
799	s->csp_reg83r += 1;
800	}
801	else {
802	s->csp_regs[d1] = d0;
803	}
804	break;
805
806	case 0x0f:
807	d0 = dsp_get_data (s);
808	ldebug ("read CSP register %#x -> %#x, mode=%#x\n",
809	d0, s->csp_regs[d0], s->csp_mode);
810	if (d0 == 0x83) {
811	ldebug ("0x83[%d] -> %#x\n",
812	s->csp_reg83w,
813	s->csp_reg83[s->csp_reg83w % 4]);
814	dsp_out_data (s, s->csp_reg83[s->csp_reg83w % 4]);
815	s->csp_reg83w += 1;
816	}
817	else {
818	dsp_out_data (s, s->csp_regs[d0]);
819	}
820	break;
821
822	case 0x10:
823	d0 = dsp_get_data (s);
824	dolog ("cmd 0x10 d0=%#x\n", d0);
825	break;
826
827	case 0x14:
828	dma_cmd8 (s, 0, dsp_get_lohi (s) + 1);
829	break;
830
831	case 0x40:
832	s->time_const = dsp_get_data (s);
833	ldebug ("set time const %d\n", s->time_const);
834	break;
835
836	case 0x42: /* FT2 sets output freq with this, go figure */
837	#if 0
838	dolog ("cmd 0x42 might not do what it think it should\n");
839	#endif
840	case 0x41:
841	s->freq = dsp_get_hilo (s);
842	ldebug ("set freq %d\n", s->freq);
843	break;
844
845	case 0x48:
846	s->block_size = dsp_get_lohi (s) + 1;
847	ldebug ("set dma block len %d\n", s->block_size);
848	break;
849
850	case 0x74:
851	case 0x75:
852	case 0x76:
853	case 0x77:
854	/* ADPCM stuff, ignore */
855	break;
856
857	case 0x80:
858	{
859	int freq, samples, bytes;
860	uint64_t ticks;
861
862	freq = s->freq > 0 ? s->freq : 11025;
863	samples = dsp_get_lohi (s) + 1;
864	bytes = samples << s->fmt_stereo << ((s->fmt_bits == 16) ? 1 : 0);
865	#ifndef VBOX
866	ticks = (bytes * ticks_per_sec) / freq;
867	if (ticks < ticks_per_sec / 1024) {
868	qemu_irq_raise (s->pic[s->irq]);
869	}
870	else {
871	if (s->aux_ts) {
872	qemu_mod_timer (
873	s->aux_ts,
874	qemu_get_clock (vm_clock) + ticks
875	);
876	}
877	}
878	ldebug ("mix silence %d %d %" PRId64 "\n", samples, bytes, ticks);
879	#else /* VBOX */
880	ticks = (bytes * TMTimerGetFreq(s->pTimer)) / freq;
881	if (ticks < TMTimerGetFreq(s->pTimer) / 1024)
882	PDMDevHlpISASetIrq(s->pDevIns, s->irq, 1);
883	else
884	TMTimerSet(s->pTimer, TMTimerGet(s->pTimer) + ticks);
885	ldebug ("mix silence %d %d % %RU64\n", samples, bytes, ticks);
886	#endif /* VBOX */
887	}
888	break;
889
890	case 0xe0:
891	d0 = dsp_get_data (s);
892	s->out_data_len = 0;
893	ldebug ("E0 data = %#x\n", d0);
894	dsp_out_data (s, ~d0);
895	break;
896
897	case 0xe2:
898	d0 = dsp_get_data (s);
899	ldebug ("E2 = %#x\n", d0);
900	break;
901
902	case 0xe4:
903	s->test_reg = dsp_get_data (s);
904	break;
905
906	case 0xf9:
907	d0 = dsp_get_data (s);
908	ldebug ("command 0xf9 with %#x\n", d0);
909	switch (d0) {
910	case 0x0e:
911	dsp_out_data (s, 0xff);
912	break;
913
914	case 0x0f:
915	dsp_out_data (s, 0x07);
916	break;
917
918	case 0x37:
919	dsp_out_data (s, 0x38);
920	break;
921
922	default:
923	dsp_out_data (s, 0x00);
924	break;
925	}
926	break;
927
928	default:
929	dolog ("complete: unrecognized command %#x\n", s->cmd);
930	return;
931	}
932	}
933
934	ldebug ("\n");
935	s->cmd = -1;
936	return;
937	}
938
939	static void legacy_reset (SB16State *s)
940	{
941	audsettings_t as;
942
943	s->freq = 11025;
944	s->fmt_signed = 0;
945	s->fmt_bits = 8;
946	s->fmt_stereo = 0;
947
948	as.freq = s->freq;
949	as.nchannels = 1;
950	as.fmt = AUD_FMT_U8;
951	as.endianness = 0;
952
953	s->voice = AUD_open_out (
954	&s->card,
955	s->voice,
956	"sb16",
957	s,
958	SB_audio_callback,
959	&as
960	);
961
962	/* Not sure about that... */
963	/* AUD_set_active_out (s->voice, 1); */
964	}
965
966	static void reset (SB16State *s)
967	{
968	#ifndef VBOX
969	qemu_irq_lower (s->pic[s->irq]);
970	if (s->dma_auto) {
971	qemu_irq_raise (s->pic[s->irq]);
972	qemu_irq_lower (s->pic[s->irq]);
973	}
974	#else /* VBOX */
975	PDMDevHlpISASetIrq(s->pDevIns, s->irq, 0);
976	if (s->dma_auto) {
977	PDMDevHlpISASetIrq(s->pDevIns, s->irq, 1);
978	PDMDevHlpISASetIrq(s->pDevIns, s->irq, 0);
979	}
980	#endif /* VBOX */
981
982	s->mixer_regs[0x82] = 0;
983	s->dma_auto = 0;
984	s->in_index = 0;
985	s->out_data_len = 0;
986	s->left_till_irq = 0;
987	s->needed_bytes = 0;
988	s->block_size = -1;
989	s->nzero = 0;
990	s->highspeed = 0;
991	s->v2x6 = 0;
992	s->cmd = -1;
993
994	dsp_out_data(s, 0xaa);
995	speaker (s, 0);
996	control (s, 0);
997	legacy_reset (s);
998	}
999
1000	static IO_WRITE_PROTO (dsp_write)
1001	{
1002	SB16State s = (SB16State)opaque;
1003	int iport = nport - s->port;
1004
1005	ldebug ("write %#x <- %#x\n", nport, val);
1006	switch (iport) {
1007	case 0x06:
1008	switch (val) {
1009	case 0x00:
1010	if (s->v2x6 == 1) {
1011	if (0 && s->highspeed) {
1012	s->highspeed = 0;
1013	#ifndef VBOX
1014	qemu_irq_lower (s->pic[s->irq]);
1015	#else
1016	PDMDevHlpISASetIrq(s->pDevIns, s->irq, 0);
1017	#endif
1018	control (s, 0);
1019	}
1020	else {
1021	reset (s);
1022	}
1023	}
1024	s->v2x6 = 0;
1025	break;
1026
1027	case 0x01:
1028	case 0x03: /* FreeBSD kludge */
1029	s->v2x6 = 1;
1030	break;
1031
1032	case 0xc6:
1033	s->v2x6 = 0; /* Prince of Persia, csp.sys, diagnose.exe */
1034	break;
1035
1036	case 0xb8: /* Panic */
1037	reset (s);
1038	break;
1039
1040	case 0x39:
1041	dsp_out_data (s, 0x38);
1042	reset (s);
1043	s->v2x6 = 0x39;
1044	break;
1045
1046	default:
1047	s->v2x6 = val;
1048	break;
1049	}
1050	break;
1051
1052	case 0x0c: /* write data or command \| write status */
1053	/* if (s->highspeed) */
1054	/* break; */
1055
1056	if (0 == s->needed_bytes) {
1057	command (s, val);
1058	#if 0
1059	if (0 == s->needed_bytes) {
1060	log_dsp (s);
1061	}
1062	#endif
1063	}
1064	else {
1065	if (s->in_index == sizeof (s->in2_data)) {
1066	dolog ("in data overrun\n");
1067	}
1068	else {
1069	s->in2_data[s->in_index++] = val;
1070	if (s->in_index == s->needed_bytes) {
1071	s->needed_bytes = 0;
1072	complete (s);
1073	#if 0
1074	log_dsp (s);
1075	#endif
1076	}
1077	}
1078	}
1079	break;
1080
1081	default:
1082	ldebug ("(nport=%#x, val=%#x)\n", nport, val);
1083	break;
1084	}
1085
1086	#ifdef VBOX
1087	return VINF_SUCCESS;
1088	#endif
1089	}
1090
1091	static IO_READ_PROTO (dsp_read)
1092	{
1093	SB16State s = (SB16State)opaque;
1094	int iport, retval, ack = 0;
1095
1096	iport = nport - s->port;
1097	#ifdef VBOX
1098	/** @todo reject non-byte access?
1099	* The spec does not mention a non-byte access so we should check how real hardware behaves. */
1100	#endif
1101
1102	switch (iport) {
1103	case 0x06: /* reset */
1104	retval = 0xff;
1105	break;
1106
1107	case 0x0a: /* read data */
1108	if (s->out_data_len) {
1109	retval = s->out_data[--s->out_data_len];
1110	s->last_read_byte = retval;
1111	}
1112	else {
1113	if (s->cmd != -1) {
1114	dolog ("empty output buffer for command %#x\n",
1115	s->cmd);
1116	}
1117	retval = s->last_read_byte;
1118	/* goto error; */
1119	}
1120	break;
1121
1122	case 0x0c: /* 0 can write */
1123	retval = s->can_write ? 0 : 0x80;
1124	break;
1125
1126	case 0x0d: /* timer interrupt clear */
1127	/* dolog ("timer interrupt clear\n"); */
1128	retval = 0;
1129	break;
1130
1131	case 0x0e: /* data available status \| irq 8 ack */
1132	retval = (!s->out_data_len \|\| s->highspeed) ? 0 : 0x80;
1133	if (s->mixer_regs[0x82] & 1) {
1134	ack = 1;
1135	s->mixer_regs[0x82] &= 1;
1136	#ifndef VBOX
1137	qemu_irq_lower (s->pic[s->irq]);
1138	#else
1139	PDMDevHlpISASetIrq(s->pDevIns, s->irq, 0);
1140	#endif
1141	}
1142	break;
1143
1144	case 0x0f: /* irq 16 ack */
1145	retval = 0xff;
1146	if (s->mixer_regs[0x82] & 2) {
1147	ack = 1;
1148	s->mixer_regs[0x82] &= 2;
1149	#ifndef VBOX
1150	qemu_irq_lower (s->pic[s->irq]);
1151	#else
1152	PDMDevHlpISASetIrq(s->pDevIns, s->irq, 0);
1153	#endif
1154	}
1155	break;
1156
1157	default:
1158	goto error;
1159	}
1160
1161	if (!ack) {
1162	ldebug ("read %#x -> %#x\n", nport, retval);
1163	}
1164
1165	#ifndef VBOX
1166	return retval;
1167	#else
1168	*pu32 = retval;
1169	return VINF_SUCCESS;
1170	#endif
1171
1172	error:
1173	dolog ("warning: dsp_read %#x error\n", nport);
1174	#ifndef VBOX
1175	return 0xff;
1176	#else
1177	return VERR_IOM_IOPORT_UNUSED;
1178	#endif
1179	}
1180
1181	static void reset_mixer (SB16State *s)
1182	{
1183	int i;
1184
1185	memset (s->mixer_regs, 0xff, 0x7f);
1186	memset (s->mixer_regs + 0x83, 0xff, sizeof (s->mixer_regs) - 0x83);
1187
1188	s->mixer_regs[0x02] = 4; /* master volume 3bits */
1189	s->mixer_regs[0x06] = 4; /* MIDI volume 3bits */
1190	s->mixer_regs[0x08] = 0; /* CD volume 3bits */
1191	s->mixer_regs[0x0a] = 0; /* voice volume 2bits */
1192
1193	/* d5=input filt, d3=lowpass filt, d1,d2=input source */
1194	s->mixer_regs[0x0c] = 0;
1195
1196	/* d5=output filt, d1=stereo switch */
1197	s->mixer_regs[0x0e] = 0;
1198
1199	/* voice volume L d5,d7, R d1,d3 */
1200	s->mixer_regs[0x04] = (4 << 5) \| (4 << 1);
1201	/* master ... */
1202	s->mixer_regs[0x22] = (4 << 5) \| (4 << 1);
1203	/* MIDI ... */
1204	s->mixer_regs[0x26] = (4 << 5) \| (4 << 1);
1205
1206	for (i = 0x30; i < 0x48; i++) {
1207	s->mixer_regs[i] = 0x20;
1208	}
1209	}
1210
1211	static IO_WRITE_PROTO(mixer_write_indexb)
1212	{
1213	SB16State s = (SB16State)opaque;
1214	(void) nport;
1215	s->mixer_nreg = val;
1216
1217	#ifdef VBOX
1218	return VINF_SUCCESS;
1219	#endif
1220	}
1221
1222	static IO_WRITE_PROTO(mixer_write_datab)
1223	{
1224	SB16State s = (SB16State)opaque;
1225
1226	(void) nport;
1227	ldebug ("mixer_write [%#x] <- %#x\n", s->mixer_nreg, val);
1228
1229	switch (s->mixer_nreg) {
1230	case 0x00:
1231	reset_mixer (s);
1232	break;
1233
1234	case 0x80:
1235	{
1236	int irq = irq_of_magic (val);
1237	ldebug ("setting irq to %d (val=%#x)\n", irq, val);
1238	if (irq > 0) {
1239	s->irq = irq;
1240	}
1241	}
1242	break;
1243
1244	case 0x81:
1245	{
1246	int dma, hdma;
1247
1248	dma = lsbindex (val & 0xf);
1249	hdma = lsbindex (val & 0xf0);
1250	if (dma != s->dma \|\| hdma != s->hdma) {
1251	dolog (
1252	"attempt to change DMA "
1253	"8bit %d(%d), 16bit %d(%d) (val=%#x)\n",
1254	dma, s->dma, hdma, s->hdma, val);
1255	}
1256	#if 0
1257	s->dma = dma;
1258	s->hdma = hdma;
1259	#endif
1260	}
1261	break;
1262
1263	case 0x82:
1264	dolog ("attempt to write into IRQ status register (val=%#x)\n",
1265	val);
1266	#ifdef VBOX
1267	return VINF_SUCCESS;
1268	#endif
1269
1270	default:
1271	if (s->mixer_nreg >= 0x80) {
1272	ldebug ("attempt to write mixer[%#x] <- %#x\n", s->mixer_nreg, val);
1273	}
1274	break;
1275	}
1276
1277	s->mixer_regs[s->mixer_nreg] = val;
1278
1279	#ifdef VBOX
1280	/* allow to set the PCM_out volume */
1281	if (s->mixer_nreg == 0x30 \|\| s->mixer_nreg == 0x31)
1282	{
1283	int mute = 0;
1284	uint8_t lvol = s->mixer_regs[0x30];
1285	uint8_t rvol = s->mixer_regs[0x31];
1286	AUD_set_volume (AUD_MIXER_VOLUME, &mute, &lvol, &rvol);
1287	}
1288	#endif /* VBOX */
1289
1290	#ifdef VBOX
1291	return VINF_SUCCESS;
1292	#endif
1293	}
1294
1295	static IO_WRITE_PROTO(mixer_write)
1296	{
1297	#ifndef VBOX
1298	mixer_write_indexb (opaque, nport, val & 0xff);
1299	mixer_write_datab (opaque, nport, (val >> 8) & 0xff);
1300	#else /* VBOX */
1301	SB16State s = (SB16State)opaque;
1302	int iport = nport - s->port;
1303	switch (cb)
1304	{
1305	case 1:
1306	switch (iport)
1307	{
1308	case 4:
1309	mixer_write_indexb (pDevIns, opaque, nport, val, 1);
1310	break;
1311	case 5:
1312	mixer_write_datab (pDevIns, opaque, nport, val, 1);
1313	break;
1314	}
1315	break;
1316	case 2:
1317	mixer_write_indexb (pDevIns, opaque, nport, val & 0xff, 1);
1318	mixer_write_datab (pDevIns, opaque, nport, (val >> 8) & 0xff, 1);
1319	break;
1320	default:
1321	AssertMsgFailed(("Port=%#x cb=%d u32=%#x\n", nport, cb, val));
1322	break;
1323	}
1324	return VINF_SUCCESS;
1325	#endif /* VBOX */
1326	}
1327
1328	static IO_READ_PROTO(mixer_read)
1329	{
1330	SB16State s = (SB16State)opaque;
1331
1332	(void) nport;
1333	#ifndef DEBUG_SB16_MOST
1334	if (s->mixer_nreg != 0x82) {
1335	ldebug ("mixer_read[%#x] -> %#x\n",
1336	s->mixer_nreg, s->mixer_regs[s->mixer_nreg]);
1337	}
1338	#else
1339	ldebug ("mixer_read[%#x] -> %#x\n",
1340	s->mixer_nreg, s->mixer_regs[s->mixer_nreg]);
1341	#endif
1342	#ifndef VBOX
1343	return s->mixer_regs[s->mixer_nreg];
1344	#else
1345	*pu32 = s->mixer_regs[s->mixer_nreg];
1346	return VINF_SUCCESS;
1347	#endif
1348	}
1349
1350	static int write_audio (SB16State *s, int nchan, int dma_pos,
1351	int dma_len, int len)
1352	{
1353	int temp, net;
1354	uint8_t tmpbuf[4096];
1355
1356	temp = len;
1357	net = 0;
1358
1359	while (temp) {
1360	int left = dma_len - dma_pos;
1361	#ifndef VBOX
1362	int copied;
1363	#else
1364	uint32_t copied;
1365	#endif
1366	size_t to_copy;
1367
1368	to_copy = audio_MIN (temp, left);
1369	if (to_copy > sizeof (tmpbuf)) {
1370	to_copy = sizeof (tmpbuf);
1371	}
1372
1373	#ifndef VBOX
1374	copied = DMA_read_memory (nchan, tmpbuf, dma_pos, to_copy);
1375	#else
1376	int rc = PDMDevHlpDMAReadMemory(s->pDevIns, nchan, tmpbuf, dma_pos,
1377	to_copy, &copied);
1378	AssertMsgRC (rc, ("DMAReadMemory -> %Rrc\n", rc));
1379	#endif
1380
1381	copied = AUD_write (s->voice, tmpbuf, copied);
1382
1383	temp -= copied;
1384	dma_pos = (dma_pos + copied) % dma_len;
1385	net += copied;
1386
1387	if (!copied) {
1388	break;
1389	}
1390	}
1391
1392	return net;
1393	}
1394
1395	#ifndef VBOX
1396	static int SB_read_DMA (void *opaque, int nchan, int dma_pos, int dma_len)
1397	#else
1398	static DECLCALLBACK(uint32_t) SB_read_DMA (PPDMDEVINS pDevIns, void *opaque, unsigned nchan, uint32_t dma_pos, uint32_t dma_len)
1399	#endif
1400	{
1401	SB16State s = (SB16State)opaque;
1402	int till, copy, written, free;
1403
1404	if (s->block_size <= 0) {
1405	dolog ("invalid block size=%d nchan=%d dma_pos=%d dma_len=%d\n",
1406	s->block_size, nchan, dma_pos, dma_len);
1407	return dma_pos;
1408	}
1409
1410	if (s->left_till_irq < 0) {
1411	s->left_till_irq = s->block_size;
1412	}
1413
1414	if (s->voice) {
1415	free = s->audio_free & ~s->align;
1416	if ((free <= 0) \|\| !dma_len) {
1417	return dma_pos;
1418	}
1419	}
1420	else {
1421	free = dma_len;
1422	}
1423
1424	copy = free;
1425	till = s->left_till_irq;
1426
1427	#ifdef DEBUG_SB16_MOST
1428	dolog ("pos:%06d %d till:%d len:%d\n",
1429	dma_pos, free, till, dma_len);
1430	#endif
1431
1432	if (till <= copy) {
1433	if (0 == s->dma_auto) {
1434	copy = till;
1435	}
1436	}
1437
1438	written = write_audio (s, nchan, dma_pos, dma_len, copy);
1439	dma_pos = (dma_pos + written) % dma_len;
1440	s->left_till_irq -= written;
1441
1442	if (s->left_till_irq <= 0) {
1443	s->mixer_regs[0x82] \|= (nchan & 4) ? 2 : 1;
1444	#ifndef VBOX
1445	qemu_irq_raise (s->pic[s->irq]);
1446	#else
1447	PDMDevHlpISASetIrq(s->pDevIns, s->irq, 1);
1448	#endif
1449	if (0 == s->dma_auto) {
1450	control (s, 0);
1451	speaker (s, 0);
1452	}
1453	}
1454
1455	#ifdef DEBUG_SB16_MOST
1456	ldebug ("pos %5d free %5d size %5d till % 5d copy %5d written %5d size %5d\n",
1457	dma_pos, free, dma_len, s->left_till_irq, copy, written,
1458	s->block_size);
1459	#endif
1460
1461	while (s->left_till_irq <= 0) {
1462	s->left_till_irq = s->block_size + s->left_till_irq;
1463	}
1464
1465	return dma_pos;
1466	}
1467
1468	static void SB_audio_callback (void *opaque, int free)
1469	{
1470	SB16State s = (SB16State)opaque;
1471	s->audio_free = free;
1472	#ifdef VBOX
1473	/* New space available, see if we can transfer more. There is no cyclic DMA timer in VBox. */
1474	PDMDevHlpDMASchedule (s->pDevIns);
1475	#endif
1476	}
1477
1478	#ifndef VBOX
1479	static void SB_save (QEMUFile f, void opaque)
1480	{
1481	SB16State *s = opaque;
1482	#else
1483	static DECLCALLBACK(int) SaveExec (PPDMDEVINS pDevIns, PSSMHANDLE pSSMHandle)
1484	{
1485	SB16State s = PDMINS_2_DATA (pDevIns, SB16State );
1486	QEMUFile *f = pSSMHandle;
1487	#endif
1488
1489	qemu_put_be32 (f, s->irq);
1490	qemu_put_be32 (f, s->dma);
1491	qemu_put_be32 (f, s->hdma);
1492	qemu_put_be32 (f, s->port);
1493	qemu_put_be32 (f, s->ver);
1494	qemu_put_be32 (f, s->in_index);
1495	qemu_put_be32 (f, s->out_data_len);
1496	qemu_put_be32 (f, s->fmt_stereo);
1497	qemu_put_be32 (f, s->fmt_signed);
1498	qemu_put_be32 (f, s->fmt_bits);
1499	qemu_put_be32s (f, &s->fmt);
1500	qemu_put_be32 (f, s->dma_auto);
1501	qemu_put_be32 (f, s->block_size);
1502	qemu_put_be32 (f, s->fifo);
1503	qemu_put_be32 (f, s->freq);
1504	qemu_put_be32 (f, s->time_const);
1505	qemu_put_be32 (f, s->speaker);
1506	qemu_put_be32 (f, s->needed_bytes);
1507	qemu_put_be32 (f, s->cmd);
1508	qemu_put_be32 (f, s->use_hdma);
1509	qemu_put_be32 (f, s->highspeed);
1510	qemu_put_be32 (f, s->can_write);
1511	qemu_put_be32 (f, s->v2x6);
1512
1513	qemu_put_8s (f, &s->csp_param);
1514	qemu_put_8s (f, &s->csp_value);
1515	qemu_put_8s (f, &s->csp_mode);
1516	qemu_put_8s (f, &s->csp_param);
1517	qemu_put_buffer (f, s->csp_regs, 256);
1518	qemu_put_8s (f, &s->csp_index);
1519	qemu_put_buffer (f, s->csp_reg83, 4);
1520	qemu_put_be32 (f, s->csp_reg83r);
1521	qemu_put_be32 (f, s->csp_reg83w);
1522
1523	qemu_put_buffer (f, s->in2_data, sizeof (s->in2_data));
1524	qemu_put_buffer (f, s->out_data, sizeof (s->out_data));
1525	qemu_put_8s (f, &s->test_reg);
1526	qemu_put_8s (f, &s->last_read_byte);
1527
1528	qemu_put_be32 (f, s->nzero);
1529	qemu_put_be32 (f, s->left_till_irq);
1530	qemu_put_be32 (f, s->dma_running);
1531	qemu_put_be32 (f, s->bytes_per_second);
1532	qemu_put_be32 (f, s->align);
1533
1534	qemu_put_be32 (f, s->mixer_nreg);
1535	qemu_put_buffer (f, s->mixer_regs, 256);
1536
1537	#ifdef VBOX
1538	return VINF_SUCCESS;
1539	#endif
1540	}
1541
1542	#ifndef VBOX
1543	static int SB_load (QEMUFile f, void opaque, int version_id)
1544	{
1545	SB16State *s = opaque;
1546
1547	if (version_id != 1) {
1548	return -EINVAL;
1549	}
1550	#else /* VBOX */
1551	static DECLCALLBACK(int) LoadExec (PPDMDEVINS pDevIns, PSSMHANDLE pSSMHandle,
1552	uint32_t u32Version)
1553	{
1554	SB16State s = PDMINS_2_DATA (pDevIns, SB16State );
1555	QEMUFile *f = pSSMHandle;
1556
1557	if (u32Version != SB16_SSM_VERSION)
1558	{
1559	AssertMsgFailed(("u32Version=%d\n", u32Version));
1560	return VERR_SSM_UNSUPPORTED_DATA_UNIT_VERSION;
1561	}
1562	#endif /* VBOX */
1563
1564	s->irq=qemu_get_be32 (f);
1565	s->dma=qemu_get_be32 (f);
1566	s->hdma=qemu_get_be32 (f);
1567	s->port=qemu_get_be32 (f);
1568	s->ver=qemu_get_be32 (f);
1569	s->in_index=qemu_get_be32 (f);
1570	s->out_data_len=qemu_get_be32 (f);
1571	s->fmt_stereo=qemu_get_be32 (f);
1572	s->fmt_signed=qemu_get_be32 (f);
1573	s->fmt_bits=qemu_get_be32 (f);
1574	qemu_get_be32s (f, (uint32_t*)&s->fmt);
1575	s->dma_auto=qemu_get_be32 (f);
1576	s->block_size=qemu_get_be32 (f);
1577	s->fifo=qemu_get_be32 (f);
1578	s->freq=qemu_get_be32 (f);
1579	s->time_const=qemu_get_be32 (f);
1580	s->speaker=qemu_get_be32 (f);
1581	s->needed_bytes=qemu_get_be32 (f);
1582	s->cmd=qemu_get_be32 (f);
1583	s->use_hdma=qemu_get_be32 (f);
1584	s->highspeed=qemu_get_be32 (f);
1585	s->can_write=qemu_get_be32 (f);
1586	s->v2x6=qemu_get_be32 (f);
1587
1588	qemu_get_8s (f, &s->csp_param);
1589	qemu_get_8s (f, &s->csp_value);
1590	qemu_get_8s (f, &s->csp_mode);
1591	qemu_get_8s (f, &s->csp_param);
1592	qemu_get_buffer (f, s->csp_regs, 256);
1593	qemu_get_8s (f, &s->csp_index);
1594	qemu_get_buffer (f, s->csp_reg83, 4);
1595	s->csp_reg83r=qemu_get_be32 (f);
1596	s->csp_reg83w=qemu_get_be32 (f);
1597
1598	qemu_get_buffer (f, s->in2_data, sizeof (s->in2_data));
1599	qemu_get_buffer (f, s->out_data, sizeof (s->out_data));
1600	qemu_get_8s (f, &s->test_reg);
1601	qemu_get_8s (f, &s->last_read_byte);
1602
1603	s->nzero=qemu_get_be32 (f);
1604	s->left_till_irq=qemu_get_be32 (f);
1605	s->dma_running=qemu_get_be32 (f);
1606	s->bytes_per_second=qemu_get_be32 (f);
1607	s->align=qemu_get_be32 (f);
1608
1609	s->mixer_nreg=qemu_get_be32 (f);
1610	qemu_get_buffer (f, s->mixer_regs, 256);
1611
1612	if (s->voice) {
1613	AUD_close_out (&s->card, s->voice);
1614	s->voice = NULL;
1615	}
1616
1617	if (s->dma_running) {
1618	if (s->freq) {
1619	audsettings_t as;
1620
1621	s->audio_free = 0;
1622
1623	as.freq = s->freq;
1624	as.nchannels = 1 << s->fmt_stereo;
1625	as.fmt = s->fmt;
1626	as.endianness = 0;
1627
1628	s->voice = AUD_open_out (
1629	&s->card,
1630	s->voice,
1631	"sb16",
1632	s,
1633	SB_audio_callback,
1634	&as
1635	);
1636	}
1637
1638	control (s, 1);
1639	speaker (s, s->speaker);
1640	}
1641
1642	#ifdef VBOX
1643	return VINF_SUCCESS;
1644	#endif
1645	}
1646
1647	#ifndef VBOX
1648	int SB16_init (AudioState audio, qemu_irq pic)
1649	{
1650	SB16State *s;
1651	int i;
1652	static const uint8_t dsp_write_ports[] = {0x6, 0xc};
1653	static const uint8_t dsp_read_ports[] = {0x6, 0xa, 0xc, 0xd, 0xe, 0xf};
1654
1655	if (!audio) {
1656	dolog ("No audio state\n");
1657	return -1;
1658	}
1659
1660	s = qemu_mallocz (sizeof (*s));
1661	if (!s) {
1662	dolog ("Could not allocate memory for SB16 (%zu bytes)\n",
1663	sizeof (*s));
1664	return -1;
1665	}
1666
1667	s->cmd = -1;
1668	s->pic = pic;
1669	s->irq = conf.irq;
1670	s->dma = conf.dma;
1671	s->hdma = conf.hdma;
1672	s->port = conf.port;
1673	s->ver = conf.ver_lo \| (conf.ver_hi << 8);
1674
1675	s->mixer_regs[0x80] = magic_of_irq (s->irq);
1676	s->mixer_regs[0x81] = (1 << s->dma) \| (1 << s->hdma);
1677	s->mixer_regs[0x82] = 2 << 5;
1678
1679	s->csp_regs[5] = 1;
1680	s->csp_regs[9] = 0xf8;
1681
1682	reset_mixer (s);
1683	s->aux_ts = qemu_new_timer (vm_clock, aux_timer, s);
1684	if (!s->aux_ts) {
1685	dolog ("warning: Could not create auxiliary timer\n");
1686	}
1687
1688	for (i = 0; i < LENOFA (dsp_write_ports); i++) {
1689	register_ioport_write (s->port + dsp_write_ports[i], 1, 1, dsp_write, s);
1690	}
1691
1692	for (i = 0; i < LENOFA (dsp_read_ports); i++) {
1693	register_ioport_read (s->port + dsp_read_ports[i], 1, 1, dsp_read, s);
1694	}
1695
1696	register_ioport_write (s->port + 0x4, 1, 1, mixer_write_indexb, s);
1697	register_ioport_write (s->port + 0x4, 1, 2, mixer_write_indexw, s);
1698	register_ioport_read (s->port + 0x5, 1, 1, mixer_read, s);
1699	register_ioport_write (s->port + 0x5, 1, 1, mixer_write_datab, s);
1700
1701	DMA_register_channel (s->hdma, SB_read_DMA, s);
1702	DMA_register_channel (s->dma, SB_read_DMA, s);
1703	s->can_write = 1;
1704
1705	register_savevm ("sb16", 0, 1, SB_save, SB_load, s);
1706	AUD_register_card (audio, "sb16", &s->card);
1707	return 0;
1708	}
1709
1710	#else /* VBOX */
1711
1712	static DECLCALLBACK(void ) sb16QueryInterface (struct PDMIBASE pInterface,
1713	PDMINTERFACE enmInterface)
1714	{
1715	SB16State pThis = (SB16State )((uintptr_t)pInterface
1716	- RT_OFFSETOF(SB16State, IBase));
1717	Assert(&pThis->IBase == pInterface);
1718	switch (enmInterface)
1719	{
1720	case PDMINTERFACE_BASE:
1721	return &pThis->IBase;
1722	default:
1723	return NULL;
1724	}
1725	}
1726
1727	static DECLCALLBACK(int) sb16Construct (PPDMDEVINS pDevIns, int iInstance, PCFGMNODE pCfgHandle)
1728	{
1729	SB16State s = PDMINS_2_DATA(pDevIns, SB16State );
1730	int rc;
1731
1732	/*
1733	* Validations.
1734	*/
1735	Assert(iInstance == 0);
1736	if (!CFGMR3AreValuesValid(pCfgHandle,
1737	"IRQ\0"
1738	"DMA\0"
1739	"DMA16\0"
1740	"Port\0"
1741	"Version\0"))
1742	return PDMDEV_SET_ERROR(pDevIns, VERR_PDM_DEVINS_UNKNOWN_CFG_VALUES,
1743	N_("Invalid configuraton for sb16 device"));
1744
1745	/*
1746	* Read config data.
1747	*/
1748	rc = CFGMR3QuerySIntDef(pCfgHandle, "IRQ", &s->irq, 5);
1749	if (RT_FAILURE(rc))
1750	return PDMDEV_SET_ERROR(pDevIns, rc,
1751	N_("Configuration error: Failed to get the \"IRQ\" value"));
1752
1753	rc = CFGMR3QuerySIntDef(pCfgHandle, "DMA", &s->dma, 1);
1754	if (RT_FAILURE(rc))
1755	return PDMDEV_SET_ERROR(pDevIns, rc,
1756	N_("Configuration error: Failed to get the \"DMA\" value"));
1757
1758	rc = CFGMR3QuerySIntDef(pCfgHandle, "DMA16", &s->hdma, 5);
1759	if (RT_FAILURE(rc))
1760	return PDMDEV_SET_ERROR(pDevIns, rc,
1761	N_("Configuration error: Failed to get the \"DMA16\" value"));
1762
1763	RTIOPORT Port;
1764	rc = CFGMR3QueryPortDef(pCfgHandle, "Port", &Port, 0x220);
1765	if (RT_FAILURE(rc))
1766	return PDMDEV_SET_ERROR(pDevIns, rc,
1767	N_("Configuration error: Failed to get the \"Port\" value"));
1768	s->port = Port;
1769
1770	uint16_t u16Version;
1771	rc = CFGMR3QueryU16Def(pCfgHandle, "Version", &u16Version, 0x0405);
1772	if (RT_FAILURE(rc))
1773	return PDMDEV_SET_ERROR(pDevIns, rc,
1774	N_("Configuration error: Failed to get the \"Version\" value"));
1775	s->ver = u16Version;
1776
1777	/*
1778	* Init instance data.
1779	*/
1780	s->pDevIns = pDevIns;
1781	s->IBase.pfnQueryInterface = sb16QueryInterface;
1782	s->cmd = -1;
1783
1784	s->mixer_regs[0x80] = magic_of_irq (s->irq);
1785	s->mixer_regs[0x81] = (1 << s->dma) \| (1 << s->hdma);
1786	s->mixer_regs[0x82] = 2 << 5;
1787
1788	s->csp_regs[5] = 1;
1789	s->csp_regs[9] = 0xf8;
1790
1791	reset_mixer(s);
1792
1793	/*
1794	* Create timer, register & attach stuff.
1795	*/
1796	rc = PDMDevHlpTMTimerCreate(pDevIns, TMCLOCK_VIRTUAL, sb16Timer, "SB16 timer", &s->pTimer);
1797	if (RT_FAILURE(rc))
1798	AssertMsgFailedReturn(("pfnTMTimerCreate -> %Rrc\n", rc), rc);
1799
1800	rc = PDMDevHlpIOPortRegister(pDevIns, s->port + 0x04, 2, s,
1801	mixer_write, mixer_read, NULL, NULL, "SB16");
1802	if (RT_FAILURE(rc))
1803	return rc;
1804	rc = PDMDevHlpIOPortRegister(pDevIns, s->port + 0x06, 10, s,
1805	dsp_write, dsp_read, NULL, NULL, "SB16");
1806	if (RT_FAILURE(rc))
1807	return rc;
1808
1809	rc = PDMDevHlpDMARegister(pDevIns, s->hdma, SB_read_DMA, s);
1810	if (RT_FAILURE(rc))
1811	return rc;
1812	rc = PDMDevHlpDMARegister(pDevIns, s->dma, SB_read_DMA, s);
1813	if (RT_FAILURE(rc))
1814	return rc;
1815
1816	s->can_write = 1;
1817
1818	rc = PDMDevHlpSSMRegister(pDevIns, pDevIns->pDevReg->szDeviceName, iInstance, SB16_SSM_VERSION,
1819	sizeof(*s), NULL, SaveExec, NULL, NULL, LoadExec, NULL);
1820	if (RT_FAILURE(rc))
1821	return rc;
1822
1823	rc = PDMDevHlpDriverAttach(pDevIns, 0, &s->IBase, &s->pDrvBase, "Audio Driver Port");
1824	if (rc == VERR_PDM_NO_ATTACHED_DRIVER)
1825	Log(("sb16: No attached driver!\n"));
1826	else if (RT_FAILURE(rc))
1827	AssertMsgFailedReturn(("Failed to attach SB16 LUN #0! rc=%Rrc\n", rc), rc);
1828
1829	AUD_register_card("sb16", &s->card);
1830	legacy_reset(s);
1831
1832	if (!s->voice)
1833	{
1834	AUD_close_out(&s->card, s->voice);
1835	s->voice = NULL;
1836	AUD_init_null();
1837	PDMDevHlpVMSetRuntimeError(pDevIns, false, "HostAudioNotResponding",
1838	N_("No audio devices could be opened. Selecting the NULL audio backend "
1839	"with the consequence that no sound is audible"));
1840	}
1841	return VINF_SUCCESS;
1842	}
1843
1844	const PDMDEVREG g_DeviceSB16 =
1845	{
1846	/* u32Version */
1847	PDM_DEVREG_VERSION,
1848	/* szDeviceName */
1849	"sb16",
1850	/* szRCMod */
1851	"",
1852	/* szR0Mod */
1853	"",
1854	/* pszDescription */
1855	"Sound Blaster 16 Controller",
1856	/* fFlags */
1857	PDM_DEVREG_FLAGS_DEFAULT_BITS,
1858	/* fClass */
1859	PDM_DEVREG_CLASS_AUDIO,
1860	/* cMaxInstances */
1861	1,
1862	/* cbInstance */
1863	sizeof(SB16State),
1864	/* pfnConstruct */
1865	sb16Construct,
1866	/* pfnDesctruct */
1867	NULL,
1868	/* pfnRelocate */
1869	NULL,
1870	/* pfnIOCtl */
1871	NULL,
1872	/* pfnPowerOn */
1873	NULL,
1874	/* pfnReset */
1875	NULL,
1876	/* pfnSuspend */
1877	NULL,
1878	/* pfnResume */
1879	NULL,
1880	/* pfnAttach */
1881	NULL,
1882	/* pfnDetach */
1883	NULL,
1884	/* pfnQueryInterface */
1885	NULL,
1886	/* pfnInitComplete */
1887	NULL,
1888	/* pfnPowerOff */
1889	NULL,
1890	/* pfnSoftReset */
1891	NULL,
1892	/* u32VersionEnd */
1893	PDM_DEVREG_VERSION
1894	};
1895
1896	#endif /* VBOX */
1897

注意: 瀏覽 TracBrowser 來幫助您使用儲存庫瀏覽器

source: vbox/trunk/src/VBox/Devices/Audio/DevSB16.cpp@ 13416

以其他格式下載: