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/feeder_chain.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) 2008-2009 Ariff Abdullah <ariff@FreeBSD.org>
    3  * All rights reserved.
    4  *
    5  * Redistribution and use in source and binary forms, with or without
    6  * modification, are permitted provided that the following conditions
    7  * are met:
    8  * 1. Redistributions of source code must retain the above copyright
    9  *    notice, this list of conditions and the following disclaimer.
   10  * 2. Redistributions in binary form must reproduce the above copyright
   11  *    notice, this list of conditions and the following disclaimer in the
   12  *    documentation and/or other materials provided with the distribution.
   13  *
   14  * THIS SOFTWARE IS PROVIDED BY THE AUTHOR AND CONTRIBUTORS ``AS IS'' AND
   15  * ANY EXPRESS OR IMPLIED WARRANTIES, INCLUDING, BUT NOT LIMITED TO, THE
   16  * IMPLIED WARRANTIES OF MERCHANTABILITY AND FITNESS FOR A PARTICULAR PURPOSE
   17  * ARE DISCLAIMED.  IN NO EVENT SHALL THE AUTHOR OR CONTRIBUTORS BE LIABLE
   18  * FOR ANY DIRECT, INDIRECT, INCIDENTAL, SPECIAL, EXEMPLARY, OR CONSEQUENTIAL
   19  * DAMAGES (INCLUDING, BUT NOT LIMITED TO, PROCUREMENT OF SUBSTITUTE GOODS
   20  * OR SERVICES; LOSS OF USE, DATA, OR PROFITS; OR BUSINESS INTERRUPTION)
   21  * HOWEVER CAUSED AND ON ANY THEORY OF LIABILITY, WHETHER IN CONTRACT, STRICT
   22  * LIABILITY, OR TORT (INCLUDING NEGLIGENCE OR OTHERWISE) ARISING IN ANY WAY
   23  * OUT OF THE USE OF THIS SOFTWARE, EVEN IF ADVISED OF THE POSSIBILITY OF
   24  * SUCH DAMAGE.
   25  */
   26 
   27 #ifdef HAVE_KERNEL_OPTION_HEADERS
   28 #include "opt_snd.h"
   29 #endif
   30 
   31 #include <dev/sound/pcm/sound.h>
   32 
   33 #include "feeder_if.h"
   34 
   35 SND_DECLARE_FILE("$FreeBSD: releng/11.2/sys/dev/sound/pcm/feeder_chain.c 331722 2018-03-29 02:50:57Z eadler $");
   36 
   37 /* chain state */
   38 struct feeder_chain_state {
   39         uint32_t afmt;                          /* audio format */
   40         uint32_t rate;                          /* sampling rate */
   41         struct pcmchan_matrix *matrix;          /* matrix map */
   42 };
   43 
   44 /*
   45  * chain descriptor that will be passed around from the beginning until the
   46  * end of chain process.
   47  */
   48 struct feeder_chain_desc {
   49         struct feeder_chain_state origin;       /* original state */
   50         struct feeder_chain_state current;      /* current state */
   51         struct feeder_chain_state target;       /* target state */
   52         struct pcm_feederdesc desc;             /* feeder descriptor */
   53         uint32_t afmt_ne;                       /* prefered native endian */
   54         int mode;                               /* chain mode */
   55         int use_eq;                             /* need EQ? */
   56         int use_matrix;                         /* need channel matrixing? */
   57         int use_volume;                         /* need softpcmvol? */
   58         int dummy;                              /* dummy passthrough */
   59         int expensive;                          /* possibly expensive */
   60 };
   61 
   62 #define FEEDER_CHAIN_LEAN               0
   63 #define FEEDER_CHAIN_16                 1
   64 #define FEEDER_CHAIN_32                 2
   65 #define FEEDER_CHAIN_MULTI              3
   66 #define FEEDER_CHAIN_FULLMULTI          4
   67 #define FEEDER_CHAIN_LAST               5
   68 
   69 #if defined(SND_FEEDER_FULL_MULTIFORMAT)
   70 #define FEEDER_CHAIN_DEFAULT            FEEDER_CHAIN_FULLMULTI
   71 #elif defined(SND_FEEDER_MULTIFORMAT)
   72 #define FEEDER_CHAIN_DEFAULT            FEEDER_CHAIN_MULTI
   73 #else
   74 #define FEEDER_CHAIN_DEFAULT            FEEDER_CHAIN_LEAN
   75 #endif
   76 
   77 /*
   78  * List of prefered formats that might be required during
   79  * processing. It will be decided through snd_fmtbest().
   80  */
   81 
   82 /* 'Lean' mode, signed 16 or 32 bit native endian. */
   83 static uint32_t feeder_chain_formats_lean[] = {
   84         AFMT_S16_NE, AFMT_S32_NE,
   85         0
   86 };
   87 
   88 /* Force everything to signed 16 bit native endian. */
   89 static uint32_t feeder_chain_formats_16[] = {
   90         AFMT_S16_NE,
   91         0
   92 };
   93 
   94 /* Force everything to signed 32 bit native endian. */
   95 static uint32_t feeder_chain_formats_32[] = {
   96         AFMT_S32_NE,
   97         0
   98 };
   99 
  100 /* Multiple choices, all except 8 bit. */
  101 static uint32_t feeder_chain_formats_multi[] = {
  102         AFMT_S16_LE, AFMT_S16_BE, AFMT_U16_LE, AFMT_U16_BE,
  103         AFMT_S24_LE, AFMT_S24_BE, AFMT_U24_LE, AFMT_U24_BE,
  104         AFMT_S32_LE, AFMT_S32_BE, AFMT_U32_LE, AFMT_U32_BE,
  105         0
  106 };
  107 
  108 /* Everything that is convertible. */
  109 static uint32_t feeder_chain_formats_fullmulti[] = {
  110         AFMT_S8, AFMT_U8,
  111         AFMT_S16_LE, AFMT_S16_BE, AFMT_U16_LE, AFMT_U16_BE,
  112         AFMT_S24_LE, AFMT_S24_BE, AFMT_U24_LE, AFMT_U24_BE,
  113         AFMT_S32_LE, AFMT_S32_BE, AFMT_U32_LE, AFMT_U32_BE,
  114         0
  115 };
  116 
  117 static uint32_t *feeder_chain_formats[FEEDER_CHAIN_LAST] = {
  118         [FEEDER_CHAIN_LEAN]      = feeder_chain_formats_lean,
  119         [FEEDER_CHAIN_16]        = feeder_chain_formats_16,
  120         [FEEDER_CHAIN_32]        = feeder_chain_formats_32,
  121         [FEEDER_CHAIN_MULTI]     = feeder_chain_formats_multi,
  122         [FEEDER_CHAIN_FULLMULTI] = feeder_chain_formats_fullmulti
  123 };
  124 
  125 static int feeder_chain_mode = FEEDER_CHAIN_DEFAULT;
  126 
  127 #if defined(_KERNEL) && defined(SND_DEBUG) && defined(SND_FEEDER_FULL_MULTIFORMAT)
  128 SYSCTL_INT(_hw_snd, OID_AUTO, feeder_chain_mode, CTLFLAG_RWTUN,
  129     &feeder_chain_mode, 0,
  130     "feeder chain mode "
  131     "(0=lean, 1=16bit, 2=32bit, 3=multiformat, 4=fullmultiformat)");
  132 #endif
  133 
  134 /*
  135  * feeder_build_format(): Chain any format converter.
  136  */
  137 static int
  138 feeder_build_format(struct pcm_channel *c, struct feeder_chain_desc *cdesc)
  139 {
  140         struct feeder_class *fc;
  141         struct pcm_feederdesc *desc;
  142         int ret;
  143 
  144         desc = &(cdesc->desc);
  145         desc->type = FEEDER_FORMAT;
  146         desc->in = 0;
  147         desc->out = 0;
  148         desc->flags = 0;
  149 
  150         fc = feeder_getclass(desc);
  151         if (fc == NULL) {
  152                 device_printf(c->dev,
  153                     "%s(): can't find feeder_format\n", __func__);
  154                 return (ENOTSUP);
  155         }
  156 
  157         desc->in = cdesc->current.afmt;
  158         desc->out = cdesc->target.afmt;
  159 
  160         ret = chn_addfeeder(c, fc, desc);
  161         if (ret != 0) {
  162                 device_printf(c->dev,
  163                     "%s(): can't add feeder_format\n", __func__);
  164                 return (ret);
  165         }
  166 
  167         c->feederflags |= 1 << FEEDER_FORMAT;
  168 
  169         cdesc->current.afmt = cdesc->target.afmt;
  170 
  171         return (0);
  172 }
  173 
  174 /*
  175  * feeder_build_formatne(): Chain format converter that suite best for native
  176  *                          endian format.
  177  */
  178 static int
  179 feeder_build_formatne(struct pcm_channel *c, struct feeder_chain_desc *cdesc)
  180 {
  181         struct feeder_chain_state otarget;
  182         int ret;
  183 
  184         if (cdesc->afmt_ne == 0 ||
  185             AFMT_ENCODING(cdesc->current.afmt) == cdesc->afmt_ne)
  186                 return (0);
  187 
  188         otarget = cdesc->target;
  189         cdesc->target = cdesc->current;
  190         cdesc->target.afmt = SND_FORMAT(cdesc->afmt_ne,
  191             cdesc->current.matrix->channels, cdesc->current.matrix->ext);
  192 
  193         ret = feeder_build_format(c, cdesc);
  194         if (ret != 0)
  195                 return (ret);
  196 
  197         cdesc->target = otarget;
  198 
  199         return (0);
  200 }
  201 
  202 /*
  203  * feeder_build_rate(): Chain sample rate converter.
  204  */
  205 static int
  206 feeder_build_rate(struct pcm_channel *c, struct feeder_chain_desc *cdesc)
  207 {
  208         struct feeder_class *fc;
  209         struct pcm_feeder *f;
  210         struct pcm_feederdesc *desc;
  211         int ret;
  212 
  213         ret = feeder_build_formatne(c, cdesc);
  214         if (ret != 0)
  215                 return (ret);
  216 
  217         desc = &(cdesc->desc);
  218         desc->type = FEEDER_RATE;
  219         desc->in = 0;
  220         desc->out = 0;
  221         desc->flags = 0;
  222 
  223         fc = feeder_getclass(desc);
  224         if (fc == NULL) {
  225                 device_printf(c->dev,
  226                     "%s(): can't find feeder_rate\n", __func__);
  227                 return (ENOTSUP);
  228         }
  229 
  230         desc->in = cdesc->current.afmt;
  231         desc->out = desc->in;
  232 
  233         ret = chn_addfeeder(c, fc, desc);
  234         if (ret != 0) {
  235                 device_printf(c->dev,
  236                     "%s(): can't add feeder_rate\n", __func__);
  237                 return (ret);
  238         }
  239 
  240         f = c->feeder;
  241 
  242         /*
  243          * If in 'dummy' mode (possibly due to passthrough mode), set the
  244          * conversion quality to the lowest possible (should be fastest) since
  245          * listener won't be hearing anything. Theoretically we can just
  246          * disable it, but that will cause weird runtime behaviour:
  247          * application appear to play something that is either too fast or too
  248          * slow.
  249          */
  250         if (cdesc->dummy != 0) {
  251                 ret = FEEDER_SET(f, FEEDRATE_QUALITY, 0);
  252                 if (ret != 0) {
  253                         device_printf(c->dev,
  254                             "%s(): can't set resampling quality\n", __func__);
  255                         return (ret);
  256                 }
  257         }
  258 
  259         ret = FEEDER_SET(f, FEEDRATE_SRC, cdesc->current.rate);
  260         if (ret != 0) {
  261                 device_printf(c->dev,
  262                     "%s(): can't set source rate\n", __func__);
  263                 return (ret);
  264         }
  265 
  266         ret = FEEDER_SET(f, FEEDRATE_DST, cdesc->target.rate);
  267         if (ret != 0) {
  268                 device_printf(c->dev,
  269                     "%s(): can't set destination rate\n", __func__);
  270                 return (ret);
  271         }
  272 
  273         c->feederflags |= 1 << FEEDER_RATE;
  274 
  275         cdesc->current.rate = cdesc->target.rate;
  276 
  277         return (0);
  278 }
  279 
  280 /*
  281  * feeder_build_matrix(): Chain channel matrixing converter.
  282  */
  283 static int
  284 feeder_build_matrix(struct pcm_channel *c, struct feeder_chain_desc *cdesc)
  285 {
  286         struct feeder_class *fc;
  287         struct pcm_feeder *f;
  288         struct pcm_feederdesc *desc;
  289         int ret;
  290 
  291         ret = feeder_build_formatne(c, cdesc);
  292         if (ret != 0)
  293                 return (ret);
  294 
  295         desc = &(cdesc->desc);
  296         desc->type = FEEDER_MATRIX;
  297         desc->in = 0;
  298         desc->out = 0;
  299         desc->flags = 0;
  300 
  301         fc = feeder_getclass(desc);
  302         if (fc == NULL) {
  303                 device_printf(c->dev,
  304                     "%s(): can't find feeder_matrix\n", __func__);
  305                 return (ENOTSUP);
  306         }
  307 
  308         desc->in = cdesc->current.afmt;
  309         desc->out = SND_FORMAT(cdesc->current.afmt,
  310             cdesc->target.matrix->channels, cdesc->target.matrix->ext);
  311 
  312         ret = chn_addfeeder(c, fc, desc);
  313         if (ret != 0) {
  314                 device_printf(c->dev,
  315                     "%s(): can't add feeder_matrix\n", __func__);
  316                 return (ret);
  317         }
  318 
  319         f = c->feeder;
  320         ret = feeder_matrix_setup(f, cdesc->current.matrix,
  321             cdesc->target.matrix);
  322         if (ret != 0) {
  323                 device_printf(c->dev,
  324                     "%s(): feeder_matrix_setup() failed\n", __func__);
  325                 return (ret);
  326         }
  327 
  328         c->feederflags |= 1 << FEEDER_MATRIX;
  329 
  330         cdesc->current.afmt = desc->out;
  331         cdesc->current.matrix = cdesc->target.matrix;
  332         cdesc->use_matrix = 0;
  333 
  334         return (0);
  335 }
  336 
  337 /*
  338  * feeder_build_volume(): Chain soft volume.
  339  */
  340 static int
  341 feeder_build_volume(struct pcm_channel *c, struct feeder_chain_desc *cdesc)
  342 {
  343         struct feeder_class *fc;
  344         struct pcm_feeder *f;
  345         struct pcm_feederdesc *desc;
  346         int ret;
  347 
  348         ret = feeder_build_formatne(c, cdesc);
  349         if (ret != 0)
  350                 return (ret);
  351 
  352         desc = &(cdesc->desc);
  353         desc->type = FEEDER_VOLUME;
  354         desc->in = 0;
  355         desc->out = 0;
  356         desc->flags = 0;
  357 
  358         fc = feeder_getclass(desc);
  359         if (fc == NULL) {
  360                 device_printf(c->dev,
  361                     "%s(): can't find feeder_volume\n", __func__);
  362                 return (ENOTSUP);
  363         }
  364 
  365         desc->in = cdesc->current.afmt;
  366         desc->out = desc->in;
  367 
  368         ret = chn_addfeeder(c, fc, desc);
  369         if (ret != 0) {
  370                 device_printf(c->dev,
  371                     "%s(): can't add feeder_volume\n", __func__);
  372                 return (ret);
  373         }
  374 
  375         f = c->feeder;
  376 
  377         /*
  378          * If in 'dummy' mode (possibly due to passthrough mode), set BYPASS
  379          * mode since listener won't be hearing anything. Theoretically we can
  380          * just disable it, but that will confuse volume per channel mixer.
  381          */
  382         if (cdesc->dummy != 0) {
  383                 ret = FEEDER_SET(f, FEEDVOLUME_STATE, FEEDVOLUME_BYPASS);
  384                 if (ret != 0) {
  385                         device_printf(c->dev,
  386                             "%s(): can't set volume bypass\n", __func__);
  387                         return (ret);
  388                 }
  389         }
  390 
  391         ret = feeder_volume_apply_matrix(f, cdesc->current.matrix);
  392         if (ret != 0) {
  393                 device_printf(c->dev,
  394                     "%s(): feeder_volume_apply_matrix() failed\n", __func__);
  395                 return (ret);
  396         }
  397 
  398         c->feederflags |= 1 << FEEDER_VOLUME;
  399 
  400         cdesc->use_volume = 0;
  401 
  402         return (0);
  403 }
  404 
  405 /*
  406  * feeder_build_eq(): Chain parametric software equalizer.
  407  */
  408 static int
  409 feeder_build_eq(struct pcm_channel *c, struct feeder_chain_desc *cdesc)
  410 {
  411         struct feeder_class *fc;
  412         struct pcm_feeder *f;
  413         struct pcm_feederdesc *desc;
  414         int ret;
  415 
  416         ret = feeder_build_formatne(c, cdesc);
  417         if (ret != 0)
  418                 return (ret);
  419 
  420         desc = &(cdesc->desc);
  421         desc->type = FEEDER_EQ;
  422         desc->in = 0;
  423         desc->out = 0;
  424         desc->flags = 0;
  425 
  426         fc = feeder_getclass(desc);
  427         if (fc == NULL) {
  428                 device_printf(c->dev,
  429                     "%s(): can't find feeder_eq\n", __func__);
  430                 return (ENOTSUP);
  431         }
  432 
  433         desc->in = cdesc->current.afmt;
  434         desc->out = desc->in;
  435 
  436         ret = chn_addfeeder(c, fc, desc);
  437         if (ret != 0) {
  438                 device_printf(c->dev,
  439                     "%s(): can't add feeder_eq\n", __func__);
  440                 return (ret);
  441         }
  442 
  443         f = c->feeder;
  444 
  445         ret = FEEDER_SET(f, FEEDEQ_RATE, cdesc->current.rate);
  446         if (ret != 0) {
  447                 device_printf(c->dev,
  448                     "%s(): can't set rate on feeder_eq\n", __func__);
  449                 return (ret);
  450         }
  451 
  452         c->feederflags |= 1 << FEEDER_EQ;
  453 
  454         cdesc->use_eq = 0;
  455 
  456         return (0);
  457 }
  458 
  459 /*
  460  * feeder_build_root(): Chain root feeder, the top, father of all.
  461  */
  462 static int
  463 feeder_build_root(struct pcm_channel *c, struct feeder_chain_desc *cdesc)
  464 {
  465         struct feeder_class *fc;
  466         int ret;
  467 
  468         fc = feeder_getclass(NULL);
  469         if (fc == NULL) {
  470                 device_printf(c->dev,
  471                     "%s(): can't find feeder_root\n", __func__);
  472                 return (ENOTSUP);
  473         }
  474 
  475         ret = chn_addfeeder(c, fc, NULL);
  476         if (ret != 0) {
  477                 device_printf(c->dev,
  478                     "%s(): can't add feeder_root\n", __func__);
  479                 return (ret);
  480         }
  481 
  482         c->feederflags |= 1 << FEEDER_ROOT;
  483 
  484         c->feeder->desc->in = cdesc->current.afmt;
  485         c->feeder->desc->out = cdesc->current.afmt;
  486 
  487         return (0);
  488 }
  489 
  490 /*
  491  * feeder_build_mixer(): Chain software mixer for virtual channels.
  492  */
  493 static int
  494 feeder_build_mixer(struct pcm_channel *c, struct feeder_chain_desc *cdesc)
  495 {
  496         struct feeder_class *fc;
  497         struct pcm_feederdesc *desc;
  498         int ret;
  499 
  500         desc = &(cdesc->desc);
  501         desc->type = FEEDER_MIXER;
  502         desc->in = 0;
  503         desc->out = 0;
  504         desc->flags = 0;
  505 
  506         fc = feeder_getclass(desc);
  507         if (fc == NULL) {
  508                 device_printf(c->dev,
  509                     "%s(): can't find feeder_mixer\n", __func__);
  510                 return (ENOTSUP);
  511         }
  512 
  513         desc->in = cdesc->current.afmt;
  514         desc->out = desc->in;
  515 
  516         ret = chn_addfeeder(c, fc, desc);
  517         if (ret != 0) {
  518                 device_printf(c->dev,
  519                     "%s(): can't add feeder_mixer\n", __func__);
  520                 return (ret);
  521         }
  522 
  523         c->feederflags |= 1 << FEEDER_MIXER;
  524 
  525         return (0);
  526 }
  527 
  528 /* Macrosses to ease our job doing stuffs later. */
  529 #define FEEDER_BW(c, t)         ((c)->t.matrix->channels * (c)->t.rate)
  530 
  531 #define FEEDRATE_UP(c)          ((c)->target.rate > (c)->current.rate)
  532 #define FEEDRATE_DOWN(c)        ((c)->target.rate < (c)->current.rate)
  533 #define FEEDRATE_REQUIRED(c)    (FEEDRATE_UP(c) || FEEDRATE_DOWN(c))
  534 
  535 #define FEEDMATRIX_UP(c)        ((c)->target.matrix->channels >         \
  536                                  (c)->current.matrix->channels)
  537 #define FEEDMATRIX_DOWN(c)      ((c)->target.matrix->channels <         \
  538                                  (c)->current.matrix->channels)
  539 #define FEEDMATRIX_REQUIRED(c)  (FEEDMATRIX_UP(c) ||                    \
  540                                  FEEDMATRIX_DOWN(c) || (c)->use_matrix != 0)
  541 
  542 #define FEEDFORMAT_REQUIRED(c)  (AFMT_ENCODING((c)->current.afmt) !=    \
  543                                  AFMT_ENCODING((c)->target.afmt))
  544 
  545 #define FEEDVOLUME_REQUIRED(c)  ((c)->use_volume != 0)
  546 
  547 #define FEEDEQ_VALIDRATE(c, t)  (feeder_eq_validrate((c)->t.rate) != 0)
  548 #define FEEDEQ_ECONOMY(c)       (FEEDER_BW(c, current) < FEEDER_BW(c, target))
  549 #define FEEDEQ_REQUIRED(c)      ((c)->use_eq != 0 &&                    \
  550                                  FEEDEQ_VALIDRATE(c, current))
  551 
  552 #define FEEDFORMAT_NE_REQUIRED(c)                                       \
  553         ((c)->afmt_ne != AFMT_S32_NE &&                                 \
  554         (((c)->mode == FEEDER_CHAIN_16 &&                               \
  555         AFMT_ENCODING((c)->current.afmt) != AFMT_S16_NE) ||             \
  556         ((c)->mode == FEEDER_CHAIN_32 &&                                \
  557         AFMT_ENCODING((c)->current.afmt) != AFMT_S32_NE) ||             \
  558         (c)->mode == FEEDER_CHAIN_FULLMULTI ||                          \
  559         ((c)->mode == FEEDER_CHAIN_MULTI &&                             \
  560         ((c)->current.afmt & AFMT_8BIT)) ||                             \
  561         ((c)->mode == FEEDER_CHAIN_LEAN &&                              \
  562         !((c)->current.afmt & (AFMT_S16_NE | AFMT_S32_NE)))))
  563 
  564 static void
  565 feeder_default_matrix(struct pcmchan_matrix *m, uint32_t fmt, int id)
  566 {
  567         int x;
  568 
  569         memset(m, 0, sizeof(*m));
  570 
  571         m->id = id;
  572         m->channels = AFMT_CHANNEL(fmt);
  573         m->ext = AFMT_EXTCHANNEL(fmt);
  574         for (x = 0; x != SND_CHN_T_MAX; x++)
  575                 m->offset[x] = -1;
  576 }
  577 
  578 int
  579 feeder_chain(struct pcm_channel *c)
  580 {
  581         struct snddev_info *d;
  582         struct pcmchan_caps *caps;
  583         struct feeder_chain_desc cdesc;
  584         struct pcmchan_matrix *hwmatrix, *softmatrix;
  585         uint32_t hwfmt, softfmt;
  586         int ret;
  587 
  588         CHN_LOCKASSERT(c);
  589 
  590         /* Remove everything first. */
  591         while (chn_removefeeder(c) == 0)
  592                 ;
  593 
  594         KASSERT(c->feeder == NULL, ("feeder chain not empty"));
  595 
  596         /* clear and populate chain descriptor. */
  597         bzero(&cdesc, sizeof(cdesc));
  598 
  599         switch (feeder_chain_mode) {
  600         case FEEDER_CHAIN_LEAN:
  601         case FEEDER_CHAIN_16:
  602         case FEEDER_CHAIN_32:
  603 #if defined(SND_FEEDER_MULTIFORMAT) || defined(SND_FEEDER_FULL_MULTIFORMAT)
  604         case FEEDER_CHAIN_MULTI:
  605 #endif
  606 #if defined(SND_FEEDER_FULL_MULTIFORMAT)
  607         case FEEDER_CHAIN_FULLMULTI:
  608 #endif
  609                 break;
  610         default:
  611                 feeder_chain_mode = FEEDER_CHAIN_DEFAULT;
  612                 break;
  613         }
  614 
  615         cdesc.mode = feeder_chain_mode;
  616         cdesc.expensive = 1;    /* XXX faster.. */
  617 
  618 #define VCHAN_PASSTHROUGH(c)    (((c)->flags & (CHN_F_VIRTUAL |         \
  619                                  CHN_F_PASSTHROUGH)) ==                 \
  620                                  (CHN_F_VIRTUAL | CHN_F_PASSTHROUGH))
  621 
  622         /* Get the best possible hardware format. */
  623         if (VCHAN_PASSTHROUGH(c))
  624                 hwfmt = c->parentchannel->format;
  625         else {
  626                 caps = chn_getcaps(c);
  627                 if (caps == NULL || caps->fmtlist == NULL) {
  628                         device_printf(c->dev,
  629                             "%s(): failed to get channel caps\n", __func__);
  630                         return (ENODEV);
  631                 }
  632 
  633                 if ((c->format & AFMT_PASSTHROUGH) &&
  634                     !snd_fmtvalid(c->format, caps->fmtlist))
  635                         return (ENODEV);
  636 
  637                 hwfmt = snd_fmtbest(c->format, caps->fmtlist);
  638                 if (hwfmt == 0 || !snd_fmtvalid(hwfmt, caps->fmtlist)) {
  639                         device_printf(c->dev,
  640                             "%s(): invalid hardware format 0x%08x\n",
  641                             __func__, hwfmt);
  642                         {
  643                                 int i;
  644                                 for (i = 0; caps->fmtlist[i] != 0; i++)
  645                                         printf("0x%08x\n", caps->fmtlist[i]);
  646                                 printf("Req: 0x%08x\n", c->format);
  647                         }
  648                         return (ENODEV);
  649                 }
  650         }
  651 
  652         /*
  653          * The 'hardware' possibly have different intepretation of channel
  654          * matrixing, so get it first .....
  655          */
  656         hwmatrix = CHANNEL_GETMATRIX(c->methods, c->devinfo, hwfmt);
  657         if (hwmatrix == NULL) {
  658                 /* setup a default matrix */
  659                 hwmatrix = &c->matrix_scratch;
  660                 feeder_default_matrix(hwmatrix, hwfmt,
  661                     SND_CHN_MATRIX_UNKNOWN);
  662         }
  663         /* ..... and rebuild hwfmt. */
  664         hwfmt = SND_FORMAT(hwfmt, hwmatrix->channels, hwmatrix->ext);
  665 
  666         /* Reset and rebuild default channel format/matrix map. */
  667         softfmt = c->format;
  668         softmatrix = &c->matrix;
  669         if (softmatrix->channels != AFMT_CHANNEL(softfmt) ||
  670             softmatrix->ext != AFMT_EXTCHANNEL(softfmt)) {
  671                 softmatrix = feeder_matrix_format_map(softfmt);
  672                 if (softmatrix == NULL) {
  673                         /* setup a default matrix */
  674                         softmatrix = &c->matrix;
  675                         feeder_default_matrix(softmatrix, softfmt,
  676                             SND_CHN_MATRIX_PCMCHANNEL);
  677                 } else {
  678                         c->matrix = *softmatrix;
  679                         c->matrix.id = SND_CHN_MATRIX_PCMCHANNEL;
  680                 }
  681         }
  682         softfmt = SND_FORMAT(softfmt, softmatrix->channels, softmatrix->ext);
  683         if (softfmt != c->format)
  684                 device_printf(c->dev,
  685                     "%s(): WARNING: %s Soft format 0x%08x -> 0x%08x\n",
  686                     __func__, CHN_DIRSTR(c), c->format, softfmt);
  687 
  688         /*
  689          * PLAY and REC are opposite.
  690          */
  691         if (c->direction == PCMDIR_PLAY) {
  692                 cdesc.origin.afmt    = softfmt;
  693                 cdesc.origin.matrix  = softmatrix;
  694                 cdesc.origin.rate    = c->speed;
  695                 cdesc.target.afmt    = hwfmt;
  696                 cdesc.target.matrix  = hwmatrix;
  697                 cdesc.target.rate    = sndbuf_getspd(c->bufhard);
  698         } else {
  699                 cdesc.origin.afmt    = hwfmt;
  700                 cdesc.origin.matrix  = hwmatrix;
  701                 cdesc.origin.rate    = sndbuf_getspd(c->bufhard);
  702                 cdesc.target.afmt    = softfmt;
  703                 cdesc.target.matrix  = softmatrix;
  704                 cdesc.target.rate    = c->speed;
  705         }
  706 
  707         d = c->parentsnddev;
  708 
  709         /*
  710          * If channel is in bitperfect or passthrough mode, make it appear
  711          * that 'origin' and 'target' identical, skipping mostly chain
  712          * procedures.
  713          */
  714         if (CHN_BITPERFECT(c) || (c->format & AFMT_PASSTHROUGH)) {
  715                 if (c->direction == PCMDIR_PLAY)
  716                         cdesc.origin = cdesc.target;
  717                 else
  718                         cdesc.target = cdesc.origin;
  719                 c->format = cdesc.target.afmt;
  720                 c->speed  = cdesc.target.rate;
  721         } else {
  722                 /* hwfmt is not convertible, so 'dummy' it. */
  723                 if (hwfmt & AFMT_PASSTHROUGH)
  724                         cdesc.dummy = 1;
  725 
  726                 if ((softfmt & AFMT_CONVERTIBLE) &&
  727                     (((d->flags & SD_F_VPC) && !(c->flags & CHN_F_HAS_VCHAN)) ||
  728                     (!(d->flags & SD_F_VPC) && (d->flags & SD_F_SOFTPCMVOL) &&
  729                     !(c->flags & CHN_F_VIRTUAL))))
  730                         cdesc.use_volume = 1;
  731 
  732                 if (feeder_matrix_compare(cdesc.origin.matrix,
  733                     cdesc.target.matrix) != 0)
  734                         cdesc.use_matrix = 1;
  735 
  736                 /* Soft EQ only applicable for PLAY. */
  737                 if (cdesc.dummy == 0 &&
  738                     c->direction == PCMDIR_PLAY && (d->flags & SD_F_EQ) &&
  739                     (((d->flags & SD_F_EQ_PC) &&
  740                     !(c->flags & CHN_F_HAS_VCHAN)) ||
  741                     (!(d->flags & SD_F_EQ_PC) && !(c->flags & CHN_F_VIRTUAL))))
  742                         cdesc.use_eq = 1;
  743 
  744                 if (FEEDFORMAT_NE_REQUIRED(&cdesc)) {
  745                         cdesc.afmt_ne =
  746                             (cdesc.dummy != 0) ?
  747                             snd_fmtbest(AFMT_ENCODING(softfmt),
  748                             feeder_chain_formats[cdesc.mode]) :
  749                             snd_fmtbest(AFMT_ENCODING(cdesc.target.afmt),
  750                             feeder_chain_formats[cdesc.mode]);
  751                         if (cdesc.afmt_ne == 0) {
  752                                 device_printf(c->dev,
  753                                     "%s(): snd_fmtbest failed!\n", __func__);
  754                                 cdesc.afmt_ne =
  755                                     (((cdesc.dummy != 0) ? softfmt :
  756                                     cdesc.target.afmt) &
  757                                     (AFMT_24BIT | AFMT_32BIT)) ?
  758                                     AFMT_S32_NE : AFMT_S16_NE;
  759                         }
  760                 }
  761         }
  762 
  763         cdesc.current = cdesc.origin;
  764 
  765         /* Build everything. */
  766 
  767         c->feederflags = 0;
  768 
  769 #define FEEDER_BUILD(t) do {                                            \
  770         ret = feeder_build_##t(c, &cdesc);                              \
  771         if (ret != 0)                                                   \
  772                 return (ret);                                           \
  773         } while (0)
  774 
  775         if (!(c->flags & CHN_F_HAS_VCHAN) || c->direction == PCMDIR_REC)
  776                 FEEDER_BUILD(root);
  777         else if (c->direction == PCMDIR_PLAY && (c->flags & CHN_F_HAS_VCHAN))
  778                 FEEDER_BUILD(mixer);
  779         else
  780                 return (ENOTSUP);
  781 
  782         /*
  783          * The basic idea is: The smaller the bandwidth, the cheaper the
  784          * conversion process, with following constraints:-
  785          *
  786          * 1) Almost all feeders work best in 16/32 native endian.
  787          * 2) Try to avoid 8bit feeders due to poor dynamic range.
  788          * 3) Avoid volume, format, matrix and rate in BITPERFECT or
  789          *    PASSTHROUGH mode.
  790          * 4) Try putting volume before EQ or rate. Should help to
  791          *    avoid/reduce possible clipping.
  792          * 5) EQ require specific, valid rate, unless it allow sloppy
  793          *    conversion.
  794          */
  795         if (FEEDMATRIX_UP(&cdesc)) {
  796                 if (FEEDEQ_REQUIRED(&cdesc) &&
  797                     (!FEEDEQ_VALIDRATE(&cdesc, target) ||
  798                     (cdesc.expensive == 0 && FEEDEQ_ECONOMY(&cdesc))))
  799                         FEEDER_BUILD(eq);
  800                 if (FEEDRATE_REQUIRED(&cdesc))
  801                         FEEDER_BUILD(rate);
  802                 FEEDER_BUILD(matrix);
  803                 if (FEEDVOLUME_REQUIRED(&cdesc))
  804                         FEEDER_BUILD(volume);
  805                 if (FEEDEQ_REQUIRED(&cdesc))
  806                         FEEDER_BUILD(eq);
  807         } else if (FEEDMATRIX_DOWN(&cdesc)) {
  808                 FEEDER_BUILD(matrix);
  809                 if (FEEDVOLUME_REQUIRED(&cdesc))
  810                         FEEDER_BUILD(volume);
  811                 if (FEEDEQ_REQUIRED(&cdesc) &&
  812                     (!FEEDEQ_VALIDRATE(&cdesc, target) ||
  813                     FEEDEQ_ECONOMY(&cdesc)))
  814                         FEEDER_BUILD(eq);
  815                 if (FEEDRATE_REQUIRED(&cdesc))
  816                         FEEDER_BUILD(rate);
  817                 if (FEEDEQ_REQUIRED(&cdesc))
  818                         FEEDER_BUILD(eq);
  819         } else {
  820                 if (FEEDRATE_DOWN(&cdesc)) {
  821                         if (FEEDEQ_REQUIRED(&cdesc) &&
  822                             !FEEDEQ_VALIDRATE(&cdesc, target)) {
  823                                 if (FEEDVOLUME_REQUIRED(&cdesc))
  824                                         FEEDER_BUILD(volume);
  825                                 FEEDER_BUILD(eq);
  826                         }
  827                         FEEDER_BUILD(rate);
  828                 }
  829                 if (FEEDMATRIX_REQUIRED(&cdesc))
  830                         FEEDER_BUILD(matrix);
  831                 if (FEEDVOLUME_REQUIRED(&cdesc))
  832                         FEEDER_BUILD(volume);
  833                 if (FEEDRATE_UP(&cdesc)) {
  834                         if (FEEDEQ_REQUIRED(&cdesc) &&
  835                             !FEEDEQ_VALIDRATE(&cdesc, target))
  836                                 FEEDER_BUILD(eq);
  837                         FEEDER_BUILD(rate);
  838                 }
  839                 if (FEEDEQ_REQUIRED(&cdesc))
  840                         FEEDER_BUILD(eq);
  841         }
  842 
  843         if (FEEDFORMAT_REQUIRED(&cdesc))
  844                 FEEDER_BUILD(format);
  845 
  846         if (c->direction == PCMDIR_REC && (c->flags & CHN_F_HAS_VCHAN))
  847                 FEEDER_BUILD(mixer);
  848 
  849         sndbuf_setfmt(c->bufsoft, c->format);
  850         sndbuf_setspd(c->bufsoft, c->speed);
  851 
  852         sndbuf_setfmt(c->bufhard, hwfmt);
  853 
  854         chn_syncstate(c);
  855 
  856         return (0);
  857 }

Cache object: 8f800e0446b974d7574144c3cac7472c


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