mirror of
https://github.com/gnss-sdr/gnss-sdr
synced 2024-06-18 19:19:56 +00:00
94 lines
4.1 KiB
C
94 lines
4.1 KiB
C
/*!
|
|
* \file volk_gnsssdr_32fc_32f_rotator_dotprodxnpuppet_32fc.h
|
|
* \brief VOLK_GNSSSDR kernel: multiplies N complex (32-bit float per component) vectors
|
|
* by a common vector, phase rotated with Doppler rate and accumulates the results in N float complex outputs.
|
|
* \authors <ul>
|
|
* <li> Carles Fernandez Prades 2016 cfernandez at cttc dot cat
|
|
* </ul>
|
|
*
|
|
* Volk puppet for integrating the resampler into volk's test system
|
|
*
|
|
* -----------------------------------------------------------------------------
|
|
*
|
|
* GNSS-SDR is a Global Navigation Satellite System software-defined receiver.
|
|
* This file is part of GNSS-SDR.
|
|
*
|
|
* Copyright (C) 2010-2020 (see AUTHORS file for a list of contributors)
|
|
* SPDX-License-Identifier: GPL-3.0-or-later
|
|
*
|
|
* -----------------------------------------------------------------------------
|
|
*/
|
|
|
|
#ifndef INCLUDED_volk_gnsssdr_32fc_32f_high_dynamic_rotator_dotprodxnpuppet_32fc_H
|
|
#define INCLUDED_volk_gnsssdr_32fc_32f_high_dynamic_rotator_dotprodxnpuppet_32fc_H
|
|
|
|
#include "volk_gnsssdr/volk_gnsssdr_32fc_32f_high_dynamic_rotator_dot_prod_32fc_xn.h"
|
|
#include <volk_gnsssdr/volk_gnsssdr.h>
|
|
#include <volk_gnsssdr/volk_gnsssdr_malloc.h>
|
|
#include <string.h>
|
|
|
|
#ifdef LV_HAVE_GENERIC
|
|
|
|
static inline void volk_gnsssdr_32fc_32f_high_dynamic_rotator_dotprodxnpuppet_32fc_generic(lv_32fc_t* result, const lv_32fc_t* local_code, const float* in, unsigned int num_points)
|
|
{
|
|
// phases must be normalized. Phase rotator expects a complex exponential input!
|
|
float rem_carrier_phase_in_rad = 0.25;
|
|
float phase_step_rad = 0.1;
|
|
lv_32fc_t phase[1];
|
|
phase[0] = lv_cmake(cosf(rem_carrier_phase_in_rad), sinf(rem_carrier_phase_in_rad));
|
|
lv_32fc_t phase_inc[1];
|
|
phase_inc[0] = lv_cmake(cosf(phase_step_rad), sinf(phase_step_rad));
|
|
lv_32fc_t phase_inc_rate[1];
|
|
phase_inc_rate[0] = lv_cmake(cosf(phase_step_rad * 0.001), sinf(phase_step_rad * 0.001));
|
|
int n;
|
|
int num_a_vectors = 3;
|
|
float** in_a = (float**)volk_gnsssdr_malloc(sizeof(float*) * num_a_vectors, volk_gnsssdr_get_alignment());
|
|
for (n = 0; n < num_a_vectors; n++)
|
|
{
|
|
in_a[n] = (float*)volk_gnsssdr_malloc(sizeof(float) * num_points, volk_gnsssdr_get_alignment());
|
|
memcpy((float*)in_a[n], (float*)in, sizeof(float) * num_points);
|
|
}
|
|
|
|
volk_gnsssdr_32fc_32f_high_dynamic_rotator_dot_prod_32fc_xn_generic(result, local_code, phase_inc[0], phase_inc_rate[0], phase, (const float**)in_a, num_a_vectors, num_points);
|
|
|
|
for (n = 0; n < num_a_vectors; n++)
|
|
{
|
|
volk_gnsssdr_free(in_a[n]);
|
|
}
|
|
volk_gnsssdr_free(in_a);
|
|
}
|
|
#endif // Generic
|
|
|
|
#ifdef LV_HAVE_GENERIC
|
|
static inline void volk_gnsssdr_32fc_32f_high_dynamic_rotator_dotprodxnpuppet_32fc_generic_arg(lv_32fc_t* result, const lv_32fc_t* local_code, const float* in, unsigned int num_points)
|
|
{
|
|
// phases must be normalized. Phase rotator expects a complex exponential input!
|
|
float rem_carrier_phase_in_rad = 0.25;
|
|
float phase_step_rad = 0.1;
|
|
lv_32fc_t phase[1];
|
|
phase[0] = lv_cmake(cosf(rem_carrier_phase_in_rad), sinf(rem_carrier_phase_in_rad));
|
|
lv_32fc_t phase_inc[1];
|
|
phase_inc[0] = lv_cmake(cosf(phase_step_rad), sinf(phase_step_rad));
|
|
lv_32fc_t phase_inc_rate[1];
|
|
phase_inc_rate[0] = lv_cmake(cosf(phase_step_rad * 0.001), sinf(phase_step_rad * 0.001));
|
|
int n;
|
|
int num_a_vectors = 3;
|
|
float** in_a = (float**)volk_gnsssdr_malloc(sizeof(float*) * num_a_vectors, volk_gnsssdr_get_alignment());
|
|
for (n = 0; n < num_a_vectors; n++)
|
|
{
|
|
in_a[n] = (float*)volk_gnsssdr_malloc(sizeof(float) * num_points, volk_gnsssdr_get_alignment());
|
|
memcpy((float*)in_a[n], (float*)in, sizeof(float) * num_points);
|
|
}
|
|
|
|
volk_gnsssdr_32fc_32f_high_dynamic_rotator_dot_prod_32fc_xn_generic_arg(result, local_code, phase_inc[0], phase_inc_rate[0], phase, (const float**)in_a, num_a_vectors, num_points);
|
|
|
|
for (n = 0; n < num_a_vectors; n++)
|
|
{
|
|
volk_gnsssdr_free(in_a[n]);
|
|
}
|
|
volk_gnsssdr_free(in_a);
|
|
}
|
|
#endif // Generic
|
|
|
|
#endif // INCLUDED_volk_gnsssdr_32fc_32f_high_dynamic_rotator_dotprodxnpuppet_32fc_H
|