1
0
mirror of https://github.com/f4exb/sdrangel.git synced 2024-09-28 15:56:33 -04:00

VOR demod: updated threading model. Part of #1346

This commit is contained in:
f4exb 2022-10-13 00:14:00 +02:00
parent 54ca369d6f
commit abf0f2f2e7
4 changed files with 83 additions and 52 deletions

View File

@ -51,14 +51,12 @@ const char * const VORDemod::m_channelId = "VORDemod";
VORDemod::VORDemod(DeviceAPI *deviceAPI) : VORDemod::VORDemod(DeviceAPI *deviceAPI) :
ChannelAPI(m_channelIdURI, ChannelAPI::StreamSingleSink), ChannelAPI(m_channelIdURI, ChannelAPI::StreamSingleSink),
m_deviceAPI(deviceAPI), m_deviceAPI(deviceAPI),
m_thread(nullptr),
m_basebandSink(nullptr),
m_running(false),
m_basebandSampleRate(0) m_basebandSampleRate(0)
{ {
setObjectName(m_channelId); setObjectName(m_channelId);
m_basebandSink = new VORDemodBaseband();
m_basebandSink->setMessageQueueToChannel(getInputMessageQueue());
m_basebandSink->moveToThread(&m_thread);
applySettings(m_settings, true); applySettings(m_settings, true);
m_deviceAPI->addChannelSink(this); m_deviceAPI->addChannelSink(this);
@ -77,6 +75,8 @@ VORDemod::VORDemod(DeviceAPI *deviceAPI) :
this, this,
&VORDemod::handleIndexInDeviceSetChanged &VORDemod::handleIndexInDeviceSetChanged
); );
start();
} }
VORDemod::~VORDemod() VORDemod::~VORDemod()
@ -91,12 +91,7 @@ VORDemod::~VORDemod()
delete m_networkManager; delete m_networkManager;
m_deviceAPI->removeChannelSinkAPI(this); m_deviceAPI->removeChannelSinkAPI(this);
m_deviceAPI->removeChannelSink(this); m_deviceAPI->removeChannelSink(this);
stop();
if (m_basebandSink->isRunning()) {
stop();
}
delete m_basebandSink;
} }
void VORDemod::setDeviceAPI(DeviceAPI *deviceAPI) void VORDemod::setDeviceAPI(DeviceAPI *deviceAPI)
@ -119,30 +114,51 @@ uint32_t VORDemod::getNumberOfDeviceStreams() const
void VORDemod::feed(const SampleVector::const_iterator& begin, const SampleVector::const_iterator& end, bool firstOfBurst) void VORDemod::feed(const SampleVector::const_iterator& begin, const SampleVector::const_iterator& end, bool firstOfBurst)
{ {
(void) firstOfBurst; (void) firstOfBurst;
m_basebandSink->feed(begin, end);
if (m_running) {
m_basebandSink->feed(begin, end);
}
} }
void VORDemod::start() void VORDemod::start()
{ {
if (m_running) {
return;
}
qDebug("VORDemod::start"); qDebug("VORDemod::start");
m_thread = new QThread();
m_basebandSink = new VORDemodBaseband();
m_basebandSink->setMessageQueueToChannel(getInputMessageQueue());
m_basebandSink->moveToThread(m_thread);
QObject::connect(m_thread, &QThread::finished, m_basebandSink, &QObject::deleteLater);
QObject::connect(m_thread, &QThread::finished, m_thread, &QThread::deleteLater);
m_basebandSink->reset(); m_basebandSink->reset();
m_basebandSink->startWork(); m_basebandSink->startWork();
m_thread.start(); m_thread->start();
DSPSignalNotification *dspMsg = new DSPSignalNotification(m_basebandSampleRate, m_centerFrequency); DSPSignalNotification *dspMsg = new DSPSignalNotification(m_basebandSampleRate, m_centerFrequency);
m_basebandSink->getInputMessageQueue()->push(dspMsg); m_basebandSink->getInputMessageQueue()->push(dspMsg);
VORDemodBaseband::MsgConfigureVORDemodBaseband *msg = VORDemodBaseband::MsgConfigureVORDemodBaseband::create(m_settings, true); VORDemodBaseband::MsgConfigureVORDemodBaseband *msg = VORDemodBaseband::MsgConfigureVORDemodBaseband::create(m_settings, true);
m_basebandSink->getInputMessageQueue()->push(msg); m_basebandSink->getInputMessageQueue()->push(msg);
m_running = true;
} }
void VORDemod::stop() void VORDemod::stop()
{ {
if (!m_running) {
return;
}
qDebug("VORDemod::stop"); qDebug("VORDemod::stop");
m_running = false;
m_basebandSink->stopWork(); m_basebandSink->stopWork();
m_thread.quit(); m_thread->quit();
m_thread.wait(); m_thread->wait();
} }
bool VORDemod::handleMessage(const Message& cmd) bool VORDemod::handleMessage(const Message& cmd)
@ -160,10 +176,15 @@ bool VORDemod::handleMessage(const Message& cmd)
DSPSignalNotification& notif = (DSPSignalNotification&) cmd; DSPSignalNotification& notif = (DSPSignalNotification&) cmd;
m_basebandSampleRate = notif.getSampleRate(); m_basebandSampleRate = notif.getSampleRate();
m_centerFrequency = notif.getCenterFrequency(); m_centerFrequency = notif.getCenterFrequency();
// Forward to the sink
DSPSignalNotification* rep = new DSPSignalNotification(notif); // make a copy
qDebug() << "VORDemod::handleMessage: DSPSignalNotification"; qDebug() << "VORDemod::handleMessage: DSPSignalNotification";
m_basebandSink->getInputMessageQueue()->push(rep);
// Forward to the sink
if (m_running)
{
DSPSignalNotification* rep = new DSPSignalNotification(notif); // make a copy
m_basebandSink->getInputMessageQueue()->push(rep);
}
// Forward to GUI if any // Forward to GUI if any
if (m_guiMessageQueue) { if (m_guiMessageQueue) {
m_guiMessageQueue->push(new DSPSignalNotification(notif)); m_guiMessageQueue->push(new DSPSignalNotification(notif));
@ -297,8 +318,11 @@ void VORDemod::applySettings(const VORDemodSettings& settings, bool force)
reverseAPIKeys.append("identThreshold"); reverseAPIKeys.append("identThreshold");
} }
VORDemodBaseband::MsgConfigureVORDemodBaseband *msg = VORDemodBaseband::MsgConfigureVORDemodBaseband::create(settings, force); if (m_running)
m_basebandSink->getInputMessageQueue()->push(msg); {
VORDemodBaseband::MsgConfigureVORDemodBaseband *msg = VORDemodBaseband::MsgConfigureVORDemodBaseband::create(settings, force);
m_basebandSink->getInputMessageQueue()->push(msg);
}
if (settings.m_useReverseAPI) if (settings.m_useReverseAPI)
{ {
@ -522,12 +546,16 @@ void VORDemod::webapiFormatChannelSettings(SWGSDRangel::SWGChannelSettings& resp
void VORDemod::webapiFormatChannelReport(SWGSDRangel::SWGChannelReport& response) void VORDemod::webapiFormatChannelReport(SWGSDRangel::SWGChannelReport& response)
{ {
double magsqAvg, magsqPeak; if (m_running)
int nbMagsqSamples; {
getMagSqLevels(magsqAvg, magsqPeak, nbMagsqSamples); double magsqAvg, magsqPeak;
response.getVorDemodReport()->setChannelPowerDb(CalcDb::dbPower(magsqAvg)); int nbMagsqSamples;
response.getVorDemodReport()->setSquelch(m_basebandSink->getSquelchOpen() ? 1 : 0); getMagSqLevels(magsqAvg, magsqPeak, nbMagsqSamples);
response.getVorDemodReport()->setAudioSampleRate(m_basebandSink->getAudioSampleRate()); response.getVorDemodReport()->setChannelPowerDb(CalcDb::dbPower(magsqAvg));
response.getVorDemodReport()->setSquelch(m_basebandSink->getSquelchOpen() ? 1 : 0);
response.getVorDemodReport()->setAudioSampleRate(m_basebandSink->getAudioSampleRate());
}
response.getVorDemodReport()->setNavId(m_settings.m_navId); response.getVorDemodReport()->setNavId(m_settings.m_navId);
response.getVorDemodReport()->setRadial(m_radial); response.getVorDemodReport()->setRadial(m_radial);
response.getVorDemodReport()->setRefMag(m_refMag); response.getVorDemodReport()->setRefMag(m_refMag);
@ -701,7 +729,7 @@ void VORDemod::networkManagerFinished(QNetworkReply *reply)
void VORDemod::handleIndexInDeviceSetChanged(int index) void VORDemod::handleIndexInDeviceSetChanged(int index)
{ {
if (index < 0) { if (!m_running || (index < 0)) {
return; return;
} }

View File

@ -22,7 +22,6 @@
#include <vector> #include <vector>
#include <QNetworkRequest> #include <QNetworkRequest>
#include <QThread>
#include "dsp/basebandsamplesink.h" #include "dsp/basebandsamplesink.h"
#include "channel/channelapi.h" #include "channel/channelapi.h"
@ -122,12 +121,17 @@ public:
const QStringList& channelSettingsKeys, const QStringList& channelSettingsKeys,
SWGSDRangel::SWGChannelSettings& response); SWGSDRangel::SWGChannelSettings& response);
uint32_t getAudioSampleRate() const { return m_basebandSink->getAudioSampleRate(); } uint32_t getAudioSampleRate() const { return m_running ? m_basebandSink->getAudioSampleRate() : 0; }
double getMagSq() const { return m_basebandSink->getMagSq(); } double getMagSq() const { return m_running ? m_basebandSink->getMagSq() : 0.0; }
bool getSquelchOpen() const { return m_basebandSink->getSquelchOpen(); } bool getSquelchOpen() const { return m_running ? m_basebandSink->getSquelchOpen() : false; }
void getMagSqLevels(double& avg, double& peak, int& nbSamples) { void getMagSqLevels(double& avg, double& peak, int& nbSamples)
m_basebandSink->getMagSqLevels(avg, peak, nbSamples); {
if (m_running) {
m_basebandSink->getMagSqLevels(avg, peak, nbSamples);
} else {
avg = 0.0; peak = 0.0; nbSamples = 1;
}
} }
uint32_t getNumberOfDeviceStreams() const; uint32_t getNumberOfDeviceStreams() const;
@ -137,8 +141,9 @@ public:
private: private:
DeviceAPI *m_deviceAPI; DeviceAPI *m_deviceAPI;
QThread m_thread; QThread *m_thread;
VORDemodBaseband* m_basebandSink; VORDemodBaseband *m_basebandSink;
bool m_running;
VORDemodSettings m_settings; VORDemodSettings m_settings;
int m_basebandSampleRate; //!< stored from device message used when starting baseband sink int m_basebandSampleRate; //!< stored from device message used when starting baseband sink
qint64 m_centerFrequency; qint64 m_centerFrequency;

View File

@ -28,12 +28,12 @@
MESSAGE_CLASS_DEFINITION(VORDemodBaseband::MsgConfigureVORDemodBaseband, Message) MESSAGE_CLASS_DEFINITION(VORDemodBaseband::MsgConfigureVORDemodBaseband, Message)
VORDemodBaseband::VORDemodBaseband() : VORDemodBaseband::VORDemodBaseband() :
m_channelizer(&m_sink),
m_messageQueueToGUI(nullptr), m_messageQueueToGUI(nullptr),
m_running(false) m_running(false)
{ {
qDebug("VORDemodBaseband::VORDemodBaseband"); qDebug("VORDemodBaseband::VORDemodBaseband");
m_sampleFifo.setSize(SampleSinkFifo::getSizePolicy(48000)); m_sampleFifo.setSize(SampleSinkFifo::getSizePolicy(48000));
m_channelizer = new DownChannelizer(&m_sink);
DSPEngine::instance()->getAudioDeviceManager()->addAudioSink(m_sink.getAudioFifo(), getInputMessageQueue()); DSPEngine::instance()->getAudioDeviceManager()->addAudioSink(m_sink.getAudioFifo(), getInputMessageQueue());
m_sink.applyAudioSampleRate(DSPEngine::instance()->getAudioDeviceManager()->getOutputSampleRate()); m_sink.applyAudioSampleRate(DSPEngine::instance()->getAudioDeviceManager()->getOutputSampleRate());
@ -44,7 +44,6 @@ VORDemodBaseband::~VORDemodBaseband()
{ {
m_inputMessageQueue.clear(); m_inputMessageQueue.clear();
DSPEngine::instance()->getAudioDeviceManager()->removeAudioSink(m_sink.getAudioFifo()); DSPEngine::instance()->getAudioDeviceManager()->removeAudioSink(m_sink.getAudioFifo());
delete m_channelizer;
} }
void VORDemodBaseband::reset() void VORDemodBaseband::reset()
@ -102,12 +101,12 @@ void VORDemodBaseband::handleData()
// first part of FIFO data // first part of FIFO data
if (part1begin != part1end) { if (part1begin != part1end) {
m_channelizer->feed(part1begin, part1end); m_channelizer.feed(part1begin, part1end);
} }
// second part of FIFO data (used when block wraps around) // second part of FIFO data (used when block wraps around)
if(part2begin != part2end) { if(part2begin != part2end) {
m_channelizer->feed(part2begin, part2end); m_channelizer.feed(part2begin, part2end);
} }
m_sampleFifo.readCommit((unsigned int) count); m_sampleFifo.readCommit((unsigned int) count);
@ -144,13 +143,13 @@ bool VORDemodBaseband::handleMessage(const Message& cmd)
DSPSignalNotification& notif = (DSPSignalNotification&) cmd; DSPSignalNotification& notif = (DSPSignalNotification&) cmd;
qDebug() << "VORDemodBaseband::handleMessage: DSPSignalNotification: basebandSampleRate: " << notif.getSampleRate() << " centerFrequency: " << notif.getCenterFrequency(); qDebug() << "VORDemodBaseband::handleMessage: DSPSignalNotification: basebandSampleRate: " << notif.getSampleRate() << " centerFrequency: " << notif.getCenterFrequency();
m_sampleFifo.setSize(SampleSinkFifo::getSizePolicy(notif.getSampleRate())); m_sampleFifo.setSize(SampleSinkFifo::getSizePolicy(notif.getSampleRate()));
m_channelizer->setBasebandSampleRate(notif.getSampleRate()); m_channelizer.setBasebandSampleRate(notif.getSampleRate());
m_sink.applyChannelSettings(m_channelizer->getChannelSampleRate(), m_channelizer->getChannelFrequencyOffset()); m_sink.applyChannelSettings(m_channelizer.getChannelSampleRate(), m_channelizer.getChannelFrequencyOffset());
if (m_channelSampleRate != m_channelizer->getChannelSampleRate()) if (m_channelSampleRate != m_channelizer.getChannelSampleRate())
{ {
m_sink.applyAudioSampleRate(m_sink.getAudioSampleRate()); // reapply when channel sample rate changes m_sink.applyAudioSampleRate(m_sink.getAudioSampleRate()); // reapply when channel sample rate changes
m_channelSampleRate = m_channelizer->getChannelSampleRate(); m_channelSampleRate = m_channelizer.getChannelSampleRate();
} }
return true; return true;
@ -165,13 +164,13 @@ void VORDemodBaseband::applySettings(const VORDemodSettings& settings, bool forc
{ {
if ((settings.m_inputFrequencyOffset != m_settings.m_inputFrequencyOffset) || force) if ((settings.m_inputFrequencyOffset != m_settings.m_inputFrequencyOffset) || force)
{ {
m_channelizer->setChannelization(m_sink.getAudioSampleRate(), settings.m_inputFrequencyOffset); m_channelizer.setChannelization(m_sink.getAudioSampleRate(), settings.m_inputFrequencyOffset);
m_sink.applyChannelSettings(m_channelizer->getChannelSampleRate(), m_channelizer->getChannelFrequencyOffset()); m_sink.applyChannelSettings(m_channelizer.getChannelSampleRate(), m_channelizer.getChannelFrequencyOffset());
if (m_channelSampleRate != m_channelizer->getChannelSampleRate()) if (m_channelSampleRate != m_channelizer.getChannelSampleRate())
{ {
m_sink.applyAudioSampleRate(m_sink.getAudioSampleRate()); // reapply when channel sample rate changes m_sink.applyAudioSampleRate(m_sink.getAudioSampleRate()); // reapply when channel sample rate changes
m_channelSampleRate = m_channelizer->getChannelSampleRate(); m_channelSampleRate = m_channelizer.getChannelSampleRate();
} }
} }
@ -186,8 +185,8 @@ void VORDemodBaseband::applySettings(const VORDemodSettings& settings, bool forc
if (m_sink.getAudioSampleRate() != audioSampleRate) if (m_sink.getAudioSampleRate() != audioSampleRate)
{ {
m_channelizer->setChannelization(audioSampleRate, settings.m_inputFrequencyOffset); m_channelizer.setChannelization(audioSampleRate, settings.m_inputFrequencyOffset);
m_sink.applyChannelSettings(m_channelizer->getChannelSampleRate(), m_channelizer->getChannelFrequencyOffset()); m_sink.applyChannelSettings(m_channelizer.getChannelSampleRate(), m_channelizer.getChannelFrequencyOffset());
m_sink.applyAudioSampleRate(audioSampleRate); m_sink.applyAudioSampleRate(audioSampleRate);
} }
} }

View File

@ -23,13 +23,12 @@
#include <QRecursiveMutex> #include <QRecursiveMutex>
#include "dsp/samplesinkfifo.h" #include "dsp/samplesinkfifo.h"
#include "dsp/downchannelizer.h"
#include "util/message.h" #include "util/message.h"
#include "util/messagequeue.h" #include "util/messagequeue.h"
#include "vordemodsink.h" #include "vordemodsink.h"
class DownChannelizer;
class VORDemodBaseband : public QObject class VORDemodBaseband : public QObject
{ {
Q_OBJECT Q_OBJECT
@ -75,7 +74,7 @@ public:
private: private:
SampleSinkFifo m_sampleFifo; SampleSinkFifo m_sampleFifo;
DownChannelizer * m_channelizer; DownChannelizer m_channelizer;
int m_channelSampleRate; int m_channelSampleRate;
VORDemodSCSink m_sink; VORDemodSCSink m_sink;
MessageQueue m_inputMessageQueue; //!< Queue for asynchronous inbound communication MessageQueue m_inputMessageQueue; //!< Queue for asynchronous inbound communication