minor xlib fix
[picodrive.git] / pico / sound / mix.c
1 // some code for sample mixing
2 // (c) Copyright 2006-2007, Grazvydas "notaz" Ignotas
3
4 #define MAXOUT          (+32767)
5 #define MINOUT          (-32768)
6
7 /* limitter */
8 #define Limit(val, max,min) { \
9         if ( val > max )      val = max; \
10         else if ( val < min ) val = min; \
11 }
12
13
14 void mix_32_to_16l_stereo(short *dest, int *src, int count)
15 {
16         int l, r;
17
18         for (; count > 0; count--)
19         {
20                 l = r = *dest;
21                 l += *src++;
22                 r += *src++;
23                 Limit( l, MAXOUT, MINOUT );
24                 Limit( r, MAXOUT, MINOUT );
25                 *dest++ = l;
26                 *dest++ = r;
27         }
28 }
29
30
31 void mix_32_to_16_mono(short *dest, int *src, int count)
32 {
33         int l;
34
35         for (; count > 0; count--)
36         {
37                 l = *dest;
38                 l += *src++;
39                 Limit( l, MAXOUT, MINOUT );
40                 *dest++ = l;
41         }
42 }
43
44
45 void mix_16h_to_32(int *dest_buf, short *mp3_buf, int count)
46 {
47         while (count--)
48         {
49                 *dest_buf++ += *mp3_buf++ >> 1;
50         }
51 }
52
53 void mix_16h_to_32_s1(int *dest_buf, short *mp3_buf, int count)
54 {
55         count >>= 1;
56         while (count--)
57         {
58                 *dest_buf++ += *mp3_buf++ >> 1;
59                 *dest_buf++ += *mp3_buf++ >> 1;
60                 mp3_buf += 1*2;
61         }
62 }
63
64 void mix_16h_to_32_s2(int *dest_buf, short *mp3_buf, int count)
65 {
66         count >>= 1;
67         while (count--)
68         {
69                 *dest_buf++ += *mp3_buf++ >> 1;
70                 *dest_buf++ += *mp3_buf++ >> 1;
71                 mp3_buf += 3*2;
72         }
73 }
74