1: /*
    2:  * QEMU Mixing engine
    3:  *
    4:  * Copyright (c) 2004-2005 Vassili Karpov (malc)
    5:  *
    6:  * Permission is hereby granted, free of charge, to any person obtaining a copy
    7:  * of this software and associated documentation files (the "Software"), to deal
    8:  * in the Software without restriction, including without limitation the rights
    9:  * to use, copy, modify, merge, publish, distribute, sublicense, and/or sell
   10:  * copies of the Software, and to permit persons to whom the Software is
   11:  * furnished to do so, subject to the following conditions:
   12:  *
   13:  * The above copyright notice and this permission notice shall be included in
   14:  * all copies or substantial portions of the Software.
   15:  *
   16:  * THE SOFTWARE IS PROVIDED "AS IS", WITHOUT WARRANTY OF ANY KIND, EXPRESS OR
   17:  * IMPLIED, INCLUDING BUT NOT LIMITED TO THE WARRANTIES OF MERCHANTABILITY,
   18:  * FITNESS FOR A PARTICULAR PURPOSE AND NONINFRINGEMENT. IN NO EVENT SHALL
   19:  * THE AUTHORS OR COPYRIGHT HOLDERS BE LIABLE FOR ANY CLAIM, DAMAGES OR OTHER
   20:  * LIABILITY, WHETHER IN AN ACTION OF CONTRACT, TORT OR OTHERWISE, ARISING FROM,
   21:  * OUT OF OR IN CONNECTION WITH THE SOFTWARE OR THE USE OR OTHER DEALINGS IN
   22:  * THE SOFTWARE.
   23:  */
   24: 
   25: /*
   26:  * Tusen tack till Mike Nordell
   27:  * dec++'ified by Dscho
   28:  */
   29: 
   30: #ifndef SIGNED
   31: #define HALF (IN_MAX >> 1)
   32: #endif
   33: 
   34: #ifdef NOVOL
   35: #define VOL(a, b) a
   36: #else
   37: #ifdef FLOAT_MIXENG
   38: #define VOL(a, b) ((a) * (b))
   39: #else
   40: #define VOL(a, b) ((a) * (b)) >> 32
   41: #endif
   42: #endif
   43: 
   44: #define ET glue (ENDIAN_CONVERSION, glue (_, IN_T))
   45: 
   46: #ifdef FLOAT_MIXENG
   47: static real_t inline glue (conv_, ET) (IN_T v)
   48: {
   49:     IN_T nv = ENDIAN_CONVERT (v);
   50: 
   51: #ifdef RECIPROCAL
   52: #ifdef SIGNED
   53:     return nv * (1.f / (real_t) (IN_MAX - IN_MIN));
   54: #else
   55:     return (nv - HALF) * (1.f / (real_t) IN_MAX);
   56: #endif
   57: #else  /* !RECIPROCAL */
   58: #ifdef SIGNED
   59:     return nv / (real_t) (IN_MAX - IN_MIN);
   60: #else
   61:     return (nv - HALF) / (real_t) IN_MAX;
   62: #endif
   63: #endif
   64: }
   65: 
   66: static IN_T inline glue (clip_, ET) (real_t v)
   67: {
   68:     if (v >= 0.5) {
   69:         return IN_MAX;
   70:     }
   71:     else if (v < -0.5) {
   72:         return IN_MIN;
   73:     }
   74: 
   75: #ifdef SIGNED
   76:     return ENDIAN_CONVERT ((IN_T) (v * (IN_MAX - IN_MIN)));
   77: #else
   78:     return ENDIAN_CONVERT ((IN_T) ((v * IN_MAX) + HALF));
   79: #endif
   80: }
   81: 
   82: #else  /* !FLOAT_MIXENG */
   83: 
   84: static inline int64_t glue (conv_, ET) (IN_T v)
   85: {
   86:     IN_T nv = ENDIAN_CONVERT (v);
   87: #ifdef SIGNED
   88:     return ((int64_t) nv) << (32 - SHIFT);
   89: #else
   90:     return ((int64_t) nv - HALF) << (32 - SHIFT);
   91: #endif
   92: }
   93: 
   94: static inline IN_T glue (clip_, ET) (int64_t v)
   95: {
   96:     if (v >= 0x7f000000) {
   97:         return IN_MAX;
   98:     }
   99:     else if (v < -2147483648LL) {
  100:         return IN_MIN;
  101:     }
  102: 
  103: #ifdef SIGNED
  104:     return ENDIAN_CONVERT ((IN_T) (v >> (32 - SHIFT)));
  105: #else
  106:     return ENDIAN_CONVERT ((IN_T) ((v >> (32 - SHIFT)) + HALF));
  107: #endif
  108: }
  109: #endif
  110: 
  111: static void glue (glue (conv_, ET), _to_stereo)
  112:     (st_sample_t *dst, const void *src, int samples, volume_t *vol)
  113: {
  114:     st_sample_t *out = dst;
  115:     IN_T *in = (IN_T *) src;
  116: #ifndef NOVOL
  117:     if (vol->mute) {
  118:         mixeng_clear (dst, samples);
  119:         return;
  120:     }
  121: #else
  122:     (void) vol;
  123: #endif
  124:     while (samples--) {
  125:         out->l = VOL (glue (conv_, ET) (*in++), vol->l);
  126:         out->r = VOL (glue (conv_, ET) (*in++), vol->r);
  127:         out += 1;
  128:     }
  129: }
  130: 
  131: static void glue (glue (conv_, ET), _to_mono)
  132:     (st_sample_t *dst, const void *src, int samples, volume_t *vol)
  133: {
  134:     st_sample_t *out = dst;
  135:     IN_T *in = (IN_T *) src;
  136: #ifndef NOVOL
  137:     if (vol->mute) {
  138:         mixeng_clear (dst, samples);
  139:         return;
  140:     }
  141: #else
  142:     (void) vol;
  143: #endif
  144:     while (samples--) {
  145:         out->l = VOL (glue (conv_, ET) (in[0]), vol->l);
  146:         out->r = out->l;
  147:         out += 1;
  148:         in += 1;
  149:     }
  150: }
  151: 
  152: static void glue (glue (clip_, ET), _from_stereo)
  153:     (void *dst, const st_sample_t *src, int samples)
  154: {
  155:     const st_sample_t *in = src;
  156:     IN_T *out = (IN_T *) dst;
  157:     while (samples--) {
  158:         *out++ = glue (clip_, ET) (in->l);
  159:         *out++ = glue (clip_, ET) (in->r);
  160:         in += 1;
  161:     }
  162: }
  163: 
  164: static void glue (glue (clip_, ET), _from_mono)
  165:     (void *dst, const st_sample_t *src, int samples)
  166: {
  167:     const st_sample_t *in = src;
  168:     IN_T *out = (IN_T *) dst;
  169:     while (samples--) {
  170:         *out++ = glue (clip_, ET) (in->l + in->r);
  171:         in += 1;
  172:     }
  173: }
  174: 
  175: #undef ET
  176: #undef HALF
  177: #undef VOL