Chris@366: 
Chris@366: #include "ConstantQ.h"
Chris@366: #include "CQInverse.h"
Chris@366: 
Chris@366: #include <sndfile.h>
Chris@366: 
Chris@366: #include <iostream>
Chris@366: 
Chris@366: using std::vector;
Chris@366: using std::cerr;
Chris@366: using std::endl;
Chris@366: 
Chris@366: #include <cstring>
Chris@366: 
Chris@366: #include <getopt.h>
Chris@366: #include <unistd.h>
Chris@366: #include <sys/time.h>
Chris@366: #include <cstdlib>
Chris@366: 
Chris@366: int main(int argc, char **argv)
Chris@366: {
Chris@366:     double maxFreq = 0;
Chris@366:     double minFreq = 0;
Chris@366:     int bpo = 0;
Chris@366:     bool help = false;
Chris@366:     
Chris@366:     int c;
Chris@366: 
Chris@366:     while (1) {
Chris@366: 	int optionIndex = 0;
Chris@366: 	
Chris@366: 	static struct option longOpts[] = {
Chris@366: 	    { "help", 0, 0, 'h', },
Chris@366: 	    { "maxfreq", 1, 0, 'x', },
Chris@366: 	    { "minfreq", 1, 0, 'n', },
Chris@366: 	    { "bpo", 1, 0, 'b' },
Chris@366: 	    { 0, 0, 0, 0 },
Chris@366: 	};
Chris@366: 
Chris@366: 	c = getopt_long(argc, argv,
Chris@366: 			"hx:n:b:",
Chris@366: 			longOpts, &optionIndex);
Chris@366: 	if (c == -1) break;
Chris@366: 
Chris@366: 	switch (c) {
Chris@366: 	case 'h': help = true; break;
Chris@366: 	case 'x': maxFreq = atof(optarg); break;
Chris@366: 	case 'n': minFreq = atof(optarg); break;
Chris@366: 	case 'b': bpo = atoi(optarg); break;
Chris@366: 	default: help = true; break;
Chris@366: 	}
Chris@366:     }
Chris@366: 
Chris@366:     if (help || (optind + 2 != argc && optind + 3 != argc)) {
Chris@366: 	cerr << endl;
Chris@366: 	cerr << "Usage: " << argv[0] << " [options] infile.wav outfile.wav [differencefile.wav]" << endl;
Chris@366: 	cerr << endl;
Chris@366: 	cerr << "Options:" << endl;
Chris@366: 	cerr << "  -x<X>, --maxfreq <X>  Maximum frequency (default = sample rate / 3)" << endl;
Chris@366: 	cerr << "  -n<X>, --minfreq <X>  Minimum frequency (default = 100, actual min may vary)" << endl;
Chris@366: 	cerr << "  -b<X>, --bpo <X>      Bins per octave   (default = 60)" << endl;
Chris@366: 	cerr << "  -h, --help            Print this help" << endl;
Chris@366: 	cerr << endl;
Chris@366: 	cerr << "This rather useless program simply performs a forward Constant-Q transform with" << endl;
Chris@366: 	cerr << "the requested parameters, followed by its inverse, and writes the result to the" << endl;
Chris@366: 	cerr << "output file. If a diff file name is provided, the difference between input and" << endl;
Chris@366: 	cerr << "output signals is also written to that. All this accomplishes is to produce a" << endl;
Chris@366: 	cerr << "signal that approximates the input: it's intended for test purposes only." << endl;
Chris@366: 	cerr << endl;
Chris@366: 	cerr << "(Want to calculate and obtain a Constant-Q spectrogram? Use the CQVamp plugin" << endl;
Chris@366: 	cerr << "in a Vamp plugin host.)" << endl;
Chris@366: 	cerr << endl;
Chris@366: 	return 2;
Chris@366:     }
Chris@366: 
Chris@366:     char *fileName = strdup(argv[optind++]);
Chris@366:     char *fileNameOut = strdup(argv[optind++]);
Chris@366:     char *diffFileName = (optind < argc ? strdup(argv[optind++]) : 0);
Chris@366:     bool doDiff = (diffFileName != 0);
Chris@366: 
Chris@366:     SNDFILE *sndfile;
Chris@366:     SNDFILE *sndfileOut;
Chris@366:     SNDFILE *sndDiffFile = 0;
Chris@366:     SF_INFO sfinfo;
Chris@366:     SF_INFO sfinfoOut;
Chris@366:     SF_INFO sfinfoDiff;
Chris@366:     memset(&sfinfo, 0, sizeof(SF_INFO));
Chris@366: 
Chris@366:     sndfile = sf_open(fileName, SFM_READ, &sfinfo);
Chris@366:     if (!sndfile) {
Chris@366: 	cerr << "ERROR: Failed to open input file \"" << fileName << "\": "
Chris@366: 	     << sf_strerror(sndfile) << endl;
Chris@366: 	return 1;
Chris@366:     }
Chris@366: 
Chris@366:     sfinfoOut.channels = 1;
Chris@366:     sfinfoOut.format = SF_FORMAT_WAV | SF_FORMAT_PCM_16;
Chris@366:     sfinfoOut.frames = sfinfo.frames;
Chris@366:     sfinfoOut.samplerate = sfinfo.samplerate;
Chris@366:     sfinfoOut.sections = sfinfo.sections;
Chris@366:     sfinfoOut.seekable = sfinfo.seekable;
Chris@366: 
Chris@366:     sndfileOut = sf_open(fileNameOut, SFM_WRITE, &sfinfoOut) ;
Chris@366:     if (!sndfileOut) {
Chris@366: 	cerr << "ERROR: Failed to open output file \"" << fileNameOut << "\" for writing: "
Chris@366: 	     << sf_strerror(sndfileOut) << endl;
Chris@366: 	return 1;
Chris@366:     }
Chris@366: 
Chris@366:     if (doDiff) {
Chris@366: 	sfinfoDiff = sfinfoOut;
Chris@366: 	sndDiffFile = sf_open(diffFileName, SFM_WRITE, &sfinfoDiff);
Chris@366: 	if (!sndDiffFile) {
Chris@366: 	    cerr << "ERROR: Failed to open diff output file \"" << diffFileName << "\" for writing: "
Chris@366: 		 << sf_strerror(sndDiffFile) << endl;
Chris@366: 	    return 1;
Chris@366: 	}
Chris@366:     }
Chris@366: 
Chris@366:     int ibs = 1024;
Chris@366:     int channels = sfinfo.channels;
Chris@366:     float *fbuf = new float[channels * ibs];
Chris@366: 
Chris@366:     if (maxFreq == 0.0) maxFreq = sfinfo.samplerate / 3;
Chris@366:     if (minFreq == 0.0) minFreq = 100;
Chris@366:     if (bpo == 0) bpo = 60;
Chris@366: 
Chris@366:     CQParameters params(sfinfo.samplerate, minFreq, maxFreq, bpo);
Chris@366:     ConstantQ cq(params);
Chris@366:     CQInverse cqi(params);
Chris@366: 
Chris@366:     cerr << "max freq = " << cq.getMaxFrequency() << ", min freq = "
Chris@366: 	 << cq.getMinFrequency() << ", octaves = " << cq.getOctaves() << endl;
Chris@366: 
Chris@366:     cerr << "octave boundaries: ";
Chris@366:     for (int i = 0; i < cq.getOctaves(); ++i) {
Chris@366: 	cerr << cq.getMaxFrequency() / pow(2, i) << " ";
Chris@366:     }
Chris@366:     cerr << endl;
Chris@366: 
Chris@366:     int inframe = 0;
Chris@366:     int outframe = 0;
Chris@366:     int latency = cq.getLatency() + cqi.getLatency();
Chris@366: 
Chris@366:     vector<double> buffer;
Chris@366: 
Chris@366:     double maxdiff = 0.0;
Chris@366:     int maxdiffidx = 0;
Chris@366: 
Chris@366:     cerr << "forward latency = " << cq.getLatency() << ", inverse latency = " 
Chris@366: 	 << cqi.getLatency() << ", total = " << latency << endl;
Chris@366: 
Chris@366:     timeval tv;
Chris@366:     (void)gettimeofday(&tv, 0);
Chris@366: 
Chris@366:     while (inframe < sfinfo.frames) {
Chris@366: 
Chris@366:         int count = -1;
Chris@366: 	
Chris@366: 	if ((count = sf_readf_float(sndfile, fbuf, ibs)) < 0) {
Chris@366: 	    break;
Chris@366: 	}
Chris@366: 
Chris@366: 	vector<double> cqin;
Chris@366: 	for (int i = 0; i < count; ++i) {
Chris@366: 	    double v = fbuf[i * channels];
Chris@366: 	    if (channels > 1) {
Chris@366: 		for (int c = 1; c < channels; ++c) {
Chris@366: 		    v += fbuf[i * channels + c];
Chris@366: 		}
Chris@366: 		v /= channels;
Chris@366: 	    }
Chris@366: 	    cqin.push_back(v);
Chris@366: 	}
Chris@366: 
Chris@366: 	if (doDiff) {
Chris@366: 	    buffer.insert(buffer.end(), cqin.begin(), cqin.end());
Chris@366: 	}
Chris@366: 	
Chris@366: 	vector<double> cqout = cqi.process(cq.process(cqin));
Chris@366: 
Chris@366: 	for (int i = 0; i < int(cqout.size()); ++i) {
Chris@366: 	    if (cqout[i] > 1.0) cqout[i] = 1.0;
Chris@366: 	    if (cqout[i] < -1.0) cqout[i] = -1.0;
Chris@366: 	}
Chris@366: 
Chris@366: 	if (outframe >= latency) {
Chris@366: 
Chris@366: 	    sf_writef_double(sndfileOut, 
Chris@366: 			     cqout.data(), 
Chris@366: 			     cqout.size());
Chris@366: 
Chris@366: 	} else if (outframe + (int)cqout.size() >= latency) {
Chris@366: 
Chris@366: 	    int offset = latency - outframe;
Chris@366: 	    sf_writef_double(sndfileOut, 
Chris@366: 			     cqout.data() + offset,
Chris@366: 			     cqout.size() - offset);
Chris@366: 	}
Chris@366: 
Chris@366: 	if (doDiff) {
Chris@366: 	    for (int i = 0; i < (int)cqout.size(); ++i) {
Chris@366: 		if (outframe + i >= latency) {
Chris@366: 		    int dframe = outframe + i - latency;
Chris@366: 		    if (dframe >= (int)buffer.size()) cqout[i] = 0;
Chris@366: 		    else cqout[i] -= buffer[dframe];
Chris@366: 		    if (fabs(cqout[i]) > maxdiff &&
Chris@366: 			dframe > sfinfo.samplerate && // ignore first/last sec
Chris@366: 			dframe + sfinfo.samplerate < sfinfo.frames) {
Chris@366: 			maxdiff = fabs(cqout[i]);
Chris@366: 			maxdiffidx = dframe;
Chris@366: 		    }
Chris@366: 		}
Chris@366: 	    }
Chris@366: 	    
Chris@366: 	    if (outframe >= latency) {
Chris@366: 
Chris@366: 		sf_writef_double(sndDiffFile, 
Chris@366: 				 cqout.data(), 
Chris@366: 				 cqout.size());
Chris@366: 
Chris@366: 	    } else if (outframe + (int)cqout.size() >= latency) {
Chris@366: 
Chris@366: 		int offset = latency - outframe;
Chris@366: 		sf_writef_double(sndDiffFile, 
Chris@366: 				 cqout.data() + offset,
Chris@366: 				 cqout.size() - offset);
Chris@366: 	    }
Chris@366: 	}
Chris@366: 
Chris@366: 	inframe += count;
Chris@366: 	outframe += cqout.size();
Chris@366:     }
Chris@366: 
Chris@366:     vector<double> r = cqi.process(cq.getRemainingOutput());
Chris@366:     vector<double> r2 = cqi.getRemainingOutput();
Chris@366: 
Chris@366:     r.insert(r.end(), r2.begin(), r2.end());
Chris@366: 
Chris@366:     for (int i = 0; i < int(r.size()); ++i) {
Chris@366: 	if (r[i] > 1.0) r[i] = 1.0;
Chris@366: 	if (r[i] < -1.0) r[i] = -1.0;
Chris@366:     }
Chris@366: 
Chris@366:     sf_writef_double(sndfileOut, r.data(), r.size());
Chris@366:     if (doDiff) {
Chris@366: 	for (int i = 0; i < (int)r.size(); ++i) {
Chris@366: 	    if (outframe + i >= latency) {
Chris@366: 		int dframe = outframe + i - latency;
Chris@366: 		if (dframe >= (int)buffer.size()) r[i] = 0;
Chris@366: 		else r[i] -= buffer[dframe];
Chris@366: 		if (fabs(r[i]) > maxdiff &&
Chris@366: 		    dframe > sfinfo.samplerate && // ignore first/last sec
Chris@366: 		    dframe + sfinfo.samplerate < sfinfo.frames) {
Chris@366: 		    maxdiff = fabs(r[i]);
Chris@366: 		    maxdiffidx = dframe;
Chris@366: 		}
Chris@366: 	    }
Chris@366: 	}
Chris@366: 	sf_writef_double(sndDiffFile, r.data(), r.size());
Chris@366:     }
Chris@366:     outframe += r.size();
Chris@366: 
Chris@366:     sf_close(sndfile);
Chris@366:     sf_close(sndfileOut);
Chris@366: 
Chris@366:     if (doDiff) {
Chris@366: 	sf_close(sndDiffFile);
Chris@366:     }
Chris@366: 
Chris@366:     cerr << "in: " << inframe << ", out: " << outframe - latency << endl;
Chris@366: 
Chris@366:     if (doDiff) {
Chris@366: 	double db = 10 * log10(maxdiff);
Chris@366: 	cerr << "max diff [excluding first and last second of audio] is "
Chris@366: 	     << maxdiff << " (" << db << " dBFS)"
Chris@366: 	     << " at sample index " << maxdiffidx << endl;
Chris@366:     }
Chris@366:     
Chris@366:     timeval etv;
Chris@366:     (void)gettimeofday(&etv, 0);
Chris@366:         
Chris@366:     etv.tv_sec -= tv.tv_sec;
Chris@366:     if (etv.tv_usec < tv.tv_usec) {
Chris@366: 	etv.tv_usec += 1000000;
Chris@366: 	etv.tv_sec -= 1;
Chris@366:     }
Chris@366:     etv.tv_usec -= tv.tv_usec;
Chris@366:         
Chris@366:     double sec = double(etv.tv_sec) + (double(etv.tv_usec) / 1000000.0);
Chris@366:     cerr << "elapsed time (not counting init): " << sec << " sec, frames/sec at input: " << inframe/sec << endl;
Chris@366: 
Chris@366:     return 0;
Chris@366: }
Chris@366: