sb16.c revision 129181
1/*
2 * Copyright (c) 1999 Cameron Grant <cg@freebsd.org>
3 * Copyright 1997,1998 Luigi Rizzo.
4 *
5 * Derived from files in the Voxware 3.5 distribution,
6 * Copyright by Hannu Savolainen 1994, under the same copyright
7 * conditions.
8 * All rights reserved.
9 *
10 * Redistribution and use in source and binary forms, with or without
11 * modification, are permitted provided that the following conditions
12 * are met:
13 * 1. Redistributions of source code must retain the above copyright
14 *    notice, this list of conditions and the following disclaimer.
15 * 2. Redistributions in binary form must reproduce the above copyright
16 *    notice, this list of conditions and the following disclaimer in the
17 *    documentation and/or other materials provided with the distribution.
18 *
19 * THIS SOFTWARE IS PROVIDED BY THE AUTHOR AND CONTRIBUTORS ``AS IS'' AND
20 * ANY EXPRESS OR IMPLIED WARRANTIES, INCLUDING, BUT NOT LIMITED TO, THE
21 * IMPLIED WARRANTIES OF MERCHANTABILITY AND FITNESS FOR A PARTICULAR PURPOSE
22 * ARE DISCLAIMED.  IN NO EVENT SHALL THE AUTHOR OR CONTRIBUTORS BE LIABLE
23 * FOR ANY DIRECT, INDIRECT, INCIDENTAL, SPECIAL, EXEMPLARY, OR CONSEQUENTIAL
24 * DAMAGES (INCLUDING, BUT NOT LIMITED TO, PROCUREMENT OF SUBSTITUTE GOODS
25 * OR SERVICES; LOSS OF USE, DATA, OR PROFITS; OR BUSINESS INTERRUPTION)
26 * HOWEVER CAUSED AND ON ANY THEORY OF LIABILITY, WHETHER IN CONTRACT, STRICT
27 * LIABILITY, OR TORT (INCLUDING NEGLIGENCE OR OTHERWISE) ARISING IN ANY WAY
28 * OUT OF THE USE OF THIS SOFTWARE, EVEN IF ADVISED OF THE POSSIBILITY OF
29 * SUCH DAMAGE.
30 */
31
32#include <dev/sound/pcm/sound.h>
33
34#include  <dev/sound/isa/sb.h>
35#include  <dev/sound/chip.h>
36
37#include <isa/isavar.h>
38
39#include "mixer_if.h"
40
41SND_DECLARE_FILE("$FreeBSD: head/sys/dev/sound/isa/sb16.c 129181 2004-05-13 11:33:44Z truckman $");
42
43#define SB16_BUFFSIZE	4096
44#define PLAIN_SB16(x) ((((x)->bd_flags) & (BD_F_SB16|BD_F_SB16X)) == BD_F_SB16)
45
46static u_int32_t sb16_fmt8[] = {
47	AFMT_U8,
48	AFMT_STEREO | AFMT_U8,
49	0
50};
51static struct pcmchan_caps sb16_caps8 = {5000, 45000, sb16_fmt8, 0};
52
53static u_int32_t sb16_fmt16[] = {
54	AFMT_S16_LE,
55	AFMT_STEREO | AFMT_S16_LE,
56	0
57};
58static struct pcmchan_caps sb16_caps16 = {5000, 45000, sb16_fmt16, 0};
59
60static u_int32_t sb16x_fmt[] = {
61	AFMT_U8,
62	AFMT_STEREO | AFMT_U8,
63	AFMT_S16_LE,
64	AFMT_STEREO | AFMT_S16_LE,
65	0
66};
67static struct pcmchan_caps sb16x_caps = {5000, 49000, sb16x_fmt, 0};
68
69struct sb_info;
70
71struct sb_chinfo {
72	struct sb_info *parent;
73	struct pcm_channel *channel;
74	struct snd_dbuf *buffer;
75	int dir, run, dch;
76	u_int32_t fmt, spd, blksz;
77};
78
79struct sb_info {
80    	struct resource *io_base;	/* I/O address for the board */
81    	struct resource *irq;
82   	struct resource *drq1;
83    	struct resource *drq2;
84    	void *ih;
85    	bus_dma_tag_t parent_dmat;
86
87	unsigned int bufsize;
88    	int bd_id;
89    	u_long bd_flags;       /* board-specific flags */
90	int prio, prio16;
91    	struct sb_chinfo pch, rch;
92	device_t parent_dev;
93};
94
95#if 0
96static void sb_lock(struct sb_info *sb);
97static void sb_unlock(struct sb_info *sb);
98static int sb_rd(struct sb_info *sb, int reg);
99static void sb_wr(struct sb_info *sb, int reg, u_int8_t val);
100static int sb_cmd(struct sb_info *sb, u_char val);
101/* static int sb_cmd1(struct sb_info *sb, u_char cmd, int val); */
102static int sb_cmd2(struct sb_info *sb, u_char cmd, int val);
103static u_int sb_get_byte(struct sb_info *sb);
104static void sb_setmixer(struct sb_info *sb, u_int port, u_int value);
105static int sb_getmixer(struct sb_info *sb, u_int port);
106static int sb_reset_dsp(struct sb_info *sb);
107
108static void sb_intr(void *arg);
109#endif
110
111/*
112 * Common code for the midi and pcm functions
113 *
114 * sb_cmd write a single byte to the CMD port.
115 * sb_cmd1 write a CMD + 1 byte arg
116 * sb_cmd2 write a CMD + 2 byte arg
117 * sb_get_byte returns a single byte from the DSP data port
118 */
119
120static void
121sb_lock(struct sb_info *sb) {
122
123	sbc_lock(device_get_softc(sb->parent_dev));
124}
125
126static void
127sb_lockassert(struct sb_info *sb) {
128
129	sbc_lockassert(device_get_softc(sb->parent_dev));
130}
131
132static void
133sb_unlock(struct sb_info *sb) {
134
135	sbc_unlock(device_get_softc(sb->parent_dev));
136}
137
138static int
139port_rd(struct resource *port, int off)
140{
141	return bus_space_read_1(rman_get_bustag(port), rman_get_bushandle(port), off);
142}
143
144static void
145port_wr(struct resource *port, int off, u_int8_t data)
146{
147	bus_space_write_1(rman_get_bustag(port), rman_get_bushandle(port), off, data);
148}
149
150static int
151sb_rd(struct sb_info *sb, int reg)
152{
153	return port_rd(sb->io_base, reg);
154}
155
156static void
157sb_wr(struct sb_info *sb, int reg, u_int8_t val)
158{
159	port_wr(sb->io_base, reg, val);
160}
161
162static int
163sb_dspwr(struct sb_info *sb, u_char val)
164{
165    	int  i;
166
167    	for (i = 0; i < 1000; i++) {
168		if ((sb_rd(sb, SBDSP_STATUS) & 0x80))
169	    		DELAY((i > 100)? 1000 : 10);
170	    	else {
171			sb_wr(sb, SBDSP_CMD, val);
172			return 1;
173		}
174    	}
175#if __FreeBSD_version > 500000
176	if (curthread->td_intr_nesting_level == 0)
177		printf("sb_dspwr(0x%02x) timed out.\n", val);
178#endif
179    	return 0;
180}
181
182static int
183sb_cmd(struct sb_info *sb, u_char val)
184{
185#if 0
186	printf("sb_cmd: %x\n", val);
187#endif
188    	return sb_dspwr(sb, val);
189}
190
191/*
192static int
193sb_cmd1(struct sb_info *sb, u_char cmd, int val)
194{
195#if 0
196    	printf("sb_cmd1: %x, %x\n", cmd, val);
197#endif
198    	if (sb_dspwr(sb, cmd)) {
199		return sb_dspwr(sb, val & 0xff);
200    	} else return 0;
201}
202*/
203
204static int
205sb_cmd2(struct sb_info *sb, u_char cmd, int val)
206{
207	int r;
208
209#if 0
210    	printf("sb_cmd2: %x, %x\n", cmd, val);
211#endif
212	sb_lock(sb);
213	r = 0;
214    	if (sb_dspwr(sb, cmd)) {
215		if (sb_dspwr(sb, val & 0xff)) {
216			if (sb_dspwr(sb, (val >> 8) & 0xff)) {
217				r = 1;
218			}
219		}
220    	}
221	sb_unlock(sb);
222
223	return r;
224}
225
226/*
227 * in the SB, there is a set of indirect "mixer" registers with
228 * address at offset 4, data at offset 5
229 */
230static void
231sb_setmixer(struct sb_info *sb, u_int port, u_int value)
232{
233	sb_lock(sb);
234    	sb_wr(sb, SB_MIX_ADDR, (u_char) (port & 0xff)); /* Select register */
235    	DELAY(10);
236    	sb_wr(sb, SB_MIX_DATA, (u_char) (value & 0xff));
237    	DELAY(10);
238	sb_unlock(sb);
239}
240
241static int
242sb_getmixer(struct sb_info *sb, u_int port)
243{
244    	int val;
245
246	sb_lock(sb);
247    	sb_wr(sb, SB_MIX_ADDR, (u_char) (port & 0xff)); /* Select register */
248    	DELAY(10);
249    	val = sb_rd(sb, SB_MIX_DATA);
250    	DELAY(10);
251	sb_unlock(sb);
252
253    	return val;
254}
255
256static u_int
257sb_get_byte(struct sb_info *sb)
258{
259    	int i;
260
261    	for (i = 1000; i > 0; i--) {
262		if (sb_rd(sb, DSP_DATA_AVAIL) & 0x80)
263			return sb_rd(sb, DSP_READ);
264		else
265			DELAY(20);
266    	}
267    	return 0xffff;
268}
269
270static int
271sb_reset_dsp(struct sb_info *sb)
272{
273	u_char b;
274
275	sb_lockassert(sb);
276    	sb_wr(sb, SBDSP_RST, 3);
277    	DELAY(100);
278    	sb_wr(sb, SBDSP_RST, 0);
279	b = sb_get_byte(sb);
280    	if (b != 0xAA) {
281        	DEB(printf("sb_reset_dsp 0x%lx failed\n",
282			   rman_get_start(sb->io_base)));
283		return ENXIO;	/* Sorry */
284    	}
285    	return 0;
286}
287
288/************************************************************/
289
290struct sb16_mixent {
291	int reg;
292	int bits;
293	int ofs;
294	int stereo;
295};
296
297static const struct sb16_mixent sb16_mixtab[32] = {
298    	[SOUND_MIXER_VOLUME]	= { 0x30, 5, 3, 1 },
299    	[SOUND_MIXER_PCM]	= { 0x32, 5, 3, 1 },
300    	[SOUND_MIXER_SYNTH]	= { 0x34, 5, 3, 1 },
301    	[SOUND_MIXER_CD]	= { 0x36, 5, 3, 1 },
302    	[SOUND_MIXER_LINE]	= { 0x38, 5, 3, 1 },
303    	[SOUND_MIXER_MIC]	= { 0x3a, 5, 3, 0 },
304       	[SOUND_MIXER_SPEAKER]	= { 0x3b, 5, 3, 0 },
305    	[SOUND_MIXER_IGAIN]	= { 0x3f, 2, 6, 1 },
306    	[SOUND_MIXER_OGAIN]	= { 0x41, 2, 6, 1 },
307	[SOUND_MIXER_TREBLE]	= { 0x44, 4, 4, 1 },
308    	[SOUND_MIXER_BASS]	= { 0x46, 4, 4, 1 },
309	[SOUND_MIXER_LINE1]	= { 0x52, 5, 3, 1 }
310};
311
312static int
313sb16mix_init(struct snd_mixer *m)
314{
315    	struct sb_info *sb = mix_getdevinfo(m);
316
317	mix_setdevs(m, SOUND_MASK_SYNTH | SOUND_MASK_PCM | SOUND_MASK_SPEAKER |
318     		       SOUND_MASK_LINE | SOUND_MASK_MIC | SOUND_MASK_CD |
319     		       SOUND_MASK_IGAIN | SOUND_MASK_OGAIN | SOUND_MASK_LINE1 |
320     		       SOUND_MASK_VOLUME | SOUND_MASK_BASS | SOUND_MASK_TREBLE);
321
322	mix_setrecdevs(m, SOUND_MASK_SYNTH | SOUND_MASK_LINE |
323			  SOUND_MASK_LINE1 | SOUND_MASK_MIC | SOUND_MASK_CD);
324
325	sb_setmixer(sb, 0x3c, 0x1f); /* make all output active */
326
327	sb_setmixer(sb, 0x3d, 0); /* make all inputs-l off */
328	sb_setmixer(sb, 0x3e, 0); /* make all inputs-r off */
329
330	return 0;
331}
332
333static int
334sb16mix_set(struct snd_mixer *m, unsigned dev, unsigned left, unsigned right)
335{
336    	struct sb_info *sb = mix_getdevinfo(m);
337    	const struct sb16_mixent *e;
338    	int max;
339
340	e = &sb16_mixtab[dev];
341	max = (1 << e->bits) - 1;
342
343	left = (left * max) / 100;
344	right = (right * max) / 100;
345
346	sb_setmixer(sb, e->reg, left << e->ofs);
347	if (e->stereo)
348		sb_setmixer(sb, e->reg + 1, right << e->ofs);
349	else
350		right = left;
351
352	left = (left * 100) / max;
353	right = (right * 100) / max;
354
355    	return left | (right << 8);
356}
357
358static int
359sb16mix_setrecsrc(struct snd_mixer *m, u_int32_t src)
360{
361    	struct sb_info *sb = mix_getdevinfo(m);
362    	u_char recdev;
363
364	recdev = 0;
365	if (src & SOUND_MASK_MIC)
366		recdev |= 0x01; /* mono mic */
367
368	if (src & SOUND_MASK_CD)
369		recdev |= 0x06; /* l+r cd */
370
371	if (src & SOUND_MASK_LINE)
372		recdev |= 0x18; /* l+r line */
373
374	if (src & SOUND_MASK_SYNTH)
375		recdev |= 0x60; /* l+r midi */
376
377	sb_setmixer(sb, SB16_IMASK_L, recdev);
378	sb_setmixer(sb, SB16_IMASK_R, recdev);
379
380	/* Switch on/off FM tuner source */
381	if (src & SOUND_MASK_LINE1)
382		sb_setmixer(sb, 0x4a, 0x0c);
383	else
384		sb_setmixer(sb, 0x4a, 0x00);
385
386	/*
387	 * since the same volume controls apply to the input and
388	 * output sections, the best approach to have a consistent
389	 * behaviour among cards would be to disable the output path
390	 * on devices which are used to record.
391	 * However, since users like to have feedback, we only disable
392	 * the mic -- permanently.
393	 */
394        sb_setmixer(sb, SB16_OMASK, 0x1f & ~1);
395
396	return src;
397}
398
399static kobj_method_t sb16mix_mixer_methods[] = {
400    	KOBJMETHOD(mixer_init,		sb16mix_init),
401    	KOBJMETHOD(mixer_set,		sb16mix_set),
402    	KOBJMETHOD(mixer_setrecsrc,	sb16mix_setrecsrc),
403	{ 0, 0 }
404};
405MIXER_DECLARE(sb16mix_mixer);
406
407/************************************************************/
408
409static void
410sb16_release_resources(struct sb_info *sb, device_t dev)
411{
412    	if (sb->irq) {
413    		if (sb->ih)
414			bus_teardown_intr(dev, sb->irq, sb->ih);
415 		bus_release_resource(dev, SYS_RES_IRQ, 0, sb->irq);
416		sb->irq = 0;
417    	}
418    	if (sb->drq2) {
419		if (sb->drq2 != sb->drq1) {
420			isa_dma_release(rman_get_start(sb->drq2));
421			bus_release_resource(dev, SYS_RES_DRQ, 1, sb->drq2);
422		}
423		sb->drq2 = 0;
424    	}
425     	if (sb->drq1) {
426		isa_dma_release(rman_get_start(sb->drq1));
427		bus_release_resource(dev, SYS_RES_DRQ, 0, sb->drq1);
428		sb->drq1 = 0;
429    	}
430   	if (sb->io_base) {
431		bus_release_resource(dev, SYS_RES_IOPORT, 0, sb->io_base);
432		sb->io_base = 0;
433    	}
434    	if (sb->parent_dmat) {
435		bus_dma_tag_destroy(sb->parent_dmat);
436		sb->parent_dmat = 0;
437    	}
438     	free(sb, M_DEVBUF);
439}
440
441static int
442sb16_alloc_resources(struct sb_info *sb, device_t dev)
443{
444	int rid;
445
446	rid = 0;
447	if (!sb->io_base)
448    		sb->io_base = bus_alloc_resource_any(dev, SYS_RES_IOPORT,
449			&rid, RF_ACTIVE);
450
451	rid = 0;
452	if (!sb->irq)
453    		sb->irq = bus_alloc_resource_any(dev, SYS_RES_IRQ, &rid,
454			RF_ACTIVE);
455
456	rid = 0;
457	if (!sb->drq1)
458    		sb->drq1 = bus_alloc_resource_any(dev, SYS_RES_DRQ, &rid,
459			RF_ACTIVE);
460
461	rid = 1;
462	if (!sb->drq2)
463        	sb->drq2 = bus_alloc_resource_any(dev, SYS_RES_DRQ, &rid,
464			RF_ACTIVE);
465
466    	if (sb->io_base && sb->drq1 && sb->irq) {
467		isa_dma_acquire(rman_get_start(sb->drq1));
468		isa_dmainit(rman_get_start(sb->drq1), sb->bufsize);
469
470		if (sb->drq2) {
471			isa_dma_acquire(rman_get_start(sb->drq2));
472			isa_dmainit(rman_get_start(sb->drq2), sb->bufsize);
473		} else {
474			sb->drq2 = sb->drq1;
475			pcm_setflags(dev, pcm_getflags(dev) | SD_F_SIMPLEX);
476		}
477		return 0;
478	} else return ENXIO;
479}
480
481/* sbc does locking for us */
482static void
483sb_intr(void *arg)
484{
485    	struct sb_info *sb = (struct sb_info *)arg;
486    	int reason = 3, c;
487
488    	/*
489     	 * The Vibra16X has separate flags for 8 and 16 bit transfers, but
490     	 * I have no idea how to tell capture from playback interrupts...
491     	 */
492
493	reason = 0;
494	sb_lock(sb);
495    	c = sb_getmixer(sb, IRQ_STAT);
496    	if (c & 1)
497		sb_rd(sb, DSP_DATA_AVAIL); /* 8-bit int ack */
498
499    	if (c & 2)
500		sb_rd(sb, DSP_DATA_AVL16); /* 16-bit int ack */
501	sb_unlock(sb);
502
503	/*
504	 * this tells us if the source is 8-bit or 16-bit dma. We
505     	 * have to check the io channel to map it to read or write...
506     	 */
507
508	if (sb->bd_flags & BD_F_SB16X) {
509    		if (c & 1) { /* 8-bit format */
510			if (sb->pch.fmt & AFMT_8BIT)
511				reason |= 1;
512			if (sb->rch.fmt & AFMT_8BIT)
513				reason |= 2;
514    		}
515    		if (c & 2) { /* 16-bit format */
516			if (sb->pch.fmt & AFMT_16BIT)
517				reason |= 1;
518			if (sb->rch.fmt & AFMT_16BIT)
519				reason |= 2;
520    		}
521	} else {
522    		if (c & 1) { /* 8-bit dma */
523			if (sb->pch.dch == 1)
524				reason |= 1;
525			if (sb->rch.dch == 1)
526				reason |= 2;
527    		}
528    		if (c & 2) { /* 16-bit dma */
529			if (sb->pch.dch == 2)
530				reason |= 1;
531			if (sb->rch.dch == 2)
532				reason |= 2;
533    		}
534	}
535#if 0
536    	printf("sb_intr: reason=%d c=0x%x\n", reason, c);
537#endif
538    	if ((reason & 1) && (sb->pch.run))
539		chn_intr(sb->pch.channel);
540
541    	if ((reason & 2) && (sb->rch.run))
542		chn_intr(sb->rch.channel);
543}
544
545static int
546sb_setup(struct sb_info *sb)
547{
548	struct sb_chinfo *ch;
549	u_int8_t v;
550	int l, pprio;
551
552	sb_lock(sb);
553	if (sb->bd_flags & BD_F_DMARUN)
554		sndbuf_dma(sb->pch.buffer, PCMTRIG_STOP);
555	if (sb->bd_flags & BD_F_DMARUN2)
556		sndbuf_dma(sb->rch.buffer, PCMTRIG_STOP);
557	sb->bd_flags &= ~(BD_F_DMARUN | BD_F_DMARUN2);
558
559	sb_reset_dsp(sb);
560
561	if (sb->bd_flags & BD_F_SB16X) {
562		pprio = sb->pch.run? 1 : 0;
563		sndbuf_dmasetup(sb->pch.buffer, pprio? sb->drq1 : NULL);
564		sb->pch.dch = pprio? 1 : 0;
565		sndbuf_dmasetup(sb->rch.buffer, pprio? sb->drq2 : sb->drq1);
566		sb->rch.dch = pprio? 2 : 1;
567	} else {
568		if (sb->pch.run && sb->rch.run) {
569			pprio = (sb->rch.fmt & AFMT_16BIT)? 0 : 1;
570			sndbuf_dmasetup(sb->pch.buffer, pprio? sb->drq2 : sb->drq1);
571			sb->pch.dch = pprio? 2 : 1;
572			sndbuf_dmasetup(sb->rch.buffer, pprio? sb->drq1 : sb->drq2);
573			sb->rch.dch = pprio? 1 : 2;
574		} else {
575			if (sb->pch.run) {
576				sndbuf_dmasetup(sb->pch.buffer, (sb->pch.fmt & AFMT_16BIT)? sb->drq2 : sb->drq1);
577				sb->pch.dch = (sb->pch.fmt & AFMT_16BIT)? 2 : 1;
578				sndbuf_dmasetup(sb->rch.buffer, (sb->pch.fmt & AFMT_16BIT)? sb->drq1 : sb->drq2);
579				sb->rch.dch = (sb->pch.fmt & AFMT_16BIT)? 1 : 2;
580			} else if (sb->rch.run) {
581				sndbuf_dmasetup(sb->pch.buffer, (sb->rch.fmt & AFMT_16BIT)? sb->drq1 : sb->drq2);
582				sb->pch.dch = (sb->rch.fmt & AFMT_16BIT)? 1 : 2;
583				sndbuf_dmasetup(sb->rch.buffer, (sb->rch.fmt & AFMT_16BIT)? sb->drq2 : sb->drq1);
584				sb->rch.dch = (sb->rch.fmt & AFMT_16BIT)? 2 : 1;
585			}
586		}
587	}
588
589	sndbuf_dmasetdir(sb->pch.buffer, PCMDIR_PLAY);
590	sndbuf_dmasetdir(sb->rch.buffer, PCMDIR_REC);
591
592	/*
593	printf("setup: [pch = %d, pfmt = %d, pgo = %d] [rch = %d, rfmt = %d, rgo = %d]\n",
594	       sb->pch.dch, sb->pch.fmt, sb->pch.run, sb->rch.dch, sb->rch.fmt, sb->rch.run);
595	*/
596
597	ch = &sb->pch;
598	if (ch->run) {
599		l = ch->blksz;
600		if (ch->fmt & AFMT_16BIT)
601			l >>= 1;
602		l--;
603
604		/* play speed */
605		RANGE(ch->spd, 5000, 45000);
606		sb_cmd(sb, DSP_CMD_OUT16);
607    		sb_cmd(sb, ch->spd >> 8);
608		sb_cmd(sb, ch->spd & 0xff);
609
610		/* play format, length */
611		v = DSP_F16_AUTO | DSP_F16_FIFO_ON | DSP_F16_DAC;
612		v |= (ch->fmt & AFMT_16BIT)? DSP_DMA16 : DSP_DMA8;
613		sb_cmd(sb, v);
614
615		v = (ch->fmt & AFMT_STEREO)? DSP_F16_STEREO : 0;
616		v |= (ch->fmt & AFMT_SIGNED)? DSP_F16_SIGNED : 0;
617		sb_cmd2(sb, v, l);
618		sndbuf_dma(ch->buffer, PCMTRIG_START);
619		sb->bd_flags |= BD_F_DMARUN;
620	}
621
622	ch = &sb->rch;
623	if (ch->run) {
624		l = ch->blksz;
625		if (ch->fmt & AFMT_16BIT)
626			l >>= 1;
627		l--;
628
629		/* record speed */
630		RANGE(ch->spd, 5000, 45000);
631		sb_cmd(sb, DSP_CMD_IN16);
632    		sb_cmd(sb, ch->spd >> 8);
633		sb_cmd(sb, ch->spd & 0xff);
634
635		/* record format, length */
636		v = DSP_F16_AUTO | DSP_F16_FIFO_ON | DSP_F16_ADC;
637		v |= (ch->fmt & AFMT_16BIT)? DSP_DMA16 : DSP_DMA8;
638		sb_cmd(sb, v);
639
640		v = (ch->fmt & AFMT_STEREO)? DSP_F16_STEREO : 0;
641		v |= (ch->fmt & AFMT_SIGNED)? DSP_F16_SIGNED : 0;
642		sb_cmd2(sb, v, l);
643		sndbuf_dma(ch->buffer, PCMTRIG_START);
644		sb->bd_flags |= BD_F_DMARUN2;
645	}
646	sb_unlock(sb);
647
648    	return 0;
649}
650
651/* channel interface */
652static void *
653sb16chan_init(kobj_t obj, void *devinfo, struct snd_dbuf *b, struct pcm_channel *c, int dir)
654{
655	struct sb_info *sb = devinfo;
656	struct sb_chinfo *ch = (dir == PCMDIR_PLAY)? &sb->pch : &sb->rch;
657
658	ch->parent = sb;
659	ch->channel = c;
660	ch->buffer = b;
661	ch->dir = dir;
662
663	if (sndbuf_alloc(ch->buffer, sb->parent_dmat, sb->bufsize) == -1)
664		return NULL;
665
666	return ch;
667}
668
669static int
670sb16chan_setformat(kobj_t obj, void *data, u_int32_t format)
671{
672	struct sb_chinfo *ch = data;
673	struct sb_info *sb = ch->parent;
674
675	ch->fmt = format;
676	sb->prio = ch->dir;
677	sb->prio16 = (ch->fmt & AFMT_16BIT)? 1 : 0;
678
679	return 0;
680}
681
682static int
683sb16chan_setspeed(kobj_t obj, void *data, u_int32_t speed)
684{
685	struct sb_chinfo *ch = data;
686
687	ch->spd = speed;
688	return speed;
689}
690
691static int
692sb16chan_setblocksize(kobj_t obj, void *data, u_int32_t blocksize)
693{
694	struct sb_chinfo *ch = data;
695
696	ch->blksz = blocksize;
697	return ch->blksz;
698}
699
700static int
701sb16chan_trigger(kobj_t obj, void *data, int go)
702{
703	struct sb_chinfo *ch = data;
704	struct sb_info *sb = ch->parent;
705
706	if (go == PCMTRIG_EMLDMAWR || go == PCMTRIG_EMLDMARD)
707		return 0;
708
709	if (go == PCMTRIG_START)
710		ch->run = 1;
711	else
712		ch->run = 0;
713
714	sb_setup(sb);
715
716	return 0;
717}
718
719static int
720sb16chan_getptr(kobj_t obj, void *data)
721{
722	struct sb_chinfo *ch = data;
723
724	return sndbuf_dmaptr(ch->buffer);
725}
726
727static struct pcmchan_caps *
728sb16chan_getcaps(kobj_t obj, void *data)
729{
730	struct sb_chinfo *ch = data;
731	struct sb_info *sb = ch->parent;
732
733	if ((sb->prio == 0) || (sb->prio == ch->dir))
734		return &sb16x_caps;
735	else
736		return sb->prio16? &sb16_caps8 : &sb16_caps16;
737}
738
739static int
740sb16chan_resetdone(kobj_t obj, void *data)
741{
742	struct sb_chinfo *ch = data;
743	struct sb_info *sb = ch->parent;
744
745	sb->prio = 0;
746
747	return 0;
748}
749
750static kobj_method_t sb16chan_methods[] = {
751    	KOBJMETHOD(channel_init,		sb16chan_init),
752    	KOBJMETHOD(channel_resetdone,		sb16chan_resetdone),
753    	KOBJMETHOD(channel_setformat,		sb16chan_setformat),
754    	KOBJMETHOD(channel_setspeed,		sb16chan_setspeed),
755    	KOBJMETHOD(channel_setblocksize,	sb16chan_setblocksize),
756    	KOBJMETHOD(channel_trigger,		sb16chan_trigger),
757    	KOBJMETHOD(channel_getptr,		sb16chan_getptr),
758    	KOBJMETHOD(channel_getcaps,		sb16chan_getcaps),
759	{ 0, 0 }
760};
761CHANNEL_DECLARE(sb16chan);
762
763/************************************************************/
764
765static int
766sb16_probe(device_t dev)
767{
768    	char buf[64];
769	uintptr_t func, ver, r, f;
770
771	/* The parent device has already been probed. */
772	r = BUS_READ_IVAR(device_get_parent(dev), dev, 0, &func);
773	if (func != SCF_PCM)
774		return (ENXIO);
775
776	r = BUS_READ_IVAR(device_get_parent(dev), dev, 1, &ver);
777	f = (ver & 0xffff0000) >> 16;
778	ver &= 0x0000ffff;
779	if (f & BD_F_SB16) {
780		snprintf(buf, sizeof buf, "SB16 DSP %d.%02d%s", (int) ver >> 8, (int) ver & 0xff,
781			 (f & BD_F_SB16X)? " (ViBRA16X)" : "");
782    		device_set_desc_copy(dev, buf);
783		return 0;
784	} else
785		return (ENXIO);
786}
787
788static int
789sb16_attach(device_t dev)
790{
791    	struct sb_info *sb;
792	uintptr_t ver;
793    	char status[SND_STATUSLEN], status2[SND_STATUSLEN];
794
795    	sb = (struct sb_info *)malloc(sizeof *sb, M_DEVBUF, M_NOWAIT | M_ZERO);
796    	if (!sb)
797		return ENXIO;
798
799	sb->parent_dev = device_get_parent(dev);
800	BUS_READ_IVAR(sb->parent_dev, dev, 1, &ver);
801	sb->bd_id = ver & 0x0000ffff;
802	sb->bd_flags = (ver & 0xffff0000) >> 16;
803	sb->bufsize = pcm_getbuffersize(dev, 4096, SB16_BUFFSIZE, 65536);
804
805	if (sb16_alloc_resources(sb, dev))
806		goto no;
807	sb_lock(sb);
808	if (sb_reset_dsp(sb)) {
809		sb_unlock(sb);
810		goto no;
811	}
812	sb_unlock(sb);
813	if (mixer_init(dev, &sb16mix_mixer_class, sb))
814		goto no;
815	if (snd_setup_intr(dev, sb->irq, 0, sb_intr, sb, &sb->ih))
816		goto no;
817
818	if (sb->bd_flags & BD_F_SB16X)
819		pcm_setflags(dev, pcm_getflags(dev) | SD_F_SIMPLEX);
820
821	sb->prio = 0;
822
823    	if (bus_dma_tag_create(/*parent*/NULL, /*alignment*/2, /*boundary*/0,
824			/*lowaddr*/BUS_SPACE_MAXADDR_24BIT,
825			/*highaddr*/BUS_SPACE_MAXADDR,
826			/*filter*/NULL, /*filterarg*/NULL,
827			/*maxsize*/sb->bufsize, /*nsegments*/1,
828			/*maxsegz*/0x3ffff, /*flags*/0,
829			/*lockfunc*/busdma_lock_mutex, /*lockarg*/&Giant,
830			&sb->parent_dmat) != 0) {
831		device_printf(dev, "unable to create dma tag\n");
832		goto no;
833    	}
834
835    	if (!(pcm_getflags(dev) & SD_F_SIMPLEX))
836		snprintf(status2, SND_STATUSLEN, ":%ld", rman_get_start(sb->drq2));
837	else
838		status2[0] = '\0';
839
840    	snprintf(status, SND_STATUSLEN, "at io 0x%lx irq %ld drq %ld%s bufsz %ud %s",
841    	     	rman_get_start(sb->io_base), rman_get_start(sb->irq),
842		rman_get_start(sb->drq1), status2, sb->bufsize,
843		PCM_KLDSTRING(snd_sb16));
844
845    	if (pcm_register(dev, sb, 1, 1))
846		goto no;
847	pcm_addchan(dev, PCMDIR_REC, &sb16chan_class, sb);
848	pcm_addchan(dev, PCMDIR_PLAY, &sb16chan_class, sb);
849
850    	pcm_setstatus(dev, status);
851
852    	return 0;
853
854no:
855    	sb16_release_resources(sb, dev);
856    	return ENXIO;
857}
858
859static int
860sb16_detach(device_t dev)
861{
862	int r;
863	struct sb_info *sb;
864
865	r = pcm_unregister(dev);
866	if (r)
867		return r;
868
869	sb = pcm_getdevinfo(dev);
870    	sb16_release_resources(sb, dev);
871	return 0;
872}
873
874static device_method_t sb16_methods[] = {
875	/* Device interface */
876	DEVMETHOD(device_probe,		sb16_probe),
877	DEVMETHOD(device_attach,	sb16_attach),
878	DEVMETHOD(device_detach,	sb16_detach),
879
880	{ 0, 0 }
881};
882
883static driver_t sb16_driver = {
884	"pcm",
885	sb16_methods,
886	PCM_SOFTC_SIZE,
887};
888
889DRIVER_MODULE(snd_sb16, sbc, sb16_driver, pcm_devclass, 0, 0);
890MODULE_DEPEND(snd_sb16, snd_pcm, PCM_MINVER, PCM_PREFVER, PCM_MAXVER);
891MODULE_DEPEND(snd_sb16, snd_sbc, 1, 1, 1);
892MODULE_VERSION(snd_sb16, 1);
893