mirror of
https://github.com/f4exb/sdrangel.git
synced 2024-11-04 16:01:14 -05:00
WFM demod: use settings in demod
This commit is contained in:
parent
8a7dcfa4dd
commit
f9b426de69
@ -27,6 +27,7 @@
|
|||||||
#include "dsp/pidcontroller.h"
|
#include "dsp/pidcontroller.h"
|
||||||
|
|
||||||
MESSAGE_CLASS_DEFINITION(WFMDemod::MsgConfigureWFMDemod, Message)
|
MESSAGE_CLASS_DEFINITION(WFMDemod::MsgConfigureWFMDemod, Message)
|
||||||
|
MESSAGE_CLASS_DEFINITION(WFMDemod::MsgConfigureChannelizer, Message)
|
||||||
|
|
||||||
WFMDemod::WFMDemod(BasebandSampleSink* sampleSink) :
|
WFMDemod::WFMDemod(BasebandSampleSink* sampleSink) :
|
||||||
m_squelchOpen(false),
|
m_squelchOpen(false),
|
||||||
@ -42,24 +43,16 @@ WFMDemod::WFMDemod(BasebandSampleSink* sampleSink) :
|
|||||||
{
|
{
|
||||||
setObjectName("WFMDemod");
|
setObjectName("WFMDemod");
|
||||||
|
|
||||||
m_config.m_inputSampleRate = 384000;
|
|
||||||
m_config.m_inputFrequencyOffset = 0;
|
|
||||||
m_config.m_rfBandwidth = 180000;
|
|
||||||
m_config.m_afBandwidth = 15000;
|
|
||||||
m_config.m_squelch = -60.0;
|
|
||||||
m_config.m_volume = 2.0;
|
|
||||||
m_config.m_audioSampleRate = DSPEngine::instance()->getAudioSampleRate();
|
|
||||||
m_rfFilter = new fftfilt(-50000.0 / 384000.0, 50000.0 / 384000.0, rfFilterFftLength);
|
m_rfFilter = new fftfilt(-50000.0 / 384000.0, 50000.0 / 384000.0, rfFilterFftLength);
|
||||||
m_phaseDiscri.setFMScaling(384000/75000);
|
m_phaseDiscri.setFMScaling(384000/75000);
|
||||||
|
|
||||||
apply();
|
|
||||||
|
|
||||||
m_audioBuffer.resize(16384);
|
m_audioBuffer.resize(16384);
|
||||||
m_audioBufferFill = 0;
|
m_audioBufferFill = 0;
|
||||||
|
|
||||||
m_movingAverage.resize(16, 0);
|
m_movingAverage.resize(16, 0);
|
||||||
|
|
||||||
DSPEngine::instance()->addAudioSink(&m_audioFifo);
|
DSPEngine::instance()->addAudioSink(&m_audioFifo);
|
||||||
|
applySettings(m_settings, true);
|
||||||
}
|
}
|
||||||
|
|
||||||
WFMDemod::~WFMDemod()
|
WFMDemod::~WFMDemod()
|
||||||
@ -72,18 +65,6 @@ WFMDemod::~WFMDemod()
|
|||||||
DSPEngine::instance()->removeAudioSink(&m_audioFifo);
|
DSPEngine::instance()->removeAudioSink(&m_audioFifo);
|
||||||
}
|
}
|
||||||
|
|
||||||
void WFMDemod::configure(
|
|
||||||
MessageQueue* messageQueue,
|
|
||||||
Real rfBandwidth,
|
|
||||||
Real afBandwidth,
|
|
||||||
Real volume,
|
|
||||||
Real squelch,
|
|
||||||
bool audioMute)
|
|
||||||
{
|
|
||||||
Message* cmd = MsgConfigureWFMDemod::create(rfBandwidth, afBandwidth, volume, squelch, audioMute);
|
|
||||||
messageQueue->push(cmd);
|
|
||||||
}
|
|
||||||
|
|
||||||
void WFMDemod::feed(const SampleVector::const_iterator& begin, const SampleVector::const_iterator& end, bool firstOfBurst __attribute__((unused)))
|
void WFMDemod::feed(const SampleVector::const_iterator& begin, const SampleVector::const_iterator& end, bool firstOfBurst __attribute__((unused)))
|
||||||
{
|
{
|
||||||
Complex ci;
|
Complex ci;
|
||||||
@ -119,7 +100,7 @@ void WFMDemod::feed(const SampleVector::const_iterator& begin, const SampleVecto
|
|||||||
m_magsqCount++;
|
m_magsqCount++;
|
||||||
|
|
||||||
if(m_movingAverage.average() >= m_squelchLevel)
|
if(m_movingAverage.average() >= m_squelchLevel)
|
||||||
m_squelchState = m_running.m_rfBandwidth / 20; // decay rate
|
m_squelchState = m_settings.m_rfBandwidth / 20; // decay rate
|
||||||
|
|
||||||
if (m_squelchState > 0)
|
if (m_squelchState > 0)
|
||||||
{
|
{
|
||||||
@ -132,7 +113,7 @@ void WFMDemod::feed(const SampleVector::const_iterator& begin, const SampleVecto
|
|||||||
m_squelchOpen = false;
|
m_squelchOpen = false;
|
||||||
}
|
}
|
||||||
|
|
||||||
if (m_running.m_audioMute)
|
if (m_settings.m_audioMute)
|
||||||
{
|
{
|
||||||
demod = 0;
|
demod = 0;
|
||||||
}
|
}
|
||||||
@ -141,7 +122,7 @@ void WFMDemod::feed(const SampleVector::const_iterator& begin, const SampleVecto
|
|||||||
|
|
||||||
if(m_interpolator.decimate(&m_interpolatorDistanceRemain, e, &ci))
|
if(m_interpolator.decimate(&m_interpolatorDistanceRemain, e, &ci))
|
||||||
{
|
{
|
||||||
quint16 sample = (qint16)(ci.real() * 3276.8f * m_running.m_volume);
|
quint16 sample = (qint16)(ci.real() * 3276.8f * m_settings.m_volume);
|
||||||
m_sampleBuffer.push_back(Sample(sample, sample));
|
m_sampleBuffer.push_back(Sample(sample, sample));
|
||||||
m_audioBuffer[m_audioBufferFill].l = sample;
|
m_audioBuffer[m_audioBufferFill].l = sample;
|
||||||
m_audioBuffer[m_audioBufferFill].r = sample;
|
m_audioBuffer[m_audioBufferFill].r = sample;
|
||||||
@ -203,36 +184,42 @@ bool WFMDemod::handleMessage(const Message& cmd)
|
|||||||
{
|
{
|
||||||
DownChannelizer::MsgChannelizerNotification& notif = (DownChannelizer::MsgChannelizerNotification&) cmd;
|
DownChannelizer::MsgChannelizerNotification& notif = (DownChannelizer::MsgChannelizerNotification&) cmd;
|
||||||
|
|
||||||
m_config.m_inputSampleRate = notif.getSampleRate();
|
WFMDemodSettings settings = m_settings;
|
||||||
m_config.m_inputFrequencyOffset = notif.getFrequencyOffset();
|
|
||||||
|
|
||||||
qDebug() << "WFMDemod::handleMessage: MsgChannelizerNotification: m_inputSampleRate: " << m_config.m_inputSampleRate
|
settings.m_inputSampleRate = notif.getSampleRate();
|
||||||
<< " m_inputFrequencyOffset: " << m_config.m_inputFrequencyOffset;
|
settings.m_inputFrequencyOffset = notif.getFrequencyOffset();
|
||||||
|
|
||||||
apply();
|
applySettings(settings);
|
||||||
|
|
||||||
|
qDebug() << "WFMDemod::handleMessage: MsgChannelizerNotification: m_inputSampleRate: " << settings.m_inputSampleRate
|
||||||
|
<< " m_inputFrequencyOffset: " << settings.m_inputFrequencyOffset;
|
||||||
|
|
||||||
return true;
|
return true;
|
||||||
}
|
}
|
||||||
else if (MsgConfigureWFMDemod::match(cmd))
|
else if (MsgConfigureWFMDemod::match(cmd))
|
||||||
{
|
{
|
||||||
MsgConfigureWFMDemod& cfg = (MsgConfigureWFMDemod&) cmd;
|
MsgConfigureWFMDemod& cfg = (MsgConfigureWFMDemod&) cmd;
|
||||||
|
|
||||||
m_config.m_rfBandwidth = cfg.getRFBandwidth();
|
WFMDemodSettings settings = cfg.getSettings();
|
||||||
m_config.m_afBandwidth = cfg.getAFBandwidth();
|
|
||||||
m_config.m_volume = cfg.getVolume();
|
|
||||||
m_config.m_squelch = cfg.getSquelch();
|
|
||||||
m_config.m_audioMute = cfg.getAudioMute();
|
|
||||||
|
|
||||||
qDebug() << "WFMDemod::handleMessage: MsgConfigureWFMDemod: m_rfBandwidth: " << m_config.m_rfBandwidth
|
// These settings are set with DownChannelizer::MsgChannelizerNotification
|
||||||
<< " m_afBandwidth: " << m_config.m_afBandwidth
|
settings.m_inputSampleRate = m_settings.m_inputSampleRate;
|
||||||
<< " m_volume: " << m_config.m_volume
|
settings.m_inputFrequencyOffset = m_settings.m_inputFrequencyOffset;
|
||||||
<< " m_squelch: " << m_config.m_squelch
|
|
||||||
<< " m_audioMute: " << m_config.m_audioMute;
|
|
||||||
|
|
||||||
apply();
|
applySettings(settings, cfg.getForce());
|
||||||
|
|
||||||
return true;
|
qDebug() << "WFMDemod::handleMessage: MsgConfigureWFMDemod:"
|
||||||
}
|
<< " m_rfBandwidth: " << settings.m_rfBandwidth
|
||||||
|
<< " m_afBandwidth: " << settings.m_afBandwidth
|
||||||
|
<< " m_volume: " << settings.m_volume
|
||||||
|
<< " m_squelch: " << settings.m_squelch
|
||||||
|
<< " m_copyAudioToUDP: " << settings.m_copyAudioToUDP
|
||||||
|
<< " m_udpAddress: " << settings.m_udpAddress
|
||||||
|
<< " m_udpPort: " << settings.m_udpPort
|
||||||
|
<< " force: " << cfg.getForce();
|
||||||
|
|
||||||
|
return true;
|
||||||
|
}
|
||||||
else
|
else
|
||||||
{
|
{
|
||||||
if (m_sampleSink != 0)
|
if (m_sampleSink != 0)
|
||||||
@ -246,49 +233,41 @@ bool WFMDemod::handleMessage(const Message& cmd)
|
|||||||
}
|
}
|
||||||
}
|
}
|
||||||
|
|
||||||
void WFMDemod::apply()
|
void WFMDemod::applySettings(const WFMDemodSettings& settings, bool force)
|
||||||
{
|
{
|
||||||
|
if((settings.m_inputFrequencyOffset != m_settings.m_inputFrequencyOffset) ||
|
||||||
|
(settings.m_inputSampleRate != m_settings.m_inputSampleRate) || force)
|
||||||
|
{
|
||||||
|
qDebug() << "WFMDemod::applySettings: m_nco.setFreq";
|
||||||
|
m_nco.setFreq(-settings.m_inputFrequencyOffset, settings.m_inputSampleRate);
|
||||||
|
}
|
||||||
|
|
||||||
if((m_config.m_inputFrequencyOffset != m_running.m_inputFrequencyOffset) ||
|
if((settings.m_inputSampleRate != m_settings.m_inputSampleRate) ||
|
||||||
(m_config.m_inputSampleRate != m_running.m_inputSampleRate))
|
(settings.m_audioSampleRate != m_settings.m_audioSampleRate) ||
|
||||||
{
|
(settings.m_afBandwidth != m_settings.m_afBandwidth) ||
|
||||||
qDebug() << "WFMDemod::apply: m_nco.setFreq";
|
(settings.m_rfBandwidth != m_settings.m_rfBandwidth) || force)
|
||||||
m_nco.setFreq(-m_config.m_inputFrequencyOffset, m_config.m_inputSampleRate);
|
{
|
||||||
}
|
m_settingsMutex.lock();
|
||||||
|
qDebug() << "WFMDemod::applySettings: m_interpolator.create";
|
||||||
if((m_config.m_inputSampleRate != m_running.m_inputSampleRate) ||
|
m_interpolator.create(16, settings.m_inputSampleRate, settings.m_afBandwidth);
|
||||||
(m_config.m_audioSampleRate != m_running.m_audioSampleRate) ||
|
m_interpolatorDistanceRemain = (Real) settings.m_inputSampleRate / (Real) settings.m_audioSampleRate;
|
||||||
(m_config.m_afBandwidth != m_running.m_afBandwidth) ||
|
m_interpolatorDistance = (Real) settings.m_inputSampleRate / (Real) settings.m_audioSampleRate;
|
||||||
(m_config.m_rfBandwidth != m_running.m_rfBandwidth))
|
qDebug() << "WFMDemod::applySettings: m_rfFilter->create_filter";
|
||||||
{
|
Real lowCut = -(settings.m_rfBandwidth / 2.0) / settings.m_inputSampleRate;
|
||||||
m_settingsMutex.lock();
|
Real hiCut = (settings.m_rfBandwidth / 2.0) / settings.m_inputSampleRate;
|
||||||
qDebug() << "WFMDemod::apply: m_interpolator.create";
|
|
||||||
m_interpolator.create(16, m_config.m_inputSampleRate, m_config.m_afBandwidth);
|
|
||||||
m_interpolatorDistanceRemain = (Real) m_config.m_inputSampleRate / (Real) m_config.m_audioSampleRate;
|
|
||||||
m_interpolatorDistance = (Real) m_config.m_inputSampleRate / (Real) m_config.m_audioSampleRate;
|
|
||||||
qDebug() << "WFMDemod::apply: m_rfFilter->create_filter";
|
|
||||||
Real lowCut = -(m_config.m_rfBandwidth / 2.0) / m_config.m_inputSampleRate;
|
|
||||||
Real hiCut = (m_config.m_rfBandwidth / 2.0) / m_config.m_inputSampleRate;
|
|
||||||
m_rfFilter->create_filter(lowCut, hiCut);
|
m_rfFilter->create_filter(lowCut, hiCut);
|
||||||
m_fmExcursion = m_config.m_rfBandwidth / (Real) m_config.m_inputSampleRate;
|
m_fmExcursion = settings.m_rfBandwidth / (Real) settings.m_inputSampleRate;
|
||||||
m_phaseDiscri.setFMScaling(1.0f/m_fmExcursion);
|
m_phaseDiscri.setFMScaling(1.0f/m_fmExcursion);
|
||||||
qDebug("WFMDemod::apply: m_fmExcursion: %f", m_fmExcursion);
|
qDebug("WFMDemod::applySettings: m_fmExcursion: %f", m_fmExcursion);
|
||||||
m_settingsMutex.unlock();
|
m_settingsMutex.unlock();
|
||||||
}
|
}
|
||||||
|
|
||||||
if(m_config.m_squelch != m_running.m_squelch)
|
if ((settings.m_squelch != m_settings.m_squelch) || force)
|
||||||
{
|
{
|
||||||
qDebug() << "WFMDemod::apply: set m_squelchLevel";
|
qDebug() << "WFMDemod::applySettings: set m_squelchLevel";
|
||||||
m_squelchLevel = pow(10.0, m_config.m_squelch / 20.0);
|
m_squelchLevel = pow(10.0, settings.m_squelch / 20.0);
|
||||||
m_squelchLevel *= m_squelchLevel;
|
m_squelchLevel *= m_squelchLevel;
|
||||||
}
|
}
|
||||||
|
|
||||||
m_running.m_inputSampleRate = m_config.m_inputSampleRate;
|
m_settings = settings;
|
||||||
m_running.m_inputFrequencyOffset = m_config.m_inputFrequencyOffset;
|
|
||||||
m_running.m_rfBandwidth = m_config.m_rfBandwidth;
|
|
||||||
m_running.m_afBandwidth = m_config.m_afBandwidth;
|
|
||||||
m_running.m_squelch = m_config.m_squelch;
|
|
||||||
m_running.m_volume = m_config.m_volume;
|
|
||||||
m_running.m_audioSampleRate = m_config.m_audioSampleRate;
|
|
||||||
m_running.m_audioMute = m_config.m_audioMute;
|
|
||||||
}
|
}
|
||||||
|
@ -30,21 +30,61 @@
|
|||||||
#include "audio/audiofifo.h"
|
#include "audio/audiofifo.h"
|
||||||
#include "util/message.h"
|
#include "util/message.h"
|
||||||
|
|
||||||
|
#include "wfmdemodsettings.h"
|
||||||
|
|
||||||
#define rfFilterFftLength 1024
|
#define rfFilterFftLength 1024
|
||||||
|
|
||||||
class WFMDemod : public BasebandSampleSink {
|
class WFMDemod : public BasebandSampleSink {
|
||||||
public:
|
public:
|
||||||
|
class MsgConfigureWFMDemod : public Message {
|
||||||
|
MESSAGE_CLASS_DECLARATION
|
||||||
|
|
||||||
|
public:
|
||||||
|
const WFMDemodSettings& getSettings() const { return m_settings; }
|
||||||
|
bool getForce() const { return m_force; }
|
||||||
|
|
||||||
|
static MsgConfigureWFMDemod* create(const WFMDemodSettings& settings, bool force)
|
||||||
|
{
|
||||||
|
return new MsgConfigureWFMDemod(settings, force);
|
||||||
|
}
|
||||||
|
|
||||||
|
private:
|
||||||
|
WFMDemodSettings m_settings;
|
||||||
|
bool m_force;
|
||||||
|
|
||||||
|
MsgConfigureWFMDemod(const WFMDemodSettings& settings, bool force) :
|
||||||
|
Message(),
|
||||||
|
m_settings(settings),
|
||||||
|
m_force(force)
|
||||||
|
{ }
|
||||||
|
};
|
||||||
|
|
||||||
|
class MsgConfigureChannelizer : public Message {
|
||||||
|
MESSAGE_CLASS_DECLARATION
|
||||||
|
|
||||||
|
public:
|
||||||
|
int getSampleRate() const { return m_sampleRate; }
|
||||||
|
int getCenterFrequency() const { return m_centerFrequency; }
|
||||||
|
|
||||||
|
static MsgConfigureChannelizer* create(int sampleRate, int centerFrequency)
|
||||||
|
{
|
||||||
|
return new MsgConfigureChannelizer(sampleRate, centerFrequency);
|
||||||
|
}
|
||||||
|
|
||||||
|
private:
|
||||||
|
int m_sampleRate;
|
||||||
|
int m_centerFrequency;
|
||||||
|
|
||||||
|
MsgConfigureChannelizer(int sampleRate, int centerFrequency) :
|
||||||
|
Message(),
|
||||||
|
m_sampleRate(sampleRate),
|
||||||
|
m_centerFrequency(centerFrequency)
|
||||||
|
{ }
|
||||||
|
};
|
||||||
|
|
||||||
WFMDemod(BasebandSampleSink* sampleSink);
|
WFMDemod(BasebandSampleSink* sampleSink);
|
||||||
virtual ~WFMDemod();
|
virtual ~WFMDemod();
|
||||||
|
|
||||||
void configure(
|
|
||||||
MessageQueue* messageQueue,
|
|
||||||
Real rfBandwidth,
|
|
||||||
Real afBandwidth,
|
|
||||||
Real volume,
|
|
||||||
Real squelch,
|
|
||||||
bool auduiMute);
|
|
||||||
|
|
||||||
virtual void feed(const SampleVector::const_iterator& begin, const SampleVector::const_iterator& end, bool po);
|
virtual void feed(const SampleVector::const_iterator& begin, const SampleVector::const_iterator& end, bool po);
|
||||||
virtual void start();
|
virtual void start();
|
||||||
virtual void stop();
|
virtual void stop();
|
||||||
@ -65,67 +105,12 @@ public:
|
|||||||
}
|
}
|
||||||
|
|
||||||
private:
|
private:
|
||||||
class MsgConfigureWFMDemod : public Message {
|
|
||||||
MESSAGE_CLASS_DECLARATION
|
|
||||||
|
|
||||||
public:
|
|
||||||
Real getRFBandwidth() const { return m_rfBandwidth; }
|
|
||||||
Real getAFBandwidth() const { return m_afBandwidth; }
|
|
||||||
Real getVolume() const { return m_volume; }
|
|
||||||
Real getSquelch() const { return m_squelch; }
|
|
||||||
bool getAudioMute() const { return m_audioMute; }
|
|
||||||
|
|
||||||
static MsgConfigureWFMDemod* create(Real rfBandwidth, Real afBandwidth, Real volume, Real squelch, bool audioMute)
|
|
||||||
{
|
|
||||||
return new MsgConfigureWFMDemod(rfBandwidth, afBandwidth, volume, squelch, audioMute);
|
|
||||||
}
|
|
||||||
|
|
||||||
private:
|
|
||||||
Real m_rfBandwidth;
|
|
||||||
Real m_afBandwidth;
|
|
||||||
Real m_volume;
|
|
||||||
Real m_squelch;
|
|
||||||
bool m_audioMute;
|
|
||||||
|
|
||||||
MsgConfigureWFMDemod(Real rfBandwidth, Real afBandwidth, Real volume, Real squelch, bool audioMute) :
|
|
||||||
Message(),
|
|
||||||
m_rfBandwidth(rfBandwidth),
|
|
||||||
m_afBandwidth(afBandwidth),
|
|
||||||
m_volume(volume),
|
|
||||||
m_squelch(squelch),
|
|
||||||
m_audioMute(audioMute)
|
|
||||||
{ }
|
|
||||||
};
|
|
||||||
|
|
||||||
enum RateState {
|
enum RateState {
|
||||||
RSInitialFill,
|
RSInitialFill,
|
||||||
RSRunning
|
RSRunning
|
||||||
};
|
};
|
||||||
|
|
||||||
struct Config {
|
WFMDemodSettings m_settings;
|
||||||
int m_inputSampleRate;
|
|
||||||
qint64 m_inputFrequencyOffset;
|
|
||||||
Real m_rfBandwidth;
|
|
||||||
Real m_afBandwidth;
|
|
||||||
Real m_squelch;
|
|
||||||
Real m_volume;
|
|
||||||
quint32 m_audioSampleRate;
|
|
||||||
bool m_audioMute;
|
|
||||||
|
|
||||||
Config() :
|
|
||||||
m_inputSampleRate(-1),
|
|
||||||
m_inputFrequencyOffset(0),
|
|
||||||
m_rfBandwidth(-1),
|
|
||||||
m_afBandwidth(-1),
|
|
||||||
m_squelch(0),
|
|
||||||
m_volume(0),
|
|
||||||
m_audioSampleRate(0),
|
|
||||||
m_audioMute(false)
|
|
||||||
{ }
|
|
||||||
};
|
|
||||||
|
|
||||||
Config m_config;
|
|
||||||
Config m_running;
|
|
||||||
|
|
||||||
NCO m_nco;
|
NCO m_nco;
|
||||||
Interpolator m_interpolator; //!< Interpolator between sample rate sent from DSP engine and requested RF bandwidth (rational)
|
Interpolator m_interpolator; //!< Interpolator between sample rate sent from DSP engine and requested RF bandwidth (rational)
|
||||||
@ -155,7 +140,7 @@ private:
|
|||||||
|
|
||||||
PhaseDiscriminators m_phaseDiscri;
|
PhaseDiscriminators m_phaseDiscri;
|
||||||
|
|
||||||
void apply();
|
void applySettings(const WFMDemodSettings& settings, bool force = false);
|
||||||
};
|
};
|
||||||
|
|
||||||
#endif // INCLUDE_WFMDEMOD_H
|
#endif // INCLUDE_WFMDEMOD_H
|
||||||
|
@ -225,12 +225,8 @@ void WFMDemodGUI::applySettings(bool force)
|
|||||||
|
|
||||||
ui->deltaFrequency->setValue(m_channelMarker.getCenterFrequency());
|
ui->deltaFrequency->setValue(m_channelMarker.getCenterFrequency());
|
||||||
|
|
||||||
m_wfmDemod->configure(m_wfmDemod->getInputMessageQueue(),
|
WFMDemod::MsgConfigureWFMDemod* msgConfig = WFMDemod::MsgConfigureWFMDemod::create( m_settings, force);
|
||||||
m_settings.m_rfBandwidth,
|
m_wfmDemod->getInputMessageQueue()->push(msgConfig);
|
||||||
m_settings.m_afBandwidth,
|
|
||||||
m_settings.m_volume,
|
|
||||||
m_settings.m_squelch,
|
|
||||||
m_settings.m_audioMute);
|
|
||||||
}
|
}
|
||||||
}
|
}
|
||||||
|
|
||||||
|
Loading…
Reference in New Issue
Block a user