git.gag.com Git - debian/gnuradio/blob - vrt/lib/copiers.cc

   1 /* -*- c++ -*- */
   2 /*
   3  * Copyright 2009 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 along
  18  * with this program; if not, write to the Free Software Foundation, Inc.,
  19  * 51 Franklin Street, Fifth Floor, Boston, MA 02110-1301 USA.
  20  */
  21
  22 #ifdef HAVE_CONFIG_H
  23 #include <config.h>
  24 #endif
  25 #include <vrt/copiers.h>
  26 #include <arpa/inet.h>
  27 #include <assert.h>
  28 #include <string.h>
  29
  30 namespace vrt {
  31
  32   void
  33   copy_net_16sc_to_host_16sc(size_t nitems,
  34                              const uint32_t *items,
  35                              std::complex<int16_t> *host_items)
  36   {
  37 #ifdef WORDS_BIGENDIAN
  38
  39     assert(sizeof(items[0]) == sizeof(host_items[0]));
  40     memcpy(host_items, items, nitems * sizeof(items[0]));
  41
  42 #else
  43
  44     // FIXME SIMD welcome here
  45
  46     for (size_t i = 0; i < nitems; i++){
  47       uint32_t t = ntohl(items[i]);
  48       //printf("%9d\n", items[i]);
  49       host_items[i] = std::complex<int16_t>((t >> 16), t & 0xffff);
  50     }
  51
  52 #endif
  53   }
  54
  55   void
  56   copy_net_16sc_to_host_32fc(size_t nitems,
  57                              const uint32_t *items,
  58                              std::complex<float> *host_items)
  59   {
  60     // FIXME SIMD welcome here
  61
  62     for (size_t i = 0; i < nitems; i++){
  63       uint32_t t = ntohl(items[i]);
  64       int16_t re = (t >> 16) & 0xffff;
  65       int16_t im = (t & 0xffff);
  66       host_items[i] = std::complex<float>(re * 1.0/32768, im * 1.0/32768);
  67     }
  68   }
  69
  70 };
  71