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