| /* |
| ** Copyright (C) 2002-2011 Erik de Castro Lopo <erikd@mega-nerd.com> |
| ** |
| ** This program is free software; you can redistribute it and/or modify |
| ** it under the terms of the GNU General Public License as published by |
| ** the Free Software Foundation; either version 2 of the License, or |
| ** (at your option) any later version. |
| ** |
| ** This program is distributed in the hope that it will be useful, |
| ** but WITHOUT ANY WARRANTY; without even the implied warranty of |
| ** MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE. See the |
| ** GNU General Public License for more details. |
| ** |
| ** You should have received a copy of the GNU General Public License |
| ** along with this program; if not, write to the Free Software |
| ** Foundation, Inc., 59 Temple Place, Suite 330, Boston, MA 02111-1307, USA. |
| */ |
| |
| #include <stdio.h> |
| #include <stdlib.h> |
| #include <math.h> |
| |
| #include <samplerate.h> |
| |
| #include "util.h" |
| |
| #define SHORT_BUFFER_LEN 2048 |
| #define LONG_BUFFER_LEN ((1 << 16) - 20) |
| |
| static void simple_test (int converter) ; |
| static void stream_test (int converter, double ratio) ; |
| static void init_term_test (int converter, double ratio) ; |
| |
| static int next_block_length (int reset) ; |
| |
| int |
| main (void) |
| { static double src_ratios [] = |
| { 0.999900, 1.000100, 0.789012, 1.200000, 0.333333, 3.100000, |
| 0.125000, 8.000000, 0.099900, 9.990000, 0.100000, 10.00000 |
| } ; |
| |
| int k ; |
| |
| puts ("\n Zero Order Hold interpolator:") ; |
| |
| for (k = 0 ; k < ARRAY_LEN (src_ratios) ; k++) |
| init_term_test (SRC_ZERO_ORDER_HOLD, src_ratios [k]) ; |
| puts ("") ; |
| for (k = 0 ; k < ARRAY_LEN (src_ratios) ; k++) |
| stream_test (SRC_ZERO_ORDER_HOLD, src_ratios [k]) ; |
| |
| |
| puts ("\n Linear interpolator:") ; |
| for (k = 0 ; k < ARRAY_LEN (src_ratios) ; k++) |
| init_term_test (SRC_LINEAR, src_ratios [k]) ; |
| puts ("") ; |
| for (k = 0 ; k < ARRAY_LEN (src_ratios) ; k++) |
| stream_test (SRC_LINEAR, src_ratios [k]) ; |
| |
| |
| puts ("\n Sinc interpolator:") ; |
| for (k = 0 ; k < ARRAY_LEN (src_ratios) ; k++) |
| init_term_test (SRC_SINC_FASTEST, src_ratios [k]) ; |
| puts ("") ; |
| for (k = 0 ; k < ARRAY_LEN (src_ratios) ; k++) |
| stream_test (SRC_SINC_FASTEST, src_ratios [k]) ; |
| |
| puts ("") ; |
| |
| simple_test (SRC_SINC_FASTEST) ; |
| |
| return 0 ; |
| } /* main */ |
| |
| static void |
| simple_test (int converter) |
| { |
| int ilen = 199030, olen = 1000, error ; |
| |
| { |
| float in [ilen] ; |
| float out [olen] ; |
| double ratio = (1.0 * olen) / ilen ; |
| SRC_DATA src_data = |
| { in, out, |
| ilen, olen, |
| 0, 0, 0, |
| ratio |
| } ; |
| |
| error = src_simple (&src_data, converter, 1) ; |
| if (error) |
| { printf ("\n\nLine %d : %s\n\n", __LINE__, src_strerror (error)) ; |
| exit (1) ; |
| } ; |
| } ; |
| |
| return ; |
| } /* simple_test */ |
| |
| static void |
| init_term_test (int converter, double src_ratio) |
| { static float input [SHORT_BUFFER_LEN], output [SHORT_BUFFER_LEN] ; |
| |
| SRC_DATA src_data ; |
| |
| int k, input_len, output_len, error, terminate ; |
| |
| printf ("\tinit_term_test (SRC ratio = %7.4f) .......... ", src_ratio) ; |
| fflush (stdout) ; |
| |
| /* Calculate maximun input and output lengths. */ |
| if (src_ratio >= 1.0) |
| { output_len = SHORT_BUFFER_LEN ; |
| input_len = (int) floor (SHORT_BUFFER_LEN / src_ratio) ; |
| } |
| else |
| { input_len = SHORT_BUFFER_LEN ; |
| output_len = (int) floor (SHORT_BUFFER_LEN * src_ratio) ; |
| } ; |
| |
| /* Reduce input_len by 10 so output is longer than necessary. */ |
| input_len -= 10 ; |
| |
| for (k = 0 ; k < ARRAY_LEN (input) ; k++) |
| input [k] = 1.0 ; |
| |
| if (output_len > SHORT_BUFFER_LEN) |
| { printf ("\n\nLine %d : output_len > SHORT_BUFFER_LEN\n\n", __LINE__) ; |
| exit (1) ; |
| } ; |
| |
| src_data.data_in = input ; |
| src_data.input_frames = input_len ; |
| |
| src_data.src_ratio = src_ratio ; |
| |
| src_data.data_out = output ; |
| src_data.output_frames = SHORT_BUFFER_LEN ; |
| |
| if ((error = src_simple (&src_data, converter, 1))) |
| { printf ("\n\nLine %d : %s\n\n", __LINE__, src_strerror (error)) ; |
| exit (1) ; |
| } ; |
| |
| terminate = (int) ceil ((src_ratio >= 1.0) ? 1 : 1.0 / src_ratio) ; |
| |
| if (fabs (src_ratio * input_len - src_data.output_frames_gen) > terminate) |
| { printf ("\n\nLine %d : Bad output frame count.\n\n", __LINE__) ; |
| printf ("\tterminate : %d\n", terminate) ; |
| printf ("\tsrc_ratio : %.4f\n", src_ratio) ; |
| printf ("\tinput_len : %d\n" |
| "\tinput_len * src_ratio : %f\n", input_len, input_len * src_ratio) ; |
| printf ("\toutput_frames_gen : %ld\n\n", src_data.output_frames_gen) ; |
| exit (1) ; |
| } ; |
| |
| if (abs (src_data.input_frames_used - input_len) > 1) |
| { printf ("\n\nLine %d : input_frames_used should be %d, is %ld.\n\n", |
| __LINE__, input_len, src_data.input_frames_used) ; |
| printf ("\tsrc_ratio : %.4f\n", src_ratio) ; |
| printf ("\tinput_len : %d\n\tinput_used : %ld\n\n", input_len, src_data.input_frames_used) ; |
| exit (1) ; |
| } ; |
| |
| if (fabs (output [0]) < 0.1) |
| { printf ("\n\nLine %d : First output sample is bad.\n\n", __LINE__) ; |
| printf ("\toutput [0] == %f\n\n", output [0]) ; |
| exit (1) ; |
| } |
| |
| puts ("ok") ; |
| |
| return ; |
| } /* init_term_test */ |
| |
| static void |
| stream_test (int converter, double src_ratio) |
| { static float input [LONG_BUFFER_LEN], output [LONG_BUFFER_LEN] ; |
| |
| SRC_STATE *src_state ; |
| SRC_DATA src_data ; |
| |
| int input_len, output_len, current_in, current_out ; |
| int k, error, terminate ; |
| |
| printf ("\tstream_test (SRC ratio = %7.4f) .......... ", src_ratio) ; |
| fflush (stdout) ; |
| |
| /* Erik */ |
| for (k = 0 ; k < LONG_BUFFER_LEN ; k++) input [k] = k * 1.0 ; |
| |
| /* Calculate maximun input and output lengths. */ |
| if (src_ratio >= 1.0) |
| { output_len = LONG_BUFFER_LEN ; |
| input_len = (int) floor (LONG_BUFFER_LEN / src_ratio) ; |
| } |
| else |
| { input_len = LONG_BUFFER_LEN ; |
| output_len = (int) floor (LONG_BUFFER_LEN * src_ratio) ; |
| } ; |
| |
| /* Reduce input_len by 10 so output is longer than necessary. */ |
| input_len -= 20 ; |
| |
| if (output_len > LONG_BUFFER_LEN) |
| { printf ("\n\nLine %d : output_len > LONG_BUFFER_LEN\n\n", __LINE__) ; |
| exit (1) ; |
| } ; |
| |
| current_in = current_out = 0 ; |
| |
| /* Perform sample rate conversion. */ |
| if ((src_state = src_new (converter, 1, &error)) == NULL) |
| { printf ("\n\nLine %d : src_new() failed : %s\n\n", __LINE__, src_strerror (error)) ; |
| exit (1) ; |
| } ; |
| |
| src_data.end_of_input = 0 ; /* Set this later. */ |
| |
| src_data.data_in = input ; |
| |
| src_data.src_ratio = src_ratio ; |
| |
| src_data.data_out = output ; |
| src_data.output_frames = ARRAY_LEN (output) / 10 ; |
| |
| terminate = 1 + (int) ceil ((src_ratio >= 1.0) ? src_ratio : 1.0 / src_ratio) ; |
| |
| while (1) |
| { |
| src_data.input_frames = next_block_length (0) ; |
| src_data.input_frames = MIN (src_data.input_frames, input_len - current_in) ; |
| |
| src_data.output_frames = ARRAY_LEN (output) - current_out ; |
| /*-Erik MIN (src_data.output_frames, output_len - current_out) ;-*/ |
| |
| src_data.end_of_input = (current_in >= input_len) ? 1 : 0 ; |
| |
| if ((error = src_process (src_state, &src_data))) |
| { printf ("\n\nLine %d : %s\n\n", __LINE__, src_strerror (error)) ; |
| printf (" src_data.input_frames : %ld\n", src_data.input_frames) ; |
| printf (" src_data.output_frames : %ld\n\n", src_data.output_frames) ; |
| exit (1) ; |
| } ; |
| |
| if (src_data.end_of_input && src_data.output_frames_gen == 0) |
| break ; |
| |
| if (src_data.input_frames_used > src_data.input_frames) |
| { printf ("\n\nLine %d : input_frames_used > input_frames\n\n", __LINE__) ; |
| printf (" src_data.input_frames : %ld\n", src_data.input_frames) ; |
| printf (" src_data.input_frames_used : %ld\n", src_data.input_frames_used) ; |
| printf (" src_data.output_frames : %ld\n", src_data.output_frames) ; |
| printf (" src_data.output_frames_gen : %ld\n\n", src_data.output_frames_gen) ; |
| exit (1) ; |
| } ; |
| |
| if (src_data.input_frames_used < 0) |
| { printf ("\n\nLine %d : input_frames_used (%ld) < 0\n\n", __LINE__, src_data.input_frames_used) ; |
| exit (1) ; |
| } ; |
| |
| if (src_data.output_frames_gen < 0) |
| { printf ("\n\nLine %d : output_frames_gen (%ld) < 0\n\n", __LINE__, src_data.output_frames_gen) ; |
| exit (1) ; |
| } ; |
| |
| current_in += src_data.input_frames_used ; |
| current_out += src_data.output_frames_gen ; |
| |
| if (current_in > input_len + terminate) |
| { printf ("\n\nLine %d : current_in (%d) > input_len (%d + %d)\n\n", __LINE__, current_in, input_len, terminate) ; |
| exit (1) ; |
| } ; |
| |
| if (current_out > output_len) |
| { printf ("\n\nLine %d : current_out (%d) > output_len (%d)\n\n", __LINE__, current_out, output_len) ; |
| exit (1) ; |
| } ; |
| |
| if (src_data.input_frames_used > input_len) |
| { printf ("\n\nLine %d : input_frames_used (%ld) > %d\n\n", __LINE__, src_data.input_frames_used, input_len) ; |
| exit (1) ; |
| } ; |
| |
| if (src_data.output_frames_gen > output_len) |
| { printf ("\n\nLine %d : output_frames_gen (%ld) > %d\n\n", __LINE__, src_data.output_frames_gen, output_len) ; |
| exit (1) ; |
| } ; |
| |
| if (src_data.data_in == NULL && src_data.output_frames_gen == 0) |
| break ; |
| |
| |
| src_data.data_in += src_data.input_frames_used ; |
| src_data.data_out += src_data.output_frames_gen ; |
| } ; |
| |
| src_state = src_delete (src_state) ; |
| |
| if (fabs (current_out - src_ratio * input_len) > terminate) |
| { printf ("\n\nLine %d : bad output data length %d should be %2.1f +/- %d.\n", __LINE__, |
| current_out, src_ratio * input_len, terminate) ; |
| printf ("\tsrc_ratio : %.4f\n", src_ratio) ; |
| printf ("\tinput_len : %d\n\tinput_used : %d\n", input_len, current_in) ; |
| printf ("\toutput_len : %d\n\toutput_gen : %d\n\n", output_len, current_out) ; |
| exit (1) ; |
| } ; |
| |
| if (current_in != input_len) |
| { printf ("\n\nLine %d : unused input.\n", __LINE__) ; |
| printf ("\tinput_len : %d\n", input_len) ; |
| printf ("\tinput_frames_used : %d\n\n", current_in) ; |
| exit (1) ; |
| } ; |
| |
| puts ("ok") ; |
| |
| return ; |
| } /* stream_test */ |
| |
| static int |
| next_block_length (int reset) |
| { static int block_lengths [] = /* Should be an odd length. */ |
| { /*-2, 500, 5, 400, 10, 300, 20, 200, 50, 100, 70 -*/ |
| 5, 400, 10, 300, 20, 200, 50, 100, 70 |
| } ; |
| static int block_len_index = 0 ; |
| |
| if (reset) |
| block_len_index = 0 ; |
| else |
| block_len_index = (block_len_index + 1) % ARRAY_LEN (block_lengths) ; |
| |
| return block_lengths [block_len_index] ; |
| } /* next_block_length */ |
| |