/*****************************************************************************
-** FILE IDENTIFICATION
+** File IDENTIFICATION
**
** Name: filter.cpp
** Purpose: Routines for signal-procesing filters
** This is part of the CTSim program
** Copyright (C) 1983-2000 Kevin Rosenberg
**
-** $Id: filter.cpp,v 1.8 2000/07/04 18:33:35 kevin Exp $
+** $Id: filter.cpp,v 1.10 2000/07/05 01:34:46 kevin Exp $
**
** This program is free software; you can redistribute it and/or modify
** it under the terms of the GNU General Public License (version 2) as
m_fail = true;
return;
}
+ m_traceLevel = TRACE_NONE;
m_nameFilter = convertFilterIDToName (m_idFilter);
m_nameDomain = convertDomainIDToName (m_idDomain);
m_nameFilterMethod = convertFilterMethodIDToName (m_idFilterMethod);
m_vecFourierSinTable[i] = sin (angleIncrement * i);
}
m_nFilterPoints = m_nSignalPoints;
- m_filterMin = 0;
- m_filterMax = m_nSignalPoints * m_signalInc;
- m_filterInc = (m_filterMax - m_filterMin) / (m_nFilterPoints - 1);
+ m_filterMin = -1. / (2 * m_signalInc);
+ m_filterMax = 1. / (2 * m_signalInc);
+ m_filterInc = (m_filterMax - m_filterMin) / m_nFilterPoints;
m_vecFilter = new double [m_nFilterPoints];
int halfFilter = m_nFilterPoints / 2;
for (int i = 0; i < halfFilter; i++)
for (int i = 0; i < halfFilter; i++)
m_vecFilter[m_nFilterPoints - i - 1] = static_cast<double>(i) / (halfFilter - 1) / (2 * m_signalInc);
if (halfFilter % 2) // odd
- m_vecFilter[halfFilter] = 1;
+ m_vecFilter[halfFilter] = 1 / (2 * m_signalInc);
} else if (m_idFilterMethod == FILTER_METHOD_FFT || m_idFilterMethod == FILTER_METHOD_FFT_ZEROPAD_2 || m_idFilterMethod == FILTER_METHOD_FFT_ZEROPAD_4) {
m_nFilterPoints = m_nSignalPoints;
if (m_idFilterMethod == FILTER_METHOD_FFT_ZEROPAD_2 || m_idFilterMethod == FILTER_METHOD_FFT_ZEROPAD_4) {
m_nFilterPoints = 1 << nextPowerOf2;
cout << "nFilterPoints = " << m_nFilterPoints << endl;
}
- m_filterMin = 0;
- m_filterMax = m_nSignalPoints * m_signalInc;
- m_filterInc = (m_filterMax - m_filterMin) / (m_nFilterPoints - 1);
+ m_filterMin = -1. / (2 * m_signalInc);
+ m_filterMax = 1. / (2 * m_signalInc);
+ m_filterInc = (m_filterMax - m_filterMin) / m_nFilterPoints;
m_vecFilter = new double [m_nFilterPoints];
int halfFilter = m_nFilterPoints / 2;
for (int i = 0; i < halfFilter; i++)
for (int i = 0; i < halfFilter; i++)
m_vecFilter[m_nFilterPoints - i - 1] = static_cast<double>(i) / (halfFilter - 1) / (2 * m_signalInc);
if (halfFilter % 2) // odd
- m_vecFilter[halfFilter] = 1;
+ m_vecFilter[halfFilter] = 1 / (2 * m_signalInc);
#if HAVE_FFTW
m_planForward = fftw_create_plan (m_nFilterPoints, FFTW_FORWARD, FFTW_ESTIMATE);
complex<double> complexOutput[m_nSignalPoints];
complex<double> filteredSignal[m_nSignalPoints];
finiteFourierTransform (input, fftSignal, m_nSignalPoints, -1);
+ if (m_traceLevel >= TRACE_PLOT) {
+ double test[m_nSignalPoints];
+ for (int i = 0; i < m_nSignalPoints; i++)
+ test[i] = abs(fftSignal[i]);
+ ezplot_1d(test, m_nSignalPoints);
+ cio_kb_getc();
+ }
dotProduct (m_vecFilter, fftSignal, filteredSignal, m_nSignalPoints);
+ if (m_traceLevel >= TRACE_PLOT) {
+ double test[m_nSignalPoints];
+ for (int i = 0; i < m_nSignalPoints; i++)
+ test[i] = abs(filteredSignal[i]);
+ ezplot_1d(test, m_nSignalPoints);
+ cio_kb_getc();
+ }
finiteFourierTransform (filteredSignal, complexOutput, m_nSignalPoints, 1);
- for (int i = 0; i < m_nSignalPoints; i++) {
+ for (int i = 0; i < m_nSignalPoints; i++)
output[i] = abs( complexOutput[i] );
- }
} else if (m_idFilterMethod == FILTER_METHOD_FFT || FILTER_METHOD_FFT_ZEROPAD_2 || FILTER_METHOD_FFT_ZEROPAD_4) {
fftw_complex in[m_nFilterPoints], out[m_nFilterPoints];
for (int i = 0; i < m_nSignalPoints; i++) {
in[i].re = in[i].im = 0; // ZeroPad
}
fftw_one(m_planForward, in, out);
+ if (m_traceLevel >= TRACE_PLOT) {
+ double test[m_nFilterPoints];
+ for (int i = 0; i < m_nFilterPoints; i++)
+ test[i] = sqrt(out[i].re * out[i].re + out[i].im * out[i].im);
+ ezplot_1d(test, m_nFilterPoints);
+ cio_kb_getc();
+ }
for (int i = 0; i < m_nFilterPoints; i++) {
out[i].re = m_vecFilter[i] * out[i].re / m_nSignalPoints;
out[i].im = m_vecFilter[i] * out[i].im / m_nSignalPoints;
}
+ if (m_traceLevel >= TRACE_PLOT) {
+ double test[m_nFilterPoints];
+ for (int i = 0; i < m_nFilterPoints; i++)
+ test[i] = sqrt(out[i].re * out[i].re + out[i].im * out[i].im);
+ ezplot_1d(test, m_nFilterPoints);
+ cio_kb_getc();
+ }
fftw_one(m_planBackward, out, in);
+ if (m_traceLevel >= TRACE_PLOT) {
+ double test[m_nFilterPoints];
+ for (int i = 0; i < m_nFilterPoints; i++)
+ test[i] = sqrt(in[i].re * in[i].re + in[i].im * in[i].im);
+ ezplot_1d(test, m_nFilterPoints);
+ cio_kb_getc();
+ }
for (int i = 0; i < m_nSignalPoints; i++)
output[i] = sqrt (in[i].re * in[i].re + in[i].im * in[i].im);
}