VE7UWU/sdrangel
1
0
Fork 0
mirror of https://github.com/f4exb/sdrangel.git synced 2026-07-25 11:34:09 -04:00
Code Issues Projects Releases Wiki Activity

New PLL: implemented trick on the phase comparator for M-ary PSK operation

Browse Source
This commit is contained in:
f4exb
2018-05-14 19:14:30 +02:00
parent b5d6d56cc9
commit 68c50769fe
2 changed files with 36 additions and 5 deletions
Download Patch File Download Diff File Expand all files Collapse all files
sdrbase/dsp/phaselockcomplex.cpp
+25 -3
View File
@@ -3,7 +3,9 @@
// written by Edouard Griffiths //
// //
// See: http://liquidsdr.org/blog/pll-howto/ //
// Fixes filter registers saturation //
// Fixed filter registers saturation //
// Added order for PSK locking. This brilliant idea actually comes from this //
// post: https://www.dsprelated.com/showthread/comp.dsp/36356-1.php //
// //
// 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 //
@@ -37,7 +39,8 @@ PhaseLockComplex::PhaseLockComplex() :
m_y(1.0, 0.0),
m_yRe(1.0),
m_yIm(0.0),
m_freq(0.0)
m_freq(0.0),
m_pskOrder(1)
{
}
@@ -71,6 +74,11 @@ void PhaseLockComplex::computeCoefficients(Real wn, Real zeta, Real K)
reset();
}
void PhaseLockComplex::setPskOrder(unsigned int order)
{
m_pskOrder = order > 0 ? order : 1;
}
void PhaseLockComplex::reset()
{
// reset filter accumulators and phase
@@ -96,6 +104,11 @@ void PhaseLockComplex::feed(float re, float im)
std::complex<float> x(re, im);
m_deltaPhi = std::arg(x * std::conj(m_y));
// bring phase 0 on any of the PSK symbols
if (m_pskOrder > 1) {
m_deltaPhi = normalizeAngle(m_pskOrder*m_deltaPhi);
}
// advance buffer
m_v2 = m_v1; // shift center register to upper register
m_v1 = m_v0; // shift lower register to center register
@@ -134,4 +147,13 @@ void PhaseLockComplex::feed(float re, float im)
m_phiHatLast = m_phiHat;
}
float PhaseLockComplex::normalizeAngle(float angle)
{
while (angle <= -M_PI) {
angle += 2.0*M_PI;
}
while (angle > M_PI) {
angle -= 2.0*M_PI;
}
return angle;
}