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
glue(conv_,ET)47 static 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
glue(clip_,ET)66 static 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
glue(conv_,ET)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
glue(clip_,ET)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
glue(glue (conv_,ET),_to_stereo)111 static 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
glue(glue (conv_,ET),_to_mono)131 static 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
glue(glue (clip_,ET),_from_stereo)152 static 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
glue(glue (clip_,ET),_from_mono)164 static 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