555 lines
15 KiB
C++
555 lines
15 KiB
C++
// Copyright (c) Charles J. Cliffe
|
|
// SPDX-License-Identifier: GPL-2.0+
|
|
|
|
#include "DemodulatorInstance.h"
|
|
#include "CubicSDR.h"
|
|
|
|
#if USE_HAMLIB
|
|
#include "RigThread.h"
|
|
#endif
|
|
|
|
DemodVisualCue::DemodVisualCue() {
|
|
squelchBreak.store(false);
|
|
}
|
|
|
|
DemodVisualCue::~DemodVisualCue() {
|
|
|
|
}
|
|
|
|
void DemodVisualCue::triggerSquelchBreak(int counter) {
|
|
squelchBreak.store(counter);
|
|
}
|
|
|
|
int DemodVisualCue::getSquelchBreak() {
|
|
return squelchBreak.load();
|
|
}
|
|
|
|
void DemodVisualCue::step() {
|
|
if (squelchBreak.load()) {
|
|
squelchBreak--;
|
|
if (squelchBreak.load() < 0) {
|
|
squelchBreak.store(0);
|
|
}
|
|
}
|
|
}
|
|
|
|
DemodulatorInstance::DemodulatorInstance() {
|
|
|
|
#if ENABLE_DIGITAL_LAB
|
|
activeOutput = nullptr;
|
|
#endif
|
|
|
|
active.store(false);
|
|
squelch.store(false);
|
|
muted.store(false);
|
|
deltaLock.store(false);
|
|
deltaLockOfs.store(0);
|
|
currentOutputDevice.store(-1);
|
|
currentAudioGain.store(1.0);
|
|
follow.store(false);
|
|
tracking.store(false);
|
|
|
|
label.store(new std::string("Unnamed"));
|
|
user_label.store(new std::wstring());
|
|
|
|
pipeIQInputData = new DemodulatorThreadInputQueue;
|
|
pipeIQDemodData = new DemodulatorThreadPostInputQueue;
|
|
|
|
audioThread = new AudioThread();
|
|
|
|
demodulatorPreThread = new DemodulatorPreThread(this);
|
|
demodulatorPreThread->setInputQueue("IQDataInput",pipeIQInputData);
|
|
demodulatorPreThread->setOutputQueue("IQDataOutput",pipeIQDemodData);
|
|
|
|
pipeAudioData = new AudioThreadInputQueue;
|
|
threadQueueControl = new DemodulatorThreadControlCommandQueue;
|
|
|
|
demodulatorThread = new DemodulatorThread(this);
|
|
demodulatorThread->setInputQueue("IQDataInput",pipeIQDemodData);
|
|
demodulatorThread->setInputQueue("ControlQueue",threadQueueControl);
|
|
demodulatorThread->setOutputQueue("AudioDataOutput", pipeAudioData);
|
|
|
|
audioThread->setInputQueue("AudioDataInput", pipeAudioData);
|
|
}
|
|
|
|
DemodulatorInstance::~DemodulatorInstance() {
|
|
#if ENABLE_DIGITAL_LAB
|
|
delete activeOutput;
|
|
#endif
|
|
delete audioThread;
|
|
delete demodulatorThread;
|
|
delete demodulatorPreThread;
|
|
delete pipeIQInputData;
|
|
delete pipeIQDemodData;
|
|
delete threadQueueControl;
|
|
delete pipeAudioData;
|
|
}
|
|
|
|
void DemodulatorInstance::setVisualOutputQueue(DemodulatorThreadOutputQueue *tQueue) {
|
|
demodulatorThread->setOutputQueue("AudioVisualOutput", tQueue);
|
|
}
|
|
|
|
void DemodulatorInstance::run() {
|
|
if (active) {
|
|
return;
|
|
}
|
|
|
|
t_Audio = new std::thread(&AudioThread::threadMain, audioThread);
|
|
|
|
#ifdef __APPLE__ // Already using pthreads, might as well do some custom init..
|
|
pthread_attr_t attr;
|
|
size_t size;
|
|
|
|
pthread_attr_init(&attr);
|
|
pthread_attr_setstacksize(&attr, 2048000);
|
|
pthread_attr_getstacksize(&attr, &size);
|
|
pthread_create(&t_PreDemod, &attr, &DemodulatorPreThread::pthread_helper, demodulatorPreThread);
|
|
pthread_attr_destroy(&attr);
|
|
|
|
pthread_attr_init(&attr);
|
|
pthread_attr_setstacksize(&attr, 2048000);
|
|
pthread_attr_getstacksize(&attr, &size);
|
|
pthread_create(&t_Demod, &attr, &DemodulatorThread::pthread_helper, demodulatorThread);
|
|
pthread_attr_destroy(&attr);
|
|
|
|
// std::cout << "Initialized demodulator stack size of " << size << std::endl;
|
|
|
|
#else
|
|
t_PreDemod = new std::thread(&DemodulatorPreThread::threadMain, demodulatorPreThread);
|
|
t_Demod = new std::thread(&DemodulatorThread::threadMain, demodulatorThread);
|
|
#endif
|
|
|
|
active = true;
|
|
|
|
}
|
|
|
|
void DemodulatorInstance::updateLabel(long long freq) {
|
|
std::stringstream newLabel;
|
|
newLabel.precision(3);
|
|
newLabel << std::fixed << ((long double) freq / 1000000.0);
|
|
setLabel(newLabel.str());
|
|
}
|
|
|
|
void DemodulatorInstance::terminate() {
|
|
|
|
#if ENABLE_DIGITAL_LAB
|
|
if (activeOutput) {
|
|
closeOutput();
|
|
}
|
|
#endif
|
|
|
|
// std::cout << "Terminating demodulator audio thread.." << std::endl;
|
|
audioThread->terminate();
|
|
// std::cout << "Terminating demodulator thread.." << std::endl;
|
|
demodulatorThread->terminate();
|
|
// std::cout << "Terminating demodulator preprocessor thread.." << std::endl;
|
|
demodulatorPreThread->terminate();
|
|
}
|
|
|
|
std::string DemodulatorInstance::getLabel() {
|
|
return *(label.load());
|
|
}
|
|
|
|
void DemodulatorInstance::setLabel(std::string labelStr) {
|
|
|
|
delete label.exchange(new std::string(labelStr));
|
|
}
|
|
|
|
bool DemodulatorInstance::isTerminated() {
|
|
|
|
//
|
|
bool audioTerminated = audioThread->isTerminated();
|
|
bool demodTerminated = demodulatorThread->isTerminated();
|
|
bool preDemodTerminated = demodulatorPreThread->isTerminated();
|
|
|
|
//Cleanup the worker threads, if the threads are indeed terminated
|
|
if (audioTerminated) {
|
|
|
|
if (t_Audio) {
|
|
t_Audio->join();
|
|
|
|
delete t_Audio;
|
|
t_Audio = nullptr;
|
|
}
|
|
}
|
|
|
|
if (demodTerminated) {
|
|
|
|
if (t_Demod) {
|
|
#ifdef __APPLE__
|
|
pthread_join(t_Demod, nullptr);
|
|
#else
|
|
t_Demod->join();
|
|
delete t_Demod;
|
|
#endif
|
|
t_Demod = nullptr;
|
|
}
|
|
}
|
|
|
|
if (preDemodTerminated) {
|
|
|
|
if (t_PreDemod) {
|
|
|
|
#ifdef __APPLE__
|
|
pthread_join(t_PreDemod, NULL);
|
|
#else
|
|
t_PreDemod->join();
|
|
delete t_PreDemod;
|
|
#endif
|
|
t_PreDemod = nullptr;
|
|
}
|
|
}
|
|
|
|
bool terminated = audioTerminated && demodTerminated && preDemodTerminated;
|
|
|
|
return terminated;
|
|
}
|
|
|
|
bool DemodulatorInstance::isActive() {
|
|
return active;
|
|
}
|
|
|
|
void DemodulatorInstance::setActive(bool state) {
|
|
if (active && !state) {
|
|
#if ENABLE_DIGITAL_LAB
|
|
if (activeOutput) {
|
|
activeOutput->Hide();
|
|
}
|
|
#endif
|
|
audioThread->setActive(state);
|
|
DemodulatorThread::releaseSquelchLock(this);
|
|
} else if (!active && state) {
|
|
#if ENABLE_DIGITAL_LAB
|
|
if (activeOutput && getModemType() == "digital") {
|
|
activeOutput->Show();
|
|
}
|
|
#endif
|
|
audioThread->setActive(state);
|
|
}
|
|
if (!state) {
|
|
tracking = false;
|
|
}
|
|
active = state;
|
|
}
|
|
|
|
void DemodulatorInstance::squelchAuto() {
|
|
DemodulatorThreadControlCommand command;
|
|
command.cmd = DemodulatorThreadControlCommand::DEMOD_THREAD_CMD_CTL_SQUELCH_ON;
|
|
threadQueueControl->push(command);
|
|
squelch = true;
|
|
}
|
|
|
|
bool DemodulatorInstance::isSquelchEnabled() {
|
|
return (demodulatorThread->getSquelchLevel() != 0.0);
|
|
}
|
|
|
|
void DemodulatorInstance::setSquelchEnabled(bool state) {
|
|
if (!state && squelch) {
|
|
DemodulatorThreadControlCommand command;
|
|
command.cmd = DemodulatorThreadControlCommand::DEMOD_THREAD_CMD_CTL_SQUELCH_OFF;
|
|
threadQueueControl->push(command);
|
|
} else if (state && !squelch) {
|
|
DemodulatorThreadControlCommand command;
|
|
command.cmd = DemodulatorThreadControlCommand::DEMOD_THREAD_CMD_CTL_SQUELCH_ON;
|
|
threadQueueControl->push(command);
|
|
}
|
|
|
|
squelch = state;
|
|
}
|
|
|
|
float DemodulatorInstance::getSignalLevel() {
|
|
return demodulatorThread->getSignalLevel();
|
|
}
|
|
|
|
float DemodulatorInstance::getSignalFloor() {
|
|
return demodulatorThread->getSignalFloor();
|
|
}
|
|
|
|
float DemodulatorInstance::getSignalCeil() {
|
|
return demodulatorThread->getSignalCeil();
|
|
}
|
|
|
|
void DemodulatorInstance::setSquelchLevel(float signal_level_in) {
|
|
demodulatorThread->setSquelchLevel(signal_level_in);
|
|
wxGetApp().getDemodMgr().setLastSquelchLevel(signal_level_in);
|
|
wxGetApp().getDemodMgr().setLastSquelchEnabled(true);
|
|
}
|
|
|
|
float DemodulatorInstance::getSquelchLevel() {
|
|
return demodulatorThread->getSquelchLevel();
|
|
}
|
|
|
|
void DemodulatorInstance::setOutputDevice(int device_id) {
|
|
if (!active) {
|
|
audioThread->setInitOutputDevice(device_id);
|
|
} else if (audioThread) {
|
|
AudioThreadCommand command;
|
|
command.cmd = AudioThreadCommand::AUDIO_THREAD_CMD_SET_DEVICE;
|
|
command.int_value = device_id;
|
|
audioThread->getCommandQueue()->push(command);
|
|
}
|
|
setAudioSampleRate(AudioThread::deviceSampleRate[device_id]);
|
|
currentOutputDevice = device_id;
|
|
}
|
|
|
|
int DemodulatorInstance::getOutputDevice() {
|
|
if (currentOutputDevice == -1) {
|
|
if (audioThread) {
|
|
currentOutputDevice = audioThread->getOutputDevice();
|
|
}
|
|
}
|
|
|
|
return currentOutputDevice;
|
|
}
|
|
|
|
void DemodulatorInstance::setDemodulatorType(std::string demod_type_in) {
|
|
setGain(getGain());
|
|
if (demodulatorPreThread) {
|
|
std::string currentDemodType = demodulatorPreThread->getDemodType();
|
|
if ((currentDemodType != "") && (currentDemodType != demod_type_in)) {
|
|
lastModemSettings[currentDemodType] = demodulatorPreThread->readModemSettings();
|
|
lastModemBandwidth[currentDemodType] = demodulatorPreThread->getBandwidth();
|
|
}
|
|
#if ENABLE_DIGITAL_LAB
|
|
if (activeOutput) {
|
|
activeOutput->Hide();
|
|
}
|
|
#endif
|
|
|
|
demodulatorPreThread->setDemodType(demod_type_in);
|
|
int lastbw = 0;
|
|
if (currentDemodType != "" && lastModemBandwidth.find(demod_type_in) != lastModemBandwidth.end()) {
|
|
lastbw = lastModemBandwidth[demod_type_in];
|
|
}
|
|
if (!lastbw) {
|
|
lastbw = Modem::getModemDefaultSampleRate(demod_type_in);
|
|
}
|
|
if (lastbw) {
|
|
setBandwidth(lastbw);
|
|
}
|
|
|
|
#if ENABLE_DIGITAL_LAB
|
|
if (isModemInitialized() && getModemType() == "digital") {
|
|
ModemDigitalOutputConsole *outp = (ModemDigitalOutputConsole *)getOutput();
|
|
outp->setTitle(getDemodulatorType() + ": " + frequencyToStr(getFrequency()));
|
|
}
|
|
#endif
|
|
}
|
|
}
|
|
|
|
std::string DemodulatorInstance::getDemodulatorType() {
|
|
return demodulatorPreThread->getDemodType();
|
|
}
|
|
|
|
std::wstring DemodulatorInstance::getDemodulatorUserLabel() {
|
|
return *(user_label.load());
|
|
}
|
|
|
|
void DemodulatorInstance::setDemodulatorUserLabel(const std::wstring& demod_user_label) {
|
|
|
|
delete user_label.exchange(new std::wstring(demod_user_label));
|
|
}
|
|
|
|
void DemodulatorInstance::setDemodulatorLock(bool demod_lock_in) {
|
|
Modem *cModem = demodulatorPreThread->getModem();
|
|
if (cModem && cModem->getType() == "digital") {
|
|
((ModemDigital *)cModem)->setDemodulatorLock(demod_lock_in);
|
|
}
|
|
}
|
|
|
|
int DemodulatorInstance::getDemodulatorLock() {
|
|
Modem *cModem = demodulatorPreThread->getModem();
|
|
|
|
if (cModem && cModem->getType() == "digital") {
|
|
return ((ModemDigital *)cModem)->getDemodulatorLock();
|
|
}
|
|
|
|
return 0;
|
|
}
|
|
|
|
void DemodulatorInstance::setBandwidth(int bw) {
|
|
demodulatorPreThread->setBandwidth(bw);
|
|
}
|
|
|
|
int DemodulatorInstance::getBandwidth() {
|
|
return demodulatorPreThread->getBandwidth();
|
|
}
|
|
|
|
void DemodulatorInstance::setFrequency(long long freq) {
|
|
if ((freq - getBandwidth() / 2) <= 0) {
|
|
freq = getBandwidth() / 2;
|
|
}
|
|
|
|
demodulatorPreThread->setFrequency(freq);
|
|
#if ENABLE_DIGITAL_LAB
|
|
if (activeOutput) {
|
|
if (isModemInitialized() && getModemType() == "digital") {
|
|
ModemDigitalOutputConsole *outp = (ModemDigitalOutputConsole *)getOutput();
|
|
outp->setTitle(getDemodulatorType() + ": " + frequencyToStr(getFrequency()));
|
|
}
|
|
}
|
|
#endif
|
|
#if USE_HAMLIB
|
|
if (wxGetApp().rigIsActive() && wxGetApp().getRigThread()->getFollowModem() && wxGetApp().getDemodMgr().getLastActiveDemodulator() == this) {
|
|
wxGetApp().getRigThread()->setFrequency(freq,true);
|
|
}
|
|
#endif
|
|
}
|
|
|
|
long long DemodulatorInstance::getFrequency() {
|
|
return demodulatorPreThread->getFrequency();
|
|
}
|
|
|
|
void DemodulatorInstance::setAudioSampleRate(int sampleRate) {
|
|
demodulatorPreThread->setSampleRate(sampleRate);
|
|
}
|
|
|
|
int DemodulatorInstance::getAudioSampleRate() {
|
|
if (!audioThread) {
|
|
return 0;
|
|
}
|
|
return audioThread->getSampleRate();
|
|
}
|
|
|
|
|
|
void DemodulatorInstance::setGain(float gain_in) {
|
|
currentAudioGain = gain_in;
|
|
audioThread->setGain(gain_in);
|
|
}
|
|
|
|
float DemodulatorInstance::getGain() {
|
|
return currentAudioGain;
|
|
}
|
|
|
|
bool DemodulatorInstance::isFollow() {
|
|
return follow;
|
|
}
|
|
|
|
void DemodulatorInstance::setFollow(bool follow) {
|
|
this->follow = follow;
|
|
}
|
|
|
|
bool DemodulatorInstance::isTracking() {
|
|
return tracking;
|
|
}
|
|
|
|
void DemodulatorInstance::setTracking(bool tracking) {
|
|
this->tracking = tracking;
|
|
}
|
|
|
|
bool DemodulatorInstance::isDeltaLock() {
|
|
return deltaLock.load();
|
|
}
|
|
|
|
void DemodulatorInstance::setDeltaLock(bool lock) {
|
|
deltaLock.store(lock);
|
|
}
|
|
|
|
void DemodulatorInstance::setDeltaLockOfs(int lockOfs) {
|
|
deltaLockOfs.store(lockOfs);
|
|
}
|
|
|
|
int DemodulatorInstance::getDeltaLockOfs() {
|
|
return deltaLockOfs.load();
|
|
}
|
|
|
|
bool DemodulatorInstance::isMuted() {
|
|
return demodulatorThread->isMuted();
|
|
}
|
|
|
|
void DemodulatorInstance::setMuted(bool muted) {
|
|
this->muted = muted;
|
|
demodulatorThread->setMuted(muted);
|
|
wxGetApp().getDemodMgr().setLastMuted(muted);
|
|
}
|
|
|
|
DemodVisualCue *DemodulatorInstance::getVisualCue() {
|
|
return &visualCue;
|
|
}
|
|
|
|
DemodulatorThreadInputQueue *DemodulatorInstance::getIQInputDataPipe() {
|
|
return pipeIQInputData;
|
|
}
|
|
|
|
ModemArgInfoList DemodulatorInstance::getModemArgs() {
|
|
Modem *m = demodulatorPreThread->getModem();
|
|
|
|
ModemArgInfoList args;
|
|
if (m != nullptr) {
|
|
args = m->getSettings();
|
|
}
|
|
return args;
|
|
}
|
|
|
|
std::string DemodulatorInstance::readModemSetting(std::string setting) {
|
|
return demodulatorPreThread->readModemSetting(setting);
|
|
}
|
|
|
|
void DemodulatorInstance::writeModemSetting(std::string setting, std::string value) {
|
|
demodulatorPreThread->writeModemSetting(setting, value);
|
|
}
|
|
|
|
ModemSettings DemodulatorInstance::readModemSettings() {
|
|
return demodulatorPreThread->readModemSettings();
|
|
}
|
|
|
|
void DemodulatorInstance::writeModemSettings(ModemSettings settings) {
|
|
demodulatorPreThread->writeModemSettings(settings);
|
|
}
|
|
|
|
bool DemodulatorInstance::isModemInitialized() {
|
|
if (!demodulatorPreThread || isTerminated()) {
|
|
return false;
|
|
}
|
|
return demodulatorPreThread->isInitialized();
|
|
}
|
|
|
|
std::string DemodulatorInstance::getModemType() {
|
|
if (isModemInitialized()) {
|
|
return demodulatorPreThread->getModem()->getType();
|
|
}
|
|
return "";
|
|
}
|
|
|
|
ModemSettings DemodulatorInstance::getLastModemSettings(std::string demodType) {
|
|
if (lastModemSettings.find(demodType) != lastModemSettings.end()) {
|
|
return lastModemSettings[demodType];
|
|
} else {
|
|
ModemSettings mods;
|
|
return mods;
|
|
}
|
|
}
|
|
|
|
#if ENABLE_DIGITAL_LAB
|
|
ModemDigitalOutput *DemodulatorInstance::getOutput() {
|
|
if (activeOutput == nullptr) {
|
|
activeOutput = new ModemDigitalOutputConsole();
|
|
}
|
|
return activeOutput;
|
|
}
|
|
|
|
void DemodulatorInstance::showOutput() {
|
|
if (activeOutput != nullptr) {
|
|
activeOutput->Show();
|
|
}
|
|
}
|
|
|
|
void DemodulatorInstance::hideOutput() {
|
|
if (activeOutput != nullptr) {
|
|
activeOutput->Hide();
|
|
}
|
|
}
|
|
|
|
void DemodulatorInstance::closeOutput() {
|
|
if (isModemInitialized()) {
|
|
if (getModemType() == "digital") {
|
|
ModemDigital *dModem = (ModemDigital *)demodulatorPreThread->getModem();
|
|
dModem->setOutput(nullptr);
|
|
}
|
|
}
|
|
if (activeOutput) {
|
|
activeOutput->Close();
|
|
}
|
|
}
|
|
#endif
|