diff --git a/plugins/channel/CMakeLists.txt b/plugins/channel/CMakeLists.txt index b16491325..f1506c59a 100644 --- a/plugins/channel/CMakeLists.txt +++ b/plugins/channel/CMakeLists.txt @@ -4,5 +4,6 @@ add_subdirectory(nfm) add_subdirectory(ssb) add_subdirectory(tcpsrc) add_subdirectory(usb) +add_subdirectory(wfm) #add_subdirectory(tetra) diff --git a/plugins/channel/wfm/CMakeLists.txt b/plugins/channel/wfm/CMakeLists.txt new file mode 100644 index 000000000..72d173c1b --- /dev/null +++ b/plugins/channel/wfm/CMakeLists.txt @@ -0,0 +1,47 @@ +project(wfm) + +set(wfm_SOURCES + wfmdemod.cpp + wfmdemodgui.cpp + wfmplugin.cpp +) + +set(wfm_HEADERS + wfmdemod.h + wfmdemodgui.h + wfmplugin.h +) + +set(wfm_FORMS + wfmdemodgui.ui +) + +include_directories( + . + ${CMAKE_CURRENT_BINARY_DIR} + ${CMAKE_SOURCE_DIR}/include + ${CMAKE_SOURCE_DIR}/include-gpl + ${OPENGL_INCLUDE_DIR} +) + +#include(${QT_USE_FILE}) +add_definitions(${QT_DEFINITIONS}) +add_definitions(-DQT_PLUGIN) +add_definitions(-DQT_SHARED) + +#qt5_wrap_cpp(wfm_HEADERS_MOC ${wfm_HEADERS}) +qt5_wrap_ui(wfm_FORMS_HEADERS ${wfm_FORMS}) + +add_library(demodwfm SHARED + ${wfm_SOURCES} + ${wfm_HEADERS_MOC} + ${wfm_FORMS_HEADERS} +) + +target_link_libraries(demodwfm + ${QT_LIBRARIES} + ${OPENGL_LIBRARIES} + sdrbase +) + +qt5_use_modules(demodwfm Core Widgets OpenGL Multimedia) diff --git a/plugins/channel/wfm/wfmdemod.cpp b/plugins/channel/wfm/wfmdemod.cpp new file mode 100644 index 000000000..1329a93d7 --- /dev/null +++ b/plugins/channel/wfm/wfmdemod.cpp @@ -0,0 +1,119 @@ +/////////////////////////////////////////////////////////////////////////////////// +// Copyright (C) 2012 maintech GmbH, Otto-Hahn-Str. 15, 97204 Hoechberg, Germany // +// written by Christian Daniel // +// // +// This program is free software; you can redistribute it and/or modify // +// it under the terms of the GNU General Public License as published by // +// the Free Software Foundation as version 3 of the License, or // +// // +// This program is distributed in the hope that it will be useful, // +// but WITHOUT ANY WARRANTY; without even the implied warranty of // +// MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE. See the // +// GNU General Public License V3 for more details. // +// // +// You should have received a copy of the GNU General Public License // +// along with this program. If not, see . // +/////////////////////////////////////////////////////////////////////////////////// + +#include +#include +#include "wfmdemod.h" +#include "audio/audiooutput.h" +#include "dsp/dspcommands.h" + +MESSAGE_CLASS_DEFINITION(WFMDemod::MsgConfigureWFMDemod, Message) + +WFMDemod::WFMDemod(AudioFifo* audioFifo, SampleSink* sampleSink) : + m_sampleSink(sampleSink), + m_audioFifo(audioFifo) +{ + m_volume = 2.0; + m_sampleRate = 250000; + m_frequency = 0; + + m_nco.setFreq(m_frequency, m_sampleRate); + m_interpolator.create(16, m_sampleRate, 16000); + m_sampleDistanceRemain = (Real)m_sampleRate / 48000.0; + + m_audioBuffer.resize(256); + m_audioBufferFill = 0; +} + +WFMDemod::~WFMDemod() +{ +} + +void WFMDemod::configure(MessageQueue* messageQueue, Real afBandwidth, Real volume) +{ + Message* cmd = MsgConfigureWFMDemod::create(afBandwidth, volume); + cmd->submit(messageQueue, this); +} + +void WFMDemod::feed(SampleVector::const_iterator begin, SampleVector::const_iterator end, bool positiveOnly) +{ + Complex ci; + bool consumed; + qint16 sample; + Real demod; + + for(SampleVector::const_iterator it = begin; it < end; ++it) { + Complex c(it->real() , it->imag()); + Complex d = c * conj(m_lastSample); + m_lastSample = c; + demod = atan2(d.imag(), d.real()) * (1 /M_PI); + Complex e(demod, 0); + + consumed = false; + if(m_interpolator.interpolate(&m_sampleDistanceRemain, e, &consumed, &ci)) { + sample = (qint16)(3000.0 * ci.real() * m_volume); + m_sampleBuffer.push_back(Sample(sample, sample)); + m_audioBuffer[m_audioBufferFill].l = sample; + m_audioBuffer[m_audioBufferFill].r = sample; + ++m_audioBufferFill; + if(m_audioBufferFill >= m_audioBuffer.size()) { + uint res = m_audioFifo->write((const quint8*)&m_audioBuffer[0], m_audioBufferFill, 1); + /* + if(res != m_audioBufferFill) + qDebug("lost %u samples", m_audioBufferFill - res); + */ + m_audioBufferFill = 0; + } + + m_sampleDistanceRemain += (Real)m_sampleRate / 48000.0; + } + } + if(m_audioFifo->write((const quint8*)&m_audioBuffer[0], m_audioBufferFill, 0) != m_audioBufferFill) + ;//qDebug("lost samples"); + m_audioBufferFill = 0; + + if(m_sampleSink != NULL) + m_sampleSink->feed(m_sampleBuffer.begin(), m_sampleBuffer.end(), true); + m_sampleBuffer.clear(); +} + +void WFMDemod::start() {} +void WFMDemod::stop() {} + +bool WFMDemod::handleMessage(Message* cmd) +{ + if(DSPSignalNotification::match(cmd)) { + DSPSignalNotification* signal = (DSPSignalNotification*)cmd; + qDebug("%d samples/sec, %lld Hz offset", signal->getSampleRate(), signal->getFrequencyOffset()); + m_sampleRate = signal->getSampleRate(); + m_interpolator.create(16, m_sampleRate, m_afBandwidth); + m_sampleDistanceRemain = m_sampleRate / 48000.0; + cmd->completed(); + return true; + } else if(MsgConfigureWFMDemod::match(cmd)) { + MsgConfigureWFMDemod* cfg = (MsgConfigureWFMDemod*)cmd; + m_afBandwidth = cfg->getAFBandwidth(); + m_interpolator.create(16, m_sampleRate, m_afBandwidth); + m_volume = cfg->getVolume(); + cmd->completed(); + return true; + } else { + if(m_sampleSink != NULL) + return m_sampleSink->handleMessage(cmd); + else return false; + } +} diff --git a/plugins/channel/wfm/wfmdemod.h b/plugins/channel/wfm/wfmdemod.h new file mode 100644 index 000000000..bf3fcfa09 --- /dev/null +++ b/plugins/channel/wfm/wfmdemod.h @@ -0,0 +1,92 @@ +/////////////////////////////////////////////////////////////////////////////////// +// Copyright (C) 2012 maintech GmbH, Otto-Hahn-Str. 15, 97204 Hoechberg, Germany // +// written by Christian Daniel // +// // +// This program is free software; you can redistribute it and/or modify // +// it under the terms of the GNU General Public License as published by // +// the Free Software Foundation as version 3 of the License, or // +// // +// This program is distributed in the hope that it will be useful, // +// but WITHOUT ANY WARRANTY; without even the implied warranty of // +// MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE. See the // +// GNU General Public License V3 for more details. // +// // +// You should have received a copy of the GNU General Public License // +// along with this program. If not, see . // +/////////////////////////////////////////////////////////////////////////////////// + +#ifndef INCLUDE_WFMDEMOD_H +#define INCLUDE_WFMDEMOD_H + +#include +#include "dsp/samplesink.h" +#include "dsp/nco.h" +#include "dsp/interpolator.h" +#include "dsp/lowpass.h" +#include "audio/audiofifo.h" +#include "util/message.h" + +class AudioFifo; + +class WFMDemod : public SampleSink { +public: + WFMDemod(AudioFifo* audioFifo, SampleSink* sampleSink); + ~WFMDemod(); + + void configure(MessageQueue* messageQueue, Real afBandwidth, Real volume); + + void feed(SampleVector::const_iterator begin, SampleVector::const_iterator end, bool positiveOnly); + void start(); + void stop(); + bool handleMessage(Message* cmd); + +private: + class MsgConfigureWFMDemod : public Message { + MESSAGE_CLASS_DECLARATION + + public: + Real getAFBandwidth() const { return m_afBandwidth; } + Real getVolume() const { return m_volume; } + + static MsgConfigureWFMDemod* create(Real afBandwidth, Real volume) + { + return new MsgConfigureWFMDemod(afBandwidth, volume); + } + + private: + Real m_afBandwidth; + Real m_volume; + + MsgConfigureWFMDemod(Real afBandwidth, Real volume) : + Message(), + m_afBandwidth(afBandwidth), + m_volume(volume) + { } + }; + + struct AudioSample { + qint16 l; + qint16 r; + }; + typedef std::vector AudioVector; + + Real m_afBandwidth; + Real m_volume; + int m_sampleRate; + int m_frequency; + + NCO m_nco; + Interpolator m_interpolator; + Real m_sampleDistanceRemain; + + Complex m_lastSample; + + AudioVector m_audioBuffer; + uint m_audioBufferFill; + AudioFifo* m_audioFifo; + + SampleSink* m_sampleSink; + SampleVector m_sampleBuffer; +}; + +#endif // INCLUDE_WFMDEMOD_H diff --git a/plugins/channel/wfm/wfmdemodgui.cpp b/plugins/channel/wfm/wfmdemodgui.cpp new file mode 100644 index 000000000..b6f66c7cc --- /dev/null +++ b/plugins/channel/wfm/wfmdemodgui.cpp @@ -0,0 +1,182 @@ +#include +#include +#include "wfmdemodgui.h" +#include "ui_wfmdemodgui.h" +#include "wfmdemodgui.h" +#include "ui_wfmdemodgui.h" +#include "dsp/threadedsamplesink.h" +#include "dsp/channelizer.h" +#include "wfmdemod.h" +#include "dsp/spectrumvis.h" +#include "gui/glspectrum.h" +#include "plugin/pluginapi.h" +#include "util/simpleserializer.h" +#include "gui/basicchannelsettingswidget.h" + +WFMDemodGUI* WFMDemodGUI::create(PluginAPI* pluginAPI) +{ + WFMDemodGUI* gui = new WFMDemodGUI(pluginAPI); + return gui; +} + +void WFMDemodGUI::destroy() +{ + delete this; +} + +void WFMDemodGUI::setName(const QString& name) +{ + setObjectName(name); +} + +void WFMDemodGUI::resetToDefaults() +{ + ui->afBW->setValue(6); + ui->volume->setValue(20); + ui->spectrumGUI->resetToDefaults(); + applySettings(); +} + +QByteArray WFMDemodGUI::serialize() const +{ + SimpleSerializer s(1); + s.writeS32(1, m_channelMarker->getCenterFrequency()); + s.writeS32(2, ui->afBW->value()); + s.writeS32(3, ui->volume->value()); + s.writeBlob(4, ui->spectrumGUI->serialize()); + s.writeU32(5, m_channelMarker->getColor().rgb()); + return s.final(); +} + +bool WFMDemodGUI::deserialize(const QByteArray& data) +{ + SimpleDeserializer d(data); + + if(!d.isValid()) { + resetToDefaults(); + return false; + } + + if(d.getVersion() == 1) { + QByteArray bytetmp; + quint32 u32tmp; + qint32 tmp; + d.readS32(1, &tmp, 0); + m_channelMarker->setCenterFrequency(tmp); + d.readS32(2, &tmp, 6); + ui->afBW->setValue(tmp); + d.readS32(3, &tmp, 20); + ui->volume->setValue(tmp); + d.readBlob(4, &bytetmp); + ui->spectrumGUI->deserialize(bytetmp); + if(d.readU32(5, &u32tmp)) + m_channelMarker->setColor(u32tmp); + applySettings(); + return true; + } else { + resetToDefaults(); + return false; + } +} + +bool WFMDemodGUI::handleMessage(Message* message) +{ + return false; +} + +void WFMDemodGUI::viewChanged() +{ + applySettings(); +} + +void WFMDemodGUI::on_afBW_valueChanged(int value) +{ + ui->afBWText->setText(QString("%1 kHz").arg(value)); + applySettings(); +} + +void WFMDemodGUI::on_volume_valueChanged(int value) +{ + ui->volumeText->setText(QString("%1").arg(value / 10.0, 0, 'f', 1)); + applySettings(); +} + +void WFMDemodGUI::onWidgetRolled(QWidget* widget, bool rollDown) +{ + /* + if((widget == ui->spectrumContainer) && (m_wfmDemod != NULL)) + m_wfmDemod->setSpectrum(m_threadedSampleSink->getMessageQueue(), rollDown); + */ +} + +void WFMDemodGUI::onMenuDoubleClicked() +{ + if(!m_basicSettingsShown) { + m_basicSettingsShown = true; + BasicChannelSettingsWidget* bcsw = new BasicChannelSettingsWidget(m_channelMarker, this); + bcsw->show(); + } +} + +WFMDemodGUI::WFMDemodGUI(PluginAPI* pluginAPI, QWidget* parent) : + RollupWidget(parent), + ui(new Ui::WFMDemodGUI), + m_pluginAPI(pluginAPI), + m_basicSettingsShown(false) +{ + ui->setupUi(this); + setAttribute(Qt::WA_DeleteOnClose, true); + connect(this, SIGNAL(widgetRolled(QWidget*,bool)), this, SLOT(onWidgetRolled(QWidget*,bool))); + connect(this, SIGNAL(menuDoubleClickEvent()), this, SLOT(onMenuDoubleClicked())); + + m_audioFifo = new AudioFifo(4, 48000 / 4); + m_spectrumVis = new SpectrumVis(ui->glSpectrum); + m_wfmDemod = new WFMDemod(m_audioFifo, m_spectrumVis); + m_channelizer = new Channelizer(m_wfmDemod); + m_threadedSampleSink = new ThreadedSampleSink(m_channelizer); + m_pluginAPI->addAudioSource(m_audioFifo); + m_pluginAPI->addSampleSink(m_threadedSampleSink); + + ui->glSpectrum->setCenterFrequency(12000); + ui->glSpectrum->setSampleRate(24000); + ui->glSpectrum->setDisplayWaterfall(true); + ui->glSpectrum->setDisplayMaxHold(true); + m_spectrumVis->configure(m_threadedSampleSink->getMessageQueue(), 64, 10, FFTWindow::BlackmanHarris); + + m_channelMarker = new ChannelMarker(this); + m_channelMarker->setColor(Qt::red); + m_channelMarker->setBandwidth(16000); + m_channelMarker->setCenterFrequency(0); + m_channelMarker->setVisible(true); + connect(m_channelMarker, SIGNAL(changed()), this, SLOT(viewChanged())); + m_pluginAPI->addChannelMarker(m_channelMarker); + + ui->spectrumGUI->setBuddies(m_threadedSampleSink->getMessageQueue(), m_spectrumVis, ui->glSpectrum); + + applySettings(); +} + +WFMDemodGUI::~WFMDemodGUI() +{ + m_pluginAPI->removeChannelInstance(this); + m_pluginAPI->removeAudioSource(m_audioFifo); + m_pluginAPI->removeSampleSink(m_threadedSampleSink); + delete m_threadedSampleSink; + delete m_channelizer; + delete m_wfmDemod; + delete m_spectrumVis; + delete m_audioFifo; + delete m_channelMarker; + delete ui; +} + +void WFMDemodGUI::applySettings() +{ + setTitleColor(m_channelMarker->getColor()); + m_channelizer->configure(m_threadedSampleSink->getMessageQueue(), + 48000, + m_channelMarker->getCenterFrequency()); + m_wfmDemod->configure(m_threadedSampleSink->getMessageQueue(), + ui->afBW->value() * 1000.0, + ui->volume->value() * 0.1); +} diff --git a/plugins/channel/wfm/wfmdemodgui.h b/plugins/channel/wfm/wfmdemodgui.h new file mode 100644 index 000000000..bd3c1d482 --- /dev/null +++ b/plugins/channel/wfm/wfmdemodgui.h @@ -0,0 +1,60 @@ +#ifndef INCLUDE_WFMDEMODGUI_H +#define INCLUDE_WFMDEMODGUI_H + +#include "gui/rollupwidget.h" +#include "plugin/plugingui.h" + +class PluginAPI; +class ChannelMarker; + +class AudioFifo; +class ThreadedSampleSink; +class Channelizer; +class WFMDemod; +class SpectrumVis; + +namespace Ui { + class WFMDemodGUI; +} + +class WFMDemodGUI : public RollupWidget, public PluginGUI { + Q_OBJECT + +public: + static WFMDemodGUI* create(PluginAPI* pluginAPI); + void destroy(); + + void setName(const QString& name); + + void resetToDefaults(); + QByteArray serialize() const; + bool deserialize(const QByteArray& data); + + bool handleMessage(Message* message); + +private slots: + void viewChanged(); + void on_afBW_valueChanged(int value); + void on_volume_valueChanged(int value); + void onWidgetRolled(QWidget* widget, bool rollDown); + void onMenuDoubleClicked(); + +private: + Ui::WFMDemodGUI* ui; + PluginAPI* m_pluginAPI; + ChannelMarker* m_channelMarker; + bool m_basicSettingsShown; + + AudioFifo* m_audioFifo; + ThreadedSampleSink* m_threadedSampleSink; + Channelizer* m_channelizer; + WFMDemod* m_wfmDemod; + SpectrumVis* m_spectrumVis; + + explicit WFMDemodGUI(PluginAPI* pluginAPI, QWidget* parent = NULL); + ~WFMDemodGUI(); + + void applySettings(); +}; + +#endif // INCLUDE_WFMDEMODGUI_H diff --git a/plugins/channel/wfm/wfmdemodgui.ui b/plugins/channel/wfm/wfmdemodgui.ui new file mode 100644 index 000000000..f5d9d0c2e --- /dev/null +++ b/plugins/channel/wfm/wfmdemodgui.ui @@ -0,0 +1,172 @@ + + + WFMDemodGUI + + + + 0 + 0 + 302 + 410 + + + + WBFM Demodulator + + + + + 35 + 35 + 242 + 96 + + + + Settings + + + + 2 + + + 3 + + + + + AF Bandwidth + + + + + + + 1 + + + 20 + + + 1 + + + 3 + + + Qt::Horizontal + + + + + + + + 50 + 0 + + + + 6 kHz + + + Qt::AlignRight|Qt::AlignTrailing|Qt::AlignVCenter + + + + + + + Volume + + + + + + + 100 + + + 20 + + + Qt::Horizontal + + + + + + + + 50 + 0 + + + + 2.0 + + + Qt::AlignRight|Qt::AlignTrailing|Qt::AlignVCenter + + + + + + + + + 40 + 140 + 218 + 184 + + + + Channel Spectrum + + + + 2 + + + 3 + + + + + + 200 + 150 + + + + + + + + + + + + + GLSpectrum + QWidget +
gui/glspectrum.h
+ 1 +
+ + GLSpectrumGUI + QWidget +
gui/glspectrumgui.h
+ 1 +
+ + RollupWidget + QWidget +
gui/rollupwidget.h
+ 1 +
+
+ + +
diff --git a/plugins/channel/wfm/wfmplugin.cpp b/plugins/channel/wfm/wfmplugin.cpp new file mode 100644 index 000000000..a85832349 --- /dev/null +++ b/plugins/channel/wfm/wfmplugin.cpp @@ -0,0 +1,53 @@ +#include +#include +#include "plugin/pluginapi.h" +#include "wfmplugin.h" +#include "wfmdemodgui.h" + +const PluginDescriptor WFMPlugin::m_pluginDescriptor = { + QString("WFM Demodulator"), + QString("---"), + QString("(c) maintech GmbH (written by Christian Daniel)"), + QString("http://www.maintech.de"), + true, + QString("http://www.maintech.de") +}; + +WFMPlugin::WFMPlugin(QObject* parent) : + QObject(parent) +{ +} + +const PluginDescriptor& WFMPlugin::getPluginDescriptor() const +{ + return m_pluginDescriptor; +} + +void WFMPlugin::initPlugin(PluginAPI* pluginAPI) +{ + m_pluginAPI = pluginAPI; + + // register WFM demodulator + QAction* action = new QAction(tr("&WFM Demodulator"), this); + connect(action, SIGNAL(triggered()), this, SLOT(createInstanceWFM())); + m_pluginAPI->registerChannel("de.maintech.sdrangelove.channel.wfm", this, action); +} + +PluginGUI* WFMPlugin::createChannel(const QString& channelName) +{ + if(channelName == "de.maintech.sdrangelove.channel.wfm") { + WFMDemodGUI* gui = WFMDemodGUI::create(m_pluginAPI); + m_pluginAPI->registerChannelInstance("de.maintech.sdrangelove.channel.wfm", gui); + m_pluginAPI->addChannelRollup(gui); + return gui; + } else { + return NULL; + } +} + +void WFMPlugin::createInstanceWFM() +{ + WFMDemodGUI* gui = WFMDemodGUI::create(m_pluginAPI); + m_pluginAPI->registerChannelInstance("de.maintech.sdrangelove.channel.wfm", gui); + m_pluginAPI->addChannelRollup(gui); +} diff --git a/plugins/channel/wfm/wfmplugin.h b/plugins/channel/wfm/wfmplugin.h new file mode 100644 index 000000000..189e72334 --- /dev/null +++ b/plugins/channel/wfm/wfmplugin.h @@ -0,0 +1,29 @@ +#ifndef INCLUDE_WFMPLUGIN_H +#define INCLUDE_WFMPLUGIN_H + +#include +#include "plugin/plugininterface.h" + +class WFMPlugin : public QObject, PluginInterface { + Q_OBJECT + Q_INTERFACES(PluginInterface) + Q_PLUGIN_METADATA(IID "de.maintech.sdrangelove.channel.wfm") + +public: + explicit WFMPlugin(QObject* parent = NULL); + + const PluginDescriptor& getPluginDescriptor() const; + void initPlugin(PluginAPI* pluginAPI); + + PluginGUI* createChannel(const QString& channelName); + +private: + static const PluginDescriptor m_pluginDescriptor; + + PluginAPI* m_pluginAPI; + +private slots: + void createInstanceWFM(); +}; + +#endif // INCLUDE_WFMPLUGIN_H