libdspl-2.0
Библиотека алгоритмов цифровой обработки сигналов
goertzel.c
1 /*
2 * Copyright (c) 2015-2024 Sergey Bakhurin
3 * Digital Signal Processing Library [http://dsplib.org]
4 *
5 * This file is part of libdspl-2.0.
6 *
7 * is free software: you can redistribute it and/or modify
8 * it under the terms of the GNU Lesser General Public License as published by
9 * the Free Software Foundation, either version 3 of the License, or
10 * (at your option) any later version.
11 *
12 * DSPL is distributed in the hope that it will be useful,
13 * but WITHOUT ANY WARRANTY; without even the implied warranty of
14 * MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE. See the
15 * GNU General Public License for more details.
16 *
17 * You should have received a copy of the GNU Lesser General Public License
18 * along with Foobar. If not, see <http://www.gnu.org/licenses/>.
19 */
20 
21 #include <stdlib.h>
22 #include <string.h>
23 #include "dspl.h"
24 
25 
26 #ifdef DOXYGEN_ENGLISH
27 
73 #endif
74 #ifdef DOXYGEN_RUSSIAN
75 
122 #endif
123 int DSPL_API goertzel(double *x, int n, int *ind, int k, complex_t *y)
124 {
125 
126  int m, p;
127  double wR, wI;
128  double alpha;
129  double v[3];
130 
131  if(!x || !y || !ind)
132  return ERROR_PTR;
133 
134  if(n < 1 || k < 1)
135  return ERROR_SIZE;
136 
137  for(p = 0; p < k; p++)
138  {
139  wR = cos(M_2PI * (double)ind[p] / (double)n);
140  wI = sin(M_2PI * (double)ind[p] / (double)n);
141 
142  alpha = 2.0 * wR;
143  v[0] = v[1] = v[2] = 0.0;
144 
145  for(m = 0; m < n; m++)
146  {
147  v[2] = v[1];
148  v[1] = v[0];
149  v[0] = x[m]+alpha*v[1] - v[2];
150  }
151  RE(y[p]) = wR * v[0] - v[1];
152  IM(y[p]) = wI * v[0];
153  }
154  return RES_OK;
155 }
#define RE(x)
Макрос определяющий реальную часть комплексного числа.
Definition: dspl.h:420
#define ERROR_PTR
Ошибка указателя. Данная ошибка означает, что один из обязательных указателей (память под который дол...
Definition: dspl.h:610
#define ERROR_SIZE
Ошибка при передаче размера массива. Данная ошибка возникает когда помимо указателя на массив входных...
Definition: dspl.h:618
int goertzel(double *x, int n, int *ind, int k, complex_t *y)
Алгоритм Гёрцеля для расчета отдельных спектральных отсчетов дискретного преобразования Фурье веществ...
Definition: goertzel.c:123
double complex_t[2]
Описание комплексного типа данных.
Definition: dspl.h:86
#define RES_OK
Функция завершилась корректно. Ошибки отсутствуют.
Definition: dspl.h:558
#define IM(x)
Макрос определяющий мнимую часть комплексного числа.
Definition: dspl.h:478