mirror of
https://github.com/f4exb/sdrangel.git
synced 2024-11-05 16:31:15 -05:00
Deep redesign: debug NFM demod interpolator init
This commit is contained in:
parent
b36f3057ae
commit
11cc3044f8
@ -53,6 +53,7 @@ AMDemod::AMDemod() :
|
|||||||
|
|
||||||
AMDemod::~AMDemod()
|
AMDemod::~AMDemod()
|
||||||
{
|
{
|
||||||
|
DSPEngine::instance()->removeAudioSink(&m_audioFifo);
|
||||||
}
|
}
|
||||||
|
|
||||||
void AMDemod::configure(MessageQueue* messageQueue, Real rfBandwidth, Real afBandwidth, Real volume, Real squelch)
|
void AMDemod::configure(MessageQueue* messageQueue, Real rfBandwidth, Real afBandwidth, Real volume, Real squelch)
|
||||||
@ -225,8 +226,6 @@ void AMDemod::apply()
|
|||||||
m_interpolator.create(16, m_config.m_inputSampleRate, m_config.m_rfBandwidth / 2.2);
|
m_interpolator.create(16, m_config.m_inputSampleRate, m_config.m_rfBandwidth / 2.2);
|
||||||
m_interpolatorDistanceRemain = 0;
|
m_interpolatorDistanceRemain = 0;
|
||||||
m_interpolatorDistance = (Real) m_config.m_inputSampleRate / (Real) m_config.m_audioSampleRate;
|
m_interpolatorDistance = (Real) m_config.m_inputSampleRate / (Real) m_config.m_audioSampleRate;
|
||||||
qDebug() << "AMDemod::apply: m_inputSampleRate: " << m_config.m_inputSampleRate
|
|
||||||
<< " m_interpolatorDistance: " << m_interpolatorDistance;
|
|
||||||
}
|
}
|
||||||
|
|
||||||
if((m_config.m_afBandwidth != m_running.m_afBandwidth) ||
|
if((m_config.m_afBandwidth != m_running.m_afBandwidth) ||
|
||||||
|
@ -30,13 +30,12 @@ static const Real afSqTones[2] = {1200.0, 8000.0};
|
|||||||
|
|
||||||
MESSAGE_CLASS_DEFINITION(NFMDemod::MsgConfigureNFMDemod, Message)
|
MESSAGE_CLASS_DEFINITION(NFMDemod::MsgConfigureNFMDemod, Message)
|
||||||
|
|
||||||
NFMDemod::NFMDemod(AudioFifo* audioFifo, SampleSink* sampleSink) :
|
NFMDemod::NFMDemod() :
|
||||||
m_ctcssIndex(0),
|
m_ctcssIndex(0),
|
||||||
m_sampleCount(0),
|
m_sampleCount(0),
|
||||||
m_afSquelch(2, afSqTones),
|
m_afSquelch(2, afSqTones),
|
||||||
m_squelchOpen(false),
|
m_squelchOpen(false),
|
||||||
m_sampleSink(sampleSink),
|
m_audioFifo(4, 48000)
|
||||||
m_audioFifo(audioFifo)
|
|
||||||
{
|
{
|
||||||
setObjectName("NFMDemod");
|
setObjectName("NFMDemod");
|
||||||
|
|
||||||
@ -46,11 +45,11 @@ NFMDemod::NFMDemod(AudioFifo* audioFifo, SampleSink* sampleSink) :
|
|||||||
m_config.m_afBandwidth = 3000;
|
m_config.m_afBandwidth = 3000;
|
||||||
m_config.m_squelch = -30.0;
|
m_config.m_squelch = -30.0;
|
||||||
m_config.m_volume = 2.0;
|
m_config.m_volume = 2.0;
|
||||||
m_config.m_audioSampleRate = 48000;
|
m_config.m_audioSampleRate = DSPEngine::instance()->getAudioSampleRate();
|
||||||
|
|
||||||
apply();
|
apply();
|
||||||
|
|
||||||
m_audioBuffer.resize(16384);
|
m_audioBuffer.resize(1<<14);
|
||||||
m_audioBufferFill = 0;
|
m_audioBufferFill = 0;
|
||||||
|
|
||||||
m_movingAverage.resize(16, 0);
|
m_movingAverage.resize(16, 0);
|
||||||
@ -61,10 +60,13 @@ NFMDemod::NFMDemod(AudioFifo* audioFifo, SampleSink* sampleSink) :
|
|||||||
m_ctcssDetector.setCoefficients(3000, 6000.0); // 0.5s / 2 Hz resolution
|
m_ctcssDetector.setCoefficients(3000, 6000.0); // 0.5s / 2 Hz resolution
|
||||||
m_afSquelch.setCoefficients(24, 48000.0, 5, 1); // 4000 Hz span, 250us
|
m_afSquelch.setCoefficients(24, 48000.0, 5, 1); // 4000 Hz span, 250us
|
||||||
m_afSquelch.setThreshold(0.001);
|
m_afSquelch.setThreshold(0.001);
|
||||||
|
|
||||||
|
DSPEngine::instance()->addAudioSink(&m_audioFifo);
|
||||||
}
|
}
|
||||||
|
|
||||||
NFMDemod::~NFMDemod()
|
NFMDemod::~NFMDemod()
|
||||||
{
|
{
|
||||||
|
DSPEngine::instance()->removeAudioSink(&m_audioFifo);
|
||||||
}
|
}
|
||||||
|
|
||||||
void NFMDemod::configure(MessageQueue* messageQueue, Real rfBandwidth, Real afBandwidth, Real volume, Real squelch)
|
void NFMDemod::configure(MessageQueue* messageQueue, Real rfBandwidth, Real afBandwidth, Real volume, Real squelch)
|
||||||
@ -107,7 +109,7 @@ void NFMDemod::feed(SampleVector::const_iterator begin, SampleVector::const_iter
|
|||||||
{
|
{
|
||||||
Complex ci;
|
Complex ci;
|
||||||
|
|
||||||
if (m_audioFifo->size() == 0)
|
if (m_audioFifo.size() == 0)
|
||||||
{
|
{
|
||||||
return;
|
return;
|
||||||
}
|
}
|
||||||
@ -227,13 +229,12 @@ void NFMDemod::feed(SampleVector::const_iterator begin, SampleVector::const_iter
|
|||||||
|
|
||||||
if (m_audioBufferFill >= m_audioBuffer.size())
|
if (m_audioBufferFill >= m_audioBuffer.size())
|
||||||
{
|
{
|
||||||
uint res = m_audioFifo->write((const quint8*)&m_audioBuffer[0], m_audioBufferFill, 1);
|
uint res = m_audioFifo.write((const quint8*)&m_audioBuffer[0], m_audioBufferFill, 10);
|
||||||
|
|
||||||
/* FIXME: Not necessarily bad, There is a race between threads but generally it works i.e. samples are not lost
|
|
||||||
if (res != m_audioBufferFill)
|
if (res != m_audioBufferFill)
|
||||||
{
|
{
|
||||||
qDebug("lost %u audio samples", m_audioBufferFill - res);
|
qDebug("NFMDemod::feed: %u/%u audio samples written", res, m_audioBufferFill);
|
||||||
}*/
|
}
|
||||||
|
|
||||||
m_audioBufferFill = 0;
|
m_audioBufferFill = 0;
|
||||||
}
|
}
|
||||||
@ -245,28 +246,22 @@ void NFMDemod::feed(SampleVector::const_iterator begin, SampleVector::const_iter
|
|||||||
|
|
||||||
if (m_audioBufferFill > 0)
|
if (m_audioBufferFill > 0)
|
||||||
{
|
{
|
||||||
uint res = m_audioFifo->write((const quint8*)&m_audioBuffer[0], m_audioBufferFill, 1);
|
uint res = m_audioFifo.write((const quint8*)&m_audioBuffer[0], m_audioBufferFill, 10);
|
||||||
|
|
||||||
/* Same remark as above
|
|
||||||
if (res != m_audioBufferFill)
|
if (res != m_audioBufferFill)
|
||||||
{
|
{
|
||||||
qDebug("lost %u samples", m_audioBufferFill - res);
|
qDebug("NFMDemod::feed: %u/%u tail samples written", res, m_audioBufferFill);
|
||||||
}*/
|
}
|
||||||
|
|
||||||
m_audioBufferFill = 0;
|
m_audioBufferFill = 0;
|
||||||
}
|
}
|
||||||
|
|
||||||
if(m_sampleSink != NULL)
|
|
||||||
m_sampleSink->feed(m_sampleBuffer.begin(), m_sampleBuffer.end(), false);
|
|
||||||
m_sampleBuffer.clear();
|
m_sampleBuffer.clear();
|
||||||
}
|
}
|
||||||
|
|
||||||
void NFMDemod::start()
|
void NFMDemod::start()
|
||||||
{
|
{
|
||||||
m_audioFifo->clear();
|
m_audioFifo.clear();
|
||||||
m_interpolatorRegulation = 0.9999;
|
|
||||||
m_interpolatorDistance = 1.0;
|
|
||||||
m_interpolatorDistanceRemain = 0.0;
|
|
||||||
m_m1Sample = 0;
|
m_m1Sample = 0;
|
||||||
}
|
}
|
||||||
|
|
||||||
@ -312,14 +307,7 @@ bool NFMDemod::handleMessage(const Message& cmd)
|
|||||||
}
|
}
|
||||||
else
|
else
|
||||||
{
|
{
|
||||||
if (m_sampleSink != 0)
|
return false;
|
||||||
{
|
|
||||||
return m_sampleSink->handleMessage(cmd);
|
|
||||||
}
|
|
||||||
else
|
|
||||||
{
|
|
||||||
return false;
|
|
||||||
}
|
|
||||||
}
|
}
|
||||||
}
|
}
|
||||||
|
|
||||||
|
@ -36,7 +36,7 @@ class NFMDemodGUI;
|
|||||||
|
|
||||||
class NFMDemod : public SampleSink {
|
class NFMDemod : public SampleSink {
|
||||||
public:
|
public:
|
||||||
NFMDemod(AudioFifo* audioFifo, SampleSink* sampleSink);
|
NFMDemod();
|
||||||
~NFMDemod();
|
~NFMDemod();
|
||||||
|
|
||||||
void configure(MessageQueue* messageQueue, Real rfBandwidth, Real afBandwidth, Real volume, Real squelch);
|
void configure(MessageQueue* messageQueue, Real rfBandwidth, Real afBandwidth, Real volume, Real squelch);
|
||||||
@ -126,7 +126,6 @@ private:
|
|||||||
Config m_running;
|
Config m_running;
|
||||||
|
|
||||||
NCO m_nco;
|
NCO m_nco;
|
||||||
Real m_interpolatorRegulation;
|
|
||||||
Interpolator m_interpolator;
|
Interpolator m_interpolator;
|
||||||
Real m_interpolatorDistance;
|
Real m_interpolatorDistance;
|
||||||
Real m_interpolatorDistanceRemain;
|
Real m_interpolatorDistanceRemain;
|
||||||
@ -153,8 +152,7 @@ private:
|
|||||||
AudioVector m_audioBuffer;
|
AudioVector m_audioBuffer;
|
||||||
uint m_audioBufferFill;
|
uint m_audioBufferFill;
|
||||||
|
|
||||||
SampleSink* m_sampleSink;
|
AudioFifo m_audioFifo;
|
||||||
AudioFifo* m_audioFifo;
|
|
||||||
SampleVector m_sampleBuffer;
|
SampleVector m_sampleBuffer;
|
||||||
|
|
||||||
NFMDemodGUI *m_nfmDemodGUI;
|
NFMDemodGUI *m_nfmDemodGUI;
|
||||||
|
@ -217,9 +217,7 @@ NFMDemodGUI::NFMDemodGUI(PluginAPI* pluginAPI, QWidget* parent) :
|
|||||||
connect(this, SIGNAL(widgetRolled(QWidget*,bool)), this, SLOT(onWidgetRolled(QWidget*,bool)));
|
connect(this, SIGNAL(widgetRolled(QWidget*,bool)), this, SLOT(onWidgetRolled(QWidget*,bool)));
|
||||||
connect(this, SIGNAL(menuDoubleClickEvent()), this, SLOT(onMenuDoubleClicked()));
|
connect(this, SIGNAL(menuDoubleClickEvent()), this, SLOT(onMenuDoubleClicked()));
|
||||||
|
|
||||||
m_audioFifo = new AudioFifo(4, 48000);
|
m_nfmDemod = new NFMDemod();
|
||||||
|
|
||||||
m_nfmDemod = new NFMDemod(m_audioFifo, 0);
|
|
||||||
m_nfmDemod->registerGUI(this);
|
m_nfmDemod->registerGUI(this);
|
||||||
|
|
||||||
int ctcss_nbTones;
|
int ctcss_nbTones;
|
||||||
@ -233,11 +231,9 @@ NFMDemodGUI::NFMDemodGUI(PluginAPI* pluginAPI, QWidget* parent) :
|
|||||||
}
|
}
|
||||||
|
|
||||||
ui->deltaFrequency->setColorMapper(ColorMapper(ColorMapper::ReverseGold));
|
ui->deltaFrequency->setColorMapper(ColorMapper(ColorMapper::ReverseGold));
|
||||||
//ui->deltaFrequency->setBold(true);
|
|
||||||
|
|
||||||
m_channelizer = new Channelizer(m_nfmDemod);
|
m_channelizer = new Channelizer(m_nfmDemod);
|
||||||
m_threadedChannelizer = new ThreadedSampleSink(m_channelizer, this);
|
m_threadedChannelizer = new ThreadedSampleSink(m_channelizer, this);
|
||||||
DSPEngine::instance()->addAudioSink(m_audioFifo);
|
|
||||||
DSPEngine::instance()->addThreadedSink(m_threadedChannelizer);
|
DSPEngine::instance()->addThreadedSink(m_threadedChannelizer);
|
||||||
|
|
||||||
m_channelMarker = new ChannelMarker(this);
|
m_channelMarker = new ChannelMarker(this);
|
||||||
@ -245,7 +241,9 @@ NFMDemodGUI::NFMDemodGUI(PluginAPI* pluginAPI, QWidget* parent) :
|
|||||||
m_channelMarker->setBandwidth(12500);
|
m_channelMarker->setBandwidth(12500);
|
||||||
m_channelMarker->setCenterFrequency(0);
|
m_channelMarker->setCenterFrequency(0);
|
||||||
m_channelMarker->setVisible(true);
|
m_channelMarker->setVisible(true);
|
||||||
|
|
||||||
connect(m_channelMarker, SIGNAL(changed()), this, SLOT(viewChanged()));
|
connect(m_channelMarker, SIGNAL(changed()), this, SLOT(viewChanged()));
|
||||||
|
|
||||||
m_pluginAPI->addChannelMarker(m_channelMarker);
|
m_pluginAPI->addChannelMarker(m_channelMarker);
|
||||||
|
|
||||||
applySettings();
|
applySettings();
|
||||||
@ -254,12 +252,10 @@ NFMDemodGUI::NFMDemodGUI(PluginAPI* pluginAPI, QWidget* parent) :
|
|||||||
NFMDemodGUI::~NFMDemodGUI()
|
NFMDemodGUI::~NFMDemodGUI()
|
||||||
{
|
{
|
||||||
m_pluginAPI->removeChannelInstance(this);
|
m_pluginAPI->removeChannelInstance(this);
|
||||||
DSPEngine::instance()->removeAudioSink(m_audioFifo);
|
|
||||||
DSPEngine::instance()->removeThreadedSink(m_threadedChannelizer);
|
DSPEngine::instance()->removeThreadedSink(m_threadedChannelizer);
|
||||||
delete m_threadedChannelizer;
|
delete m_threadedChannelizer;
|
||||||
delete m_channelizer;
|
delete m_channelizer;
|
||||||
delete m_nfmDemod;
|
delete m_nfmDemod;
|
||||||
delete m_audioFifo;
|
|
||||||
delete m_channelMarker;
|
delete m_channelMarker;
|
||||||
delete ui;
|
delete ui;
|
||||||
}
|
}
|
||||||
|
@ -9,8 +9,8 @@ MESSAGE_CLASS_DEFINITION(Channelizer::MsgChannelizerNotification, Message)
|
|||||||
|
|
||||||
Channelizer::Channelizer(SampleSink* sampleSink) :
|
Channelizer::Channelizer(SampleSink* sampleSink) :
|
||||||
m_sampleSink(sampleSink),
|
m_sampleSink(sampleSink),
|
||||||
m_inputSampleRate(10),
|
m_inputSampleRate(0),
|
||||||
m_requestedOutputSampleRate(10),
|
m_requestedOutputSampleRate(0),
|
||||||
m_requestedCenterFrequency(0),
|
m_requestedCenterFrequency(0),
|
||||||
m_currentOutputSampleRate(0),
|
m_currentOutputSampleRate(0),
|
||||||
m_currentCenterFrequency(0)
|
m_currentCenterFrequency(0)
|
||||||
@ -55,7 +55,7 @@ void Channelizer::feed(SampleVector::const_iterator begin, SampleVector::const_i
|
|||||||
|
|
||||||
void Channelizer::start()
|
void Channelizer::start()
|
||||||
{
|
{
|
||||||
if(m_sampleSink != 0)
|
if (m_sampleSink != 0)
|
||||||
{
|
{
|
||||||
qDebug() << "Channelizer::start: thread: " << thread()
|
qDebug() << "Channelizer::start: thread: " << thread()
|
||||||
<< " m_inputSampleRate: " << m_inputSampleRate
|
<< " m_inputSampleRate: " << m_inputSampleRate
|
||||||
@ -119,10 +119,18 @@ bool Channelizer::handleMessage(const Message& cmd)
|
|||||||
|
|
||||||
void Channelizer::applyConfiguration()
|
void Channelizer::applyConfiguration()
|
||||||
{
|
{
|
||||||
|
if (m_inputSampleRate == 0)
|
||||||
|
{
|
||||||
|
qDebug() << "Channelizer::applyConfiguration: m_inputSampleRate=0 aborting";
|
||||||
|
return;
|
||||||
|
}
|
||||||
|
|
||||||
freeFilterChain();
|
freeFilterChain();
|
||||||
|
|
||||||
m_currentCenterFrequency = createFilterChain(
|
m_currentCenterFrequency = createFilterChain(
|
||||||
m_inputSampleRate / -2, m_inputSampleRate / 2,
|
m_inputSampleRate / -2, m_inputSampleRate / 2,
|
||||||
m_requestedCenterFrequency - m_requestedOutputSampleRate / 2, m_requestedCenterFrequency + m_requestedOutputSampleRate / 2);
|
m_requestedCenterFrequency - m_requestedOutputSampleRate / 2, m_requestedCenterFrequency + m_requestedOutputSampleRate / 2);
|
||||||
|
|
||||||
m_currentOutputSampleRate = m_inputSampleRate / (1 << m_filterStages.size());
|
m_currentOutputSampleRate = m_inputSampleRate / (1 << m_filterStages.size());
|
||||||
|
|
||||||
qDebug() << "Channelizer::applyConfiguration in=" << m_inputSampleRate
|
qDebug() << "Channelizer::applyConfiguration in=" << m_inputSampleRate
|
||||||
|
@ -502,12 +502,17 @@ void MainWindow::on_presetLoad_clicked()
|
|||||||
qDebug() << "MainWindow::on_presetLoad_clicked";
|
qDebug() << "MainWindow::on_presetLoad_clicked";
|
||||||
|
|
||||||
QTreeWidgetItem* item = ui->presetTree->currentItem();
|
QTreeWidgetItem* item = ui->presetTree->currentItem();
|
||||||
if(item == 0) {
|
|
||||||
|
if(item == 0)
|
||||||
|
{
|
||||||
updatePresetControls();
|
updatePresetControls();
|
||||||
return;
|
return;
|
||||||
}
|
}
|
||||||
|
|
||||||
const Preset* preset = qvariant_cast<const Preset*>(item->data(0, Qt::UserRole));
|
const Preset* preset = qvariant_cast<const Preset*>(item->data(0, Qt::UserRole));
|
||||||
if(preset == 0) {
|
|
||||||
|
if(preset == 0)
|
||||||
|
{
|
||||||
return;
|
return;
|
||||||
}
|
}
|
||||||
|
|
||||||
|
Loading…
Reference in New Issue
Block a user