Imported Upstream version 3.0
[debian/gnuradio] / gnuradio-core / src / lib / general / gr_skiphead.cc
1 /* -*- c++ -*- */
2 /*
3  * Copyright 2005 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 #include <gr_skiphead.h>
27 #include <gr_io_signature.h>
28
29 gr_skiphead::gr_skiphead (size_t sizeof_stream_item, int nitems)
30   : gr_sync_block ("skiphead",
31        gr_make_io_signature (1, 1, sizeof_stream_item),
32        gr_make_io_signature (1, 1, sizeof_stream_item)),
33     d_nitems (nitems), d_nskipped_items (0)
34 {
35 }
36
37 gr_block_sptr
38 gr_make_skiphead (size_t sizeof_stream_item, int nitems)
39 {
40   return gr_block_sptr (new gr_skiphead (sizeof_stream_item, nitems));
41 }
42
43 int
44 gr_skiphead::work (int noutput_items,
45         gr_vector_const_void_star &input_items,
46         gr_vector_void_star &output_items)
47 {
48   int items_to_skip = d_nitems - d_nskipped_items;
49   if (items_to_skip <=0)
50   {
51      //Done with skipping, copy all input to the output;
52      memcpy (output_items[0], input_items[0], noutput_items * input_signature()->sizeof_stream_item (0));
53      return noutput_items;
54   } else if (items_to_skip < noutput_items)
55   {
56      memcpy (output_items[0], &(((char *)input_items[0])[items_to_skip*input_signature()->sizeof_stream_item (0)]), (noutput_items -items_to_skip) * input_signature()->sizeof_stream_item (0));
57     //memcpy (output_items[0], &((input_items[0])[items_to_skip]), (noutput_items -items_to_skip) * input_signature()->sizeof_stream_item (0));
58      //memcpy (output_items[0], input_items[0]+items_to_skip*input_signature()->sizeof_stream_item (0), (noutput_items -items_to_skip) * input_signature()->sizeof_stream_item (0));
59      d_nskipped_items += items_to_skip;
60      consume_each (items_to_skip);
61      return (noutput_items -items_to_skip);
62   } else
63   {
64      d_nskipped_items += noutput_items;
65      consume_each (items_to_skip);
66      return 0;
67   }
68
69   return -1;//Should never get here
70 }