sb16.c revision 55428
1/* 2 * Copyright (c) 1999 Cameron Grant <gandalf@vilnya.demon.co.uk> 3 * Copyright 1997,1998 Luigi Rizzo. 4 * 5 * Derived from files in the Voxware 3.5 distribution, 6 * Copyright by Hannu Savolainen 1994, under the same copyright 7 * conditions. 8 * All rights reserved. 9 * 10 * Redistribution and use in source and binary forms, with or without 11 * modification, are permitted provided that the following conditions 12 * are met: 13 * 1. Redistributions of source code must retain the above copyright 14 * notice, this list of conditions and the following disclaimer. 15 * 2. Redistributions in binary form must reproduce the above copyright 16 * notice, this list of conditions and the following disclaimer in the 17 * documentation and/or other materials provided with the distribution. 18 * 19 * THIS SOFTWARE IS PROVIDED BY THE AUTHOR AND CONTRIBUTORS ``AS IS'' AND 20 * ANY EXPRESS OR IMPLIED WARRANTIES, INCLUDING, BUT NOT LIMITED TO, THE 21 * IMPLIED WARRANTIES OF MERCHANTABILITY AND FITNESS FOR A PARTICULAR PURPOSE 22 * ARE DISCLAIMED. IN NO EVENT SHALL THE AUTHOR OR CONTRIBUTORS BE LIABLE 23 * FOR ANY DIRECT, INDIRECT, INCIDENTAL, SPECIAL, EXEMPLARY, OR CONSEQUENTIAL 24 * DAMAGES (INCLUDING, BUT NOT LIMITED TO, PROCUREMENT OF SUBSTITUTE GOODS 25 * OR SERVICES; LOSS OF USE, DATA, OR PROFITS; OR BUSINESS INTERRUPTION) 26 * HOWEVER CAUSED AND ON ANY THEORY OF LIABILITY, WHETHER IN CONTRACT, STRICT 27 * LIABILITY, OR TORT (INCLUDING NEGLIGENCE OR OTHERWISE) ARISING IN ANY WAY 28 * OUT OF THE USE OF THIS SOFTWARE, EVEN IF ADVISED OF THE POSSIBILITY OF 29 * SUCH DAMAGE. 30 * 31 * $FreeBSD: head/sys/dev/sound/isa/sb16.c 55428 2000-01-05 04:01:34Z cg $ 32 */ 33 34#include <dev/sound/pcm/sound.h> 35 36#include "sbc.h" 37 38#define __SB_MIXER_C__ /* XXX warning... */ 39#include <dev/sound/isa/sb.h> 40#include <dev/sound/chip.h> 41 42#define ESS_BUFFSIZE (65536 - 256) 43 44/* channel interface */ 45static void *sbchan_init(void *devinfo, snd_dbuf *b, pcm_channel *c, int dir); 46static int sbchan_setdir(void *data, int dir); 47static int sbchan_setformat(void *data, u_int32_t format); 48static int sbchan_setspeed(void *data, u_int32_t speed); 49static int sbchan_setblocksize(void *data, u_int32_t blocksize); 50static int sbchan_trigger(void *data, int go); 51static int sbchan_getptr(void *data); 52static pcmchan_caps *sbchan_getcaps(void *data); 53 54/* channel interface for ESS */ 55static void *esschan_init(void *devinfo, snd_dbuf *b, pcm_channel *c, int dir); 56static int esschan_setdir(void *data, int dir); 57static int esschan_setformat(void *data, u_int32_t format); 58static int esschan_setspeed(void *data, u_int32_t speed); 59static int esschan_setblocksize(void *data, u_int32_t blocksize); 60static int esschan_trigger(void *data, int go); 61static int esschan_getptr(void *data); 62static pcmchan_caps *esschan_getcaps(void *data); 63 64static pcmchan_caps sb_playcaps = { 65 4000, 22050, 66 AFMT_U8, 67 AFMT_U8 68}; 69 70static pcmchan_caps sb_reccaps = { 71 4000, 13000, 72 AFMT_U8, 73 AFMT_U8 74}; 75 76static pcmchan_caps sbpro_playcaps = { 77 4000, 45000, 78 AFMT_STEREO | AFMT_U8, 79 AFMT_STEREO | AFMT_U8 80}; 81 82static pcmchan_caps sbpro_reccaps = { 83 4000, 15000, 84 AFMT_STEREO | AFMT_U8, 85 AFMT_STEREO | AFMT_U8 86}; 87 88static pcmchan_caps sb16_hcaps = { 89 5000, 45000, 90 AFMT_STEREO | AFMT_S16_LE, 91 AFMT_STEREO | AFMT_S16_LE 92}; 93 94static pcmchan_caps sb16_lcaps = { 95 5000, 45000, 96 AFMT_STEREO | AFMT_U8, 97 AFMT_STEREO | AFMT_U8 98}; 99 100static pcmchan_caps sb16x_caps = { 101 5000, 49000, 102 AFMT_STEREO | AFMT_U8 | AFMT_S16_LE, 103 AFMT_STEREO | AFMT_S16_LE 104}; 105 106static pcmchan_caps ess_playcaps = { 107 5000, 49000, 108 AFMT_STEREO | AFMT_U8 | AFMT_S16_LE, 109 AFMT_STEREO | AFMT_S16_LE 110}; 111 112static pcmchan_caps ess_reccaps = { 113 5000, 49000, 114 AFMT_STEREO | AFMT_U8 | AFMT_S16_LE, 115 AFMT_STEREO | AFMT_S16_LE 116}; 117 118static pcm_channel sb_chantemplate = { 119 sbchan_init, 120 sbchan_setdir, 121 sbchan_setformat, 122 sbchan_setspeed, 123 sbchan_setblocksize, 124 sbchan_trigger, 125 sbchan_getptr, 126 sbchan_getcaps, 127}; 128 129static pcm_channel ess_chantemplate = { 130 esschan_init, 131 esschan_setdir, 132 esschan_setformat, 133 esschan_setspeed, 134 esschan_setblocksize, 135 esschan_trigger, 136 esschan_getptr, 137 esschan_getcaps, 138}; 139#define PLAIN_SB16(x) ((((x)->bd_flags) & (BD_F_SB16|BD_F_SB16X)) == BD_F_SB16) 140 141struct sb_info; 142 143struct sb_chinfo { 144 struct sb_info *parent; 145 pcm_channel *channel; 146 snd_dbuf *buffer; 147 int dir; 148 u_int32_t fmt; 149 int ess_dma_started; 150}; 151 152struct sb_info { 153 struct resource *io_base; /* I/O address for the board */ 154 struct resource *irq; 155 struct resource *drq1; 156 struct resource *drq2; 157 bus_dma_tag_t parent_dmat; 158 159 int bd_id; 160 u_long bd_flags; /* board-specific flags */ 161 struct sb_chinfo pch, rch; 162}; 163 164static int sb_rd(struct sb_info *sb, int reg); 165static void sb_wr(struct sb_info *sb, int reg, u_int8_t val); 166static int sb_dspready(struct sb_info *sb); 167static int sb_cmd(struct sb_info *sb, u_char val); 168static int sb_cmd1(struct sb_info *sb, u_char cmd, int val); 169static int sb_cmd2(struct sb_info *sb, u_char cmd, int val); 170static u_int sb_get_byte(struct sb_info *sb); 171static void sb_setmixer(struct sb_info *sb, u_int port, u_int value); 172static int sb_getmixer(struct sb_info *sb, u_int port); 173static int sb_reset_dsp(struct sb_info *sb); 174 175static void sb_intr(void *arg); 176static int sb_format(struct sb_chinfo *ch, u_int32_t format); 177static int sb_speed(struct sb_chinfo *ch, int speed); 178static int sb_start(struct sb_chinfo *ch); 179static int sb_stop(struct sb_chinfo *ch); 180 181static int ess_write(struct sb_info *sb, u_char reg, int val); 182static int ess_read(struct sb_info *sb, u_char reg); 183static void ess_intr(void *arg); 184static int ess_format(struct sb_chinfo *ch, u_int32_t format); 185static int ess_speed(struct sb_chinfo *ch, int speed); 186static int ess_start(struct sb_chinfo *ch); 187static int ess_stop(struct sb_chinfo *ch); 188static int ess_abort(struct sb_chinfo *ch); 189 190static int sbmix_init(snd_mixer *m); 191static int sbmix_set(snd_mixer *m, unsigned dev, unsigned left, unsigned right); 192static int sbmix_setrecsrc(snd_mixer *m, u_int32_t src); 193 194static snd_mixer sb_mixer = { 195 "SoundBlaster mixer", 196 sbmix_init, 197 sbmix_set, 198 sbmix_setrecsrc, 199}; 200 201static devclass_t pcm_devclass; 202 203/* 204 * Common code for the midi and pcm functions 205 * 206 * sb_cmd write a single byte to the CMD port. 207 * sb_cmd1 write a CMD + 1 byte arg 208 * sb_cmd2 write a CMD + 2 byte arg 209 * sb_get_byte returns a single byte from the DSP data port 210 * 211 * ess_write is actually sb_cmd1 212 * ess_read access ext. regs via sb_cmd(0xc0, reg) followed by sb_get_byte 213 */ 214 215static int 216port_rd(struct resource *port, int off) 217{ 218 return bus_space_read_1(rman_get_bustag(port), 219 rman_get_bushandle(port), 220 off); 221} 222 223static void 224port_wr(struct resource *port, int off, u_int8_t data) 225{ 226 return bus_space_write_1(rman_get_bustag(port), 227 rman_get_bushandle(port), 228 off, data); 229} 230 231static int 232sb_rd(struct sb_info *sb, int reg) 233{ 234 return port_rd(sb->io_base, reg); 235} 236 237static void 238sb_wr(struct sb_info *sb, int reg, u_int8_t val) 239{ 240 port_wr(sb->io_base, reg, val); 241} 242 243static int 244sb_dspready(struct sb_info *sb) 245{ 246 return ((sb_rd(sb, SBDSP_STATUS) & 0x80) == 0); 247} 248 249static int 250sb_dspwr(struct sb_info *sb, u_char val) 251{ 252 int i; 253 254 for (i = 0; i < 1000; i++) { 255 if (sb_dspready(sb)) { 256 sb_wr(sb, SBDSP_CMD, val); 257 return 1; 258 } 259 if (i > 10) DELAY((i > 100)? 1000 : 10); 260 } 261 printf("sb_dspwr(0x%02x) timed out.\n", val); 262 return 0; 263} 264 265static int 266sb_cmd(struct sb_info *sb, u_char val) 267{ 268#if 0 269 printf("sb_cmd: %x\n", val); 270#endif 271 return sb_dspwr(sb, val); 272} 273 274static int 275sb_cmd1(struct sb_info *sb, u_char cmd, int val) 276{ 277#if 0 278 printf("sb_cmd1: %x, %x\n", cmd, val); 279#endif 280 if (sb_dspwr(sb, cmd)) { 281 return sb_dspwr(sb, val & 0xff); 282 } else return 0; 283} 284 285static int 286sb_cmd2(struct sb_info *sb, u_char cmd, int val) 287{ 288#if 0 289 printf("sb_cmd2: %x, %x\n", cmd, val); 290#endif 291 if (sb_dspwr(sb, cmd)) { 292 return sb_dspwr(sb, val & 0xff) && 293 sb_dspwr(sb, (val >> 8) & 0xff); 294 } else return 0; 295} 296 297/* 298 * in the SB, there is a set of indirect "mixer" registers with 299 * address at offset 4, data at offset 5 300 */ 301static void 302sb_setmixer(struct sb_info *sb, u_int port, u_int value) 303{ 304 u_long flags; 305 306 flags = spltty(); 307 sb_wr(sb, SB_MIX_ADDR, (u_char) (port & 0xff)); /* Select register */ 308 DELAY(10); 309 sb_wr(sb, SB_MIX_DATA, (u_char) (value & 0xff)); 310 DELAY(10); 311 splx(flags); 312} 313 314static int 315sb_getmixer(struct sb_info *sb, u_int port) 316{ 317 int val; 318 u_long flags; 319 320 flags = spltty(); 321 sb_wr(sb, SB_MIX_ADDR, (u_char) (port & 0xff)); /* Select register */ 322 DELAY(10); 323 val = sb_rd(sb, SB_MIX_DATA); 324 DELAY(10); 325 splx(flags); 326 327 return val; 328} 329 330static u_int 331sb_get_byte(struct sb_info *sb) 332{ 333 int i; 334 335 for (i = 1000; i > 0; i--) { 336 if (sb_rd(sb, DSP_DATA_AVAIL) & 0x80) 337 return sb_rd(sb, DSP_READ); 338 else 339 DELAY(20); 340 } 341 return 0xffff; 342} 343 344static int 345ess_write(struct sb_info *sb, u_char reg, int val) 346{ 347 return sb_cmd1(sb, reg, val); 348} 349 350static int 351ess_read(struct sb_info *sb, u_char reg) 352{ 353 return (sb_cmd(sb, 0xc0) && sb_cmd(sb, reg))? sb_get_byte(sb) : 0xffff; 354} 355 356static int 357sb_reset_dsp(struct sb_info *sb) 358{ 359 sb_wr(sb, SBDSP_RST, 3); 360 DELAY(100); 361 sb_wr(sb, SBDSP_RST, 0); 362 if (sb_get_byte(sb) != 0xAA) { 363 DEB(printf("sb_reset_dsp 0x%lx failed\n", 364 rman_get_start(d->io_base))); 365 return ENXIO; /* Sorry */ 366 } 367 if (sb->bd_flags & BD_F_ESS) sb_cmd(sb, 0xc6); 368 return 0; 369} 370 371static void 372sb_release_resources(struct sb_info *sb, device_t dev) 373{ 374 /* should we bus_teardown_intr here? */ 375 if (sb->irq) { 376 bus_release_resource(dev, SYS_RES_IRQ, 0, sb->irq); 377 sb->irq = 0; 378 } 379 if (sb->drq1) { 380 bus_release_resource(dev, SYS_RES_DRQ, 0, sb->drq1); 381 sb->drq1 = 0; 382 } 383 if (sb->drq2) { 384 bus_release_resource(dev, SYS_RES_DRQ, 1, sb->drq2); 385 sb->drq2 = 0; 386 } 387 if (sb->io_base) { 388 bus_release_resource(dev, SYS_RES_IOPORT, 0, sb->io_base); 389 sb->io_base = 0; 390 } 391 free(sb, M_DEVBUF); 392} 393 394static int 395sb_alloc_resources(struct sb_info *sb, device_t dev) 396{ 397 int rid; 398 399 rid = 0; 400 if (!sb->io_base) 401 sb->io_base = bus_alloc_resource(dev, SYS_RES_IOPORT, 402 &rid, 0, ~0, 1, 403 RF_ACTIVE); 404 rid = 0; 405 if (!sb->irq) 406 sb->irq = bus_alloc_resource(dev, SYS_RES_IRQ, 407 &rid, 0, ~0, 1, 408 RF_ACTIVE); 409 rid = 0; 410 if (!sb->drq1) 411 sb->drq1 = bus_alloc_resource(dev, SYS_RES_DRQ, 412 &rid, 0, ~0, 1, 413 RF_ACTIVE); 414 rid = 1; 415 if (!sb->drq2 && !(sb->bd_flags & BD_F_ESS)) 416 sb->drq2 = bus_alloc_resource(dev, SYS_RES_DRQ, 417 &rid, 0, ~0, 1, 418 RF_ACTIVE); 419 420 if (sb->io_base && sb->drq1 && sb->irq) { 421 int bs = (sb->bd_flags & BD_F_ESS)? ESS_BUFFSIZE : DSP_BUFFSIZE; 422 423 isa_dma_acquire(rman_get_start(sb->drq1)); 424 isa_dmainit(rman_get_start(sb->drq1), bs); 425 426 if (sb->drq2) { 427 isa_dma_acquire(rman_get_start(sb->drq2)); 428 isa_dmainit(rman_get_start(sb->drq2), bs); 429 } 430 431 return 0; 432 } else return ENXIO; 433} 434 435static void 436sb16_swap(void *v, int dir) 437{ 438 struct sb_info *sb = v; 439 int pb = sb->pch.buffer->dl; 440 int rb = sb->rch.buffer->dl; 441 int pc = sb->pch.buffer->chan; 442 int rc = sb->rch.buffer->chan; 443 int swp = 0; 444 445 if (!pb && !rb) { 446 if (dir == PCMDIR_PLAY && pc < 4) swp = 1; 447 else if (dir == PCMDIR_REC && rc < 4) swp = 1; 448 if (sb->bd_flags & BD_F_SB16X) swp = !swp; 449 if (swp) { 450 int t; 451 452 t = sb->pch.buffer->chan; 453 sb->pch.buffer->chan = sb->rch.buffer->chan; 454 sb->rch.buffer->chan = t; 455 sb->pch.buffer->dir = B_WRITE; 456 sb->rch.buffer->dir = B_READ; 457 } 458 } 459} 460 461static int 462sb_doattach(device_t dev, struct sb_info *sb) 463{ 464 snddev_info *d = device_get_softc(dev); 465 void *ih; 466 char status[SND_STATUSLEN]; 467 int bs = (sb->bd_flags & BD_F_ESS)? ESS_BUFFSIZE : DSP_BUFFSIZE; 468 469 if (sb_alloc_resources(sb, dev)) goto no; 470 if (sb_reset_dsp(sb)) goto no; 471 mixer_init(d, &sb_mixer, sb); 472 473 if (sb->bd_flags & BD_F_ESS) 474 bus_setup_intr(dev, sb->irq, INTR_TYPE_TTY, ess_intr, sb, &ih); 475 else 476 bus_setup_intr(dev, sb->irq, INTR_TYPE_TTY, sb_intr, sb, &ih); 477 if ((sb->bd_flags & BD_F_SB16) && !(sb->bd_flags & BD_F_SB16X)) 478 pcm_setswap(dev, sb16_swap); 479 if (!sb->drq2) 480 pcm_setflags(dev, pcm_getflags(dev) | SD_F_SIMPLEX); 481 482 if (bus_dma_tag_create(/*parent*/NULL, /*alignment*/2, /*boundary*/0, 483 /*lowaddr*/BUS_SPACE_MAXADDR_24BIT, 484 /*highaddr*/BUS_SPACE_MAXADDR, 485 /*filter*/NULL, /*filterarg*/NULL, 486 /*maxsize*/bs, /*nsegments*/1, 487 /*maxsegz*/0x3ffff, 488 /*flags*/0, &sb->parent_dmat) != 0) { 489 device_printf(dev, "unable to create dma tag\n"); 490 goto no; 491 } 492 493 snprintf(status, SND_STATUSLEN, "at io 0x%lx irq %ld drq %ld", 494 rman_get_start(sb->io_base), rman_get_start(sb->irq), 495 rman_get_start(sb->drq1)); 496 if (sb->drq2) snprintf(status + strlen(status), SND_STATUSLEN - strlen(status), 497 ":%ld", rman_get_start(sb->drq2)); 498 499 if (pcm_register(dev, sb, 1, 1)) goto no; 500 if (sb->bd_flags & BD_F_ESS) { 501 pcm_addchan(dev, PCMDIR_REC, &ess_chantemplate, sb); 502 pcm_addchan(dev, PCMDIR_PLAY, &ess_chantemplate, sb); 503 } else { 504 pcm_addchan(dev, PCMDIR_REC, &sb_chantemplate, sb); 505 pcm_addchan(dev, PCMDIR_PLAY, &sb_chantemplate, sb); 506 } 507 pcm_setstatus(dev, status); 508 509 return 0; 510 511no: 512 sb_release_resources(sb, dev); 513 return ENXIO; 514} 515 516static void 517sb_intr(void *arg) 518{ 519 struct sb_info *sb = (struct sb_info *)arg; 520 int reason = 3, c; 521 522 /* 523 * SB < 4.0 is half duplex and has only 1 bit for int source, 524 * so we fake it. SB 4.x (SB16) has the int source in a separate 525 * register. 526 * The Vibra16X has separate flags for 8 and 16 bit transfers, but 527 * I have no idea how to tell capture from playback interrupts... 528 */ 529 if (sb->bd_flags & BD_F_SB16) { 530 c = sb_getmixer(sb, IRQ_STAT); 531 /* this tells us if the source is 8-bit or 16-bit dma. We 532 * have to check the io channel to map it to read or write... 533 */ 534 reason = 0; 535 if (c & 1) { /* 8-bit dma */ 536 if (sb->pch.fmt & AFMT_U8) reason |= 1; 537 if (sb->rch.fmt & AFMT_U8) reason |= 2; 538 } 539 if (c & 2) { /* 16-bit dma */ 540 if (sb->pch.fmt & AFMT_S16_LE) reason |= 1; 541 if (sb->rch.fmt & AFMT_S16_LE) reason |= 2; 542 } 543 } else c = 1; 544#if 0 545 printf("sb_intr: reason=%d c=0x%x\n", reason, c); 546#endif 547 if ((reason & 1) && (sb->pch.buffer->dl > 0)) 548 chn_intr(sb->pch.channel); 549 if ((reason & 2) && (sb->rch.buffer->dl > 0)) 550 chn_intr(sb->rch.channel); 551 if (c & 1) sb_rd(sb, DSP_DATA_AVAIL); /* 8-bit int ack */ 552 if (c & 2) sb_rd(sb, DSP_DATA_AVL16); /* 16-bit int ack */ 553} 554 555static void 556ess_intr(void *arg) 557{ 558 struct sb_info *sb = (struct sb_info *)arg; 559 sb_rd(sb, DSP_DATA_AVAIL); /* int ack */ 560#ifdef notyet 561 /* 562 * XXX 563 * for full-duplex mode: 564 * should read port 0x6 to identify where interrupt came from. 565 */ 566#endif 567 /* 568 * We are transferring data in DSP normal mode, 569 * so clear the dl to indicate the DMA is stopped. 570 */ 571 if (sb->pch.buffer->dl > 0) { 572 sb->pch.buffer->dl = -1; 573 chn_intr(sb->pch.channel); 574 } 575 if (sb->rch.buffer->dl > 0) { 576 sb->rch.buffer->dl = -1; 577 chn_intr(sb->rch.channel); 578 } 579} 580 581static int 582sb_format(struct sb_chinfo *ch, u_int32_t format) 583{ 584 ch->fmt = format; 585 return 0; 586} 587 588static int 589sb_speed(struct sb_chinfo *ch, int speed) 590{ 591 struct sb_info *sb = ch->parent; 592 int play = (ch->dir == PCMDIR_PLAY)? 1 : 0; 593 int stereo = (ch->fmt & AFMT_STEREO)? 1 : 0; 594 595 if (sb->bd_flags & BD_F_SB16) { 596 RANGE(speed, 5000, 45000); 597 sb_cmd(sb, 0x42 - play); 598 sb_cmd(sb, speed >> 8); 599 sb_cmd(sb, speed & 0xff); 600 } else { 601 u_char tconst; 602 int max_speed = 45000, tmp; 603 u_long flags; 604 605 /* here enforce speed limitations - max 22050 on sb 1.x*/ 606 if (sb->bd_id <= 0x200) max_speed = 22050; 607 608 /* 609 * SB models earlier than SB Pro have low limit for the 610 * input rate. Note that this is only for input, but since 611 * we do not support separate values for rec & play.... 612 */ 613 if (!play) { 614 if (sb->bd_id <= 0x200) max_speed = 13000; 615 else if (sb->bd_id < 0x300) max_speed = 15000; 616 } 617 RANGE(speed, 4000, max_speed); 618 if (stereo) speed <<= 1; 619 620 /* 621 * Now the speed should be valid. Compute the value to be 622 * programmed into the board. 623 */ 624 if (speed > 22050) { /* High speed mode on 2.01/3.xx */ 625 tconst = (u_char) 626 ((65536 - ((256000000 + speed / 2) / speed)) 627 >> 8); 628 sb->bd_flags |= BD_F_HISPEED; 629 tmp = 65536 - (tconst << 8); 630 speed = (256000000 + tmp / 2) / tmp; 631 } else { 632 sb->bd_flags &= ~BD_F_HISPEED; 633 tconst = (256 - ((1000000 + speed / 2) / speed)) & 0xff; 634 tmp = 256 - tconst; 635 speed = (1000000 + tmp / 2) / tmp; 636 } 637 flags = spltty(); 638 sb_cmd1(sb, 0x40, tconst); /* set time constant */ 639 splx(flags); 640 if (stereo) speed >>= 1; 641 } 642 return speed; 643} 644 645static int 646sb_start(struct sb_chinfo *ch) 647{ 648 struct sb_info *sb = ch->parent; 649 int play = (ch->dir == PCMDIR_PLAY)? 1 : 0; 650 int b16 = (ch->fmt & AFMT_S16_LE)? 1 : 0; 651 int stereo = (ch->fmt & AFMT_STEREO)? 1 : 0; 652 int l = ch->buffer->dl; 653 int dh = ch->buffer->chan > 3; 654 u_char i1, i2; 655 656 if (b16 || dh) l >>= 1; 657 l--; 658 if (play) sb_cmd(sb, DSP_CMD_SPKON); 659 if (sb->bd_flags & BD_F_SB16) { 660 i1 = DSP_F16_AUTO | DSP_F16_FIFO_ON | 661 (play? DSP_F16_DAC : DSP_F16_ADC); 662 i1 |= (b16 || dh)? DSP_DMA16 : DSP_DMA8; 663 i2 = (stereo? DSP_F16_STEREO : 0) | (b16? DSP_F16_SIGNED : 0); 664 sb_cmd(sb, i1); 665 sb_cmd2(sb, i2, l); 666 } else { 667 if (sb->bd_flags & BD_F_HISPEED) i1 = play? 0x90 : 0x98; 668 else i1 = play? 0x1c : 0x2c; 669 sb_setmixer(sb, 0x0e, stereo? 2 : 0); 670 /* an ESS extension -- they can do 16 bits */ 671 if (b16) i1 |= 1; 672 sb_cmd2(sb, 0x48, l); 673 sb_cmd(sb, i1); 674 } 675 sb->bd_flags |= BD_F_DMARUN << b16; 676 return 0; 677} 678 679static int 680sb_stop(struct sb_chinfo *ch) 681{ 682 struct sb_info *sb = ch->parent; 683 int play = (ch->dir == PCMDIR_PLAY)? 1 : 0; 684 int b16 = (ch->fmt & AFMT_S16_LE)? 1 : 0; 685 686 if (sb->bd_flags & BD_F_HISPEED) sb_reset_dsp(sb); 687 else { 688 sb_cmd(sb, b16? DSP_CMD_DMAPAUSE_16 : DSP_CMD_DMAPAUSE_8); 689 /* 690 * The above seems to have the undocumented side effect of 691 * blocking the other side as well. If the other 692 * channel was active (SB16) I have to re-enable it :( 693 */ 694 if (sb->bd_flags & (BD_F_DMARUN << (1 - b16))) 695 sb_cmd(sb, b16? 0xd4 : 0xd6 ); 696 } 697 if (play) sb_cmd(sb, DSP_CMD_SPKOFF); /* speaker off */ 698 sb->bd_flags &= ~(BD_F_DMARUN << b16); 699 return 0; 700} 701 702/* utility functions for ESS */ 703static int 704ess_format(struct sb_chinfo *ch, u_int32_t format) 705{ 706 struct sb_info *sb = ch->parent; 707 int play = (ch->dir == PCMDIR_PLAY)? 1 : 0; 708 int b16 = (format & AFMT_S16_LE)? 1 : 0; 709 int stereo = (format & AFMT_STEREO)? 1 : 0; 710 u_char c; 711 ch->fmt = format; 712 sb_reset_dsp(sb); 713 /* auto-init DMA mode */ 714 ess_write(sb, 0xb8, play ? 0x04 : 0x0e); 715 /* mono/stereo */ 716 c = (ess_read(sb, 0xa8) & ~0x03) | 1; 717 if (!stereo) c++; 718 ess_write(sb, 0xa8, c); 719 /* demand mode, 4 bytes/xfer */ 720 ess_write(sb, 0xb9, 2); 721 /* setup dac/adc */ 722 if (play) ess_write(sb, 0xb6, b16? 0x00 : 0x80); 723 ess_write(sb, 0xb7, 0x51 | (b16? 0x20 : 0x00)); 724 ess_write(sb, 0xb7, 0x98 + (b16? 0x24 : 0x00) + (stereo? 0x00 : 0x38)); 725 /* irq/drq control */ 726 ess_write(sb, 0xb1, (ess_read(sb, 0xb1) & 0x0f) | 0x50); 727 ess_write(sb, 0xb2, (ess_read(sb, 0xb2) & 0x0f) | 0x50); 728 return 0; 729} 730 731static int 732ess_speed(struct sb_chinfo *ch, int speed) 733{ 734 struct sb_info *sb = ch->parent; 735 int t; 736 RANGE (speed, 5000, 49000); 737 if (speed > 22000) { 738 t = (795500 + speed / 2) / speed; 739 speed = (795500 + t / 2) / t; 740 t = (256 - t ) | 0x80; 741 } else { 742 t = (397700 + speed / 2) / speed; 743 speed = (397700 + t / 2) / t; 744 t = 128 - t; 745 } 746 ess_write(sb, 0xa1, t); /* set time constant */ 747#if 0 748 d->play_speed = d->rec_speed = speed; 749 speed = (speed * 9 ) / 20; 750#endif 751 t = 256 - 7160000 / ((speed * 9 / 20) * 82); 752 ess_write(sb, 0xa2, t); 753 return speed; 754} 755 756static int 757ess_start(struct sb_chinfo *ch) 758{ 759 struct sb_info *sb = ch->parent; 760 int play = (ch->dir == PCMDIR_PLAY)? 1 : 0; 761 short c = - ch->buffer->dl; 762 u_char c1; 763 /* 764 * clear bit 0 of register B8h 765 */ 766#if 1 767 c1 = play ? 0x04 : 0x0e; 768 ess_write(sb, 0xb8, c1++); 769#else 770 c1 = ess_read(sb, 0xb8) & 0xfe; 771 ess_write(sb, 0xb8, c1++); 772#endif 773 /* 774 * update ESS Transfer Count Register 775 */ 776 ess_write(sb, 0xa4, (u_char)((u_short)c & 0xff)); 777 ess_write(sb, 0xa5, (u_char)(((u_short)c >> 8) & 0xff)); 778 /* 779 * set bit 0 of register B8h 780 */ 781 ess_write(sb, 0xb8, c1); 782 if (play) 783 sb_cmd(sb, DSP_CMD_SPKON); 784 return 0; 785} 786 787static int 788ess_stop(struct sb_chinfo *ch) 789{ 790 struct sb_info *sb = ch->parent; 791 /* 792 * no need to send a stop command if the DMA has already stopped. 793 */ 794 if (ch->buffer->dl > 0) { 795 sb_cmd(sb, DSP_CMD_DMAPAUSE_8); /* pause dma. */ 796 } 797 return 0; 798} 799 800static int 801ess_abort(struct sb_chinfo *ch) 802{ 803 struct sb_info *sb = ch->parent; 804 int play = (ch->dir == PCMDIR_PLAY)? 1 : 0; 805 if (play) sb_cmd(sb, DSP_CMD_SPKOFF); /* speaker off */ 806 sb_reset_dsp(sb); 807 ess_format(ch, ch->fmt); 808 ess_speed(ch, ch->channel->speed); 809 return 0; 810} 811 812/* channel interface */ 813static void * 814sbchan_init(void *devinfo, snd_dbuf *b, pcm_channel *c, int dir) 815{ 816 struct sb_info *sb = devinfo; 817 struct sb_chinfo *ch = (dir == PCMDIR_PLAY)? &sb->pch : &sb->rch; 818 int dch, dl, dh; 819 820 ch->parent = sb; 821 ch->channel = c; 822 ch->buffer = b; 823 ch->buffer->bufsize = DSP_BUFFSIZE; 824 if (chn_allocbuf(ch->buffer, sb->parent_dmat) == -1) return NULL; 825 dch = (dir == PCMDIR_PLAY)? 1 : 0; 826 if (sb->bd_flags & BD_F_SB16X) dch = !dch; 827 dl = rman_get_start(sb->drq1); 828 if (sb->drq2) dh = rman_get_start(sb->drq2); else dh = dl; 829 ch->buffer->chan = dch? dh : dl; 830 return ch; 831} 832 833static int 834sbchan_setdir(void *data, int dir) 835{ 836 struct sb_chinfo *ch = data; 837 ch->dir = dir; 838 return 0; 839} 840 841static int 842sbchan_setformat(void *data, u_int32_t format) 843{ 844 struct sb_chinfo *ch = data; 845 sb_format(ch, format); 846 return 0; 847} 848 849static int 850sbchan_setspeed(void *data, u_int32_t speed) 851{ 852 struct sb_chinfo *ch = data; 853 return sb_speed(ch, speed); 854} 855 856static int 857sbchan_setblocksize(void *data, u_int32_t blocksize) 858{ 859 return blocksize; 860} 861 862static int 863sbchan_trigger(void *data, int go) 864{ 865 struct sb_chinfo *ch = data; 866 if (go == PCMTRIG_EMLDMAWR) return 0; 867 buf_isadma(ch->buffer, go); 868 if (go == PCMTRIG_START) sb_start(ch); else sb_stop(ch); 869 return 0; 870} 871 872static int 873sbchan_getptr(void *data) 874{ 875 struct sb_chinfo *ch = data; 876 return buf_isadmaptr(ch->buffer); 877} 878 879static pcmchan_caps * 880sbchan_getcaps(void *data) 881{ 882 struct sb_chinfo *ch = data; 883 int p = (ch->dir == PCMDIR_PLAY)? 1 : 0; 884 if (ch->parent->bd_id < 0x300) 885 return p? &sb_playcaps : &sb_reccaps; 886 else if (ch->parent->bd_id < 0x400) 887 return p? &sbpro_playcaps : &sbpro_reccaps; 888 else if (ch->parent->bd_flags & BD_F_SB16X) 889 return &sb16x_caps; 890 else 891 return (ch->buffer->chan >= 4)? &sb16_hcaps : &sb16_lcaps; 892} 893/* channel interface for ESS18xx */ 894static void * 895esschan_init(void *devinfo, snd_dbuf *b, pcm_channel *c, int dir) 896{ 897 struct sb_info *sb = devinfo; 898 struct sb_chinfo *ch = (dir == PCMDIR_PLAY)? &sb->pch : &sb->rch; 899 900 ch->parent = sb; 901 ch->channel = c; 902 ch->buffer = b; 903 ch->buffer->bufsize = ESS_BUFFSIZE; 904 if (chn_allocbuf(ch->buffer, sb->parent_dmat) == -1) return NULL; 905 ch->buffer->chan = rman_get_start(sb->drq1); 906 return ch; 907} 908 909static int 910esschan_setdir(void *data, int dir) 911{ 912 struct sb_chinfo *ch = data; 913 ch->dir = dir; 914 return 0; 915} 916 917static int 918esschan_setformat(void *data, u_int32_t format) 919{ 920 struct sb_chinfo *ch = data; 921 ess_format(ch, format); 922 return 0; 923} 924 925static int 926esschan_setspeed(void *data, u_int32_t speed) 927{ 928 struct sb_chinfo *ch = data; 929 return ess_speed(ch, speed); 930} 931 932static int 933esschan_setblocksize(void *data, u_int32_t blocksize) 934{ 935 return blocksize; 936} 937 938static int 939esschan_trigger(void *data, int go) 940{ 941 struct sb_chinfo *ch = data; 942 if (go == PCMTRIG_EMLDMAWR) return 0; 943 switch (go) { 944 case PCMTRIG_START: 945 if (!ch->ess_dma_started) 946 buf_isadma(ch->buffer, go); 947 ch->ess_dma_started = 1; 948 ess_start(ch); 949 break; 950 case PCMTRIG_STOP: 951 if (ch->buffer->dl >= 0) { 952 buf_isadma(ch->buffer, go); 953 ch->ess_dma_started = 0; 954 ess_stop(ch); 955 } 956 break; 957 case PCMTRIG_ABORT: 958 default: 959 ch->ess_dma_started = 0; 960 ess_abort(ch); 961 buf_isadma(ch->buffer, go); 962 break; 963 } 964 return 0; 965} 966 967static int 968esschan_getptr(void *data) 969{ 970 struct sb_chinfo *ch = data; 971 return buf_isadmaptr(ch->buffer); 972} 973 974static pcmchan_caps * 975esschan_getcaps(void *data) 976{ 977 struct sb_chinfo *ch = data; 978 return (ch->dir == PCMDIR_PLAY)? &ess_playcaps : &ess_reccaps; 979} 980 981/************************************************************/ 982 983static int 984sbmix_init(snd_mixer *m) 985{ 986 struct sb_info *sb = mix_getdevinfo(m); 987 988 switch (sb->bd_flags & BD_F_MIX_MASK) { 989 case BD_F_MIX_CT1345: /* SB 3.0 has 1345 mixer */ 990 mix_setdevs(m, SBPRO_MIXER_DEVICES); 991 mix_setrecdevs(m, SBPRO_RECORDING_DEVICES); 992 sb_setmixer(sb, 0, 1); /* reset mixer */ 993 if (!(sb->bd_flags & BD_F_ESS)) 994 sb_setmixer(sb, MIC_VOL, 0x6); /* mic volume max */ 995 sb_setmixer(sb, RECORD_SRC, 0x0); /* mic source */ 996 sb_setmixer(sb, FM_VOL, 0x0); /* no midi */ 997 break; 998 999 case BD_F_MIX_CT1745: /* SB16 mixer ... */ 1000 mix_setdevs(m, SB16_MIXER_DEVICES); 1001 mix_setrecdevs(m, SB16_RECORDING_DEVICES); 1002 sb_setmixer(sb, 0x3c, 0x1f); /* make all output active */ 1003 sb_setmixer(sb, 0x3d, 0); /* make all inputs-l off */ 1004 sb_setmixer(sb, 0x3e, 0); /* make all inputs-r off */ 1005 } 1006 return 0; 1007} 1008 1009static int 1010sbmix_set(snd_mixer *m, unsigned dev, unsigned left, unsigned right) 1011{ 1012 struct sb_info *sb = mix_getdevinfo(m); 1013 int regoffs; 1014 u_char val; 1015 mixer_tab *iomap; 1016 1017 switch (sb->bd_flags & BD_F_MIX_MASK) { 1018 case BD_F_MIX_CT1345: 1019 if (sb->bd_flags & BD_F_ESS) 1020 iomap = &ess_mix; 1021 else 1022 iomap = &sbpro_mix; 1023 break; 1024 1025 case BD_F_MIX_CT1745: 1026 iomap = &sb16_mix; 1027 break; 1028 1029 default: 1030 return -1; 1031 } 1032 1033 /* Change left channel */ 1034 regoffs = (*iomap)[dev][LEFT_CHN].regno; 1035 if (regoffs != 0) { 1036 val = sb_getmixer(sb, regoffs); 1037 change_bits(iomap, &val, dev, LEFT_CHN, left); 1038 sb_setmixer(sb, regoffs, val); 1039 } 1040 1041 /* Change right channel */ 1042 regoffs = (*iomap)[dev][RIGHT_CHN].regno; 1043 if (regoffs != 0) { 1044 val = sb_getmixer(sb, regoffs); /* Read the new one */ 1045 change_bits(iomap, &val, dev, RIGHT_CHN, right); 1046 sb_setmixer(sb, regoffs, val); 1047 } else 1048 right = left; 1049 1050 return left | (right << 8); 1051} 1052 1053static int 1054sbmix_setrecsrc(snd_mixer *m, u_int32_t src) 1055{ 1056 struct sb_info *sb = mix_getdevinfo(m); 1057 u_char recdev; 1058 1059 switch (sb->bd_flags & BD_F_MIX_MASK) { 1060 case BD_F_MIX_CT1345: 1061 if (src == SOUND_MASK_LINE) recdev = 0x06; 1062 else if (src == SOUND_MASK_CD) recdev = 0x02; 1063 else { /* default: mic */ 1064 src = SOUND_MASK_MIC; 1065 recdev = 0; 1066 } 1067 sb_setmixer(sb, RECORD_SRC, recdev | 1068 (sb_getmixer(sb, RECORD_SRC) & ~0x07)); 1069 break; 1070 1071 case BD_F_MIX_CT1745: /* sb16 */ 1072 recdev = 0; 1073 if (src & SOUND_MASK_MIC) recdev |= 0x01; /* mono mic */ 1074 if (src & SOUND_MASK_CD) recdev |= 0x06; /* l+r cd */ 1075 if (src & SOUND_MASK_LINE) recdev |= 0x18; /* l+r line */ 1076 if (src & SOUND_MASK_SYNTH) recdev |= 0x60; /* l+r midi */ 1077 sb_setmixer(sb, SB16_IMASK_L, recdev); 1078 sb_setmixer(sb, SB16_IMASK_R, recdev); 1079 /* 1080 * since the same volume controls apply to the input and 1081 * output sections, the best approach to have a consistent 1082 * behaviour among cards would be to disable the output path 1083 * on devices which are used to record. 1084 * However, since users like to have feedback, we only disable 1085 * the mic -- permanently. 1086 */ 1087 sb_setmixer(sb, SB16_OMASK, 0x1f & ~1); 1088 break; 1089 } 1090 return src; 1091} 1092 1093static int 1094sbsbc_probe(device_t dev) 1095{ 1096 char buf[64]; 1097 uintptr_t func, ver, r, f; 1098 1099 /* The parent device has already been probed. */ 1100 r = BUS_READ_IVAR(device_get_parent(dev), dev, 0, &func); 1101 if (func != SCF_PCM) 1102 return (ENXIO); 1103 1104 r = BUS_READ_IVAR(device_get_parent(dev), dev, 1, &ver); 1105 f = (ver & 0xffff0000) >> 16; 1106 ver &= 0x0000ffff; 1107 snprintf(buf, sizeof buf, "SB DSP %d.%02d%s%s", (int) ver >> 8, (int) ver & 0xff, 1108 (f & BD_F_ESS)? " (ESS mode)" : "", 1109 (f & BD_F_SB16X)? " (ViBRA16X)" : ""); 1110 device_set_desc_copy(dev, buf); 1111 1112 return 0; 1113} 1114 1115static int 1116sbsbc_attach(device_t dev) 1117{ 1118 struct sb_info *sb; 1119 uintptr_t ver; 1120 1121 sb = (struct sb_info *)malloc(sizeof *sb, M_DEVBUF, M_NOWAIT); 1122 if (!sb) return ENXIO; 1123 bzero(sb, sizeof *sb); 1124 1125 BUS_READ_IVAR(device_get_parent(dev), dev, 1, &ver); 1126 sb->bd_id = ver & 0x0000ffff; 1127 sb->bd_flags = (ver & 0xffff0000) >> 16; 1128 1129 return sb_doattach(dev, sb); 1130} 1131 1132static device_method_t sbsbc_methods[] = { 1133 /* Device interface */ 1134 DEVMETHOD(device_probe, sbsbc_probe), 1135 DEVMETHOD(device_attach, sbsbc_attach), 1136 1137 { 0, 0 } 1138}; 1139 1140static driver_t sbsbc_driver = { 1141 "pcm", 1142 sbsbc_methods, 1143 sizeof(snddev_info), 1144}; 1145 1146DRIVER_MODULE(sbsbc, sbc, sbsbc_driver, pcm_devclass, 0, 0); 1147 1148 1149 1150