|
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 |
|
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 |
|
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 |
|
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 (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 |
|
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 |
|
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 |
|
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 |