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 #define ET glue (ENDIAN_CONVERSION, glue (glue (glue (_, ITYPE), BSIZE), _t)) 35 #define IN_T glue (glue (ITYPE, BSIZE), _t) 36 37 #ifdef FLOAT_MIXENG 38 static mixeng_real inline glue (conv_, ET) (IN_T v) 39 { 40 IN_T nv = ENDIAN_CONVERT (v); 41 42 #ifdef RECIPROCAL 43 #ifdef SIGNED 44 return nv * (1.f / (mixeng_real) (IN_MAX - IN_MIN)); 45 #else 46 return (nv - HALF) * (1.f / (mixeng_real) IN_MAX); 47 #endif 48 #else /* !RECIPROCAL */ 49 #ifdef SIGNED 50 return nv / (mixeng_real) ((mixeng_real) IN_MAX - IN_MIN); 51 #else 52 return (nv - HALF) / (mixeng_real) IN_MAX; 53 #endif 54 #endif 55 } 56 57 static IN_T inline glue (clip_, ET) (mixeng_real v) 58 { 59 if (v >= 0.5) { 60 return IN_MAX; 61 } 62 else if (v < -0.5) { 63 return IN_MIN; 64 } 65 66 #ifdef SIGNED 67 return ENDIAN_CONVERT ((IN_T) (v * ((mixeng_real) IN_MAX - IN_MIN))); 68 #else 69 return ENDIAN_CONVERT ((IN_T) ((v * IN_MAX) + HALF)); 70 #endif 71 } 72 73 #else /* !FLOAT_MIXENG */ 74 75 static inline int64_t glue (conv_, ET) (IN_T v) 76 { 77 IN_T nv = ENDIAN_CONVERT (v); 78 #ifdef SIGNED 79 return ((int64_t) nv) << (32 - SHIFT); 80 #else 81 return ((int64_t) nv - HALF) << (32 - SHIFT); 82 #endif 83 } 84 85 static inline IN_T glue (clip_, ET) (int64_t v) 86 { 87 if (v >= 0x7f000000) { 88 return IN_MAX; 89 } 90 else if (v < -2147483648LL) { 91 return IN_MIN; 92 } 93 94 #ifdef SIGNED 95 return ENDIAN_CONVERT ((IN_T) (v >> (32 - SHIFT))); 96 #else 97 return ENDIAN_CONVERT ((IN_T) ((v >> (32 - SHIFT)) + HALF)); 98 #endif 99 } 100 #endif 101 102 static void glue (glue (conv_, ET), _to_stereo) 103 (struct st_sample *dst, const void *src, int samples) 104 { 105 struct st_sample *out = dst; 106 IN_T *in = (IN_T *) src; 107 108 while (samples--) { 109 out->l = glue (conv_, ET) (*in++); 110 out->r = glue (conv_, ET) (*in++); 111 out += 1; 112 } 113 } 114 115 static void glue (glue (conv_, ET), _to_mono) 116 (struct st_sample *dst, const void *src, int samples) 117 { 118 struct st_sample *out = dst; 119 IN_T *in = (IN_T *) src; 120 121 while (samples--) { 122 out->l = glue (conv_, ET) (in[0]); 123 out->r = out->l; 124 out += 1; 125 in += 1; 126 } 127 } 128 129 static void glue (glue (clip_, ET), _from_stereo) 130 (void *dst, const struct st_sample *src, int samples) 131 { 132 const struct st_sample *in = src; 133 IN_T *out = (IN_T *) dst; 134 while (samples--) { 135 *out++ = glue (clip_, ET) (in->l); 136 *out++ = glue (clip_, ET) (in->r); 137 in += 1; 138 } 139 } 140 141 static void glue (glue (clip_, ET), _from_mono) 142 (void *dst, const struct st_sample *src, int samples) 143 { 144 const struct st_sample *in = src; 145 IN_T *out = (IN_T *) dst; 146 while (samples--) { 147 *out++ = glue (clip_, ET) (in->l + in->r); 148 in += 1; 149 } 150 } 151 152 #undef ET 153 #undef HALF 154 #undef IN_T 155