1
0
mirror of https://github.com/f4exb/sdrangel.git synced 2024-11-14 04:11:48 -05:00
sdrangel/sdrbase/dsp/goertzel.h

50 lines
2.3 KiB
C++

///////////////////////////////////////////////////////////////////////////////////
// Copyright (C) 2012 maintech GmbH, Otto-Hahn-Str. 15, 97204 Hoechberg, Germany //
// written by Christian Daniel //
// Copyright (C) 2015-2016, 2018-2019 Edouard Griffiths, F4EXB <f4exb06@gmail.com> //
// Copyright (C) 2020 Jon Beniston, M7RCE <jon@beniston.com> //
// //
// 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/>. //
///////////////////////////////////////////////////////////////////////////////////
#ifndef INCLUDE_GOERTZEL_H
#define INCLUDE_GOERTZEL_H
#include <complex>
#include "export.h"
// Goertzel filter for calculting discrete Fourier transform for a single frequency
// Implementation supports non-integer multiples of fundamental frequency, see:
// https://asp-eurasipjournals.springeropen.com/track/pdf/10.1186/1687-6180-2012-56.pdf
class SDRBASE_API Goertzel
{
public:
Goertzel(double frequency, int sampleRate);
void reset();
void filter(double sample);
std::complex<double> goertzel(double lastSample);
double mag();
double phase();
int size() { return m_sampleCount; }
private:
double m_s0, m_s1, m_s2;
double m_a, m_b;
std::complex<double> m_c, m_z;
int m_sampleCount;
};
#endif // INCLUDE_GOERTZEL_H