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:
parent
54ca369d6f
commit
abf0f2f2e7
@ -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;
|
||||||
}
|
}
|
||||||
|
|
||||||
|
@ -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;
|
||||||
|
@ -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);
|
||||||
}
|
}
|
||||||
}
|
}
|
||||||
|
@ -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
|
||||||
|
Loading…
Reference in New Issue
Block a user