The Design and Implementation of the FreeBSD Operating System, Second Edition
Now available: The Design and Implementation of the FreeBSD Operating System (Second Edition)


[ source navigation ] [ diff markup ] [ identifier search ] [ freetext search ] [ file search ] [ list types ] [ track identifier ]

FreeBSD/Linux Kernel Cross Reference
sys/dev/sound/isa/ess.c

Version: -  FREEBSD  -  FREEBSD-13-STABLE  -  FREEBSD-13-0  -  FREEBSD-12-STABLE  -  FREEBSD-12-0  -  FREEBSD-11-STABLE  -  FREEBSD-11-0  -  FREEBSD-10-STABLE  -  FREEBSD-10-0  -  FREEBSD-9-STABLE  -  FREEBSD-9-0  -  FREEBSD-8-STABLE  -  FREEBSD-8-0  -  FREEBSD-7-STABLE  -  FREEBSD-7-0  -  FREEBSD-6-STABLE  -  FREEBSD-6-0  -  FREEBSD-5-STABLE  -  FREEBSD-5-0  -  FREEBSD-4-STABLE  -  FREEBSD-3-STABLE  -  FREEBSD22  -  l41  -  OPENBSD  -  linux-2.6  -  MK84  -  PLAN9  -  xnu-8792 
SearchContext: -  none  -  3  -  10 

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

Cache object: ec32109ec4424a357993232f203a8ae3


[ source navigation ] [ diff markup ] [ identifier search ] [ freetext search ] [ file search ] [ list types ] [ track identifier ]


This page is part of the FreeBSD/Linux Linux Kernel Cross-Reference, and was automatically generated using a modified version of the LXR engine.