libdspl-2.0
Библиотека алгоритмов цифровой обработки сигналов
filter_iir.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 
97 #endif
98 #ifdef DOXYGEN_RUSSIAN
99 
164 #endif
165 int DSPL_API filter_iir(double* b, double* a, int ord,
166  double* x, int n, double* y)
167 {
168  double *buf = NULL;
169  double *an = NULL;
170  double *bn = NULL;
171  double u;
172  int k;
173  int m;
174  int count;
175 
176  if(!b || !x || !y)
177  return ERROR_PTR;
178 
179  if(ord < 1 || n < 1)
180  return ERROR_SIZE;
181 
182  if(a && a[0]==0.0)
183  return ERROR_FILTER_A0;
184 
185  count = ord + 1;
186  buf = (double*) malloc(count*sizeof(double));
187  an = (double*) malloc(count*sizeof(double));
188 
189  memset(buf, 0, count*sizeof(double));
190 
191  if(!a)
192  {
193  memset(an, 0, count*sizeof(double));
194  bn = b;
195  }
196  else
197  {
198  bn = (double*) malloc(count*sizeof(double));
199  for(k = 0; k < count; k++)
200  {
201  an[k] = a[k] / a[0];
202  bn[k] = b[k] / a[0];
203  }
204  }
205 
206  for(k = 0; k < n; k++)
207  {
208  for(m = ord; m > 0; m--)
209  buf[m] = buf[m-1];
210  u = 0.0;
211  for(m = ord; m > 0; m--)
212  u += buf[m]*an[m];
213 
214  buf[0] = x[k] - u;
215  y[k] = 0.0;
216  for(m = 0; m < count; m++)
217  y[k] += buf[m] * bn[m];
218  }
219 
220  if(buf)
221  free(buf);
222  if(an)
223  free(an);
224  if(bn && (bn != b))
225  free(bn);
226  return RES_OK;
227 }
228 
int filter_iir(double *b, double *a, int ord, double *x, int n, double *y)
Фильтрация вещественного сигнала вещественным БИХ-фильтром
Definition: filter_iir.c:165
#define ERROR_FILTER_A0
Параметр передаточной характеристики цифрового БИХ-фильтра не может быть равен нулю.
Definition: dspl.h:572
#define ERROR_PTR
Ошибка указателя. Данная ошибка означает, что один из обязательных указателей (память под который дол...
Definition: dspl.h:610
#define ERROR_SIZE
Ошибка при передаче размера массива. Данная ошибка возникает когда помимо указателя на массив входных...
Definition: dspl.h:618
#define RES_OK
Функция завершилась корректно. Ошибки отсутствуют.
Definition: dspl.h:558