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