Imported Upstream version 3.0
[debian/gnuradio] / gnuradio-core / src / lib / general / gr_keep_one_in_n.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_keep_one_in_n.h>
28 #include <gr_io_signature.h>
29
30 gr_keep_one_in_n_sptr
31 gr_make_keep_one_in_n (size_t item_size, int n)
32 {
33   return gr_keep_one_in_n_sptr (new gr_keep_one_in_n (item_size, n));
34 }
35
36 gr_keep_one_in_n::gr_keep_one_in_n (size_t item_size, int n)
37   : gr_block ("keep_one_in_n",
38               gr_make_io_signature (1, 1, item_size),
39               gr_make_io_signature (1, 1, item_size)),
40     d_n (n), d_count(n)
41 {
42 }
43
44 void
45 gr_keep_one_in_n::set_n(int n)
46 {
47   if (n < 1)
48     n = 1;
49
50   d_n = n;
51   d_count = n;
52 }
53
54 int
55 gr_keep_one_in_n::general_work (int noutput_items,
56                                 gr_vector_int &ninput_items,
57                                 gr_vector_const_void_star &input_items,
58                                 gr_vector_void_star &output_items)
59 {
60   const char *in = (const char *) input_items[0];
61   char *out = (char *) output_items[0];
62   
63   size_t item_size = input_signature ()->sizeof_stream_item (0);
64   int    ni = 0;
65   int    no = 0;
66
67   while (ni < ninput_items[0] && no < noutput_items){
68     d_count--;
69     if (d_count <= 0){
70       memcpy (out, in, item_size);              // copy 1 item
71       out += item_size;
72       no++;
73       d_count = d_n;
74     }
75     in += item_size;
76     ni++;
77   }
78
79   consume_each (ni);
80   return no;
81 }