sys/dev/sound/isa/ess.c

   1 /*-
   2  * Copyright (c) 1999 Cameron Grant <cg@freebsd.org>
   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: src/sys/dev/sound/isa/ess.c,v 1.34.2.2 2006/01/19 01:17:00 ariff Exp $
  32  * $DragonFly: src/sys/dev/sound/isa/ess.c,v 1.7 2007/01/04 21:47:02 corecode Exp $
  33  */
  34
  35 #include <dev/sound/pcm/sound.h>
  36
  37 #include  <dev/sound/isa/sb.h>
  38 #include  <dev/sound/chip.h>
  39
  40 #include <bus/isa/isavar.h>
  41
  42 #include "mixer_if.h"
  43
  44 SND_DECLARE_FILE("$DragonFly: src/sys/dev/sound/isa/ess.c,v 1.7 2007/01/04 21:47:02 corecode Exp $");
  45
  46 #define ESS_BUFFSIZE (4096)
  47 #define ABS(x) (((x) < 0)? -(x) : (x))
  48
  49 /* audio2 never generates irqs and sounds very noisy */
  50 #undef ESS18XX_DUPLEX
  51
  52 /* more accurate clocks and split audio1/audio2 rates */
  53 #define ESS18XX_NEWSPEED
  54
  55 static u_int32_t ess_pfmt[] = {
  56         AFMT_U8,
  57         AFMT_STEREO | AFMT_U8,
  58         AFMT_S8,
  59         AFMT_STEREO | AFMT_S8,
  60         AFMT_S16_LE,
  61         AFMT_STEREO | AFMT_S16_LE,
  62         AFMT_U16_LE,
  63         AFMT_STEREO | AFMT_U16_LE,
  64         0
  65 };
  66
  67 static struct pcmchan_caps ess_playcaps = {6000, 48000, ess_pfmt, 0};
  68
  69 static u_int32_t ess_rfmt[] = {
  70         AFMT_U8,
  71         AFMT_STEREO | AFMT_U8,
  72         AFMT_S8,
  73         AFMT_STEREO | AFMT_S8,
  74         AFMT_S16_LE,
  75         AFMT_STEREO | AFMT_S16_LE,
  76         AFMT_U16_LE,
  77         AFMT_STEREO | AFMT_U16_LE,
  78         0
  79 };
  80
  81 static struct pcmchan_caps ess_reccaps = {6000, 48000, ess_rfmt, 0};
  82
  83 struct ess_info;
  84
  85 struct ess_chinfo {
  86         struct ess_info *parent;
  87         struct pcm_channel *channel;
  88         struct snd_dbuf *buffer;
  89         int dir, hwch, stopping, run;
  90         u_int32_t fmt, spd, blksz;
  91 };
  92
  93 struct ess_info {
  94         device_t parent_dev;
  95         struct resource *io_base;       /* I/O address for the board */
  96         struct resource *irq;
  97         struct resource *drq1;
  98         struct resource *drq2;
  99         void *ih;
 100         bus_dma_tag_t parent_dmat;
 101
 102         unsigned int bufsize;
 103         int type, duplex:1, newspeed:1;
 104         u_long bd_flags;       /* board-specific flags */
 105         struct ess_chinfo pch, rch;
 106 };
 107
 108 #if 0
 109 static int ess_rd(struct ess_info *sc, int reg);
 110 static void ess_wr(struct ess_info *sc, int reg, u_int8_t val);
 111 static int ess_dspready(struct ess_info *sc);
 112 static int ess_cmd(struct ess_info *sc, u_char val);
 113 static int ess_cmd1(struct ess_info *sc, u_char cmd, int val);
 114 static int ess_get_byte(struct ess_info *sc);
 115 static void ess_setmixer(struct ess_info *sc, u_int port, u_int value);
 116 static int ess_getmixer(struct ess_info *sc, u_int port);
 117 static int ess_reset_dsp(struct ess_info *sc);
 118
 119 static int ess_write(struct ess_info *sc, u_char reg, int val);
 120 static int ess_read(struct ess_info *sc, u_char reg);
 121
 122 static void ess_intr(void *arg);
 123 static int ess_setupch(struct ess_info *sc, int ch, int dir, int spd, u_int32_t fmt, int len);
 124 static int ess_start(struct ess_chinfo *ch);
 125 static int ess_stop(struct ess_chinfo *ch);
 126 #endif
 127
 128 /*
 129  * Common code for the midi and pcm functions
 130  *
 131  * ess_cmd write a single byte to the CMD port.
 132  * ess_cmd1 write a CMD + 1 byte arg
 133  * ess_cmd2 write a CMD + 2 byte arg
 134  * ess_get_byte returns a single byte from the DSP data port
 135  *
 136  * ess_write is actually ess_cmd1
 137  * ess_read access ext. regs via ess_cmd(0xc0, reg) followed by ess_get_byte
 138  */
 139
 140 static void
 141 ess_lock(struct ess_info *sc) {
 142
 143         sbc_lock(device_get_softc(sc->parent_dev));
 144 }
 145
 146 static void
 147 ess_unlock(struct ess_info *sc) {
 148
 149         sbc_unlock(device_get_softc(sc->parent_dev));
 150 }
 151
 152 static int
 153 port_rd(struct resource *port, int off)
 154 {
 155         return bus_space_read_1(rman_get_bustag(port),
 156                                 rman_get_bushandle(port),
 157                                 off);
 158 }
 159
 160 static void
 161 port_wr(struct resource *port, int off, u_int8_t data)
 162 {
 163         bus_space_write_1(rman_get_bustag(port),
 164                           rman_get_bushandle(port),
 165                           off, data);
 166 }
 167
 168 static int
 169 ess_rd(struct ess_info *sc, int reg)
 170 {
 171         return port_rd(sc->io_base, reg);
 172 }
 173
 174 static void
 175 ess_wr(struct ess_info *sc, int reg, u_int8_t val)
 176 {
 177         port_wr(sc->io_base, reg, val);
 178 }
 179
 180 static int
 181 ess_dspready(struct ess_info *sc)
 182 {
 183         return ((ess_rd(sc, SBDSP_STATUS) & 0x80) == 0);
 184 }
 185
 186 static int
 187 ess_dspwr(struct ess_info *sc, u_char val)
 188 {
 189         int  i;
 190
 191         for (i = 0; i < 1000; i++) {
 192                 if (ess_dspready(sc)) {
 193                         ess_wr(sc, SBDSP_CMD, val);
 194                         return 1;
 195                 }
 196                 if (i > 10) DELAY((i > 100)? 1000 : 10);
 197         }
 198         kprintf("ess_dspwr(0x%02x) timed out.\n", val);
 199         return 0;
 200 }
 201
 202 static int
 203 ess_cmd(struct ess_info *sc, u_char val)
 204 {
 205 #if 0
 206         kprintf("ess_cmd: %x\n", val);
 207 #endif
 208         return ess_dspwr(sc, val);
 209 }
 210
 211 static int
 212 ess_cmd1(struct ess_info *sc, u_char cmd, int val)
 213 {
 214 #if 0
 215         kprintf("ess_cmd1: %x, %x\n", cmd, val);
 216 #endif
 217         if (ess_dspwr(sc, cmd)) {
 218                 return ess_dspwr(sc, val & 0xff);
 219         } else return 0;
 220 }
 221
 222 static void
 223 ess_setmixer(struct ess_info *sc, u_int port, u_int value)
 224 {
 225         DEB(kprintf("ess_setmixer: reg=%x, val=%x\n", port, value);)
 226         ess_wr(sc, SB_MIX_ADDR, (u_char) (port & 0xff)); /* Select register */
 227         DELAY(10);
 228         ess_wr(sc, SB_MIX_DATA, (u_char) (value & 0xff));
 229         DELAY(10);
 230 }
 231
 232 static int
 233 ess_getmixer(struct ess_info *sc, u_int port)
 234 {
 235         int val;
 236         ess_wr(sc, SB_MIX_ADDR, (u_char) (port & 0xff)); /* Select register */
 237         DELAY(10);
 238         val = ess_rd(sc, SB_MIX_DATA);
 239         DELAY(10);
 240
 241         return val;
 242 }
 243
 244 static int
 245 ess_get_byte(struct ess_info *sc)
 246 {
 247         int i;
 248
 249         for (i = 1000; i > 0; i--) {
 250                 if (ess_rd(sc, DSP_DATA_AVAIL) & 0x80)
 251                         return ess_rd(sc, DSP_READ);
 252                 else
 253                         DELAY(20);
 254         }
 255         return -1;
 256 }
 257
 258 static int
 259 ess_write(struct ess_info *sc, u_char reg, int val)
 260 {
 261         return ess_cmd1(sc, reg, val);
 262 }
 263
 264 static int
 265 ess_read(struct ess_info *sc, u_char reg)
 266 {
 267         return (ess_cmd(sc, 0xc0) && ess_cmd(sc, reg))? ess_get_byte(sc) : -1;
 268 }
 269
 270 static int
 271 ess_reset_dsp(struct ess_info *sc)
 272 {
 273         ess_wr(sc, SBDSP_RST, 3);
 274         DELAY(100);
 275         ess_wr(sc, SBDSP_RST, 0);
 276         if (ess_get_byte(sc) != 0xAA) {
 277                 DEB(kprintf("ess_reset_dsp 0x%lx failed\n",
 278                            rman_get_start(sc->io_base)));
 279                 return ENXIO;   /* Sorry */
 280         }
 281         ess_cmd(sc, 0xc6);
 282         return 0;
 283 }
 284
 285 static void
 286 ess_release_resources(struct ess_info *sc, device_t dev)
 287 {
 288         if (sc->irq) {
 289                 if (sc->ih)
 290                         bus_teardown_intr(dev, sc->irq, sc->ih);
 291                 bus_release_resource(dev, SYS_RES_IRQ, 0, sc->irq);
 292                 sc->irq = 0;
 293         }
 294         if (sc->drq1) {
 295                 isa_dma_release(rman_get_start(sc->drq1));
 296                 bus_release_resource(dev, SYS_RES_DRQ, 0, sc->drq1);
 297                 sc->drq1 = 0;
 298         }
 299         if (sc->drq2) {
 300                 isa_dma_release(rman_get_start(sc->drq2));
 301                 bus_release_resource(dev, SYS_RES_DRQ, 1, sc->drq2);
 302                 sc->drq2 = 0;
 303         }
 304         if (sc->io_base) {
 305                 bus_release_resource(dev, SYS_RES_IOPORT, 0, sc->io_base);
 306                 sc->io_base = 0;
 307         }
 308         if (sc->parent_dmat) {
 309                 bus_dma_tag_destroy(sc->parent_dmat);
 310                 sc->parent_dmat = 0;
 311         }
 312         kfree(sc, M_DEVBUF);
 313 }
 314
 315 static int
 316 ess_alloc_resources(struct ess_info *sc, device_t dev)
 317 {
 318         int rid;
 319
 320         rid = 0;
 321         if (!sc->io_base)
 322                 sc->io_base = bus_alloc_resource_any(dev, SYS_RES_IOPORT,
 323                                                      &rid, RF_ACTIVE);
 324         rid = 0;
 325         if (!sc->irq)
 326                 sc->irq = bus_alloc_resource_any(dev, SYS_RES_IRQ,
 327                                                  &rid, RF_ACTIVE);
 328         rid = 0;
 329         if (!sc->drq1)
 330                 sc->drq1 = bus_alloc_resource_any(dev, SYS_RES_DRQ,
 331                                                   &rid, RF_ACTIVE);
 332         rid = 1;
 333         if (!sc->drq2)
 334                 sc->drq2 = bus_alloc_resource_any(dev, SYS_RES_DRQ,
 335                                                   &rid, RF_ACTIVE);
 336
 337         if (sc->io_base && sc->drq1 && sc->irq) {
 338                 isa_dma_acquire(rman_get_start(sc->drq1));
 339                 isa_dmainit(rman_get_start(sc->drq1), sc->bufsize);
 340
 341                 if (sc->drq2) {
 342                         isa_dma_acquire(rman_get_start(sc->drq2));
 343                         isa_dmainit(rman_get_start(sc->drq2), sc->bufsize);
 344                 }
 345
 346                 return 0;
 347         } else return ENXIO;
 348 }
 349
 350 static void
 351 ess_intr(void *arg)
 352 {
 353         struct ess_info *sc = (struct ess_info *)arg;
 354         int src, pirq, rirq;
 355
 356         ess_lock(sc);
 357         src = 0;
 358         if (ess_getmixer(sc, 0x7a) & 0x80)
 359                 src |= 2;
 360         if (ess_rd(sc, 0x0c) & 0x01)
 361                 src |= 1;
 362
 363         pirq = (src & sc->pch.hwch)? 1 : 0;
 364         rirq = (src & sc->rch.hwch)? 1 : 0;
 365
 366         if (pirq) {
 367                 if (sc->pch.run) {
 368                         ess_unlock(sc);
 369                         chn_intr(sc->pch.channel);
 370                         ess_lock(sc);
 371                 }
 372                 if (sc->pch.stopping) {
 373                         sc->pch.run = 0;
 374                         sndbuf_dma(sc->pch.buffer, PCMTRIG_STOP);
 375                         sc->pch.stopping = 0;
 376                         if (sc->pch.hwch == 1)
 377                                 ess_write(sc, 0xb8, ess_read(sc, 0xb8) & ~0x01);
 378                         else
 379                                 ess_setmixer(sc, 0x78, ess_getmixer(sc, 0x78) & ~0x03);
 380                 }
 381         }
 382
 383         if (rirq) {
 384                 if (sc->rch.run) {
 385                         ess_unlock(sc);
 386                         chn_intr(sc->rch.channel);
 387                         ess_lock(sc);
 388                 }
 389                 if (sc->rch.stopping) {
 390                         sc->rch.run = 0;
 391                         sndbuf_dma(sc->rch.buffer, PCMTRIG_STOP);
 392                         sc->rch.stopping = 0;
 393                         /* XXX: will this stop audio2? */
 394                         ess_write(sc, 0xb8, ess_read(sc, 0xb8) & ~0x01);
 395                 }
 396         }
 397
 398         if (src & 2)
 399                 ess_setmixer(sc, 0x7a, ess_getmixer(sc, 0x7a) & ~0x80);
 400         if (src & 1)
 401                 ess_rd(sc, DSP_DATA_AVAIL);
 402         ess_unlock(sc);
 403 }
 404
 405 /* utility functions for ESS */
 406 static u_int8_t
 407 ess_calcspeed8(int *spd)
 408 {
 409         int speed = *spd;
 410         u_int32_t t;
 411
 412         if (speed > 22000) {
 413                 t = (795500 + speed / 2) / speed;
 414                 speed = (795500 + t / 2) / t;
 415                 t = (256 - t) | 0x80;
 416         } else {
 417                 t = (397700 + speed / 2) / speed;
 418                 speed = (397700 + t / 2) / t;
 419                 t = 128 - t;
 420         }
 421         *spd = speed;
 422         return t & 0x000000ff;
 423 }
 424
 425 static u_int8_t
 426 ess_calcspeed9(int *spd)
 427 {
 428         int speed, s0, s1, use0;
 429         u_int8_t t0, t1;
 430
 431         /* rate = source / (256 - divisor) */
 432         /* divisor = 256 - (source / rate) */
 433         speed = *spd;
 434         t0 = 128 - (793800 / speed);
 435         s0 = 793800 / (128 - t0);
 436
 437         t1 = 128 - (768000 / speed);
 438         s1 = 768000 / (128 - t1);
 439         t1 |= 0x80;
 440
 441         use0 = (ABS(speed - s0) < ABS(speed - s1))? 1 : 0;
 442
 443         *spd = use0? s0 : s1;
 444         return use0? t0 : t1;
 445 }
 446
 447 static u_int8_t
 448 ess_calcfilter(int spd)
 449 {
 450         int cutoff;
 451
 452         /* cutoff = 7160000 / (256 - divisor) */
 453         /* divisor = 256 - (7160000 / cutoff) */
 454         cutoff = (spd * 9 * 82) / 20;
 455         return (256 - (7160000 / cutoff));
 456 }
 457
 458 static int
 459 ess_setupch(struct ess_info *sc, int ch, int dir, int spd, u_int32_t fmt, int len)
 460 {
 461         int play = (dir == PCMDIR_PLAY)? 1 : 0;
 462         int b16 = (fmt & AFMT_16BIT)? 1 : 0;
 463         int stereo = (fmt & AFMT_STEREO)? 1 : 0;
 464         int unsign = (fmt == AFMT_U8 || fmt == AFMT_U16_LE)? 1 : 0;
 465         u_int8_t spdval, fmtval;
 466
 467
 468         spdval = (sc->newspeed)? ess_calcspeed9(&spd) : ess_calcspeed8(&spd);
 469         len = -len;
 470
 471         if (ch == 1) {
 472                 KASSERT((dir == PCMDIR_PLAY) || (dir == PCMDIR_REC), ("ess_setupch: dir1 bad"));
 473                 /* transfer length low */
 474                 ess_write(sc, 0xa4, len & 0x00ff);
 475                 /* transfer length high */
 476                 ess_write(sc, 0xa5, (len & 0xff00) >> 8);
 477                 /* autoinit, dma dir */
 478                 ess_write(sc, 0xb8, 0x04 | (play? 0x00 : 0x0a));
 479                 /* mono/stereo */
 480                 ess_write(sc, 0xa8, (ess_read(sc, 0xa8) & ~0x03) | (stereo? 0x01 : 0x02));
 481                 /* demand mode, 4 bytes/xfer */
 482                 ess_write(sc, 0xb9, 0x02);
 483                 /* sample rate */
 484                 ess_write(sc, 0xa1, spdval);
 485                 /* filter cutoff */
 486                 ess_write(sc, 0xa2, ess_calcfilter(spd));
 487                 /* setup dac/adc */
 488                 if (play)
 489                         ess_write(sc, 0xb6, unsign? 0x80 : 0x00);
 490                 /* mono, b16: signed, load signal */
 491                 ess_write(sc, 0xb7, 0x51 | (unsign? 0x00 : 0x20));
 492                 /* setup fifo */
 493                 ess_write(sc, 0xb7, 0x90 | (unsign? 0x00 : 0x20) |
 494                                            (b16? 0x04 : 0x00) |
 495                                            (stereo? 0x08 : 0x40));
 496                 /* irq control */
 497                 ess_write(sc, 0xb1, (ess_read(sc, 0xb1) & 0x0f) | 0x50);
 498                 /* drq control */
 499                 ess_write(sc, 0xb2, (ess_read(sc, 0xb2) & 0x0f) | 0x50);
 500         } else if (ch == 2) {
 501                 KASSERT(dir == PCMDIR_PLAY, ("ess_setupch: dir2 bad"));
 502                 /* transfer length low */
 503                 ess_setmixer(sc, 0x74, len & 0x00ff);
 504                 /* transfer length high */
 505                 ess_setmixer(sc, 0x76, (len & 0xff00) >> 8);
 506                 /* autoinit, 4 bytes/req */
 507                 ess_setmixer(sc, 0x78, 0x90);
 508                 fmtval = b16 | (stereo << 1) | (unsign << 2);
 509                 /* enable irq, set format */
 510                 ess_setmixer(sc, 0x7a, 0x40 | fmtval);
 511                 if (sc->newspeed) {
 512                         /* sample rate */
 513                         ess_setmixer(sc, 0x70, spdval);
 514                         /* filter cutoff */
 515                         ess_setmixer(sc, 0x72, ess_calcfilter(spd));
 516                 }
 517         }
 518
 519         return 0;
 520 }
 521 static int
 522 ess_start(struct ess_chinfo *ch)
 523 {
 524         struct ess_info *sc = ch->parent;
 525         int play = (ch->dir == PCMDIR_PLAY)? 1 : 0;
 526
 527         ess_lock(sc);
 528         ess_setupch(sc, ch->hwch, ch->dir, ch->spd, ch->fmt, ch->blksz);
 529         ch->stopping = 0;
 530         if (ch->hwch == 1)
 531                 ess_write(sc, 0xb8, ess_read(sc, 0xb8) | 0x01);
 532         else
 533                 ess_setmixer(sc, 0x78, ess_getmixer(sc, 0x78) | 0x03);
 534         if (play)
 535                 ess_cmd(sc, DSP_CMD_SPKON);
 536         ess_unlock(sc);
 537         return 0;
 538 }
 539
 540 static int
 541 ess_stop(struct ess_chinfo *ch)
 542 {
 543         struct ess_info *sc = ch->parent;
 544         int play = (ch->dir == PCMDIR_PLAY)? 1 : 0;
 545
 546         ess_lock(sc);
 547         ch->stopping = 1;
 548         if (ch->hwch == 1)
 549                 ess_write(sc, 0xb8, ess_read(sc, 0xb8) & ~0x04);
 550         else
 551                 ess_setmixer(sc, 0x78, ess_getmixer(sc, 0x78) & ~0x10);
 552         if (play)
 553                 ess_cmd(sc, DSP_CMD_SPKOFF);
 554         ess_unlock(sc);
 555         return 0;
 556 }
 557
 558 /* -------------------------------------------------------------------- */
 559 /* channel interface for ESS18xx */
 560 static void *
 561 esschan_init(kobj_t obj, void *devinfo, struct snd_dbuf *b, struct pcm_channel *c, int dir)
 562 {
 563         struct ess_info *sc = devinfo;
 564         struct ess_chinfo *ch = (dir == PCMDIR_PLAY)? &sc->pch : &sc->rch;
 565
 566         ch->parent = sc;
 567         ch->channel = c;
 568         ch->buffer = b;
 569         if (sndbuf_alloc(ch->buffer, sc->parent_dmat, sc->bufsize) != 0)
 570                 return NULL;
 571         ch->dir = dir;
 572         ch->hwch = 1;
 573         if ((dir == PCMDIR_PLAY) && (sc->duplex))
 574                 ch->hwch = 2;
 575         sndbuf_dmasetup(ch->buffer, (ch->hwch == 1)? sc->drq1 : sc->drq2);
 576         return ch;
 577 }
 578
 579 static int
 580 esschan_setformat(kobj_t obj, void *data, u_int32_t format)
 581 {
 582         struct ess_chinfo *ch = data;
 583
 584         ch->fmt = format;
 585         return 0;
 586 }
 587
 588 static int
 589 esschan_setspeed(kobj_t obj, void *data, u_int32_t speed)
 590 {
 591         struct ess_chinfo *ch = data;
 592         struct ess_info *sc = ch->parent;
 593
 594         ch->spd = speed;
 595         if (sc->newspeed)
 596                 ess_calcspeed9(&ch->spd);
 597         else
 598                 ess_calcspeed8(&ch->spd);
 599         return ch->spd;
 600 }
 601
 602 static int
 603 esschan_setblocksize(kobj_t obj, void *data, u_int32_t blocksize)
 604 {
 605         struct ess_chinfo *ch = data;
 606
 607         ch->blksz = blocksize;
 608         return ch->blksz;
 609 }
 610
 611 static int
 612 esschan_trigger(kobj_t obj, void *data, int go)
 613 {
 614         struct ess_chinfo *ch = data;
 615
 616         if (go == PCMTRIG_EMLDMAWR || go == PCMTRIG_EMLDMARD)
 617                 return 0;
 618
 619         switch (go) {
 620         case PCMTRIG_START:
 621                 ch->run = 1;
 622                 sndbuf_dma(ch->buffer, go);
 623                 ess_start(ch);
 624                 break;
 625
 626         case PCMTRIG_STOP:
 627         case PCMTRIG_ABORT:
 628         default:
 629                 ess_stop(ch);
 630                 break;
 631         }
 632         return 0;
 633 }
 634
 635 static int
 636 esschan_getptr(kobj_t obj, void *data)
 637 {
 638         struct ess_chinfo *ch = data;
 639
 640         return sndbuf_dmaptr(ch->buffer);
 641 }
 642
 643 static struct pcmchan_caps *
 644 esschan_getcaps(kobj_t obj, void *data)
 645 {
 646         struct ess_chinfo *ch = data;
 647
 648         return (ch->dir == PCMDIR_PLAY)? &ess_playcaps : &ess_reccaps;
 649 }
 650
 651 static kobj_method_t esschan_methods[] = {
 652         KOBJMETHOD(channel_init,                esschan_init),
 653         KOBJMETHOD(channel_setformat,           esschan_setformat),
 654         KOBJMETHOD(channel_setspeed,            esschan_setspeed),
 655         KOBJMETHOD(channel_setblocksize,        esschan_setblocksize),
 656         KOBJMETHOD(channel_trigger,             esschan_trigger),
 657         KOBJMETHOD(channel_getptr,              esschan_getptr),
 658         KOBJMETHOD(channel_getcaps,             esschan_getcaps),
 659         { 0, 0 }
 660 };
 661 CHANNEL_DECLARE(esschan);
 662
 663 /************************************************************/
 664
 665 static int
 666 essmix_init(struct snd_mixer *m)
 667 {
 668         struct ess_info *sc = mix_getdevinfo(m);
 669
 670         mix_setrecdevs(m, SOUND_MASK_CD | SOUND_MASK_MIC | SOUND_MASK_LINE |
 671                           SOUND_MASK_IMIX);
 672
 673         mix_setdevs(m, SOUND_MASK_SYNTH | SOUND_MASK_PCM | SOUND_MASK_LINE |
 674                        SOUND_MASK_MIC | SOUND_MASK_CD | SOUND_MASK_VOLUME |
 675                        SOUND_MASK_LINE1 | SOUND_MASK_SPEAKER);
 676
 677         ess_setmixer(sc, 0, 0); /* reset */
 678
 679         return 0;
 680 }
 681
 682 static int
 683 essmix_set(struct snd_mixer *m, unsigned dev, unsigned left, unsigned right)
 684 {
 685         struct ess_info *sc = mix_getdevinfo(m);
 686         int preg = 0, rreg = 0, l, r;
 687
 688         l = (left * 15) / 100;
 689         r = (right * 15) / 100;
 690         switch (dev) {
 691         case SOUND_MIXER_SYNTH:
 692                 preg = 0x36;
 693                 rreg = 0x6b;
 694                 break;
 695
 696         case SOUND_MIXER_PCM:
 697                 preg = 0x14;
 698                 rreg = 0x7c;
 699                 break;
 700
 701         case SOUND_MIXER_LINE:
 702                 preg = 0x3e;
 703                 rreg = 0x6e;
 704                 break;
 705
 706         case SOUND_MIXER_MIC:
 707                 preg = 0x1a;
 708                 rreg = 0x68;
 709                 break;
 710
 711         case SOUND_MIXER_LINE1:
 712                 preg = 0x3a;
 713                 rreg = 0x6c;
 714                 break;
 715
 716         case SOUND_MIXER_CD:
 717                 preg = 0x38;
 718                 rreg = 0x6a;
 719                 break;
 720
 721         case SOUND_MIXER_SPEAKER:
 722                 preg = 0x3c;
 723                 break;
 724
 725         case SOUND_MIXER_VOLUME:
 726                 l = left? (left * 63) / 100 : 64;
 727                 r = right? (right * 63) / 100 : 64;
 728                 ess_setmixer(sc, 0x60, l);
 729                 ess_setmixer(sc, 0x62, r);
 730                 left = (l == 64)? 0 : (l * 100) / 63;
 731                 right = (r == 64)? 0 : (r * 100) / 63;
 732                 return left | (right << 8);
 733         }
 734
 735         if (preg)
 736                 ess_setmixer(sc, preg, (l << 4) | r);
 737         if (rreg)
 738                 ess_setmixer(sc, rreg, (l << 4) | r);
 739
 740         left = (l * 100) / 15;
 741         right = (r * 100) / 15;
 742
 743         return left | (right << 8);
 744 }
 745
 746 static int
 747 essmix_setrecsrc(struct snd_mixer *m, u_int32_t src)
 748 {
 749         struct ess_info *sc = mix_getdevinfo(m);
 750         u_char recdev;
 751
 752         switch (src) {
 753         case SOUND_MASK_CD:
 754                 recdev = 0x02;
 755                 break;
 756
 757         case SOUND_MASK_LINE:
 758                 recdev = 0x06;
 759                 break;
 760
 761         case SOUND_MASK_IMIX:
 762                 recdev = 0x05;
 763                 break;
 764
 765         case SOUND_MASK_MIC:
 766         default:
 767                 recdev = 0x00;
 768                 src = SOUND_MASK_MIC;
 769                 break;
 770         }
 771
 772         ess_setmixer(sc, 0x1c, recdev);
 773
 774         return src;
 775 }
 776
 777 static kobj_method_t essmixer_methods[] = {
 778         KOBJMETHOD(mixer_init,          essmix_init),
 779         KOBJMETHOD(mixer_set,           essmix_set),
 780         KOBJMETHOD(mixer_setrecsrc,     essmix_setrecsrc),
 781         { 0, 0 }
 782 };
 783 MIXER_DECLARE(essmixer);
 784
 785 /************************************************************/
 786
 787 static int
 788 ess_probe(device_t dev)
 789 {
 790         uintptr_t func, ver, r, f;
 791
 792         /* The parent device has already been probed. */
 793         r = BUS_READ_IVAR(device_get_parent(dev), dev, 0, &func);
 794         if (func != SCF_PCM)
 795                 return (ENXIO);
 796
 797         r = BUS_READ_IVAR(device_get_parent(dev), dev, 1, &ver);
 798         f = (ver & 0xffff0000) >> 16;
 799         if (!(f & BD_F_ESS))
 800                 return (ENXIO);
 801
 802         device_set_desc(dev, "ESS 18xx DSP");
 803
 804         return 0;
 805 }
 806
 807 static int
 808 ess_attach(device_t dev)
 809 {
 810         struct ess_info *sc;
 811         char status[SND_STATUSLEN], buf[64];
 812         int ver;
 813
 814         sc = kmalloc(sizeof *sc, M_DEVBUF, M_WAITOK | M_ZERO);
 815         sc->parent_dev = device_get_parent(dev);
 816         sc->bufsize = pcm_getbuffersize(dev, 4096, ESS_BUFFSIZE, 65536);
 817         if (ess_alloc_resources(sc, dev))
 818                 goto no;
 819         if (ess_reset_dsp(sc))
 820                 goto no;
 821         if (mixer_init(dev, &essmixer_class, sc))
 822                 goto no;
 823
 824         sc->duplex = 0;
 825         sc->newspeed = 0;
 826         ver = (ess_getmixer(sc, 0x40) << 8) | ess_rd(sc, SB_MIX_DATA);
 827         ksnprintf(buf, sizeof buf, "ESS %x DSP", ver);
 828         device_set_desc_copy(dev, buf);
 829         if (bootverbose)
 830                 device_printf(dev, "ESS%x detected", ver);
 831
 832         switch (ver) {
 833         case 0x1869:
 834         case 0x1879:
 835 #ifdef ESS18XX_DUPLEX
 836                 sc->duplex = sc->drq2? 1 : 0;
 837 #endif
 838 #ifdef ESS18XX_NEWSPEED
 839                 sc->newspeed = 1;
 840 #endif
 841                 break;
 842         }
 843         if (bootverbose)
 844                 kprintf("%s%s\n", sc->duplex? ", duplex" : "",
 845                                  sc->newspeed? ", newspeed" : "");
 846
 847         if (sc->newspeed)
 848                 ess_setmixer(sc, 0x71, 0x22);
 849
 850         snd_setup_intr(dev, sc->irq, 0, ess_intr, sc, &sc->ih);
 851         if (!sc->duplex)
 852                 pcm_setflags(dev, pcm_getflags(dev) | SD_F_SIMPLEX);
 853
 854         if (bus_dma_tag_create(/*parent*/NULL, /*alignment*/2, /*boundary*/0,
 855                         /*lowaddr*/BUS_SPACE_MAXADDR_24BIT,
 856                         /*highaddr*/BUS_SPACE_MAXADDR,
 857                         /*filter*/NULL, /*filterarg*/NULL,
 858                         /*maxsize*/sc->bufsize, /*nsegments*/1,
 859                         /*maxsegz*/0x3ffff,
 860                         /*flags*/0,
 861                         &sc->parent_dmat) != 0) {
 862                 device_printf(dev, "unable to create dma tag\n");
 863                 goto no;
 864         }
 865
 866         if (sc->drq2)
 867                 ksnprintf(buf, SND_STATUSLEN, ":%ld", rman_get_start(sc->drq2));
 868         else
 869                 buf[0] = '\0';
 870
 871         ksnprintf(status, SND_STATUSLEN, "at io 0x%lx irq %ld drq %ld%s bufsz %u %s",
 872                 rman_get_start(sc->io_base), rman_get_start(sc->irq),
 873                 rman_get_start(sc->drq1), buf, sc->bufsize,
 874                 PCM_KLDSTRING(snd_ess));
 875
 876         if (pcm_register(dev, sc, 1, 1))
 877                 goto no;
 878         pcm_addchan(dev, PCMDIR_REC, &esschan_class, sc);
 879         pcm_addchan(dev, PCMDIR_PLAY, &esschan_class, sc);
 880         pcm_setstatus(dev, status);
 881
 882         return 0;
 883
 884 no:
 885         ess_release_resources(sc, dev);
 886         return ENXIO;
 887 }
 888
 889 static int
 890 ess_detach(device_t dev)
 891 {
 892         int r;
 893         struct ess_info *sc;
 894
 895         r = pcm_unregister(dev);
 896         if (r)
 897                 return r;
 898
 899         sc = pcm_getdevinfo(dev);
 900         ess_release_resources(sc, dev);
 901         return 0;
 902 }
 903
 904 static int
 905 ess_resume(device_t dev)
 906 {
 907         struct ess_info *sc;
 908
 909         sc = pcm_getdevinfo(dev);
 910
 911         if (ess_reset_dsp(sc)) {
 912                 device_printf(dev, "unable to reset DSP at resume\n");
 913                 return ENXIO;
 914         }
 915
 916         if (mixer_reinit(dev)) {
 917                 device_printf(dev, "unable to reinitialize mixer at resume\n");
 918                 return ENXIO;
 919         }
 920
 921         return 0;
 922 }
 923
 924 static device_method_t ess_methods[] = {
 925         /* Device interface */
 926         DEVMETHOD(device_probe,         ess_probe),
 927         DEVMETHOD(device_attach,        ess_attach),
 928         DEVMETHOD(device_detach,        ess_detach),
 929         DEVMETHOD(device_resume,        ess_resume),
 930
 931         { 0, 0 }
 932 };
 933
 934 static driver_t ess_driver = {
 935         "pcm",
 936         ess_methods,
 937         PCM_SOFTC_SIZE,
 938 };
 939
 940 DRIVER_MODULE(snd_ess, sbc, ess_driver, pcm_devclass, 0, 0);
 941 MODULE_DEPEND(snd_ess, sound, SOUND_MINVER, SOUND_PREFVER, SOUND_MAXVER);
 942 MODULE_DEPEND(snd_ess, snd_sbc, 1, 1, 1);
 943 MODULE_VERSION(snd_ess, 1);
 944
 945 /************************************************************/
 946
 947 static devclass_t esscontrol_devclass;
 948
 949 static struct isa_pnp_id essc_ids[] = {
 950         {0x06007316, "ESS Control"},
 951         {0}
 952 };
 953
 954 static int
 955 esscontrol_probe(device_t dev)
 956 {
 957         int i;
 958
 959         i = ISA_PNP_PROBE(device_get_parent(dev), dev, essc_ids);
 960         if (i == 0)
 961                 device_quiet(dev);
 962         return i;
 963 }
 964
 965 static int
 966 esscontrol_attach(device_t dev)
 967 {
 968 #ifdef notyet
 969         struct resource *io;
 970         int rid, i, x;
 971
 972         rid = 0;
 973         io = bus_alloc_resource_any(dev, SYS_RES_IOPORT, &rid, RF_ACTIVE);
 974         x = 0;
 975         for (i = 0; i < 0x100; i++) {
 976                 port_wr(io, 0, i);
 977                 x = port_rd(io, 1);
 978                 if ((i & 0x0f) == 0)
 979                         kprintf("%3.3x: ", i);
 980                 kprintf("%2.2x ", x);
 981                 if ((i & 0x0f) == 0x0f)
 982                         kprintf("\n");
 983         }
 984         bus_release_resource(dev, SYS_RES_IOPORT, 0, io);
 985         io = NULL;
 986 #endif
 987
 988         return 0;
 989 }
 990
 991 static int
 992 esscontrol_detach(device_t dev)
 993 {
 994         return 0;
 995 }
 996
 997 static device_method_t esscontrol_methods[] = {
 998         /* Device interface */
 999         DEVMETHOD(device_probe,         esscontrol_probe),
1000         DEVMETHOD(device_attach,        esscontrol_attach),
1001         DEVMETHOD(device_detach,        esscontrol_detach),
1002
1003         { 0, 0 }
1004 };
1005
1006 static driver_t esscontrol_driver = {
1007         "esscontrol",
1008         esscontrol_methods,
1009         1,
1010 };
1011
1012 DRIVER_MODULE(esscontrol, isa, esscontrol_driver, esscontrol_devclass, 0, 0);
1013 DRIVER_MODULE(esscontrol, acpi, esscontrol_driver, esscontrol_devclass, 0, 0);