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
  28 namespace vrt {
  29
  30   void
  31   copy_net_16sc_to_host_16sc(size_t nitems,
  32                              const uint32_t *items,
  33                              std::complex<int16_t> *host_items)
  34   {
  35 #ifdef WORDS_BIGENDIAN
  36
  37     assert(sizeof(items[0]) == sizeof(host_items[0]));
  38     memcpy(host_items, items, nitems * sizeof(items[0]));
  39
  40 #else
  41
  42     // FIXME SIMD welcome here
  43
  44     for (size_t i = 0; i < nitems; i++){
  45       uint32_t t = ntohl(items[i]);
  46       //printf("%9d\n", items[i]);
  47       host_items[i] = std::complex<int16_t>((t >> 16), t & 0xffff);
  48     }
  49
  50 #endif
  51   }
  52
  53   void
  54   copy_net_16sc_to_host_32fc(size_t nitems,
  55                              const uint32_t *items,
  56                              std::complex<float> *host_items)
  57   {
  58     // FIXME SIMD welcome here
  59
  60     for (size_t i = 0; i < nitems; i++){
  61       uint32_t t = ntohl(items[i]);
  62       int16_t re = (t >> 16) & 0xffff;
  63       int16_t im = (t & 0xffff);
  64       host_items[i] = std::complex<float>(re * 1.0/32768, im * 1.0/32768);
  65     }
  66   }
  67
  68 };
  69