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