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