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_format.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 /*
   28  * feeder_format: New generation of generic, any-to-any format converter, as
   29  *                long as the sample values can be read _and_ write.
   30  */
   31 
   32 #ifdef _KERNEL
   33 #ifdef HAVE_KERNEL_OPTION_HEADERS
   34 #include "opt_snd.h"
   35 #endif
   36 #include <dev/sound/pcm/sound.h>
   37 #include <dev/sound/pcm/pcm.h>
   38 #include <dev/sound/pcm/g711.h>
   39 #include <dev/sound/pcm/intpcm.h>
   40 #include "feeder_if.h"
   41 
   42 #define SND_USE_FXDIV
   43 #include "snd_fxdiv_gen.h"
   44 
   45 SND_DECLARE_FILE("$FreeBSD: releng/9.0/sys/dev/sound/pcm/feeder_format.c 193640 2009-06-07 19:12:08Z ariff $");
   46 #endif
   47 
   48 #define FEEDFORMAT_RESERVOIR    (SND_CHN_MAX * PCM_32_BPS)
   49 
   50 INTPCM_DECLARE(intpcm_conv_tables)
   51 
   52 struct feed_format_info {
   53         uint32_t ibps, obps;
   54         uint32_t ialign, oalign, channels;
   55         intpcm_read_t *read;
   56         intpcm_write_t *write;
   57         uint8_t reservoir[FEEDFORMAT_RESERVOIR];
   58 };
   59 
   60 /*
   61  * dummy ac3/dts passthrough, etc.
   62  * XXX assume as s16le.
   63  */
   64 static __inline intpcm_t
   65 intpcm_read_null(uint8_t *src __unused)
   66 {
   67 
   68         return (0);
   69 }
   70 
   71 static __inline void
   72 intpcm_write_null(uint8_t *dst, intpcm_t v __unused)
   73 {
   74 
   75         _PCM_WRITE_S16_LE(dst, 0);
   76 }
   77 
   78 #define FEEDFORMAT_ENTRY(SIGN, BIT, ENDIAN)                             \
   79         {                                                               \
   80                 AFMT_##SIGN##BIT##_##ENDIAN,                            \
   81                 intpcm_read_##SIGN##BIT##ENDIAN,                        \
   82                 intpcm_write_##SIGN##BIT##ENDIAN                        \
   83         }
   84 
   85 static const struct {
   86         uint32_t format;
   87         intpcm_read_t *read;
   88         intpcm_write_t *write;
   89 } feed_format_ops[] = {
   90         FEEDFORMAT_ENTRY(S,  8, NE),
   91         FEEDFORMAT_ENTRY(S, 16, LE),
   92         FEEDFORMAT_ENTRY(S, 24, LE),
   93         FEEDFORMAT_ENTRY(S, 32, LE),
   94         FEEDFORMAT_ENTRY(S, 16, BE),
   95         FEEDFORMAT_ENTRY(S, 24, BE),
   96         FEEDFORMAT_ENTRY(S, 32, BE),
   97         FEEDFORMAT_ENTRY(U,  8, NE),
   98         FEEDFORMAT_ENTRY(U, 16, LE),
   99         FEEDFORMAT_ENTRY(U, 24, LE),
  100         FEEDFORMAT_ENTRY(U, 32, LE),
  101         FEEDFORMAT_ENTRY(U, 16, BE),
  102         FEEDFORMAT_ENTRY(U, 24, BE),
  103         FEEDFORMAT_ENTRY(U, 32, BE),
  104         {
  105                 AFMT_MU_LAW,
  106                 intpcm_read_ulaw, intpcm_write_ulaw
  107         },
  108         {
  109                 AFMT_A_LAW,
  110                 intpcm_read_alaw, intpcm_write_alaw
  111         },
  112         {
  113                 AFMT_AC3,
  114                 intpcm_read_null, intpcm_write_null
  115         }
  116 };
  117 
  118 #define FEEDFORMAT_TAB_SIZE                                             \
  119         ((int32_t)(sizeof(feed_format_ops) / sizeof(feed_format_ops[0])))
  120 
  121 static int
  122 feed_format_init(struct pcm_feeder *f)
  123 {
  124         struct feed_format_info *info;
  125         intpcm_read_t *rd_op;
  126         intpcm_write_t *wr_op;
  127         int i;
  128 
  129         if (f->desc->in == f->desc->out ||
  130             AFMT_CHANNEL(f->desc->in) != AFMT_CHANNEL(f->desc->out))
  131                 return (EINVAL);
  132 
  133         rd_op = NULL;
  134         wr_op = NULL;
  135 
  136         for (i = 0; i < FEEDFORMAT_TAB_SIZE &&
  137             (rd_op == NULL || wr_op == NULL); i++) {
  138                 if (rd_op == NULL &&
  139                     AFMT_ENCODING(f->desc->in) == feed_format_ops[i].format)
  140                         rd_op = feed_format_ops[i].read;
  141                 if (wr_op == NULL &&
  142                     AFMT_ENCODING(f->desc->out) == feed_format_ops[i].format)
  143                         wr_op = feed_format_ops[i].write;
  144         }
  145 
  146         if (rd_op == NULL || wr_op == NULL) {
  147                 printf("%s(): failed to initialize io ops "
  148                     "in=0x%08x out=0x%08x\n",
  149                     __func__, f->desc->in, f->desc->out);
  150                 return (EINVAL);
  151         }
  152 
  153         info = malloc(sizeof(*info), M_DEVBUF, M_NOWAIT | M_ZERO);
  154         if (info == NULL)
  155                 return (ENOMEM);
  156 
  157         info->channels = AFMT_CHANNEL(f->desc->in);
  158 
  159         info->ibps = AFMT_BPS(f->desc->in);
  160         info->ialign = info->ibps * info->channels;
  161         info->read = rd_op;
  162 
  163         info->obps = AFMT_BPS(f->desc->out);
  164         info->oalign = info->obps * info->channels;
  165         info->write = wr_op;
  166 
  167         f->data = info;
  168 
  169         return (0);
  170 }
  171 
  172 static int
  173 feed_format_free(struct pcm_feeder *f)
  174 {
  175         struct feed_format_info *info;
  176 
  177         info = f->data;
  178         if (info != NULL)
  179                 free(info, M_DEVBUF);
  180 
  181         f->data = NULL;
  182 
  183         return (0);
  184 }
  185 
  186 static int
  187 feed_format_set(struct pcm_feeder *f, int what, int value)
  188 {
  189         struct feed_format_info *info;
  190 
  191         info = f->data;
  192 
  193         switch (what) {
  194         case FEEDFORMAT_CHANNELS:
  195                 if (value < SND_CHN_MIN || value > SND_CHN_MAX)
  196                         return (EINVAL);
  197                 info->channels = (uint32_t)value;
  198                 info->ialign = info->ibps * info->channels;
  199                 info->oalign = info->obps * info->channels;
  200                 break;
  201         default:
  202                 return (EINVAL);
  203                 break;
  204         }
  205 
  206         return (0);
  207 }
  208 
  209 static int
  210 feed_format_feed(struct pcm_feeder *f, struct pcm_channel *c, uint8_t *b,
  211     uint32_t count, void *source)
  212 {
  213         struct feed_format_info *info;
  214         intpcm_t v;
  215         uint32_t j;
  216         uint8_t *src, *dst;
  217 
  218         info = f->data;
  219         dst = b;
  220         count = SND_FXROUND(count, info->oalign);
  221 
  222         do {
  223                 if (count < info->oalign)
  224                         break;
  225 
  226                 if (count < info->ialign) {
  227                         src = info->reservoir;
  228                         j = info->ialign;
  229                 } else {
  230                         if (info->ialign == info->oalign)
  231                                 j = count;
  232                         else if (info->ialign > info->oalign)
  233                                 j = SND_FXROUND(count, info->ialign);
  234                         else
  235                                 j = SND_FXDIV(count, info->oalign) *
  236                                     info->ialign;
  237                         src = dst + count - j;
  238                 }
  239 
  240                 j = SND_FXDIV(FEEDER_FEED(f->source, c, src, j, source),
  241                     info->ialign);
  242                 if (j == 0)
  243                         break;
  244 
  245                 j *= info->channels;
  246                 count -= j * info->obps;
  247 
  248                 do {
  249                         v = info->read(src);
  250                         info->write(dst, v);
  251                         dst += info->obps;
  252                         src += info->ibps;
  253                 } while (--j != 0);
  254 
  255         } while (count != 0);
  256 
  257         return (dst - b);
  258 }
  259 
  260 static struct pcm_feederdesc feeder_format_desc[] = {
  261         { FEEDER_FORMAT, 0, 0, 0, 0 },
  262         { 0, 0, 0, 0, 0 }
  263 };
  264 
  265 static kobj_method_t feeder_format_methods[] = {
  266         KOBJMETHOD(feeder_init,         feed_format_init),
  267         KOBJMETHOD(feeder_free,         feed_format_free),
  268         KOBJMETHOD(feeder_set,          feed_format_set),
  269         KOBJMETHOD(feeder_feed,         feed_format_feed),
  270         KOBJMETHOD_END
  271 };
  272 
  273 FEEDER_DECLARE(feeder_format, NULL);
  274 
  275 /* Extern */
  276 intpcm_read_t *
  277 feeder_format_read_op(uint32_t format)
  278 {
  279         int i;
  280 
  281         for (i = 0; i < FEEDFORMAT_TAB_SIZE; i++) {
  282                 if (AFMT_ENCODING(format) == feed_format_ops[i].format)
  283                         return (feed_format_ops[i].read);
  284         }
  285 
  286         return (NULL);
  287 }
  288 
  289 intpcm_write_t *
  290 feeder_format_write_op(uint32_t format)
  291 {
  292         int i;
  293 
  294         for (i = 0; i < FEEDFORMAT_TAB_SIZE; i++) {
  295                 if (AFMT_ENCODING(format) == feed_format_ops[i].format)
  296                         return (feed_format_ops[i].write);
  297         }
  298 
  299         return (NULL);
  300 }

Cache object: 6f4adb7039c2113c6381359b89a98152


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