Imported Upstream version 3.0
[debian/gnuradio] / gnuradio-core / src / lib / general / gr_interleave.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_interleave.h>
28 #include <gr_io_signature.h>
29 #include <string.h>
30
31
32 gr_interleave_sptr
33 gr_make_interleave (size_t itemsize)
34 {
35   return gr_interleave_sptr (new gr_interleave (itemsize));
36 }
37
38 gr_interleave::gr_interleave (size_t itemsize)
39   : gr_sync_interpolator ("interleave",
40                           gr_make_io_signature (1, gr_io_signature::IO_INFINITE, itemsize),
41                           gr_make_io_signature (1, 1, itemsize),
42                           1),
43     d_itemsize (itemsize)
44 {
45 }
46
47 gr_interleave::~gr_interleave ()
48 {
49   // NOP
50 }
51
52 bool
53 gr_interleave::check_topology (int ninputs, int noutputs)
54 {
55   set_interpolation (ninputs);
56   return true;
57 }
58
59 int
60 gr_interleave::work (int noutput_items,
61                      gr_vector_const_void_star &input_items,
62                      gr_vector_void_star &output_items)
63 {
64   size_t nchan = input_items.size ();
65   size_t itemsize = d_itemsize;
66   const char **in = (const char **) &input_items[0];
67   char *out = (char *) output_items[0];
68
69   for (int i = 0; i < noutput_items; i += nchan){
70     for (unsigned int n = 0; n < nchan; n++){
71       memcpy (out, in[n], itemsize);
72       out += itemsize;
73       in[n] += itemsize;
74     }
75   }
76   return noutput_items;
77 }