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