comicsansg/CubicSDR
comicsansg/CubicSDR
1
0
Fork 0
mirror of https://github.com/cjcliffe/CubicSDR.git synced 2025-02-03 09:44:26 -05:00
Code Issues Projects Releases Wiki Activity

Merge pull request #48 from cjcliffe/issue46-fft-underrun

Browse Source 
Issue46 fft underrun
This commit is contained in:
Charles J. Cliffe 2015-02-01 21:35:10 -05:00
commit 48399ccc68
6 changed files with 129 additions and 81 deletions
Show Stats Download Patch File Download Diff File Expand all files Collapse all files

4
src/AppFrame.cpp
View File

@ -373,8 +373,8 @@ void AppFrame::OnIdle(wxIdleEvent& event) {
if (demodBw > wxGetApp().getSampleRate() / 2) { if (demodBw > wxGetApp().getSampleRate() / 2) {
demodBw = wxGetApp().getSampleRate() / 2; demodBw = wxGetApp().getSampleRate() / 2;
} }
if (demodBw < 50000) { if (demodBw < 30000) {
demodBw = 50000; demodBw = 30000;
} }
demodWaterfallCanvas->setBandwidth(demodBw); demodWaterfallCanvas->setBandwidth(demodBw);
demodSpectrumCanvas->setBandwidth(demodBw); demodSpectrumCanvas->setBandwidth(demodBw);

2
src/CubicSDR.cpp
View File

@ -29,7 +29,7 @@ bool CubicSDR::OnInit() {
sdrThread = new SDRThread(threadCmdQueueSDR); sdrThread = new SDRThread(threadCmdQueueSDR);
sdrPostThread = new SDRPostThread(); sdrPostThread = new SDRPostThread();
sdrPostThread->setNumVisSamples(2048); sdrPostThread->setNumVisSamples(16384);
iqPostDataQueue = new SDRThreadIQDataQueue; iqPostDataQueue = new SDRThreadIQDataQueue;
iqVisualQueue = new DemodulatorThreadInputQueue; iqVisualQueue = new DemodulatorThreadInputQueue;

2
src/CubicSDRDefs.h
View File

@ -11,7 +11,7 @@ const char filePathSeparator =
#endif #endif
#ifdef __APPLE__ #ifdef __APPLE__
#define BUF_SIZE (16384*2) #define BUF_SIZE (16384*6)
#define DEFAULT_SAMPLE_RATE 2000000 #define DEFAULT_SAMPLE_RATE 2000000
#endif #endif
#ifdef __linux__ #ifdef __linux__

2
src/sdr/SDRPostThread.cpp
View File

@ -6,7 +6,7 @@
#include <deque> #include <deque>
SDRPostThread::SDRPostThread() : SDRPostThread::SDRPostThread() :
iqDataOutQueue(NULL), iqDataInQueue(NULL), iqVisualQueue(NULL), terminated(false), dcFilter(NULL), num_vis_samples(2048) { iqDataOutQueue(NULL), iqDataInQueue(NULL), iqVisualQueue(NULL), terminated(false), dcFilter(NULL), num_vis_samples(16384) {
} }
SDRPostThread::~SDRPostThread() { SDRPostThread::~SDRPostThread() {

195
src/visual/WaterfallCanvas.cpp
View File

@ -36,7 +36,7 @@ wxEND_EVENT_TABLE()
WaterfallCanvas::WaterfallCanvas(wxWindow *parent, int *attribList) : WaterfallCanvas::WaterfallCanvas(wxWindow *parent, int *attribList) :
InteractiveCanvas(parent, attribList), spectrumCanvas(NULL), dragState(WF_DRAG_NONE), nextDragState(WF_DRAG_NONE), fft_size(0), waterfall_lines( InteractiveCanvas(parent, attribList), spectrumCanvas(NULL), dragState(WF_DRAG_NONE), nextDragState(WF_DRAG_NONE), fft_size(0), waterfall_lines(
0), plan( 0), plan(
NULL), in(NULL), out(NULL), resampler(NULL), resamplerRatio(0), lastInputBandwidth(0), zoom(1), mouseZoom(1), otherWaterfallCanvas(NULL), polling(true) { NULL), in(NULL), out(NULL), resampler(NULL), resamplerRatio(0), lastInputBandwidth(0), zoom(1), mouseZoom(1), otherWaterfallCanvas(NULL), polling(true), last_data_size(0), fft_in_data(NULL), fft_last_data(NULL) {
glContext = new WaterfallContext(this, &wxGetApp().GetContext(this)); glContext = new WaterfallContext(this, &wxGetApp().GetContext(this));
@ -64,6 +64,14 @@ void WaterfallCanvas::setup(int fft_size_in, int waterfall_lines_in) {
free(in); free(in);
} }
in = (fftwf_complex*) fftwf_malloc(sizeof(fftwf_complex) * fft_size); in = (fftwf_complex*) fftwf_malloc(sizeof(fftwf_complex) * fft_size);
if (fft_in_data) {
free(fft_in_data);
}
fft_in_data = (fftwf_complex*) fftwf_malloc(sizeof(fftwf_complex) * fft_size);
if (fft_last_data) {
free(fft_last_data);
}
fft_last_data = (fftwf_complex*) fftwf_malloc(sizeof(fftwf_complex) * fft_size);
if (out) { if (out) {
free(out); free(out);
} }
@ -394,11 +402,22 @@ void WaterfallCanvas::setData(DemodulatorThreadIQData *input) {
spectrum_points.resize(fft_size * 2); spectrum_points.resize(fft_size * 2);
} }
unsigned int num_written;
if (isView) { if (isView) {
if (!input->frequency || !input->sampleRate) { if (!input->frequency || !input->sampleRate) {
return; return;
} }
resamplerRatio = (double) (bandwidth) / (double) input->sampleRate;
int desired_input_size = fft_size / resamplerRatio;
if (input->data.size() < desired_input_size) {
// std::cout << "fft underflow, desired: " << desired_input_size << " actual:" << input->data.size() << std::endl;
desired_input_size = input->data.size();
}
if (centerFreq != input->frequency) { if (centerFreq != input->frequency) {
if ((centerFreq - input->frequency) != shiftFrequency || lastInputBandwidth != input->sampleRate) { if ((centerFreq - input->frequency) != shiftFrequency || lastInputBandwidth != input->sampleRate) {
if (abs(input->frequency - centerFreq) < (wxGetApp().getSampleRate() / 2)) { if (abs(input->frequency - centerFreq) < (wxGetApp().getSampleRate() / 2)) {
@ -408,26 +427,24 @@ void WaterfallCanvas::setData(DemodulatorThreadIQData *input) {
} }
} }
if (shiftBuffer.size() != input->data.size()) { if (shiftBuffer.size() != desired_input_size) {
if (shiftBuffer.capacity() < input->data.size()) { if (shiftBuffer.capacity() < desired_input_size) {
shiftBuffer.reserve(input->data.size()); shiftBuffer.reserve(desired_input_size);
} }
shiftBuffer.resize(input->data.size()); shiftBuffer.resize(desired_input_size);
} }
if (shiftFrequency < 0) { if (shiftFrequency < 0) {
nco_crcf_mix_block_up(freqShifter, &input->data[0], &shiftBuffer[0], input->data.size()); nco_crcf_mix_block_up(freqShifter, &input->data[0], &shiftBuffer[0], desired_input_size);
} else { } else {
nco_crcf_mix_block_down(freqShifter, &input->data[0], &shiftBuffer[0], input->data.size()); nco_crcf_mix_block_down(freqShifter, &input->data[0], &shiftBuffer[0], desired_input_size);
} }
} else { } else {
shiftBuffer.assign(input->data.begin(), input->data.end()); shiftBuffer.assign(input->data.begin(), input->data.end());
} }
if (!resampler || bandwidth != lastBandwidth || lastInputBandwidth != input->sampleRate) { if (!resampler || bandwidth != lastBandwidth || lastInputBandwidth != input->sampleRate) {
resamplerRatio = (double) (bandwidth) / (double) input->sampleRate; float As = 60.0f;
float As = 120.0f;
if (resampler) { if (resampler) {
msresamp_crcf_destroy(resampler); msresamp_crcf_destroy(resampler);
@ -438,7 +455,8 @@ void WaterfallCanvas::setData(DemodulatorThreadIQData *input) {
lastInputBandwidth = input->sampleRate; lastInputBandwidth = input->sampleRate;
} }
int out_size = ceil((double) (input->data.size()) * resamplerRatio) + 512;
int out_size = ceil((double) (desired_input_size) * resamplerRatio) + 512;
if (resampleBuffer.size() != out_size) { if (resampleBuffer.size() != out_size) {
if (resampleBuffer.capacity() < out_size) { if (resampleBuffer.capacity() < out_size) {
@ -447,104 +465,131 @@ void WaterfallCanvas::setData(DemodulatorThreadIQData *input) {
resampleBuffer.resize(out_size); resampleBuffer.resize(out_size);
} }
unsigned int num_written;
msresamp_crcf_execute(resampler, &shiftBuffer[0], input->data.size(), &resampleBuffer[0], &num_written); msresamp_crcf_execute(resampler, &shiftBuffer[0], desired_input_size, &resampleBuffer[0], &num_written);
resampleBuffer.resize(fft_size); resampleBuffer.resize(fft_size);
if (num_written < fft_size) { if (num_written < fft_size) {
for (int i = 0; i < num_written; i++) { for (int i = 0; i < num_written; i++) {
in[i][0] = resampleBuffer[i].real; fft_in_data[i][0] = resampleBuffer[i].real;
in[i][1] = resampleBuffer[i].imag; fft_in_data[i][1] = resampleBuffer[i].imag;
} }
for (int i = num_written; i < fft_size; i++) { for (int i = num_written; i < fft_size; i++) {
in[i][0] = 0; fft_in_data[i][0] = 0;
in[i][1] = 0; fft_in_data[i][1] = 0;
} }
} else { } else {
for (int i = 0; i < fft_size; i++) { for (int i = 0; i < fft_size; i++) {
in[i][0] = resampleBuffer[i].real; fft_in_data[i][0] = resampleBuffer[i].real;
in[i][1] = resampleBuffer[i].imag; fft_in_data[i][1] = resampleBuffer[i].imag;
} }
} }
} else { } else {
num_written = data->size();
if (data->size() < fft_size) { if (data->size() < fft_size) {
for (int i = 0, iMax = data->size(); i < iMax; i++) { for (int i = 0, iMax = data->size(); i < iMax; i++) {
in[i][0] = (*data)[i].real; fft_in_data[i][0] = (*data)[i].real;
in[i][1] = (*data)[i].imag; fft_in_data[i][1] = (*data)[i].imag;
} }
for (int i = data->size(); i < fft_size; i++) { for (int i = data->size(); i < fft_size; i++) {
in[i][0] = 0; fft_in_data[i][0] = 0;
in[i][1] = 0; fft_in_data[i][1] = 0;
} }
} else { } else {
for (int i = 0; i < fft_size; i++) { for (int i = 0; i < fft_size; i++) {
in[i][0] = (*data)[i].real; fft_in_data[i][0] = (*data)[i].real;
in[i][1] = (*data)[i].imag; fft_in_data[i][1] = (*data)[i].imag;
} }
} }
} }
fftwf_execute(plan); bool execute = false;
float fft_ceil = 0, fft_floor = 1; if (num_written >= fft_size) {
execute = true;
memcpy(in, fft_in_data, fft_size * sizeof(fftwf_complex));
memcpy(fft_last_data, in, fft_size * sizeof(fftwf_complex));
if (fft_result.size() < fft_size) { } else {
fft_result.resize(fft_size); if (last_data_size + num_written < fft_size) { // priming
fft_result_ma.resize(fft_size); unsigned int num_copy = fft_size;
fft_result_maa.resize(fft_size); num_copy = fft_size - last_data_size;
} if (num_written > num_copy) {
num_copy = num_written;
int n; }
for (int i = 0, iMax = fft_size / 2; i < iMax; i++) { memcpy(fft_last_data, fft_in_data, num_copy * sizeof(fftwf_complex));
n = (i == 0) ? 1 : i; last_data_size += num_copy;
float a = out[n][0];
float b = out[n][1];
float c = sqrt(a * a + b * b);
float x = out[fft_size / 2 + n][0];
float y = out[fft_size / 2 + n][1];
float z = sqrt(x * x + y * y);
fft_result[i] = (z);
fft_result[fft_size / 2 + i] = (c);
}
for (int i = 0, iMax = fft_size; i < iMax; i++) {
if (isView) {
fft_result_maa[i] += (fft_result_ma[i] - fft_result_maa[i]) * 0.65;
fft_result_ma[i] += (fft_result[i] - fft_result_ma[i]) * 0.65;
} else { } else {
fft_result_maa[i] += (fft_result_ma[i] - fft_result_maa[i]) * 0.65; unsigned int num_last = (fft_size - num_written);
fft_result_ma[i] += (fft_result[i] - fft_result_ma[i]) * 0.65; memcpy(in, fft_last_data + (last_data_size - num_last), num_last * sizeof(fftwf_complex));
} memcpy(in + num_last, fft_in_data, num_written * sizeof(fftwf_complex));
memcpy(fft_last_data, in, fft_size * sizeof(fftwf_complex));
if (fft_result_maa[i] > fft_ceil) { execute = true;
fft_ceil = fft_result_maa[i];
}
if (fft_result_maa[i] < fft_floor) {
fft_floor = fft_result_maa[i];
} }
} }
fft_ceil += 0.25; if (execute) {
fft_floor -= 1; fftwf_execute(plan);
fft_ceil_ma = fft_ceil_ma + (fft_ceil - fft_ceil_ma) * 0.05; float fft_ceil = 0, fft_floor = 1;
fft_ceil_maa = fft_ceil_maa + (fft_ceil_ma - fft_ceil_maa) * 0.05;
fft_floor_ma = fft_floor_ma + (fft_floor - fft_floor_ma) * 0.05; if (fft_result.size() < fft_size) {
fft_floor_maa = fft_floor_maa + (fft_floor_ma - fft_floor_maa) * 0.05; fft_result.resize(fft_size);
fft_result_ma.resize(fft_size);
fft_result_maa.resize(fft_size);
}
for (int i = 0, iMax = fft_size; i < iMax; i++) { int n;
float v = (log10(fft_result_maa[i] - fft_floor_maa) / log10(fft_ceil_maa - fft_floor_maa)); for (int i = 0, iMax = fft_size / 2; i < iMax; i++) {
spectrum_points[i * 2] = ((float) i / (float) iMax); n = (i == 0) ? 1 : i;
spectrum_points[i * 2 + 1] = v; float a = out[n][0];
} float b = out[n][1];
float c = sqrt(a * a + b * b);
if (spectrumCanvas) { float x = out[fft_size / 2 + n][0];
spectrumCanvas->spectrum_points.assign(spectrum_points.begin(), spectrum_points.end()); float y = out[fft_size / 2 + n][1];
float z = sqrt(x * x + y * y);
fft_result[i] = (z);
fft_result[fft_size / 2 + i] = (c);
}
for (int i = 0, iMax = fft_size; i < iMax; i++) {
if (isView) {
fft_result_maa[i] += (fft_result_ma[i] - fft_result_maa[i]) * 0.65;
fft_result_ma[i] += (fft_result[i] - fft_result_ma[i]) * 0.65;
} else {
fft_result_maa[i] += (fft_result_ma[i] - fft_result_maa[i]) * 0.65;
fft_result_ma[i] += (fft_result[i] - fft_result_ma[i]) * 0.65;
}
if (fft_result_maa[i] > fft_ceil) {
fft_ceil = fft_result_maa[i];
}
if (fft_result_maa[i] < fft_floor) {
fft_floor = fft_result_maa[i];
}
}
fft_ceil += 0.25;
fft_floor -= 1;
fft_ceil_ma = fft_ceil_ma + (fft_ceil - fft_ceil_ma) * 0.05;
fft_ceil_maa = fft_ceil_maa + (fft_ceil_ma - fft_ceil_maa) * 0.05;
fft_floor_ma = fft_floor_ma + (fft_floor - fft_floor_ma) * 0.05;
fft_floor_maa = fft_floor_maa + (fft_floor_ma - fft_floor_maa) * 0.05;
for (int i = 0, iMax = fft_size; i < iMax; i++) {
float v = (log10(fft_result_maa[i] - fft_floor_maa) / log10(fft_ceil_maa - fft_floor_maa));
spectrum_points[i * 2] = ((float) i / (float) iMax);
spectrum_points[i * 2 + 1] = v;
}
if (spectrumCanvas) {
spectrumCanvas->spectrum_points.assign(spectrum_points.begin(), spectrum_points.end());
}
} }
} }
} }

5
src/visual/WaterfallCanvas.h
View File

@ -56,7 +56,8 @@ private:
WaterfallCanvas *otherWaterfallCanvas; WaterfallCanvas *otherWaterfallCanvas;
bool polling; bool polling;
fftwf_complex *in, *out; fftwf_complex *in, *out, *fft_in_data, *fft_last_data;
unsigned int last_data_size;
fftwf_plan plan; fftwf_plan plan;
float fft_ceil_ma, fft_ceil_maa; float fft_ceil_ma, fft_ceil_maa;
@ -84,6 +85,8 @@ private:
std::vector<liquid_float_complex> shiftBuffer; std::vector<liquid_float_complex> shiftBuffer;
std::vector<liquid_float_complex> resampleBuffer; std::vector<liquid_float_complex> resampleBuffer;
// event table // event table
wxDECLARE_EVENT_TABLE(); wxDECLARE_EVENT_TABLE();
}; };