LXR qemu/audio/mixeng.c

   1/*
   2 * QEMU Mixing engine
   3 *
   4 * Copyright (c) 2004-2005 Vassili Karpov (malc)
   5 * Copyright (c) 1998 Fabrice Bellard
   6 *
   7 * Permission is hereby granted, free of charge, to any person obtaining a copy
   8 * of this software and associated documentation files (the "Software"), to deal
   9 * in the Software without restriction, including without limitation the rights
  10 * to use, copy, modify, merge, publish, distribute, sublicense, and/or sell
  11 * copies of the Software, and to permit persons to whom the Software is
  12 * furnished to do so, subject to the following conditions:
  13 *
  14 * The above copyright notice and this permission notice shall be included in
  15 * all copies or substantial portions of the Software.
  16 *
  17 * THE SOFTWARE IS PROVIDED "AS IS", WITHOUT WARRANTY OF ANY KIND, EXPRESS OR
  18 * IMPLIED, INCLUDING BUT NOT LIMITED TO THE WARRANTIES OF MERCHANTABILITY,
  19 * FITNESS FOR A PARTICULAR PURPOSE AND NONINFRINGEMENT. IN NO EVENT SHALL
  20 * THE AUTHORS OR COPYRIGHT HOLDERS BE LIABLE FOR ANY CLAIM, DAMAGES OR OTHER
  21 * LIABILITY, WHETHER IN AN ACTION OF CONTRACT, TORT OR OTHERWISE, ARISING FROM,
  22 * OUT OF OR IN CONNECTION WITH THE SOFTWARE OR THE USE OR OTHER DEALINGS IN
  23 * THE SOFTWARE.
  24 */
  25#include "qemu/osdep.h"
  26#include "qemu-common.h"
  27#include "audio.h"
  28
  29#define AUDIO_CAP "mixeng"
  30#include "audio_int.h"
  31
  32/* 8 bit */
  33#define ENDIAN_CONVERSION natural
  34#define ENDIAN_CONVERT(v) (v)
  35
  36/* Signed 8 bit */
  37#define BSIZE 8
  38#define ITYPE int
  39#define IN_MIN SCHAR_MIN
  40#define IN_MAX SCHAR_MAX
  41#define SIGNED
  42#define SHIFT 8
  43#include "mixeng_template.h"
  44#undef SIGNED
  45#undef IN_MAX
  46#undef IN_MIN
  47#undef BSIZE
  48#undef ITYPE
  49#undef SHIFT
  50
  51/* Unsigned 8 bit */
  52#define BSIZE 8
  53#define ITYPE uint
  54#define IN_MIN 0
  55#define IN_MAX UCHAR_MAX
  56#define SHIFT 8
  57#include "mixeng_template.h"
  58#undef IN_MAX
  59#undef IN_MIN
  60#undef BSIZE
  61#undef ITYPE
  62#undef SHIFT
  63
  64#undef ENDIAN_CONVERT
  65#undef ENDIAN_CONVERSION
  66
  67/* Signed 16 bit */
  68#define BSIZE 16
  69#define ITYPE int
  70#define IN_MIN SHRT_MIN
  71#define IN_MAX SHRT_MAX
  72#define SIGNED
  73#define SHIFT 16
  74#define ENDIAN_CONVERSION natural
  75#define ENDIAN_CONVERT(v) (v)
  76#include "mixeng_template.h"
  77#undef ENDIAN_CONVERT
  78#undef ENDIAN_CONVERSION
  79#define ENDIAN_CONVERSION swap
  80#define ENDIAN_CONVERT(v) bswap16 (v)
  81#include "mixeng_template.h"
  82#undef ENDIAN_CONVERT
  83#undef ENDIAN_CONVERSION
  84#undef SIGNED
  85#undef IN_MAX
  86#undef IN_MIN
  87#undef BSIZE
  88#undef ITYPE
  89#undef SHIFT
  90
  91/* Unsigned 16 bit */
  92#define BSIZE 16
  93#define ITYPE uint
  94#define IN_MIN 0
  95#define IN_MAX USHRT_MAX
  96#define SHIFT 16
  97#define ENDIAN_CONVERSION natural
  98#define ENDIAN_CONVERT(v) (v)
  99#include "mixeng_template.h"
 100#undef ENDIAN_CONVERT
 101#undef ENDIAN_CONVERSION
 102#define ENDIAN_CONVERSION swap
 103#define ENDIAN_CONVERT(v) bswap16 (v)
 104#include "mixeng_template.h"
 105#undef ENDIAN_CONVERT
 106#undef ENDIAN_CONVERSION
 107#undef IN_MAX
 108#undef IN_MIN
 109#undef BSIZE
 110#undef ITYPE
 111#undef SHIFT
 112
 113/* Signed 32 bit */
 114#define BSIZE 32
 115#define ITYPE int
 116#define IN_MIN INT32_MIN
 117#define IN_MAX INT32_MAX
 118#define SIGNED
 119#define SHIFT 32
 120#define ENDIAN_CONVERSION natural
 121#define ENDIAN_CONVERT(v) (v)
 122#include "mixeng_template.h"
 123#undef ENDIAN_CONVERT
 124#undef ENDIAN_CONVERSION
 125#define ENDIAN_CONVERSION swap
 126#define ENDIAN_CONVERT(v) bswap32 (v)
 127#include "mixeng_template.h"
 128#undef ENDIAN_CONVERT
 129#undef ENDIAN_CONVERSION
 130#undef SIGNED
 131#undef IN_MAX
 132#undef IN_MIN
 133#undef BSIZE
 134#undef ITYPE
 135#undef SHIFT
 136
 137/* Unsigned 32 bit */
 138#define BSIZE 32
 139#define ITYPE uint
 140#define IN_MIN 0
 141#define IN_MAX UINT32_MAX
 142#define SHIFT 32
 143#define ENDIAN_CONVERSION natural
 144#define ENDIAN_CONVERT(v) (v)
 145#include "mixeng_template.h"
 146#undef ENDIAN_CONVERT
 147#undef ENDIAN_CONVERSION
 148#define ENDIAN_CONVERSION swap
 149#define ENDIAN_CONVERT(v) bswap32 (v)
 150#include "mixeng_template.h"
 151#undef ENDIAN_CONVERT
 152#undef ENDIAN_CONVERSION
 153#undef IN_MAX
 154#undef IN_MIN
 155#undef BSIZE
 156#undef ITYPE
 157#undef SHIFT
 158
 159t_sample *mixeng_conv[2][2][2][3] = {
 160    {
 161        {
 162            {
 163                conv_natural_uint8_t_to_mono,
 164                conv_natural_uint16_t_to_mono,
 165                conv_natural_uint32_t_to_mono
 166            },
 167            {
 168                conv_natural_uint8_t_to_mono,
 169                conv_swap_uint16_t_to_mono,
 170                conv_swap_uint32_t_to_mono,
 171            }
 172        },
 173        {
 174            {
 175                conv_natural_int8_t_to_mono,
 176                conv_natural_int16_t_to_mono,
 177                conv_natural_int32_t_to_mono
 178            },
 179            {
 180                conv_natural_int8_t_to_mono,
 181                conv_swap_int16_t_to_mono,
 182                conv_swap_int32_t_to_mono
 183            }
 184        }
 185    },
 186    {
 187        {
 188            {
 189                conv_natural_uint8_t_to_stereo,
 190                conv_natural_uint16_t_to_stereo,
 191                conv_natural_uint32_t_to_stereo
 192            },
 193            {
 194                conv_natural_uint8_t_to_stereo,
 195                conv_swap_uint16_t_to_stereo,
 196                conv_swap_uint32_t_to_stereo
 197            }
 198        },
 199        {
 200            {
 201                conv_natural_int8_t_to_stereo,
 202                conv_natural_int16_t_to_stereo,
 203                conv_natural_int32_t_to_stereo
 204            },
 205            {
 206                conv_natural_int8_t_to_stereo,
 207                conv_swap_int16_t_to_stereo,
 208                conv_swap_int32_t_to_stereo,
 209            }
 210        }
 211    }
 212};
 213
 214f_sample *mixeng_clip[2][2][2][3] = {
 215    {
 216        {
 217            {
 218                clip_natural_uint8_t_from_mono,
 219                clip_natural_uint16_t_from_mono,
 220                clip_natural_uint32_t_from_mono
 221            },
 222            {
 223                clip_natural_uint8_t_from_mono,
 224                clip_swap_uint16_t_from_mono,
 225                clip_swap_uint32_t_from_mono
 226            }
 227        },
 228        {
 229            {
 230                clip_natural_int8_t_from_mono,
 231                clip_natural_int16_t_from_mono,
 232                clip_natural_int32_t_from_mono
 233            },
 234            {
 235                clip_natural_int8_t_from_mono,
 236                clip_swap_int16_t_from_mono,
 237                clip_swap_int32_t_from_mono
 238            }
 239        }
 240    },
 241    {
 242        {
 243            {
 244                clip_natural_uint8_t_from_stereo,
 245                clip_natural_uint16_t_from_stereo,
 246                clip_natural_uint32_t_from_stereo
 247            },
 248            {
 249                clip_natural_uint8_t_from_stereo,
 250                clip_swap_uint16_t_from_stereo,
 251                clip_swap_uint32_t_from_stereo
 252            }
 253        },
 254        {
 255            {
 256                clip_natural_int8_t_from_stereo,
 257                clip_natural_int16_t_from_stereo,
 258                clip_natural_int32_t_from_stereo
 259            },
 260            {
 261                clip_natural_int8_t_from_stereo,
 262                clip_swap_int16_t_from_stereo,
 263                clip_swap_int32_t_from_stereo
 264            }
 265        }
 266    }
 267};
 268
 269/*
 270 * August 21, 1998
 271 * Copyright 1998 Fabrice Bellard.
 272 *
 273 * [Rewrote completely the code of Lance Norskog And Sundry
 274 * Contributors with a more efficient algorithm.]
 275 *
 276 * This source code is freely redistributable and may be used for
 277 * any purpose.  This copyright notice must be maintained.
 278 * Lance Norskog And Sundry Contributors are not responsible for
 279 * the consequences of using this software.
 280 */
 281
 282/*
 283 * Sound Tools rate change effect file.
 284 */
 285/*
 286 * Linear Interpolation.
 287 *
 288 * The use of fractional increment allows us to use no buffer. It
 289 * avoid the problems at the end of the buffer we had with the old
 290 * method which stored a possibly big buffer of size
 291 * lcm(in_rate,out_rate).
 292 *
 293 * Limited to 16 bit samples and sampling frequency <= 65535 Hz. If
 294 * the input & output frequencies are equal, a delay of one sample is
 295 * introduced.  Limited to processing 32-bit count worth of samples.
 296 *
 297 * 1 << FRAC_BITS evaluating to zero in several places.  Changed with
 298 * an (unsigned long) cast to make it safe.  MarkMLl 2/1/99
 299 */
 300
 301/* Private data */
 302struct rate {
 303    uint64_t opos;
 304    uint64_t opos_inc;
 305    uint32_t ipos;              /* position in the input stream (integer) */
 306    struct st_sample ilast;          /* last sample in the input stream */
 307};
 308
 309/*
 310 * Prepare processing.
 311 */
 312void *st_rate_start (int inrate, int outrate)
 313{
 314    struct rate *rate = audio_calloc (AUDIO_FUNC, 1, sizeof (*rate));
 315
 316    if (!rate) {
 317        dolog ("Could not allocate resampler (%zu bytes)\n", sizeof (*rate));
 318        return NULL;
 319    }
 320
 321    rate->opos = 0;
 322
 323    /* increment */
 324    rate->opos_inc = ((uint64_t) inrate << 32) / outrate;
 325
 326    rate->ipos = 0;
 327    rate->ilast.l = 0;
 328    rate->ilast.r = 0;
 329    return rate;
 330}
 331
 332#define NAME st_rate_flow_mix
 333#define OP(a, b) a += b
 334#include "rate_template.h"
 335
 336#define NAME st_rate_flow
 337#define OP(a, b) a = b
 338#include "rate_template.h"
 339
 340void st_rate_stop (void *opaque)
 341{
 342    g_free (opaque);
 343}
 344
 345void mixeng_clear (struct st_sample *buf, int len)
 346{
 347    memset (buf, 0, len * sizeof (struct st_sample));
 348}
 349
 350void mixeng_volume (struct st_sample *buf, int len, struct mixeng_volume *vol)
 351{
 352    if (vol->mute) {
 353        mixeng_clear (buf, len);
 354        return;
 355    }
 356
 357    while (len--) {
 358#ifdef FLOAT_MIXENG
 359        buf->l = buf->l * vol->l;
 360        buf->r = buf->r * vol->r;
 361#else
 362        buf->l = (buf->l * vol->l) >> 32;
 363        buf->r = (buf->r * vol->r) >> 32;
 364#endif
 365        buf += 1;
 366    }
 367}
 368