bpmdsp/apply_filter.c

#include "bpm/bpm_dsp.h"


void _shift_down( double *x, int n ) {
  int k=0;
  for( k=0; k<n-1; k++ ) x[k] = x[k+1];
  return;
}

// -------------------------------------------------------------------

void _reset( double *x ) {
  int i = 0;
  for( i=0;i<=MAXPZ;i++) x[i] = 0.;
}

// -------------------------------------------------------------------

int apply_filter( filter_t *f, double *wf ) {

  int i = 0, k = 0;

  if ( ! f || ! wf ) {
    bpm_error( "Invalid pointers in apply_filter()", __FILE__, __LINE__ );
    return BPM_FAILURE;
  }

  // reset the buffers
  _reset( f->xv );
  _reset( f->yv );

  if( f->IsFIR ) {
    // apply filter for Finite Impulse response
    
    for ( i=0; i<f->ns; i++ ) {
      _shift_down( f->xv, f->nxc );
      f->xv[f->nxc-1] = wf[i] / f->gain;
      f->wfbuffer[i] = 0.;
      for( k=0; k<f->nxc; k++ ) f->wfbuffer[i] += ( f->xc[k] * f->xv[k] ); 
    }


  } else {
    // apply filter for Infinite Impulse response
    
    for ( i=0; i<f->ns; i++ ) {

      _shift_down( f->xv, f->nxc );
      f->xv[f->nxc-1] = wf[i] / f->gain;

      _shift_down( f->yv, f->nyc );
      f->yv[f->nyc-1] = 0.;
      
      // the x contrib
      for ( k=0; k < f->nxc;   k++ ) f->yv[f->nyc-1] += ( f->xc[k] * f->xv[k] );

      // the y contrib
      for ( k=0; k < f->nyc-1; k++ ) f->yv[f->nyc-1] += ( f->yc[k] * f->yv[k] );

      f->wfbuffer[i] = f->yv[f->nyc-1];
    }


  }

  // copy buffer to input waveform
  for(i=0;i<f->ns;i++) wf[i] = f->wfbuffer[i];

  return BPM_SUCCESS;
}

---