362
|
1 /*
|
|
2 Extended Audio Converter for SDL (Simple DirectMedia Layer)
|
|
3 Copyright (C) 2002 Frank Ranostaj
|
|
4 Institute of Applied Physik
|
|
5 Johann Wolfgang Goethe-Universität
|
|
6 Frankfurt am Main, Germany
|
338
|
7
|
362
|
8 This library is free software; you can redistribute it and/or
|
|
9 modify it under the terms of the GNU Library General Public
|
|
10 License as published by the Free Software Foundation; either
|
|
11 version 2 of the License, or (at your option) any later version.
|
338
|
12
|
362
|
13 This library is distributed in the hope that it will be useful,
|
|
14 but WITHOUT ANY WARRANTY; without even the implied warranty of
|
|
15 MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE. See the GNU
|
|
16 Library General Public License for more details.
|
338
|
17
|
362
|
18 You should have received a copy of the GNU Library General Public
|
|
19 License along with this library; if not, write to the Free
|
|
20 Foundation, Inc., 59 Temple Place, Suite 330, Boston, MA 02111-1307 USA
|
338
|
21
|
362
|
22 Frank Ranostaj
|
|
23 ranostaj@stud.uni-frankfurt.de
|
338
|
24 */
|
|
25
|
362
|
26 #ifndef Suffix
|
|
27 #error include filter_template.h with defined Suffix macro!
|
|
28 #else
|
|
29 #define CH(x) (Suffix((x)*))
|
|
30 //---------------------------------------------------------------------------
|
338
|
31 int Suffix(_doubleRate)( short *buffer, int mode, int length )
|
|
32 {
|
362
|
33 const fsize = _fsize/2;
|
|
34 int i,di,border;
|
|
35 short inbuffer[_fsize];
|
338
|
36
|
362
|
37 if( mode & SDL_AI_Loop )
|
|
38 {
|
|
39 for( i = 0; i < fsize; i++ )
|
|
40 {
|
|
41 inbuffer[CH(i+fsize)] = buffer[CH(length+i)] = buffer[CH(i)];
|
|
42 inbuffer[CH(i)] = buffer[CH(length-fsize+i)];
|
|
43 }
|
|
44 border = 0;
|
|
45 }
|
|
46 else
|
|
47 {
|
|
48 for( i = 0; i < fsize; i++ )
|
|
49 {
|
|
50 inbuffer[CH(i)] = buffer[CH(length+i)] = 0;
|
|
51 inbuffer[CH(i+fsize)] = buffer[CH(i)];
|
|
52 }
|
|
53 border = fsize/2;
|
|
54 }
|
338
|
55
|
362
|
56 for(i = length + border - 1; i >= -border; i--)
|
|
57 {
|
|
58 const short* const inp = i < fsize/2 ?
|
|
59 &inbuffer[CH(i+fsize)] : &buffer[CH(i)];
|
|
60 short* const outp = &buffer[CH(2*(i+border))];
|
|
61 int out = 0;
|
338
|
62
|
362
|
63 for( di = 1; di < 1+fsize; di+=2 )
|
|
64 out+= filter[di]*( inp[CH(di)/2] + inp[CH(1-di)/2] );
|
|
65 outp[CH(1)] = ( 32770*inp[CH(1)] + out) >> 16;
|
|
66 outp[CH(0)] = ( 32770*inp[CH(0)] + out) >> 16;
|
|
67 }
|
|
68 return 2*length + 4*border;
|
338
|
69 }
|
|
70
|
|
71 //---------------------------------------------------------------------------
|
|
72 short Suffix(filterHalfBand)( short* inp )
|
|
73 {
|
362
|
74 static const int fsize = _fsize;
|
|
75 int out = 32770*inp[0];
|
|
76 int di;
|
|
77 for( di = 1; di < fsize/2; di+=2 )
|
|
78 out+= filter[di]*( inp[CH(di)] + inp[CH(-di)] );
|
|
79 return out >> 16;
|
338
|
80 }
|
|
81
|
|
82 int Suffix(_halfRate)( short *buffer, int mode, int length )
|
|
83 {
|
362
|
84 static const int fsize = _fsize;
|
338
|
85
|
362
|
86 int i,border;
|
338
|
87
|
362
|
88 short inbuffer[3*_fsize];
|
|
89 short *finp, *linp;
|
338
|
90
|
362
|
91 if( mode & SDL_AI_Loop )
|
|
92 {
|
|
93 if( length & 1 )
|
|
94 {
|
|
95 // do something meaningful
|
|
96 }
|
|
97 for( i = 0; i < fsize; i++ )
|
|
98 {
|
|
99 inbuffer[CH(i)] = buffer[CH(length-fsize+i)];
|
|
100 inbuffer[CH(i+fsize)] = buffer[CH(i)];
|
|
101 }
|
|
102 border = 0;
|
|
103 finp = inbuffer + CH( fsize );
|
|
104 linp = inbuffer + CH( fsize-length );
|
|
105 }
|
|
106 else
|
|
107 {
|
|
108 for( i = 0; i < fsize; i++ )
|
|
109 {
|
|
110 inbuffer[CH(i)] = buffer[CH(length-fsize+i)];
|
|
111 inbuffer[CH(i+fsize)] = 0;
|
|
112 inbuffer[CH(i+2*fsize)] = buffer[CH(i)];
|
|
113 }
|
|
114 border = fsize;
|
|
115 finp = inbuffer + CH( (3*fsize)/2 + 2*border );
|
|
116 linp = inbuffer + CH( fsize/2 - length );
|
|
117 }
|
338
|
118
|
362
|
119 length = ( length + 1 ) / 2;
|
338
|
120
|
362
|
121 for(i = -border; i < fsize; i++)
|
|
122 {
|
|
123 buffer[CH(i+border)] = Suffix(filterHalfBand)( finp+CH(2*i) );
|
|
124 }
|
|
125 for(; i < length-fsize; i++)
|
|
126 {
|
|
127 buffer[CH(i+border)] = Suffix(filterHalfBand)( buffer+CH(2*i) );
|
|
128 }
|
|
129 for(; i < length+border; i++)
|
|
130 {
|
|
131 buffer[CH(i+border)] = Suffix(filterHalfBand)( linp+CH(2*i) );
|
|
132 }
|
|
133 return length + 2*border;
|
338
|
134 }
|
|
135
|
|
136 //---------------------------------------------------------------------------
|
|
137 short Suffix(filterVarBand)( VarFilter* filt, short** inpp, char* cpos )
|
|
138 {
|
362
|
139 int di;
|
|
140 int out = 0;
|
|
141 short *inp = *inpp;
|
|
142 int pos = *cpos;
|
|
143 short *filter = filt->c[pos];
|
338
|
144
|
362
|
145 for( di = 0; di < 2*_fsize; di++ )
|
|
146 out+= filter[di] * (int)inp[CH(di)];
|
338
|
147
|
362
|
148 *inpp += CH(filt->incr[pos]);
|
|
149 *cpos = ( pos + 1 ) % filt->pos_mod;
|
|
150 return out >> 16;
|
338
|
151 }
|
|
152
|
362
|
153 int Suffix(_varRateDown)( short* buffer, int mode, VarFilter* filter, int length )
|
338
|
154 {
|
362
|
155 static const int fsize = _fsize;
|
|
156 int i,border;
|
|
157 short inbuffer[CH(3*_fsize)];
|
|
158 short *finp, *linp, *bufp, *outbuf;
|
|
159 char pos = 0;
|
|
160 VarFilter* filterp = filter;
|
|
161
|
|
162 if( mode & SDL_AI_Loop )
|
|
163 {
|
|
164 for( i = 0; i < fsize; i++ )
|
|
165 {
|
|
166 inbuffer[CH(i)] = buffer[CH(length-fsize+i)];
|
|
167 inbuffer[CH(i+fsize)] = buffer[CH(i)];
|
|
168 }
|
|
169 border = 0;
|
|
170 finp = inbuffer+CH(fsize);
|
|
171 linp = inbuffer+CH(fsize-length);
|
|
172 }
|
|
173 else
|
|
174 {
|
|
175 for( i = 0; i < fsize; i++ )
|
|
176 {
|
|
177 inbuffer[CH(i)] = buffer[CH(length-fsize+i)];
|
|
178 inbuffer[CH(i+fsize)] = 0;
|
|
179 inbuffer[CH(i+2*fsize)] = buffer[CH(i)];
|
|
180 }
|
|
181 border = fsize;
|
|
182 finp = inbuffer + CH( 3*fsize/2 );
|
|
183 linp = inbuffer + CH( fsize/2 );
|
|
184 }
|
|
185
|
|
186 length = ( length + 1 ) / 2;
|
|
187 bufp = buffer;
|
|
188 outbuf = buffer+CH(border);
|
338
|
189
|
362
|
190 for(i = -border; i < fsize; i++)
|
|
191 {
|
|
192 outbuf[CH(i)] = Suffix(filterVarBand)( filterp, &finp, &pos );
|
|
193 }
|
|
194 for(; i < length-fsize; i++)
|
|
195 {
|
|
196 outbuf[CH(i)] = Suffix(filterVarBand)( filterp, &bufp, &pos );
|
|
197 }
|
|
198 for(; i < length+border; i++)
|
|
199 {
|
|
200 outbuf[CH(i)] = Suffix(filterVarBand)( filterp, &linp, &pos );
|
|
201 }
|
|
202 return length + 2*border;
|
|
203 }
|
|
204
|
|
205 int Suffix(_varRateUp)( short* buffer, int mode, VarFilter* filter, int length )
|
|
206 {
|
|
207 static const int fsize = _fsize;
|
|
208 int i,border;
|
|
209 short inbuffer[CH(3*_fsize)];
|
|
210 short *finp, *linp, *bufp, *outbuf;
|
|
211 char pos = 0;
|
|
212 VarFilter* filterp = filter;
|
338
|
213
|
362
|
214 if( mode & SDL_AI_Loop )
|
|
215 {
|
|
216 for( i = 0; i < fsize; i++ )
|
|
217 {
|
|
218 inbuffer[CH(i)] = buffer[CH(length-fsize+i)];
|
|
219 inbuffer[CH(i+fsize)] = buffer[CH(i)];
|
|
220 }
|
|
221 border = 0;
|
|
222 finp = inbuffer+CH(fsize);
|
|
223 linp = inbuffer+CH(fsize-length);
|
|
224 }
|
|
225 else
|
|
226 {
|
|
227 for( i = 0; i < fsize; i++ )
|
|
228 {
|
|
229 inbuffer[CH(i)] = buffer[CH(length-fsize+i)];
|
|
230 inbuffer[CH(i+fsize)] = 0;
|
|
231 inbuffer[CH(i+2*fsize)] = buffer[CH(i)];
|
|
232 }
|
|
233 border = fsize;
|
|
234 finp = inbuffer + CH( 3*fsize/2 );
|
|
235 linp = inbuffer + CH( fsize/2 );
|
|
236 }
|
338
|
237
|
362
|
238 length = 2 * length;
|
|
239 bufp = buffer+length;
|
|
240 outbuf = buffer+CH(border);
|
|
241
|
|
242 for(i = length+border-1; i > length-fsize-1; i--)
|
|
243 {
|
|
244 outbuf[CH(i)] = Suffix(filterVarBand)( filterp, &linp, &pos );
|
|
245 }
|
|
246 for(; i > fsize-1 ; i--)
|
|
247 {
|
|
248 outbuf[CH(i)] = Suffix(filterVarBand)( filterp, &bufp, &pos );
|
|
249 }
|
|
250 for(; i > -border-1; i--)
|
|
251 {
|
|
252 outbuf[CH(i)] = Suffix(filterVarBand)( filterp, &finp, &pos );
|
|
253 }
|
|
254 return length + 2*border;
|
338
|
255 }
|
|
256 //---------------------------------------------------------------------------
|
|
257 #undef CH
|
|
258 #endif /* Suffix */
|
362
|
259
|