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
 159 t_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
 214 f_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 completly 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 */
 302 struct 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  */
 312 void *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
 340 void st_rate_stop (void *opaque)
 341 {
 342     g_free (opaque);
 343 }
 344
 345 void mixeng_clear (struct st_sample *buf, int len)
 346 {
 347     memset (buf, 0, len * sizeof (struct st_sample));
 348 }
 349
 350 void 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 }