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