2014-05-21 13:31:14 -04:00
|
|
|
///////////////////////////////////////////////////////////////////////////////////
|
|
|
|
// 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 <http://www.gnu.org/licenses/>. //
|
|
|
|
///////////////////////////////////////////////////////////////////////////////////
|
|
|
|
|
|
|
|
#ifndef INCLUDE_SSBDEMOD_H
|
|
|
|
#define INCLUDE_SSBDEMOD_H
|
|
|
|
|
2016-10-02 16:29:04 -04:00
|
|
|
#include <dsp/basebandsamplesink.h>
|
2015-08-24 17:23:45 -04:00
|
|
|
#include <QMutex>
|
2014-05-21 13:31:14 -04:00
|
|
|
#include <vector>
|
2016-12-19 02:28:50 -05:00
|
|
|
#include "dsp/ncof.h"
|
2014-05-21 13:31:14 -04:00
|
|
|
#include "dsp/interpolator.h"
|
2014-07-13 04:06:43 -04:00
|
|
|
#include "dsp/fftfilt.h"
|
2017-07-24 18:58:16 -04:00
|
|
|
#include "dsp/agc.h"
|
2014-05-21 13:31:14 -04:00
|
|
|
#include "audio/audiofifo.h"
|
|
|
|
#include "util/message.h"
|
|
|
|
|
2014-07-13 04:06:43 -04:00
|
|
|
#define ssbFftLen 1024
|
|
|
|
|
2016-10-02 16:29:04 -04:00
|
|
|
class SSBDemod : public BasebandSampleSink {
|
2014-05-21 13:31:14 -04:00
|
|
|
public:
|
2016-10-02 16:29:04 -04:00
|
|
|
SSBDemod(BasebandSampleSink* sampleSink);
|
2015-08-17 02:29:34 -04:00
|
|
|
virtual ~SSBDemod();
|
2014-05-21 13:31:14 -04:00
|
|
|
|
2015-12-05 12:48:15 -05:00
|
|
|
void configure(MessageQueue* messageQueue,
|
|
|
|
Real Bandwidth,
|
|
|
|
Real LowCutoff,
|
|
|
|
Real volume,
|
|
|
|
int spanLog2,
|
2015-12-05 13:57:48 -05:00
|
|
|
bool audioBinaural,
|
2015-12-05 18:43:40 -05:00
|
|
|
bool audioFlipChannels,
|
2016-04-05 03:20:02 -04:00
|
|
|
bool dsb,
|
|
|
|
bool audioMute);
|
2014-05-21 13:31:14 -04:00
|
|
|
|
2015-08-25 02:24:23 -04:00
|
|
|
virtual void feed(const SampleVector::const_iterator& begin, const SampleVector::const_iterator& end, bool positiveOnly);
|
2015-08-17 02:29:34 -04:00
|
|
|
virtual void start();
|
|
|
|
virtual void stop();
|
|
|
|
virtual bool handleMessage(const Message& cmd);
|
2014-05-21 13:31:14 -04:00
|
|
|
|
2017-05-16 17:39:49 -04:00
|
|
|
double getMagSq() const { return m_magsq; }
|
2015-10-04 04:50:26 -04:00
|
|
|
|
2017-05-16 17:39:49 -04:00
|
|
|
void getMagSqLevels(double& avg, double& peak, int& nbSamples)
|
2016-12-05 19:58:23 -05:00
|
|
|
{
|
2017-05-16 11:46:44 -04:00
|
|
|
avg = m_magsqCount == 0 ? 1e-10 : m_magsqSum / m_magsqCount;
|
2016-12-05 19:58:23 -05:00
|
|
|
m_magsq = avg;
|
2017-05-16 11:46:44 -04:00
|
|
|
peak = m_magsqPeak == 0.0 ? 1e-10 : m_magsqPeak;
|
|
|
|
nbSamples = m_magsqCount == 0 ? 1 : m_magsqCount;
|
2016-12-05 19:58:23 -05:00
|
|
|
m_magsqSum = 0.0f;
|
|
|
|
m_magsqPeak = 0.0f;
|
|
|
|
m_magsqCount = 0;
|
|
|
|
}
|
|
|
|
|
2014-05-21 13:31:14 -04:00
|
|
|
private:
|
|
|
|
class MsgConfigureSSBDemod : public Message {
|
|
|
|
MESSAGE_CLASS_DECLARATION
|
|
|
|
|
|
|
|
public:
|
|
|
|
Real getBandwidth() const { return m_Bandwidth; }
|
2015-05-12 15:50:02 -04:00
|
|
|
Real getLoCutoff() const { return m_LowCutoff; }
|
2014-05-21 13:31:14 -04:00
|
|
|
Real getVolume() const { return m_volume; }
|
2015-06-11 03:18:10 -04:00
|
|
|
int getSpanLog2() const { return m_spanLog2; }
|
2015-12-05 12:48:15 -05:00
|
|
|
bool getAudioBinaural() const { return m_audioBinaural; }
|
2015-12-05 13:57:48 -05:00
|
|
|
bool getAudioFlipChannels() const { return m_audioFlipChannels; }
|
2015-12-05 18:43:40 -05:00
|
|
|
bool getDSB() const { return m_dsb; }
|
2016-04-05 03:20:02 -04:00
|
|
|
bool getAudioMute() const { return m_audioMute; }
|
2014-05-21 13:31:14 -04:00
|
|
|
|
2015-12-05 12:48:15 -05:00
|
|
|
static MsgConfigureSSBDemod* create(Real Bandwidth,
|
|
|
|
Real LowCutoff,
|
|
|
|
Real volume,
|
|
|
|
int spanLog2,
|
2015-12-05 13:57:48 -05:00
|
|
|
bool audioBinaural,
|
2015-12-05 18:43:40 -05:00
|
|
|
bool audioFlipChannels,
|
2016-04-05 03:20:02 -04:00
|
|
|
bool dsb,
|
|
|
|
bool audioMute)
|
2014-05-21 13:31:14 -04:00
|
|
|
{
|
2016-04-05 03:20:02 -04:00
|
|
|
return new MsgConfigureSSBDemod(Bandwidth, LowCutoff, volume, spanLog2, audioBinaural, audioFlipChannels, dsb, audioMute);
|
2014-05-21 13:31:14 -04:00
|
|
|
}
|
|
|
|
|
|
|
|
private:
|
|
|
|
Real m_Bandwidth;
|
2015-05-12 15:50:02 -04:00
|
|
|
Real m_LowCutoff;
|
2014-05-21 13:31:14 -04:00
|
|
|
Real m_volume;
|
2015-06-11 03:18:10 -04:00
|
|
|
int m_spanLog2;
|
2015-12-05 12:48:15 -05:00
|
|
|
bool m_audioBinaural;
|
2015-12-05 13:57:48 -05:00
|
|
|
bool m_audioFlipChannels;
|
2015-12-05 18:43:40 -05:00
|
|
|
bool m_dsb;
|
2016-04-05 03:20:02 -04:00
|
|
|
bool m_audioMute;
|
2014-05-21 13:31:14 -04:00
|
|
|
|
2015-12-05 12:48:15 -05:00
|
|
|
MsgConfigureSSBDemod(Real Bandwidth,
|
|
|
|
Real LowCutoff,
|
|
|
|
Real volume,
|
|
|
|
int spanLog2,
|
2015-12-05 13:57:48 -05:00
|
|
|
bool audioBinaural,
|
2015-12-05 18:43:40 -05:00
|
|
|
bool audioFlipChannels,
|
2016-04-05 03:20:02 -04:00
|
|
|
bool dsb,
|
|
|
|
bool audioMute) :
|
2014-05-21 13:31:14 -04:00
|
|
|
Message(),
|
|
|
|
m_Bandwidth(Bandwidth),
|
2015-05-12 15:50:02 -04:00
|
|
|
m_LowCutoff(LowCutoff),
|
2015-06-11 03:18:10 -04:00
|
|
|
m_volume(volume),
|
2015-12-05 12:48:15 -05:00
|
|
|
m_spanLog2(spanLog2),
|
2015-12-05 13:57:48 -05:00
|
|
|
m_audioBinaural(audioBinaural),
|
2015-12-05 18:43:40 -05:00
|
|
|
m_audioFlipChannels(audioFlipChannels),
|
2016-04-05 03:20:02 -04:00
|
|
|
m_dsb(dsb),
|
|
|
|
m_audioMute(audioMute)
|
2014-05-21 13:31:14 -04:00
|
|
|
{ }
|
|
|
|
};
|
|
|
|
|
|
|
|
struct AudioSample {
|
|
|
|
qint16 l;
|
|
|
|
qint16 r;
|
|
|
|
};
|
2015-12-05 12:48:15 -05:00
|
|
|
|
2014-05-21 13:31:14 -04:00
|
|
|
typedef std::vector<AudioSample> AudioVector;
|
|
|
|
|
|
|
|
Real m_Bandwidth;
|
2015-05-12 15:50:02 -04:00
|
|
|
Real m_LowCutoff;
|
2014-05-21 13:31:14 -04:00
|
|
|
Real m_volume;
|
2015-06-11 03:18:10 -04:00
|
|
|
int m_spanLog2;
|
2015-12-25 22:04:22 -05:00
|
|
|
fftfilt::cmplx m_sum;
|
2014-06-27 13:46:14 -04:00
|
|
|
int m_undersampleCount;
|
2014-05-21 13:31:14 -04:00
|
|
|
int m_sampleRate;
|
|
|
|
int m_frequency;
|
2015-12-05 12:48:15 -05:00
|
|
|
bool m_audioBinaual;
|
2015-12-05 13:57:48 -05:00
|
|
|
bool m_audioFlipChannels;
|
2014-07-13 04:06:43 -04:00
|
|
|
bool m_usb;
|
2015-12-05 18:43:40 -05:00
|
|
|
bool m_dsb;
|
2016-04-05 03:20:02 -04:00
|
|
|
bool m_audioMute;
|
2017-05-16 17:39:49 -04:00
|
|
|
double m_magsq;
|
|
|
|
double m_magsqSum;
|
|
|
|
double m_magsqPeak;
|
2016-12-05 19:58:23 -05:00
|
|
|
int m_magsqCount;
|
2017-07-24 18:58:16 -04:00
|
|
|
MagAGC m_agc;
|
2014-05-21 13:31:14 -04:00
|
|
|
|
2016-12-19 02:28:50 -05:00
|
|
|
NCOF m_nco;
|
2014-05-21 13:31:14 -04:00
|
|
|
Interpolator m_interpolator;
|
|
|
|
Real m_sampleDistanceRemain;
|
2014-07-13 04:06:43 -04:00
|
|
|
fftfilt* SSBFilter;
|
2015-12-25 21:56:28 -05:00
|
|
|
fftfilt* DSBFilter;
|
2014-05-21 13:31:14 -04:00
|
|
|
|
2016-10-02 16:29:04 -04:00
|
|
|
BasebandSampleSink* m_sampleSink;
|
2014-11-21 14:44:19 -05:00
|
|
|
SampleVector m_sampleBuffer;
|
|
|
|
|
2014-05-21 13:31:14 -04:00
|
|
|
AudioVector m_audioBuffer;
|
|
|
|
uint m_audioBufferFill;
|
2015-08-23 20:40:02 -04:00
|
|
|
AudioFifo m_audioFifo;
|
|
|
|
quint32 m_audioSampleRate;
|
2015-08-24 17:23:45 -04:00
|
|
|
|
|
|
|
QMutex m_settingsMutex;
|
2014-05-21 13:31:14 -04:00
|
|
|
};
|
|
|
|
|
|
|
|
#endif // INCLUDE_SSBDEMOD_H
|