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