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 NOVOL
|
---|
35 | #define VOL(a, b) a
|
---|
36 | #else
|
---|
37 | #ifdef FLOAT_MIXENG
|
---|
38 | #define VOL(a, b) ((a) * (b))
|
---|
39 | #else
|
---|
40 | #define VOL(a, b) ((a) * (b)) >> 32
|
---|
41 | #endif
|
---|
42 | #endif
|
---|
43 |
|
---|
44 | #define ET glue (ENDIAN_CONVERSION, glue (_, IN_T))
|
---|
45 |
|
---|
46 | #ifdef FLOAT_MIXENG
|
---|
47 | static real_t 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 / (real_t) (IN_MAX - IN_MIN));
|
---|
54 | #else
|
---|
55 | return (nv - HALF) * (1.f / (real_t) IN_MAX);
|
---|
56 | #endif
|
---|
57 | #else /* !RECIPROCAL */
|
---|
58 | #ifdef SIGNED
|
---|
59 | return nv / (real_t) (IN_MAX - IN_MIN);
|
---|
60 | #else
|
---|
61 | return (nv - HALF) / (real_t) IN_MAX;
|
---|
62 | #endif
|
---|
63 | #endif
|
---|
64 | }
|
---|
65 |
|
---|
66 | static IN_T inline glue (clip_, ET) (real_t 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 | (st_sample_t *dst, const void *src, int samples, volume_t *vol)
|
---|
113 | {
|
---|
114 | st_sample_t *out = dst;
|
---|
115 | IN_T *in = (IN_T *) src;
|
---|
116 | #ifndef NOVOL
|
---|
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 | (st_sample_t *dst, const void *src, int samples, volume_t *vol)
|
---|
133 | {
|
---|
134 | st_sample_t *out = dst;
|
---|
135 | IN_T *in = (IN_T *) src;
|
---|
136 | #ifndef NOVOL
|
---|
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 st_sample_t *src, int samples)
|
---|
154 | {
|
---|
155 | const st_sample_t *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 st_sample_t *src, int samples)
|
---|
166 | {
|
---|
167 | const st_sample_t *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
|
---|