gnss-sdr/src/algorithms/data_type_adapter/gnuradio_blocks/interleaved_byte_to_complex...

61 lines
2.2 KiB
C++

/*!
* \file interleaved_byte_to_complex_short.cc
* \brief Adapts a byte (8-bits) interleaved sample stream into a std::complex<short> stream
* \author Javier Arribas (jarribas(at)cttc.es)
*
* -------------------------------------------------------------------------
*
* Copyright (C) 2010-2019 (see AUTHORS file for a list of contributors)
*
* GNSS-SDR is a software defined Global Navigation
* Satellite Systems receiver
*
* This file is part of GNSS-SDR.
*
* SPDX-License-Identifier: GPL-3.0-or-later
*
* -------------------------------------------------------------------------
*/
#include "interleaved_byte_to_complex_short.h"
#include <gnuradio/io_signature.h>
#include <volk/volk.h>
#include <algorithm> // for max
interleaved_byte_to_complex_short_sptr make_interleaved_byte_to_complex_short()
{
return interleaved_byte_to_complex_short_sptr(new interleaved_byte_to_complex_short());
}
interleaved_byte_to_complex_short::interleaved_byte_to_complex_short() : sync_decimator("interleaved_byte_to_complex_short",
gr::io_signature::make(1, 1, sizeof(int8_t)),
gr::io_signature::make(1, 1, sizeof(lv_16sc_t)), // lv_16sc_t is a Volk's typedef for std::complex<short int>
2)
{
const auto alignment_multiple = static_cast<int>(volk_get_alignment() / sizeof(lv_16sc_t));
set_alignment(std::max(1, alignment_multiple));
}
int interleaved_byte_to_complex_short::work(int noutput_items,
gr_vector_const_void_star &input_items,
gr_vector_void_star &output_items)
{
const auto *in = reinterpret_cast<const int8_t *>(input_items[0]);
auto *out = reinterpret_cast<lv_16sc_t *>(output_items[0]);
// This could be put into a Volk kernel
int8_t real_part;
int8_t imag_part;
for (int number = 0; number < noutput_items; number++)
{
// lv_cmake(r, i) defined at volk/volk_complex.h
real_part = *in++;
imag_part = *in++;
*out++ = lv_cmake(static_cast<int16_t>(real_part), static_cast<int16_t>(imag_part));
}
return noutput_items;
}