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