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