mirror of
https://github.com/miek/inspectrum.git
synced 2026-02-24 11:41:35 +01:00
64 lines
2.0 KiB
C++
64 lines
2.0 KiB
C++
/*
|
|
* Copyright (C) 2016, Mike Walters <mike@flomp.net>
|
|
*
|
|
* This file is part of inspectrum.
|
|
*
|
|
* 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, either 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 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 "tunertransform.h"
|
|
#include <liquid/liquid.h>
|
|
#include "util.h"
|
|
|
|
TunerTransform::TunerTransform(SampleSource<std::complex<float>> *src) : SampleBuffer(src), taps{1.0f}
|
|
{
|
|
|
|
}
|
|
|
|
void TunerTransform::work(void *input, void *output, int count, off_t sampleid)
|
|
{
|
|
auto in = static_cast<std::complex<float>*>(input);
|
|
auto out = static_cast<std::complex<float>*>(output);
|
|
std::unique_ptr<std::complex<float>[]> temp(new std::complex<float>[count]);
|
|
|
|
// Mix down
|
|
nco_crcf mix = nco_crcf_create(LIQUID_NCO);
|
|
nco_crcf_set_phase(mix, fmodf(frequency * sampleid, Tau));
|
|
nco_crcf_set_frequency(mix, frequency);
|
|
nco_crcf_mix_block_down(mix,
|
|
static_cast<std::complex<float>*>(input),
|
|
temp.get(),
|
|
count);
|
|
nco_crcf_destroy(mix);
|
|
|
|
// Filter
|
|
firfilt_crcf filter = firfilt_crcf_create(taps.data(), taps.size());
|
|
for (int i = 0; i < count; i++)
|
|
{
|
|
firfilt_crcf_push(filter, temp[i]);
|
|
firfilt_crcf_execute(filter, &out[i]);
|
|
}
|
|
firfilt_crcf_destroy(filter);
|
|
}
|
|
|
|
void TunerTransform::setFrequency(float frequency)
|
|
{
|
|
this->frequency = frequency;
|
|
}
|
|
|
|
void TunerTransform::setTaps(std::vector<float> taps)
|
|
{
|
|
this->taps = taps;
|
|
}
|