Chris@137: /* -*- c-basic-offset: 4 indent-tabs-mode: nil -*-  vi:set ts=8 sts=4 sw=4: */
Chris@137: 
Chris@150: #include "dsp/rateconversion/Resampler.h"
Chris@137: 
Chris@150: #include "base/Window.h"
Chris@150: #include "dsp/transforms/FFT.h"
Chris@143: 
Chris@137: #include <iostream>
Chris@137: 
Chris@137: #include <cmath>
Chris@137: 
Chris@137: #define BOOST_TEST_DYN_LINK
Chris@137: #define BOOST_TEST_MAIN
Chris@137: 
Chris@137: #include <boost/test/unit_test.hpp>
Chris@137: 
Chris@137: BOOST_AUTO_TEST_SUITE(TestResampler)
Chris@137: 
Chris@137: using std::cout;
Chris@137: using std::endl;
Chris@138: using std::vector;
Chris@138: 
Chris@138: void
Chris@138: testResamplerOneShot(int sourceRate,
Chris@138: 		     int targetRate,
Chris@138: 		     int n,
Chris@138: 		     double *in,
Chris@138: 		     int m,
Chris@141: 		     double *expected,
Chris@141: 		     int skip)
Chris@138: {
Chris@138:     vector<double> resampled = Resampler::resample(sourceRate, targetRate,
Chris@138: 						   in, n);
Chris@141:     if (skip == 0) {
Chris@141: 	BOOST_CHECK_EQUAL(resampled.size(), m);
Chris@141:     }
Chris@138:     for (int i = 0; i < m; ++i) {
Chris@148: 	BOOST_CHECK_SMALL(resampled[i + skip] - expected[i], 1e-6);
Chris@138:     }
Chris@138: }
Chris@137: 
Chris@137: void
Chris@137: testResampler(int sourceRate,
Chris@137: 	      int targetRate,
Chris@137: 	      int n,
Chris@137: 	      double *in,
Chris@137: 	      int m,
Chris@137: 	      double *expected)
Chris@137: {
Chris@139:     // Here we provide the input in chunks (of varying size)
Chris@138: 
Chris@137:     Resampler r(sourceRate, targetRate);
Chris@137:     int latency = r.getLatency();
Chris@137: 
Chris@137:     int m1 = m + latency;
Chris@137:     int n1 = int((m1 * sourceRate) / targetRate);
Chris@137: 
Chris@137:     double *inPadded = new double[n1];
Chris@137:     double *outPadded = new double[m1];
Chris@137: 
Chris@137:     for (int i = 0; i < n1; ++i) {
Chris@137: 	if (i < n) inPadded[i] = in[i];
Chris@137: 	else inPadded[i] = 0.0;
Chris@137:     }
Chris@137:     
Chris@137:     for (int i = 0; i < m1; ++i) {
Chris@137: 	outPadded[i] = -999.0;
Chris@137:     }
Chris@137: 
Chris@139:     int chunkSize = 1;
Chris@139:     int got = 0;
Chris@139:     int i = 0;
Chris@137: 
Chris@139:     while (true) {
Chris@139: 	got += r.process(inPadded + i, outPadded + got, chunkSize);
Chris@139: 	i = i + chunkSize;
Chris@139: 	chunkSize = chunkSize + 1;
Chris@141: 	if (i >= n1) {
Chris@139: 	    break;
Chris@139: 	} else if (i + chunkSize >= n1) {
Chris@139: 	    chunkSize = n1 - i;
Chris@141: 	} else if (chunkSize > 15) {
Chris@141: 	    chunkSize = 1;
Chris@139: 	}
Chris@139:     }
Chris@139: 
Chris@141:     BOOST_CHECK_EQUAL(got, m1);
Chris@137: 
Chris@137:     for (int i = latency; i < m1; ++i) {
Chris@138: 	BOOST_CHECK_SMALL(outPadded[i] - expected[i-latency], 1e-8);
Chris@137:     }
Chris@141: 
Chris@137:     delete[] outPadded;
Chris@137:     delete[] inPadded;
Chris@137: }
Chris@148: 
Chris@140: BOOST_AUTO_TEST_CASE(sameRateOneShot)
Chris@140: {
Chris@140:     double d[] = { 0, 0.1, -0.3, -0.4, -0.3, 0, 0.5, 0.2, 0.8, -0.1 };
Chris@141:     testResamplerOneShot(4, 4, 10, d, 10, d, 0);
Chris@140: }
Chris@140: 
Chris@137: BOOST_AUTO_TEST_CASE(sameRate)
Chris@137: {
Chris@137:     double d[] = { 0, 0.1, -0.3, -0.4, -0.3, 0, 0.5, 0.2, 0.8, -0.1 };
Chris@137:     testResampler(4, 4, 10, d, 10, d);
Chris@137: }
Chris@137: 
Chris@141: BOOST_AUTO_TEST_CASE(interpolatedMisc)
Chris@141: {
Chris@141:     // Interpolating any signal by N should give a signal in which
Chris@141:     // every Nth sample is the original signal
Chris@141:     double in[] = { 0, 0.1, -0.3, -0.4, -0.3, 0, 0.5, 0.2, 0.8, -0.1 };
Chris@141:     int n = sizeof(in)/sizeof(in[0]);
Chris@141:     for (int factor = 2; factor < 10; ++factor) {
Chris@141: 	vector<double> out = Resampler::resample(6, 6 * factor, in, n);
Chris@141: 	for (int i = 0; i < n; ++i) {
Chris@141: 	    BOOST_CHECK_SMALL(out[i * factor] - in[i], 1e-5);
Chris@141: 	}
Chris@141:     }
Chris@141: }
Chris@141: 
Chris@141: BOOST_AUTO_TEST_CASE(interpolatedSine)
Chris@141: {
Chris@142:     // Interpolating a sinusoid should give us a sinusoid, once we've
Chris@142:     // dropped the first few samples
Chris@141:     double in[1000];
Chris@141:     double out[2000];
Chris@141:     for (int i = 0; i < 1000; ++i) {
Chris@141: 	in[i] = sin(i * M_PI / 2.0);
Chris@141:     }
Chris@141:     for (int i = 0; i < 2000; ++i) {
Chris@141: 	out[i] = sin(i * M_PI / 4.0);
Chris@141:     }
Chris@142:     testResamplerOneShot(8, 16, 1000, in, 200, out, 512);
Chris@142: }
Chris@142: 
Chris@142: BOOST_AUTO_TEST_CASE(decimatedSine)
Chris@142: {
Chris@142:     // Decimating a sinusoid should give us a sinusoid, once we've
Chris@142:     // dropped the first few samples
Chris@142:     double in[2000];
Chris@142:     double out[1000];
Chris@142:     for (int i = 0; i < 2000; ++i) {
Chris@142: 	in[i] = sin(i * M_PI / 8.0);
Chris@142:     }
Chris@142:     for (int i = 0; i < 1000; ++i) {
Chris@142: 	out[i] = sin(i * M_PI / 4.0);
Chris@142:     }
Chris@142:     testResamplerOneShot(16, 8, 2000, in, 200, out, 256);
Chris@141: }
Chris@148: 
Chris@172: double
Chris@172: measureSinFreq(const vector<double> &v, int rate, int countCycles)
Chris@172: {
Chris@172:     int n = v.size();
Chris@172:     int firstCrossing = -1;
Chris@172:     int lastCrossing = -1;
Chris@172:     int nCrossings = 0;
Chris@172:     // count -ve -> +ve transitions
Chris@172:     for (int i = 0; i + 1 < n; ++i) {
Chris@172:         if (v[i] <= 0.0 && v[i+1] > 0.0) {
Chris@172:             if (firstCrossing < 0) firstCrossing = i;
Chris@172:             lastCrossing = i;
Chris@172:             ++nCrossings;
Chris@172:             if (nCrossings == countCycles) break;
Chris@172:         }
Chris@172:     }
Chris@172:     int nCycles = nCrossings - 1;
Chris@172:     if (nCycles <= 0) return 0.0;
Chris@172:     cout << "lastCrossing = " << lastCrossing << ", firstCrossing = " << firstCrossing << ", dist = " << lastCrossing - firstCrossing << ", nCycles = " << nCycles << endl;
Chris@172:     double cycle = double(lastCrossing - firstCrossing) / nCycles;
Chris@172:     return rate / cycle;
Chris@172: }
Chris@172: 
Chris@172: void
Chris@172: testSinFrequency(int freq,
Chris@172:                  int sourceRate,
Chris@172:                  int targetRate)
Chris@172: {
Chris@172:     // Resampling a sinusoid and then resampling back should give us a
Chris@172:     // sinusoid of the same frequency as we started with. Let's start
Chris@172:     // with a few thousand cycles of it
Chris@172: 
Chris@172:     int nCycles = 5000;
Chris@172: 
Chris@172:     int duration = int(nCycles * float(sourceRate) / float(freq));
Chris@172:     cout << "freq = " << freq << ", sourceRate = " << sourceRate << ", targetRate = " << targetRate << ", duration = " << duration << endl;
Chris@172: 
Chris@172:     vector<double> in(duration, 0);
Chris@172:     for (int i = 0; i < duration; ++i) {
Chris@172:         in[i] = sin(i * M_PI * 2.0 * freq / sourceRate);
Chris@172:     }
Chris@172: 
Chris@172:     vector<double> out = Resampler::resample(sourceRate, targetRate,
Chris@172:                                              in.data(), in.size());
Chris@172: 
Chris@172:     vector<double> back = Resampler::resample(targetRate, sourceRate,
Chris@172:                                               out.data(), out.size());
Chris@172: 
Chris@172:     BOOST_CHECK_EQUAL(in.size(), back.size());
Chris@172: 
Chris@172:     double inFreq = measureSinFreq(in, sourceRate, nCycles - 2);
Chris@172:     double backFreq = measureSinFreq(back, sourceRate, nCycles - 2);
Chris@172:     
Chris@172:     cout << "inFreq = " << inFreq << ", backFreq = " << backFreq << endl;
Chris@172: 
Chris@172:     BOOST_CHECK_SMALL(inFreq - backFreq, 1e-8);
Chris@172: 
Chris@172:     //    for (int i = 0; i < int(in.size()); ++i) {
Chris@172: //	BOOST_CHECK_SMALL(in[i] - back[i], 1e-6);
Chris@172: //    }
Chris@172: }
Chris@172: 
Chris@172: BOOST_AUTO_TEST_CASE(downUp2)
Chris@172: {
Chris@172:     testSinFrequency(440, 44100, 22050);
Chris@172: }
Chris@172: 
Chris@172: BOOST_AUTO_TEST_CASE(downUp16)
Chris@172: {
Chris@172:     testSinFrequency(440, 48000, 3000);
Chris@172: }
Chris@172: 
Chris@172: BOOST_AUTO_TEST_CASE(upDown2)
Chris@172: {
Chris@172:     testSinFrequency(440, 44100, 88200);
Chris@172: }
Chris@172: 
Chris@172: BOOST_AUTO_TEST_CASE(upDown16)
Chris@172: {
Chris@172:     testSinFrequency(440, 3000, 48000);
Chris@172: }
Chris@172: 
Chris@143: vector<double>
Chris@144: squareWave(int rate, double freq, int n)
Chris@143: {
Chris@143:     //!!! todo: hoist, test
Chris@143:     vector<double> v(n, 0.0);
Chris@143:     for (int h = 0; h < (rate/4)/freq; ++h) {
Chris@143: 	double m = h * 2 + 1;
Chris@144: 	double scale = 1.0 / m;
Chris@143: 	for (int i = 0; i < n; ++i) {
Chris@144: 	    double s = scale * sin((i * 2.0 * M_PI * m * freq) / rate);
Chris@144: 	    v[i] += s;
Chris@143: 	}
Chris@143:     }
Chris@143:     return v;
Chris@143: }
Chris@143: 
Chris@143: void
Chris@143: testSpectrum(int inrate, int outrate)
Chris@143: {
Chris@143:     // One second of a square wave
Chris@143:     int freq = 500;
Chris@143: 
Chris@143:     vector<double> square =
Chris@143: 	squareWave(inrate, freq, inrate);
Chris@143: 
Chris@143:     vector<double> maybeSquare = 
Chris@143: 	Resampler::resample(inrate, outrate, square.data(), square.size());
Chris@143: 
Chris@143:     BOOST_CHECK_EQUAL(maybeSquare.size(), outrate);
Chris@143: 
Chris@143:     Window<double>(HanningWindow, inrate).cut(square.data());
Chris@143:     Window<double>(HanningWindow, outrate).cut(maybeSquare.data());
Chris@143: 
Chris@143:     // forward magnitude with size inrate, outrate
Chris@143: 
Chris@143:     vector<double> inSpectrum(inrate, 0.0);
Chris@143:     FFTReal(inrate).forwardMagnitude(square.data(), inSpectrum.data());
Chris@148:     for (int i = 0; i < (int)inSpectrum.size(); ++i) {
Chris@144: 	inSpectrum[i] /= inrate;
Chris@144:     }
Chris@143: 
Chris@143:     vector<double> outSpectrum(outrate, 0.0);
Chris@143:     FFTReal(outrate).forwardMagnitude(maybeSquare.data(), outSpectrum.data());
Chris@148:     for (int i = 0; i < (int)outSpectrum.size(); ++i) {
Chris@144: 	outSpectrum[i] /= outrate;
Chris@144:     }
Chris@143: 
Chris@156:     // Don't compare bins any higher than 96% of Nyquist freq of lower sr
Chris@143:     int lengthOfInterest = (inrate < outrate ? inrate : outrate) / 2;
Chris@156:     lengthOfInterest = lengthOfInterest - (lengthOfInterest / 25);
Chris@143: 
Chris@143:     for (int i = 0; i < lengthOfInterest; ++i) {
Chris@143: 	BOOST_CHECK_SMALL(inSpectrum[i] - outSpectrum[i], 1e-7);
Chris@143:     }
Chris@143: }
Chris@143: 
Chris@143: BOOST_AUTO_TEST_CASE(spectrum)
Chris@143: {
Chris@143:     int rates[] = { 8000, 22050, 44100, 48000 };
Chris@148:     for (int i = 0; i < (int)(sizeof(rates)/sizeof(rates[0])); ++i) {
Chris@148: 	    for (int j = 0; j < (int)(sizeof(rates)/sizeof(rates[0])); ++j) {
Chris@143: 	    testSpectrum(rates[i], rates[j]);
Chris@143: 	}
Chris@143:     }
Chris@143: }
Chris@143: 
Chris@137: BOOST_AUTO_TEST_SUITE_END()
Chris@137: