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