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