xref: /openbsd-src/sys/dev/pci/yds.c (revision 8445c53715e7030056b779e8ab40efb7820981f2)
1 /*	$OpenBSD: yds.c,v 1.6 2001/08/26 03:32:22 jason Exp $	*/
2 /*	$NetBSD: yds.c,v 1.5 2001/05/21 23:55:04 minoura Exp $	*/
3 
4 /*
5  * Copyright (c) 2000, 2001 Kazuki Sakamoto and Minoura Makoto.
6  * All rights reserved.
7  *
8  * Redistribution and use in source and binary forms, with or without
9  * modification, are permitted provided that the following conditions
10  * are met:
11  * 1. Redistributions of source code must retain the above copyright
12  *    notice, this list of conditions and the following disclaimer.
13  * 2. Redistributions in binary form must reproduce the above copyright
14  *    notice, this list of conditions and the following disclaimer in the
15  *    documentation and/or other materials provided with the distribution.
16  *
17  * THIS SOFTWARE IS PROVIDED BY THE AUTHOR ``AS IS'' AND ANY EXPRESS OR
18  * IMPLIED WARRANTIES, INCLUDING, BUT NOT LIMITED TO, THE IMPLIED WARRANTIES
19  * OF MERCHANTABILITY AND FITNESS FOR A PARTICULAR PURPOSE ARE DISCLAIMED.
20  * IN NO EVENT SHALL THE AUTHOR BE LIABLE FOR ANY DIRECT, INDIRECT,
21  * INCIDENTAL, SPECIAL, EXEMPLARY, OR CONSEQUENTIAL DAMAGES (INCLUDING, BUT
22  * NOT LIMITED TO, PROCUREMENT OF SUBSTITUTE GOODS OR SERVICES; LOSS OF USE,
23  * DATA, OR PROFITS; OR BUSINESS INTERRUPTION) HOWEVER CAUSED AND ON ANY
24  * THEORY OF LIABILITY, WHETHER IN CONTRACT, STRICT LIABILITY, OR TORT
25  * (INCLUDING NEGLIGENCE OR OTHERWISE) ARISING IN ANY WAY OUT OF THE USE OF
26  * THIS SOFTWARE, EVEN IF ADVISED OF THE POSSIBILITY OF SUCH DAMAGE.
27  */
28 
29 /*
30  * Yamaha YMF724[B-F]/740[B-C]/744/754
31  *
32  * Documentation links:
33  * - ftp://ftp.alsa-project.org/pub/manuals/yamaha/
34  * - ftp://ftp.alsa-project.org/pub/manuals/yamaha/pci/
35  *
36  * TODO:
37  * - FM synth volume (difficult: mixed before ac97)
38  * - Digital in/out (SPDIF) support
39  * - Effect??
40  */
41 
42 #include <sys/param.h>
43 #include <sys/systm.h>
44 #include <sys/kernel.h>
45 #include <sys/malloc.h>
46 #include <sys/device.h>
47 #include <sys/proc.h>
48 #include <sys/queue.h>
49 #include <sys/fcntl.h>
50 
51 #include <dev/pci/pcidevs.h>
52 #include <dev/pci/pcireg.h>
53 #include <dev/pci/pcivar.h>
54 
55 #include <sys/audioio.h>
56 #include <dev/audio_if.h>
57 #include <dev/midi_if.h>
58 #include <dev/mulaw.h>
59 #include <dev/auconv.h>
60 #include <dev/ic/ac97.h>
61 #include <dev/ic/mpuvar.h>
62 
63 #include <machine/bus.h>
64 #include <machine/intr.h>
65 
66 #include <dev/microcode/yds/yds_hwmcode.h>
67 
68 #include <dev/pci/ydsreg.h>
69 #include <dev/pci/ydsvar.h>
70 
71 /* Debug */
72 #undef YDS_USE_REC_SLOT
73 #define YDS_USE_P44
74 
75 #ifdef AUDIO_DEBUG
76 # define DPRINTF(x)	if (ydsdebug) printf x
77 # define DPRINTFN(n,x)	if (ydsdebug>(n)) printf x
78 int	ydsdebug = 0;
79 #else
80 # define DPRINTF(x)
81 # define DPRINTFN(n,x)
82 #endif
83 #ifdef YDS_USE_REC_SLOT
84 # define YDS_INPUT_SLOT 0	/* REC slot = ADC + loopbacks */
85 #else
86 # define YDS_INPUT_SLOT 1	/* ADC slot */
87 #endif
88 
89 int	yds_match __P((struct device *, void *, void *));
90 void	yds_attach __P((struct device *, struct device *, void *));
91 int	yds_intr __P((void *));
92 
93 #ifdef __HAS_NEW_BUS_DMAMAP_SYNC
94 #define yds_bus_dmamap_sync(t, m, o, l, f) \
95     bus_dmamap_sync((t), (m), (o), (l), (f))
96 #else
97 #define yds_bus_dmamap_sync(t, m, o, l, f) \
98     bus_dmamap_sync((t), (m), (f))
99 #endif
100 
101 #define DMAADDR(p) ((p)->map->dm_segs[0].ds_addr)
102 #define KERNADDR(p) ((void *)((p)->addr))
103 
104 int	yds_allocmem __P((struct yds_softc *, size_t, size_t, struct yds_dma *));
105 int	yds_freemem __P((struct yds_softc *, struct yds_dma *));
106 
107 #ifndef AUDIO_DEBUG
108 #define YWRITE1(sc, r, x) bus_space_write_1((sc)->memt, (sc)->memh, (r), (x))
109 #define YWRITE2(sc, r, x) bus_space_write_2((sc)->memt, (sc)->memh, (r), (x))
110 #define YWRITE4(sc, r, x) bus_space_write_4((sc)->memt, (sc)->memh, (r), (x))
111 #define YREAD1(sc, r) bus_space_read_1((sc)->memt, (sc)->memh, (r))
112 #define YREAD2(sc, r) bus_space_read_2((sc)->memt, (sc)->memh, (r))
113 #define YREAD4(sc, r) bus_space_read_4((sc)->memt, (sc)->memh, (r))
114 #else
115 
116 u_int16_t YREAD2(struct yds_softc *sc,bus_size_t r);
117 u_int32_t YREAD4(struct yds_softc *sc,bus_size_t r);
118 void YWRITE1(struct yds_softc *sc,bus_size_t r,u_int8_t x);
119 void YWRITE2(struct yds_softc *sc,bus_size_t r,u_int16_t x);
120 void YWRITE4(struct yds_softc *sc,bus_size_t r,u_int32_t x);
121 
122 u_int16_t YREAD2(struct yds_softc *sc,bus_size_t r)
123 {
124   DPRINTFN(5, (" YREAD2(0x%lX)\n",(unsigned long)r));
125   return bus_space_read_2(sc->memt,sc->memh,r);
126 }
127 u_int32_t YREAD4(struct yds_softc *sc,bus_size_t r)
128 {
129   DPRINTFN(5, (" YREAD4(0x%lX)\n",(unsigned long)r));
130   return bus_space_read_4(sc->memt,sc->memh,r);
131 }
132 void YWRITE1(struct yds_softc *sc,bus_size_t r,u_int8_t x)
133 {
134   DPRINTFN(5, (" YWRITE1(0x%lX,0x%lX)\n",(unsigned long)r,(unsigned long)x));
135   bus_space_write_1(sc->memt,sc->memh,r,x);
136 }
137 void YWRITE2(struct yds_softc *sc,bus_size_t r,u_int16_t x)
138 {
139   DPRINTFN(5, (" YWRITE2(0x%lX,0x%lX)\n",(unsigned long)r,(unsigned long)x));
140   bus_space_write_2(sc->memt,sc->memh,r,x);
141 }
142 void YWRITE4(struct yds_softc *sc,bus_size_t r,u_int32_t x)
143 {
144   DPRINTFN(5, (" YWRITE4(0x%lX,0x%lX)\n",(unsigned long)r,(unsigned long)x));
145   bus_space_write_4(sc->memt,sc->memh,r,x);
146 }
147 #endif
148 
149 #define	YWRITEREGION4(sc, r, x, c)	\
150 	bus_space_write_region_4((sc)->memt, (sc)->memh, (r), (x), (c) / 4)
151 
152 struct cfdriver yds_cd = {
153 	NULL, "yds", DV_DULL
154 };
155 
156 struct cfattach yds_ca = {
157 	sizeof(struct yds_softc), yds_match, yds_attach
158 };
159 
160 int	yds_open __P((void *, int));
161 void	yds_close __P((void *));
162 int	yds_query_encoding __P((void *, struct audio_encoding *));
163 int	yds_set_params __P((void *, int, int, struct audio_params *, struct audio_params *));
164 int	yds_round_blocksize __P((void *, int));
165 int	yds_trigger_output __P((void *, void *, void *, int, void (*)(void *),
166 	    void *, struct audio_params *));
167 int	yds_trigger_input __P((void *, void *, void *, int, void (*)(void *),
168 	    void *, struct audio_params *));
169 int	yds_halt_output __P((void *));
170 int	yds_halt_input __P((void *));
171 int	yds_getdev __P((void *, struct audio_device *));
172 int	yds_mixer_set_port __P((void *, mixer_ctrl_t *));
173 int	yds_mixer_get_port __P((void *, mixer_ctrl_t *));
174 void   *yds_malloc __P((void *, u_long, int, int));
175 void	yds_free __P((void *, void *, int));
176 u_long	yds_round_buffersize __P((void *, u_long));
177 int	yds_mappage __P((void *, void *, int, int));
178 int	yds_get_props __P((void *));
179 int	yds_query_devinfo __P((void *addr, mixer_devinfo_t *dip));
180 
181 int     yds_attach_codec __P((void *sc, struct ac97_codec_if *));
182 int	yds_read_codec __P((void *sc, u_int8_t a, u_int16_t *d));
183 int	yds_write_codec __P((void *sc, u_int8_t a, u_int16_t d));
184 void    yds_reset_codec __P((void *sc));
185 int     yds_get_portnum_by_name __P((struct yds_softc *, char *, char *,
186 				 char *));
187 
188 static u_int yds_get_dstype __P((int));
189 static int yds_download_mcode __P((struct yds_softc *));
190 static int yds_allocate_slots __P((struct yds_softc *));
191 static void yds_configure_legacy __P((struct device *arg));
192 static void yds_enable_dsp __P((struct yds_softc *));
193 static int yds_disable_dsp __P((struct yds_softc *));
194 static int yds_ready_codec __P((struct yds_codec_softc *));
195 static int yds_halt __P((struct yds_softc *));
196 static u_int32_t yds_get_lpfq __P((u_int));
197 static u_int32_t yds_get_lpfk __P((u_int));
198 static struct yds_dma *yds_find_dma __P((struct yds_softc *, void *));
199 
200 #ifdef AUDIO_DEBUG
201 static void yds_dump_play_slot __P((struct yds_softc *, int));
202 #define	YDS_DUMP_PLAY_SLOT(n,sc,bank) \
203 	if (ydsdebug > (n)) yds_dump_play_slot(sc, bank)
204 #else
205 #define	YDS_DUMP_PLAY_SLOT(n,sc,bank)
206 #endif /* AUDIO_DEBUG */
207 
208 static struct audio_hw_if yds_hw_if = {
209 	yds_open,
210 	yds_close,
211 	NULL,
212 	yds_query_encoding,
213 	yds_set_params,
214 	yds_round_blocksize,
215 	NULL,
216 	NULL,
217 	NULL,
218 	NULL,
219 	NULL,
220 	yds_halt_output,
221 	yds_halt_input,
222 	NULL,
223 	yds_getdev,
224 	NULL,
225 	yds_mixer_set_port,
226 	yds_mixer_get_port,
227 	yds_query_devinfo,
228 	yds_malloc,
229 	yds_free,
230 	yds_round_buffersize,
231 	yds_mappage,
232 	yds_get_props,
233 	yds_trigger_output,
234 	yds_trigger_input,
235 };
236 
237 struct audio_device yds_device = {
238 	"Yamaha DS-1",
239 	"",
240 	"yds"
241 };
242 
243 const static struct {
244 	u_int	id;
245 	u_int	flags;
246 #define YDS_CAP_MCODE_1			0x0001
247 #define YDS_CAP_MCODE_1E		0x0002
248 #define YDS_CAP_LEGACY_SELECTABLE	0x0004
249 #define YDS_CAP_LEGACY_FLEXIBLE		0x0008
250 #define YDS_CAP_HAS_P44			0x0010
251 } yds_chip_capability_list[] = {
252 	{ PCI_PRODUCT_YAMAHA_YMF724,
253 	  YDS_CAP_MCODE_1|YDS_CAP_LEGACY_SELECTABLE },
254 	/* 740[C] has only 32 slots.  But anyway we use only 2 */
255 	{ PCI_PRODUCT_YAMAHA_YMF740,
256 	  YDS_CAP_MCODE_1|YDS_CAP_LEGACY_SELECTABLE },	/* XXX NOT TESTED */
257 	{ PCI_PRODUCT_YAMAHA_YMF740C,
258 	  YDS_CAP_MCODE_1E|YDS_CAP_LEGACY_SELECTABLE },
259 	{ PCI_PRODUCT_YAMAHA_YMF724F,
260 	  YDS_CAP_MCODE_1E|YDS_CAP_LEGACY_SELECTABLE },
261 	{ PCI_PRODUCT_YAMAHA_YMF744,
262 	  YDS_CAP_MCODE_1E|YDS_CAP_LEGACY_FLEXIBLE },
263 	{ PCI_PRODUCT_YAMAHA_YMF754,
264 	  YDS_CAP_MCODE_1E|YDS_CAP_LEGACY_FLEXIBLE|YDS_CAP_HAS_P44 },
265 	/* How about 734/737/738?? */
266 	{ 0, 0 }
267 };
268 #ifdef AUDIO_DEBUG
269 #define YDS_CAP_BITS	"\020\005P44\004LEGFLEX\003LEGSEL\002MCODE1E\001MCODE1"
270 #endif
271 
272 #ifdef AUDIO_DEBUG
273 static void
274 yds_dump_play_slot(sc, bank)
275 	struct yds_softc *sc;
276 	int bank;
277 {
278 	int i, j;
279 	u_int32_t *p;
280 	u_int32_t num;
281 	struct yds_dma *dma;
282 
283 	for (i = 0; i < N_PLAY_SLOTS; i++) {
284 		printf("pbankp[%d] = %p,", i*2, sc->pbankp[i*2]);
285 		printf("pbankp[%d] = %p\n", i*2+1, sc->pbankp[i*2+1]);
286 	}
287 
288 	p = (u_int32_t*)sc->ptbl;
289 	for (i = 0; i < N_PLAY_SLOTS+1; i++) {
290 		printf("ptbl + %d:0x%x\n", i, *p);
291 		p++;
292 	}
293 
294 	num = *(u_int32_t*)sc->ptbl;
295 	printf("num = %d\n", num);
296 
297 	for (i = 0; i < num; i++) {
298 
299 		p = (u_int32_t *)sc->pbankp[i];
300 
301 		dma = yds_find_dma(sc,(void*)p);
302 
303 		printf("  pbankp[%d] : %p(%p)\n",
304 		       i, p, (void*)vtophys((vaddr_t)p));
305 		for (j = 0; j < sizeof(struct play_slot_ctrl_bank) /
306 		    sizeof(u_int32_t); j++) {
307 			printf("    0x%02x: 0x%08x\n",
308 			       (unsigned) (j * sizeof(u_int32_t)),
309 			       (unsigned) *p++);
310 		}
311 		/*
312 		p = (u_int32_t *)sc->pbankp[i*2 + 1];
313 		printf("  pbankp[%d] : %p\n", i*2 + 1, p);
314 		for (j = 0; j < sizeof(struct play_slot_ctrl_bank) /
315 		    sizeof(u_int32_t); j++) {
316 			printf("    0x%02x: 0x%08x\n",
317 				j * sizeof(u_int32_t), *p++);
318 				delay(1);
319 		}
320 		*/
321 	}
322 }
323 #endif /* AUDIO_DEBUG */
324 
325 static u_int
326 yds_get_dstype(id)
327 	int id;
328 {
329 	int i;
330 
331 	for (i = 0; yds_chip_capability_list[i].id; i++) {
332 		if (PCI_PRODUCT(id) == yds_chip_capability_list[i].id)
333 			return yds_chip_capability_list[i].flags;
334 	}
335 
336 	return -1;
337 }
338 
339 static int
340 yds_download_mcode(sc)
341 	struct yds_softc *sc;
342 {
343 	u_int ctrl;
344 	const u_int32_t *p;
345 	size_t size;
346 	int dstype;
347 
348 	static struct {
349 		const u_int32_t *mcode;
350 		size_t size;
351 	} ctrls[] = {
352 		{yds_ds1_ctrl_mcode, sizeof(yds_ds1_ctrl_mcode)},
353 		{yds_ds1e_ctrl_mcode, sizeof(yds_ds1e_ctrl_mcode)},
354 	};
355 
356 	if (sc->sc_flags & YDS_CAP_MCODE_1)
357 		dstype = YDS_DS_1;
358 	else if (sc->sc_flags & YDS_CAP_MCODE_1E)
359 		dstype = YDS_DS_1E;
360 	else
361 		return 1;	/* unknown */
362 
363 	if (yds_disable_dsp(sc))
364 		return 1;
365 
366 	/* Software reset */
367         YWRITE4(sc, YDS_MODE, YDS_MODE_RESET);
368         YWRITE4(sc, YDS_MODE, 0);
369 
370         YWRITE4(sc, YDS_MAPOF_REC, 0);
371         YWRITE4(sc, YDS_MAPOF_EFFECT, 0);
372         YWRITE4(sc, YDS_PLAY_CTRLBASE, 0);
373         YWRITE4(sc, YDS_REC_CTRLBASE, 0);
374         YWRITE4(sc, YDS_EFFECT_CTRLBASE, 0);
375         YWRITE4(sc, YDS_WORK_BASE, 0);
376 
377         ctrl = YREAD2(sc, YDS_GLOBAL_CONTROL);
378         YWRITE2(sc, YDS_GLOBAL_CONTROL,
379 		ctrl & ~0x0007);
380 
381 	/* Download DSP microcode. */
382 	p = yds_dsp_mcode;
383 	size = sizeof(yds_dsp_mcode);
384 	YWRITEREGION4(sc, YDS_DSP_INSTRAM, p, size);
385 
386 	/* Download CONTROL microcode. */
387 	p = ctrls[dstype].mcode;
388 	size = ctrls[dstype].size;
389 	YWRITEREGION4(sc, YDS_CTRL_INSTRAM, p, size);
390 
391 	yds_enable_dsp(sc);
392 	delay(10*1000);		/* nessesary on my 724F (??) */
393 
394 	return 0;
395 }
396 
397 static int
398 yds_allocate_slots(sc)
399 	struct yds_softc *sc;
400 {
401 	size_t pcs, rcs, ecs, ws, memsize;
402 	void *mp;
403 	u_int32_t da;		/* DMA address */
404 	char *va;		/* KVA */
405 	off_t cb;
406 	int i;
407 	struct yds_dma *p;
408 
409 	/* Alloc DSP Control Data */
410 	pcs = YREAD4(sc, YDS_PLAY_CTRLSIZE) * sizeof(u_int32_t);
411 	rcs = YREAD4(sc, YDS_REC_CTRLSIZE) * sizeof(u_int32_t);
412 	ecs = YREAD4(sc, YDS_EFFECT_CTRLSIZE) * sizeof(u_int32_t);
413 	ws = WORK_SIZE;
414 	YWRITE4(sc, YDS_WORK_SIZE, ws / sizeof(u_int32_t));
415 
416 	DPRINTF(("play control size : %d\n", (unsigned int)pcs));
417 	DPRINTF(("rec control size : %d\n", (unsigned int)rcs));
418 	DPRINTF(("eff control size : %d\n", (unsigned int)ecs));
419 	DPRINTF(("work size : %d\n", (unsigned int)ws));
420 #ifdef DIAGNOSTIC
421 	if (pcs != sizeof(struct play_slot_ctrl_bank)) {
422 		printf("%s: invalid play slot ctrldata %d != %d\n",
423 		       sc->sc_dev.dv_xname, (unsigned int)pcs,
424 		       (unsigned int)sizeof(struct play_slot_ctrl_bank));
425 	}
426 	if (rcs != sizeof(struct rec_slot_ctrl_bank)) {
427 		printf("%s: invalid rec slot ctrldata %d != %d\n",
428 		       sc->sc_dev.dv_xname, (unsigned int)rcs,
429 		       (unsigned int)sizeof(struct rec_slot_ctrl_bank));
430         }
431 #endif
432 
433 	memsize = N_PLAY_SLOTS*N_PLAY_SLOT_CTRL_BANK*pcs +
434 		  N_REC_SLOT_CTRL*N_REC_SLOT_CTRL_BANK*rcs + ws;
435 	memsize += (N_PLAY_SLOTS+1)*sizeof(u_int32_t);
436 
437 	p = &sc->sc_ctrldata;
438 	i = yds_allocmem(sc, memsize, 16, p);
439 	if (i) {
440 		printf("%s: couldn't alloc/map DSP DMA buffer, reason %d\n",
441 		       sc->sc_dev.dv_xname, i);
442 		free(p, M_DEVBUF);
443 		return 1;
444 	}
445 	mp = KERNADDR(p);
446 	da = DMAADDR(p);
447 
448 	DPRINTF(("mp:%p, DMA addr:%p\n",
449 		 mp, (void*) sc->sc_ctrldata.map->dm_segs[0].ds_addr));
450 
451 	bzero(mp, memsize);
452 
453 	/* Work space */
454         cb = 0;
455 	va = (u_int8_t*)mp;
456 	YWRITE4(sc, YDS_WORK_BASE, da + cb);
457         cb += ws;
458 
459 	/* Play control data table */
460         sc->ptbl = (u_int32_t *)(va + cb);
461 	sc->ptbloff = cb;
462         YWRITE4(sc, YDS_PLAY_CTRLBASE, da + cb);
463         cb += (N_PLAY_SLOT_CTRL + 1) * sizeof(u_int32_t);
464 
465 	/* Record slot control data */
466         sc->rbank = (struct rec_slot_ctrl_bank *)(va + cb);
467         YWRITE4(sc, YDS_REC_CTRLBASE, da + cb);
468 	sc->rbankoff = cb;
469         cb += N_REC_SLOT_CTRL * N_REC_SLOT_CTRL_BANK * rcs;
470 
471 #if 0
472 	/* Effect slot control data -- unused */
473         YWRITE4(sc, YDS_EFFECT_CTRLBASE, da + cb);
474         cb += N_EFFECT_SLOT_CTRL * N_EFFECT_SLOT_CTRL_BANK * ecs;
475 #endif
476 
477 	/* Play slot control data */
478         sc->pbankoff = da + cb;
479         for (i=0; i<N_PLAY_SLOT_CTRL; i++) {
480 		sc->pbankp[i*2] = (struct play_slot_ctrl_bank *)(va + cb);
481 		*(sc->ptbl + i+1) = da + cb;
482                 cb += pcs;
483 
484                 sc->pbankp[i*2+1] = (struct play_slot_ctrl_bank *)(va + cb);
485                 cb += pcs;
486         }
487 	/* Sync play control data table */
488 	yds_bus_dmamap_sync(sc->sc_dmatag, p->map, sc->ptbloff,
489 	    (N_PLAY_SLOT_CTRL+1) * sizeof(u_int32_t),
490 	    BUS_DMASYNC_PREWRITE);
491 
492 	return 0;
493 }
494 
495 static void
496 yds_enable_dsp(sc)
497 	struct yds_softc *sc;
498 {
499 	YWRITE4(sc, YDS_CONFIG, YDS_DSP_SETUP);
500 }
501 
502 static int
503 yds_disable_dsp(sc)
504 	struct yds_softc *sc;
505 {
506 	int to;
507 	u_int32_t data;
508 
509 	data = YREAD4(sc, YDS_CONFIG);
510 	if (data)
511 		YWRITE4(sc, YDS_CONFIG, YDS_DSP_DISABLE);
512 
513 	for (to = 0; to < YDS_WORK_TIMEOUT; to++) {
514 		if ((YREAD4(sc, YDS_STATUS) & YDS_STAT_WORK) == 0)
515 			return 0;
516 		delay(1);
517 	}
518 
519 	return 1;
520 }
521 
522 int
523 yds_match(parent, match, aux)
524 	struct device *parent;
525 	void *match;
526 	void *aux;
527 {
528 	struct pci_attach_args *pa = (struct pci_attach_args *) aux;
529 
530 	switch (PCI_VENDOR(pa->pa_id)) {
531 	case PCI_VENDOR_YAMAHA:
532 		switch (PCI_PRODUCT(pa->pa_id)) {
533 		case PCI_PRODUCT_YAMAHA_YMF724:
534 		case PCI_PRODUCT_YAMAHA_YMF740:
535 		case PCI_PRODUCT_YAMAHA_YMF740C:
536 		case PCI_PRODUCT_YAMAHA_YMF724F:
537 		case PCI_PRODUCT_YAMAHA_YMF744:
538 		case PCI_PRODUCT_YAMAHA_YMF754:
539 		/* 734, 737, 738?? */
540 			return (1);
541 		}
542 		break;
543 	}
544 
545 	return (0);
546 }
547 
548 /*
549  * This routine is called after all the ISA devices are configured,
550  * to avoid conflict.
551  */
552 static void
553 yds_configure_legacy (arg)
554 	struct device *arg;
555 #define FLEXIBLE	(sc->sc_flags & YDS_CAP_LEGACY_FLEXIBLE)
556 #define SELECTABLE	(sc->sc_flags & YDS_CAP_LEGACY_SELECTABLE)
557 {
558 	struct yds_softc *sc = (struct yds_softc*) arg;
559 	pcireg_t reg;
560 	struct device *dev;
561 	int i;
562 	bus_addr_t opl_addrs[] = {0x388, 0x398, 0x3A0, 0x3A8};
563 	bus_addr_t mpu_addrs[] = {0x330, 0x300, 0x332, 0x334};
564 
565 	if (!FLEXIBLE && !SELECTABLE)
566 		return;
567 
568 	reg = pci_conf_read(sc->sc_pc, sc->sc_pcitag, YDS_PCI_LEGACY);
569 	reg &= ~0x8133c03f;	/* these bits are out of interest */
570 	reg |= ((YDS_PCI_EX_LEGACY_IMOD) |
571 		(YDS_PCI_LEGACY_FMEN |
572 		 YDS_PCI_LEGACY_MEN /*| YDS_PCI_LEGACY_MIEN*/));
573 	if (FLEXIBLE) {
574 		pci_conf_write(sc->sc_pc, sc->sc_pcitag, YDS_PCI_LEGACY, reg);
575 		delay(100*1000);
576 	}
577 
578 	/* Look for OPL */
579 	dev = 0;
580 	for (i = 0; i < sizeof(opl_addrs) / sizeof (bus_addr_t); i++) {
581 		if (SELECTABLE) {
582 			pci_conf_write(sc->sc_pc, sc->sc_pcitag,
583 				       YDS_PCI_LEGACY, reg | (i << (0+16)));
584 			delay(100*1000);	/* wait 100ms */
585 		} else
586 			pci_conf_write(sc->sc_pc, sc->sc_pcitag,
587 				       YDS_PCI_FM_BA, opl_addrs[i]);
588 		if (bus_space_map(sc->sc_opl_iot,
589 				  opl_addrs[i], 4, 0, &sc->sc_opl_ioh) == 0) {
590 			struct audio_attach_args aa;
591 
592 			aa.type = AUDIODEV_TYPE_OPL;
593 			aa.hwif = aa.hdl = NULL;
594 			dev = config_found(&sc->sc_dev, &aa, audioprint);
595 			if (dev == 0)
596 				bus_space_unmap(sc->sc_opl_iot,
597 						sc->sc_opl_ioh, 4);
598 			else {
599 				if (SELECTABLE)
600 					reg |= (i << (0+16));
601 				break;
602 			}
603 		}
604 	}
605 	if (dev == 0) {
606 		reg &= ~YDS_PCI_LEGACY_FMEN;
607 		pci_conf_write(sc->sc_pc, sc->sc_pcitag,
608 			       YDS_PCI_LEGACY, reg);
609 	} else {
610 		/* Max. volume */
611 		YWRITE4(sc, YDS_LEGACY_OUT_VOLUME, 0x3fff3fff);
612 		YWRITE4(sc, YDS_LEGACY_REC_VOLUME, 0x3fff3fff);
613 	}
614 
615 	/* Look for MPU */
616 	dev = 0;
617 	for (i = 0; i < sizeof(mpu_addrs) / sizeof (bus_addr_t); i++) {
618 		if (SELECTABLE)
619 			pci_conf_write(sc->sc_pc, sc->sc_pcitag,
620 				       YDS_PCI_LEGACY, reg | (i << (4+16)));
621 		else
622 			pci_conf_write(sc->sc_pc, sc->sc_pcitag,
623 				       YDS_PCI_MPU_BA, mpu_addrs[i]);
624 		if (bus_space_map(sc->sc_mpu_iot,
625 				  mpu_addrs[i], 2, 0, &sc->sc_mpu_ioh) == 0) {
626 			struct audio_attach_args aa;
627 
628 			aa.type = AUDIODEV_TYPE_MPU;
629 			aa.hwif = aa.hdl = NULL;
630 			dev = config_found(&sc->sc_dev, &aa, audioprint);
631 			if (dev == 0)
632 				bus_space_unmap(sc->sc_mpu_iot,
633 						sc->sc_mpu_ioh, 2);
634 			else {
635 				if (SELECTABLE)
636 					reg |= (i << (4+16));
637 				break;
638 			}
639 		}
640 	}
641 	if (dev == 0) {
642 		reg &= ~(YDS_PCI_LEGACY_MEN | YDS_PCI_LEGACY_MIEN);
643 		pci_conf_write(sc->sc_pc, sc->sc_pcitag,
644 			       YDS_PCI_LEGACY, reg);
645 	}
646 	sc->sc_mpu = dev;
647 }
648 #undef FLEXIBLE
649 #undef SELECTABLE
650 
651 void
652 yds_attach(parent, self, aux)
653 	struct device *parent;
654 	struct device *self;
655 	void *aux;
656 {
657 	struct yds_softc *sc = (struct yds_softc *)self;
658 	struct pci_attach_args *pa = (struct pci_attach_args *)aux;
659 	pci_chipset_tag_t pc = pa->pa_pc;
660 	char const *intrstr;
661 	pci_intr_handle_t ih;
662 	pcireg_t reg;
663 	struct yds_codec_softc *codec;
664 	mixer_ctrl_t ctl;
665 	int i, r, to;
666 	int ac97_id2;
667 
668 	/* Map register to memory */
669 	if (pci_mapreg_map(pa, YDS_PCI_MBA, PCI_MAPREG_TYPE_MEM, 0,
670 	    &sc->memt, &sc->memh, NULL, NULL, 0)) {
671 		printf("%s: can't map memory space\n", sc->sc_dev.dv_xname);
672 		return;
673 	}
674 
675 	/* Map and establish the interrupt. */
676 	if (pci_intr_map(pa, &ih)) {
677 		printf("%s: couldn't map interrupt\n", sc->sc_dev.dv_xname);
678 		return;
679 	}
680 	intrstr = pci_intr_string(pc, ih);
681 	sc->sc_ih = pci_intr_establish(pc, ih, IPL_AUDIO, yds_intr, sc,
682 	    self->dv_xname);
683 	if (sc->sc_ih == NULL) {
684 		printf("%s: couldn't establish interrupt",
685 		    sc->sc_dev.dv_xname);
686 		if (intrstr != NULL)
687 			printf(" at %s", intrstr);
688 		printf("\n");
689 		return;
690 	}
691 	printf(": %s\n", intrstr);
692 
693 	sc->sc_dmatag = pa->pa_dmat;
694 	sc->sc_pc = pc;
695 	sc->sc_pcitag = pa->pa_tag;
696 	sc->sc_id = pa->pa_id;
697 	sc->sc_flags = yds_get_dstype(sc->sc_id);
698 #ifdef AUDIO_DEBUG
699 	if (ydsdebug) {
700 		char bits[80];
701 
702 		printf("%s: chip has %s\n", sc->sc_dev.dv_xname,
703 		       bitmask_snprintf(sc->sc_flags, YDS_CAP_BITS, bits,
704 					sizeof(bits)));
705 	}
706 #endif
707 
708 	/* Disable legacy mode */
709 	reg = pci_conf_read(pc, pa->pa_tag, YDS_PCI_LEGACY);
710 	pci_conf_write(pc, pa->pa_tag, YDS_PCI_LEGACY,
711 		       reg & YDS_PCI_LEGACY_LAD);
712 
713 	/* Enable the device. */
714 	reg = pci_conf_read(pc, pa->pa_tag, PCI_COMMAND_STATUS_REG);
715 	reg |= (PCI_COMMAND_IO_ENABLE | PCI_COMMAND_MEM_ENABLE |
716 		PCI_COMMAND_MASTER_ENABLE);
717 	pci_conf_write(pc, pa->pa_tag, PCI_COMMAND_STATUS_REG, reg);
718 	reg = pci_conf_read(pc, pa->pa_tag, PCI_COMMAND_STATUS_REG);
719 
720 	/* Mute all volumes */
721 	for (i = 0x80; i < 0xc0; i += 2)
722 		YWRITE2(sc, i, 0);
723 
724 	/* Download microcode */
725 	if (yds_download_mcode(sc)) {
726 		printf("%s: download microcode failed\n", sc->sc_dev.dv_xname);
727 		return;
728 	}
729 	/* Allocate DMA buffers */
730 	if (yds_allocate_slots(sc)) {
731 		printf("%s: could not allocate slots\n", sc->sc_dev.dv_xname);
732 		return;
733 	}
734 
735 	/* Warm reset */
736 	reg = pci_conf_read(pc, pa->pa_tag, YDS_PCI_DSCTRL);
737 	pci_conf_write(pc, pa->pa_tag, YDS_PCI_DSCTRL, reg | YDS_DSCTRL_WRST);
738 	delay(50000);
739 
740 	/*
741 	 * Detect primary/secondary AC97
742 	 *	YMF754 Hardware Specification Rev 1.01 page 24
743 	 */
744 	reg = pci_conf_read(pc, pa->pa_tag, YDS_PCI_DSCTRL);
745 	pci_conf_write(pc, pa->pa_tag, YDS_PCI_DSCTRL,
746 		reg & ~YDS_DSCTRL_CRST);
747 	delay(400000);		/* Needed for 740C. */
748 
749 	/* Primary */
750 	for (to = 0; to < AC97_TIMEOUT; to++) {
751 		if ((YREAD2(sc, AC97_STAT_ADDR1) & AC97_BUSY) == 0)
752 			break;
753 		delay(1);
754 	}
755 	if (to == AC97_TIMEOUT) {
756 		printf("%s: no AC97 avaliable\n", sc->sc_dev.dv_xname);
757 		return;
758 	}
759 
760 	/* Secondary */
761 	/* Secondary AC97 is used for 4ch audio. Currently unused. */
762 	ac97_id2 = -1;
763 	if ((YREAD2(sc, YDS_ACTIVITY) & YDS_ACTIVITY_DOCKA) == 0)
764 		goto detected;
765 #if 0				/* reset secondary... */
766 	YWRITE2(sc, YDS_GPIO_OCTRL,
767 		YREAD2(sc, YDS_GPIO_OCTRL) & ~YDS_GPIO_GPO2);
768 	YWRITE2(sc, YDS_GPIO_FUNCE,
769 		(YREAD2(sc, YDS_GPIO_FUNCE)&(~YDS_GPIO_GPC2))|YDS_GPIO_GPE2);
770 #endif
771 	for (to = 0; to < AC97_TIMEOUT; to++) {
772 		if ((YREAD2(sc, AC97_STAT_ADDR2) & AC97_BUSY) == 0)
773 			break;
774 		delay(1);
775 	}
776 	if (to < AC97_TIMEOUT) {
777 		/* detect id */
778 		for (ac97_id2 = 1; ac97_id2 < 4; ac97_id2++) {
779 			YWRITE2(sc, AC97_CMD_ADDR,
780 				AC97_CMD_READ | AC97_ID(ac97_id2) | 0x28);
781 
782 			for (to = 0; to < AC97_TIMEOUT; to++) {
783 				if ((YREAD2(sc, AC97_STAT_ADDR2) & AC97_BUSY)
784 				    == 0)
785 					goto detected;
786 				delay(1);
787 			}
788 		}
789 		if (ac97_id2 == 4)
790 			ac97_id2 = -1;
791 detected:
792 		;
793 	}
794 
795 	pci_conf_write(pc, pa->pa_tag, YDS_PCI_DSCTRL,
796 		       reg | YDS_DSCTRL_CRST);
797 	delay (20);
798 	pci_conf_write(pc, pa->pa_tag, YDS_PCI_DSCTRL,
799 		reg & ~YDS_DSCTRL_CRST);
800 	delay (400000);
801 	for (to = 0; to < AC97_TIMEOUT; to++) {
802 		if ((YREAD2(sc, AC97_STAT_ADDR1) & AC97_BUSY) == 0)
803 			break;
804 		delay(1);
805 	}
806 
807 	/*
808 	 * Attach ac97 codec
809 	 */
810 	for (i = 0; i < 2; i++) {
811 		static struct {
812 			int data;
813 			int addr;
814 		} statregs[] = {
815 			{AC97_STAT_DATA1, AC97_STAT_ADDR1},
816 			{AC97_STAT_DATA2, AC97_STAT_ADDR2},
817 		};
818 
819 		if (i == 1 && ac97_id2 == -1)
820 			break;		/* secondary ac97 not available */
821 
822 		codec = &sc->sc_codec[i];
823 		memcpy(&codec->sc_dev, &sc->sc_dev, sizeof(codec->sc_dev));
824 		codec->sc = sc;
825 		codec->id = i == 1 ? ac97_id2 : 0;
826 		codec->status_data = statregs[i].data;
827 		codec->status_addr = statregs[i].addr;
828 		codec->host_if.arg = codec;
829 		codec->host_if.attach = yds_attach_codec;
830 		codec->host_if.read = yds_read_codec;
831 		codec->host_if.write = yds_write_codec;
832 		codec->host_if.reset = yds_reset_codec;
833 
834 		if ((r = ac97_attach(&codec->host_if)) != 0) {
835 			printf("%s: can't attach codec (error 0x%X)\n",
836 				sc->sc_dev.dv_xname, r);
837 			return;
838 		}
839 	}
840 
841 	/* Just enable the DAC and master volumes by default */
842 	ctl.type = AUDIO_MIXER_ENUM;
843 	ctl.un.ord = 0;  /* off */
844 	ctl.dev = yds_get_portnum_by_name(sc, AudioCoutputs,
845 	       AudioNmaster, AudioNmute);
846 	yds_mixer_set_port(sc, &ctl);
847 	ctl.dev = yds_get_portnum_by_name(sc, AudioCinputs,
848 	       AudioNdac, AudioNmute);
849 	yds_mixer_set_port(sc, &ctl);
850 	ctl.dev = yds_get_portnum_by_name(sc, AudioCinputs,
851 	       AudioNcd, AudioNmute);
852 	yds_mixer_set_port(sc, &ctl);
853 	ctl.dev = yds_get_portnum_by_name(sc, AudioCrecord,
854 	       AudioNvolume, AudioNmute);
855 	yds_mixer_set_port(sc, &ctl);
856 
857 	ctl.dev = yds_get_portnum_by_name(sc, AudioCrecord,
858 	       AudioNsource, NULL);
859 	ctl.type = AUDIO_MIXER_ENUM;
860 	ctl.un.ord = 0;
861 	yds_mixer_set_port(sc, &ctl);
862 
863 	/* Set a reasonable default volume */
864 	ctl.type = AUDIO_MIXER_VALUE;
865 	ctl.un.value.num_channels = 2;
866 	ctl.un.value.level[AUDIO_MIXER_LEVEL_LEFT] =
867 	ctl.un.value.level[AUDIO_MIXER_LEVEL_RIGHT] = 127;
868 
869 	ctl.dev = sc->sc_codec[0].codec_if->vtbl->get_portnum_by_name(
870 		sc->sc_codec[0].codec_if, AudioCoutputs, AudioNmaster, NULL);
871 	yds_mixer_set_port(sc, &ctl);
872 
873 	audio_attach_mi(&yds_hw_if, sc, &sc->sc_dev);
874 
875 	sc->sc_legacy_iot = pa->pa_iot;
876 	config_defer((struct device*) sc, yds_configure_legacy);
877 }
878 
879 int
880 yds_attach_codec(sc_, codec_if)
881 	void *sc_;
882 	struct ac97_codec_if *codec_if;
883 {
884 	struct yds_codec_softc *sc = sc_;
885 
886 	sc->codec_if = codec_if;
887 	return 0;
888 }
889 
890 static int
891 yds_ready_codec(sc)
892 	struct yds_codec_softc *sc;
893 {
894 	int to;
895 
896 	for (to = 0; to < AC97_TIMEOUT; to++) {
897 		if ((YREAD2(sc->sc, sc->status_addr) & AC97_BUSY) == 0)
898 			return 0;
899 		delay(1);
900 	}
901 
902 	return 1;
903 }
904 
905 int
906 yds_read_codec(sc_, reg, data)
907 	void *sc_;
908 	u_int8_t reg;
909 	u_int16_t *data;
910 {
911 	struct yds_codec_softc *sc = sc_;
912 
913 	YWRITE2(sc->sc, AC97_CMD_ADDR, AC97_CMD_READ | AC97_ID(sc->id) | reg);
914 
915 	if (yds_ready_codec(sc)) {
916 		printf("%s: yds_read_codec timeout\n",
917 		       sc->sc->sc_dev.dv_xname);
918 		return EIO;
919 	}
920 
921 	*data = YREAD2(sc->sc, sc->status_data);
922 
923 	return 0;
924 }
925 
926 int
927 yds_write_codec(sc_, reg, data)
928 	void *sc_;
929 	u_int8_t reg;
930 	u_int16_t data;
931 {
932 	struct yds_codec_softc *sc = sc_;
933 
934 	YWRITE2(sc->sc, AC97_CMD_ADDR, AC97_CMD_WRITE | AC97_ID(sc->id) | reg);
935 	YWRITE2(sc->sc, AC97_CMD_DATA, data);
936 
937 	if (yds_ready_codec(sc)) {
938 		printf("%s: yds_write_codec timeout\n",
939 			sc->sc->sc_dev.dv_xname);
940 		return EIO;
941 	}
942 
943 	return 0;
944 }
945 
946 /*
947  * XXX: Must handle the secondary differntly!!
948  */
949 void
950 yds_reset_codec(sc_)
951 	void *sc_;
952 {
953 	struct yds_codec_softc *codec = sc_;
954 	struct yds_softc *sc = codec->sc;
955 	pcireg_t reg;
956 
957 	/* reset AC97 codec */
958 	reg = pci_conf_read(sc->sc_pc, sc->sc_pcitag, YDS_PCI_DSCTRL);
959 	if (reg & 0x03) {
960 		pci_conf_write(sc->sc_pc, sc->sc_pcitag,
961 			       YDS_PCI_DSCTRL, reg & ~0x03);
962 		pci_conf_write(sc->sc_pc, sc->sc_pcitag,
963 			       YDS_PCI_DSCTRL, reg | 0x03);
964 		pci_conf_write(sc->sc_pc, sc->sc_pcitag,
965 			       YDS_PCI_DSCTRL, reg & ~0x03);
966 		delay(50000);
967 	}
968 
969 	yds_ready_codec(sc_);
970 }
971 
972 int
973 yds_intr(p)
974 	void *p;
975 {
976 	struct yds_softc *sc = p;
977 	u_int status;
978 
979 	status = YREAD4(sc, YDS_STATUS);
980 	DPRINTFN(1, ("yds_intr: status=%08x\n", status));
981 	if ((status & (YDS_STAT_INT|YDS_STAT_TINT)) == 0) {
982 #if NMPU > 0
983 		if (sc->sc_mpu)
984 			return mpu_intr(sc->sc_mpu);
985 #endif
986 		return 0;
987 	}
988 
989 	if (status & YDS_STAT_TINT) {
990 		YWRITE4(sc, YDS_STATUS, YDS_STAT_TINT);
991 		printf ("yds_intr: timeout!\n");
992 	}
993 
994 	if (status & YDS_STAT_INT) {
995 		int nbank = (YREAD4(sc, YDS_CONTROL_SELECT) == 0);
996 
997 		/* Clear interrupt flag */
998 		YWRITE4(sc, YDS_STATUS, YDS_STAT_INT);
999 
1000 		/* Buffer for the next frame is always ready. */
1001 		YWRITE4(sc, YDS_MODE, YREAD4(sc, YDS_MODE) | YDS_MODE_ACTV2);
1002 
1003 		if (sc->sc_play.intr) {
1004 			u_int dma, cpu, blk, len;
1005 
1006 			/* Sync play slot control data */
1007 			yds_bus_dmamap_sync(sc->sc_dmatag, sc->sc_ctrldata.map,
1008 			    sc->pbankoff,
1009 			    sizeof(struct play_slot_ctrl_bank) * (*sc->ptbl)*
1010 			    N_PLAY_SLOT_CTRL_BANK,
1011 			    BUS_DMASYNC_POSTWRITE|BUS_DMASYNC_POSTREAD);
1012 			dma = sc->pbankp[nbank]->pgstart * sc->sc_play.factor;
1013 			cpu = sc->sc_play.offset;
1014 			blk = sc->sc_play.blksize;
1015 			len = sc->sc_play.length;
1016 
1017 			if (((dma > cpu) && (dma - cpu > blk * 2)) ||
1018 			    ((cpu > dma) && (dma + len - cpu > blk * 2))) {
1019 				/* We can fill the next block */
1020 				/* Sync ring buffer first for previous write */
1021 				yds_bus_dmamap_sync(sc->sc_dmatag,
1022 				    sc->sc_play.dma->map,
1023 				    cpu, blk,
1024 				    BUS_DMASYNC_POSTWRITE);
1025 				sc->sc_play.intr(sc->sc_play.intr_arg);
1026 				sc->sc_play.offset += blk;
1027 				if (sc->sc_play.offset >= len) {
1028 					sc->sc_play.offset -= len;
1029 #ifdef DIAGNOSTIC
1030 					if (sc->sc_play.offset != 0)
1031 						printf ("Audio ringbuffer botch\n");
1032 #endif
1033 				}
1034 				/* Sync ring buffer for next write */
1035 				yds_bus_dmamap_sync(sc->sc_dmatag,
1036 				    sc->sc_play.dma->map, cpu, blk,
1037 				    BUS_DMASYNC_PREWRITE);
1038 			}
1039 		}
1040 		if (sc->sc_rec.intr) {
1041 			u_int dma, cpu, blk, len;
1042 
1043 			/* Sync rec slot control data */
1044 			yds_bus_dmamap_sync(sc->sc_dmatag, sc->sc_ctrldata.map,
1045 			    sc->rbankoff, sizeof(struct rec_slot_ctrl_bank)*
1046 			    N_REC_SLOT_CTRL * N_REC_SLOT_CTRL_BANK,
1047 			    BUS_DMASYNC_POSTWRITE|BUS_DMASYNC_POSTREAD);
1048 			dma = sc->rbank[YDS_INPUT_SLOT*2 + nbank].pgstartadr;
1049 			cpu = sc->sc_rec.offset;
1050 			blk = sc->sc_rec.blksize;
1051 			len = sc->sc_rec.length;
1052 
1053 			if (((dma > cpu) && (dma - cpu > blk * 2)) ||
1054 			    ((cpu > dma) && (dma + len - cpu > blk * 2))) {
1055 				/* We can drain the current block */
1056 				/* Sync ring buffer first */
1057 				yds_bus_dmamap_sync(sc->sc_dmatag,
1058 				    sc->sc_rec.dma->map, cpu, blk,
1059 				    BUS_DMASYNC_POSTREAD);
1060 				sc->sc_rec.intr(sc->sc_rec.intr_arg);
1061 				sc->sc_rec.offset += blk;
1062 				if (sc->sc_rec.offset >= len) {
1063 					sc->sc_rec.offset -= len;
1064 #ifdef DIAGNOSTIC
1065 					if (sc->sc_rec.offset != 0)
1066 						printf ("Audio ringbuffer botch\n");
1067 #endif
1068 				}
1069 				/* Sync ring buffer for next read */
1070 				yds_bus_dmamap_sync(sc->sc_dmatag,
1071 				    sc->sc_rec.dma->map, cpu, blk,
1072 				    BUS_DMASYNC_PREREAD);
1073 			}
1074 		}
1075 	}
1076 
1077 	return 1;
1078 }
1079 
1080 int
1081 yds_allocmem(sc, size, align, p)
1082 	struct yds_softc *sc;
1083 	size_t size;
1084 	size_t align;
1085 	struct yds_dma *p;
1086 {
1087 	int error;
1088 
1089 	p->size = size;
1090 	error = bus_dmamem_alloc(sc->sc_dmatag, p->size, align, 0,
1091 				 p->segs, sizeof(p->segs)/sizeof(p->segs[0]),
1092 				 &p->nsegs, BUS_DMA_NOWAIT);
1093 	if (error)
1094 		return (error);
1095 
1096 	error = bus_dmamem_map(sc->sc_dmatag, p->segs, p->nsegs, p->size,
1097 			       &p->addr, BUS_DMA_NOWAIT|BUS_DMA_COHERENT);
1098 	if (error)
1099 		goto free;
1100 
1101 	error = bus_dmamap_create(sc->sc_dmatag, p->size, 1, p->size,
1102 				  0, BUS_DMA_NOWAIT, &p->map);
1103 	if (error)
1104 		goto unmap;
1105 
1106 	error = bus_dmamap_load(sc->sc_dmatag, p->map, p->addr, p->size, NULL,
1107 				BUS_DMA_NOWAIT);
1108 	if (error)
1109 		goto destroy;
1110 	return (0);
1111 
1112 destroy:
1113 	bus_dmamap_destroy(sc->sc_dmatag, p->map);
1114 unmap:
1115 	bus_dmamem_unmap(sc->sc_dmatag, p->addr, p->size);
1116 free:
1117 	bus_dmamem_free(sc->sc_dmatag, p->segs, p->nsegs);
1118 	return (error);
1119 }
1120 
1121 int
1122 yds_freemem(sc, p)
1123 	struct yds_softc *sc;
1124 	struct yds_dma *p;
1125 {
1126 	bus_dmamap_unload(sc->sc_dmatag, p->map);
1127 	bus_dmamap_destroy(sc->sc_dmatag, p->map);
1128 	bus_dmamem_unmap(sc->sc_dmatag, p->addr, p->size);
1129 	bus_dmamem_free(sc->sc_dmatag, p->segs, p->nsegs);
1130 	return 0;
1131 }
1132 
1133 int
1134 yds_open(addr, flags)
1135 	void *addr;
1136 	int flags;
1137 {
1138 	struct yds_softc *sc = addr;
1139 	int mode;
1140 
1141 	/* Select bank 0. */
1142 	YWRITE4(sc, YDS_CONTROL_SELECT, 0);
1143 
1144 	/* Start the DSP operation. */
1145 	mode = YREAD4(sc, YDS_MODE);
1146 	mode |= YDS_MODE_ACTV;
1147 	mode &= ~YDS_MODE_ACTV2;
1148 	YWRITE4(sc, YDS_MODE, mode);
1149 
1150 	return 0;
1151 }
1152 
1153 /*
1154  * Close function is called at splaudio().
1155  */
1156 void
1157 yds_close(addr)
1158 	void *addr;
1159 {
1160 	struct yds_softc *sc = addr;
1161 
1162 	yds_halt_output(sc);
1163 	yds_halt_input(sc);
1164 	yds_halt(sc);
1165 }
1166 
1167 int
1168 yds_query_encoding(addr, fp)
1169 	void *addr;
1170 	struct audio_encoding *fp;
1171 {
1172 	switch (fp->index) {
1173 	case 0:
1174 		strcpy(fp->name, AudioEulinear);
1175 		fp->encoding = AUDIO_ENCODING_ULINEAR;
1176 		fp->precision = 8;
1177 		fp->flags = 0;
1178 		return (0);
1179 	case 1:
1180 		strcpy(fp->name, AudioEmulaw);
1181 		fp->encoding = AUDIO_ENCODING_ULAW;
1182 		fp->precision = 8;
1183 		fp->flags = AUDIO_ENCODINGFLAG_EMULATED;
1184 		return (0);
1185 	case 2:
1186 		strcpy(fp->name, AudioEalaw);
1187 		fp->encoding = AUDIO_ENCODING_ALAW;
1188 		fp->precision = 8;
1189 		fp->flags = AUDIO_ENCODINGFLAG_EMULATED;
1190 		return (0);
1191 	case 3:
1192 		strcpy(fp->name, AudioEslinear);
1193 		fp->encoding = AUDIO_ENCODING_SLINEAR;
1194 		fp->precision = 8;
1195 		fp->flags = AUDIO_ENCODINGFLAG_EMULATED;
1196 		return (0);
1197 	case 4:
1198 		strcpy(fp->name, AudioEslinear_le);
1199 		fp->encoding = AUDIO_ENCODING_SLINEAR_LE;
1200 		fp->precision = 16;
1201 		fp->flags = 0;
1202 		return (0);
1203 	case 5:
1204 		strcpy(fp->name, AudioEulinear_le);
1205 		fp->encoding = AUDIO_ENCODING_ULINEAR_LE;
1206 		fp->precision = 16;
1207 		fp->flags = AUDIO_ENCODINGFLAG_EMULATED;
1208 		return (0);
1209 	case 6:
1210 		strcpy(fp->name, AudioEslinear_be);
1211 		fp->encoding = AUDIO_ENCODING_SLINEAR_BE;
1212 		fp->precision = 16;
1213 		fp->flags = AUDIO_ENCODINGFLAG_EMULATED;
1214 		return (0);
1215 	case 7:
1216 		strcpy(fp->name, AudioEulinear_be);
1217 		fp->encoding = AUDIO_ENCODING_ULINEAR_BE;
1218 		fp->precision = 16;
1219 		fp->flags = AUDIO_ENCODINGFLAG_EMULATED;
1220 		return (0);
1221 	default:
1222 		return (EINVAL);
1223 	}
1224 }
1225 
1226 int
1227 yds_set_params(addr, setmode, usemode, play, rec)
1228 	void *addr;
1229 	int setmode, usemode;
1230 	struct audio_params *play, *rec;
1231 {
1232 	struct audio_params *p;
1233 	int mode;
1234 
1235 	for (mode = AUMODE_RECORD; mode != -1;
1236 	     mode = mode == AUMODE_RECORD ? AUMODE_PLAY : -1) {
1237 		if ((setmode & mode) == 0)
1238 			continue;
1239 
1240 		p = mode == AUMODE_PLAY ? play : rec;
1241 
1242 		if (p->sample_rate < 4000 || p->sample_rate > 48000 ||
1243 		    (p->precision != 8 && p->precision != 16) ||
1244 		    (p->channels != 1 && p->channels != 2))
1245 			return (EINVAL);
1246 
1247 		p->factor = 1;
1248 		p->sw_code = 0;
1249 		switch (p->encoding) {
1250 		case AUDIO_ENCODING_SLINEAR_BE:
1251 			if (p->precision == 16)
1252 				p->sw_code = swap_bytes;
1253 			else
1254 				p->sw_code = change_sign8;
1255 			break;
1256 		case AUDIO_ENCODING_SLINEAR_LE:
1257 			if (p->precision != 16)
1258 				p->sw_code = change_sign8;
1259 			break;
1260 		case AUDIO_ENCODING_ULINEAR_BE:
1261 			if (p->precision == 16) {
1262 				if (mode == AUMODE_PLAY)
1263 					p->sw_code = swap_bytes_change_sign16_le;
1264 				else
1265 					p->sw_code = change_sign16_swap_bytes_le;
1266 			}
1267 			break;
1268 		case AUDIO_ENCODING_ULINEAR_LE:
1269 			if (p->precision == 16)
1270 				p->sw_code = change_sign16_le;
1271 			break;
1272 		case AUDIO_ENCODING_ULAW:
1273 			if (mode == AUMODE_PLAY) {
1274 				p->factor = 2;
1275 				p->precision = 16;
1276 				p->sw_code = mulaw_to_slinear16_le;
1277 			} else
1278 				p->sw_code = ulinear8_to_mulaw;
1279 			break;
1280 		case AUDIO_ENCODING_ALAW:
1281 			if (mode == AUMODE_PLAY) {
1282 				p->factor = 2;
1283 				p->precision = 16;
1284 				p->sw_code = alaw_to_slinear16_le;
1285 			} else
1286 				p->sw_code = ulinear8_to_alaw;
1287 			break;
1288 		default:
1289 			return (EINVAL);
1290 		}
1291 	}
1292 
1293 	return 0;
1294 }
1295 
1296 int
1297 yds_round_blocksize(addr, blk)
1298 	void *addr;
1299 	int blk;
1300 {
1301 	/*
1302 	 * Block size must be bigger than a frame.
1303 	 * That is 1024bytes at most, i.e. for 48000Hz, 16bit, 2ch.
1304 	 */
1305 	if (blk < 1024)
1306 		blk = 1024;
1307 
1308 	return blk & ~4;
1309 }
1310 
1311 static u_int32_t
1312 yds_get_lpfq(sample_rate)
1313 	u_int sample_rate;
1314 {
1315 	int i;
1316 	static struct lpfqt {
1317 		u_int rate;
1318 		u_int32_t lpfq;
1319 	} lpfqt[] = {
1320 		{8000,  0x32020000},
1321 		{11025, 0x31770000},
1322 		{16000, 0x31390000},
1323 		{22050, 0x31c90000},
1324 		{32000, 0x33d00000},
1325 		{48000, 0x40000000},
1326 		{0, 0}
1327 	};
1328 
1329 	if (sample_rate == 44100)		/* for P44 slot? */
1330 		return 0x370A0000;
1331 
1332 	for (i = 0; lpfqt[i].rate != 0; i++)
1333 		if (sample_rate <= lpfqt[i].rate)
1334 			break;
1335 
1336 	return lpfqt[i].lpfq;
1337 }
1338 
1339 static u_int32_t
1340 yds_get_lpfk(sample_rate)
1341 	u_int sample_rate;
1342 {
1343 	int i;
1344 	static struct lpfkt {
1345 		u_int rate;
1346 		u_int32_t lpfk;
1347 	} lpfkt[] = {
1348 		{8000,  0x18b20000},
1349 		{11025, 0x20930000},
1350 		{16000, 0x2b9a0000},
1351 		{22050, 0x35a10000},
1352 		{32000, 0x3eaa0000},
1353 		{48000, 0x40000000},
1354 		{0, 0}
1355 	};
1356 
1357 	if (sample_rate == 44100)		/* for P44 slot? */
1358 		return 0x46460000;
1359 
1360 	for (i = 0; lpfkt[i].rate != 0; i++)
1361 		if (sample_rate <= lpfkt[i].rate)
1362 			break;
1363 
1364 	return lpfkt[i].lpfk;
1365 }
1366 
1367 int
1368 yds_trigger_output(addr, start, end, blksize, intr, arg, param)
1369 	void *addr;
1370 	void *start, *end;
1371 	int blksize;
1372 	void (*intr) __P((void *));
1373 	void *arg;
1374 	struct audio_params *param;
1375 #define P44		(sc->sc_flags & YDS_CAP_HAS_P44)
1376 {
1377 	struct yds_softc *sc = addr;
1378 	struct yds_dma *p;
1379 	struct play_slot_ctrl_bank *psb;
1380 	const u_int gain = 0x40000000;
1381 	bus_addr_t s;
1382 	size_t l;
1383 	int i;
1384 	int p44, channels;
1385 
1386 #ifdef DIAGNOSTIC
1387 	if (sc->sc_play.intr)
1388 		panic("yds_trigger_output: already running");
1389 #endif
1390 
1391 	sc->sc_play.intr = intr;
1392 	sc->sc_play.intr_arg = arg;
1393 	sc->sc_play.offset = 0;
1394 	sc->sc_play.blksize = blksize;
1395 
1396 	DPRINTFN(1, ("yds_trigger_output: sc=%p start=%p end=%p "
1397 	    "blksize=%d intr=%p(%p)\n", addr, start, end, blksize, intr, arg));
1398 
1399 	p = yds_find_dma(sc, start);
1400 	if (!p) {
1401 		printf("yds_trigger_output: bad addr %p\n", start);
1402 		return (EINVAL);
1403 	}
1404 	sc->sc_play.dma = p;
1405 
1406 #ifdef DIAGNOSTIC
1407 	{
1408 		u_int32_t ctrlsize;
1409 		if ((ctrlsize = YREAD4(sc, YDS_PLAY_CTRLSIZE)) !=
1410 		    sizeof(struct play_slot_ctrl_bank) / sizeof(u_int32_t))
1411 			panic("%s: invalid play slot ctrldata %d %d",
1412 			      sc->sc_dev.dv_xname, ctrlsize,
1413 			      sizeof(struct play_slot_ctrl_bank));
1414 	}
1415 #endif
1416 
1417 #ifdef YDS_USE_P44
1418 	/* The document says the P44 SRC supports only stereo, 16bit PCM. */
1419 	if (P44)
1420 		p44 = ((param->sample_rate == 44100) &&
1421 		       (param->channels == 2) &&
1422 		       (param->precision == 16));
1423 	else
1424 #endif
1425 		p44 = 0;
1426 	channels = p44 ? 1 : param->channels;
1427 
1428 	s = DMAADDR(p);
1429 	l = ((char *)end - (char *)start);
1430 	sc->sc_play.length = l;
1431 
1432 	*sc->ptbl = channels;	/* Num of play */
1433 
1434 	sc->sc_play.factor = 1;
1435 	if (param->channels == 2)
1436 		sc->sc_play.factor *= 2;
1437 	if (param->precision != 8)
1438 		sc->sc_play.factor *= 2;
1439 	l /= sc->sc_play.factor;
1440 
1441 	psb = sc->pbankp[0];
1442 	memset(psb, 0, sizeof(*psb));
1443 	psb->format = ((channels == 2 ? PSLT_FORMAT_STEREO : 0) |
1444 		       (param->precision == 8 ? PSLT_FORMAT_8BIT : 0) |
1445 		       (p44 ? PSLT_FORMAT_SRC441 : 0));
1446 	psb->pgbase = s;
1447 	psb->pgloopend = l;
1448 	if (!p44) {
1449 		psb->pgdeltaend = (param->sample_rate * 65536 / 48000) << 12;
1450 		psb->lpfkend = yds_get_lpfk(param->sample_rate);
1451 		psb->eggainend = gain;
1452 		psb->lpfq = yds_get_lpfq(param->sample_rate);
1453 		psb->pgdelta = psb->pgdeltaend;
1454 		psb->lpfk = yds_get_lpfk(param->sample_rate);
1455 		psb->eggain = gain;
1456 	}
1457 
1458 	for (i = 0; i < channels; i++) {
1459 		/* i == 0: left or mono, i == 1: right */
1460 		psb = sc->pbankp[i*2];
1461 		if (i)
1462 			/* copy from left */
1463 			*psb = *(sc->pbankp[0]);
1464 		if (channels == 2) {
1465 			/* stereo */
1466 			if (i == 0) {
1467 				psb->lchgain = psb->lchgainend = gain;
1468 			} else {
1469 				psb->lchgain = psb->lchgainend = 0;
1470 				psb->rchgain = psb->rchgainend = gain;
1471 				psb->format |= PSLT_FORMAT_RCH;
1472 			}
1473 		} else if (!p44) {
1474 			/* mono */
1475 			psb->lchgain = psb->rchgain = gain;
1476 			psb->lchgainend = psb->rchgainend = gain;
1477 		}
1478 		/* copy to the other bank */
1479 		*(sc->pbankp[i*2+1]) = *psb;
1480 	}
1481 
1482 	YDS_DUMP_PLAY_SLOT(5, sc, 0);
1483 	YDS_DUMP_PLAY_SLOT(5, sc, 1);
1484 
1485 	if (p44)
1486 		YWRITE4(sc, YDS_P44_OUT_VOLUME, 0x3fff3fff);
1487 	else
1488 		YWRITE4(sc, YDS_DAC_OUT_VOLUME, 0x3fff3fff);
1489 
1490 	/* Now the play slot for the next frame is set up!! */
1491 	/* Sync play slot control data for both directions */
1492 	yds_bus_dmamap_sync(sc->sc_dmatag, sc->sc_ctrldata.map,
1493 	    sc->ptbloff, sizeof(struct play_slot_ctrl_bank) * channels *
1494 	    N_PLAY_SLOT_CTRL_BANK, BUS_DMASYNC_PREWRITE|BUS_DMASYNC_PREREAD);
1495 	/* Sync ring buffer */
1496 	yds_bus_dmamap_sync(sc->sc_dmatag, p->map, 0, blksize,
1497 	    BUS_DMASYNC_PREWRITE);
1498 	/* HERE WE GO!! */
1499 	YWRITE4(sc, YDS_MODE,
1500 		YREAD4(sc, YDS_MODE) | YDS_MODE_ACTV | YDS_MODE_ACTV2);
1501 
1502 	return 0;
1503 }
1504 #undef P44
1505 
1506 int
1507 yds_trigger_input(addr, start, end, blksize, intr, arg, param)
1508 	void *addr;
1509 	void *start, *end;
1510 	int blksize;
1511 	void (*intr) __P((void *));
1512 	void *arg;
1513 	struct audio_params *param;
1514 {
1515 	struct yds_softc *sc = addr;
1516 	struct yds_dma *p;
1517 	u_int srate, format;
1518 	struct rec_slot_ctrl_bank *rsb;
1519 	bus_addr_t s;
1520 	size_t l;
1521 
1522 #ifdef DIAGNOSTIC
1523 	if (sc->sc_rec.intr)
1524 		panic("yds_trigger_input: already running");
1525 #endif
1526 	sc->sc_rec.intr = intr;
1527 	sc->sc_rec.intr_arg = arg;
1528 	sc->sc_rec.offset = 0;
1529 	sc->sc_rec.blksize = blksize;
1530 
1531 	DPRINTFN(1, ("yds_trigger_input: "
1532 	    "sc=%p start=%p end=%p blksize=%d intr=%p(%p)\n",
1533 	    addr, start, end, blksize, intr, arg));
1534 	DPRINTFN(1, (" parameters: rate=%lu, precision=%u, channels=%u\n",
1535 	    param->sample_rate, param->precision, param->channels));
1536 
1537 	p = yds_find_dma(sc, start);
1538 	if (!p) {
1539 		printf("yds_trigger_input: bad addr %p\n", start);
1540 		return (EINVAL);
1541 	}
1542 	sc->sc_rec.dma = p;
1543 
1544 #ifdef DIAGNOSTIC
1545 	{
1546 		u_int32_t ctrlsize;
1547 		if ((ctrlsize = YREAD4(sc, YDS_REC_CTRLSIZE)) !=
1548 		    sizeof(struct rec_slot) / sizeof(u_int32_t))
1549 			panic("%s: invalid rec slot ctrldata %d",
1550 				sc->sc_dev.dv_xname, ctrlsize);
1551 	}
1552 #endif
1553 
1554 	s = DMAADDR(p);
1555 	l = ((char *)end - (char *)start);
1556 	sc->sc_rec.length = l;
1557 
1558 	sc->sc_rec.factor = 1;
1559 	if (param->channels == 2)
1560 		sc->sc_rec.factor *= 2;
1561 	if (param->precision != 8)
1562 		sc->sc_rec.factor *= 2;
1563 
1564 	rsb = &sc->rbank[0];
1565 	memset(rsb, 0, sizeof(*rsb));
1566 	rsb->pgbase = s;
1567 	rsb->pgloopendadr = l;
1568 	/* Seems all 4 banks must be set up... */
1569 	sc->rbank[1] = *rsb;
1570 	sc->rbank[2] = *rsb;
1571 	sc->rbank[3] = *rsb;
1572 
1573 	YWRITE4(sc, YDS_ADC_IN_VOLUME, 0x3fff3fff);
1574 	YWRITE4(sc, YDS_REC_IN_VOLUME, 0x3fff3fff);
1575 	srate = 48000 * 4096 / param->sample_rate - 1;
1576 	format = ((param->precision == 8 ? YDS_FORMAT_8BIT : 0) |
1577 		  (param->channels == 2 ? YDS_FORMAT_STEREO : 0));
1578 	DPRINTF(("srate=%d, format=%08x\n", srate, format));
1579 #ifdef YDS_USE_REC_SLOT
1580 	YWRITE4(sc, YDS_DAC_REC_VOLUME, 0x3fff3fff);
1581 	YWRITE4(sc, YDS_P44_REC_VOLUME, 0x3fff3fff);
1582 	YWRITE4(sc, YDS_MAPOF_REC, YDS_RECSLOT_VALID);
1583 	YWRITE4(sc, YDS_REC_SAMPLE_RATE, srate);
1584 	YWRITE4(sc, YDS_REC_FORMAT, format);
1585 #else
1586 	YWRITE4(sc, YDS_MAPOF_REC, YDS_ADCSLOT_VALID);
1587 	YWRITE4(sc, YDS_ADC_SAMPLE_RATE, srate);
1588 	YWRITE4(sc, YDS_ADC_FORMAT, format);
1589 #endif
1590 	/* Now the rec slot for the next frame is set up!! */
1591 	/* Sync record slot control data */
1592 	yds_bus_dmamap_sync(sc->sc_dmatag, sc->sc_ctrldata.map, sc->rbankoff,
1593 	    sizeof(struct rec_slot_ctrl_bank) * N_REC_SLOT_CTRL *
1594 	    N_REC_SLOT_CTRL_BANK, BUS_DMASYNC_PREWRITE|BUS_DMASYNC_PREREAD);
1595 	/* Sync ring buffer */
1596 	yds_bus_dmamap_sync(sc->sc_dmatag, p->map, 0, blksize, BUS_DMASYNC_PREREAD);
1597 	/* HERE WE GO!! */
1598 	YWRITE4(sc, YDS_MODE,
1599 		YREAD4(sc, YDS_MODE) | YDS_MODE_ACTV | YDS_MODE_ACTV2);
1600 
1601 	return 0;
1602 }
1603 
1604 static int
1605 yds_halt(sc)
1606 	struct yds_softc *sc;
1607 {
1608 	u_int32_t mode;
1609 
1610 	/* Stop the DSP operation. */
1611 	mode = YREAD4(sc, YDS_MODE);
1612 	YWRITE4(sc, YDS_MODE, mode & ~(YDS_MODE_ACTV|YDS_MODE_ACTV2));
1613 
1614 	/* Paranoia...  mute all */
1615 	YWRITE4(sc, YDS_P44_OUT_VOLUME, 0);
1616 	YWRITE4(sc, YDS_DAC_OUT_VOLUME, 0);
1617 	YWRITE4(sc, YDS_ADC_IN_VOLUME, 0);
1618 	YWRITE4(sc, YDS_REC_IN_VOLUME, 0);
1619 	YWRITE4(sc, YDS_DAC_REC_VOLUME, 0);
1620 	YWRITE4(sc, YDS_P44_REC_VOLUME, 0);
1621 
1622 	return 0;
1623 }
1624 
1625 int
1626 yds_halt_output(addr)
1627 	void *addr;
1628 {
1629 	struct yds_softc *sc = addr;
1630 
1631 	DPRINTF(("yds: yds_halt_output\n"));
1632 	if (sc->sc_play.intr) {
1633 		sc->sc_play.intr = 0;
1634 		/* Sync play slot control data */
1635 		yds_bus_dmamap_sync(sc->sc_dmatag, sc->sc_ctrldata.map,
1636 		    sc->pbankoff, sizeof(struct play_slot_ctrl_bank) *
1637 		    (*sc->ptbl)*N_PLAY_SLOT_CTRL_BANK,
1638 		    BUS_DMASYNC_POSTWRITE|BUS_DMASYNC_POSTREAD);
1639 		/* Stop the play slot operation */
1640 		sc->pbankp[0]->status =
1641 		sc->pbankp[1]->status =
1642 		sc->pbankp[2]->status =
1643 		sc->pbankp[3]->status = 1;
1644 		/* Sync ring buffer */
1645 		yds_bus_dmamap_sync(sc->sc_dmatag, sc->sc_play.dma->map, 0,
1646 		    sc->sc_play.length, BUS_DMASYNC_POSTWRITE);
1647 	}
1648 
1649 	return 0;
1650 }
1651 
1652 int
1653 yds_halt_input(addr)
1654 	void *addr;
1655 {
1656 	struct yds_softc *sc = addr;
1657 
1658 	DPRINTF(("yds: yds_halt_input\n"));
1659 	sc->sc_rec.intr = NULL;
1660 	if (sc->sc_rec.intr) {
1661 		/* Stop the rec slot operation */
1662 		YWRITE4(sc, YDS_MAPOF_REC, 0);
1663 		sc->sc_rec.intr = 0;
1664 		/* Sync rec slot control data */
1665 		yds_bus_dmamap_sync(sc->sc_dmatag, sc->sc_ctrldata.map,
1666 		    sc->rbankoff, sizeof(struct rec_slot_ctrl_bank)*
1667 		    N_REC_SLOT_CTRL*N_REC_SLOT_CTRL_BANK,
1668 		    BUS_DMASYNC_POSTWRITE|BUS_DMASYNC_POSTREAD);
1669 		/* Sync ring buffer */
1670 		yds_bus_dmamap_sync(sc->sc_dmatag, sc->sc_rec.dma->map, 0,
1671 		    sc->sc_rec.length, BUS_DMASYNC_POSTREAD);
1672 	}
1673 
1674 	return 0;
1675 }
1676 
1677 int
1678 yds_getdev(addr, retp)
1679 	void *addr;
1680 	struct audio_device *retp;
1681 {
1682 	*retp = yds_device;
1683 
1684 	return 0;
1685 }
1686 
1687 int
1688 yds_mixer_set_port(addr, cp)
1689 	void *addr;
1690 	mixer_ctrl_t *cp;
1691 {
1692 	struct yds_softc *sc = addr;
1693 
1694 	return (sc->sc_codec[0].codec_if->vtbl->mixer_set_port(
1695 	    sc->sc_codec[0].codec_if, cp));
1696 }
1697 
1698 int
1699 yds_mixer_get_port(addr, cp)
1700 	void *addr;
1701 	mixer_ctrl_t *cp;
1702 {
1703 	struct yds_softc *sc = addr;
1704 
1705 	return (sc->sc_codec[0].codec_if->vtbl->mixer_get_port(
1706 	    sc->sc_codec[0].codec_if, cp));
1707 }
1708 
1709 int
1710 yds_query_devinfo(addr, dip)
1711 	void *addr;
1712 	mixer_devinfo_t *dip;
1713 {
1714 	struct yds_softc *sc = addr;
1715 
1716 	return (sc->sc_codec[0].codec_if->vtbl->query_devinfo(
1717 	    sc->sc_codec[0].codec_if, dip));
1718 }
1719 
1720 int
1721 yds_get_portnum_by_name(sc, class, device, qualifier)
1722 	struct yds_softc *sc;
1723 	char *class, *device, *qualifier;
1724 {
1725 	return (sc->sc_codec[0].codec_if->vtbl->get_portnum_by_name(
1726 	    sc->sc_codec[0].codec_if, class, device, qualifier));
1727 }
1728 
1729 void *
1730 yds_malloc(addr, size, pool, flags)
1731 	void *addr;
1732 	u_long size;
1733 	int pool, flags;
1734 {
1735 	struct yds_softc *sc = addr;
1736 	struct yds_dma *p;
1737 	int error;
1738 
1739 	p = malloc(sizeof(*p), pool, flags);
1740 	if (!p)
1741 		return (0);
1742 	error = yds_allocmem(sc, size, 16, p);
1743 	if (error) {
1744 		free(p, pool);
1745 		return (0);
1746 	}
1747 	p->next = sc->sc_dmas;
1748 	sc->sc_dmas = p;
1749 	return (KERNADDR(p));
1750 }
1751 
1752 void
1753 yds_free(addr, ptr, pool)
1754 	void *addr;
1755 	void *ptr;
1756 	int pool;
1757 {
1758 	struct yds_softc *sc = addr;
1759 	struct yds_dma **pp, *p;
1760 
1761 	for (pp = &sc->sc_dmas; (p = *pp) != NULL; pp = &p->next) {
1762 		if (KERNADDR(p) == ptr) {
1763 			yds_freemem(sc, p);
1764 			*pp = p->next;
1765 			free(p, pool);
1766 			return;
1767 		}
1768 	}
1769 }
1770 
1771 static struct yds_dma *
1772 yds_find_dma(sc, addr)
1773 	struct yds_softc *sc;
1774 	void *addr;
1775 {
1776 	struct yds_dma *p;
1777 
1778 	for (p = sc->sc_dmas; p && KERNADDR(p) != addr; p = p->next)
1779 		;
1780 
1781 	return p;
1782 }
1783 
1784 u_long
1785 yds_round_buffersize(addr, size)
1786 	void *addr;
1787 	u_long size;
1788 {
1789 	/*
1790 	 * Buffer size should be at least twice as bigger as a frame.
1791 	 */
1792 	if (size < 1024 * 3)
1793 		size = 1024 * 3;
1794 	return (size);
1795 }
1796 
1797 int
1798 yds_mappage(addr, mem, off, prot)
1799 	void *addr;
1800 	void *mem;
1801 	int off;
1802 	int prot;
1803 {
1804 	struct yds_softc *sc = addr;
1805 	struct yds_dma *p;
1806 
1807 	if (off < 0)
1808 		return (-1);
1809 	p = yds_find_dma(sc, mem);
1810 	if (!p)
1811 		return (-1);
1812 	return (bus_dmamem_mmap(sc->sc_dmatag, p->segs, p->nsegs,
1813 				off, prot, BUS_DMA_WAITOK));
1814 }
1815 
1816 int
1817 yds_get_props(addr)
1818 	void *addr;
1819 {
1820 	return (AUDIO_PROP_MMAP | AUDIO_PROP_INDEPENDENT |
1821 		AUDIO_PROP_FULLDUPLEX);
1822 }
1823