cannam@126
|
1 /*
|
cannam@126
|
2 ** Copyright (c) 2002-2016, Erik de Castro Lopo <erikd@mega-nerd.com>
|
cannam@126
|
3 ** All rights reserved.
|
cannam@126
|
4 **
|
cannam@126
|
5 ** This code is released under 2-clause BSD license. Please see the
|
cannam@126
|
6 ** file at : https://github.com/erikd/libsamplerate/blob/master/COPYING
|
cannam@126
|
7 */
|
cannam@126
|
8
|
cannam@126
|
9 #include <stdio.h>
|
cannam@126
|
10 #include <stdlib.h>
|
cannam@126
|
11 #include <math.h>
|
cannam@126
|
12
|
cannam@126
|
13 #include <samplerate.h>
|
cannam@126
|
14
|
cannam@126
|
15 #include "util.h"
|
cannam@126
|
16
|
cannam@126
|
17 #define SHORT_BUFFER_LEN 2048
|
cannam@126
|
18 #define LONG_BUFFER_LEN ((1 << 16) - 20)
|
cannam@126
|
19
|
cannam@126
|
20 static void simple_test (int converter) ;
|
cannam@126
|
21 static void stream_test (int converter, double ratio) ;
|
cannam@126
|
22 static void init_term_test (int converter, double ratio) ;
|
cannam@126
|
23
|
cannam@126
|
24 static int next_block_length (int reset) ;
|
cannam@126
|
25
|
cannam@126
|
26 int
|
cannam@126
|
27 main (void)
|
cannam@126
|
28 { static double src_ratios [] =
|
cannam@126
|
29 { 0.999900, 1.000100, 0.789012, 1.200000, 0.333333, 3.100000,
|
cannam@126
|
30 0.125000, 8.000000, 0.099900, 9.990000, 0.100000, 10.00000
|
cannam@126
|
31 } ;
|
cannam@126
|
32
|
cannam@126
|
33 int k ;
|
cannam@126
|
34
|
cannam@126
|
35 puts ("\n Zero Order Hold interpolator:") ;
|
cannam@126
|
36
|
cannam@126
|
37 for (k = 0 ; k < ARRAY_LEN (src_ratios) ; k++)
|
cannam@126
|
38 init_term_test (SRC_ZERO_ORDER_HOLD, src_ratios [k]) ;
|
cannam@126
|
39 puts ("") ;
|
cannam@126
|
40 for (k = 0 ; k < ARRAY_LEN (src_ratios) ; k++)
|
cannam@126
|
41 stream_test (SRC_ZERO_ORDER_HOLD, src_ratios [k]) ;
|
cannam@126
|
42
|
cannam@126
|
43
|
cannam@126
|
44 puts ("\n Linear interpolator:") ;
|
cannam@126
|
45 for (k = 0 ; k < ARRAY_LEN (src_ratios) ; k++)
|
cannam@126
|
46 init_term_test (SRC_LINEAR, src_ratios [k]) ;
|
cannam@126
|
47 puts ("") ;
|
cannam@126
|
48 for (k = 0 ; k < ARRAY_LEN (src_ratios) ; k++)
|
cannam@126
|
49 stream_test (SRC_LINEAR, src_ratios [k]) ;
|
cannam@126
|
50
|
cannam@126
|
51
|
cannam@126
|
52 puts ("\n Sinc interpolator:") ;
|
cannam@126
|
53 for (k = 0 ; k < ARRAY_LEN (src_ratios) ; k++)
|
cannam@126
|
54 init_term_test (SRC_SINC_FASTEST, src_ratios [k]) ;
|
cannam@126
|
55 puts ("") ;
|
cannam@126
|
56 for (k = 0 ; k < ARRAY_LEN (src_ratios) ; k++)
|
cannam@126
|
57 stream_test (SRC_SINC_FASTEST, src_ratios [k]) ;
|
cannam@126
|
58
|
cannam@126
|
59 puts ("") ;
|
cannam@126
|
60
|
cannam@126
|
61 simple_test (SRC_SINC_FASTEST) ;
|
cannam@126
|
62
|
cannam@126
|
63 return 0 ;
|
cannam@126
|
64 } /* main */
|
cannam@126
|
65
|
cannam@126
|
66 static void
|
cannam@126
|
67 simple_test (int converter)
|
cannam@126
|
68 {
|
cannam@126
|
69 int ilen = 199030, olen = 1000, error ;
|
cannam@126
|
70
|
cannam@126
|
71 {
|
cannam@126
|
72 float in [ilen] ;
|
cannam@126
|
73 float out [olen] ;
|
cannam@126
|
74 double ratio = (1.0 * olen) / ilen ;
|
cannam@126
|
75 SRC_DATA src_data =
|
cannam@126
|
76 { in, out,
|
cannam@126
|
77 ilen, olen,
|
cannam@126
|
78 0, 0, 0,
|
cannam@126
|
79 ratio
|
cannam@126
|
80 } ;
|
cannam@126
|
81
|
cannam@126
|
82 error = src_simple (&src_data, converter, 1) ;
|
cannam@126
|
83 if (error)
|
cannam@126
|
84 { printf ("\n\nLine %d : %s\n\n", __LINE__, src_strerror (error)) ;
|
cannam@126
|
85 exit (1) ;
|
cannam@126
|
86 } ;
|
cannam@126
|
87 } ;
|
cannam@126
|
88
|
cannam@126
|
89 return ;
|
cannam@126
|
90 } /* simple_test */
|
cannam@126
|
91
|
cannam@126
|
92 static void
|
cannam@126
|
93 init_term_test (int converter, double src_ratio)
|
cannam@126
|
94 { static float input [SHORT_BUFFER_LEN], output [SHORT_BUFFER_LEN] ;
|
cannam@126
|
95
|
cannam@126
|
96 SRC_DATA src_data ;
|
cannam@126
|
97
|
cannam@126
|
98 int k, input_len, output_len, error, terminate ;
|
cannam@126
|
99
|
cannam@126
|
100 printf ("\tinit_term_test (SRC ratio = %7.4f) .......... ", src_ratio) ;
|
cannam@126
|
101 fflush (stdout) ;
|
cannam@126
|
102
|
cannam@126
|
103 /* Calculate maximun input and output lengths. */
|
cannam@126
|
104 if (src_ratio >= 1.0)
|
cannam@126
|
105 { output_len = SHORT_BUFFER_LEN ;
|
cannam@126
|
106 input_len = (int) floor (SHORT_BUFFER_LEN / src_ratio) ;
|
cannam@126
|
107 }
|
cannam@126
|
108 else
|
cannam@126
|
109 { input_len = SHORT_BUFFER_LEN ;
|
cannam@126
|
110 output_len = (int) floor (SHORT_BUFFER_LEN * src_ratio) ;
|
cannam@126
|
111 } ;
|
cannam@126
|
112
|
cannam@126
|
113 /* Reduce input_len by 10 so output is longer than necessary. */
|
cannam@126
|
114 input_len -= 10 ;
|
cannam@126
|
115
|
cannam@126
|
116 for (k = 0 ; k < ARRAY_LEN (input) ; k++)
|
cannam@126
|
117 input [k] = 1.0 ;
|
cannam@126
|
118
|
cannam@126
|
119 if (output_len > SHORT_BUFFER_LEN)
|
cannam@126
|
120 { printf ("\n\nLine %d : output_len > SHORT_BUFFER_LEN\n\n", __LINE__) ;
|
cannam@126
|
121 exit (1) ;
|
cannam@126
|
122 } ;
|
cannam@126
|
123
|
cannam@126
|
124 src_data.data_in = input ;
|
cannam@126
|
125 src_data.input_frames = input_len ;
|
cannam@126
|
126
|
cannam@126
|
127 src_data.src_ratio = src_ratio ;
|
cannam@126
|
128
|
cannam@126
|
129 src_data.data_out = output ;
|
cannam@126
|
130 src_data.output_frames = SHORT_BUFFER_LEN ;
|
cannam@126
|
131
|
cannam@126
|
132 if ((error = src_simple (&src_data, converter, 1)))
|
cannam@126
|
133 { printf ("\n\nLine %d : %s\n\n", __LINE__, src_strerror (error)) ;
|
cannam@126
|
134 exit (1) ;
|
cannam@126
|
135 } ;
|
cannam@126
|
136
|
cannam@126
|
137 terminate = (int) ceil ((src_ratio >= 1.0) ? 1 : 1.0 / src_ratio) ;
|
cannam@126
|
138
|
cannam@126
|
139 if (fabs (src_ratio * input_len - src_data.output_frames_gen) > terminate)
|
cannam@126
|
140 { printf ("\n\nLine %d : Bad output frame count.\n\n", __LINE__) ;
|
cannam@126
|
141 printf ("\tterminate : %d\n", terminate) ;
|
cannam@126
|
142 printf ("\tsrc_ratio : %.4f\n", src_ratio) ;
|
cannam@126
|
143 printf ("\tinput_len : %d\n"
|
cannam@126
|
144 "\tinput_len * src_ratio : %f\n", input_len, input_len * src_ratio) ;
|
cannam@126
|
145 printf ("\toutput_frames_gen : %ld\n\n", src_data.output_frames_gen) ;
|
cannam@126
|
146 exit (1) ;
|
cannam@126
|
147 } ;
|
cannam@126
|
148
|
cannam@126
|
149 if (labs (src_data.input_frames_used - input_len) > 1)
|
cannam@126
|
150 { printf ("\n\nLine %d : input_frames_used should be %d, is %ld.\n\n",
|
cannam@126
|
151 __LINE__, input_len, src_data.input_frames_used) ;
|
cannam@126
|
152 printf ("\tsrc_ratio : %.4f\n", src_ratio) ;
|
cannam@126
|
153 printf ("\tinput_len : %d\n\tinput_used : %ld\n\n", input_len, src_data.input_frames_used) ;
|
cannam@126
|
154 exit (1) ;
|
cannam@126
|
155 } ;
|
cannam@126
|
156
|
cannam@126
|
157 if (fabs (output [0]) < 0.1)
|
cannam@126
|
158 { printf ("\n\nLine %d : First output sample is bad.\n\n", __LINE__) ;
|
cannam@126
|
159 printf ("\toutput [0] == %f\n\n", output [0]) ;
|
cannam@126
|
160 exit (1) ;
|
cannam@126
|
161 }
|
cannam@126
|
162
|
cannam@126
|
163 puts ("ok") ;
|
cannam@126
|
164
|
cannam@126
|
165 return ;
|
cannam@126
|
166 } /* init_term_test */
|
cannam@126
|
167
|
cannam@126
|
168 static void
|
cannam@126
|
169 stream_test (int converter, double src_ratio)
|
cannam@126
|
170 { static float input [LONG_BUFFER_LEN], output [LONG_BUFFER_LEN] ;
|
cannam@126
|
171
|
cannam@126
|
172 SRC_STATE *src_state ;
|
cannam@126
|
173 SRC_DATA src_data ;
|
cannam@126
|
174
|
cannam@126
|
175 int input_len, output_len, current_in, current_out ;
|
cannam@126
|
176 int k, error, terminate ;
|
cannam@126
|
177
|
cannam@126
|
178 printf ("\tstream_test (SRC ratio = %7.4f) .......... ", src_ratio) ;
|
cannam@126
|
179 fflush (stdout) ;
|
cannam@126
|
180
|
cannam@126
|
181 /* Erik */
|
cannam@126
|
182 for (k = 0 ; k < LONG_BUFFER_LEN ; k++) input [k] = k * 1.0 ;
|
cannam@126
|
183
|
cannam@126
|
184 /* Calculate maximun input and output lengths. */
|
cannam@126
|
185 if (src_ratio >= 1.0)
|
cannam@126
|
186 { output_len = LONG_BUFFER_LEN ;
|
cannam@126
|
187 input_len = (int) floor (LONG_BUFFER_LEN / src_ratio) ;
|
cannam@126
|
188 }
|
cannam@126
|
189 else
|
cannam@126
|
190 { input_len = LONG_BUFFER_LEN ;
|
cannam@126
|
191 output_len = (int) floor (LONG_BUFFER_LEN * src_ratio) ;
|
cannam@126
|
192 } ;
|
cannam@126
|
193
|
cannam@126
|
194 /* Reduce input_len by 10 so output is longer than necessary. */
|
cannam@126
|
195 input_len -= 20 ;
|
cannam@126
|
196
|
cannam@126
|
197 if (output_len > LONG_BUFFER_LEN)
|
cannam@126
|
198 { printf ("\n\nLine %d : output_len > LONG_BUFFER_LEN\n\n", __LINE__) ;
|
cannam@126
|
199 exit (1) ;
|
cannam@126
|
200 } ;
|
cannam@126
|
201
|
cannam@126
|
202 current_in = current_out = 0 ;
|
cannam@126
|
203
|
cannam@126
|
204 /* Perform sample rate conversion. */
|
cannam@126
|
205 if ((src_state = src_new (converter, 1, &error)) == NULL)
|
cannam@126
|
206 { printf ("\n\nLine %d : src_new() failed : %s\n\n", __LINE__, src_strerror (error)) ;
|
cannam@126
|
207 exit (1) ;
|
cannam@126
|
208 } ;
|
cannam@126
|
209
|
cannam@126
|
210 src_data.end_of_input = 0 ; /* Set this later. */
|
cannam@126
|
211
|
cannam@126
|
212 src_data.data_in = input ;
|
cannam@126
|
213
|
cannam@126
|
214 src_data.src_ratio = src_ratio ;
|
cannam@126
|
215
|
cannam@126
|
216 src_data.data_out = output ;
|
cannam@126
|
217 src_data.output_frames = ARRAY_LEN (output) / 10 ;
|
cannam@126
|
218
|
cannam@126
|
219 terminate = 1 + (int) ceil ((src_ratio >= 1.0) ? src_ratio : 1.0 / src_ratio) ;
|
cannam@126
|
220
|
cannam@126
|
221 while (1)
|
cannam@126
|
222 {
|
cannam@126
|
223 src_data.input_frames = next_block_length (0) ;
|
cannam@126
|
224 src_data.input_frames = MIN (src_data.input_frames, input_len - current_in) ;
|
cannam@126
|
225
|
cannam@126
|
226 src_data.output_frames = ARRAY_LEN (output) - current_out ;
|
cannam@126
|
227 /*-Erik MIN (src_data.output_frames, output_len - current_out) ;-*/
|
cannam@126
|
228
|
cannam@126
|
229 src_data.end_of_input = (current_in >= input_len) ? 1 : 0 ;
|
cannam@126
|
230
|
cannam@126
|
231 if ((error = src_process (src_state, &src_data)))
|
cannam@126
|
232 { printf ("\n\nLine %d : %s\n\n", __LINE__, src_strerror (error)) ;
|
cannam@126
|
233 printf (" src_data.input_frames : %ld\n", src_data.input_frames) ;
|
cannam@126
|
234 printf (" src_data.output_frames : %ld\n\n", src_data.output_frames) ;
|
cannam@126
|
235 exit (1) ;
|
cannam@126
|
236 } ;
|
cannam@126
|
237
|
cannam@126
|
238 if (src_data.end_of_input && src_data.output_frames_gen == 0)
|
cannam@126
|
239 break ;
|
cannam@126
|
240
|
cannam@126
|
241 if (src_data.input_frames_used > src_data.input_frames)
|
cannam@126
|
242 { printf ("\n\nLine %d : input_frames_used > input_frames\n\n", __LINE__) ;
|
cannam@126
|
243 printf (" src_data.input_frames : %ld\n", src_data.input_frames) ;
|
cannam@126
|
244 printf (" src_data.input_frames_used : %ld\n", src_data.input_frames_used) ;
|
cannam@126
|
245 printf (" src_data.output_frames : %ld\n", src_data.output_frames) ;
|
cannam@126
|
246 printf (" src_data.output_frames_gen : %ld\n\n", src_data.output_frames_gen) ;
|
cannam@126
|
247 exit (1) ;
|
cannam@126
|
248 } ;
|
cannam@126
|
249
|
cannam@126
|
250 if (src_data.input_frames_used < 0)
|
cannam@126
|
251 { printf ("\n\nLine %d : input_frames_used (%ld) < 0\n\n", __LINE__, src_data.input_frames_used) ;
|
cannam@126
|
252 exit (1) ;
|
cannam@126
|
253 } ;
|
cannam@126
|
254
|
cannam@126
|
255 if (src_data.output_frames_gen < 0)
|
cannam@126
|
256 { printf ("\n\nLine %d : output_frames_gen (%ld) < 0\n\n", __LINE__, src_data.output_frames_gen) ;
|
cannam@126
|
257 exit (1) ;
|
cannam@126
|
258 } ;
|
cannam@126
|
259
|
cannam@126
|
260 current_in += src_data.input_frames_used ;
|
cannam@126
|
261 current_out += src_data.output_frames_gen ;
|
cannam@126
|
262
|
cannam@126
|
263 if (current_in > input_len + terminate)
|
cannam@126
|
264 { printf ("\n\nLine %d : current_in (%d) > input_len (%d + %d)\n\n", __LINE__, current_in, input_len, terminate) ;
|
cannam@126
|
265 exit (1) ;
|
cannam@126
|
266 } ;
|
cannam@126
|
267
|
cannam@126
|
268 if (current_out > output_len)
|
cannam@126
|
269 { printf ("\n\nLine %d : current_out (%d) > output_len (%d)\n\n", __LINE__, current_out, output_len) ;
|
cannam@126
|
270 exit (1) ;
|
cannam@126
|
271 } ;
|
cannam@126
|
272
|
cannam@126
|
273 if (src_data.input_frames_used > input_len)
|
cannam@126
|
274 { printf ("\n\nLine %d : input_frames_used (%ld) > %d\n\n", __LINE__, src_data.input_frames_used, input_len) ;
|
cannam@126
|
275 exit (1) ;
|
cannam@126
|
276 } ;
|
cannam@126
|
277
|
cannam@126
|
278 if (src_data.output_frames_gen > output_len)
|
cannam@126
|
279 { printf ("\n\nLine %d : output_frames_gen (%ld) > %d\n\n", __LINE__, src_data.output_frames_gen, output_len) ;
|
cannam@126
|
280 exit (1) ;
|
cannam@126
|
281 } ;
|
cannam@126
|
282
|
cannam@126
|
283 if (src_data.data_in == NULL && src_data.output_frames_gen == 0)
|
cannam@126
|
284 break ;
|
cannam@126
|
285
|
cannam@126
|
286
|
cannam@126
|
287 src_data.data_in += src_data.input_frames_used ;
|
cannam@126
|
288 src_data.data_out += src_data.output_frames_gen ;
|
cannam@126
|
289 } ;
|
cannam@126
|
290
|
cannam@126
|
291 src_state = src_delete (src_state) ;
|
cannam@126
|
292
|
cannam@126
|
293 if (fabs (current_out - src_ratio * input_len) > terminate)
|
cannam@126
|
294 { printf ("\n\nLine %d : bad output data length %d should be %2.1f +/- %d.\n", __LINE__,
|
cannam@126
|
295 current_out, src_ratio * input_len, terminate) ;
|
cannam@126
|
296 printf ("\tsrc_ratio : %.4f\n", src_ratio) ;
|
cannam@126
|
297 printf ("\tinput_len : %d\n\tinput_used : %d\n", input_len, current_in) ;
|
cannam@126
|
298 printf ("\toutput_len : %d\n\toutput_gen : %d\n\n", output_len, current_out) ;
|
cannam@126
|
299 exit (1) ;
|
cannam@126
|
300 } ;
|
cannam@126
|
301
|
cannam@126
|
302 if (current_in != input_len)
|
cannam@126
|
303 { printf ("\n\nLine %d : unused input.\n", __LINE__) ;
|
cannam@126
|
304 printf ("\tinput_len : %d\n", input_len) ;
|
cannam@126
|
305 printf ("\tinput_frames_used : %d\n\n", current_in) ;
|
cannam@126
|
306 exit (1) ;
|
cannam@126
|
307 } ;
|
cannam@126
|
308
|
cannam@126
|
309 puts ("ok") ;
|
cannam@126
|
310
|
cannam@126
|
311 return ;
|
cannam@126
|
312 } /* stream_test */
|
cannam@126
|
313
|
cannam@126
|
314 static int
|
cannam@126
|
315 next_block_length (int reset)
|
cannam@126
|
316 { static int block_lengths [] = /* Should be an odd length. */
|
cannam@126
|
317 { /*-2, 500, 5, 400, 10, 300, 20, 200, 50, 100, 70 -*/
|
cannam@126
|
318 5, 400, 10, 300, 20, 200, 50, 100, 70
|
cannam@126
|
319 } ;
|
cannam@126
|
320 static int block_len_index = 0 ;
|
cannam@126
|
321
|
cannam@126
|
322 if (reset)
|
cannam@126
|
323 block_len_index = 0 ;
|
cannam@126
|
324 else
|
cannam@126
|
325 block_len_index = (block_len_index + 1) % ARRAY_LEN (block_lengths) ;
|
cannam@126
|
326
|
cannam@126
|
327 return block_lengths [block_len_index] ;
|
cannam@126
|
328 } /* next_block_length */
|
cannam@126
|
329
|