340 lines
9.8 KiB
C
340 lines
9.8 KiB
C
/*
|
|
** 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 */
|
|
|