ref: 66946a6c3b8410def1efad881bbeadbe8556a277
dir: /src/src_fir_iir_poly.c/
/*
** Copyright (C) 2002-2004 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 <string.h>
#include "config.h"
#include "float_cast.h"
#include "common.h"
#define FIP_MAGIC_MARKER MAKE_MAGIC ('f', 'i', 'r', 'p', 'l', 'y')
#define IN_BUF_LEN 4096
typedef struct
{ int fip_magic_marker ;
int channels ;
long in_count, in_used ;
long out_count, out_gen ;
double src_ratio, input_index ;
float *input_buffer ;
int in_buf_len, in_start, in_end ;
float *fir_out ;
int fir_out_len, fir_start, fir_end ;
float *iir_out ;
int iir_out_len, iir_start, iir_end ;
float dummy [1] ;
} FIR_IIR_POLY ;
static void fip_reset (SRC_PRIVATE *psrc) ;
static int fip_process (SRC_PRIVATE *psrc, SRC_DATA *data) ;
static int fip_process_var_down (FIR_IIR_POLY * fip, SRC_DATA * data) ;
static int fip_process_const_down (FIR_IIR_POLY * fip, SRC_DATA * data) ;
static int fip_process_var_up (FIR_IIR_POLY * fip, SRC_DATA * data) ;
static int fip_process_const_up (FIR_IIR_POLY * fip, SRC_DATA * data) ;
static float best_coeffs [250] ;
const char*
fip_get_name (int src_enum)
{
switch (src_enum)
{ case SRC_FIR_IIR_POLY_BEST :
return "Best FIR/IIR/Polynomial Interpolator" ;
#if 0
case SRC_FIR_IIR_POLY_MEDIUM :
return "Medium FIR/IIR/Polynomial Interpolator" ;
case SRC_FIR_IIR_POLY_FASTEST :
return "Fastest FIR/IIR/Polynomial Interpolator" ;
#endif
} ;
return NULL ;
} /* fip_get_descrition */
const char*
fip_get_description (int src_enum)
{
switch (src_enum)
{ case SRC_FIR_IIR_POLY_BEST :
return "Three stage FIR/IIR/Polynomial Interpolator, best quality, XXdb SNR, XX% BW." ;
#if 0
case SRC_FIR_IIR_POLY_MEDIUM :
return "Three stage FIR/IIR/Polynomial Interpolator, medium quality, XXdb SNR, XX% BW." ;
case SRC_FIR_IIR_POLY_FASTEST :
return "Three stage FIR/IIR/Polynomial Interpolator, fastest, XXdb SNR, XX% BW." ;
#endif
} ;
return NULL ;
} /* fip_get_descrition */
int
fip_set_converter (SRC_PRIVATE *psrc, int src_enum)
{ FIR_IIR_POLY *fip, temp_fip ;
int buffer_total ;
if (psrc->private_data != NULL)
{ fip = (FIR_IIR_POLY *) psrc->private_data ;
if (fip->fip_magic_marker != FIP_MAGIC_MARKER)
{ free (psrc->private_data) ;
psrc->private_data = NULL ;
} ;
} ;
memset (&temp_fip, 0, sizeof (temp_fip)) ;
temp_fip.fip_magic_marker = FIP_MAGIC_MARKER ;
temp_fip.channels = psrc->channels ;
psrc->reset = fip_reset ;
psrc->process = fip_process ;
switch (src_enum)
{ case SRC_FIR_IIR_POLY_BEST :
temp_fip.in_buf_len = IN_BUF_LEN + 2 * ARRAY_LEN (best_coeffs) ;
break ;
#if 0
case SRC_FIR_IIR_POLY_MEDIUM :
break ;
case SRC_FIR_IIR_POLY_FASTEST :
break ;
#endif
default :
return SRC_ERR_BAD_CONVERTER ;
} ;
temp_fip.fir_out_len = 2 * IN_BUF_LEN ;
temp_fip.iir_out_len = 4 * IN_BUF_LEN ;
buffer_total = psrc->channels * (temp_fip.in_buf_len + temp_fip.fir_out_len + temp_fip.iir_out_len) ;
if ((fip = calloc (1, sizeof (FIR_IIR_POLY) + sizeof (fip->dummy [0]) * buffer_total)) == NULL)
return SRC_ERR_MALLOC_FAILED ;
*fip = temp_fip ;
memset (&temp_fip, 0xEE, sizeof (temp_fip)) ;
psrc->private_data = fip ;
fip->input_buffer = fip->dummy ;
fip->fir_out = fip->dummy + fip->channels * fip->in_buf_len ;
fip->iir_out = fip->dummy + fip->channels * (fip->in_buf_len + fip->fir_out_len) ;
fip_reset (psrc) ;
return SRC_ERR_NO_ERROR ;
} /* fip_set_converter */
static void
fip_reset (SRC_PRIVATE *psrc)
{ FIR_IIR_POLY *fip ;
fip = (FIR_IIR_POLY *) psrc->private_data ;
if (fip == NULL)
return ;
memset (fip->input_buffer, 0, fip->channels * fip->in_buf_len * sizeof (fip->dummy [0])) ;
memset (fip->fir_out, 0, fip->channels * fip->fir_out_len * sizeof (fip->dummy [0])) ;
memset (fip->iir_out, 0, fip->channels * fip->iir_out_len * sizeof (fip->dummy [0])) ;
fip->in_start = fip->in_end = ARRAY_LEN (best_coeffs) ;
fip->fir_start = fip->fir_end = 0 ;
fip->iir_start = fip->iir_end = 0 ;
fip->src_ratio = fip->input_index = 0.0 ;
return ;
} /* fip_reset */
/*========================================================================================
*/
static int
fip_process (SRC_PRIVATE *psrc, SRC_DATA *data)
{ FIR_IIR_POLY *fip ;
if (psrc->private_data == NULL)
return SRC_ERR_NO_PRIVATE ;
fip = (FIR_IIR_POLY*) psrc->private_data ;
/* If there is not a problem, this will be optimised out. */
if (sizeof (fip->dummy [0]) != sizeof (data->data_in [0]))
return SRC_ERR_SIZE_INCOMPATIBILITY ;
/* Just after an fip_reset(), the src_ratio field is invalid. */
if (fip->src_ratio < 1.0 / SRC_MAX_RATIO)
fip->src_ratio = data->src_ratio ;
if (fip->src_ratio < 1.0 || data->src_ratio < 1.0)
{ /* Special case code for constant and varying src_ratio downsampling. */
if (fabs (fip->src_ratio - data->src_ratio) > 1e-20)
return fip_process_var_down (fip, data) ;
return fip_process_const_down (fip, data) ;
} ;
if (fabs (fip->src_ratio - data->src_ratio) > 1e-20)
return fip_process_var_up (fip, data) ;
return fip_process_const_up (fip, data) ;
} /* fip_process */
/*----------------------------------------------------------------------------------------
*/
static int
fip_process_var_down (FIR_IIR_POLY * fip, SRC_DATA * data)
{ fip = NULL ;
data = NULL ;
printf ("%s : not implemented yet.\n", __func__) ;
return SRC_ERR_NO_ERROR ;
} /* fip_process_var_down */
static int
fip_process_const_down (FIR_IIR_POLY * fip, SRC_DATA * data)
{ fip = NULL ;
data = NULL ;
printf ("%s : not implemented yet.\n", __func__) ;
return SRC_ERR_NO_ERROR ;
} /* fip_process_const_down */
static int
fip_process_var_up (FIR_IIR_POLY * fip, SRC_DATA * data)
{ fip = NULL ;
data = NULL ;
printf ("%s : not implemented yet.\n", __func__) ;
return SRC_ERR_NO_ERROR ;
} /* fip_process_var_up */
static int
fip_process_const_up (FIR_IIR_POLY * fip, SRC_DATA * data)
{ fip = NULL ;
data = NULL ;
printf ("%s : not implemented yet.\n", __func__) ;
return SRC_ERR_NO_ERROR ;
} /* fip_process_const_up */
/*
** Do not edit or modify anything in this comment block.
** The arch-tag line is a file identity tag for the GNU Arch
** revision control system.
**
** arch-tag: a6c8bad4-740c-4e4f-99f1-e274174ab540
*/