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/pcm/channel.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) 2005-2009 Ariff Abdullah <ariff@FreeBSD.org>
    3  * Portions Copyright (c) Ryan Beasley <ryan.beasley@gmail.com> - GSoC 2006
    4  * Copyright (c) 1999 Cameron Grant <cg@FreeBSD.org>
    5  * Portions Copyright (c) Luigi Rizzo <luigi@FreeBSD.org> - 1997-99
    6  * All rights reserved.
    7  *
    8  * Redistribution and use in source and binary forms, with or without
    9  * modification, are permitted provided that the following conditions
   10  * are met:
   11  * 1. Redistributions of source code must retain the above copyright
   12  *    notice, this list of conditions and the following disclaimer.
   13  * 2. Redistributions in binary form must reproduce the above copyright
   14  *    notice, this list of conditions and the following disclaimer in the
   15  *    documentation and/or other materials provided with the distribution.
   16  *
   17  * THIS SOFTWARE IS PROVIDED BY THE AUTHOR AND CONTRIBUTORS ``AS IS'' AND
   18  * ANY EXPRESS OR IMPLIED WARRANTIES, INCLUDING, BUT NOT LIMITED TO, THE
   19  * IMPLIED WARRANTIES OF MERCHANTABILITY AND FITNESS FOR A PARTICULAR PURPOSE
   20  * ARE DISCLAIMED.  IN NO EVENT SHALL THE AUTHOR OR CONTRIBUTORS BE LIABLE
   21  * FOR ANY DIRECT, INDIRECT, INCIDENTAL, SPECIAL, EXEMPLARY, OR CONSEQUENTIAL
   22  * DAMAGES (INCLUDING, BUT NOT LIMITED TO, PROCUREMENT OF SUBSTITUTE GOODS
   23  * OR SERVICES; LOSS OF USE, DATA, OR PROFITS; OR BUSINESS INTERRUPTION)
   24  * HOWEVER CAUSED AND ON ANY THEORY OF LIABILITY, WHETHER IN CONTRACT, STRICT
   25  * LIABILITY, OR TORT (INCLUDING NEGLIGENCE OR OTHERWISE) ARISING IN ANY WAY
   26  * OUT OF THE USE OF THIS SOFTWARE, EVEN IF ADVISED OF THE POSSIBILITY OF
   27  * SUCH DAMAGE.
   28  */
   29 
   30 #include "opt_isa.h"
   31 
   32 #ifdef HAVE_KERNEL_OPTION_HEADERS
   33 #include "opt_snd.h"
   34 #endif
   35 
   36 #include <dev/sound/pcm/sound.h>
   37 #include <dev/sound/pcm/vchan.h>
   38 
   39 #include "feeder_if.h"
   40 
   41 SND_DECLARE_FILE("$FreeBSD: releng/10.1/sys/dev/sound/pcm/channel.c 243138 2012-11-16 07:05:57Z mav $");
   42 
   43 int report_soft_formats = 1;
   44 SYSCTL_INT(_hw_snd, OID_AUTO, report_soft_formats, CTLFLAG_RW,
   45         &report_soft_formats, 1, "report software-emulated formats");
   46 
   47 int report_soft_matrix = 1;
   48 SYSCTL_INT(_hw_snd, OID_AUTO, report_soft_matrix, CTLFLAG_RW,
   49         &report_soft_matrix, 1, "report software-emulated channel matrixing");
   50 
   51 int chn_latency = CHN_LATENCY_DEFAULT;
   52 TUNABLE_INT("hw.snd.latency", &chn_latency);
   53 
   54 static int
   55 sysctl_hw_snd_latency(SYSCTL_HANDLER_ARGS)
   56 {
   57         int err, val;
   58 
   59         val = chn_latency;
   60         err = sysctl_handle_int(oidp, &val, 0, req);
   61         if (err != 0 || req->newptr == NULL)
   62                 return err;
   63         if (val < CHN_LATENCY_MIN || val > CHN_LATENCY_MAX)
   64                 err = EINVAL;
   65         else
   66                 chn_latency = val;
   67 
   68         return err;
   69 }
   70 SYSCTL_PROC(_hw_snd, OID_AUTO, latency, CTLTYPE_INT | CTLFLAG_RW,
   71         0, sizeof(int), sysctl_hw_snd_latency, "I",
   72         "buffering latency (0=low ... 10=high)");
   73 
   74 int chn_latency_profile = CHN_LATENCY_PROFILE_DEFAULT;
   75 TUNABLE_INT("hw.snd.latency_profile", &chn_latency_profile);
   76 
   77 static int
   78 sysctl_hw_snd_latency_profile(SYSCTL_HANDLER_ARGS)
   79 {
   80         int err, val;
   81 
   82         val = chn_latency_profile;
   83         err = sysctl_handle_int(oidp, &val, 0, req);
   84         if (err != 0 || req->newptr == NULL)
   85                 return err;
   86         if (val < CHN_LATENCY_PROFILE_MIN || val > CHN_LATENCY_PROFILE_MAX)
   87                 err = EINVAL;
   88         else
   89                 chn_latency_profile = val;
   90 
   91         return err;
   92 }
   93 SYSCTL_PROC(_hw_snd, OID_AUTO, latency_profile, CTLTYPE_INT | CTLFLAG_RW,
   94         0, sizeof(int), sysctl_hw_snd_latency_profile, "I",
   95         "buffering latency profile (0=aggresive 1=safe)");
   96 
   97 static int chn_timeout = CHN_TIMEOUT;
   98 TUNABLE_INT("hw.snd.timeout", &chn_timeout);
   99 #ifdef SND_DEBUG
  100 static int
  101 sysctl_hw_snd_timeout(SYSCTL_HANDLER_ARGS)
  102 {
  103         int err, val;
  104 
  105         val = chn_timeout;
  106         err = sysctl_handle_int(oidp, &val, 0, req);
  107         if (err != 0 || req->newptr == NULL)
  108                 return err;
  109         if (val < CHN_TIMEOUT_MIN || val > CHN_TIMEOUT_MAX)
  110                 err = EINVAL;
  111         else
  112                 chn_timeout = val;
  113 
  114         return err;
  115 }
  116 SYSCTL_PROC(_hw_snd, OID_AUTO, timeout, CTLTYPE_INT | CTLFLAG_RW,
  117         0, sizeof(int), sysctl_hw_snd_timeout, "I",
  118         "interrupt timeout (1 - 10) seconds");
  119 #endif
  120 
  121 static int chn_vpc_autoreset = 1;
  122 TUNABLE_INT("hw.snd.vpc_autoreset", &chn_vpc_autoreset);
  123 SYSCTL_INT(_hw_snd, OID_AUTO, vpc_autoreset, CTLFLAG_RW,
  124         &chn_vpc_autoreset, 0, "automatically reset channels volume to 0db");
  125 
  126 static int chn_vol_0db_pcm = SND_VOL_0DB_PCM;
  127 TUNABLE_INT("hw.snd.vpc_0db", &chn_vol_0db_pcm);
  128 
  129 static void
  130 chn_vpc_proc(int reset, int db)
  131 {
  132         struct snddev_info *d;
  133         struct pcm_channel *c;
  134         int i;
  135 
  136         for (i = 0; pcm_devclass != NULL &&
  137             i < devclass_get_maxunit(pcm_devclass); i++) {
  138                 d = devclass_get_softc(pcm_devclass, i);
  139                 if (!PCM_REGISTERED(d))
  140                         continue;
  141                 PCM_LOCK(d);
  142                 PCM_WAIT(d);
  143                 PCM_ACQUIRE(d);
  144                 CHN_FOREACH(c, d, channels.pcm) {
  145                         CHN_LOCK(c);
  146                         CHN_SETVOLUME(c, SND_VOL_C_PCM, SND_CHN_T_VOL_0DB, db);
  147                         if (reset != 0)
  148                                 chn_vpc_reset(c, SND_VOL_C_PCM, 1);
  149                         CHN_UNLOCK(c);
  150                 }
  151                 PCM_RELEASE(d);
  152                 PCM_UNLOCK(d);
  153         }
  154 }
  155 
  156 static int
  157 sysctl_hw_snd_vpc_0db(SYSCTL_HANDLER_ARGS)
  158 {
  159         int err, val;
  160 
  161         val = chn_vol_0db_pcm;
  162         err = sysctl_handle_int(oidp, &val, 0, req);
  163         if (err != 0 || req->newptr == NULL)
  164                 return (err);
  165         if (val < SND_VOL_0DB_MIN || val > SND_VOL_0DB_MAX)
  166                 return (EINVAL);
  167 
  168         chn_vol_0db_pcm = val;
  169         chn_vpc_proc(0, val);
  170 
  171         return (0);
  172 }
  173 SYSCTL_PROC(_hw_snd, OID_AUTO, vpc_0db, CTLTYPE_INT | CTLFLAG_RW,
  174         0, sizeof(int), sysctl_hw_snd_vpc_0db, "I",
  175         "0db relative level");
  176 
  177 static int
  178 sysctl_hw_snd_vpc_reset(SYSCTL_HANDLER_ARGS)
  179 {
  180         int err, val;
  181 
  182         val = 0;
  183         err = sysctl_handle_int(oidp, &val, 0, req);
  184         if (err != 0 || req->newptr == NULL || val == 0)
  185                 return (err);
  186 
  187         chn_vol_0db_pcm = SND_VOL_0DB_PCM;
  188         chn_vpc_proc(1, SND_VOL_0DB_PCM);
  189 
  190         return (0);
  191 }
  192 SYSCTL_PROC(_hw_snd, OID_AUTO, vpc_reset, CTLTYPE_INT | CTLFLAG_RW,
  193         0, sizeof(int), sysctl_hw_snd_vpc_reset, "I",
  194         "reset volume on all channels");
  195 
  196 static int chn_usefrags = 0;
  197 TUNABLE_INT("hw.snd.usefrags", &chn_usefrags);
  198 static int chn_syncdelay = -1;
  199 TUNABLE_INT("hw.snd.syncdelay", &chn_syncdelay);
  200 #ifdef SND_DEBUG
  201 SYSCTL_INT(_hw_snd, OID_AUTO, usefrags, CTLFLAG_RW,
  202         &chn_usefrags, 1, "prefer setfragments() over setblocksize()");
  203 SYSCTL_INT(_hw_snd, OID_AUTO, syncdelay, CTLFLAG_RW,
  204         &chn_syncdelay, 1,
  205         "append (0-1000) millisecond trailing buffer delay on each sync");
  206 #endif
  207 
  208 /**
  209  * @brief Channel sync group lock
  210  *
  211  * Clients should acquire this lock @b without holding any channel locks
  212  * before touching syncgroups or the main syncgroup list.
  213  */
  214 struct mtx snd_pcm_syncgroups_mtx;
  215 MTX_SYSINIT(pcm_syncgroup, &snd_pcm_syncgroups_mtx, "PCM channel sync group lock", MTX_DEF);
  216 /**
  217  * @brief syncgroups' master list
  218  *
  219  * Each time a channel syncgroup is created, it's added to this list.  This
  220  * list should only be accessed with @sa snd_pcm_syncgroups_mtx held.
  221  *
  222  * See SNDCTL_DSP_SYNCGROUP for more information.
  223  */
  224 struct pcm_synclist snd_pcm_syncgroups = SLIST_HEAD_INITIALIZER(snd_pcm_syncgroups);
  225 
  226 static void
  227 chn_lockinit(struct pcm_channel *c, int dir)
  228 {
  229         switch (dir) {
  230         case PCMDIR_PLAY:
  231                 c->lock = snd_mtxcreate(c->name, "pcm play channel");
  232                 cv_init(&c->intr_cv, "pcmwr");
  233                 break;
  234         case PCMDIR_PLAY_VIRTUAL:
  235                 c->lock = snd_mtxcreate(c->name, "pcm virtual play channel");
  236                 cv_init(&c->intr_cv, "pcmwrv");
  237                 break;
  238         case PCMDIR_REC:
  239                 c->lock = snd_mtxcreate(c->name, "pcm record channel");
  240                 cv_init(&c->intr_cv, "pcmrd");
  241                 break;
  242         case PCMDIR_REC_VIRTUAL:
  243                 c->lock = snd_mtxcreate(c->name, "pcm virtual record channel");
  244                 cv_init(&c->intr_cv, "pcmrdv");
  245                 break;
  246         default:
  247                 panic("%s(): Invalid direction=%d", __func__, dir);
  248                 break;
  249         }
  250 
  251         cv_init(&c->cv, "pcmchn");
  252 }
  253 
  254 static void
  255 chn_lockdestroy(struct pcm_channel *c)
  256 {
  257         CHN_LOCKASSERT(c);
  258 
  259         CHN_BROADCAST(&c->cv);
  260         CHN_BROADCAST(&c->intr_cv);
  261 
  262         cv_destroy(&c->cv);
  263         cv_destroy(&c->intr_cv);
  264 
  265         snd_mtxfree(c->lock);
  266 }
  267 
  268 /**
  269  * @brief Determine channel is ready for I/O
  270  *
  271  * @retval 1 = ready for I/O
  272  * @retval 0 = not ready for I/O
  273  */
  274 static int
  275 chn_polltrigger(struct pcm_channel *c)
  276 {
  277         struct snd_dbuf *bs = c->bufsoft;
  278         u_int delta;
  279 
  280         CHN_LOCKASSERT(c);
  281 
  282         if (c->flags & CHN_F_MMAP) {
  283                 if (sndbuf_getprevtotal(bs) < c->lw)
  284                         delta = c->lw;
  285                 else
  286                         delta = sndbuf_gettotal(bs) - sndbuf_getprevtotal(bs);
  287         } else {
  288                 if (c->direction == PCMDIR_PLAY)
  289                         delta = sndbuf_getfree(bs);
  290                 else
  291                         delta = sndbuf_getready(bs);
  292         }
  293 
  294         return ((delta < c->lw) ? 0 : 1);
  295 }
  296 
  297 static void
  298 chn_pollreset(struct pcm_channel *c)
  299 {
  300 
  301         CHN_LOCKASSERT(c);
  302         sndbuf_updateprevtotal(c->bufsoft);
  303 }
  304 
  305 static void
  306 chn_wakeup(struct pcm_channel *c)
  307 {
  308         struct snd_dbuf *bs;
  309         struct pcm_channel *ch;
  310 
  311         CHN_LOCKASSERT(c);
  312 
  313         bs = c->bufsoft;
  314 
  315         if (CHN_EMPTY(c, children.busy)) {
  316                 if (SEL_WAITING(sndbuf_getsel(bs)) && chn_polltrigger(c))
  317                         selwakeuppri(sndbuf_getsel(bs), PRIBIO);
  318                 if (c->flags & CHN_F_SLEEPING) {
  319                         /*
  320                          * Ok, I can just panic it right here since it is
  321                          * quite obvious that we never allow multiple waiters
  322                          * from userland. I'm too generous...
  323                          */
  324                         CHN_BROADCAST(&c->intr_cv);
  325                 }
  326         } else {
  327                 CHN_FOREACH(ch, c, children.busy) {
  328                         CHN_LOCK(ch);
  329                         chn_wakeup(ch);
  330                         CHN_UNLOCK(ch);
  331                 }
  332         }
  333 }
  334 
  335 static int
  336 chn_sleep(struct pcm_channel *c, int timeout)
  337 {
  338         int ret;
  339 
  340         CHN_LOCKASSERT(c);
  341 
  342         if (c->flags & CHN_F_DEAD)
  343                 return (EINVAL);
  344 
  345         c->flags |= CHN_F_SLEEPING;
  346         ret = cv_timedwait_sig(&c->intr_cv, c->lock, timeout);
  347         c->flags &= ~CHN_F_SLEEPING;
  348 
  349         return ((c->flags & CHN_F_DEAD) ? EINVAL : ret);
  350 }
  351 
  352 /*
  353  * chn_dmaupdate() tracks the status of a dma transfer,
  354  * updating pointers.
  355  */
  356 
  357 static unsigned int
  358 chn_dmaupdate(struct pcm_channel *c)
  359 {
  360         struct snd_dbuf *b = c->bufhard;
  361         unsigned int delta, old, hwptr, amt;
  362 
  363         KASSERT(sndbuf_getsize(b) > 0, ("bufsize == 0"));
  364         CHN_LOCKASSERT(c);
  365 
  366         old = sndbuf_gethwptr(b);
  367         hwptr = chn_getptr(c);
  368         delta = (sndbuf_getsize(b) + hwptr - old) % sndbuf_getsize(b);
  369         sndbuf_sethwptr(b, hwptr);
  370 
  371         if (c->direction == PCMDIR_PLAY) {
  372                 amt = min(delta, sndbuf_getready(b));
  373                 amt -= amt % sndbuf_getalign(b);
  374                 if (amt > 0)
  375                         sndbuf_dispose(b, NULL, amt);
  376         } else {
  377                 amt = min(delta, sndbuf_getfree(b));
  378                 amt -= amt % sndbuf_getalign(b);
  379                 if (amt > 0)
  380                        sndbuf_acquire(b, NULL, amt);
  381         }
  382         if (snd_verbose > 3 && CHN_STARTED(c) && delta == 0) {
  383                 device_printf(c->dev, "WARNING: %s DMA completion "
  384                         "too fast/slow ! hwptr=%u, old=%u "
  385                         "delta=%u amt=%u ready=%u free=%u\n",
  386                         CHN_DIRSTR(c), hwptr, old, delta, amt,
  387                         sndbuf_getready(b), sndbuf_getfree(b));
  388         }
  389 
  390         return delta;
  391 }
  392 
  393 static void
  394 chn_wrfeed(struct pcm_channel *c)
  395 {
  396         struct snd_dbuf *b = c->bufhard;
  397         struct snd_dbuf *bs = c->bufsoft;
  398         unsigned int amt, want, wasfree;
  399 
  400         CHN_LOCKASSERT(c);
  401 
  402         if ((c->flags & CHN_F_MMAP) && !(c->flags & CHN_F_CLOSING))
  403                 sndbuf_acquire(bs, NULL, sndbuf_getfree(bs));
  404 
  405         wasfree = sndbuf_getfree(b);
  406         want = min(sndbuf_getsize(b),
  407             imax(0, sndbuf_xbytes(sndbuf_getsize(bs), bs, b) -
  408              sndbuf_getready(b)));
  409         amt = min(wasfree, want);
  410         if (amt > 0)
  411                 sndbuf_feed(bs, b, c, c->feeder, amt);
  412 
  413         /*
  414          * Possible xruns. There should be no empty space left in buffer.
  415          */
  416         if (sndbuf_getready(b) < want)
  417                 c->xruns++;
  418 
  419         if (sndbuf_getfree(b) < wasfree)
  420                 chn_wakeup(c);
  421 }
  422 
  423 #if 0
  424 static void
  425 chn_wrupdate(struct pcm_channel *c)
  426 {
  427 
  428         CHN_LOCKASSERT(c);
  429         KASSERT(c->direction == PCMDIR_PLAY, ("%s(): bad channel", __func__));
  430 
  431         if ((c->flags & (CHN_F_MMAP | CHN_F_VIRTUAL)) || CHN_STOPPED(c))
  432                 return;
  433         chn_dmaupdate(c);
  434         chn_wrfeed(c);
  435         /* tell the driver we've updated the primary buffer */
  436         chn_trigger(c, PCMTRIG_EMLDMAWR);
  437 }
  438 #endif
  439 
  440 static void
  441 chn_wrintr(struct pcm_channel *c)
  442 {
  443 
  444         CHN_LOCKASSERT(c);
  445         /* update pointers in primary buffer */
  446         chn_dmaupdate(c);
  447         /* ...and feed from secondary to primary */
  448         chn_wrfeed(c);
  449         /* tell the driver we've updated the primary buffer */
  450         chn_trigger(c, PCMTRIG_EMLDMAWR);
  451 }
  452 
  453 /*
  454  * user write routine - uiomove data into secondary buffer, trigger if necessary
  455  * if blocking, sleep, rinse and repeat.
  456  *
  457  * called externally, so must handle locking
  458  */
  459 
  460 int
  461 chn_write(struct pcm_channel *c, struct uio *buf)
  462 {
  463         struct snd_dbuf *bs = c->bufsoft;
  464         void *off;
  465         int ret, timeout, sz, t, p;
  466 
  467         CHN_LOCKASSERT(c);
  468 
  469         ret = 0;
  470         timeout = chn_timeout * hz;
  471 
  472         while (ret == 0 && buf->uio_resid > 0) {
  473                 sz = min(buf->uio_resid, sndbuf_getfree(bs));
  474                 if (sz > 0) {
  475                         /*
  476                          * The following assumes that the free space in
  477                          * the buffer can never be less around the
  478                          * unlock-uiomove-lock sequence.
  479                          */
  480                         while (ret == 0 && sz > 0) {
  481                                 p = sndbuf_getfreeptr(bs);
  482                                 t = min(sz, sndbuf_getsize(bs) - p);
  483                                 off = sndbuf_getbufofs(bs, p);
  484                                 CHN_UNLOCK(c);
  485                                 ret = uiomove(off, t, buf);
  486                                 CHN_LOCK(c);
  487                                 sz -= t;
  488                                 sndbuf_acquire(bs, NULL, t);
  489                         }
  490                         ret = 0;
  491                         if (CHN_STOPPED(c) && !(c->flags & CHN_F_NOTRIGGER)) {
  492                                 ret = chn_start(c, 0);
  493                                 if (ret != 0)
  494                                         c->flags |= CHN_F_DEAD;
  495                         }
  496                 } else if (c->flags & (CHN_F_NBIO | CHN_F_NOTRIGGER)) {
  497                         /**
  498                          * @todo Evaluate whether EAGAIN is truly desirable.
  499                          *       4Front drivers behave like this, but I'm
  500                          *       not sure if it at all violates the "write
  501                          *       should be allowed to block" model.
  502                          *
  503                          *       The idea is that, while set with CHN_F_NOTRIGGER,
  504                          *       a channel isn't playing, *but* without this we
  505                          *       end up with "interrupt timeout / channel dead".
  506                          */
  507                         ret = EAGAIN;
  508                 } else {
  509                         ret = chn_sleep(c, timeout);
  510                         if (ret == EAGAIN) {
  511                                 ret = EINVAL;
  512                                 c->flags |= CHN_F_DEAD;
  513                                 device_printf(c->dev, "%s(): %s: "
  514                                     "play interrupt timeout, channel dead\n",
  515                                     __func__, c->name);
  516                         } else if (ret == ERESTART || ret == EINTR)
  517                                 c->flags |= CHN_F_ABORTING;
  518                 }
  519         }
  520 
  521         return (ret);
  522 }
  523 
  524 /*
  525  * Feed new data from the read buffer. Can be called in the bottom half.
  526  */
  527 static void
  528 chn_rdfeed(struct pcm_channel *c)
  529 {
  530         struct snd_dbuf *b = c->bufhard;
  531         struct snd_dbuf *bs = c->bufsoft;
  532         unsigned int amt;
  533 
  534         CHN_LOCKASSERT(c);
  535 
  536         if (c->flags & CHN_F_MMAP)
  537                 sndbuf_dispose(bs, NULL, sndbuf_getready(bs));
  538 
  539         amt = sndbuf_getfree(bs);
  540         if (amt > 0)
  541                 sndbuf_feed(b, bs, c, c->feeder, amt);
  542 
  543         amt = sndbuf_getready(b);
  544         if (amt > 0) {
  545                 c->xruns++;
  546                 sndbuf_dispose(b, NULL, amt);
  547         }
  548 
  549         if (sndbuf_getready(bs) > 0)
  550                 chn_wakeup(c);
  551 }
  552 
  553 #if 0
  554 static void
  555 chn_rdupdate(struct pcm_channel *c)
  556 {
  557 
  558         CHN_LOCKASSERT(c);
  559         KASSERT(c->direction == PCMDIR_REC, ("chn_rdupdate on bad channel"));
  560 
  561         if ((c->flags & (CHN_F_MMAP | CHN_F_VIRTUAL)) || CHN_STOPPED(c))
  562                 return;
  563         chn_trigger(c, PCMTRIG_EMLDMARD);
  564         chn_dmaupdate(c);
  565         chn_rdfeed(c);
  566 }
  567 #endif
  568 
  569 /* read interrupt routine. Must be called with interrupts blocked. */
  570 static void
  571 chn_rdintr(struct pcm_channel *c)
  572 {
  573 
  574         CHN_LOCKASSERT(c);
  575         /* tell the driver to update the primary buffer if non-dma */
  576         chn_trigger(c, PCMTRIG_EMLDMARD);
  577         /* update pointers in primary buffer */
  578         chn_dmaupdate(c);
  579         /* ...and feed from primary to secondary */
  580         chn_rdfeed(c);
  581 }
  582 
  583 /*
  584  * user read routine - trigger if necessary, uiomove data from secondary buffer
  585  * if blocking, sleep, rinse and repeat.
  586  *
  587  * called externally, so must handle locking
  588  */
  589 
  590 int
  591 chn_read(struct pcm_channel *c, struct uio *buf)
  592 {
  593         struct snd_dbuf *bs = c->bufsoft;
  594         void *off;
  595         int ret, timeout, sz, t, p;
  596 
  597         CHN_LOCKASSERT(c);
  598 
  599         if (CHN_STOPPED(c) && !(c->flags & CHN_F_NOTRIGGER)) {
  600                 ret = chn_start(c, 0);
  601                 if (ret != 0) {
  602                         c->flags |= CHN_F_DEAD;
  603                         return (ret);
  604                 }
  605         }
  606 
  607         ret = 0;
  608         timeout = chn_timeout * hz;
  609 
  610         while (ret == 0 && buf->uio_resid > 0) {
  611                 sz = min(buf->uio_resid, sndbuf_getready(bs));
  612                 if (sz > 0) {
  613                         /*
  614                          * The following assumes that the free space in
  615                          * the buffer can never be less around the
  616                          * unlock-uiomove-lock sequence.
  617                          */
  618                         while (ret == 0 && sz > 0) {
  619                                 p = sndbuf_getreadyptr(bs);
  620                                 t = min(sz, sndbuf_getsize(bs) - p);
  621                                 off = sndbuf_getbufofs(bs, p);
  622                                 CHN_UNLOCK(c);
  623                                 ret = uiomove(off, t, buf);
  624                                 CHN_LOCK(c);
  625                                 sz -= t;
  626                                 sndbuf_dispose(bs, NULL, t);
  627                         }
  628                         ret = 0;
  629                 } else if (c->flags & (CHN_F_NBIO | CHN_F_NOTRIGGER))
  630                         ret = EAGAIN;
  631                 else {
  632                         ret = chn_sleep(c, timeout);
  633                         if (ret == EAGAIN) {
  634                                 ret = EINVAL;
  635                                 c->flags |= CHN_F_DEAD;
  636                                 device_printf(c->dev, "%s(): %s: "
  637                                     "record interrupt timeout, channel dead\n",
  638                                     __func__, c->name);
  639                         } else if (ret == ERESTART || ret == EINTR)
  640                                 c->flags |= CHN_F_ABORTING;
  641                 }
  642         }
  643 
  644         return (ret);
  645 }
  646 
  647 void
  648 chn_intr_locked(struct pcm_channel *c)
  649 {
  650 
  651         CHN_LOCKASSERT(c);
  652 
  653         c->interrupts++;
  654 
  655         if (c->direction == PCMDIR_PLAY)
  656                 chn_wrintr(c);
  657         else
  658                 chn_rdintr(c);
  659 }
  660 
  661 void
  662 chn_intr(struct pcm_channel *c)
  663 {
  664 
  665         if (CHN_LOCKOWNED(c)) {
  666                 chn_intr_locked(c);
  667                 return;
  668         }
  669 
  670         CHN_LOCK(c);
  671         chn_intr_locked(c);
  672         CHN_UNLOCK(c);
  673 }
  674 
  675 u_int32_t
  676 chn_start(struct pcm_channel *c, int force)
  677 {
  678         u_int32_t i, j;
  679         struct snd_dbuf *b = c->bufhard;
  680         struct snd_dbuf *bs = c->bufsoft;
  681         int err;
  682 
  683         CHN_LOCKASSERT(c);
  684         /* if we're running, or if we're prevented from triggering, bail */
  685         if (CHN_STARTED(c) || ((c->flags & CHN_F_NOTRIGGER) && !force))
  686                 return (EINVAL);
  687 
  688         err = 0;
  689 
  690         if (force) {
  691                 i = 1;
  692                 j = 0;
  693         } else {
  694                 if (c->direction == PCMDIR_REC) {
  695                         i = sndbuf_getfree(bs);
  696                         j = (i > 0) ? 1 : sndbuf_getready(b);
  697                 } else {
  698                         if (sndbuf_getfree(bs) == 0) {
  699                                 i = 1;
  700                                 j = 0;
  701                         } else {
  702                                 struct snd_dbuf *pb;
  703 
  704                                 pb = CHN_BUF_PARENT(c, b);
  705                                 i = sndbuf_xbytes(sndbuf_getready(bs), bs, pb);
  706                                 j = sndbuf_getalign(pb);
  707                         }
  708                 }
  709                 if (snd_verbose > 3 && CHN_EMPTY(c, children))
  710                         device_printf(c->dev, "%s(): %s (%s) threshold "
  711                             "i=%d j=%d\n", __func__, CHN_DIRSTR(c),
  712                             (c->flags & CHN_F_VIRTUAL) ? "virtual" :
  713                             "hardware", i, j);
  714         }
  715 
  716         if (i >= j) {
  717                 c->flags |= CHN_F_TRIGGERED;
  718                 sndbuf_setrun(b, 1);
  719                 if (c->flags & CHN_F_CLOSING)
  720                         c->feedcount = 2;
  721                 else {
  722                         c->feedcount = 0;
  723                         c->interrupts = 0;
  724                         c->xruns = 0;
  725                 }
  726                 if (c->parentchannel == NULL) {
  727                         if (c->direction == PCMDIR_PLAY)
  728                                 sndbuf_fillsilence_rl(b,
  729                                     sndbuf_xbytes(sndbuf_getsize(bs), bs, b));
  730                         if (snd_verbose > 3)
  731                                 device_printf(c->dev,
  732                                     "%s(): %s starting! (%s/%s) "
  733                                     "(ready=%d force=%d i=%d j=%d "
  734                                     "intrtimeout=%u latency=%dms)\n",
  735                                     __func__,
  736                                     (c->flags & CHN_F_HAS_VCHAN) ?
  737                                     "VCHAN PARENT" : "HW", CHN_DIRSTR(c),
  738                                     (c->flags & CHN_F_CLOSING) ? "closing" :
  739                                     "running",
  740                                     sndbuf_getready(b),
  741                                     force, i, j, c->timeout,
  742                                     (sndbuf_getsize(b) * 1000) /
  743                                     (sndbuf_getalign(b) * sndbuf_getspd(b)));
  744                 }
  745                 err = chn_trigger(c, PCMTRIG_START);
  746         }
  747 
  748         return (err);
  749 }
  750 
  751 void
  752 chn_resetbuf(struct pcm_channel *c)
  753 {
  754         struct snd_dbuf *b = c->bufhard;
  755         struct snd_dbuf *bs = c->bufsoft;
  756 
  757         c->blocks = 0;
  758         sndbuf_reset(b);
  759         sndbuf_reset(bs);
  760 }
  761 
  762 /*
  763  * chn_sync waits until the space in the given channel goes above
  764  * a threshold. The threshold is checked against fl or rl respectively.
  765  * Assume that the condition can become true, do not check here...
  766  */
  767 int
  768 chn_sync(struct pcm_channel *c, int threshold)
  769 {
  770         struct snd_dbuf *b, *bs;
  771         int ret, count, hcount, minflush, resid, residp, syncdelay, blksz;
  772         u_int32_t cflag;
  773 
  774         CHN_LOCKASSERT(c);
  775 
  776         if (c->direction != PCMDIR_PLAY)
  777                 return (EINVAL);
  778 
  779         bs = c->bufsoft;
  780 
  781         if ((c->flags & (CHN_F_DEAD | CHN_F_ABORTING)) ||
  782             (threshold < 1 && sndbuf_getready(bs) < 1))
  783                 return (0);
  784 
  785         /* if we haven't yet started and nothing is buffered, else start*/
  786         if (CHN_STOPPED(c)) {
  787                 if (threshold > 0 || sndbuf_getready(bs) > 0) {
  788                         ret = chn_start(c, 1);
  789                         if (ret != 0)
  790                                 return (ret);
  791                 } else
  792                         return (0);
  793         }
  794 
  795         b = CHN_BUF_PARENT(c, c->bufhard);
  796 
  797         minflush = threshold + sndbuf_xbytes(sndbuf_getready(b), b, bs);
  798 
  799         syncdelay = chn_syncdelay;
  800 
  801         if (syncdelay < 0 && (threshold > 0 || sndbuf_getready(bs) > 0))
  802                 minflush += sndbuf_xbytes(sndbuf_getsize(b), b, bs);
  803 
  804         /*
  805          * Append (0-1000) millisecond trailing buffer (if needed)
  806          * for slower / high latency hardwares (notably USB audio)
  807          * to avoid audible truncation.
  808          */
  809         if (syncdelay > 0)
  810                 minflush += (sndbuf_getalign(bs) * sndbuf_getspd(bs) *
  811                     ((syncdelay > 1000) ? 1000 : syncdelay)) / 1000;
  812 
  813         minflush -= minflush % sndbuf_getalign(bs);
  814 
  815         if (minflush > 0) {
  816                 threshold = min(minflush, sndbuf_getfree(bs));
  817                 sndbuf_clear(bs, threshold);
  818                 sndbuf_acquire(bs, NULL, threshold);
  819                 minflush -= threshold;
  820         }
  821 
  822         resid = sndbuf_getready(bs);
  823         residp = resid;
  824         blksz = sndbuf_getblksz(b);
  825         if (blksz < 1) {
  826                 device_printf(c->dev,
  827                     "%s(): WARNING: blksz < 1 ! maxsize=%d [%d/%d/%d]\n",
  828                     __func__, sndbuf_getmaxsize(b), sndbuf_getsize(b),
  829                     sndbuf_getblksz(b), sndbuf_getblkcnt(b));
  830                 if (sndbuf_getblkcnt(b) > 0)
  831                         blksz = sndbuf_getsize(b) / sndbuf_getblkcnt(b);
  832                 if (blksz < 1)
  833                         blksz = 1;
  834         }
  835         count = sndbuf_xbytes(minflush + resid, bs, b) / blksz;
  836         hcount = count;
  837         ret = 0;
  838 
  839         if (snd_verbose > 3)
  840                 device_printf(c->dev, "%s(): [begin] timeout=%d count=%d "
  841                     "minflush=%d resid=%d\n", __func__, c->timeout, count,
  842                     minflush, resid);
  843 
  844         cflag = c->flags & CHN_F_CLOSING;
  845         c->flags |= CHN_F_CLOSING;
  846         while (count > 0 && (resid > 0 || minflush > 0)) {
  847                 ret = chn_sleep(c, c->timeout);
  848                 if (ret == ERESTART || ret == EINTR) {
  849                         c->flags |= CHN_F_ABORTING;
  850                         break;
  851                 } else if (ret == 0 || ret == EAGAIN) {
  852                         resid = sndbuf_getready(bs);
  853                         if (resid == residp) {
  854                                 --count;
  855                                 if (snd_verbose > 3)
  856                                         device_printf(c->dev,
  857                                             "%s(): [stalled] timeout=%d "
  858                                             "count=%d hcount=%d "
  859                                             "resid=%d minflush=%d\n",
  860                                             __func__, c->timeout, count,
  861                                             hcount, resid, minflush);
  862                         } else if (resid < residp && count < hcount) {
  863                                 ++count;
  864                                 if (snd_verbose > 3)
  865                                         device_printf(c->dev,
  866                                             "%s((): [resume] timeout=%d "
  867                                             "count=%d hcount=%d "
  868                                             "resid=%d minflush=%d\n",
  869                                             __func__, c->timeout, count,
  870                                             hcount, resid, minflush);
  871                         }
  872                         if (minflush > 0 && sndbuf_getfree(bs) > 0) {
  873                                 threshold = min(minflush,
  874                                     sndbuf_getfree(bs));
  875                                 sndbuf_clear(bs, threshold);
  876                                 sndbuf_acquire(bs, NULL, threshold);
  877                                 resid = sndbuf_getready(bs);
  878                                 minflush -= threshold;
  879                         }
  880                         residp = resid;
  881                 } else
  882                         break;
  883         }
  884         c->flags &= ~CHN_F_CLOSING;
  885         c->flags |= cflag;
  886 
  887         if (snd_verbose > 3)
  888                 device_printf(c->dev,
  889                     "%s(): timeout=%d count=%d hcount=%d resid=%d residp=%d "
  890                     "minflush=%d ret=%d\n",
  891                     __func__, c->timeout, count, hcount, resid, residp,
  892                     minflush, ret);
  893 
  894         return (0);
  895 }
  896 
  897 /* called externally, handle locking */
  898 int
  899 chn_poll(struct pcm_channel *c, int ev, struct thread *td)
  900 {
  901         struct snd_dbuf *bs = c->bufsoft;
  902         int ret;
  903 
  904         CHN_LOCKASSERT(c);
  905 
  906         if (!(c->flags & (CHN_F_MMAP | CHN_F_TRIGGERED))) {
  907                 ret = chn_start(c, 1);
  908                 if (ret != 0)
  909                         return (0);
  910         }
  911 
  912         ret = 0;
  913         if (chn_polltrigger(c)) {
  914                 chn_pollreset(c);
  915                 ret = ev;
  916         } else
  917                 selrecord(td, sndbuf_getsel(bs));
  918 
  919         return (ret);
  920 }
  921 
  922 /*
  923  * chn_abort terminates a running dma transfer.  it may sleep up to 200ms.
  924  * it returns the number of bytes that have not been transferred.
  925  *
  926  * called from: dsp_close, dsp_ioctl, with channel locked
  927  */
  928 int
  929 chn_abort(struct pcm_channel *c)
  930 {
  931         int missing = 0;
  932         struct snd_dbuf *b = c->bufhard;
  933         struct snd_dbuf *bs = c->bufsoft;
  934 
  935         CHN_LOCKASSERT(c);
  936         if (CHN_STOPPED(c))
  937                 return 0;
  938         c->flags |= CHN_F_ABORTING;
  939 
  940         c->flags &= ~CHN_F_TRIGGERED;
  941         /* kill the channel */
  942         chn_trigger(c, PCMTRIG_ABORT);
  943         sndbuf_setrun(b, 0);
  944         if (!(c->flags & CHN_F_VIRTUAL))
  945                 chn_dmaupdate(c);
  946         missing = sndbuf_getready(bs);
  947 
  948         c->flags &= ~CHN_F_ABORTING;
  949         return missing;
  950 }
  951 
  952 /*
  953  * this routine tries to flush the dma transfer. It is called
  954  * on a close of a playback channel.
  955  * first, if there is data in the buffer, but the dma has not yet
  956  * begun, we need to start it.
  957  * next, we wait for the play buffer to drain
  958  * finally, we stop the dma.
  959  *
  960  * called from: dsp_close, not valid for record channels.
  961  */
  962 
  963 int
  964 chn_flush(struct pcm_channel *c)
  965 {
  966         struct snd_dbuf *b = c->bufhard;
  967 
  968         CHN_LOCKASSERT(c);
  969         KASSERT(c->direction == PCMDIR_PLAY, ("chn_flush on bad channel"));
  970         DEB(printf("chn_flush: c->flags 0x%08x\n", c->flags));
  971 
  972         c->flags |= CHN_F_CLOSING;
  973         chn_sync(c, 0);
  974         c->flags &= ~CHN_F_TRIGGERED;
  975         /* kill the channel */
  976         chn_trigger(c, PCMTRIG_ABORT);
  977         sndbuf_setrun(b, 0);
  978 
  979         c->flags &= ~CHN_F_CLOSING;
  980         return 0;
  981 }
  982 
  983 int
  984 snd_fmtvalid(uint32_t fmt, uint32_t *fmtlist)
  985 {
  986         int i;
  987 
  988         for (i = 0; fmtlist[i] != 0; i++) {
  989                 if (fmt == fmtlist[i] ||
  990                     ((fmt & AFMT_PASSTHROUGH) &&
  991                     (AFMT_ENCODING(fmt) & fmtlist[i])))
  992                         return (1);
  993         }
  994 
  995         return (0);
  996 }
  997 
  998 static const struct {
  999         char *name, *alias1, *alias2;
 1000         uint32_t afmt;
 1001 } afmt_tab[] = {
 1002         {  "alaw",  NULL, NULL, AFMT_A_LAW  },
 1003         { "mulaw",  NULL, NULL, AFMT_MU_LAW },
 1004         {    "u8",   "8", NULL, AFMT_U8     },
 1005         {    "s8",  NULL, NULL, AFMT_S8     },
 1006 #if BYTE_ORDER == LITTLE_ENDIAN
 1007         { "s16le", "s16", "16", AFMT_S16_LE },
 1008         { "s16be",  NULL, NULL, AFMT_S16_BE },
 1009 #else
 1010         { "s16le",  NULL, NULL, AFMT_S16_LE },
 1011         { "s16be", "s16", "16", AFMT_S16_BE },
 1012 #endif
 1013         { "u16le",  NULL, NULL, AFMT_U16_LE },
 1014         { "u16be",  NULL, NULL, AFMT_U16_BE },
 1015         { "s24le",  NULL, NULL, AFMT_S24_LE },
 1016         { "s24be",  NULL, NULL, AFMT_S24_BE },
 1017         { "u24le",  NULL, NULL, AFMT_U24_LE },
 1018         { "u24be",  NULL, NULL, AFMT_U24_BE },
 1019 #if BYTE_ORDER == LITTLE_ENDIAN
 1020         { "s32le", "s32", "32", AFMT_S32_LE },
 1021         { "s32be",  NULL, NULL, AFMT_S32_BE },
 1022 #else
 1023         { "s32le",  NULL, NULL, AFMT_S32_LE },
 1024         { "s32be", "s32", "32", AFMT_S32_BE },
 1025 #endif
 1026         { "u32le",  NULL, NULL, AFMT_U32_LE },
 1027         { "u32be",  NULL, NULL, AFMT_U32_BE },
 1028         {   "ac3",  NULL, NULL, AFMT_AC3    },
 1029         {    NULL,  NULL, NULL, 0           }
 1030 };
 1031 
 1032 static const struct {
 1033         char *name, *alias1, *alias2;
 1034         int matrix_id;
 1035 } matrix_id_tab[] = {
 1036         { "1.0",  "1",   "mono", SND_CHN_MATRIX_1_0     },
 1037         { "2.0",  "2", "stereo", SND_CHN_MATRIX_2_0     },
 1038         { "2.1", NULL,     NULL, SND_CHN_MATRIX_2_1     },
 1039         { "3.0",  "3",     NULL, SND_CHN_MATRIX_3_0     },
 1040         { "3.1", NULL,     NULL, SND_CHN_MATRIX_3_1     },
 1041         { "4.0",  "4",   "quad", SND_CHN_MATRIX_4_0     },
 1042         { "4.1", NULL,     NULL, SND_CHN_MATRIX_4_1     },
 1043         { "5.0",  "5",     NULL, SND_CHN_MATRIX_5_0     },
 1044         { "5.1",  "6",     NULL, SND_CHN_MATRIX_5_1     },
 1045         { "6.0", NULL,     NULL, SND_CHN_MATRIX_6_0     },
 1046         { "6.1",  "7",     NULL, SND_CHN_MATRIX_6_1     },
 1047         { "7.0", NULL,     NULL, SND_CHN_MATRIX_7_0     },
 1048         { "7.1",  "8",     NULL, SND_CHN_MATRIX_7_1     },
 1049         {  NULL, NULL,     NULL, SND_CHN_MATRIX_UNKNOWN }
 1050 };
 1051 
 1052 uint32_t
 1053 snd_str2afmt(const char *req)
 1054 {
 1055         uint32_t i, afmt;
 1056         int matrix_id;
 1057         char b1[8], b2[8];
 1058 
 1059         i = sscanf(req, "%5[^:]:%6s", b1, b2);
 1060 
 1061         if (i == 1) {
 1062                 if (strlen(req) != strlen(b1))
 1063                         return (0);
 1064                 strlcpy(b2, "2.0", sizeof(b2));
 1065         } else if (i == 2) {
 1066                 if (strlen(req) != (strlen(b1) + 1 + strlen(b2)))
 1067                         return (0);
 1068         } else
 1069                 return (0);
 1070 
 1071         afmt = 0;
 1072         matrix_id = SND_CHN_MATRIX_UNKNOWN;
 1073 
 1074         for (i = 0; afmt == 0 && afmt_tab[i].name != NULL; i++) {
 1075                 if (strcasecmp(afmt_tab[i].name, b1) == 0 ||
 1076                     (afmt_tab[i].alias1 != NULL &&
 1077                     strcasecmp(afmt_tab[i].alias1, b1) == 0) ||
 1078                     (afmt_tab[i].alias2 != NULL &&
 1079                     strcasecmp(afmt_tab[i].alias2, b1) == 0)) {
 1080                         afmt = afmt_tab[i].afmt;
 1081                         strlcpy(b1, afmt_tab[i].name, sizeof(b1));
 1082                 }
 1083         }
 1084 
 1085         if (afmt == 0)
 1086                 return (0);
 1087 
 1088         for (i = 0; matrix_id == SND_CHN_MATRIX_UNKNOWN &&
 1089             matrix_id_tab[i].name != NULL; i++) {
 1090                 if (strcmp(matrix_id_tab[i].name, b2) == 0 ||
 1091                     (matrix_id_tab[i].alias1 != NULL &&
 1092                     strcmp(matrix_id_tab[i].alias1, b2) == 0) ||
 1093                     (matrix_id_tab[i].alias2 != NULL &&
 1094                     strcasecmp(matrix_id_tab[i].alias2, b2) == 0)) {
 1095                         matrix_id = matrix_id_tab[i].matrix_id;
 1096                         strlcpy(b2, matrix_id_tab[i].name, sizeof(b2));
 1097                 }
 1098         }
 1099 
 1100         if (matrix_id == SND_CHN_MATRIX_UNKNOWN)
 1101                 return (0);
 1102 
 1103 #ifndef _KERNEL
 1104         printf("Parse OK: '%s' -> '%s:%s' %d\n", req, b1, b2,
 1105             (int)(b2[0]) - '' + (int)(b2[2]) - '');
 1106 #endif
 1107 
 1108         return (SND_FORMAT(afmt, b2[0] - '' + b2[2] - '', b2[2] - ''));
 1109 }
 1110 
 1111 uint32_t
 1112 snd_afmt2str(uint32_t afmt, char *buf, size_t len)
 1113 {
 1114         uint32_t i, enc, ch, ext;
 1115         char tmp[AFMTSTR_LEN];
 1116 
 1117         if (buf == NULL || len < AFMTSTR_LEN)
 1118                 return (0);
 1119 
 1120         
 1121         bzero(tmp, sizeof(tmp));
 1122 
 1123         enc = AFMT_ENCODING(afmt);
 1124         ch = AFMT_CHANNEL(afmt);
 1125         ext = AFMT_EXTCHANNEL(afmt);
 1126 
 1127         for (i = 0; afmt_tab[i].name != NULL; i++) {
 1128                 if (enc == afmt_tab[i].afmt) {
 1129                         strlcpy(tmp, afmt_tab[i].name, sizeof(tmp));
 1130                         strlcat(tmp, ":", sizeof(tmp));
 1131                         break;
 1132                 }
 1133         }
 1134 
 1135         if (strlen(tmp) == 0)
 1136                 return (0);
 1137         
 1138         for (i = 0; matrix_id_tab[i].name != NULL; i++) {
 1139                 if (ch == (matrix_id_tab[i].name[0] - '' +
 1140                     matrix_id_tab[i].name[2] - '') &&
 1141                     ext == (matrix_id_tab[i].name[2] - '')) {
 1142                         strlcat(tmp, matrix_id_tab[i].name, sizeof(tmp));
 1143                         break;
 1144                 }
 1145         }
 1146 
 1147         if (strlen(tmp) == 0)
 1148                 return (0);
 1149 
 1150         strlcpy(buf, tmp, len);
 1151 
 1152         return (snd_str2afmt(buf));
 1153 }
 1154 
 1155 int
 1156 chn_reset(struct pcm_channel *c, uint32_t fmt, uint32_t spd)
 1157 {
 1158         int r;
 1159 
 1160         CHN_LOCKASSERT(c);
 1161         c->feedcount = 0;
 1162         c->flags &= CHN_F_RESET;
 1163         c->interrupts = 0;
 1164         c->timeout = 1;
 1165         c->xruns = 0;
 1166 
 1167         c->flags |= (pcm_getflags(c->dev) & SD_F_BITPERFECT) ?
 1168             CHN_F_BITPERFECT : 0;
 1169 
 1170         r = CHANNEL_RESET(c->methods, c->devinfo);
 1171         if (r == 0 && fmt != 0 && spd != 0) {
 1172                 r = chn_setparam(c, fmt, spd);
 1173                 fmt = 0;
 1174                 spd = 0;
 1175         }
 1176         if (r == 0 && fmt != 0)
 1177                 r = chn_setformat(c, fmt);
 1178         if (r == 0 && spd != 0)
 1179                 r = chn_setspeed(c, spd);
 1180         if (r == 0)
 1181                 r = chn_setlatency(c, chn_latency);
 1182         if (r == 0) {
 1183                 chn_resetbuf(c);
 1184                 r = CHANNEL_RESETDONE(c->methods, c->devinfo);
 1185         }
 1186         return r;
 1187 }
 1188 
 1189 int
 1190 chn_init(struct pcm_channel *c, void *devinfo, int dir, int direction)
 1191 {
 1192         struct feeder_class *fc;
 1193         struct snd_dbuf *b, *bs;
 1194         int i, ret;
 1195 
 1196         if (chn_timeout < CHN_TIMEOUT_MIN || chn_timeout > CHN_TIMEOUT_MAX)
 1197                 chn_timeout = CHN_TIMEOUT;
 1198 
 1199         chn_lockinit(c, dir);
 1200 
 1201         b = NULL;
 1202         bs = NULL;
 1203         CHN_INIT(c, children);
 1204         CHN_INIT(c, children.busy);
 1205         c->devinfo = NULL;
 1206         c->feeder = NULL;
 1207         c->latency = -1;
 1208         c->timeout = 1;
 1209 
 1210         ret = ENOMEM;
 1211         b = sndbuf_create(c->dev, c->name, "primary", c);
 1212         if (b == NULL)
 1213                 goto out;
 1214         bs = sndbuf_create(c->dev, c->name, "secondary", c);
 1215         if (bs == NULL)
 1216                 goto out;
 1217 
 1218         CHN_LOCK(c);
 1219 
 1220         ret = EINVAL;
 1221         fc = feeder_getclass(NULL);
 1222         if (fc == NULL)
 1223                 goto out;
 1224         if (chn_addfeeder(c, fc, NULL))
 1225                 goto out;
 1226 
 1227         /*
 1228          * XXX - sndbuf_setup() & sndbuf_resize() expect to be called
 1229          *       with the channel unlocked because they are also called
 1230          *       from driver methods that don't know about locking
 1231          */
 1232         CHN_UNLOCK(c);
 1233         sndbuf_setup(bs, NULL, 0);
 1234         CHN_LOCK(c);
 1235         c->bufhard = b;
 1236         c->bufsoft = bs;
 1237         c->flags = 0;
 1238         c->feederflags = 0;
 1239         c->sm = NULL;
 1240         c->format = SND_FORMAT(AFMT_U8, 1, 0);
 1241         c->speed = DSP_DEFAULT_SPEED;
 1242 
 1243         c->matrix = *feeder_matrix_id_map(SND_CHN_MATRIX_1_0);
 1244         c->matrix.id = SND_CHN_MATRIX_PCMCHANNEL;
 1245 
 1246         for (i = 0; i < SND_CHN_T_MAX; i++) {
 1247                 c->volume[SND_VOL_C_MASTER][i] = SND_VOL_0DB_MASTER;
 1248         }
 1249 
 1250         c->volume[SND_VOL_C_MASTER][SND_CHN_T_VOL_0DB] = SND_VOL_0DB_MASTER;
 1251         c->volume[SND_VOL_C_PCM][SND_CHN_T_VOL_0DB] = chn_vol_0db_pcm;
 1252 
 1253         chn_vpc_reset(c, SND_VOL_C_PCM, 1);
 1254 
 1255         ret = ENODEV;
 1256         CHN_UNLOCK(c); /* XXX - Unlock for CHANNEL_INIT() malloc() call */
 1257         c->devinfo = CHANNEL_INIT(c->methods, devinfo, b, c, direction);
 1258         CHN_LOCK(c);
 1259         if (c->devinfo == NULL)
 1260                 goto out;
 1261 
 1262         ret = ENOMEM;
 1263         if ((sndbuf_getsize(b) == 0) && ((c->flags & CHN_F_VIRTUAL) == 0))
 1264                 goto out;
 1265 
 1266         ret = 0;
 1267         c->direction = direction;
 1268 
 1269         sndbuf_setfmt(b, c->format);
 1270         sndbuf_setspd(b, c->speed);
 1271         sndbuf_setfmt(bs, c->format);
 1272         sndbuf_setspd(bs, c->speed);
 1273 
 1274         /**
 1275          * @todo Should this be moved somewhere else?  The primary buffer
 1276          *       is allocated by the driver or via DMA map setup, and tmpbuf
 1277          *       seems to only come into existence in sndbuf_resize().
 1278          */
 1279         if (c->direction == PCMDIR_PLAY) {
 1280                 bs->sl = sndbuf_getmaxsize(bs);
 1281                 bs->shadbuf = malloc(bs->sl, M_DEVBUF, M_NOWAIT);
 1282                 if (bs->shadbuf == NULL) {
 1283                         ret = ENOMEM;
 1284                         goto out;
 1285                 }
 1286         }
 1287 
 1288 out:
 1289         CHN_UNLOCK(c);
 1290         if (ret) {
 1291                 if (c->devinfo) {
 1292                         if (CHANNEL_FREE(c->methods, c->devinfo))
 1293                                 sndbuf_free(b);
 1294                 }
 1295                 if (bs)
 1296                         sndbuf_destroy(bs);
 1297                 if (b)
 1298                         sndbuf_destroy(b);
 1299                 CHN_LOCK(c);
 1300                 c->flags |= CHN_F_DEAD;
 1301                 chn_lockdestroy(c);
 1302 
 1303                 return ret;
 1304         }
 1305 
 1306         return 0;
 1307 }
 1308 
 1309 int
 1310 chn_kill(struct pcm_channel *c)
 1311 {
 1312         struct snd_dbuf *b = c->bufhard;
 1313         struct snd_dbuf *bs = c->bufsoft;
 1314 
 1315         if (CHN_STARTED(c)) {
 1316                 CHN_LOCK(c);
 1317                 chn_trigger(c, PCMTRIG_ABORT);
 1318                 CHN_UNLOCK(c);
 1319         }
 1320         while (chn_removefeeder(c) == 0)
 1321                 ;
 1322         if (CHANNEL_FREE(c->methods, c->devinfo))
 1323                 sndbuf_free(b);
 1324         sndbuf_destroy(bs);
 1325         sndbuf_destroy(b);
 1326         CHN_LOCK(c);
 1327         c->flags |= CHN_F_DEAD;
 1328         chn_lockdestroy(c);
 1329 
 1330         return (0);
 1331 }
 1332 
 1333 /* XXX Obsolete. Use *_matrix() variant instead. */
 1334 int
 1335 chn_setvolume(struct pcm_channel *c, int left, int right)
 1336 {
 1337         int ret;
 1338 
 1339         ret = chn_setvolume_matrix(c, SND_VOL_C_MASTER, SND_CHN_T_FL, left);
 1340         ret |= chn_setvolume_matrix(c, SND_VOL_C_MASTER, SND_CHN_T_FR,
 1341             right) << 8;
 1342 
 1343         return (ret);
 1344 }
 1345 
 1346 int
 1347 chn_setvolume_multi(struct pcm_channel *c, int vc, int left, int right,
 1348     int center)
 1349 {
 1350         int i, ret;
 1351 
 1352         ret = 0;
 1353 
 1354         for (i = 0; i < SND_CHN_T_MAX; i++) {
 1355                 if ((1 << i) & SND_CHN_LEFT_MASK)
 1356                         ret |= chn_setvolume_matrix(c, vc, i, left);
 1357                 else if ((1 << i) & SND_CHN_RIGHT_MASK)
 1358                         ret |= chn_setvolume_matrix(c, vc, i, right) << 8;
 1359                 else
 1360                         ret |= chn_setvolume_matrix(c, vc, i, center) << 16;
 1361         }
 1362 
 1363         return (ret);
 1364 }
 1365 
 1366 int
 1367 chn_setvolume_matrix(struct pcm_channel *c, int vc, int vt, int val)
 1368 {
 1369         int i;
 1370 
 1371         KASSERT(c != NULL && vc >= SND_VOL_C_MASTER && vc < SND_VOL_C_MAX &&
 1372             (vc == SND_VOL_C_MASTER || (vc & 1)) &&
 1373             (vt == SND_CHN_T_VOL_0DB || (vt >= SND_CHN_T_BEGIN &&
 1374             vt <= SND_CHN_T_END)) && (vt != SND_CHN_T_VOL_0DB ||
 1375             (val >= SND_VOL_0DB_MIN && val <= SND_VOL_0DB_MAX)),
 1376             ("%s(): invalid volume matrix c=%p vc=%d vt=%d val=%d",
 1377             __func__, c, vc, vt, val));
 1378         CHN_LOCKASSERT(c);
 1379 
 1380         if (val < 0)
 1381                 val = 0;
 1382         if (val > 100)
 1383                 val = 100;
 1384 
 1385         c->volume[vc][vt] = val;
 1386 
 1387         /*
 1388          * Do relative calculation here and store it into class + 1
 1389          * to ease the job of feeder_volume.
 1390          */
 1391         if (vc == SND_VOL_C_MASTER) {
 1392                 for (vc = SND_VOL_C_BEGIN; vc <= SND_VOL_C_END;
 1393                     vc += SND_VOL_C_STEP)
 1394                         c->volume[SND_VOL_C_VAL(vc)][vt] =
 1395                             SND_VOL_CALC_VAL(c->volume, vc, vt);
 1396         } else if (vc & 1) {
 1397                 if (vt == SND_CHN_T_VOL_0DB)
 1398                         for (i = SND_CHN_T_BEGIN; i <= SND_CHN_T_END;
 1399                             i += SND_CHN_T_STEP) {
 1400                                 c->volume[SND_VOL_C_VAL(vc)][i] =
 1401                                     SND_VOL_CALC_VAL(c->volume, vc, i);
 1402                         }
 1403                 else
 1404                         c->volume[SND_VOL_C_VAL(vc)][vt] =
 1405                             SND_VOL_CALC_VAL(c->volume, vc, vt);
 1406         }
 1407 
 1408         return (val);
 1409 }
 1410 
 1411 int
 1412 chn_getvolume_matrix(struct pcm_channel *c, int vc, int vt)
 1413 {
 1414         KASSERT(c != NULL && vc >= SND_VOL_C_MASTER && vc < SND_VOL_C_MAX &&
 1415             (vt == SND_CHN_T_VOL_0DB ||
 1416             (vt >= SND_CHN_T_BEGIN && vt <= SND_CHN_T_END)),
 1417             ("%s(): invalid volume matrix c=%p vc=%d vt=%d",
 1418             __func__, c, vc, vt));
 1419         CHN_LOCKASSERT(c);
 1420 
 1421         return (c->volume[vc][vt]);
 1422 }
 1423 
 1424 struct pcmchan_matrix *
 1425 chn_getmatrix(struct pcm_channel *c)
 1426 {
 1427 
 1428         KASSERT(c != NULL, ("%s(): NULL channel", __func__));
 1429         CHN_LOCKASSERT(c);
 1430 
 1431         if (!(c->format & AFMT_CONVERTIBLE))
 1432                 return (NULL);
 1433 
 1434         return (&c->matrix);
 1435 }
 1436 
 1437 int
 1438 chn_setmatrix(struct pcm_channel *c, struct pcmchan_matrix *m)
 1439 {
 1440 
 1441         KASSERT(c != NULL && m != NULL,
 1442             ("%s(): NULL channel or matrix", __func__));
 1443         CHN_LOCKASSERT(c);
 1444 
 1445         if (!(c->format & AFMT_CONVERTIBLE))
 1446                 return (EINVAL);
 1447 
 1448         c->matrix = *m;
 1449         c->matrix.id = SND_CHN_MATRIX_PCMCHANNEL;
 1450 
 1451         return (chn_setformat(c, SND_FORMAT(c->format, m->channels, m->ext)));
 1452 }
 1453 
 1454 /*
 1455  * XXX chn_oss_* exists for the sake of compatibility.
 1456  */
 1457 int
 1458 chn_oss_getorder(struct pcm_channel *c, unsigned long long *map)
 1459 {
 1460 
 1461         KASSERT(c != NULL && map != NULL,
 1462             ("%s(): NULL channel or map", __func__));
 1463         CHN_LOCKASSERT(c);
 1464 
 1465         if (!(c->format & AFMT_CONVERTIBLE))
 1466                 return (EINVAL);
 1467 
 1468         return (feeder_matrix_oss_get_channel_order(&c->matrix, map));
 1469 }
 1470 
 1471 int
 1472 chn_oss_setorder(struct pcm_channel *c, unsigned long long *map)
 1473 {
 1474         struct pcmchan_matrix m;
 1475         int ret;
 1476 
 1477         KASSERT(c != NULL && map != NULL,
 1478             ("%s(): NULL channel or map", __func__));
 1479         CHN_LOCKASSERT(c);
 1480 
 1481         if (!(c->format & AFMT_CONVERTIBLE))
 1482                 return (EINVAL);
 1483 
 1484         m = c->matrix;
 1485         ret = feeder_matrix_oss_set_channel_order(&m, map);
 1486         if (ret != 0)
 1487                 return (ret);
 1488 
 1489         return (chn_setmatrix(c, &m));
 1490 }
 1491 
 1492 #define SND_CHN_OSS_FRONT       (SND_CHN_T_MASK_FL | SND_CHN_T_MASK_FR)
 1493 #define SND_CHN_OSS_SURR        (SND_CHN_T_MASK_SL | SND_CHN_T_MASK_SR)
 1494 #define SND_CHN_OSS_CENTER_LFE  (SND_CHN_T_MASK_FC | SND_CHN_T_MASK_LF)
 1495 #define SND_CHN_OSS_REAR        (SND_CHN_T_MASK_BL | SND_CHN_T_MASK_BR)
 1496 
 1497 int
 1498 chn_oss_getmask(struct pcm_channel *c, uint32_t *retmask)
 1499 {
 1500         struct pcmchan_matrix *m;
 1501         struct pcmchan_caps *caps;
 1502         uint32_t i, format;
 1503 
 1504         KASSERT(c != NULL && retmask != NULL,
 1505             ("%s(): NULL channel or retmask", __func__));
 1506         CHN_LOCKASSERT(c);
 1507 
 1508         caps = chn_getcaps(c);
 1509         if (caps == NULL || caps->fmtlist == NULL)
 1510                 return (ENODEV);
 1511 
 1512         for (i = 0; caps->fmtlist[i] != 0; i++) {
 1513                 format = caps->fmtlist[i];
 1514                 if (!(format & AFMT_CONVERTIBLE)) {
 1515                         *retmask |= DSP_BIND_SPDIF;
 1516                         continue;
 1517                 }
 1518                 m = CHANNEL_GETMATRIX(c->methods, c->devinfo, format);
 1519                 if (m == NULL)
 1520                         continue;
 1521                 if (m->mask & SND_CHN_OSS_FRONT)
 1522                         *retmask |= DSP_BIND_FRONT;
 1523                 if (m->mask & SND_CHN_OSS_SURR)
 1524                         *retmask |= DSP_BIND_SURR;
 1525                 if (m->mask & SND_CHN_OSS_CENTER_LFE)
 1526                         *retmask |= DSP_BIND_CENTER_LFE;
 1527                 if (m->mask & SND_CHN_OSS_REAR)
 1528                         *retmask |= DSP_BIND_REAR;
 1529         }
 1530 
 1531         /* report software-supported binding mask */
 1532         if (!CHN_BITPERFECT(c) && report_soft_matrix)
 1533                 *retmask |= DSP_BIND_FRONT | DSP_BIND_SURR |
 1534                     DSP_BIND_CENTER_LFE | DSP_BIND_REAR;
 1535 
 1536         return (0);
 1537 }
 1538 
 1539 void
 1540 chn_vpc_reset(struct pcm_channel *c, int vc, int force)
 1541 {
 1542         int i;
 1543 
 1544         KASSERT(c != NULL && vc >= SND_VOL_C_BEGIN && vc <= SND_VOL_C_END,
 1545             ("%s(): invalid reset c=%p vc=%d", __func__, c, vc));
 1546         CHN_LOCKASSERT(c);
 1547 
 1548         if (force == 0 && chn_vpc_autoreset == 0)
 1549                 return;
 1550 
 1551         for (i = SND_CHN_T_BEGIN; i <= SND_CHN_T_END; i += SND_CHN_T_STEP)
 1552                 CHN_SETVOLUME(c, vc, i, c->volume[vc][SND_CHN_T_VOL_0DB]);
 1553 }
 1554 
 1555 static u_int32_t
 1556 round_pow2(u_int32_t v)
 1557 {
 1558         u_int32_t ret;
 1559 
 1560         if (v < 2)
 1561                 v = 2;
 1562         ret = 0;
 1563         while (v >> ret)
 1564                 ret++;
 1565         ret = 1 << (ret - 1);
 1566         while (ret < v)
 1567                 ret <<= 1;
 1568         return ret;
 1569 }
 1570 
 1571 static u_int32_t
 1572 round_blksz(u_int32_t v, int round)
 1573 {
 1574         u_int32_t ret, tmp;
 1575 
 1576         if (round < 1)
 1577                 round = 1;
 1578 
 1579         ret = min(round_pow2(v), CHN_2NDBUFMAXSIZE >> 1);
 1580 
 1581         if (ret > v && (ret >> 1) > 0 && (ret >> 1) >= ((v * 3) >> 2))
 1582                 ret >>= 1;
 1583 
 1584         tmp = ret - (ret % round);
 1585         while (tmp < 16 || tmp < round) {
 1586                 ret <<= 1;
 1587                 tmp = ret - (ret % round);
 1588         }
 1589 
 1590         return ret;
 1591 }
 1592 
 1593 /*
 1594  * 4Front call it DSP Policy, while we call it "Latency Profile". The idea
 1595  * is to keep 2nd buffer short so that it doesn't cause long queue during
 1596  * buffer transfer.
 1597  *
 1598  *    Latency reference table for 48khz stereo 16bit: (PLAY)
 1599  *
 1600  *      +---------+------------+-----------+------------+
 1601  *      | Latency | Blockcount | Blocksize | Buffersize |
 1602  *      +---------+------------+-----------+------------+
 1603  *      |     0   |       2    |   64      |    128     |
 1604  *      +---------+------------+-----------+------------+
 1605  *      |     1   |       4    |   128     |    512     |
 1606  *      +---------+------------+-----------+------------+
 1607  *      |     2   |       8    |   512     |    4096    |
 1608  *      +---------+------------+-----------+------------+
 1609  *      |     3   |      16    |   512     |    8192    |
 1610  *      +---------+------------+-----------+------------+
 1611  *      |     4   |      32    |   512     |    16384   |
 1612  *      +---------+------------+-----------+------------+
 1613  *      |     5   |      32    |   1024    |    32768   |
 1614  *      +---------+------------+-----------+------------+
 1615  *      |     6   |      16    |   2048    |    32768   |
 1616  *      +---------+------------+-----------+------------+
 1617  *      |     7   |       8    |   4096    |    32768   |
 1618  *      +---------+------------+-----------+------------+
 1619  *      |     8   |       4    |   8192    |    32768   |
 1620  *      +---------+------------+-----------+------------+
 1621  *      |     9   |       2    |   16384   |    32768   |
 1622  *      +---------+------------+-----------+------------+
 1623  *      |    10   |       2    |   32768   |    65536   |
 1624  *      +---------+------------+-----------+------------+
 1625  *
 1626  * Recording need a different reference table. All we care is
 1627  * gobbling up everything within reasonable buffering threshold.
 1628  *
 1629  *    Latency reference table for 48khz stereo 16bit: (REC)
 1630  *
 1631  *      +---------+------------+-----------+------------+
 1632  *      | Latency | Blockcount | Blocksize | Buffersize |
 1633  *      +---------+------------+-----------+------------+
 1634  *      |     0   |     512    |   32      |    16384   |
 1635  *      +---------+------------+-----------+------------+
 1636  *      |     1   |     256    |   64      |    16384   |
 1637  *      +---------+------------+-----------+------------+
 1638  *      |     2   |     128    |   128     |    16384   |
 1639  *      +---------+------------+-----------+------------+
 1640  *      |     3   |      64    |   256     |    16384   |
 1641  *      +---------+------------+-----------+------------+
 1642  *      |     4   |      32    |   512     |    16384   |
 1643  *      +---------+------------+-----------+------------+
 1644  *      |     5   |      32    |   1024    |    32768   |
 1645  *      +---------+------------+-----------+------------+
 1646  *      |     6   |      16    |   2048    |    32768   |
 1647  *      +---------+------------+-----------+------------+
 1648  *      |     7   |       8    |   4096    |    32768   |
 1649  *      +---------+------------+-----------+------------+
 1650  *      |     8   |       4    |   8192    |    32768   |
 1651  *      +---------+------------+-----------+------------+
 1652  *      |     9   |       2    |   16384   |    32768   |
 1653  *      +---------+------------+-----------+------------+
 1654  *      |    10   |       2    |   32768   |    65536   |
 1655  *      +---------+------------+-----------+------------+
 1656  *
 1657  * Calculations for other data rate are entirely based on these reference
 1658  * tables. For normal operation, Latency 5 seems give the best, well
 1659  * balanced performance for typical workload. Anything below 5 will
 1660  * eat up CPU to keep up with increasing context switches because of
 1661  * shorter buffer space and usually require the application to handle it
 1662  * aggresively through possibly real time programming technique.
 1663  *
 1664  */
 1665 #define CHN_LATENCY_PBLKCNT_REF                         \
 1666         {{1, 2, 3, 4, 5, 5, 4, 3, 2, 1, 1},             \
 1667         {1, 2, 3, 4, 5, 5, 4, 3, 2, 1, 1}}
 1668 #define CHN_LATENCY_PBUFSZ_REF                          \
 1669         {{7, 9, 12, 13, 14, 15, 15, 15, 15, 15, 16},    \
 1670         {11, 12, 13, 14, 15, 16, 16, 16, 16, 16, 17}}
 1671 
 1672 #define CHN_LATENCY_RBLKCNT_REF                         \
 1673         {{9, 8, 7, 6, 5, 5, 4, 3, 2, 1, 1},             \
 1674         {9, 8, 7, 6, 5, 5, 4, 3, 2, 1, 1}}
 1675 #define CHN_LATENCY_RBUFSZ_REF                          \
 1676         {{14, 14, 14, 14, 14, 15, 15, 15, 15, 15, 16},  \
 1677         {15, 15, 15, 15, 15, 16, 16, 16, 16, 16, 17}}
 1678 
 1679 #define CHN_LATENCY_DATA_REF    192000 /* 48khz stereo 16bit ~ 48000 x 2 x 2 */
 1680 
 1681 static int
 1682 chn_calclatency(int dir, int latency, int bps, u_int32_t datarate,
 1683                                 u_int32_t max, int *rblksz, int *rblkcnt)
 1684 {
 1685         static int pblkcnts[CHN_LATENCY_PROFILE_MAX + 1][CHN_LATENCY_MAX + 1] =
 1686             CHN_LATENCY_PBLKCNT_REF;
 1687         static int  pbufszs[CHN_LATENCY_PROFILE_MAX + 1][CHN_LATENCY_MAX + 1] =
 1688             CHN_LATENCY_PBUFSZ_REF;
 1689         static int rblkcnts[CHN_LATENCY_PROFILE_MAX + 1][CHN_LATENCY_MAX + 1] =
 1690             CHN_LATENCY_RBLKCNT_REF;
 1691         static int  rbufszs[CHN_LATENCY_PROFILE_MAX + 1][CHN_LATENCY_MAX + 1] =
 1692             CHN_LATENCY_RBUFSZ_REF;
 1693         u_int32_t bufsz;
 1694         int lprofile, blksz, blkcnt;
 1695 
 1696         if (latency < CHN_LATENCY_MIN || latency > CHN_LATENCY_MAX ||
 1697             bps < 1 || datarate < 1 ||
 1698             !(dir == PCMDIR_PLAY || dir == PCMDIR_REC)) {
 1699                 if (rblksz != NULL)
 1700                         *rblksz = CHN_2NDBUFMAXSIZE >> 1;
 1701                 if (rblkcnt != NULL)
 1702                         *rblkcnt = 2;
 1703                 printf("%s(): FAILED dir=%d latency=%d bps=%d "
 1704                     "datarate=%u max=%u\n",
 1705                     __func__, dir, latency, bps, datarate, max);
 1706                 return CHN_2NDBUFMAXSIZE;
 1707         }
 1708 
 1709         lprofile = chn_latency_profile;
 1710 
 1711         if (dir == PCMDIR_PLAY) {
 1712                 blkcnt = pblkcnts[lprofile][latency];
 1713                 bufsz = pbufszs[lprofile][latency];
 1714         } else {
 1715                 blkcnt = rblkcnts[lprofile][latency];
 1716                 bufsz = rbufszs[lprofile][latency];
 1717         }
 1718 
 1719         bufsz = round_pow2(snd_xbytes(1 << bufsz, CHN_LATENCY_DATA_REF,
 1720             datarate));
 1721         if (bufsz > max)
 1722                 bufsz = max;
 1723         blksz = round_blksz(bufsz >> blkcnt, bps);
 1724 
 1725         if (rblksz != NULL)
 1726                 *rblksz = blksz;
 1727         if (rblkcnt != NULL)
 1728                 *rblkcnt = 1 << blkcnt;
 1729 
 1730         return blksz << blkcnt;
 1731 }
 1732 
 1733 static int
 1734 chn_resizebuf(struct pcm_channel *c, int latency,
 1735                                         int blkcnt, int blksz)
 1736 {
 1737         struct snd_dbuf *b, *bs, *pb;
 1738         int sblksz, sblkcnt, hblksz, hblkcnt, limit = 0, nsblksz, nsblkcnt;
 1739         int ret;
 1740 
 1741         CHN_LOCKASSERT(c);
 1742 
 1743         if ((c->flags & (CHN_F_MMAP | CHN_F_TRIGGERED)) ||
 1744             !(c->direction == PCMDIR_PLAY || c->direction == PCMDIR_REC))
 1745                 return EINVAL;
 1746 
 1747         if (latency == -1) {
 1748                 c->latency = -1;
 1749                 latency = chn_latency;
 1750         } else if (latency == -2) {
 1751                 latency = c->latency;
 1752                 if (latency < CHN_LATENCY_MIN || latency > CHN_LATENCY_MAX)
 1753                         latency = chn_latency;
 1754         } else if (latency < CHN_LATENCY_MIN || latency > CHN_LATENCY_MAX)
 1755                 return EINVAL;
 1756         else {
 1757                 c->latency = latency;
 1758         }
 1759 
 1760         bs = c->bufsoft;
 1761         b = c->bufhard;
 1762 
 1763         if (!(blksz == 0 || blkcnt == -1) &&
 1764             (blksz < 16 || blksz < sndbuf_getalign(bs) || blkcnt < 2 ||
 1765             (blksz * blkcnt) > CHN_2NDBUFMAXSIZE))
 1766                 return EINVAL;
 1767 
 1768         chn_calclatency(c->direction, latency, sndbuf_getalign(bs),
 1769             sndbuf_getalign(bs) * sndbuf_getspd(bs), CHN_2NDBUFMAXSIZE,
 1770             &sblksz, &sblkcnt);
 1771 
 1772         if (blksz == 0 || blkcnt == -1) {
 1773                 if (blkcnt == -1)
 1774                         c->flags &= ~CHN_F_HAS_SIZE;
 1775                 if (c->flags & CHN_F_HAS_SIZE) {
 1776                         blksz = sndbuf_getblksz(bs);
 1777                         blkcnt = sndbuf_getblkcnt(bs);
 1778                 }
 1779         } else
 1780                 c->flags |= CHN_F_HAS_SIZE;
 1781 
 1782         if (c->flags & CHN_F_HAS_SIZE) {
 1783                 /*
 1784                  * The application has requested their own blksz/blkcnt.
 1785                  * Just obey with it, and let them toast alone. We can
 1786                  * clamp it to the nearest latency profile, but that would
 1787                  * defeat the purpose of having custom control. The least
 1788                  * we can do is round it to the nearest ^2 and align it.
 1789                  */
 1790                 sblksz = round_blksz(blksz, sndbuf_getalign(bs));
 1791                 sblkcnt = round_pow2(blkcnt);
 1792         }
 1793 
 1794         if (c->parentchannel != NULL) {
 1795                 pb = c->parentchannel->bufsoft;
 1796                 CHN_UNLOCK(c);
 1797                 CHN_LOCK(c->parentchannel);
 1798                 chn_notify(c->parentchannel, CHN_N_BLOCKSIZE);
 1799                 CHN_UNLOCK(c->parentchannel);
 1800                 CHN_LOCK(c);
 1801                 if (c->direction == PCMDIR_PLAY) {
 1802                         limit = (pb != NULL) ?
 1803                             sndbuf_xbytes(sndbuf_getsize(pb), pb, bs) : 0;
 1804                 } else {
 1805                         limit = (pb != NULL) ?
 1806                             sndbuf_xbytes(sndbuf_getblksz(pb), pb, bs) * 2 : 0;
 1807                 }
 1808         } else {
 1809                 hblkcnt = 2;
 1810                 if (c->flags & CHN_F_HAS_SIZE) {
 1811                         hblksz = round_blksz(sndbuf_xbytes(sblksz, bs, b),
 1812                             sndbuf_getalign(b));
 1813                         hblkcnt = round_pow2(sndbuf_getblkcnt(bs));
 1814                 } else
 1815                         chn_calclatency(c->direction, latency,
 1816                             sndbuf_getalign(b),
 1817                             sndbuf_getalign(b) * sndbuf_getspd(b),
 1818                             CHN_2NDBUFMAXSIZE, &hblksz, &hblkcnt);
 1819 
 1820                 if ((hblksz << 1) > sndbuf_getmaxsize(b))
 1821                         hblksz = round_blksz(sndbuf_getmaxsize(b) >> 1,
 1822                             sndbuf_getalign(b));
 1823 
 1824                 while ((hblksz * hblkcnt) > sndbuf_getmaxsize(b)) {
 1825                         if (hblkcnt < 4)
 1826                                 hblksz >>= 1;
 1827                         else
 1828                                 hblkcnt >>= 1;
 1829                 }
 1830 
 1831                 hblksz -= hblksz % sndbuf_getalign(b);
 1832 
 1833 #if 0
 1834                 hblksz = sndbuf_getmaxsize(b) >> 1;
 1835                 hblksz -= hblksz % sndbuf_getalign(b);
 1836                 hblkcnt = 2;
 1837 #endif
 1838 
 1839                 CHN_UNLOCK(c);
 1840                 if (chn_usefrags == 0 ||
 1841                     CHANNEL_SETFRAGMENTS(c->methods, c->devinfo,
 1842                     hblksz, hblkcnt) != 0)
 1843                         sndbuf_setblksz(b, CHANNEL_SETBLOCKSIZE(c->methods,
 1844                             c->devinfo, hblksz));
 1845                 CHN_LOCK(c);
 1846 
 1847                 if (!CHN_EMPTY(c, children)) {
 1848                         nsblksz = round_blksz(
 1849                             sndbuf_xbytes(sndbuf_getblksz(b), b, bs),
 1850                             sndbuf_getalign(bs));
 1851                         nsblkcnt = sndbuf_getblkcnt(b);
 1852                         if (c->direction == PCMDIR_PLAY) {
 1853                                 do {
 1854                                         nsblkcnt--;
 1855                                 } while (nsblkcnt >= 2 &&
 1856                                     nsblksz * nsblkcnt >= sblksz * sblkcnt);
 1857                                 nsblkcnt++;
 1858                         }
 1859                         sblksz = nsblksz;
 1860                         sblkcnt = nsblkcnt;
 1861                         limit = 0;
 1862                 } else
 1863                         limit = sndbuf_xbytes(sndbuf_getblksz(b), b, bs) * 2;
 1864         }
 1865 
 1866         if (limit > CHN_2NDBUFMAXSIZE)
 1867                 limit = CHN_2NDBUFMAXSIZE;
 1868 
 1869 #if 0
 1870         while (limit > 0 && (sblksz * sblkcnt) > limit) {
 1871                 if (sblkcnt < 4)
 1872                         break;
 1873                 sblkcnt >>= 1;
 1874         }
 1875 #endif
 1876 
 1877         while ((sblksz * sblkcnt) < limit)
 1878                 sblkcnt <<= 1;
 1879 
 1880         while ((sblksz * sblkcnt) > CHN_2NDBUFMAXSIZE) {
 1881                 if (sblkcnt < 4)
 1882                         sblksz >>= 1;
 1883                 else
 1884                         sblkcnt >>= 1;
 1885         }
 1886 
 1887         sblksz -= sblksz % sndbuf_getalign(bs);
 1888 
 1889         if (sndbuf_getblkcnt(bs) != sblkcnt || sndbuf_getblksz(bs) != sblksz ||
 1890             sndbuf_getsize(bs) != (sblkcnt * sblksz)) {
 1891                 ret = sndbuf_remalloc(bs, sblkcnt, sblksz);
 1892                 if (ret != 0) {
 1893                         device_printf(c->dev, "%s(): Failed: %d %d\n",
 1894                             __func__, sblkcnt, sblksz);
 1895                         return ret;
 1896                 }
 1897         }
 1898 
 1899         /*
 1900          * Interrupt timeout
 1901          */
 1902         c->timeout = ((u_int64_t)hz * sndbuf_getsize(bs)) /
 1903             ((u_int64_t)sndbuf_getspd(bs) * sndbuf_getalign(bs));
 1904         if (c->parentchannel != NULL)
 1905                 c->timeout = min(c->timeout, c->parentchannel->timeout);
 1906         if (c->timeout < 1)
 1907                 c->timeout = 1;
 1908 
 1909         /*
 1910          * OSSv4 docs: "By default OSS will set the low water level equal
 1911          * to the fragment size which is optimal in most cases."
 1912          */
 1913         c->lw = sndbuf_getblksz(bs);
 1914         chn_resetbuf(c);
 1915 
 1916         if (snd_verbose > 3)
 1917                 device_printf(c->dev, "%s(): %s (%s) timeout=%u "
 1918                     "b[%d/%d/%d] bs[%d/%d/%d] limit=%d\n",
 1919                     __func__, CHN_DIRSTR(c),
 1920                     (c->flags & CHN_F_VIRTUAL) ? "virtual" : "hardware",
 1921                     c->timeout,
 1922                     sndbuf_getsize(b), sndbuf_getblksz(b),
 1923                     sndbuf_getblkcnt(b),
 1924                     sndbuf_getsize(bs), sndbuf_getblksz(bs),
 1925                     sndbuf_getblkcnt(bs), limit);
 1926 
 1927         return 0;
 1928 }
 1929 
 1930 int
 1931 chn_setlatency(struct pcm_channel *c, int latency)
 1932 {
 1933         CHN_LOCKASSERT(c);
 1934         /* Destroy blksz/blkcnt, enforce latency profile. */
 1935         return chn_resizebuf(c, latency, -1, 0);
 1936 }
 1937 
 1938 int
 1939 chn_setblocksize(struct pcm_channel *c, int blkcnt, int blksz)
 1940 {
 1941         CHN_LOCKASSERT(c);
 1942         /* Destroy latency profile, enforce blksz/blkcnt */
 1943         return chn_resizebuf(c, -1, blkcnt, blksz);
 1944 }
 1945 
 1946 int
 1947 chn_setparam(struct pcm_channel *c, uint32_t format, uint32_t speed)
 1948 {
 1949         struct pcmchan_caps *caps;
 1950         uint32_t hwspeed, delta;
 1951         int ret;
 1952 
 1953         CHN_LOCKASSERT(c);
 1954 
 1955         if (speed < 1 || format == 0 || CHN_STARTED(c))
 1956                 return (EINVAL);
 1957 
 1958         c->format = format;
 1959         c->speed = speed;
 1960 
 1961         caps = chn_getcaps(c);
 1962 
 1963         hwspeed = speed;
 1964         RANGE(hwspeed, caps->minspeed, caps->maxspeed);
 1965 
 1966         sndbuf_setspd(c->bufhard, CHANNEL_SETSPEED(c->methods, c->devinfo,
 1967             hwspeed));
 1968         hwspeed = sndbuf_getspd(c->bufhard);
 1969 
 1970         delta = (hwspeed > speed) ? (hwspeed - speed) : (speed - hwspeed);
 1971 
 1972         if (delta <= feeder_rate_round)
 1973                 c->speed = hwspeed;
 1974 
 1975         ret = feeder_chain(c);
 1976 
 1977         if (ret == 0)
 1978                 ret = CHANNEL_SETFORMAT(c->methods, c->devinfo,
 1979                     sndbuf_getfmt(c->bufhard));
 1980 
 1981         if (ret == 0)
 1982                 ret = chn_resizebuf(c, -2, 0, 0);
 1983 
 1984         return (ret);
 1985 }
 1986 
 1987 int
 1988 chn_setspeed(struct pcm_channel *c, uint32_t speed)
 1989 {
 1990         uint32_t oldformat, oldspeed, format;
 1991         int ret;
 1992 
 1993 #if 0
 1994         /* XXX force 48k */
 1995         if (c->format & AFMT_PASSTHROUGH)
 1996                 speed = AFMT_PASSTHROUGH_RATE;
 1997 #endif
 1998 
 1999         oldformat = c->format;
 2000         oldspeed = c->speed;
 2001         format = oldformat;
 2002 
 2003         ret = chn_setparam(c, format, speed);
 2004         if (ret != 0) {
 2005                 if (snd_verbose > 3)
 2006                         device_printf(c->dev,
 2007                             "%s(): Setting speed %d failed, "
 2008                             "falling back to %d\n",
 2009                             __func__, speed, oldspeed);
 2010                 chn_setparam(c, c->format, oldspeed);
 2011         }
 2012 
 2013         return (ret);
 2014 }
 2015 
 2016 int
 2017 chn_setformat(struct pcm_channel *c, uint32_t format)
 2018 {
 2019         uint32_t oldformat, oldspeed, speed;
 2020         int ret;
 2021 
 2022         /* XXX force stereo */
 2023         if ((format & AFMT_PASSTHROUGH) && AFMT_CHANNEL(format) < 2) {
 2024                 format = SND_FORMAT(format, AFMT_PASSTHROUGH_CHANNEL,
 2025                     AFMT_PASSTHROUGH_EXTCHANNEL);
 2026         }
 2027 
 2028         oldformat = c->format;
 2029         oldspeed = c->speed;
 2030         speed = oldspeed;
 2031 
 2032         ret = chn_setparam(c, format, speed);
 2033         if (ret != 0) {
 2034                 if (snd_verbose > 3)
 2035                         device_printf(c->dev,
 2036                             "%s(): Format change 0x%08x failed, "
 2037                             "falling back to 0x%08x\n",
 2038                             __func__, format, oldformat);
 2039                 chn_setparam(c, oldformat, oldspeed);
 2040         }
 2041 
 2042         return (ret);
 2043 }
 2044 
 2045 void
 2046 chn_syncstate(struct pcm_channel *c)
 2047 {
 2048         struct snddev_info *d;
 2049         struct snd_mixer *m;
 2050 
 2051         d = (c != NULL) ? c->parentsnddev : NULL;
 2052         m = (d != NULL && d->mixer_dev != NULL) ? d->mixer_dev->si_drv1 :
 2053             NULL;
 2054 
 2055         if (d == NULL || m == NULL)
 2056                 return;
 2057 
 2058         CHN_LOCKASSERT(c);
 2059 
 2060         if (c->feederflags & (1 << FEEDER_VOLUME)) {
 2061                 uint32_t parent;
 2062                 int vol, pvol, left, right, center;
 2063 
 2064                 if (c->direction == PCMDIR_PLAY &&
 2065                     (d->flags & SD_F_SOFTPCMVOL)) {
 2066                         /* CHN_UNLOCK(c); */
 2067                         vol = mix_get(m, SOUND_MIXER_PCM);
 2068                         parent = mix_getparent(m, SOUND_MIXER_PCM);
 2069                         if (parent != SOUND_MIXER_NONE)
 2070                                 pvol = mix_get(m, parent);
 2071                         else
 2072                                 pvol = 100 | (100 << 8);
 2073                         /* CHN_LOCK(c); */
 2074                 } else {
 2075                         vol = 100 | (100 << 8);
 2076                         pvol = vol;
 2077                 }
 2078 
 2079                 if (vol == -1) {
 2080                         device_printf(c->dev,
 2081                             "Soft PCM Volume: Failed to read pcm "
 2082                             "default value\n");
 2083                         vol = 100 | (100 << 8);
 2084                 }
 2085 
 2086                 if (pvol == -1) {
 2087                         device_printf(c->dev,
 2088                             "Soft PCM Volume: Failed to read parent "
 2089                             "default value\n");
 2090                         pvol = 100 | (100 << 8);
 2091                 }
 2092 
 2093                 left = ((vol & 0x7f) * (pvol & 0x7f)) / 100;
 2094                 right = (((vol >> 8) & 0x7f) * ((pvol >> 8) & 0x7f)) / 100;
 2095                 center = (left + right) >> 1;
 2096 
 2097                 chn_setvolume_multi(c, SND_VOL_C_MASTER, left, right, center);
 2098         }
 2099 
 2100         if (c->feederflags & (1 << FEEDER_EQ)) {
 2101                 struct pcm_feeder *f;
 2102                 int treble, bass, state;
 2103 
 2104                 /* CHN_UNLOCK(c); */
 2105                 treble = mix_get(m, SOUND_MIXER_TREBLE);
 2106                 bass = mix_get(m, SOUND_MIXER_BASS);
 2107                 /* CHN_LOCK(c); */
 2108 
 2109                 if (treble == -1)
 2110                         treble = 50;
 2111                 else
 2112                         treble = ((treble & 0x7f) +
 2113                             ((treble >> 8) & 0x7f)) >> 1;
 2114 
 2115                 if (bass == -1)
 2116                         bass = 50;
 2117                 else
 2118                         bass = ((bass & 0x7f) + ((bass >> 8) & 0x7f)) >> 1;
 2119 
 2120                 f = chn_findfeeder(c, FEEDER_EQ);
 2121                 if (f != NULL) {
 2122                         if (FEEDER_SET(f, FEEDEQ_TREBLE, treble) != 0)
 2123                                 device_printf(c->dev,
 2124                                     "EQ: Failed to set treble -- %d\n",
 2125                                     treble);
 2126                         if (FEEDER_SET(f, FEEDEQ_BASS, bass) != 0)
 2127                                 device_printf(c->dev,
 2128                                     "EQ: Failed to set bass -- %d\n",
 2129                                     bass);
 2130                         if (FEEDER_SET(f, FEEDEQ_PREAMP, d->eqpreamp) != 0)
 2131                                 device_printf(c->dev,
 2132                                     "EQ: Failed to set preamp -- %d\n",
 2133                                     d->eqpreamp);
 2134                         if (d->flags & SD_F_EQ_BYPASSED)
 2135                                 state = FEEDEQ_BYPASS;
 2136                         else if (d->flags & SD_F_EQ_ENABLED)
 2137                                 state = FEEDEQ_ENABLE;
 2138                         else
 2139                                 state = FEEDEQ_DISABLE;
 2140                         if (FEEDER_SET(f, FEEDEQ_STATE, state) != 0)
 2141                                 device_printf(c->dev,
 2142                                     "EQ: Failed to set state -- %d\n", state);
 2143                 }
 2144         }
 2145 }
 2146 
 2147 int
 2148 chn_trigger(struct pcm_channel *c, int go)
 2149 {
 2150 #ifdef DEV_ISA
 2151         struct snd_dbuf *b = c->bufhard;
 2152 #endif
 2153         struct snddev_info *d = c->parentsnddev;
 2154         int ret;
 2155 
 2156         CHN_LOCKASSERT(c);
 2157 #ifdef DEV_ISA
 2158         if (SND_DMA(b) && (go == PCMTRIG_EMLDMAWR || go == PCMTRIG_EMLDMARD))
 2159                 sndbuf_dmabounce(b);
 2160 #endif
 2161         if (!PCMTRIG_COMMON(go))
 2162                 return (CHANNEL_TRIGGER(c->methods, c->devinfo, go));
 2163 
 2164         if (go == c->trigger)
 2165                 return (0);
 2166 
 2167         ret = CHANNEL_TRIGGER(c->methods, c->devinfo, go);
 2168         if (ret != 0)
 2169                 return (ret);
 2170 
 2171         switch (go) {
 2172         case PCMTRIG_START:
 2173                 if (snd_verbose > 3)
 2174                         device_printf(c->dev,
 2175                             "%s() %s: calling go=0x%08x , "
 2176                             "prev=0x%08x\n", __func__, c->name, go,
 2177                             c->trigger);
 2178                 if (c->trigger != PCMTRIG_START) {
 2179                         c->trigger = go;
 2180                         CHN_UNLOCK(c);
 2181                         PCM_LOCK(d);
 2182                         CHN_INSERT_HEAD(d, c, channels.pcm.busy);
 2183                         PCM_UNLOCK(d);
 2184                         CHN_LOCK(c);
 2185                         chn_syncstate(c);
 2186                 }
 2187                 break;
 2188         case PCMTRIG_STOP:
 2189         case PCMTRIG_ABORT:
 2190                 if (snd_verbose > 3)
 2191                         device_printf(c->dev,
 2192                             "%s() %s: calling go=0x%08x , "
 2193                             "prev=0x%08x\n", __func__, c->name, go,
 2194                             c->trigger);
 2195                 if (c->trigger == PCMTRIG_START) {
 2196                         c->trigger = go;
 2197                         CHN_UNLOCK(c);
 2198                         PCM_LOCK(d);
 2199                         CHN_REMOVE(d, c, channels.pcm.busy);
 2200                         PCM_UNLOCK(d);
 2201                         CHN_LOCK(c);
 2202                 }
 2203                 break;
 2204         default:
 2205                 break;
 2206         }
 2207 
 2208         return (0);
 2209 }
 2210 
 2211 /**
 2212  * @brief Queries sound driver for sample-aligned hardware buffer pointer index
 2213  *
 2214  * This function obtains the hardware pointer location, then aligns it to
 2215  * the current bytes-per-sample value before returning.  (E.g., a channel
 2216  * running in 16 bit stereo mode would require 4 bytes per sample, so a
 2217  * hwptr value ranging from 32-35 would be returned as 32.)
 2218  *
 2219  * @param c     PCM channel context     
 2220  * @returns     sample-aligned hardware buffer pointer index
 2221  */
 2222 int
 2223 chn_getptr(struct pcm_channel *c)
 2224 {
 2225         int hwptr;
 2226 
 2227         CHN_LOCKASSERT(c);
 2228         hwptr = (CHN_STARTED(c)) ? CHANNEL_GETPTR(c->methods, c->devinfo) : 0;
 2229         return (hwptr - (hwptr % sndbuf_getalign(c->bufhard)));
 2230 }
 2231 
 2232 struct pcmchan_caps *
 2233 chn_getcaps(struct pcm_channel *c)
 2234 {
 2235         CHN_LOCKASSERT(c);
 2236         return CHANNEL_GETCAPS(c->methods, c->devinfo);
 2237 }
 2238 
 2239 u_int32_t
 2240 chn_getformats(struct pcm_channel *c)
 2241 {
 2242         u_int32_t *fmtlist, fmts;
 2243         int i;
 2244 
 2245         fmtlist = chn_getcaps(c)->fmtlist;
 2246         fmts = 0;
 2247         for (i = 0; fmtlist[i]; i++)
 2248                 fmts |= fmtlist[i];
 2249 
 2250         /* report software-supported formats */
 2251         if (!CHN_BITPERFECT(c) && report_soft_formats)
 2252                 fmts |= AFMT_CONVERTIBLE;
 2253 
 2254         return (AFMT_ENCODING(fmts));
 2255 }
 2256 
 2257 int
 2258 chn_notify(struct pcm_channel *c, u_int32_t flags)
 2259 {
 2260         struct pcm_channel *ch;
 2261         struct pcmchan_caps *caps;
 2262         uint32_t bestformat, bestspeed, besthwformat, *vchanformat, *vchanrate;
 2263         uint32_t vpflags;
 2264         int dirty, err, run, nrun;
 2265 
 2266         CHN_LOCKASSERT(c);
 2267 
 2268         if (CHN_EMPTY(c, children))
 2269                 return (ENODEV);
 2270 
 2271         err = 0;
 2272 
 2273         /*
 2274          * If the hwchan is running, we can't change its rate, format or
 2275          * blocksize
 2276          */
 2277         run = (CHN_STARTED(c)) ? 1 : 0;
 2278         if (run)
 2279                 flags &= CHN_N_VOLUME | CHN_N_TRIGGER;
 2280 
 2281         if (flags & CHN_N_RATE) {
 2282                 /*
 2283                  * XXX I'll make good use of this someday.
 2284                  *     However this is currently being superseded by
 2285                  *     the availability of CHN_F_VCHAN_DYNAMIC.
 2286                  */
 2287         }
 2288 
 2289         if (flags & CHN_N_FORMAT) {
 2290                 /*
 2291                  * XXX I'll make good use of this someday.
 2292                  *     However this is currently being superseded by
 2293                  *     the availability of CHN_F_VCHAN_DYNAMIC.
 2294                  */
 2295         }
 2296 
 2297         if (flags & CHN_N_VOLUME) {
 2298                 /*
 2299                  * XXX I'll make good use of this someday, though
 2300                  *     soft volume control is currently pretty much
 2301                  *     integrated.
 2302                  */
 2303         }
 2304 
 2305         if (flags & CHN_N_BLOCKSIZE) {
 2306                 /*
 2307                  * Set to default latency profile
 2308                  */
 2309                 chn_setlatency(c, chn_latency);
 2310         }
 2311 
 2312         if ((flags & CHN_N_TRIGGER) && !(c->flags & CHN_F_VCHAN_DYNAMIC)) {
 2313                 nrun = CHN_EMPTY(c, children.busy) ? 0 : 1;
 2314                 if (nrun && !run)
 2315                         err = chn_start(c, 1);
 2316                 if (!nrun && run)
 2317                         chn_abort(c);
 2318                 flags &= ~CHN_N_TRIGGER;
 2319         }
 2320 
 2321         if (flags & CHN_N_TRIGGER) {
 2322                 if (c->direction == PCMDIR_PLAY) {
 2323                         vchanformat = &c->parentsnddev->pvchanformat;
 2324                         vchanrate = &c->parentsnddev->pvchanrate;
 2325                 } else {
 2326                         vchanformat = &c->parentsnddev->rvchanformat;
 2327                         vchanrate = &c->parentsnddev->rvchanrate;
 2328                 }
 2329 
 2330                 /* Dynamic Virtual Channel */
 2331                 if (!(c->flags & CHN_F_VCHAN_ADAPTIVE)) {
 2332                         bestformat = *vchanformat;
 2333                         bestspeed = *vchanrate;
 2334                 } else {
 2335                         bestformat = 0;
 2336                         bestspeed = 0;
 2337                 }
 2338 
 2339                 besthwformat = 0;
 2340                 nrun = 0;
 2341                 caps = chn_getcaps(c);
 2342                 dirty = 0;
 2343                 vpflags = 0;
 2344 
 2345                 CHN_FOREACH(ch, c, children.busy) {
 2346                         CHN_LOCK(ch);
 2347                         if ((ch->format & AFMT_PASSTHROUGH) &&
 2348                             snd_fmtvalid(ch->format, caps->fmtlist)) {
 2349                                 bestformat = ch->format;
 2350                                 bestspeed = ch->speed;
 2351                                 CHN_UNLOCK(ch);
 2352                                 vpflags = CHN_F_PASSTHROUGH;
 2353                                 nrun++;
 2354                                 break;
 2355                         }
 2356                         if ((ch->flags & CHN_F_EXCLUSIVE) && vpflags == 0) {
 2357                                 if (c->flags & CHN_F_VCHAN_ADAPTIVE) {
 2358                                         bestspeed = ch->speed;
 2359                                         RANGE(bestspeed, caps->minspeed,
 2360                                             caps->maxspeed);
 2361                                         besthwformat = snd_fmtbest(ch->format,
 2362                                             caps->fmtlist);
 2363                                         if (besthwformat != 0)
 2364                                                 bestformat = besthwformat;
 2365                                 }
 2366                                 CHN_UNLOCK(ch);
 2367                                 vpflags = CHN_F_EXCLUSIVE;
 2368                                 nrun++;
 2369                                 continue;
 2370                         }
 2371                         if (!(c->flags & CHN_F_VCHAN_ADAPTIVE) ||
 2372                             vpflags != 0) {
 2373                                 CHN_UNLOCK(ch);
 2374                                 nrun++;
 2375                                 continue;
 2376                         }
 2377                         if (ch->speed > bestspeed) {
 2378                                 bestspeed = ch->speed;
 2379                                 RANGE(bestspeed, caps->minspeed,
 2380                                     caps->maxspeed);
 2381                         }
 2382                         besthwformat = snd_fmtbest(ch->format, caps->fmtlist);
 2383                         if (!(besthwformat & AFMT_VCHAN)) {
 2384                                 CHN_UNLOCK(ch);
 2385                                 nrun++;
 2386                                 continue;
 2387                         }
 2388                         if (AFMT_CHANNEL(besthwformat) >
 2389                             AFMT_CHANNEL(bestformat))
 2390                                 bestformat = besthwformat;
 2391                         else if (AFMT_CHANNEL(besthwformat) ==
 2392                             AFMT_CHANNEL(bestformat) &&
 2393                             AFMT_BIT(besthwformat) > AFMT_BIT(bestformat))
 2394                                 bestformat = besthwformat;
 2395                         CHN_UNLOCK(ch);
 2396                         nrun++;
 2397                 }
 2398 
 2399                 if (bestformat == 0)
 2400                         bestformat = c->format;
 2401                 if (bestspeed == 0)
 2402                         bestspeed = c->speed;
 2403 
 2404                 if (bestformat != c->format || bestspeed != c->speed)
 2405                         dirty = 1;
 2406 
 2407                 c->flags &= ~(CHN_F_PASSTHROUGH | CHN_F_EXCLUSIVE);
 2408                 c->flags |= vpflags;
 2409 
 2410                 if (nrun && !run) {
 2411                         if (dirty) {
 2412                                 bestspeed = CHANNEL_SETSPEED(c->methods,
 2413                                     c->devinfo, bestspeed);
 2414                                 err = chn_reset(c, bestformat, bestspeed);
 2415                         }
 2416                         if (err == 0 && dirty) {
 2417                                 CHN_FOREACH(ch, c, children.busy) {
 2418                                         CHN_LOCK(ch);
 2419                                         if (VCHAN_SYNC_REQUIRED(ch))
 2420                                                 vchan_sync(ch);
 2421                                         CHN_UNLOCK(ch);
 2422                                 }
 2423                         }
 2424                         if (err == 0) {
 2425                                 if (dirty)
 2426                                         c->flags |= CHN_F_DIRTY;
 2427                                 err = chn_start(c, 1);
 2428                         }
 2429                 }
 2430 
 2431                 if (nrun && run && dirty) {
 2432                         chn_abort(c);
 2433                         bestspeed = CHANNEL_SETSPEED(c->methods, c->devinfo,
 2434                             bestspeed);
 2435                         err = chn_reset(c, bestformat, bestspeed);
 2436                         if (err == 0) {
 2437                                 CHN_FOREACH(ch, c, children.busy) {
 2438                                         CHN_LOCK(ch);
 2439                                         if (VCHAN_SYNC_REQUIRED(ch))
 2440                                                 vchan_sync(ch);
 2441                                         CHN_UNLOCK(ch);
 2442                                 }
 2443                         }
 2444                         if (err == 0) {
 2445                                 c->flags |= CHN_F_DIRTY;
 2446                                 err = chn_start(c, 1);
 2447                         }
 2448                 }
 2449 
 2450                 if (err == 0 && !(bestformat & AFMT_PASSTHROUGH) &&
 2451                     (bestformat & AFMT_VCHAN)) {
 2452                         *vchanformat = bestformat;
 2453                         *vchanrate = bestspeed;
 2454                 }
 2455 
 2456                 if (!nrun && run) {
 2457                         c->flags &= ~(CHN_F_PASSTHROUGH | CHN_F_EXCLUSIVE);
 2458                         bestformat = *vchanformat;
 2459                         bestspeed = *vchanrate;
 2460                         chn_abort(c);
 2461                         if (c->format != bestformat || c->speed != bestspeed)
 2462                                 chn_reset(c, bestformat, bestspeed);
 2463                 }
 2464         }
 2465 
 2466         return (err);
 2467 }
 2468 
 2469 /**
 2470  * @brief Fetch array of supported discrete sample rates
 2471  *
 2472  * Wrapper for CHANNEL_GETRATES.  Please see channel_if.m:getrates() for
 2473  * detailed information.
 2474  *
 2475  * @note If the operation isn't supported, this function will just return 0
 2476  *       (no rates in the array), and *rates will be set to NULL.  Callers
 2477  *       should examine rates @b only if this function returns non-zero.
 2478  *
 2479  * @param c     pcm channel to examine
 2480  * @param rates pointer to array of integers; rate table will be recorded here
 2481  *
 2482  * @return number of rates in the array pointed to be @c rates
 2483  */
 2484 int
 2485 chn_getrates(struct pcm_channel *c, int **rates)
 2486 {
 2487         KASSERT(rates != NULL, ("rates is null"));
 2488         CHN_LOCKASSERT(c);
 2489         return CHANNEL_GETRATES(c->methods, c->devinfo, rates);
 2490 }
 2491 
 2492 /**
 2493  * @brief Remove channel from a sync group, if there is one.
 2494  *
 2495  * This function is initially intended for the following conditions:
 2496  *   - Starting a syncgroup (@c SNDCTL_DSP_SYNCSTART ioctl)
 2497  *   - Closing a device.  (A channel can't be destroyed if it's still in use.)
 2498  *
 2499  * @note Before calling this function, the syncgroup list mutex must be
 2500  * held.  (Consider pcm_channel::sm protected by the SG list mutex
 2501  * whether @c c is locked or not.)
 2502  *
 2503  * @param c     channel device to be started or closed
 2504  * @returns     If this channel was the only member of a group, the group ID
 2505  *              is returned to the caller so that the caller can release it
 2506  *              via free_unr() after giving up the syncgroup lock.  Else it
 2507  *              returns 0.
 2508  */
 2509 int
 2510 chn_syncdestroy(struct pcm_channel *c)
 2511 {
 2512         struct pcmchan_syncmember *sm;
 2513         struct pcmchan_syncgroup *sg;
 2514         int sg_id;
 2515 
 2516         sg_id = 0;
 2517 
 2518         PCM_SG_LOCKASSERT(MA_OWNED);
 2519 
 2520         if (c->sm != NULL) {
 2521                 sm = c->sm;
 2522                 sg = sm->parent;
 2523                 c->sm = NULL;
 2524 
 2525                 KASSERT(sg != NULL, ("syncmember has null parent"));
 2526 
 2527                 SLIST_REMOVE(&sg->members, sm, pcmchan_syncmember, link);
 2528                 free(sm, M_DEVBUF);
 2529 
 2530                 if (SLIST_EMPTY(&sg->members)) {
 2531                         SLIST_REMOVE(&snd_pcm_syncgroups, sg, pcmchan_syncgroup, link);
 2532                         sg_id = sg->id;
 2533                         free(sg, M_DEVBUF);
 2534                 }
 2535         }
 2536 
 2537         return sg_id;
 2538 }
 2539 
 2540 #ifdef OSSV4_EXPERIMENT
 2541 int
 2542 chn_getpeaks(struct pcm_channel *c, int *lpeak, int *rpeak)
 2543 {
 2544         CHN_LOCKASSERT(c);
 2545         return CHANNEL_GETPEAKS(c->methods, c->devinfo, lpeak, rpeak);
 2546 }
 2547 #endif

Cache object: db898468de864480e006fc5e1e1f97df


[ 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.