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
47static 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
66static 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
84static 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
94static 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
111static 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
131static 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
152static 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
164static 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