sys/dev/sound/pci/solo.c

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