Refactor for sample rate changes, audio thread race crash fixes

This commit is contained in:
Charles J. Cliffe 2015-03-15 21:02:26 -04:00
parent b197a7ddb2
commit 4147582d2a
12 changed files with 211 additions and 65 deletions

View File

@ -251,9 +251,9 @@ wxFrame(NULL, wxID_ANY, CUBICSDR_TITLE), activeDemodulator(NULL) {
wxMenuItem *itm = subMenu->AppendRadioItem(menu_id+j, srateName.str(), wxT("Description?")); wxMenuItem *itm = subMenu->AppendRadioItem(menu_id+j, srateName.str(), wxT("Description?"));
if ((*srate) == DEFAULT_AUDIO_SAMPLE_RATE) { if ((*srate) == DEFAULT_AUDIO_SAMPLE_RATE) {
AudioThread::deviceSampleRate[mdevices_i->first] = DEFAULT_AUDIO_SAMPLE_RATE;
itm->Check(true); itm->Check(true);
} }
audioSampleRateMenuItems[menu_id+j] = itm; audioSampleRateMenuItems[menu_id+j] = itm;
j++; j++;

View File

@ -2,7 +2,9 @@
#include "CubicSDRDefs.h" #include "CubicSDRDefs.h"
#include <vector> #include <vector>
#include <algorithm> #include <algorithm>
#include "CubicSDR.h"
#include "DemodulatorThread.h" #include "DemodulatorThread.h"
#include "DemodulatorInstance.h"
#include <memory.h> #include <memory.h>
std::map<int, AudioThread *> AudioThread::deviceController; std::map<int, AudioThread *> AudioThread::deviceController;
@ -11,7 +13,7 @@ std::map<int, std::thread *> AudioThread::deviceThread;
AudioThread::AudioThread(AudioThreadInputQueue *inputQueue, DemodulatorThreadCommandQueue* threadQueueNotify) : AudioThread::AudioThread(AudioThreadInputQueue *inputQueue, DemodulatorThreadCommandQueue* threadQueueNotify) :
currentInput(NULL), inputQueue(inputQueue), audioQueuePtr(0), underflowCount(0), terminated(false), active(false), outputDevice(-1), gain( currentInput(NULL), inputQueue(inputQueue), audioQueuePtr(0), underflowCount(0), terminated(false), active(false), outputDevice(-1), gain(
1.0), threadQueueNotify(threadQueueNotify), sampleRate(DEFAULT_AUDIO_SAMPLE_RATE), nBufferFrames(256) { 1.0), threadQueueNotify(threadQueueNotify), sampleRate(0), nBufferFrames(1024) {
boundThreads = new std::vector<AudioThread *>; boundThreads = new std::vector<AudioThread *>;
} }
@ -68,33 +70,53 @@ static int audioCallback(void *outputBuffer, void *inputBuffer, unsigned int nBu
} }
if (!srcmix->currentInput) { if (!srcmix->currentInput) {
if (srcmix->terminated) { srcmix->audioQueuePtr = 0;
if (srcmix->terminated || srcmix->inputQueue->empty()) {
continue; continue;
} }
srcmix->inputQueue->pop(srcmix->currentInput); srcmix->inputQueue->pop(srcmix->currentInput);
if (srcmix->terminated) { if (srcmix->terminated) {
continue; continue;
} }
srcmix->audioQueuePtr = 0;
continue; continue;
} }
std::lock_guard < std::mutex > lock(srcmix->currentInput->m_mutex); // std::lock_guard < std::mutex > lock(srcmix->currentInput->m_mutex);
if (srcmix->currentInput->sampleRate != src->getSampleRate()) {
while (srcmix->inputQueue->size()) {
srcmix->inputQueue->pop(srcmix->currentInput);
if (srcmix->currentInput) {
if (srcmix->currentInput->sampleRate == src->getSampleRate()) {
break;
}
srcmix->currentInput->decRefCount();
}
srcmix->currentInput = NULL;
}
srcmix->audioQueuePtr = 0;
if (!srcmix->currentInput) {
continue;
}
}
if (srcmix->currentInput->channels == 0 || !srcmix->currentInput->data.size()) { if (srcmix->currentInput->channels == 0 || !srcmix->currentInput->data.size()) {
if (!srcmix->inputQueue->empty()) { if (!srcmix->inputQueue->empty()) {
srcmix->audioQueuePtr = 0;
if (srcmix->currentInput) { if (srcmix->currentInput) {
srcmix->currentInput->decRefCount(); srcmix->currentInput->decRefCount();
srcmix->currentInput = NULL; srcmix->currentInput = NULL;
} }
if (srcmix->terminated) { if (srcmix->terminated || srcmix->inputQueue->empty()) {
continue; continue;
} }
srcmix->inputQueue->pop(srcmix->currentInput); srcmix->inputQueue->pop(srcmix->currentInput);
if (srcmix->terminated) { if (srcmix->terminated) {
continue; continue;
} }
srcmix->audioQueuePtr = 0;
} }
continue; continue;
} }
@ -104,18 +126,18 @@ static int audioCallback(void *outputBuffer, void *inputBuffer, unsigned int nBu
if (srcmix->currentInput->channels == 1) { if (srcmix->currentInput->channels == 1) {
for (int i = 0; i < nBufferFrames; i++) { for (int i = 0; i < nBufferFrames; i++) {
if (srcmix->audioQueuePtr >= srcmix->currentInput->data.size()) { if (srcmix->audioQueuePtr >= srcmix->currentInput->data.size()) {
srcmix->audioQueuePtr = 0;
if (srcmix->currentInput) { if (srcmix->currentInput) {
srcmix->currentInput->decRefCount(); srcmix->currentInput->decRefCount();
srcmix->currentInput = NULL; srcmix->currentInput = NULL;
} }
if (srcmix->terminated) { if (srcmix->terminated || srcmix->inputQueue->empty()) {
continue; break;
} }
srcmix->inputQueue->pop(srcmix->currentInput); srcmix->inputQueue->pop(srcmix->currentInput);
if (srcmix->terminated) { if (srcmix->terminated) {
continue; break;
} }
srcmix->audioQueuePtr = 0;
float srcPeak = srcmix->currentInput->peak * srcmix->gain; float srcPeak = srcmix->currentInput->peak * srcmix->gain;
if (mixPeak < srcPeak) { if (mixPeak < srcPeak) {
mixPeak = srcPeak; mixPeak = srcPeak;
@ -131,18 +153,18 @@ static int audioCallback(void *outputBuffer, void *inputBuffer, unsigned int nBu
} else { } else {
for (int i = 0, iMax = srcmix->currentInput->channels * nBufferFrames; i < iMax; i++) { for (int i = 0, iMax = srcmix->currentInput->channels * nBufferFrames; i < iMax; i++) {
if (srcmix->audioQueuePtr >= srcmix->currentInput->data.size()) { if (srcmix->audioQueuePtr >= srcmix->currentInput->data.size()) {
srcmix->audioQueuePtr = 0;
if (srcmix->currentInput) { if (srcmix->currentInput) {
srcmix->currentInput->decRefCount(); srcmix->currentInput->decRefCount();
srcmix->currentInput = NULL; srcmix->currentInput = NULL;
} }
if (srcmix->terminated) { if (srcmix->terminated || srcmix->inputQueue->empty()) {
continue; break;
} }
srcmix->inputQueue->pop(srcmix->currentInput); srcmix->inputQueue->pop(srcmix->currentInput);
if (srcmix->terminated) { if (srcmix->terminated) {
continue; break;
} }
srcmix->audioQueuePtr = 0;
float srcPeak = srcmix->currentInput->peak * srcmix->gain; float srcPeak = srcmix->currentInput->peak * srcmix->gain;
if (mixPeak < srcPeak) { if (mixPeak < srcPeak) {
mixPeak = srcPeak; mixPeak = srcPeak;
@ -228,12 +250,37 @@ void AudioThread::setDeviceSampleRate(int deviceId, int sampleRate) {
} }
void AudioThread::setSampleRate(int sampleRate) { void AudioThread::setSampleRate(int sampleRate) {
deviceSampleRate[outputDevice] = sampleRate; if (deviceController[outputDevice.load()] == this) {
deviceSampleRate[outputDevice.load()] = sampleRate;
dac.stopStream();
dac.closeStream();
for (int j = 0; j < boundThreads.load()->size(); j++) {
AudioThread *srcmix = (*(boundThreads.load()))[j];
srcmix->setSampleRate(sampleRate);
}
std::vector<DemodulatorInstance *>::iterator demod_i;
std::vector<DemodulatorInstance *> *demodulators;
demodulators = &wxGetApp().getDemodMgr().getDemodulators();
for (demod_i = demodulators->begin(); demod_i != demodulators->end(); demod_i++) {
if ((*demod_i)->getOutputDevice() == outputDevice.load()) {
(*demod_i)->setAudioSampleRate(sampleRate);
}
}
dac.openStream(&parameters, NULL, RTAUDIO_FLOAT32, sampleRate, &nBufferFrames, &audioCallback, (void *) this, &opts);
dac.startStream();
}
this->sampleRate = sampleRate; this->sampleRate = sampleRate;
dac.stopStream(); }
dac.closeStream();
dac.openStream(&parameters, NULL, RTAUDIO_FLOAT32, sampleRate, &nBufferFrames, &audioCallback, (void *) this, &opts); int AudioThread::getSampleRate() {
dac.startStream(); return this->sampleRate;
} }
void AudioThread::setupDevice(int deviceId) { void AudioThread::setupDevice(int deviceId) {
@ -253,15 +300,17 @@ void AudioThread::setupDevice(int deviceId) {
// opts.flags = RTAUDIO_MINIMIZE_LATENCY; // opts.flags = RTAUDIO_MINIMIZE_LATENCY;
opts.flags = RTAUDIO_SCHEDULE_REALTIME; opts.flags = RTAUDIO_SCHEDULE_REALTIME;
if (deviceSampleRate.find(parameters.deviceId) != deviceSampleRate.end()) {
sampleRate = deviceSampleRate[parameters.deviceId];
} else {
sampleRate = DEFAULT_AUDIO_SAMPLE_RATE;
deviceSampleRate[parameters.deviceId] = sampleRate;
}
if (deviceController.find(parameters.deviceId) == deviceController.end()) { if (deviceController.find(parameters.deviceId) == deviceController.end()) {
deviceController[parameters.deviceId] = new AudioThread(NULL, NULL); deviceController[parameters.deviceId] = new AudioThread(NULL, NULL);
int srate = DEFAULT_AUDIO_SAMPLE_RATE;
if (deviceSampleRate.find(parameters.deviceId) != deviceSampleRate.end()) { deviceController[parameters.deviceId]->setInitOutputDevice(parameters.deviceId, sampleRate);
srate = deviceSampleRate[parameters.deviceId];
} else {
deviceSampleRate[parameters.deviceId] = srate;
}
deviceController[parameters.deviceId]->setInitOutputDevice(parameters.deviceId, srate);
deviceController[parameters.deviceId]->bindThread(this); deviceController[parameters.deviceId]->bindThread(this);
deviceThread[parameters.deviceId] = new std::thread(&AudioThread::threadMain, deviceController[parameters.deviceId]); deviceThread[parameters.deviceId] = new std::thread(&AudioThread::threadMain, deviceController[parameters.deviceId]);

View File

@ -68,6 +68,7 @@ public:
void setInitOutputDevice(int deviceId, int sampleRate=-1); void setInitOutputDevice(int deviceId, int sampleRate=-1);
int getOutputDevice(); int getOutputDevice();
void setSampleRate(int sampleRate); void setSampleRate(int sampleRate);
int getSampleRate();
void threadMain(); void threadMain();
void terminate(); void terminate();

View File

@ -21,6 +21,7 @@ public:
DEMOD_THREAD_CMD_NULL, DEMOD_THREAD_CMD_NULL,
DEMOD_THREAD_CMD_SET_BANDWIDTH, DEMOD_THREAD_CMD_SET_BANDWIDTH,
DEMOD_THREAD_CMD_SET_FREQUENCY, DEMOD_THREAD_CMD_SET_FREQUENCY,
DEMOD_THREAD_CMD_SET_AUDIO_RATE,
DEMOD_THREAD_CMD_DEMOD_PREPROCESS_TERMINATED, DEMOD_THREAD_CMD_DEMOD_PREPROCESS_TERMINATED,
DEMOD_THREAD_CMD_DEMOD_TERMINATED, DEMOD_THREAD_CMD_DEMOD_TERMINATED,
DEMOD_THREAD_CMD_AUDIO_TERMINATED DEMOD_THREAD_CMD_AUDIO_TERMINATED
@ -78,9 +79,13 @@ public:
msresamp_rrrf audioResampler; msresamp_rrrf audioResampler;
msresamp_rrrf stereoResampler; msresamp_rrrf stereoResampler;
double audioResampleRatio; double audioResampleRatio;
int audioSampleRate;
firfilt_rrrf firStereoLeft;
firfilt_rrrf firStereoRight;
DemodulatorThreadPostIQData() : DemodulatorThreadPostIQData() :
sampleRate(0), audioResampler(NULL), stereoResampler(NULL), audioResampleRatio(0) { sampleRate(0), audioResampler(NULL), stereoResampler(NULL), audioResampleRatio(0), audioSampleRate(0), firStereoLeft(NULL), firStereoRight(NULL) {
} }

View File

@ -50,6 +50,8 @@ void DemodulatorInstance::run() {
currentFrequency = demodulatorPreThread->getParams().frequency; currentFrequency = demodulatorPreThread->getParams().frequency;
currentDemodType = demodulatorThread->getDemodulatorType(); currentDemodType = demodulatorThread->getDemodulatorType();
currentAudioSampleRate = AudioThread::deviceSampleRate[getOutputDevice()];
demodulatorPreThread->getParams().audioSampleRate = currentAudioSampleRate;
t_Audio = new std::thread(&AudioThread::threadMain, audioThread); t_Audio = new std::thread(&AudioThread::threadMain, audioThread);
@ -215,6 +217,8 @@ void DemodulatorInstance::setOutputDevice(int device_id) {
if (!active) { if (!active) {
audioThread->setInitOutputDevice(device_id); audioThread->setInitOutputDevice(device_id);
} else if (audioThread) { } else if (audioThread) {
setAudioSampleRate(AudioThread::deviceSampleRate[device_id]);
AudioThreadCommand command; AudioThreadCommand command;
command.cmd = AudioThreadCommand::AUDIO_THREAD_CMD_SET_DEVICE; command.cmd = AudioThreadCommand::AUDIO_THREAD_CMD_SET_DEVICE;
command.int_value = device_id; command.int_value = device_id;
@ -225,10 +229,10 @@ void DemodulatorInstance::setOutputDevice(int device_id) {
int DemodulatorInstance::getOutputDevice() { int DemodulatorInstance::getOutputDevice() {
if (currentOutputDevice == -1) { if (currentOutputDevice == -1) {
return audioThread->getOutputDevice(); currentOutputDevice = audioThread->getOutputDevice();
} else {
return currentOutputDevice;
} }
return currentOutputDevice;
} }
void DemodulatorInstance::checkBandwidth() { void DemodulatorInstance::checkBandwidth() {
@ -302,6 +306,28 @@ long long DemodulatorInstance::getFrequency() {
return currentFrequency; return currentFrequency;
} }
void DemodulatorInstance::setAudioSampleRate(int sampleRate) {
if (terminated) {
currentAudioSampleRate = sampleRate;
demodulatorPreThread->getParams().audioSampleRate = sampleRate;
} else if (demodulatorPreThread && threadQueueCommand) {
DemodulatorThreadCommand command;
command.cmd = DemodulatorThreadCommand::DEMOD_THREAD_CMD_SET_AUDIO_RATE;
currentAudioSampleRate = sampleRate;
command.llong_value = sampleRate;
threadQueueCommand->push(command);
}
}
int DemodulatorInstance::getAudioSampleRate() {
if (!currentAudioSampleRate) {
currentAudioSampleRate = audioThread->getSampleRate();
}
return currentAudioSampleRate;
}
void DemodulatorInstance::setGain(float gain_in) { void DemodulatorInstance::setGain(float gain_in) {
audioThread->setGain(gain_in); audioThread->setGain(gain_in);
} }

View File

@ -73,6 +73,11 @@ public:
void setFrequency(long long freq); void setFrequency(long long freq);
long long getFrequency(); long long getFrequency();
void setAudioSampleRate(int sampleRate);
int getAudioSampleRate();
private: private:
void checkBandwidth(); void checkBandwidth();
@ -90,4 +95,5 @@ private:
int currentBandwidth; int currentBandwidth;
int currentDemodType; int currentDemodType;
int currentOutputDevice; int currentOutputDevice;
int currentAudioSampleRate;
}; };

View File

@ -11,7 +11,7 @@
DemodulatorPreThread::DemodulatorPreThread(DemodulatorThreadInputQueue* iqInputQueue, DemodulatorThreadPostInputQueue* iqOutputQueue, DemodulatorPreThread::DemodulatorPreThread(DemodulatorThreadInputQueue* iqInputQueue, DemodulatorThreadPostInputQueue* iqOutputQueue,
DemodulatorThreadControlCommandQueue *threadQueueControl, DemodulatorThreadCommandQueue* threadQueueNotify) : DemodulatorThreadControlCommandQueue *threadQueueControl, DemodulatorThreadCommandQueue* threadQueueNotify) :
iqInputQueue(iqInputQueue), iqOutputQueue(iqOutputQueue), terminated(false), initialized(false), audioResampler(NULL), stereoResampler(NULL), iqResampleRatio( iqInputQueue(iqInputQueue), iqOutputQueue(iqOutputQueue), terminated(false), initialized(false), audioResampler(NULL), stereoResampler(NULL), iqResampleRatio(
1), audioResampleRatio(1), iqResampler(NULL), commandQueue(NULL), threadQueueNotify(threadQueueNotify), threadQueueControl( 1), audioResampleRatio(1), firStereoRight(NULL), firStereoLeft(NULL), iqResampler(NULL), commandQueue(NULL), threadQueueNotify(threadQueueNotify), threadQueueControl(
threadQueueControl) { threadQueueControl) {
freqShifter = nco_crcf_create(LIQUID_VCO); freqShifter = nco_crcf_create(LIQUID_VCO);
@ -36,8 +36,27 @@ void DemodulatorPreThread::initialize() {
audioResampler = msresamp_rrrf_create(audioResampleRatio, As); audioResampler = msresamp_rrrf_create(audioResampleRatio, As);
stereoResampler = msresamp_rrrf_create(audioResampleRatio, As); stereoResampler = msresamp_rrrf_create(audioResampleRatio, As);
// Stereo filters / shifters
double firStereoCutoff = 0.5 * ((double) 36000 / (double) params.audioSampleRate); // filter cutoff frequency
float ft = 0.05f; // filter transition
float mu = 0.0f; // fractional timing offset
if (firStereoCutoff < 0) {
firStereoCutoff = 0;
}
if (firStereoCutoff > 0.5) {
firStereoCutoff = 0.5;
}
unsigned int h_len = estimate_req_filter_len(ft, As);
float *h = new float[h_len];
liquid_firdes_kaiser(h_len, firStereoCutoff, As, mu, h);
firStereoLeft = firfilt_rrrf_create(h, h_len);
firStereoRight = firfilt_rrrf_create(h, h_len);
initialized = true; initialized = true;
// std::cout << "inputResampleRate " << params.bandwidth << std::endl;
lastParams = params; lastParams = params;
} }
@ -100,7 +119,11 @@ void DemodulatorPreThread::threadMain() {
bandwidthChanged = true; bandwidthChanged = true;
break; break;
case DemodulatorThreadCommand::DEMOD_THREAD_CMD_SET_FREQUENCY: case DemodulatorThreadCommand::DEMOD_THREAD_CMD_SET_FREQUENCY:
params.frequency = command.llong_value; params.frequency = tempParams.frequency = command.llong_value;
break;
case DemodulatorThreadCommand::DEMOD_THREAD_CMD_SET_AUDIO_RATE:
tempParams.audioSampleRate = (int)command.llong_value;
rateChanged = true;
break; break;
default: default:
break; break;
@ -228,7 +251,10 @@ void DemodulatorPreThread::threadMain() {
resamp->audioResampleRatio = audioResampleRatio; resamp->audioResampleRatio = audioResampleRatio;
resamp->audioResampler = audioResampler; resamp->audioResampler = audioResampler;
resamp->audioSampleRate = params.audioSampleRate;
resamp->stereoResampler = stereoResampler; resamp->stereoResampler = stereoResampler;
resamp->firStereoLeft = firStereoLeft;
resamp->firStereoRight = firStereoRight;
resamp->sampleRate = params.bandwidth; resamp->sampleRate = params.bandwidth;
iqOutputQueue->push(resamp); iqOutputQueue->push(resamp);
@ -245,23 +271,34 @@ void DemodulatorPreThread::threadMain() {
case DemodulatorWorkerThreadResult::DEMOD_WORKER_THREAD_RESULT_FILTERS: case DemodulatorWorkerThreadResult::DEMOD_WORKER_THREAD_RESULT_FILTERS:
msresamp_crcf_destroy(iqResampler); msresamp_crcf_destroy(iqResampler);
if (result.iqResampler) { if (result.iqResampler) {
iqResampler = result.iqResampler; iqResampler = result.iqResampler;
iqResampleRatio = result.iqResampleRatio; iqResampleRatio = result.iqResampleRatio;
} }
if (result.firStereoLeft) {
firStereoLeft = result.firStereoLeft;
}
if (result.firStereoRight) {
firStereoRight = result.firStereoRight;
}
if (result.audioResampler) { if (result.audioResampler) {
audioResampler = result.audioResampler; audioResampler = result.audioResampler;
audioResampleRatio = result.audioResamplerRatio; audioResampleRatio = result.audioResamplerRatio;
stereoResampler = result.stereoResampler; stereoResampler = result.stereoResampler;
}
if (result.audioSampleRate) {
params.audioSampleRate = result.audioSampleRate; params.audioSampleRate = result.audioSampleRate;
} }
if (params.bandwidth) { if (result.bandwidth) {
params.bandwidth = result.bandwidth; params.bandwidth = result.bandwidth;
} }
if (params.sampleRate) {
if (result.sampleRate) {
params.sampleRate = result.sampleRate; params.sampleRate = result.sampleRate;
} }
break; break;

View File

@ -58,6 +58,9 @@ protected:
msresamp_rrrf stereoResampler; msresamp_rrrf stereoResampler;
double audioResampleRatio; double audioResampleRatio;
firfilt_rrrf firStereoLeft;
firfilt_rrrf firStereoRight;
DemodulatorThreadParameters params; DemodulatorThreadParameters params;
DemodulatorThreadParameters lastParams; DemodulatorThreadParameters lastParams;

View File

@ -16,7 +16,7 @@ DemodulatorThread::DemodulatorThread(DemodulatorThreadPostInputQueue* iqInputQue
iqInputQueue(iqInputQueue), audioVisOutputQueue(NULL), audioOutputQueue(NULL), iqAutoGain(NULL), amOutputCeil(1), amOutputCeilMA(1), amOutputCeilMAA( iqInputQueue(iqInputQueue), audioVisOutputQueue(NULL), audioOutputQueue(NULL), iqAutoGain(NULL), amOutputCeil(1), amOutputCeilMA(1), amOutputCeilMAA(
1), stereo(false), terminated( 1), stereo(false), terminated(
false), demodulatorType(DEMOD_TYPE_FM), threadQueueNotify(threadQueueNotify), threadQueueControl(threadQueueControl), squelchLevel(0), signalLevel( false), demodulatorType(DEMOD_TYPE_FM), threadQueueNotify(threadQueueNotify), threadQueueControl(threadQueueControl), squelchLevel(0), signalLevel(
0), squelchEnabled(false) { 0), squelchEnabled(false), audioSampleRate(0) {
demodFM = freqdem_create(0.5); demodFM = freqdem_create(0.5);
demodAM_USB = ampmodem_create(0.5, 0.0, LIQUID_AMPMODEM_USB, 1); demodAM_USB = ampmodem_create(0.5, 0.0, LIQUID_AMPMODEM_USB, 1);
@ -46,29 +46,6 @@ void DemodulatorThread::threadMain() {
firfilt_rrrf firStereoLeft = NULL; firfilt_rrrf firStereoLeft = NULL;
firfilt_rrrf firStereoRight = NULL; firfilt_rrrf firStereoRight = NULL;
// Stereo filters / shifters
double firStereoCutoff = 0.5 * ((double) 36000 / (double) DEFAULT_AUDIO_SAMPLE_RATE); // filter cutoff frequency
float ft = 0.05f; // filter transition
float As = 120.0f; // stop-band attenuation [dB]
float mu = 0.0f; // fractional timing offset
if (firStereoCutoff < 0) {
firStereoCutoff = 0;
}
if (firStereoCutoff > 0.5) {
firStereoCutoff = 0.5;
}
unsigned int h_len = estimate_req_filter_len(ft, As);
float *h = new float[h_len];
liquid_firdes_kaiser(h_len, firStereoCutoff, As, mu, h);
firStereoLeft = firfilt_rrrf_create(h, h_len);
firStereoRight = firfilt_rrrf_create(h, h_len);
delete h;
liquid_float_complex x, y, z[2]; liquid_float_complex x, y, z[2];
float rz[2]; float rz[2];
@ -124,11 +101,15 @@ void DemodulatorThread::threadMain() {
if (audioResampler == NULL) { if (audioResampler == NULL) {
audioResampler = inp->audioResampler; audioResampler = inp->audioResampler;
stereoResampler = inp->stereoResampler; stereoResampler = inp->stereoResampler;
firStereoLeft = inp->firStereoLeft;
firStereoRight = inp->firStereoRight;
audioSampleRate = inp->audioSampleRate;
} else if (audioResampler != inp->audioResampler) { } else if (audioResampler != inp->audioResampler) {
msresamp_rrrf_destroy(audioResampler); msresamp_rrrf_destroy(audioResampler);
msresamp_rrrf_destroy(stereoResampler); msresamp_rrrf_destroy(stereoResampler);
audioResampler = inp->audioResampler; audioResampler = inp->audioResampler;
stereoResampler = inp->stereoResampler; stereoResampler = inp->stereoResampler;
audioSampleRate = inp->audioSampleRate;
if (demodAM) { if (demodAM) {
ampmodem_reset(demodAM); ampmodem_reset(demodAM);
@ -136,6 +117,20 @@ void DemodulatorThread::threadMain() {
freqdem_reset(demodFM); freqdem_reset(demodFM);
} }
if (firStereoLeft != inp->firStereoLeft) {
if (firStereoLeft != NULL) {
firfilt_rrrf_destroy(firStereoLeft);
}
firStereoLeft = inp->firStereoLeft;
}
if (firStereoRight != inp->firStereoRight) {
if (firStereoRight != NULL) {
firfilt_rrrf_destroy(firStereoRight);
}
firStereoRight = inp->firStereoRight;
}
if (agcData.size() != bufSize) { if (agcData.size() != bufSize) {
if (agcData.capacity() < bufSize) { if (agcData.capacity() < bufSize) {
agcData.reserve(bufSize); agcData.reserve(bufSize);
@ -274,6 +269,7 @@ void DemodulatorThread::threadMain() {
outputBuffers.push_back(ati); outputBuffers.push_back(ati);
} }
ati->sampleRate = audioSampleRate;
ati->setRefCount(1); ati->setRefCount(1);
if (stereo) { if (stereo) {

View File

@ -75,6 +75,7 @@ protected:
std::atomic<bool> stereo; std::atomic<bool> stereo;
std::atomic<bool> terminated; std::atomic<bool> terminated;
std::atomic<int> demodulatorType; std::atomic<int> demodulatorType;
int audioSampleRate;
DemodulatorThreadCommandQueue* threadQueueNotify; DemodulatorThreadCommandQueue* threadQueueNotify;
DemodulatorThreadControlCommandQueue *threadQueueControl; DemodulatorThreadControlCommandQueue *threadQueueControl;

View File

@ -49,6 +49,26 @@ void DemodulatorWorkerThread::threadMain() {
result.audioResampler = msresamp_rrrf_create(result.audioResamplerRatio, As); result.audioResampler = msresamp_rrrf_create(result.audioResamplerRatio, As);
result.stereoResampler = msresamp_rrrf_create(result.audioResamplerRatio, As); result.stereoResampler = msresamp_rrrf_create(result.audioResamplerRatio, As);
result.audioSampleRate = filterCommand.audioSampleRate; result.audioSampleRate = filterCommand.audioSampleRate;
// Stereo filters / shifters
double firStereoCutoff = 0.5 * ((double) 36000 / (double) filterCommand.audioSampleRate); // filter cutoff frequency
float ft = 0.05f; // filter transition
float mu = 0.0f; // fractional timing offset
if (firStereoCutoff < 0) {
firStereoCutoff = 0;
}
if (firStereoCutoff > 0.5) {
firStereoCutoff = 0.5;
}
unsigned int h_len = estimate_req_filter_len(ft, As);
float *h = new float[h_len];
liquid_firdes_kaiser(h_len, firStereoCutoff, As, mu, h);
result.firStereoLeft = firfilt_rrrf_create(h, h_len);
result.firStereoRight = firfilt_rrrf_create(h, h_len);
} }
if (filterCommand.bandwidth) { if (filterCommand.bandwidth) {

View File

@ -16,14 +16,13 @@ public:
DemodulatorWorkerThreadResult() : DemodulatorWorkerThreadResult() :
cmd(DEMOD_WORKER_THREAD_RESULT_NULL), iqResampler(NULL), iqResampleRatio(0), audioResampler(NULL), stereoResampler(NULL), audioResamplerRatio( cmd(DEMOD_WORKER_THREAD_RESULT_NULL), iqResampler(NULL), iqResampleRatio(0), audioResampler(NULL), stereoResampler(NULL), audioResamplerRatio(
0), sampleRate(0), bandwidth(0), audioSampleRate(0) { 0), firStereoLeft(NULL), firStereoRight(NULL), sampleRate(0), bandwidth(0), audioSampleRate(0) {
} }
DemodulatorWorkerThreadResult(DemodulatorThreadResultEnum cmd) : DemodulatorWorkerThreadResult(DemodulatorThreadResultEnum cmd) :
cmd(cmd), iqResampler(NULL), iqResampleRatio(0), audioResampler(NULL), stereoResampler(NULL), audioResamplerRatio(0), sampleRate(0), bandwidth( DemodulatorWorkerThreadResult() {
0), audioSampleRate(0) { this->cmd = cmd;
} }
DemodulatorThreadResultEnum cmd; DemodulatorThreadResultEnum cmd;
@ -34,6 +33,9 @@ public:
msresamp_rrrf stereoResampler; msresamp_rrrf stereoResampler;
double audioResamplerRatio; double audioResamplerRatio;
firfilt_rrrf firStereoLeft;
firfilt_rrrf firStereoRight;
long long sampleRate; long long sampleRate;
unsigned int bandwidth; unsigned int bandwidth;
unsigned int audioSampleRate; unsigned int audioSampleRate;