mirror of
https://github.com/f4exb/sdrangel.git
synced 2024-09-09 22:56:34 -04:00
214 lines
6.8 KiB
C++
214 lines
6.8 KiB
C++
///////////////////////////////////////////////////////////////////////////////////
|
|
// Copyright (C) 2018 Edouard Griffiths, F4EXB //
|
|
// //
|
|
// 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 //
|
|
// (at your option) any later version. //
|
|
// //
|
|
// 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 "decimatorsfi.h"
|
|
|
|
template<>
|
|
void DecimatorsFI<true>::decimate1(SampleVector::iterator* it, const float* buf, qint32 nbIAndQ)
|
|
{
|
|
float xreal, yimag;
|
|
|
|
for (int pos = 0; pos < nbIAndQ - 1; pos += 2)
|
|
{
|
|
xreal = buf[pos+0];
|
|
yimag = buf[pos+1];
|
|
(**it).setReal(xreal * SDR_RX_SCALEF);
|
|
(**it).setImag(yimag * SDR_RX_SCALEF);
|
|
++(*it); // Valgrind optim (comment not repeated)
|
|
}
|
|
}
|
|
|
|
template<>
|
|
void DecimatorsFI<false>::decimate1(SampleVector::iterator* it, const float* buf, qint32 nbIAndQ)
|
|
{
|
|
float xreal, yimag;
|
|
|
|
for (int pos = 0; pos < nbIAndQ - 1; pos += 2)
|
|
{
|
|
xreal = buf[pos+1];
|
|
yimag = buf[pos+0];
|
|
(**it).setReal(xreal * SDR_RX_SCALEF);
|
|
(**it).setImag(yimag * SDR_RX_SCALEF);
|
|
++(*it); // Valgrind optim (comment not repeated)
|
|
}
|
|
}
|
|
|
|
template<>
|
|
void DecimatorsFI<true>::decimate2_inf(SampleVector::iterator* it, const float* buf, qint32 nbIAndQ)
|
|
{
|
|
float xreal, yimag;
|
|
|
|
for (int pos = 0; pos < nbIAndQ - 7; pos += 8)
|
|
{
|
|
xreal = (buf[pos+0] - buf[pos+3]);
|
|
yimag = (buf[pos+1] + buf[pos+2]);
|
|
(**it).setReal(xreal * SDR_RX_SCALED);
|
|
(**it).setImag(yimag * SDR_RX_SCALED);
|
|
++(*it);
|
|
|
|
xreal = (buf[pos+7] - buf[pos+4]);
|
|
yimag = (- buf[pos+5] - buf[pos+6]);
|
|
(**it).setReal(xreal * SDR_RX_SCALED);
|
|
(**it).setImag(yimag * SDR_RX_SCALED);
|
|
++(*it);
|
|
}
|
|
}
|
|
|
|
template<>
|
|
void DecimatorsFI<false>::decimate2_inf(SampleVector::iterator* it, const float* buf, qint32 nbIAndQ)
|
|
{
|
|
float xreal, yimag;
|
|
|
|
for (int pos = 0; pos < nbIAndQ - 7; pos += 8)
|
|
{
|
|
xreal = (buf[pos+1] + buf[pos+2]);
|
|
yimag = (buf[pos+0] - buf[pos+3]);
|
|
(**it).setReal(xreal * SDR_RX_SCALED);
|
|
(**it).setImag(yimag * SDR_RX_SCALED);
|
|
++(*it);
|
|
|
|
xreal = (- buf[pos+5] - buf[pos+6]);
|
|
yimag = (buf[pos+7] - buf[pos+4]);
|
|
(**it).setReal(xreal * SDR_RX_SCALED);
|
|
(**it).setImag(yimag * SDR_RX_SCALED);
|
|
++(*it);
|
|
}
|
|
}
|
|
|
|
template<>
|
|
void DecimatorsFI<true>::decimate2_sup(SampleVector::iterator* it, const float* buf, qint32 nbIAndQ)
|
|
{
|
|
float xreal, yimag;
|
|
|
|
for (int pos = 0; pos < nbIAndQ - 7; pos += 8)
|
|
{
|
|
xreal = (buf[pos+1] - buf[pos+2]);
|
|
yimag = (- buf[pos+0] - buf[pos+3]);
|
|
(**it).setReal(xreal * SDR_RX_SCALED);
|
|
(**it).setImag(yimag * SDR_RX_SCALED);
|
|
++(*it);
|
|
|
|
xreal = (buf[pos+6] - buf[pos+5]);
|
|
yimag = (buf[pos+4] + buf[pos+7]);
|
|
(**it).setReal(xreal * SDR_RX_SCALED);
|
|
(**it).setImag(yimag * SDR_RX_SCALED);
|
|
++(*it);
|
|
}
|
|
}
|
|
|
|
template<>
|
|
void DecimatorsFI<false>::decimate2_sup(SampleVector::iterator* it, const float* buf, qint32 nbIAndQ)
|
|
{
|
|
float xreal, yimag;
|
|
|
|
for (int pos = 0; pos < nbIAndQ - 7; pos += 8)
|
|
{
|
|
xreal = (- buf[pos+0] - buf[pos+3]);
|
|
yimag = (buf[pos+1] - buf[pos+2]);
|
|
(**it).setReal(xreal * SDR_RX_SCALED);
|
|
(**it).setImag(yimag * SDR_RX_SCALED);
|
|
++(*it);
|
|
|
|
xreal = (buf[pos+4] + buf[pos+7]);
|
|
yimag = (buf[pos+6] - buf[pos+5]);
|
|
(**it).setReal(xreal * SDR_RX_SCALED);
|
|
(**it).setImag(yimag * SDR_RX_SCALED);
|
|
++(*it);
|
|
}
|
|
}
|
|
|
|
template<>
|
|
void DecimatorsFI<true>::decimate4_inf(SampleVector::iterator* it, const float* buf, qint32 nbIAndQ)
|
|
{
|
|
float xreal, yimag;
|
|
|
|
for (int pos = 0; pos < nbIAndQ - 7; pos += 8)
|
|
{
|
|
xreal = (buf[pos+0] - buf[pos+3] + buf[pos+7] - buf[pos+4]);
|
|
yimag = (buf[pos+1] - buf[pos+5] + buf[pos+2] - buf[pos+6]);
|
|
|
|
(**it).setReal(xreal * SDR_RX_SCALED);
|
|
(**it).setImag(yimag * SDR_RX_SCALED);
|
|
|
|
++(*it);
|
|
}
|
|
}
|
|
|
|
template<>
|
|
void DecimatorsFI<false>::decimate4_inf(SampleVector::iterator* it, const float* buf, qint32 nbIAndQ)
|
|
{
|
|
float xreal, yimag;
|
|
|
|
for (int pos = 0; pos < nbIAndQ - 7; pos += 8)
|
|
{
|
|
xreal = (buf[pos+1] - buf[pos+5] + buf[pos+2] - buf[pos+6]);
|
|
yimag = (buf[pos+0] - buf[pos+3] + buf[pos+7] - buf[pos+4]);
|
|
|
|
(**it).setReal(xreal * SDR_RX_SCALED);
|
|
(**it).setImag(yimag * SDR_RX_SCALED);
|
|
|
|
++(*it);
|
|
}
|
|
}
|
|
|
|
template<>
|
|
void DecimatorsFI<true>::decimate4_sup(SampleVector::iterator* it, const float* buf, qint32 nbIAndQ)
|
|
{
|
|
// Sup (USB):
|
|
// x y x y x y x y / x -> 1,-2,-5,6 / y -> -0,-3,4,7
|
|
// [ rotate: 1, 0, -2, 3, -5, -4, 6, -7]
|
|
// Inf (LSB):
|
|
// x y x y x y x y / x -> 0,-3,-4,7 / y -> 1,2,-5,-6
|
|
// [ rotate: 0, 1, -3, 2, -4, -5, 7, -6]
|
|
float xreal, yimag;
|
|
|
|
for (int pos = 0; pos < nbIAndQ - 7; pos += 8)
|
|
{
|
|
xreal = (buf[pos+1] - buf[pos+2] - buf[pos+5] + buf[pos+6]);
|
|
yimag = (- buf[pos+0] - buf[pos+3] + buf[pos+4] + buf[pos+7]);
|
|
|
|
(**it).setReal(xreal * SDR_RX_SCALED);
|
|
(**it).setImag(yimag * SDR_RX_SCALED);
|
|
|
|
++(*it);
|
|
}
|
|
}
|
|
|
|
template<>
|
|
void DecimatorsFI<false>::decimate4_sup(SampleVector::iterator* it, const float* buf, qint32 nbIAndQ)
|
|
{
|
|
// Sup (USB):
|
|
// x y x y x y x y / x -> 1,-2,-5,6 / y -> -0,-3,4,7
|
|
// [ rotate: 1, 0, -2, 3, -5, -4, 6, -7]
|
|
// Inf (LSB):
|
|
// x y x y x y x y / x -> 0,-3,-4,7 / y -> 1,2,-5,-6
|
|
// [ rotate: 0, 1, -3, 2, -4, -5, 7, -6]
|
|
float xreal, yimag;
|
|
|
|
for (int pos = 0; pos < nbIAndQ - 7; pos += 8)
|
|
{
|
|
xreal = (- buf[pos+0] - buf[pos+3] + buf[pos+4] + buf[pos+7]);
|
|
yimag = (buf[pos+1] - buf[pos+2] - buf[pos+5] + buf[pos+6]);
|
|
|
|
(**it).setReal(xreal * SDR_RX_SCALED);
|
|
(**it).setImag(yimag * SDR_RX_SCALED);
|
|
|
|
++(*it);
|
|
}
|
|
}
|
|
|