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