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 CONFIG_MIXEMU 35#ifdef FLOAT_MIXENG 36#define VOL(a, b) ((a) * (b)) 37#else 38#define VOL(a, b) ((a) * (b)) >> 32 39#endif 40#else 41#define VOL(a, b) a 42#endif 43 44#define ET glue (ENDIAN_CONVERSION, glue (_, IN_T)) 45 46#ifdef FLOAT_MIXENG 47static mixeng_real 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 / (mixeng_real) (IN_MAX - IN_MIN)); 54#else 55 return (nv - HALF) * (1.f / (mixeng_real) IN_MAX); 56#endif 57#else /* !RECIPROCAL */ 58#ifdef SIGNED 59 return nv / (mixeng_real) (IN_MAX - IN_MIN); 60#else 61 return (nv - HALF) / (mixeng_real) IN_MAX; 62#endif 63#endif 64} 65 66static IN_T inline glue (clip_, ET) (mixeng_real 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 84static 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 94static 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 111static void glue (glue (conv_, ET), _to_stereo) 112 (struct st_sample *dst, const void *src, int samples, struct mixeng_volume *vol) 113{ 114 struct st_sample *out = dst; 115 IN_T *in = (IN_T *) src; 116#ifdef CONFIG_MIXEMU 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 131static void glue (glue (conv_, ET), _to_mono) 132 (struct st_sample *dst, const void *src, int samples, struct mixeng_volume *vol) 133{ 134 struct st_sample *out = dst; 135 IN_T *in = (IN_T *) src; 136#ifdef CONFIG_MIXEMU 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 152static void glue (glue (clip_, ET), _from_stereo) 153 (void *dst, const struct st_sample *src, int samples) 154{ 155 const struct st_sample *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 164static void glue (glue (clip_, ET), _from_mono) 165 (void *dst, const struct st_sample *src, int samples) 166{ 167 const struct st_sample *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 178