1
0
mirror of https://github.com/f4exb/sdrangel.git synced 2024-11-23 16:38:37 -05:00
sdrangel/plugins/channelrx/demodatv/atvdemod.cpp

734 lines
23 KiB
C++
Raw Normal View History

2017-02-23 02:18:56 -05:00
///////////////////////////////////////////////////////////////////////////////////
// Copyright (C) 2017 F4HKW //
// for F4EXB / SDRAngel //
// //
// 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/>. //
///////////////////////////////////////////////////////////////////////////////////
#include "atvdemod.h"
#include <QTime>
#include <QDebug>
#include <stdio.h>
#include <complex.h>
#include "audio/audiooutput.h"
#include "dsp/dspengine.h"
#include "dsp/pidcontroller.h"
MESSAGE_CLASS_DEFINITION(ATVDemod::MsgConfigureATVDemod, Message)
2017-03-17 04:39:20 -04:00
MESSAGE_CLASS_DEFINITION(ATVDemod::MsgConfigureRFATVDemod, Message)
MESSAGE_CLASS_DEFINITION(ATVDemod::MsgReportEffectiveSampleRate, Message)
2017-02-23 02:18:56 -05:00
const int ATVDemod::m_ssbFftLen = 1024;
ATVDemod::ATVDemod(DeviceSourceAPI *deviceAPI) :
m_deviceAPI(deviceAPI),
m_registeredATVScreen(NULL),
2017-05-25 14:13:34 -04:00
m_intNumberSamplePerTop(0),
2017-02-23 02:18:56 -05:00
m_intImageIndex(0),
m_intSynchroPoints(0),
m_blnSynchroDetected(false),
m_blnVerticalSynchroDetected(false),
2017-05-25 14:13:34 -04:00
m_fltAmpLineAverage(0.0f),
2017-02-23 02:18:56 -05:00
m_fltEffMin(2000000000.0f),
m_fltEffMax(-2000000000.0f),
m_fltAmpMin(-2000000000.0f),
m_fltAmpMax(2000000000.0f),
m_fltAmpDelta(1.0),
2017-05-25 14:13:34 -04:00
m_intColIndex(0),
m_intSampleIndex(0),
m_intRowIndex(0),
m_intLineIndex(0),
m_objAvgColIndex(3),
m_objMagSqAverage(40, 0),
m_bfoPLL(200/1000000, 100/1000000, 0.01),
m_bfoFilter(200.0, 1000000.0, 0.9),
m_interpolatorDistance(1.0f),
2017-05-25 14:13:34 -04:00
m_interpolatorDistanceRemain(0.0f),
m_DSBFilter(0),
m_DSBFilterBuffer(0),
m_DSBFilterBufferIndex(0),
2017-05-25 14:13:34 -04:00
m_objSettingsMutex(QMutex::Recursive)
2017-02-23 02:18:56 -05:00
{
setObjectName("ATVDemod");
2017-02-23 02:18:56 -05:00
//*************** ATV PARAMETERS ***************
//m_intNumberSamplePerLine=0;
2017-02-23 02:18:56 -05:00
m_intSynchroPoints=0;
m_intNumberOfLines=0;
m_interleaved = true;
2017-02-23 02:18:56 -05:00
m_objMagSqAverage.resize(32, 1.0);
2017-10-01 03:06:55 -04:00
m_DSBFilter = new fftfilt((2.0f * m_rfConfig.m_fltRFBandwidth) / 1000000, 2 * m_ssbFftLen); // arbitrary 1 MS/s sample rate
m_DSBFilterBuffer = new Complex[m_ssbFftLen];
memset(m_DSBFilterBuffer, 0, sizeof(Complex)*(m_ssbFftLen));
2017-02-23 02:18:56 -05:00
memset((void*)m_fltBufferI,0,6*sizeof(float));
memset((void*)m_fltBufferQ,0,6*sizeof(float));
m_objPhaseDiscri.setFMScaling(1.0f);
applyStandard();
2017-02-23 02:18:56 -05:00
}
ATVDemod::~ATVDemod()
{
2017-02-23 02:18:56 -05:00
}
void ATVDemod::setATVScreen(ATVScreen *objScreen)
2017-02-23 02:18:56 -05:00
{
m_registeredATVScreen = objScreen;
2017-02-23 02:18:56 -05:00
}
void ATVDemod::configure(
MessageQueue* objMessageQueue,
float fltLineDurationUs,
float fltTopDurationUs,
float fltFramePerS,
ATVStd enmATVStandard,
int intNumberOfLines,
float fltRatioOfRowsToDisplay,
float fltVoltLevelSynchroTop,
float fltVoltLevelSynchroBlack,
bool blnHSync,
2017-03-19 14:10:48 -04:00
bool blnVSync,
bool blnInvertVideo,
int intVideoTabIndex)
2017-02-23 02:18:56 -05:00
{
Message* msgCmd = MsgConfigureATVDemod::create(
fltLineDurationUs,
fltTopDurationUs,
fltFramePerS,
enmATVStandard,
intNumberOfLines,
fltRatioOfRowsToDisplay,
fltVoltLevelSynchroTop,
fltVoltLevelSynchroBlack,
blnHSync,
2017-03-19 14:10:48 -04:00
blnVSync,
blnInvertVideo,
intVideoTabIndex);
2017-02-23 02:18:56 -05:00
objMessageQueue->push(msgCmd);
}
2017-03-17 04:39:20 -04:00
void ATVDemod::configureRF(
MessageQueue* objMessageQueue,
ATVModulation enmModulation,
float fltRFBandwidth,
float fltRFOppBandwidth,
bool blnFFTFiltering,
bool blnDecimatorEnable,
float fltBFOFrequency,
float fmDeviation)
2017-03-17 04:39:20 -04:00
{
Message* msgCmd = MsgConfigureRFATVDemod::create(
enmModulation,
fltRFBandwidth,
fltRFOppBandwidth,
blnFFTFiltering,
blnDecimatorEnable,
fltBFOFrequency,
fmDeviation);
2017-03-17 04:39:20 -04:00
objMessageQueue->push(msgCmd);
}
2017-05-25 14:13:34 -04:00
void ATVDemod::feed(const SampleVector::const_iterator& begin, const SampleVector::const_iterator& end, bool firstOfBurst __attribute__((unused)))
2017-02-23 02:18:56 -05:00
{
float fltI;
float fltQ;
2017-03-18 00:37:52 -04:00
Complex ci;
2017-02-23 02:18:56 -05:00
2017-03-18 00:37:52 -04:00
qint16 * ptrBufferToRelease = 0;
2017-02-23 02:18:56 -05:00
//********** Let's rock and roll buddy ! **********
m_objSettingsMutex.lock();
//********** Accessing ATV Screen context **********
#ifdef EXTENDED_DIRECT_SAMPLE
qint16 * ptrBuffer;
qint32 intLen;
//********** Reading direct samples **********
SampleVector::const_iterator it = begin;
intLen = it->intLen;
ptrBuffer = it->ptrBuffer;
ptrBufferToRelease = ptrBuffer;
++it;
for(qint32 intInd=0; intInd<intLen-1; intInd +=2)
{
fltI= ((qint32) (*ptrBuffer)) << 4;
ptrBuffer ++;
fltQ= ((qint32) (*ptrBuffer)) << 4;
ptrBuffer ++;
2017-02-23 02:18:56 -05:00
#else
for (SampleVector::const_iterator it = begin; it != end; ++it /* ++it **/)
{
fltI = it->real();
fltQ = it->imag();
#endif
2017-03-18 00:37:52 -04:00
Complex c(fltI, fltQ);
2017-10-01 03:06:55 -04:00
if (m_rfRunning.m_intFrequencyOffset != 0)
2017-03-18 00:37:52 -04:00
{
c *= m_nco.nextIQ();
}
2017-10-01 03:06:55 -04:00
if (m_rfRunning.m_blndecimatorEnable)
{
2017-03-18 00:37:52 -04:00
if (m_interpolator.decimate(&m_interpolatorDistanceRemain, c, &ci))
{
demod(ci);
m_interpolatorDistanceRemain += m_interpolatorDistance;
}
}
else
2017-02-23 02:18:56 -05:00
{
2017-03-18 00:37:52 -04:00
demod(c);
}
}
2017-02-23 02:18:56 -05:00
if ((m_running.m_intVideoTabIndex == 1) && (m_scopeSink != 0)) // do only if scope tab is selected and scope is available
{
m_scopeSink->feed(m_scopeSampleBuffer.begin(), m_scopeSampleBuffer.end(), false); // m_ssb = positive only
m_scopeSampleBuffer.clear();
}
2017-03-18 00:37:52 -04:00
if (ptrBufferToRelease != 0)
{
delete ptrBufferToRelease;
}
2017-02-23 02:18:56 -05:00
2017-03-18 00:37:52 -04:00
m_objSettingsMutex.unlock();
}
2017-02-23 02:18:56 -05:00
2017-03-18 00:37:52 -04:00
void ATVDemod::demod(Complex& c)
{
2017-10-01 03:06:55 -04:00
float fltDivSynchroBlack = 1.0f - m_running.m_fltVoltLevelSynchroBlack;
2017-03-18 00:37:52 -04:00
float fltNormI;
float fltNormQ;
float fltNorm;
float fltVal;
int intVal;
2017-02-23 02:18:56 -05:00
//********** FFT filtering **********
2017-10-01 03:06:55 -04:00
if (m_rfRunning.m_blnFFTFiltering)
{
int n_out;
fftfilt::cmplx *filtered;
2017-10-01 03:06:55 -04:00
n_out = m_DSBFilter->runAsym(c, &filtered, m_rfRunning.m_enmModulation != ATV_LSB); // all usb except explicitely lsb
if (n_out > 0)
{
memcpy((void *) m_DSBFilterBuffer, (const void *) filtered, n_out*sizeof(Complex));
m_DSBFilterBufferIndex = 0;
}
m_DSBFilterBufferIndex++;
}
2017-03-18 00:37:52 -04:00
//********** demodulation **********
2017-02-23 02:18:56 -05:00
2017-10-01 03:06:55 -04:00
const float& fltI = m_rfRunning.m_blnFFTFiltering ? m_DSBFilterBuffer[m_DSBFilterBufferIndex-1].real() : c.real();
const float& fltQ = m_rfRunning.m_blnFFTFiltering ? m_DSBFilterBuffer[m_DSBFilterBufferIndex-1].imag() : c.imag();
double magSq;
2017-02-23 02:18:56 -05:00
2017-10-01 03:06:55 -04:00
if ((m_rfRunning.m_enmModulation == ATV_FM1) || (m_rfRunning.m_enmModulation == ATV_FM2))
2017-03-18 00:37:52 -04:00
{
//Amplitude FM
magSq = fltI*fltI + fltQ*fltQ;
m_objMagSqAverage.feed(magSq);
fltNorm = sqrt(magSq);
2017-03-18 00:37:52 -04:00
fltNormI= fltI/fltNorm;
fltNormQ= fltQ/fltNorm;
2017-02-23 02:18:56 -05:00
2017-03-18 00:37:52 -04:00
//-2 > 2 : 0 -> 1 volt
//0->0.3 synchro 0.3->1 image
2017-02-23 02:18:56 -05:00
2017-10-01 03:06:55 -04:00
if (m_rfRunning.m_enmModulation == ATV_FM1)
2017-03-18 00:37:52 -04:00
{
//YDiff Cd
fltVal = m_fltBufferI[0]*(fltNormQ - m_fltBufferQ[1]);
fltVal -= m_fltBufferQ[0]*(fltNormI - m_fltBufferI[1]);
2017-02-23 02:18:56 -05:00
2017-03-18 00:37:52 -04:00
fltVal += 2.0f;
fltVal /= 4.0f;
2017-02-23 02:18:56 -05:00
}
2017-03-18 00:37:52 -04:00
else
2017-02-23 02:18:56 -05:00
{
2017-03-18 00:37:52 -04:00
//YDiff Folded
fltVal = m_fltBufferI[2]*((m_fltBufferQ[5]-fltNormQ)/16.0f + m_fltBufferQ[1] - m_fltBufferQ[3]);
fltVal -= m_fltBufferQ[2]*((m_fltBufferI[5]-fltNormI)/16.0f + m_fltBufferI[1] - m_fltBufferI[3]);
2017-02-23 02:18:56 -05:00
2017-03-18 00:37:52 -04:00
fltVal += 2.125f;
fltVal /= 4.25f;
2017-02-23 02:18:56 -05:00
2017-03-18 00:37:52 -04:00
m_fltBufferI[5]=m_fltBufferI[4];
m_fltBufferQ[5]=m_fltBufferQ[4];
2017-02-23 02:18:56 -05:00
2017-03-18 00:37:52 -04:00
m_fltBufferI[4]=m_fltBufferI[3];
m_fltBufferQ[4]=m_fltBufferQ[3];
2017-02-23 02:18:56 -05:00
2017-03-18 00:37:52 -04:00
m_fltBufferI[3]=m_fltBufferI[2];
m_fltBufferQ[3]=m_fltBufferQ[2];
m_fltBufferI[2]=m_fltBufferI[1];
m_fltBufferQ[2]=m_fltBufferQ[1];
}
2017-02-23 02:18:56 -05:00
2017-03-18 00:37:52 -04:00
m_fltBufferI[1]=m_fltBufferI[0];
m_fltBufferQ[1]=m_fltBufferQ[0];
m_fltBufferI[0]=fltNormI;
m_fltBufferQ[0]=fltNormQ;
2017-10-01 03:06:55 -04:00
if (m_rfRunning.m_fmDeviation != 1.0f)
{
2017-10-01 03:06:55 -04:00
fltVal = ((fltVal - 0.5f) / m_rfRunning.m_fmDeviation) + 0.5f;
}
2017-03-18 00:37:52 -04:00
}
2017-10-01 03:06:55 -04:00
else if (m_rfRunning.m_enmModulation == ATV_AM)
2017-03-18 00:37:52 -04:00
{
//Amplitude AM
magSq = fltI*fltI + fltQ*fltQ;
m_objMagSqAverage.feed(magSq);
fltNorm = sqrt(magSq);
fltVal = fltNorm / (1<<15);
//fltVal = magSq / (1<<30);
2017-02-23 02:18:56 -05:00
2017-03-18 00:37:52 -04:00
//********** Mini and Maxi Amplitude tracking **********
2017-02-23 02:18:56 -05:00
2017-03-18 00:37:52 -04:00
if(fltVal<m_fltEffMin)
2017-02-23 02:18:56 -05:00
{
2017-03-18 00:37:52 -04:00
m_fltEffMin=fltVal;
2017-02-23 02:18:56 -05:00
}
2017-03-18 00:37:52 -04:00
if(fltVal>m_fltEffMax)
2017-02-23 02:18:56 -05:00
{
2017-03-18 00:37:52 -04:00
m_fltEffMax=fltVal;
2017-02-23 02:18:56 -05:00
}
2017-03-18 00:37:52 -04:00
//Normalisation
fltVal -= m_fltAmpMin;
fltVal /=m_fltAmpDelta;
}
2017-10-01 03:06:55 -04:00
else if ((m_rfRunning.m_enmModulation == ATV_USB) || (m_rfRunning.m_enmModulation == ATV_LSB))
{
magSq = fltI*fltI + fltQ*fltQ;
m_objMagSqAverage.feed(magSq);
fltNorm = sqrt(magSq);
Real bfoValues[2];
float fltFiltered = m_bfoFilter.run(fltI);
m_bfoPLL.process(fltFiltered, bfoValues);
// do the mix
float mixI = fltI * bfoValues[0] - fltQ * bfoValues[1];
float mixQ = fltI * bfoValues[1] + fltQ * bfoValues[0];
2017-10-01 03:06:55 -04:00
if (m_rfRunning.m_enmModulation == ATV_USB) {
fltVal = (mixI + mixQ);
} else {
fltVal = (mixI - mixQ);
}
//********** Mini and Maxi Amplitude tracking **********
if(fltVal<m_fltEffMin)
{
m_fltEffMin=fltVal;
}
if(fltVal>m_fltEffMax)
{
m_fltEffMax=fltVal;
}
//Normalisation
fltVal -= m_fltAmpMin;
fltVal /=m_fltAmpDelta;
}
2017-10-01 03:06:55 -04:00
else if (m_rfRunning.m_enmModulation == ATV_FM3)
{
float rawDeviation;
fltVal = m_objPhaseDiscri.phaseDiscriminatorDelta(c, magSq, rawDeviation) + 0.5f;
//fltVal = fltVal < 0.0f ? 0.0f : fltVal > 1.0f ? 1.0f : fltVal;
m_objMagSqAverage.feed(magSq);
fltNorm = sqrt(magSq);
}
2017-03-18 00:37:52 -04:00
else
{
magSq = fltI*fltI + fltQ*fltQ;
m_objMagSqAverage.feed(magSq);
fltNorm = sqrt(magSq);
2017-03-18 00:37:52 -04:00
fltVal = 0.0f;
}
2017-02-23 02:18:56 -05:00
2017-10-01 03:06:55 -04:00
fltVal = m_running.m_blnInvertVideo ? 1.0f - fltVal : fltVal;
fltVal = (fltVal < -1.0f) ? -1.0f : (fltVal > 1.0f) ? 1.0f : fltVal;
if ((m_running.m_intVideoTabIndex == 1) && (m_scopeSink != 0)) { // feed scope buffer only if scope is present and visible
m_scopeSampleBuffer.push_back(Sample(fltVal*32767.0f, 0.0f));
2017-04-09 11:43:23 -04:00
}
2017-03-19 14:10:48 -04:00
2017-03-18 00:37:52 -04:00
m_fltAmpLineAverage += fltVal;
2017-02-23 02:18:56 -05:00
2017-03-18 00:37:52 -04:00
//********** gray level **********
//-0.3 -> 0.7
2017-10-01 03:06:55 -04:00
intVal = (int) 255.0*(fltVal - m_running.m_fltVoltLevelSynchroBlack) / fltDivSynchroBlack;
2017-02-23 02:18:56 -05:00
2017-03-18 00:37:52 -04:00
//0 -> 255
if(intVal<0)
{
intVal=0;
}
else if(intVal>255)
{
intVal=255;
}
2017-02-23 02:18:56 -05:00
//********** process video sample **********
2017-10-01 03:06:55 -04:00
if (m_running.m_enmATVStandard == ATVStdHSkip)
2017-03-18 00:37:52 -04:00
{
processHSkip(fltVal, intVal);
2017-02-23 02:18:56 -05:00
}
else
{
processClassic(fltVal, intVal);
}
2017-02-23 02:18:56 -05:00
}
void ATVDemod::start()
{
//m_objTimer.start();
2017-02-23 02:18:56 -05:00
}
void ATVDemod::stop()
{
}
bool ATVDemod::handleMessage(const Message& cmd)
{
qDebug() << "ATVDemod::handleMessage";
2017-02-23 02:18:56 -05:00
if (DownChannelizer::MsgChannelizerNotification::match(cmd))
{
2017-02-23 02:18:56 -05:00
DownChannelizer::MsgChannelizerNotification& objNotif = (DownChannelizer::MsgChannelizerNotification&) cmd;
2017-10-01 03:06:55 -04:00
m_config.m_intSampleRate = objNotif.getSampleRate();
m_rfConfig.m_intFrequencyOffset = objNotif.getFrequencyOffset();
2017-02-23 02:18:56 -05:00
qDebug() << "ATVDemod::handleMessage: MsgChannelizerNotification:"
2017-10-01 03:06:55 -04:00
<< " m_intSampleRate: " << m_config.m_intSampleRate
<< " m_intFrequencyOffset: " << m_rfConfig.m_intFrequencyOffset;
2017-02-23 02:18:56 -05:00
applySettings();
2017-03-16 21:00:16 -04:00
return true;
}
else if (MsgConfigureATVDemod::match(cmd))
{
2017-02-23 02:18:56 -05:00
MsgConfigureATVDemod& objCfg = (MsgConfigureATVDemod&) cmd;
2017-10-01 03:06:55 -04:00
m_config = objCfg.m_objMsgConfig;
2017-03-16 16:07:51 -04:00
qDebug() << "ATVDemod::handleMessage: MsgConfigureATVDemod:"
2017-10-01 03:06:55 -04:00
<< " m_fltVoltLevelSynchroBlack:" << m_config.m_fltVoltLevelSynchroBlack
<< " m_fltVoltLevelSynchroTop:" << m_config.m_fltVoltLevelSynchroTop
<< " m_fltFramePerS:" << m_config.m_fltFramePerS
<< " m_fltLineDurationUs:" << m_config.m_fltLineDuration
<< " m_fltRatioOfRowsToDisplay:" << m_config.m_fltRatioOfRowsToDisplay
<< " m_fltTopDurationUs:" << m_config.m_fltTopDuration
<< " m_blnHSync:" << m_config.m_blnHSync
<< " m_blnVSync:" << m_config.m_blnVSync;
applySettings();
2017-02-23 02:18:56 -05:00
return true;
}
else if (MsgConfigureRFATVDemod::match(cmd))
{
MsgConfigureRFATVDemod& objCfg = (MsgConfigureRFATVDemod&) cmd;
2017-10-01 03:06:55 -04:00
m_rfConfig = objCfg.m_objMsgConfig;
qDebug() << "ATVDemod::handleMessage: MsgConfigureRFATVDemod:"
2017-10-01 03:06:55 -04:00
<< " m_enmModulation:" << m_rfConfig.m_enmModulation
<< " m_fltRFBandwidth:" << m_rfConfig.m_fltRFBandwidth
<< " m_fltRFOppBandwidth:" << m_rfConfig.m_fltRFOppBandwidth
<< " m_blnFFTFiltering:" << m_rfConfig.m_blnFFTFiltering
<< " m_blnDecimatorEnable:" << m_rfConfig.m_blndecimatorEnable
<< " m_fltBFOFrequency:" << m_rfConfig.m_fltBFOFrequency
<< " m_fmDeviation:" << m_rfConfig.m_fmDeviation;
applySettings();
return true;
}
else
{
if (m_scopeSink != 0)
{
return m_scopeSink->handleMessage(cmd);
}
else
{
return false;
}
}
2017-02-23 02:18:56 -05:00
}
void ATVDemod::applySettings()
{
2017-02-23 02:18:56 -05:00
2017-10-01 03:06:55 -04:00
if (m_config.m_intSampleRate == 0)
2017-02-23 02:18:56 -05:00
{
return;
}
bool forwardSampleRateChange = false;
2017-10-01 03:06:55 -04:00
if((m_rfConfig.m_intFrequencyOffset != m_rfRunning.m_intFrequencyOffset)
|| (m_rfConfig.m_enmModulation != m_rfRunning.m_enmModulation)
|| (m_config.m_intSampleRate != m_running.m_intSampleRate))
{
2017-10-01 03:06:55 -04:00
m_nco.setFreq(-m_rfConfig.m_intFrequencyOffset, m_config.m_intSampleRate);
}
2017-10-01 03:06:55 -04:00
if ((m_config.m_intSampleRate != m_running.m_intSampleRate)
|| (m_rfConfig.m_fltRFBandwidth != m_rfRunning.m_fltRFBandwidth)
|| (m_config.m_fltFramePerS != m_running.m_fltFramePerS)
|| (m_config.m_intNumberOfLines != m_running.m_intNumberOfLines))
{
m_objSettingsMutex.lock();
2017-10-01 03:06:55 -04:00
int linesPerSecond = m_config.m_intNumberOfLines * m_config.m_fltFramePerS;
2017-10-01 03:06:55 -04:00
int maxPoints = m_config.m_intSampleRate / linesPerSecond;
int i = maxPoints;
for (; i > 0; i--)
{
if ((i * linesPerSecond) % 10 == 0)
break;
}
int nbPointsPerRateUnit = i == 0 ? maxPoints : i;
2017-10-01 03:06:55 -04:00
m_configPrivate.m_intTVSampleRate = nbPointsPerRateUnit * linesPerSecond;
2017-10-01 03:06:55 -04:00
if (m_configPrivate.m_intTVSampleRate > 0)
{
2017-10-01 03:06:55 -04:00
m_interpolatorDistance = (Real) m_configPrivate.m_intTVSampleRate / (Real) m_config.m_intSampleRate;
}
else
{
2017-10-01 03:06:55 -04:00
m_configPrivate.m_intTVSampleRate = m_config.m_intSampleRate;
m_interpolatorDistance = 1.0f;
}
m_interpolatorDistanceRemain = 0;
m_interpolator.create(24,
2017-10-01 03:06:55 -04:00
m_configPrivate.m_intTVSampleRate,
m_rfConfig.m_fltRFBandwidth / getRFBandwidthDivisor(m_rfConfig.m_enmModulation),
3.0);
m_objSettingsMutex.unlock();
}
2017-10-01 03:06:55 -04:00
if((m_config.m_fltFramePerS != m_running.m_fltFramePerS)
|| (m_config.m_fltLineDuration != m_running.m_fltLineDuration)
|| (m_config.m_intSampleRate != m_running.m_intSampleRate)
|| (m_config.m_fltTopDuration != m_running.m_fltTopDuration)
|| (m_config.m_fltRatioOfRowsToDisplay != m_running.m_fltRatioOfRowsToDisplay)
|| (m_config.m_enmATVStandard != m_running.m_enmATVStandard)
|| (m_config.m_intNumberOfLines != m_running.m_intNumberOfLines))
2017-03-16 20:42:15 -04:00
{
m_objSettingsMutex.lock();
2017-10-01 03:06:55 -04:00
m_intNumberOfLines = m_config.m_intNumberOfLines;
applyStandard();
2017-10-01 03:06:55 -04:00
m_configPrivate.m_intNumberSamplePerLine = (int) (m_config.m_fltLineDuration * m_config.m_intSampleRate);
m_intNumberSamplePerTop = (int) (m_config.m_fltTopDuration * m_config.m_intSampleRate);
m_registeredATVScreen->setRenderImmediate(!(m_config.m_fltFramePerS > 25.0f));
m_registeredATVScreen->resizeATVScreen(
2017-10-01 03:06:55 -04:00
m_configPrivate.m_intNumberSamplePerLine - m_intNumberSamplePerLineSignals,
m_intNumberOfLines - m_intNumberOfBlackLines);
qDebug() << "ATVDemod::applySettings:"
2017-10-01 03:06:55 -04:00
<< " m_fltLineDuration: " << m_config.m_fltLineDuration
<< " m_fltFramePerS: " << m_config.m_fltFramePerS
<< " m_intNumberOfLines: " << m_intNumberOfLines
2017-10-01 03:06:55 -04:00
<< " m_intNumberSamplePerLine: " << m_configPrivate.m_intNumberSamplePerLine
<< " m_intNumberOfBlackLines: " << m_intNumberOfBlackLines;
2017-03-16 20:42:15 -04:00
2017-03-16 21:00:16 -04:00
m_intImageIndex = 0;
m_intColIndex=0;
m_intRowIndex=0;
2017-03-16 20:42:15 -04:00
2017-03-16 20:47:16 -04:00
m_objSettingsMutex.unlock();
}
2017-10-01 03:06:55 -04:00
if ((m_configPrivate.m_intTVSampleRate != m_runningPrivate.m_intTVSampleRate)
|| (m_configPrivate.m_intNumberSamplePerLine != m_runningPrivate.m_intNumberSamplePerLine)
|| (m_config.m_intSampleRate != m_running.m_intSampleRate)
|| (m_rfConfig.m_blndecimatorEnable != m_rfRunning.m_blndecimatorEnable))
{
forwardSampleRateChange = true;
}
2017-10-01 03:06:55 -04:00
if ((m_configPrivate.m_intTVSampleRate != m_runningPrivate.m_intTVSampleRate)
|| (m_rfConfig.m_fltRFBandwidth != m_rfRunning.m_fltRFBandwidth)
|| (m_rfConfig.m_fltRFOppBandwidth != m_rfRunning.m_fltRFOppBandwidth))
{
m_objSettingsMutex.lock();
2017-10-01 03:06:55 -04:00
m_DSBFilter->create_asym_filter(m_rfConfig.m_fltRFOppBandwidth / m_configPrivate.m_intTVSampleRate,
m_rfConfig.m_fltRFBandwidth / m_configPrivate.m_intTVSampleRate);
memset(m_DSBFilterBuffer, 0, sizeof(Complex)*(m_ssbFftLen));
m_DSBFilterBufferIndex = 0;
m_objSettingsMutex.unlock();
}
2017-10-01 03:06:55 -04:00
if ((m_configPrivate.m_intTVSampleRate != m_runningPrivate.m_intTVSampleRate)
|| (m_rfConfig.m_fltBFOFrequency != m_rfRunning.m_fltBFOFrequency))
{
2017-10-01 03:06:55 -04:00
m_bfoPLL.configure(m_rfConfig.m_fltBFOFrequency / m_configPrivate.m_intTVSampleRate,
100.0 / m_configPrivate.m_intTVSampleRate,
0.01);
2017-10-01 03:06:55 -04:00
m_bfoFilter.setFrequencies(m_rfConfig.m_fltBFOFrequency, m_configPrivate.m_intTVSampleRate);
}
2017-10-01 03:06:55 -04:00
if (m_rfConfig.m_fmDeviation != m_rfRunning.m_fmDeviation)
{
2017-10-01 03:06:55 -04:00
m_objPhaseDiscri.setFMScaling(1.0f / m_rfConfig.m_fmDeviation);
}
2017-10-01 03:06:55 -04:00
m_running = m_config;
m_rfRunning = m_rfConfig;
m_runningPrivate = m_configPrivate;
if (forwardSampleRateChange)
{
2017-10-01 03:06:55 -04:00
int sampleRate = m_rfRunning.m_blndecimatorEnable ? m_runningPrivate.m_intTVSampleRate : m_running.m_intSampleRate;
MsgReportEffectiveSampleRate *report;
2017-10-01 03:06:55 -04:00
report = MsgReportEffectiveSampleRate::create(sampleRate, m_runningPrivate.m_intNumberSamplePerLine);
2017-09-27 17:47:29 -04:00
getMessageQueueToGUI()->push(report);
}
2017-02-23 02:18:56 -05:00
}
void ATVDemod::applyStandard()
{
2017-10-01 03:06:55 -04:00
switch(m_config.m_enmATVStandard)
{
case ATVStdHSkip:
// what is left in a line for the image
m_intNumberOfSyncLines = 0;
m_intNumberOfBlackLines = 0;
m_intNumberOfEqLines = 0; // not applicable
m_interleaved = false;
break;
case ATVStdShort:
// what is left in a line for the image
m_intNumberOfSyncLines = 4;
m_intNumberOfBlackLines = 4;
m_intNumberOfEqLines = 0;
m_interleaved = false;
break;
case ATVStdShortInterleaved:
// what is left in a line for the image
m_intNumberOfSyncLines = 4;
m_intNumberOfBlackLines = 4;
m_intNumberOfEqLines = 0;
m_interleaved = true;
break;
case ATVStd405: // Follows loosely the 405 lines standard
// what is left in a ine for the image
m_intNumberOfSyncLines = 24; // (15+7)*2 - 20
m_intNumberOfBlackLines = 28; // above + 4
m_intNumberOfEqLines = 3;
m_interleaved = true;
break;
case ATVStdPAL525: // Follows PAL-M standard
// what is left in a 64/1.008 us line for the image
m_intNumberOfSyncLines = 40; // (15+15)*2 - 20
m_intNumberOfBlackLines = 44; // above + 4
m_intNumberOfEqLines = 3;
m_interleaved = true;
break;
case ATVStdPAL625: // Follows PAL-B/G/H standard
default:
// what is left in a 64 us line for the image
m_intNumberOfSyncLines = 44; // (15+17)*2 - 20
m_intNumberOfBlackLines = 48; // above + 4
m_intNumberOfEqLines = 3;
m_interleaved = true;
}
// for now all standards apply this
2017-10-01 03:06:55 -04:00
m_intNumberSamplePerLineSignals = (int) ((12.0f/64.0f)*m_config.m_fltLineDuration * m_config.m_intSampleRate); // 12.0 = 7.3 + 4.7
m_intNumberSaplesPerHSync = (int) ((9.6f/64.0f)*m_config.m_fltLineDuration * m_config.m_intSampleRate); // 9.4 = 4.7 + 4.7
}
int ATVDemod::getSampleRate()
2017-02-23 02:18:56 -05:00
{
2017-10-01 03:06:55 -04:00
return m_running.m_intSampleRate;
2017-02-23 02:18:56 -05:00
}
int ATVDemod::getEffectiveSampleRate()
{
2017-10-01 03:06:55 -04:00
return m_rfRunning.m_blndecimatorEnable ? m_runningPrivate.m_intTVSampleRate : m_running.m_intSampleRate;
}
bool ATVDemod::getBFOLocked()
{
2017-10-01 03:06:55 -04:00
if ((m_rfRunning.m_enmModulation == ATV_USB) || (m_rfRunning.m_enmModulation == ATV_LSB))
{
return m_bfoPLL.locked();
}
else
{
return false;
}
}
float ATVDemod::getRFBandwidthDivisor(ATVModulation modulation)
{
switch(modulation)
{
case ATV_USB:
case ATV_LSB:
return 1.05f;
break;
case ATV_FM1:
case ATV_FM2:
case ATV_AM:
default:
return 2.2f;
}
}