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