git.gag.com Git - debian/gnuradio/blob - gr-trellis/src/lib/trellis_permutation.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 <trellis_permutation.h>
  28 #include <gr_io_signature.h>
  29 #include <iostream>
  30
  31 trellis_permutation_sptr
  32 trellis_make_permutation (int K, const std::vector<int> &TABLE, int SYMS_PER_BLOCK, size_t NBYTES_INOUT)
  33 {
  34   return trellis_permutation_sptr (new trellis_permutation (K,TABLE,SYMS_PER_BLOCK,NBYTES_INOUT));
  35 }
  36
  37 trellis_permutation::trellis_permutation (int K, const std::vector<int> &TABLE, int SYMS_PER_BLOCK, size_t NBYTES_INOUT)
  38   : gr_sync_block ("permutation",
  39                    gr_make_io_signature (1, -1, NBYTES_INOUT),
  40                    gr_make_io_signature (1, -1, NBYTES_INOUT)),
  41     d_K (K),
  42     d_TABLE (TABLE),
  43     d_SYMS_PER_BLOCK (SYMS_PER_BLOCK),
  44     d_NBYTES_INOUT (NBYTES_INOUT)
  45 {
  46     set_output_multiple (d_K*SYMS_PER_BLOCK);
  47     //std::cout << d_K << "\n";
  48 }
  49
  50
  51
  52 int
  53 trellis_permutation::work (int noutput_items,
  54                         gr_vector_const_void_star &input_items,
  55                         gr_vector_void_star &output_items)
  56 {
  57   int nstreams = input_items.size();
  58   assert (input_items.size() == output_items.size());
  59   assert (noutput_items % d_K ==0);
  60
  61   for (int m=0;m<nstreams;m++) {
  62     const char *in = (const char *) input_items[m];
  63     char *out = (char *) output_items[m];
  64
  65     // per stream processing
  66     for (int i = 0; i < noutput_items/d_SYMS_PER_BLOCK; i++){
  67       // Index i refers to blocks.
  68       // Begining of packet (in blocks)
  69       int i0 = d_K*(i/d_K);
  70       // position of block within packet (in blocks)
  71       int j0 = i%d_K;
  72       // new position of block within packet (in blocks)
  73       int k0 = d_TABLE[j0];
  74       memcpy(&(out[i*d_SYMS_PER_BLOCK*d_NBYTES_INOUT]),
  75              &(in[(i0+k0)*d_SYMS_PER_BLOCK*d_NBYTES_INOUT]),
  76              d_NBYTES_INOUT*d_SYMS_PER_BLOCK);
  77     }
  78     // end per stream processing
  79   }
  80   return noutput_items;
  81 }