libdspl-2.0
Библиотека алгоритмов цифровой обработки сигналов
goertzel_cmplx.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 
27 #ifdef DOXYGEN_ENGLISH
28 
75 #endif
76 #ifdef DOXYGEN_RUSSIAN
77 
124 #endif
125 int DSPL_API goertzel_cmplx(complex_t *x, int n, int *ind, int k, complex_t *y)
126 {
127 
128  int m, p;
129  complex_t w;
130  double alpha;
131  complex_t v[3];
132 
133  if(!x || !y || !ind)
134  return ERROR_PTR;
135 
136  if(n < 1 || k < 1)
137  return ERROR_SIZE;
138 
139  for(p = 0; p < k; p++)
140  {
141  RE(w) = cos(M_2PI * (double)ind[p] / (double)n);
142  IM(w) = sin(M_2PI * (double)ind[p] / (double)n);
143 
144  alpha = 2.0 * RE(w);
145  memset(v, 0, 3*sizeof(complex_t));
146 
147  for(m = 0; m < n; m++)
148  {
149  RE(v[2]) = RE(v[1]);
150  RE(v[1]) = RE(v[0]);
151  RE(v[0]) = RE(x[m]) + alpha * RE(v[1]) - RE(v[2]);
152 
153  IM(v[2]) = IM(v[1]);
154  IM(v[1]) = IM(v[0]);
155  IM(v[0]) = IM(x[m]) + alpha * IM(v[1]) - IM(v[2]);
156  }
157 
158  RE(y[p]) = CMRE(w, v[0]) - RE(v[1]);
159  IM(y[p]) = CMIM(w, v[0]) - IM(v[1]);
160  }
161 
162  return RES_OK;
163 }
164 
#define RE(x)
Макрос определяющий реальную часть комплексного числа.
Definition: dspl.h:420
#define ERROR_PTR
Ошибка указателя. Данная ошибка означает, что один из обязательных указателей (память под который дол...
Definition: dspl.h:610
#define ERROR_SIZE
Ошибка при передаче размера массива. Данная ошибка возникает когда помимо указателя на массив входных...
Definition: dspl.h:618
double complex_t[2]
Описание комплексного типа данных.
Definition: dspl.h:86
#define RES_OK
Функция завершилась корректно. Ошибки отсутствуют.
Definition: dspl.h:558
int goertzel_cmplx(complex_t *x, int n, int *ind, int k, complex_t *y)
Алгоритм Гёрцеля для расчета отдельных спектральных отсчетов дискретного преобразования Фурье комплек...
#define IM(x)
Макрос определяющий мнимую часть комплексного числа.
Definition: dspl.h:478