1 /*- 2 * Copyright (c) 1999 Cameron Grant <cg@freebsd.org> 3 * 4 * Redistribution and use in source and binary forms, with or without 5 * modification, are permitted provided that the following conditions 6 * are met: 7 * 1. Redistributions of source code must retain the above copyright 8 * notice, this list of conditions and the following disclaimer. 9 * 2. Redistributions in binary form must reproduce the above copyright 10 * notice, this list of conditions and the following disclaimer in the 11 * documentation and/or other materials provided with the distribution. 12 * 13 * THIS SOFTWARE IS PROVIDED BY THE AUTHOR AND CONTRIBUTORS ``AS IS'' AND 14 * ANY EXPRESS OR IMPLIED WARRANTIES, INCLUDING, BUT NOT LIMITED TO, THE 15 * IMPLIED WARRANTIES OF MERCHANTABILITY AND FITNESS FOR A PARTICULAR PURPOSE 16 * ARE DISCLAIMED. IN NO EVENT SHALL THE AUTHOR OR CONTRIBUTORS BE LIABLE 17 * FOR ANY DIRECT, INDIRECT, INCIDENTAL, SPECIAL, EXEMPLARY, OR CONSEQUENTIAL 18 * DAMAGES (INCLUDING, BUT NOT LIMITED TO, PROCUREMENT OF SUBSTITUTE GOODS 19 * OR SERVICES; LOSS OF USE, DATA, OR PROFITS; OR BUSINESS INTERRUPTION) 20 * HOWEVER CAUSED AND ON ANY THEORY OF LIABILITY, WHETHER IN CONTRACT, STRICT 21 * LIABILITY, OR TORT (INCLUDING NEGLIGENCE OR OTHERWISE) ARISING IN ANY WAY 22 * OUT OF THE USE OF THIS SOFTWARE, EVEN IF ADVISED OF THE POSSIBILITY OF 23 * SUCH DAMAGE. 24 * 25 * $FreeBSD: src/sys/dev/sound/pci/solo.c,v 1.35.2.4 2006/07/13 01:53:54 yongari Exp $ 26 * $DragonFly: src/sys/dev/sound/pci/solo.c,v 1.10 2007/06/16 20:07:19 dillon Exp $ 27 */ 28 29 #include <dev/sound/pcm/sound.h> 30 31 #include <bus/pci/pcireg.h> 32 #include <bus/pci/pcivar.h> 33 34 #include <dev/sound/isa/sb.h> 35 #include <dev/sound/chip.h> 36 37 #include "mixer_if.h" 38 39 SND_DECLARE_FILE("$DragonFly: src/sys/dev/sound/pci/solo.c,v 1.10 2007/06/16 20:07:19 dillon Exp $"); 40 41 #define SOLO_DEFAULT_BUFSZ 16384 42 #define ABS(x) (((x) < 0)? -(x) : (x)) 43 44 /* if defined, playback always uses the 2nd channel and full duplex works */ 45 #define ESS18XX_DUPLEX 1 46 47 /* more accurate clocks and split audio1/audio2 rates */ 48 #define ESS18XX_NEWSPEED 49 50 /* 1 = INTR_MPSAFE, 0 = GIANT */ 51 #define ESS18XX_MPSAFE 1 52 53 static u_int32_t ess_playfmt[] = { 54 AFMT_U8, 55 AFMT_STEREO | AFMT_U8, 56 AFMT_S8, 57 AFMT_STEREO | AFMT_S8, 58 AFMT_S16_LE, 59 AFMT_STEREO | AFMT_S16_LE, 60 AFMT_U16_LE, 61 AFMT_STEREO | AFMT_U16_LE, 62 0 63 }; 64 static struct pcmchan_caps ess_playcaps = {6000, 48000, ess_playfmt, 0}; 65 66 /* 67 * Recording output is byte-swapped 68 */ 69 static u_int32_t ess_recfmt[] = { 70 AFMT_U8, 71 AFMT_STEREO | AFMT_U8, 72 AFMT_S8, 73 AFMT_STEREO | AFMT_S8, 74 AFMT_S16_BE, 75 AFMT_STEREO | AFMT_S16_BE, 76 AFMT_U16_BE, 77 AFMT_STEREO | AFMT_U16_BE, 78 0 79 }; 80 static struct pcmchan_caps ess_reccaps = {6000, 48000, ess_recfmt, 0}; 81 82 struct ess_info; 83 84 struct ess_chinfo { 85 struct ess_info *parent; 86 struct pcm_channel *channel; 87 struct snd_dbuf *buffer; 88 int dir, hwch, stopping; 89 u_int32_t fmt, spd, blksz; 90 }; 91 92 struct ess_info { 93 struct resource *io, *sb, *vc, *mpu, *gp; /* I/O address for the board */ 94 struct resource *irq; 95 void *ih; 96 bus_dma_tag_t parent_dmat; 97 98 int simplex_dir, type, duplex:1, newspeed:1, dmasz[2]; 99 unsigned int bufsz; 100 101 struct ess_chinfo pch, rch; 102 #if ESS18XX_MPSAFE == 1 103 sndlock_t lock; 104 #endif 105 }; 106 107 #if ESS18XX_MPSAFE == 1 108 #define ess_lock(_ess) snd_mtxlock((_ess)->lock) 109 #define ess_unlock(_ess) snd_mtxunlock((_ess)->lock) 110 #define ess_lock_assert(_ess) snd_mtxassert((_ess)->lock) 111 #else 112 #define ess_lock(_ess) 113 #define ess_unlock(_ess) 114 #define ess_lock_assert(_ess) 115 #endif 116 117 static int ess_rd(struct ess_info *sc, int reg); 118 static void ess_wr(struct ess_info *sc, int reg, u_int8_t val); 119 static int ess_dspready(struct ess_info *sc); 120 static int ess_cmd(struct ess_info *sc, u_char val); 121 static int ess_cmd1(struct ess_info *sc, u_char cmd, int val); 122 static int ess_get_byte(struct ess_info *sc); 123 static void ess_setmixer(struct ess_info *sc, u_int port, u_int value); 124 static int ess_getmixer(struct ess_info *sc, u_int port); 125 static int ess_reset_dsp(struct ess_info *sc); 126 127 static int ess_write(struct ess_info *sc, u_char reg, int val); 128 static int ess_read(struct ess_info *sc, u_char reg); 129 130 static void ess_intr(void *arg); 131 static int ess_setupch(struct ess_info *sc, int ch, int dir, int spd, u_int32_t fmt, int len); 132 static int ess_start(struct ess_chinfo *ch); 133 static int ess_stop(struct ess_chinfo *ch); 134 135 static int ess_dmasetup(struct ess_info *sc, int ch, u_int32_t base, u_int16_t cnt, int dir); 136 static int ess_dmapos(struct ess_info *sc, int ch); 137 static int ess_dmatrigger(struct ess_info *sc, int ch, int go); 138 139 /* 140 * Common code for the midi and pcm functions 141 * 142 * ess_cmd write a single byte to the CMD port. 143 * ess_cmd1 write a CMD + 1 byte arg 144 * ess_cmd2 write a CMD + 2 byte arg 145 * ess_get_byte returns a single byte from the DSP data port 146 * 147 * ess_write is actually ess_cmd1 148 * ess_read access ext. regs via ess_cmd(0xc0, reg) followed by ess_get_byte 149 */ 150 151 static int 152 port_rd(struct resource *port, int regno, int size) 153 { 154 bus_space_tag_t st = rman_get_bustag(port); 155 bus_space_handle_t sh = rman_get_bushandle(port); 156 157 switch (size) { 158 case 1: 159 return bus_space_read_1(st, sh, regno); 160 case 2: 161 return bus_space_read_2(st, sh, regno); 162 case 4: 163 return bus_space_read_4(st, sh, regno); 164 default: 165 return 0xffffffff; 166 } 167 } 168 169 static void 170 port_wr(struct resource *port, int regno, u_int32_t data, int size) 171 { 172 bus_space_tag_t st = rman_get_bustag(port); 173 bus_space_handle_t sh = rman_get_bushandle(port); 174 175 switch (size) { 176 case 1: 177 bus_space_write_1(st, sh, regno, data); 178 break; 179 case 2: 180 bus_space_write_2(st, sh, regno, data); 181 break; 182 case 4: 183 bus_space_write_4(st, sh, regno, data); 184 break; 185 } 186 } 187 188 static int 189 ess_rd(struct ess_info *sc, int reg) 190 { 191 return port_rd(sc->sb, reg, 1); 192 } 193 194 static void 195 ess_wr(struct ess_info *sc, int reg, u_int8_t val) 196 { 197 port_wr(sc->sb, reg, val, 1); 198 } 199 200 static int 201 ess_dspready(struct ess_info *sc) 202 { 203 return ((ess_rd(sc, SBDSP_STATUS) & 0x80) == 0); 204 } 205 206 static int 207 ess_dspwr(struct ess_info *sc, u_char val) 208 { 209 int i; 210 211 for (i = 0; i < 1000; i++) { 212 if (ess_dspready(sc)) { 213 ess_wr(sc, SBDSP_CMD, val); 214 return 1; 215 } 216 if (i > 10) DELAY((i > 100)? 1000 : 10); 217 } 218 kprintf("ess_dspwr(0x%02x) timed out.\n", val); 219 return 0; 220 } 221 222 static int 223 ess_cmd(struct ess_info *sc, u_char val) 224 { 225 DEB(kprintf("ess_cmd: %x\n", val)); 226 return ess_dspwr(sc, val); 227 } 228 229 static int 230 ess_cmd1(struct ess_info *sc, u_char cmd, int val) 231 { 232 DEB(kprintf("ess_cmd1: %x, %x\n", cmd, val)); 233 if (ess_dspwr(sc, cmd)) { 234 return ess_dspwr(sc, val & 0xff); 235 } else return 0; 236 } 237 238 static void 239 ess_setmixer(struct ess_info *sc, u_int port, u_int value) 240 { 241 DEB(kprintf("ess_setmixer: reg=%x, val=%x\n", port, value);) 242 ess_wr(sc, SB_MIX_ADDR, (u_char) (port & 0xff)); /* Select register */ 243 DELAY(10); 244 ess_wr(sc, SB_MIX_DATA, (u_char) (value & 0xff)); 245 DELAY(10); 246 } 247 248 static int 249 ess_getmixer(struct ess_info *sc, u_int port) 250 { 251 int val; 252 253 ess_wr(sc, SB_MIX_ADDR, (u_char) (port & 0xff)); /* Select register */ 254 DELAY(10); 255 val = ess_rd(sc, SB_MIX_DATA); 256 DELAY(10); 257 258 return val; 259 } 260 261 static int 262 ess_get_byte(struct ess_info *sc) 263 { 264 int i; 265 266 for (i = 1000; i > 0; i--) { 267 if (ess_rd(sc, 0xc) & 0x40) 268 return ess_rd(sc, DSP_READ); 269 else 270 DELAY(20); 271 } 272 return -1; 273 } 274 275 static int 276 ess_write(struct ess_info *sc, u_char reg, int val) 277 { 278 return ess_cmd1(sc, reg, val); 279 } 280 281 static int 282 ess_read(struct ess_info *sc, u_char reg) 283 { 284 return (ess_cmd(sc, 0xc0) && ess_cmd(sc, reg))? ess_get_byte(sc) : -1; 285 } 286 287 static int 288 ess_reset_dsp(struct ess_info *sc) 289 { 290 DEB(kprintf("ess_reset_dsp\n")); 291 ess_wr(sc, SBDSP_RST, 3); 292 DELAY(100); 293 ess_wr(sc, SBDSP_RST, 0); 294 if (ess_get_byte(sc) != 0xAA) { 295 DEB(kprintf("ess_reset_dsp failed\n")); 296 /* 297 rman_get_start(d->io_base))); 298 */ 299 return ENXIO; /* Sorry */ 300 } 301 ess_cmd(sc, 0xc6); 302 return 0; 303 } 304 305 static void 306 ess_intr(void *arg) 307 { 308 struct ess_info *sc = (struct ess_info *)arg; 309 int src, pirq = 0, rirq = 0; 310 311 ess_lock(sc); 312 src = 0; 313 if (ess_getmixer(sc, 0x7a) & 0x80) 314 src |= 2; 315 if (ess_rd(sc, 0x0c) & 0x01) 316 src |= 1; 317 318 if (src == 0) { 319 ess_unlock(sc); 320 return; 321 } 322 323 if (sc->duplex) { 324 pirq = (src & sc->pch.hwch)? 1 : 0; 325 rirq = (src & sc->rch.hwch)? 1 : 0; 326 } else { 327 if (sc->simplex_dir == PCMDIR_PLAY) 328 pirq = 1; 329 if (sc->simplex_dir == PCMDIR_REC) 330 rirq = 1; 331 if (!pirq && !rirq) 332 kprintf("solo: IRQ neither playback nor rec!\n"); 333 } 334 335 DEB(kprintf("ess_intr: pirq:%d rirq:%d\n",pirq,rirq)); 336 337 if (pirq) { 338 if (sc->pch.stopping) { 339 ess_dmatrigger(sc, sc->pch.hwch, 0); 340 sc->pch.stopping = 0; 341 if (sc->pch.hwch == 1) 342 ess_write(sc, 0xb8, ess_read(sc, 0xb8) & ~0x01); 343 else 344 ess_setmixer(sc, 0x78, ess_getmixer(sc, 0x78) & ~0x03); 345 } 346 ess_unlock(sc); 347 chn_intr(sc->pch.channel); 348 ess_lock(sc); 349 } 350 351 if (rirq) { 352 if (sc->rch.stopping) { 353 ess_dmatrigger(sc, sc->rch.hwch, 0); 354 sc->rch.stopping = 0; 355 /* XXX: will this stop audio2? */ 356 ess_write(sc, 0xb8, ess_read(sc, 0xb8) & ~0x01); 357 } 358 ess_unlock(sc); 359 chn_intr(sc->rch.channel); 360 ess_lock(sc); 361 } 362 363 if (src & 2) 364 ess_setmixer(sc, 0x7a, ess_getmixer(sc, 0x7a) & ~0x80); 365 if (src & 1) 366 ess_rd(sc, DSP_DATA_AVAIL); 367 368 ess_unlock(sc); 369 } 370 371 /* utility functions for ESS */ 372 static u_int8_t 373 ess_calcspeed8(int *spd) 374 { 375 int speed = *spd; 376 u_int32_t t; 377 378 if (speed > 22000) { 379 t = (795500 + speed / 2) / speed; 380 speed = (795500 + t / 2) / t; 381 t = (256 - t) | 0x80; 382 } else { 383 t = (397700 + speed / 2) / speed; 384 speed = (397700 + t / 2) / t; 385 t = 128 - t; 386 } 387 *spd = speed; 388 return t & 0x000000ff; 389 } 390 391 static u_int8_t 392 ess_calcspeed9(int *spd) 393 { 394 int speed, s0, s1, use0; 395 u_int8_t t0, t1; 396 397 /* rate = source / (256 - divisor) */ 398 /* divisor = 256 - (source / rate) */ 399 speed = *spd; 400 t0 = 128 - (793800 / speed); 401 s0 = 793800 / (128 - t0); 402 403 t1 = 128 - (768000 / speed); 404 s1 = 768000 / (128 - t1); 405 t1 |= 0x80; 406 407 use0 = (ABS(speed - s0) < ABS(speed - s1))? 1 : 0; 408 409 *spd = use0? s0 : s1; 410 return use0? t0 : t1; 411 } 412 413 static u_int8_t 414 ess_calcfilter(int spd) 415 { 416 int cutoff; 417 418 /* cutoff = 7160000 / (256 - divisor) */ 419 /* divisor = 256 - (7160000 / cutoff) */ 420 cutoff = (spd * 9 * 82) / 20; 421 return (256 - (7160000 / cutoff)); 422 } 423 424 static int 425 ess_setupch(struct ess_info *sc, int ch, int dir, int spd, u_int32_t fmt, int len) 426 { 427 int play = (dir == PCMDIR_PLAY)? 1 : 0; 428 int b16 = (fmt & AFMT_16BIT)? 1 : 0; 429 int stereo = (fmt & AFMT_STEREO)? 1 : 0; 430 int unsign = (fmt == AFMT_U8 || fmt == AFMT_U16_LE || fmt == AFMT_U16_BE)? 1 : 0; 431 u_int8_t spdval, fmtval; 432 433 DEB(kprintf("ess_setupch\n")); 434 spdval = (sc->newspeed)? ess_calcspeed9(&spd) : ess_calcspeed8(&spd); 435 436 sc->simplex_dir = play ? PCMDIR_PLAY : PCMDIR_REC ; 437 438 if (ch == 1) { 439 KASSERT((dir == PCMDIR_PLAY) || (dir == PCMDIR_REC), ("ess_setupch: dir1 bad")); 440 len = -len; 441 /* transfer length low */ 442 ess_write(sc, 0xa4, len & 0x00ff); 443 /* transfer length high */ 444 ess_write(sc, 0xa5, (len & 0xff00) >> 8); 445 /* autoinit, dma dir */ 446 ess_write(sc, 0xb8, 0x04 | (play? 0x00 : 0x0a)); 447 /* mono/stereo */ 448 ess_write(sc, 0xa8, (ess_read(sc, 0xa8) & ~0x03) | (stereo? 0x01 : 0x02)); 449 /* demand mode, 4 bytes/xfer */ 450 ess_write(sc, 0xb9, 0x02); 451 /* sample rate */ 452 ess_write(sc, 0xa1, spdval); 453 /* filter cutoff */ 454 ess_write(sc, 0xa2, ess_calcfilter(spd)); 455 /* setup dac/adc */ 456 /* 457 if (play) 458 ess_write(sc, 0xb6, unsign? 0x80 : 0x00); 459 */ 460 /* mono, b16: signed, load signal */ 461 /* 462 ess_write(sc, 0xb7, 0x51 | (unsign? 0x00 : 0x20)); 463 */ 464 /* setup fifo */ 465 ess_write(sc, 0xb7, 0x91 | (unsign? 0x00 : 0x20) | 466 (b16? 0x04 : 0x00) | 467 (stereo? 0x08 : 0x40)); 468 /* irq control */ 469 ess_write(sc, 0xb1, (ess_read(sc, 0xb1) & 0x0f) | 0x50); 470 /* drq control */ 471 ess_write(sc, 0xb2, (ess_read(sc, 0xb2) & 0x0f) | 0x50); 472 } else if (ch == 2) { 473 KASSERT(dir == PCMDIR_PLAY, ("ess_setupch: dir2 bad")); 474 len >>= 1; 475 len = -len; 476 /* transfer length low */ 477 ess_setmixer(sc, 0x74, len & 0x00ff); 478 /* transfer length high */ 479 ess_setmixer(sc, 0x76, (len & 0xff00) >> 8); 480 /* autoinit, 4 bytes/req */ 481 ess_setmixer(sc, 0x78, 0x10); 482 fmtval = b16 | (stereo << 1) | ((!unsign) << 2); 483 /* enable irq, set format */ 484 ess_setmixer(sc, 0x7a, 0x40 | fmtval); 485 if (sc->newspeed) { 486 /* sample rate */ 487 ess_setmixer(sc, 0x70, spdval); 488 /* filter cutoff */ 489 ess_setmixer(sc, 0x72, ess_calcfilter(spd)); 490 } 491 492 } 493 return 0; 494 } 495 static int 496 ess_start(struct ess_chinfo *ch) 497 { 498 struct ess_info *sc = ch->parent; 499 500 DEB(kprintf("ess_start\n");); 501 ess_setupch(sc, ch->hwch, ch->dir, ch->spd, ch->fmt, ch->blksz); 502 ch->stopping = 0; 503 if (ch->hwch == 1) { 504 ess_write(sc, 0xb8, ess_read(sc, 0xb8) | 0x01); 505 if (ch->dir == PCMDIR_PLAY) { 506 #if 0 507 DELAY(100000); /* 100 ms */ 508 #endif 509 ess_cmd(sc, 0xd1); 510 } 511 } else 512 ess_setmixer(sc, 0x78, ess_getmixer(sc, 0x78) | 0x03); 513 return 0; 514 } 515 516 static int 517 ess_stop(struct ess_chinfo *ch) 518 { 519 struct ess_info *sc = ch->parent; 520 521 DEB(kprintf("ess_stop\n")); 522 ch->stopping = 1; 523 if (ch->hwch == 1) 524 ess_write(sc, 0xb8, ess_read(sc, 0xb8) & ~0x04); 525 else 526 ess_setmixer(sc, 0x78, ess_getmixer(sc, 0x78) & ~0x10); 527 DEB(kprintf("done with stop\n")); 528 return 0; 529 } 530 531 /* -------------------------------------------------------------------- */ 532 /* channel interface for ESS18xx */ 533 static void * 534 esschan_init(kobj_t obj, void *devinfo, struct snd_dbuf *b, struct pcm_channel *c, int dir) 535 { 536 struct ess_info *sc = devinfo; 537 struct ess_chinfo *ch = (dir == PCMDIR_PLAY)? &sc->pch : &sc->rch; 538 539 DEB(kprintf("esschan_init\n")); 540 ch->parent = sc; 541 ch->channel = c; 542 ch->buffer = b; 543 ch->dir = dir; 544 if (sndbuf_alloc(ch->buffer, sc->parent_dmat, sc->bufsz) != 0) 545 return NULL; 546 ch->hwch = 1; 547 if ((dir == PCMDIR_PLAY) && (sc->duplex)) 548 ch->hwch = 2; 549 return ch; 550 } 551 552 static int 553 esschan_setformat(kobj_t obj, void *data, u_int32_t format) 554 { 555 struct ess_chinfo *ch = data; 556 557 ch->fmt = format; 558 return 0; 559 } 560 561 static int 562 esschan_setspeed(kobj_t obj, void *data, u_int32_t speed) 563 { 564 struct ess_chinfo *ch = data; 565 struct ess_info *sc = ch->parent; 566 567 ch->spd = speed; 568 if (sc->newspeed) 569 ess_calcspeed9(&ch->spd); 570 else 571 ess_calcspeed8(&ch->spd); 572 return ch->spd; 573 } 574 575 static int 576 esschan_setblocksize(kobj_t obj, void *data, u_int32_t blocksize) 577 { 578 struct ess_chinfo *ch = data; 579 580 ch->blksz = blocksize; 581 return ch->blksz; 582 } 583 584 static int 585 esschan_trigger(kobj_t obj, void *data, int go) 586 { 587 struct ess_chinfo *ch = data; 588 struct ess_info *sc = ch->parent; 589 590 DEB(kprintf("esschan_trigger: %d\n",go)); 591 if (go == PCMTRIG_EMLDMAWR || go == PCMTRIG_EMLDMARD) 592 return 0; 593 594 ess_lock(sc); 595 switch (go) { 596 case PCMTRIG_START: 597 ess_dmasetup(sc, ch->hwch, sndbuf_getbufaddr(ch->buffer), sndbuf_getsize(ch->buffer), ch->dir); 598 ess_dmatrigger(sc, ch->hwch, 1); 599 ess_start(ch); 600 break; 601 602 case PCMTRIG_STOP: 603 case PCMTRIG_ABORT: 604 default: 605 ess_stop(ch); 606 break; 607 } 608 ess_unlock(sc); 609 return 0; 610 } 611 612 static int 613 esschan_getptr(kobj_t obj, void *data) 614 { 615 struct ess_chinfo *ch = data; 616 struct ess_info *sc = ch->parent; 617 int ret; 618 619 ess_lock(sc); 620 ret = ess_dmapos(sc, ch->hwch); 621 ess_unlock(sc); 622 return ret; 623 } 624 625 static struct pcmchan_caps * 626 esschan_getcaps(kobj_t obj, void *data) 627 { 628 struct ess_chinfo *ch = data; 629 630 return (ch->dir == PCMDIR_PLAY)? &ess_playcaps : &ess_reccaps; 631 } 632 633 static kobj_method_t esschan_methods[] = { 634 KOBJMETHOD(channel_init, esschan_init), 635 KOBJMETHOD(channel_setformat, esschan_setformat), 636 KOBJMETHOD(channel_setspeed, esschan_setspeed), 637 KOBJMETHOD(channel_setblocksize, esschan_setblocksize), 638 KOBJMETHOD(channel_trigger, esschan_trigger), 639 KOBJMETHOD(channel_getptr, esschan_getptr), 640 KOBJMETHOD(channel_getcaps, esschan_getcaps), 641 { 0, 0 } 642 }; 643 CHANNEL_DECLARE(esschan); 644 645 /************************************************************/ 646 647 static int 648 essmix_init(struct snd_mixer *m) 649 { 650 struct ess_info *sc = mix_getdevinfo(m); 651 652 mix_setrecdevs(m, SOUND_MASK_CD | SOUND_MASK_MIC | SOUND_MASK_LINE | 653 SOUND_MASK_IMIX); 654 655 mix_setdevs(m, SOUND_MASK_SYNTH | SOUND_MASK_PCM | SOUND_MASK_LINE | 656 SOUND_MASK_MIC | SOUND_MASK_CD | SOUND_MASK_VOLUME | 657 SOUND_MASK_LINE1); 658 659 ess_setmixer(sc, 0, 0); /* reset */ 660 661 return 0; 662 } 663 664 static int 665 essmix_set(struct snd_mixer *m, unsigned dev, unsigned left, unsigned right) 666 { 667 struct ess_info *sc = mix_getdevinfo(m); 668 int preg = 0, rreg = 0, l, r; 669 670 l = (left * 15) / 100; 671 r = (right * 15) / 100; 672 switch (dev) { 673 case SOUND_MIXER_SYNTH: 674 preg = 0x36; 675 rreg = 0x6b; 676 break; 677 678 case SOUND_MIXER_PCM: 679 preg = 0x14; 680 rreg = 0x7c; 681 break; 682 683 case SOUND_MIXER_LINE: 684 preg = 0x3e; 685 rreg = 0x6e; 686 break; 687 688 case SOUND_MIXER_MIC: 689 preg = 0x1a; 690 rreg = 0x68; 691 break; 692 693 case SOUND_MIXER_LINE1: 694 preg = 0x3a; 695 rreg = 0x6c; 696 break; 697 698 case SOUND_MIXER_CD: 699 preg = 0x38; 700 rreg = 0x6a; 701 break; 702 703 case SOUND_MIXER_VOLUME: 704 l = left? (left * 63) / 100 : 64; 705 r = right? (right * 63) / 100 : 64; 706 ess_setmixer(sc, 0x60, l); 707 ess_setmixer(sc, 0x62, r); 708 left = (l == 64)? 0 : (l * 100) / 63; 709 right = (r == 64)? 0 : (r * 100) / 63; 710 return left | (right << 8); 711 } 712 713 if (preg) 714 ess_setmixer(sc, preg, (l << 4) | r); 715 if (rreg) 716 ess_setmixer(sc, rreg, (l << 4) | r); 717 718 left = (l * 100) / 15; 719 right = (r * 100) / 15; 720 721 return left | (right << 8); 722 } 723 724 static int 725 essmix_setrecsrc(struct snd_mixer *m, u_int32_t src) 726 { 727 struct ess_info *sc = mix_getdevinfo(m); 728 u_char recdev; 729 730 switch (src) { 731 case SOUND_MASK_CD: 732 recdev = 0x02; 733 break; 734 735 case SOUND_MASK_LINE: 736 recdev = 0x06; 737 break; 738 739 case SOUND_MASK_IMIX: 740 recdev = 0x05; 741 break; 742 743 case SOUND_MASK_MIC: 744 default: 745 recdev = 0x00; 746 src = SOUND_MASK_MIC; 747 break; 748 } 749 750 ess_setmixer(sc, 0x1c, recdev); 751 752 return src; 753 } 754 755 static kobj_method_t solomixer_methods[] = { 756 KOBJMETHOD(mixer_init, essmix_init), 757 KOBJMETHOD(mixer_set, essmix_set), 758 KOBJMETHOD(mixer_setrecsrc, essmix_setrecsrc), 759 { 0, 0 } 760 }; 761 MIXER_DECLARE(solomixer); 762 763 /************************************************************/ 764 765 static int 766 ess_dmasetup(struct ess_info *sc, int ch, u_int32_t base, u_int16_t cnt, int dir) 767 { 768 KASSERT(ch == 1 || ch == 2, ("bad ch")); 769 sc->dmasz[ch - 1] = cnt; 770 if (ch == 1) { 771 port_wr(sc->vc, 0x8, 0xc4, 1); /* command */ 772 port_wr(sc->vc, 0xd, 0xff, 1); /* reset */ 773 port_wr(sc->vc, 0xf, 0x01, 1); /* mask */ 774 port_wr(sc->vc, 0xb, dir == PCMDIR_PLAY? 0x58 : 0x54, 1); /* mode */ 775 port_wr(sc->vc, 0x0, base, 4); 776 port_wr(sc->vc, 0x4, cnt - 1, 2); 777 778 } else if (ch == 2) { 779 port_wr(sc->io, 0x6, 0x08, 1); /* autoinit */ 780 port_wr(sc->io, 0x0, base, 4); 781 port_wr(sc->io, 0x4, cnt, 2); 782 } 783 return 0; 784 } 785 786 static int 787 ess_dmapos(struct ess_info *sc, int ch) 788 { 789 int p = 0, i = 0, j = 0; 790 791 KASSERT(ch == 1 || ch == 2, ("bad ch")); 792 if (ch == 1) { 793 794 /* 795 * During recording, this register is known to give back 796 * garbage if it's not quiescent while being read. That's 797 * why we spl, stop the DMA, and try over and over until 798 * adjacent reads are "close", in the right order and not 799 * bigger than is otherwise possible. 800 */ 801 ess_dmatrigger(sc, ch, 0); 802 DELAY(20); 803 do { 804 DELAY(10); 805 if (j > 1) 806 kprintf("DMA count reg bogus: %04x & %04x\n", 807 i, p); 808 i = port_rd(sc->vc, 0x4, 2) + 1; 809 p = port_rd(sc->vc, 0x4, 2) + 1; 810 } while ((p > sc->dmasz[ch - 1] || i < p || (p - i) > 0x8) && j++ < 1000); 811 ess_dmatrigger(sc, ch, 1); 812 } 813 else if (ch == 2) 814 p = port_rd(sc->io, 0x4, 2); 815 return sc->dmasz[ch - 1] - p; 816 } 817 818 static int 819 ess_dmatrigger(struct ess_info *sc, int ch, int go) 820 { 821 KASSERT(ch == 1 || ch == 2, ("bad ch")); 822 if (ch == 1) 823 port_wr(sc->vc, 0xf, go? 0x00 : 0x01, 1); /* mask */ 824 else if (ch == 2) 825 port_wr(sc->io, 0x6, 0x08 | (go? 0x02 : 0x00), 1); /* autoinit */ 826 return 0; 827 } 828 829 static void 830 ess_release_resources(struct ess_info *sc, device_t dev) 831 { 832 if (sc->irq) { 833 if (sc->ih) 834 bus_teardown_intr(dev, sc->irq, sc->ih); 835 bus_release_resource(dev, SYS_RES_IRQ, 0, sc->irq); 836 sc->irq = 0; 837 } 838 if (sc->io) { 839 bus_release_resource(dev, SYS_RES_IOPORT, PCIR_BAR(0), sc->io); 840 sc->io = 0; 841 } 842 843 if (sc->sb) { 844 bus_release_resource(dev, SYS_RES_IOPORT, PCIR_BAR(1), sc->sb); 845 sc->sb = 0; 846 } 847 848 if (sc->vc) { 849 bus_release_resource(dev, SYS_RES_IOPORT, PCIR_BAR(2), sc->vc); 850 sc->vc = 0; 851 } 852 853 if (sc->mpu) { 854 bus_release_resource(dev, SYS_RES_IOPORT, PCIR_BAR(3), sc->mpu); 855 sc->mpu = 0; 856 } 857 858 if (sc->gp) { 859 bus_release_resource(dev, SYS_RES_IOPORT, PCIR_BAR(4), sc->gp); 860 sc->gp = 0; 861 } 862 863 if (sc->parent_dmat) { 864 bus_dma_tag_destroy(sc->parent_dmat); 865 sc->parent_dmat = 0; 866 } 867 868 #if ESS18XX_MPSAFE == 1 869 if (sc->lock) { 870 snd_mtxfree(sc->lock); 871 sc->lock = NULL; 872 } 873 #endif 874 875 kfree(sc, M_DEVBUF); 876 } 877 878 static int 879 ess_alloc_resources(struct ess_info *sc, device_t dev) 880 { 881 int rid; 882 883 rid = PCIR_BAR(0); 884 sc->io = bus_alloc_resource_any(dev, SYS_RES_IOPORT, &rid, RF_ACTIVE); 885 886 rid = PCIR_BAR(1); 887 sc->sb = bus_alloc_resource_any(dev, SYS_RES_IOPORT, &rid, RF_ACTIVE); 888 889 rid = PCIR_BAR(2); 890 sc->vc = bus_alloc_resource_any(dev, SYS_RES_IOPORT, &rid, RF_ACTIVE); 891 892 rid = PCIR_BAR(3); 893 sc->mpu = bus_alloc_resource_any(dev, SYS_RES_IOPORT, &rid, RF_ACTIVE); 894 895 rid = PCIR_BAR(4); 896 sc->gp = bus_alloc_resource_any(dev, SYS_RES_IOPORT, &rid, RF_ACTIVE); 897 898 rid = 0; 899 sc->irq = bus_alloc_resource_any(dev, SYS_RES_IRQ, &rid, 900 RF_ACTIVE | RF_SHAREABLE); 901 902 #if ESS18XX_MPSAFE == 1 903 sc->lock = snd_mtxcreate(device_get_nameunit(dev), "sound softc"); 904 905 return (sc->irq && sc->io && sc->sb && sc->vc && 906 sc->mpu && sc->gp && sc->lock)? 0 : ENXIO; 907 #else 908 return (sc->irq && sc->io && sc->sb && sc->vc && sc->mpu && sc->gp)? 0 : ENXIO; 909 #endif 910 } 911 912 static int 913 ess_probe(device_t dev) 914 { 915 char *s = NULL; 916 u_int32_t subdev; 917 918 subdev = (pci_get_subdevice(dev) << 16) | pci_get_subvendor(dev); 919 switch (pci_get_devid(dev)) { 920 case 0x1969125d: 921 if (subdev == 0x8888125d) 922 s = "ESS Solo-1E"; 923 else if (subdev == 0x1818125d) 924 s = "ESS Solo-1"; 925 else 926 s = "ESS Solo-1 (unknown vendor)"; 927 break; 928 } 929 930 if (s) 931 device_set_desc(dev, s); 932 return s ? BUS_PROBE_DEFAULT : ENXIO; 933 } 934 935 #define ESS_PCI_LEGACYCONTROL 0x40 936 #define ESS_PCI_CONFIG 0x50 937 #define ESS_PCI_DDMACONTROL 0x60 938 939 static int 940 ess_suspend(device_t dev) 941 { 942 return 0; 943 } 944 945 static int 946 ess_resume(device_t dev) 947 { 948 uint16_t ddma; 949 uint32_t data; 950 struct ess_info *sc = pcm_getdevinfo(dev); 951 952 ess_lock(sc); 953 data = pci_read_config(dev, PCIR_COMMAND, 2); 954 data |= PCIM_CMD_PORTEN | PCIM_CMD_BUSMASTEREN; 955 pci_write_config(dev, PCIR_COMMAND, data, 2); 956 data = pci_read_config(dev, PCIR_COMMAND, 2); 957 958 ddma = rman_get_start(sc->vc) | 1; 959 pci_write_config(dev, ESS_PCI_LEGACYCONTROL, 0x805f, 2); 960 pci_write_config(dev, ESS_PCI_DDMACONTROL, ddma, 2); 961 pci_write_config(dev, ESS_PCI_CONFIG, 0, 2); 962 963 if (ess_reset_dsp(sc)) { 964 ess_unlock(sc); 965 goto no; 966 } 967 ess_unlock(sc); 968 if (mixer_reinit(dev)) 969 goto no; 970 ess_lock(sc); 971 if (sc->newspeed) 972 ess_setmixer(sc, 0x71, 0x2a); 973 974 port_wr(sc->io, 0x7, 0xb0, 1); /* enable irqs */ 975 ess_unlock(sc); 976 977 return 0; 978 no: 979 return EIO; 980 } 981 982 static int 983 ess_attach(device_t dev) 984 { 985 struct ess_info *sc; 986 char status[SND_STATUSLEN]; 987 u_int16_t ddma; 988 u_int32_t data; 989 990 sc = (struct ess_info *)kmalloc(sizeof *sc, M_DEVBUF, M_NOWAIT | M_ZERO); 991 if (!sc) 992 return ENXIO; 993 994 data = pci_read_config(dev, PCIR_COMMAND, 2); 995 data |= PCIM_CMD_PORTEN | PCIM_CMD_BUSMASTEREN; 996 pci_write_config(dev, PCIR_COMMAND, data, 2); 997 data = pci_read_config(dev, PCIR_COMMAND, 2); 998 999 if (ess_alloc_resources(sc, dev)) 1000 goto no; 1001 1002 sc->bufsz = pcm_getbuffersize(dev, 4096, SOLO_DEFAULT_BUFSZ, 65536); 1003 1004 ddma = rman_get_start(sc->vc) | 1; 1005 pci_write_config(dev, ESS_PCI_LEGACYCONTROL, 0x805f, 2); 1006 pci_write_config(dev, ESS_PCI_DDMACONTROL, ddma, 2); 1007 pci_write_config(dev, ESS_PCI_CONFIG, 0, 2); 1008 1009 port_wr(sc->io, 0x7, 0xb0, 1); /* enable irqs */ 1010 #ifdef ESS18XX_DUPLEX 1011 sc->duplex = 1; 1012 #else 1013 sc->duplex = 0; 1014 #endif 1015 1016 #ifdef ESS18XX_NEWSPEED 1017 sc->newspeed = 1; 1018 #else 1019 sc->newspeed = 0; 1020 #endif 1021 if (snd_setup_intr(dev, sc->irq, 1022 #if ESS18XX_MPSAFE == 1 1023 INTR_MPSAFE 1024 #else 1025 0 1026 #endif 1027 , ess_intr, sc, &sc->ih)) { 1028 device_printf(dev, "unable to map interrupt\n"); 1029 goto no; 1030 } 1031 1032 if (!sc->duplex) 1033 pcm_setflags(dev, pcm_getflags(dev) | SD_F_SIMPLEX); 1034 1035 #if 0 1036 if (bus_dma_tag_create(/*parent*/NULL, /*alignment*/65536, /*boundary*/0, 1037 #endif 1038 if (bus_dma_tag_create(/*parent*/NULL, /*alignment*/2, /*boundary*/0, 1039 /*lowaddr*/BUS_SPACE_MAXADDR_24BIT, 1040 /*highaddr*/BUS_SPACE_MAXADDR, 1041 /*filter*/NULL, /*filterarg*/NULL, 1042 /*maxsize*/sc->bufsz, /*nsegments*/1, 1043 /*maxsegz*/0x3ffff, 1044 /*flags*/0, 1045 &sc->parent_dmat) != 0) { 1046 device_printf(dev, "unable to create dma tag\n"); 1047 goto no; 1048 } 1049 1050 if (ess_reset_dsp(sc)) 1051 goto no; 1052 1053 if (sc->newspeed) 1054 ess_setmixer(sc, 0x71, 0x2a); 1055 1056 if (mixer_init(dev, &solomixer_class, sc)) 1057 goto no; 1058 1059 ksnprintf(status, SND_STATUSLEN, "at io 0x%lx,0x%lx,0x%lx irq %ld %s", 1060 rman_get_start(sc->io), rman_get_start(sc->sb), rman_get_start(sc->vc), 1061 rman_get_start(sc->irq),PCM_KLDSTRING(snd_solo)); 1062 1063 if (pcm_register(dev, sc, 1, 1)) 1064 goto no; 1065 pcm_addchan(dev, PCMDIR_REC, &esschan_class, sc); 1066 pcm_addchan(dev, PCMDIR_PLAY, &esschan_class, sc); 1067 pcm_setstatus(dev, status); 1068 1069 return 0; 1070 1071 no: 1072 ess_release_resources(sc, dev); 1073 return ENXIO; 1074 } 1075 1076 static int 1077 ess_detach(device_t dev) 1078 { 1079 int r; 1080 struct ess_info *sc; 1081 1082 r = pcm_unregister(dev); 1083 if (r) 1084 return r; 1085 1086 sc = pcm_getdevinfo(dev); 1087 ess_release_resources(sc, dev); 1088 return 0; 1089 } 1090 1091 static device_method_t ess_methods[] = { 1092 /* Device interface */ 1093 DEVMETHOD(device_probe, ess_probe), 1094 DEVMETHOD(device_attach, ess_attach), 1095 DEVMETHOD(device_detach, ess_detach), 1096 DEVMETHOD(device_resume, ess_resume), 1097 DEVMETHOD(device_suspend, ess_suspend), 1098 1099 { 0, 0 } 1100 }; 1101 1102 static driver_t ess_driver = { 1103 "pcm", 1104 ess_methods, 1105 PCM_SOFTC_SIZE, 1106 }; 1107 1108 DRIVER_MODULE(snd_solo, pci, ess_driver, pcm_devclass, 0, 0); 1109 MODULE_DEPEND(snd_solo, sound, SOUND_MINVER, SOUND_PREFVER, SOUND_MAXVER); 1110 MODULE_VERSION(snd_solo, 1); 1111 1112 1113 1114