2018-05-22 10:25:14 +00:00
/*!
2019-02-26 18:30:08 +00:00
* \ file galileo_e1_dll_pll_veml_tracking_fpga . cc
2018-05-22 10:25:14 +00:00
* \ brief Adapts a DLL + PLL VEML ( Very Early Minus Late ) tracking loop block
2019-02-26 18:30:08 +00:00
* to a TrackingInterface for Galileo E1 signals for the FPGA
* \ author Marc Majoral , 2019. mmajoral ( at ) cttc . cat
2018-05-22 10:25:14 +00:00
*
* Code DLL + carrier PLL according to the algorithms described in :
* K . Borre , D . M . Akos , N . Bertelsen , P . Rinder , and S . H . Jensen ,
* A Software - Defined GPS and Galileo Receiver . A Single - Frequency
* Approach , Birkhauser , 2007
*
2020-07-28 14:57:15 +00:00
* - - - - - - - - - - - - - - - - - - - - - - - - - - - - - - - - - - - - - - - - - - - - - - - - - - - - - - - - - - - - - - - - - - - - - - - - - - - - -
2018-05-22 10:25:14 +00:00
*
2020-12-30 12:35:06 +00:00
* GNSS - SDR is a Global Navigation Satellite System software - defined receiver .
2018-05-22 10:25:14 +00:00
* This file is part of GNSS - SDR .
*
2020-12-30 12:35:06 +00:00
* Copyright ( C ) 2010 - 2020 ( see AUTHORS file for a list of contributors )
2020-02-08 00:20:02 +00:00
* SPDX - License - Identifier : GPL - 3.0 - or - later
2018-05-22 10:25:14 +00:00
*
2020-07-28 14:57:15 +00:00
* - - - - - - - - - - - - - - - - - - - - - - - - - - - - - - - - - - - - - - - - - - - - - - - - - - - - - - - - - - - - - - - - - - - - - - - - - - - - -
2018-05-22 10:25:14 +00:00
*/
# include "galileo_e1_dll_pll_veml_tracking_fpga.h"
# include "Galileo_E1.h"
2018-12-09 21:00:09 +00:00
# include "configuration_interface.h"
# include "display.h"
2019-03-06 13:36:51 +00:00
# include "dll_pll_conf_fpga.h"
2020-11-07 21:43:19 +00:00
# include "galileo_e1_signal_replica.h"
2018-05-22 10:25:14 +00:00
# include "gnss_sdr_flags.h"
2020-11-27 09:51:06 +00:00
# include "uio_fpga.h"
2019-10-27 20:34:19 +00:00
# include <volk_gnsssdr/volk_gnsssdr_alloc.h>
2022-06-13 19:05:29 +00:00
# include <algorithm>
2019-07-14 12:09:12 +00:00
# include <array>
2018-05-22 10:25:14 +00:00
2024-04-29 06:27:33 +00:00
# if USE_GLOG_AND_GFLAGS
# include <glog/logging.h>
# else
# include <absl/log/log.h>
# endif
2018-05-22 10:25:14 +00:00
GalileoE1DllPllVemlTrackingFpga : : GalileoE1DllPllVemlTrackingFpga (
2022-12-08 16:39:16 +00:00
const ConfigurationInterface * configuration ,
const std : : string & role ,
unsigned int in_streams ,
unsigned int out_streams )
: role_ ( role ) ,
data_codes_ptr_ ( nullptr ) ,
channel_ ( 0 ) ,
in_streams_ ( in_streams ) ,
out_streams_ ( out_streams )
2018-05-22 10:25:14 +00:00
{
2020-02-19 23:07:03 +00:00
Dll_Pll_Conf_Fpga trk_params_fpga = Dll_Pll_Conf_Fpga ( ) ;
2022-12-08 16:39:16 +00:00
trk_params_fpga . SetFromConfiguration ( configuration , role_ ) ;
2019-03-28 11:30:57 +00:00
2020-02-19 23:07:03 +00:00
if ( trk_params_fpga . extend_correlation_symbols < 1 )
2019-03-28 11:30:57 +00:00
{
2020-02-19 23:07:03 +00:00
trk_params_fpga . extend_correlation_symbols = 1 ;
2020-07-07 16:53:50 +00:00
std : : cout < < TEXT_RED < < " WARNING: Galileo E1. extend_correlation_symbols must be bigger than 0. Coherent integration has been set to 1 symbol (4 ms) " < < TEXT_RESET < < ' \n ' ;
2018-05-22 10:25:14 +00:00
}
2020-02-19 23:07:03 +00:00
else if ( ! trk_params_fpga . track_pilot and trk_params_fpga . extend_correlation_symbols > 1 )
2018-05-22 10:25:14 +00:00
{
2020-02-19 23:07:03 +00:00
trk_params_fpga . extend_correlation_symbols = 1 ;
2020-07-07 16:53:50 +00:00
std : : cout < < TEXT_RED < < " WARNING: Galileo E1. Extended coherent integration is not allowed when tracking the data component. Coherent integration has been set to 4 ms (1 symbol) " < < TEXT_RESET < < ' \n ' ;
2018-05-22 10:25:14 +00:00
}
2020-02-19 23:07:03 +00:00
if ( ( trk_params_fpga . extend_correlation_symbols > 1 ) and ( trk_params_fpga . pll_bw_narrow_hz > trk_params_fpga . pll_bw_hz or trk_params_fpga . dll_bw_narrow_hz > trk_params_fpga . dll_bw_hz ) )
2018-05-22 10:25:14 +00:00
{
2020-07-07 16:53:50 +00:00
std : : cout < < TEXT_RED < < " WARNING: Galileo E1. PLL or DLL narrow tracking bandwidth is higher than wide tracking one " < < TEXT_RESET < < ' \n ' ;
2018-05-22 10:25:14 +00:00
}
2022-12-08 16:39:16 +00:00
track_pilot_ = trk_params_fpga . track_pilot ;
2020-07-17 08:48:37 +00:00
const auto vector_length = static_cast < int32_t > ( std : : round ( trk_params_fpga . fs_in / ( GALILEO_E1_CODE_CHIP_RATE_CPS / GALILEO_E1_B_CODE_LENGTH_CHIPS ) ) ) ;
2020-02-19 23:07:03 +00:00
trk_params_fpga . vector_length = vector_length ;
trk_params_fpga . system = ' E ' ;
2022-12-08 16:39:16 +00:00
const std : : array < char , 3 > sig { ' 1 ' , ' B ' , ' \0 ' } ;
std : : copy_n ( sig . data ( ) , 3 , trk_params_fpga . signal ) ;
2019-09-16 15:29:18 +00:00
2020-11-27 09:51:06 +00:00
// UIO device file
2022-12-08 16:39:16 +00:00
device_name_ = configuration - > property ( role_ + " .devicename " , default_device_name_Galileo_E1 ) ;
2020-11-27 09:51:06 +00:00
2019-10-02 13:53:57 +00:00
// compute the number of tracking channels that have already been instantiated. The order in which
// GNSS-SDR instantiates the tracking channels i L1, L2, L5, E1, E5a
2021-02-10 17:43:11 +00:00
uint32_t num_prev_assigned_ch_1C = 0 ;
std : : string device_io_name ;
2021-02-11 12:37:32 +00:00
if ( configuration - > property ( " Tracking_1C.devicename " , default_device_name_GPS_L1 ) = = default_device_name_GPS_L1 )
2021-02-10 17:43:11 +00:00
{
2021-02-11 12:45:55 +00:00
for ( uint32_t k = 0 ; k < configuration - > property ( " Channels_1C.count " , 0U ) ; k + + )
2021-02-10 17:43:11 +00:00
{
2021-05-18 10:25:15 +00:00
if ( find_uio_dev_file_name ( device_io_name , default_device_name_GPS_L1 , k ) = = 0 )
2021-02-10 17:43:11 +00:00
{
num_prev_assigned_ch_1C = num_prev_assigned_ch_1C + 1 ;
}
}
}
else
{
2022-12-08 16:39:16 +00:00
if ( configuration - > property ( " Tracking_1C.devicename " , std : : string ( " " ) ) ! = device_name_ )
2021-02-10 17:43:11 +00:00
{
num_prev_assigned_ch_1C = configuration - > property ( " Channels_1C.count " , 0 ) ;
}
}
uint32_t num_prev_assigned_ch_2S = configuration - > property ( " Channels_2S.count " , 0 ) ;
uint32_t num_prev_assigned_ch_L5 = configuration - > property ( " Channels_L5.count " , 0 ) ;
2022-12-08 16:39:16 +00:00
num_prev_assigned_ch_ = num_prev_assigned_ch_1C + num_prev_assigned_ch_2S + num_prev_assigned_ch_L5 ;
2018-05-22 10:25:14 +00:00
2020-02-19 23:07:03 +00:00
// ################# PRE-COMPUTE ALL THE CODES #################
2019-02-27 13:37:07 +00:00
uint32_t code_samples_per_chip = 2 ;
2022-12-08 16:39:16 +00:00
prn_codes_ptr_ = static_cast < int32_t * > ( volk_gnsssdr_malloc ( static_cast < int32_t > ( GALILEO_E1_B_CODE_LENGTH_CHIPS ) * code_samples_per_chip * GALILEO_E1_NUMBER_OF_CODES * sizeof ( int32_t ) , volk_gnsssdr_get_alignment ( ) ) ) ;
2019-10-27 20:34:19 +00:00
volk_gnsssdr : : vector < float > ca_codes_f ( static_cast < uint32_t > ( GALILEO_E1_B_CODE_LENGTH_CHIPS ) * code_samples_per_chip ) ;
volk_gnsssdr : : vector < float > data_codes_f ;
2018-05-22 10:25:14 +00:00
2022-12-08 16:39:16 +00:00
if ( track_pilot_ )
2018-08-01 13:55:40 +00:00
{
2022-12-08 16:39:16 +00:00
data_codes_ptr_ = static_cast < int32_t * > ( volk_gnsssdr_malloc ( ( static_cast < uint32_t > ( GALILEO_E1_B_CODE_LENGTH_CHIPS ) ) * code_samples_per_chip * GALILEO_E1_NUMBER_OF_CODES * sizeof ( int32_t ) , volk_gnsssdr_get_alignment ( ) ) ) ;
2019-10-27 20:34:19 +00:00
data_codes_f . resize ( static_cast < uint32_t > ( GALILEO_E1_B_CODE_LENGTH_CHIPS ) * code_samples_per_chip , 0.0 ) ;
2018-08-01 13:55:40 +00:00
}
2019-02-27 13:37:07 +00:00
for ( uint32_t PRN = 1 ; PRN < = GALILEO_E1_NUMBER_OF_CODES ; PRN + + )
2018-05-22 10:25:14 +00:00
{
2019-06-28 23:28:30 +00:00
std : : array < char , 3 > data_signal = { ' 1 ' , ' B ' , ' \0 ' } ;
2022-12-08 16:39:16 +00:00
if ( track_pilot_ )
2018-05-22 10:25:14 +00:00
{
2019-06-28 23:28:30 +00:00
std : : array < char , 3 > pilot_signal = { ' 1 ' , ' C ' , ' \0 ' } ;
2019-10-27 20:34:19 +00:00
galileo_e1_code_gen_sinboc11_float ( ca_codes_f , pilot_signal , PRN ) ;
galileo_e1_code_gen_sinboc11_float ( data_codes_f , data_signal , PRN ) ;
2018-05-22 10:25:14 +00:00
2019-04-02 16:46:37 +00:00
// The code is generated as a series of 1s and -1s. In order to store the values using only one bit, a -1 is stored as a 0 in the FPGA
2019-02-27 13:37:07 +00:00
for ( uint32_t s = 0 ; s < 2 * GALILEO_E1_B_CODE_LENGTH_CHIPS ; s + + )
2018-05-22 10:25:14 +00:00
{
2019-06-30 10:09:11 +00:00
auto tmp_value = static_cast < int32_t > ( ca_codes_f [ s ] ) ;
2019-04-02 16:46:37 +00:00
if ( tmp_value < 0 )
{
tmp_value = 0 ;
}
2019-04-02 18:36:48 +00:00
tmp_value = tmp_value | LOCAL_CODE_FPGA_ENABLE_WRITE_MEMORY ;
2022-12-08 16:39:16 +00:00
prn_codes_ptr_ [ static_cast < int32_t > ( GALILEO_E1_B_CODE_LENGTH_CHIPS ) * 2 * ( PRN - 1 ) + s ] = tmp_value ;
2019-04-02 16:46:37 +00:00
tmp_value = static_cast < int32_t > ( data_codes_f [ s ] ) ;
if ( tmp_value < 0 )
{
tmp_value = 0 ;
}
2019-04-02 18:36:48 +00:00
tmp_value = tmp_value | LOCAL_CODE_FPGA_ENABLE_WRITE_MEMORY | LOCAL_CODE_FPGA_CORRELATOR_SELECT_COUNT ;
2022-12-08 16:39:16 +00:00
data_codes_ptr_ [ static_cast < int32_t > ( GALILEO_E1_B_CODE_LENGTH_CHIPS ) * 2 * ( PRN - 1 ) + s ] = tmp_value ;
2018-05-22 10:25:14 +00:00
}
}
else
{
2019-10-27 20:34:19 +00:00
galileo_e1_code_gen_sinboc11_float ( ca_codes_f , data_signal , PRN ) ;
2018-05-22 10:25:14 +00:00
2019-04-02 16:46:37 +00:00
// The code is generated as a series of 1s and -1s. In order to store the values using only one bit, a -1 is stored as a 0 in the FPGA
2019-02-27 13:37:07 +00:00
for ( uint32_t s = 0 ; s < 2 * GALILEO_E1_B_CODE_LENGTH_CHIPS ; s + + )
2018-05-22 10:25:14 +00:00
{
2019-06-30 10:09:11 +00:00
auto tmp_value = static_cast < int32_t > ( ca_codes_f [ s ] ) ;
2019-04-02 16:46:37 +00:00
if ( tmp_value < 0 )
{
tmp_value = 0 ;
}
2019-04-02 18:36:48 +00:00
tmp_value = tmp_value | LOCAL_CODE_FPGA_ENABLE_WRITE_MEMORY ;
2022-12-08 16:39:16 +00:00
prn_codes_ptr_ [ static_cast < int32_t > ( GALILEO_E1_B_CODE_LENGTH_CHIPS ) * 2 * ( PRN - 1 ) + s ] = tmp_value ;
2018-05-22 10:25:14 +00:00
}
}
}
2022-12-08 16:39:16 +00:00
trk_params_fpga . ca_codes = prn_codes_ptr_ ;
trk_params_fpga . data_codes = data_codes_ptr_ ;
2020-02-19 23:07:03 +00:00
trk_params_fpga . code_length_chips = GALILEO_E1_B_CODE_LENGTH_CHIPS ;
trk_params_fpga . code_samples_per_chip = code_samples_per_chip ; // 2 sample per chip
trk_params_fpga . extended_correlation_in_fpga = false ;
trk_params_fpga . extend_fpga_integration_periods = 1 ; // (number of FPGA integrations that are combined in the SW)
trk_params_fpga . fpga_integration_period = 1 ; // (number of symbols that are effectively integrated in the FPGA)
2019-08-28 14:19:36 +00:00
2020-02-19 23:07:03 +00:00
// ################# MAKE TRACKING GNU Radio object ###################
2022-12-08 16:39:16 +00:00
DLOG ( INFO ) < < " role " < < role_ ;
tracking_fpga_sc_sptr_ = dll_pll_veml_make_tracking_fpga ( trk_params_fpga ) ;
DLOG ( INFO ) < < " tracking( " < < tracking_fpga_sc_sptr_ - > unique_id ( ) < < " ) " ;
2019-08-13 19:26:36 +00:00
if ( in_streams_ > 1 )
{
LOG ( ERROR ) < < " This implementation only supports one input stream " ;
}
if ( out_streams_ > 1 )
{
LOG ( ERROR ) < < " This implementation only supports one output stream " ;
}
2018-05-22 10:25:14 +00:00
}
GalileoE1DllPllVemlTrackingFpga : : ~ GalileoE1DllPllVemlTrackingFpga ( )
{
2022-12-08 16:39:16 +00:00
volk_gnsssdr_free ( prn_codes_ptr_ ) ;
if ( track_pilot_ )
2018-08-01 13:55:40 +00:00
{
2022-12-08 16:39:16 +00:00
volk_gnsssdr_free ( data_codes_ptr_ ) ;
2018-08-01 13:55:40 +00:00
}
}
2018-05-22 10:25:14 +00:00
2019-03-01 09:11:36 +00:00
2019-03-01 14:29:43 +00:00
void GalileoE1DllPllVemlTrackingFpga : : stop_tracking ( )
{
2022-12-08 16:39:16 +00:00
tracking_fpga_sc_sptr_ - > stop_tracking ( ) ;
2019-03-01 14:29:43 +00:00
}
2018-05-22 10:25:14 +00:00
void GalileoE1DllPllVemlTrackingFpga : : start_tracking ( )
{
2022-12-08 16:39:16 +00:00
tracking_fpga_sc_sptr_ - > start_tracking ( ) ;
2018-05-22 10:25:14 +00:00
}
/*
* Set tracking channel unique ID
*/
void GalileoE1DllPllVemlTrackingFpga : : set_channel ( unsigned int channel )
{
channel_ = channel ;
2020-11-27 09:51:06 +00:00
// UIO device file
std : : string device_io_name ;
2020-11-27 11:21:10 +00:00
// find the uio device file corresponding to the tracking multicorrelator
2022-12-08 16:39:16 +00:00
if ( find_uio_dev_file_name ( device_io_name , device_name_ , channel_ - num_prev_assigned_ch_ ) < 0 )
2020-11-27 09:51:06 +00:00
{
2022-12-08 16:39:16 +00:00
std : : cout < < " Cannot find the FPGA uio device file corresponding to device name " < < device_name_ < < std : : endl ;
2020-11-27 09:51:06 +00:00
throw std : : exception ( ) ;
}
2022-12-08 16:39:16 +00:00
tracking_fpga_sc_sptr_ - > set_channel ( channel_ , device_io_name ) ;
2018-05-22 10:25:14 +00:00
}
void GalileoE1DllPllVemlTrackingFpga : : set_gnss_synchro ( Gnss_Synchro * p_gnss_synchro )
{
2022-12-08 16:39:16 +00:00
tracking_fpga_sc_sptr_ - > set_gnss_synchro ( p_gnss_synchro ) ;
2018-05-22 10:25:14 +00:00
}
void GalileoE1DllPllVemlTrackingFpga : : connect ( gr : : top_block_sptr top_block )
{
if ( top_block )
{ /* top_block is not null */
} ;
2019-03-01 09:11:36 +00:00
// nothing to connect, now the tracking uses gr_sync_decimator
2018-05-22 10:25:14 +00:00
}
void GalileoE1DllPllVemlTrackingFpga : : disconnect ( gr : : top_block_sptr top_block )
{
if ( top_block )
{ /* top_block is not null */
} ;
2019-03-01 09:11:36 +00:00
// nothing to disconnect, now the tracking uses gr_sync_decimator
2018-05-22 10:25:14 +00:00
}
gr : : basic_block_sptr GalileoE1DllPllVemlTrackingFpga : : get_left_block ( )
{
2022-12-08 16:39:16 +00:00
return tracking_fpga_sc_sptr_ ;
2018-05-22 10:25:14 +00:00
}
gr : : basic_block_sptr GalileoE1DllPllVemlTrackingFpga : : get_right_block ( )
{
2022-12-08 16:39:16 +00:00
return tracking_fpga_sc_sptr_ ;
2018-05-22 10:25:14 +00:00
}