Imported Upstream version 3.0
[debian/gnuradio] / gnuradio-core / src / lib / filter / gr_iir_filter_ffd.cc
1 /* -*- c++ -*- */
2 /*
3  * Copyright 2004 Free Software Foundation, Inc.
4  * 
5  * This file is part of GNU Radio
6  * 
7  * GNU Radio is free software; you can redistribute it and/or modify
8  * it under the terms of the GNU General Public License as published by
9  * the Free Software Foundation; either version 2, or (at your option)
10  * any later version.
11  * 
12  * GNU Radio 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 General Public License
18  * along with GNU Radio; see the file COPYING.  If not, write to
19  * the Free Software Foundation, Inc., 51 Franklin Street,
20  * Boston, MA 02110-1301, USA.
21  */
22
23 #ifdef HAVE_CONFIG_H
24 #include "config.h"
25 #endif
26
27 #include <gr_iir_filter_ffd.h>
28 #include <gr_io_signature.h>
29 #include <stdio.h>
30
31
32 gr_iir_filter_ffd_sptr 
33 gr_make_iir_filter_ffd (const std::vector<double> &fftaps,
34                         const std::vector<double> &fbtaps) throw (std::invalid_argument)
35 {
36   return gr_iir_filter_ffd_sptr (new gr_iir_filter_ffd (fftaps, fbtaps));
37 }
38
39 gr_iir_filter_ffd::gr_iir_filter_ffd (const std::vector<double> &fftaps,
40                                       const std::vector<double> &fbtaps) throw (std::invalid_argument)
41
42   : gr_sync_block ("iir_filter_ffd",
43                    gr_make_io_signature (1, 1, sizeof (float)),
44                    gr_make_io_signature (1, 1, sizeof (float))),
45     d_iir (fftaps, fbtaps),
46     d_updated (false)
47 {
48   // fprintf (stderr, "gr_iir_filter_ffd::ctor\n");
49 }
50
51 gr_iir_filter_ffd::~gr_iir_filter_ffd ()
52 {
53   // nop
54 }
55
56 void
57 gr_iir_filter_ffd::set_taps (const std::vector<double> &fftaps,
58                              const std::vector<double> &fbtaps) throw (std::invalid_argument)
59 {
60   if (fftaps.size () != fbtaps.size ()){
61     fprintf (stderr,
62      "gr_iir_filter_ffd::set_taps: fftaps and fbtaps must have the same number of elements.\n");
63     throw std::invalid_argument ("gr_iir_filter_ffd::set_taps");
64   }
65   
66   d_new_fftaps = fftaps;
67   d_new_fbtaps = fbtaps;
68   d_updated = true;
69 }
70
71 int
72 gr_iir_filter_ffd::work (int noutput_items,
73                          gr_vector_const_void_star &input_items,
74                          gr_vector_void_star &output_items)
75 {
76   const float *in = (const float *) input_items[0];
77   float *out = (float *) output_items[0];
78
79   // fprintf (stderr, "gr_iir_filter_ffd::work noutput_items = %d\n", noutput_items);
80
81   if (d_updated){
82     d_iir.set_taps (d_new_fftaps, d_new_fbtaps);
83     d_updated = false;
84   }
85
86   d_iir.filter_n (out, in, noutput_items);
87   return noutput_items;
88 };