xref: /openbmc/qemu/audio/mixeng.c (revision 09a274d8)
1 /*
2  * QEMU Mixing engine
3  *
4  * Copyright (c) 2004-2005 Vassili Karpov (malc)
5  * Copyright (c) 1998 Fabrice Bellard
6  *
7  * Permission is hereby granted, free of charge, to any person obtaining a copy
8  * of this software and associated documentation files (the "Software"), to deal
9  * in the Software without restriction, including without limitation the rights
10  * to use, copy, modify, merge, publish, distribute, sublicense, and/or sell
11  * copies of the Software, and to permit persons to whom the Software is
12  * furnished to do so, subject to the following conditions:
13  *
14  * The above copyright notice and this permission notice shall be included in
15  * all copies or substantial portions of the Software.
16  *
17  * THE SOFTWARE IS PROVIDED "AS IS", WITHOUT WARRANTY OF ANY KIND, EXPRESS OR
18  * IMPLIED, INCLUDING BUT NOT LIMITED TO THE WARRANTIES OF MERCHANTABILITY,
19  * FITNESS FOR A PARTICULAR PURPOSE AND NONINFRINGEMENT. IN NO EVENT SHALL
20  * THE AUTHORS OR COPYRIGHT HOLDERS BE LIABLE FOR ANY CLAIM, DAMAGES OR OTHER
21  * LIABILITY, WHETHER IN AN ACTION OF CONTRACT, TORT OR OTHERWISE, ARISING FROM,
22  * OUT OF OR IN CONNECTION WITH THE SOFTWARE OR THE USE OR OTHER DEALINGS IN
23  * THE SOFTWARE.
24  */
25 #include "qemu/osdep.h"
26 #include "qemu-common.h"
27 #include "qemu/bswap.h"
28 #include "qemu/error-report.h"
29 #include "audio.h"
30 
31 #define AUDIO_CAP "mixeng"
32 #include "audio_int.h"
33 
34 /* 8 bit */
35 #define ENDIAN_CONVERSION natural
36 #define ENDIAN_CONVERT(v) (v)
37 
38 /* Signed 8 bit */
39 #define BSIZE 8
40 #define ITYPE int
41 #define IN_MIN SCHAR_MIN
42 #define IN_MAX SCHAR_MAX
43 #define SIGNED
44 #define SHIFT 8
45 #include "mixeng_template.h"
46 #undef SIGNED
47 #undef IN_MAX
48 #undef IN_MIN
49 #undef BSIZE
50 #undef ITYPE
51 #undef SHIFT
52 
53 /* Unsigned 8 bit */
54 #define BSIZE 8
55 #define ITYPE uint
56 #define IN_MIN 0
57 #define IN_MAX UCHAR_MAX
58 #define SHIFT 8
59 #include "mixeng_template.h"
60 #undef IN_MAX
61 #undef IN_MIN
62 #undef BSIZE
63 #undef ITYPE
64 #undef SHIFT
65 
66 #undef ENDIAN_CONVERT
67 #undef ENDIAN_CONVERSION
68 
69 /* Signed 16 bit */
70 #define BSIZE 16
71 #define ITYPE int
72 #define IN_MIN SHRT_MIN
73 #define IN_MAX SHRT_MAX
74 #define SIGNED
75 #define SHIFT 16
76 #define ENDIAN_CONVERSION natural
77 #define ENDIAN_CONVERT(v) (v)
78 #include "mixeng_template.h"
79 #undef ENDIAN_CONVERT
80 #undef ENDIAN_CONVERSION
81 #define ENDIAN_CONVERSION swap
82 #define ENDIAN_CONVERT(v) bswap16 (v)
83 #include "mixeng_template.h"
84 #undef ENDIAN_CONVERT
85 #undef ENDIAN_CONVERSION
86 #undef SIGNED
87 #undef IN_MAX
88 #undef IN_MIN
89 #undef BSIZE
90 #undef ITYPE
91 #undef SHIFT
92 
93 /* Unsigned 16 bit */
94 #define BSIZE 16
95 #define ITYPE uint
96 #define IN_MIN 0
97 #define IN_MAX USHRT_MAX
98 #define SHIFT 16
99 #define ENDIAN_CONVERSION natural
100 #define ENDIAN_CONVERT(v) (v)
101 #include "mixeng_template.h"
102 #undef ENDIAN_CONVERT
103 #undef ENDIAN_CONVERSION
104 #define ENDIAN_CONVERSION swap
105 #define ENDIAN_CONVERT(v) bswap16 (v)
106 #include "mixeng_template.h"
107 #undef ENDIAN_CONVERT
108 #undef ENDIAN_CONVERSION
109 #undef IN_MAX
110 #undef IN_MIN
111 #undef BSIZE
112 #undef ITYPE
113 #undef SHIFT
114 
115 /* Signed 32 bit */
116 #define BSIZE 32
117 #define ITYPE int
118 #define IN_MIN INT32_MIN
119 #define IN_MAX INT32_MAX
120 #define SIGNED
121 #define SHIFT 32
122 #define ENDIAN_CONVERSION natural
123 #define ENDIAN_CONVERT(v) (v)
124 #include "mixeng_template.h"
125 #undef ENDIAN_CONVERT
126 #undef ENDIAN_CONVERSION
127 #define ENDIAN_CONVERSION swap
128 #define ENDIAN_CONVERT(v) bswap32 (v)
129 #include "mixeng_template.h"
130 #undef ENDIAN_CONVERT
131 #undef ENDIAN_CONVERSION
132 #undef SIGNED
133 #undef IN_MAX
134 #undef IN_MIN
135 #undef BSIZE
136 #undef ITYPE
137 #undef SHIFT
138 
139 /* Unsigned 32 bit */
140 #define BSIZE 32
141 #define ITYPE uint
142 #define IN_MIN 0
143 #define IN_MAX UINT32_MAX
144 #define SHIFT 32
145 #define ENDIAN_CONVERSION natural
146 #define ENDIAN_CONVERT(v) (v)
147 #include "mixeng_template.h"
148 #undef ENDIAN_CONVERT
149 #undef ENDIAN_CONVERSION
150 #define ENDIAN_CONVERSION swap
151 #define ENDIAN_CONVERT(v) bswap32 (v)
152 #include "mixeng_template.h"
153 #undef ENDIAN_CONVERT
154 #undef ENDIAN_CONVERSION
155 #undef IN_MAX
156 #undef IN_MIN
157 #undef BSIZE
158 #undef ITYPE
159 #undef SHIFT
160 
161 t_sample *mixeng_conv[2][2][2][3] = {
162     {
163         {
164             {
165                 conv_natural_uint8_t_to_mono,
166                 conv_natural_uint16_t_to_mono,
167                 conv_natural_uint32_t_to_mono
168             },
169             {
170                 conv_natural_uint8_t_to_mono,
171                 conv_swap_uint16_t_to_mono,
172                 conv_swap_uint32_t_to_mono,
173             }
174         },
175         {
176             {
177                 conv_natural_int8_t_to_mono,
178                 conv_natural_int16_t_to_mono,
179                 conv_natural_int32_t_to_mono
180             },
181             {
182                 conv_natural_int8_t_to_mono,
183                 conv_swap_int16_t_to_mono,
184                 conv_swap_int32_t_to_mono
185             }
186         }
187     },
188     {
189         {
190             {
191                 conv_natural_uint8_t_to_stereo,
192                 conv_natural_uint16_t_to_stereo,
193                 conv_natural_uint32_t_to_stereo
194             },
195             {
196                 conv_natural_uint8_t_to_stereo,
197                 conv_swap_uint16_t_to_stereo,
198                 conv_swap_uint32_t_to_stereo
199             }
200         },
201         {
202             {
203                 conv_natural_int8_t_to_stereo,
204                 conv_natural_int16_t_to_stereo,
205                 conv_natural_int32_t_to_stereo
206             },
207             {
208                 conv_natural_int8_t_to_stereo,
209                 conv_swap_int16_t_to_stereo,
210                 conv_swap_int32_t_to_stereo,
211             }
212         }
213     }
214 };
215 
216 f_sample *mixeng_clip[2][2][2][3] = {
217     {
218         {
219             {
220                 clip_natural_uint8_t_from_mono,
221                 clip_natural_uint16_t_from_mono,
222                 clip_natural_uint32_t_from_mono
223             },
224             {
225                 clip_natural_uint8_t_from_mono,
226                 clip_swap_uint16_t_from_mono,
227                 clip_swap_uint32_t_from_mono
228             }
229         },
230         {
231             {
232                 clip_natural_int8_t_from_mono,
233                 clip_natural_int16_t_from_mono,
234                 clip_natural_int32_t_from_mono
235             },
236             {
237                 clip_natural_int8_t_from_mono,
238                 clip_swap_int16_t_from_mono,
239                 clip_swap_int32_t_from_mono
240             }
241         }
242     },
243     {
244         {
245             {
246                 clip_natural_uint8_t_from_stereo,
247                 clip_natural_uint16_t_from_stereo,
248                 clip_natural_uint32_t_from_stereo
249             },
250             {
251                 clip_natural_uint8_t_from_stereo,
252                 clip_swap_uint16_t_from_stereo,
253                 clip_swap_uint32_t_from_stereo
254             }
255         },
256         {
257             {
258                 clip_natural_int8_t_from_stereo,
259                 clip_natural_int16_t_from_stereo,
260                 clip_natural_int32_t_from_stereo
261             },
262             {
263                 clip_natural_int8_t_from_stereo,
264                 clip_swap_int16_t_from_stereo,
265                 clip_swap_int32_t_from_stereo
266             }
267         }
268     }
269 };
270 
271 
272 void audio_sample_to_uint64(void *samples, int pos,
273                             uint64_t *left, uint64_t *right)
274 {
275     struct st_sample *sample = samples;
276     sample += pos;
277 #ifdef FLOAT_MIXENG
278     error_report(
279         "Coreaudio and floating point samples are not supported by replay yet");
280     abort();
281 #else
282     *left = sample->l;
283     *right = sample->r;
284 #endif
285 }
286 
287 void audio_sample_from_uint64(void *samples, int pos,
288                             uint64_t left, uint64_t right)
289 {
290     struct st_sample *sample = samples;
291     sample += pos;
292 #ifdef FLOAT_MIXENG
293     error_report(
294         "Coreaudio and floating point samples are not supported by replay yet");
295     abort();
296 #else
297     sample->l = left;
298     sample->r = right;
299 #endif
300 }
301 
302 /*
303  * August 21, 1998
304  * Copyright 1998 Fabrice Bellard.
305  *
306  * [Rewrote completely the code of Lance Norskog And Sundry
307  * Contributors with a more efficient algorithm.]
308  *
309  * This source code is freely redistributable and may be used for
310  * any purpose.  This copyright notice must be maintained.
311  * Lance Norskog And Sundry Contributors are not responsible for
312  * the consequences of using this software.
313  */
314 
315 /*
316  * Sound Tools rate change effect file.
317  */
318 /*
319  * Linear Interpolation.
320  *
321  * The use of fractional increment allows us to use no buffer. It
322  * avoid the problems at the end of the buffer we had with the old
323  * method which stored a possibly big buffer of size
324  * lcm(in_rate,out_rate).
325  *
326  * Limited to 16 bit samples and sampling frequency <= 65535 Hz. If
327  * the input & output frequencies are equal, a delay of one sample is
328  * introduced.  Limited to processing 32-bit count worth of samples.
329  *
330  * 1 << FRAC_BITS evaluating to zero in several places.  Changed with
331  * an (unsigned long) cast to make it safe.  MarkMLl 2/1/99
332  */
333 
334 /* Private data */
335 struct rate {
336     uint64_t opos;
337     uint64_t opos_inc;
338     uint32_t ipos;              /* position in the input stream (integer) */
339     struct st_sample ilast;          /* last sample in the input stream */
340 };
341 
342 /*
343  * Prepare processing.
344  */
345 void *st_rate_start (int inrate, int outrate)
346 {
347     struct rate *rate = audio_calloc(__func__, 1, sizeof(*rate));
348 
349     if (!rate) {
350         dolog ("Could not allocate resampler (%zu bytes)\n", sizeof (*rate));
351         return NULL;
352     }
353 
354     rate->opos = 0;
355 
356     /* increment */
357     rate->opos_inc = ((uint64_t) inrate << 32) / outrate;
358 
359     rate->ipos = 0;
360     rate->ilast.l = 0;
361     rate->ilast.r = 0;
362     return rate;
363 }
364 
365 #define NAME st_rate_flow_mix
366 #define OP(a, b) a += b
367 #include "rate_template.h"
368 
369 #define NAME st_rate_flow
370 #define OP(a, b) a = b
371 #include "rate_template.h"
372 
373 void st_rate_stop (void *opaque)
374 {
375     g_free (opaque);
376 }
377 
378 void mixeng_clear (struct st_sample *buf, int len)
379 {
380     memset (buf, 0, len * sizeof (struct st_sample));
381 }
382 
383 void mixeng_volume (struct st_sample *buf, int len, struct mixeng_volume *vol)
384 {
385     if (vol->mute) {
386         mixeng_clear (buf, len);
387         return;
388     }
389 
390     while (len--) {
391 #ifdef FLOAT_MIXENG
392         buf->l = buf->l * vol->l;
393         buf->r = buf->r * vol->r;
394 #else
395         buf->l = (buf->l * vol->l) >> 32;
396         buf->r = (buf->r * vol->r) >> 32;
397 #endif
398         buf += 1;
399     }
400 }
401