Imported Upstream version 3.0.4
[debian/gnuradio] / gnuradio-core / src / lib / general / gr_unpack_k_bits_bb.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 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 #if HAVE_CONFIG_H
24 #include "config.h"
25 #endif
26
27 #include <gr_unpack_k_bits_bb.h>
28 #include <gr_io_signature.h>
29 #include <stdexcept>
30 #include <iostream>
31
32 gr_unpack_k_bits_bb_sptr gr_make_unpack_k_bits_bb (unsigned k)
33 {
34   return gr_unpack_k_bits_bb_sptr (new gr_unpack_k_bits_bb (k));
35 }
36
37
38 gr_unpack_k_bits_bb::gr_unpack_k_bits_bb (unsigned k)
39   : gr_sync_interpolator ("unpack_k_bits_bb",
40                           gr_make_io_signature (1, 1, sizeof (unsigned char)),
41                           gr_make_io_signature (1, 1, sizeof (unsigned char)),
42                           k),
43     d_k (k)
44 {
45   if (d_k == 0)
46     throw std::out_of_range ("interpolation must be > 0");
47 }
48
49 gr_unpack_k_bits_bb::~gr_unpack_k_bits_bb ()
50 {
51 }
52
53 int
54 gr_unpack_k_bits_bb::work (int noutput_items,
55                            gr_vector_const_void_star &input_items,
56                            gr_vector_void_star &output_items)
57 {
58   const unsigned char *in = (const unsigned char *) input_items[0];
59   unsigned char *out = (unsigned char *) output_items[0];
60
61   int n = 0;
62   for (unsigned int i = 0; i < noutput_items/d_k; i++){
63     unsigned int t = in[i];
64     for (int j = d_k - 1; j >= 0; j--)
65       out[n++] = (t >> j) & 0x01;
66   }
67
68   assert(n == noutput_items);
69   return noutput_items;
70 }