2018-03-02 16:40:13 +00:00
/*!
2018-05-22 10:25:14 +00:00
* \ file gps_l1_ca_dll_pll_tracking_fpga . cc
2018-03-02 16:40:13 +00:00
* \ brief Implementation of an adapter of a DLL + PLL tracking loop block
2019-02-26 18:30:08 +00:00
* for GPS L1 C / A to a TrackingInterface for the FPGA
* \ author Marc Majoral , 2019 , mmajoral ( at ) cttc . es
2018-03-02 16:40:13 +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
*
* - - - - - - - - - - - - - - - - - - - - - - - - - - - - - - - - - - - - - - - - - - - - - - - - - - - - - - - - - - - - - - - - - - - - - - - - -
*
2019-02-26 18:30:08 +00:00
* Copyright ( C ) 2010 - 2019 ( see AUTHORS file for a list of contributors )
2018-03-02 16:40:13 +00:00
*
* GNSS - SDR is a software defined Global Navigation
* Satellite Systems receiver
*
* This file is part of GNSS - SDR .
*
2020-02-08 00:20:02 +00:00
* SPDX - License - Identifier : GPL - 3.0 - or - later
2018-03-02 16:40:13 +00:00
*
* - - - - - - - - - - - - - - - - - - - - - - - - - - - - - - - - - - - - - - - - - - - - - - - - - - - - - - - - - - - - - - - - - - - - - - - - -
*/
2018-05-03 08:38:21 +00:00
# include "gps_l1_ca_dll_pll_tracking_fpga.h"
# include "GPS_L1_CA.h"
2018-12-09 21:00:09 +00:00
# include "configuration_interface.h"
2018-05-03 08:38:21 +00:00
# include "display.h"
2019-03-06 13:36:51 +00:00
# include "dll_pll_conf_fpga.h"
2018-12-09 21:00:09 +00:00
# include "gnss_sdr_flags.h"
# include "gps_sdr_signal_processing.h"
# include <glog/logging.h>
2019-03-02 23:15:20 +00:00
# include <volk_gnsssdr/volk_gnsssdr.h>
2019-07-14 12:09:12 +00:00
# include <array>
2018-05-03 08:38:21 +00:00
2018-03-02 16:40:13 +00:00
GpsL1CaDllPllTrackingFpga : : GpsL1CaDllPllTrackingFpga (
2020-06-29 07:07:41 +00:00
const ConfigurationInterface * configuration , const std : : string & role ,
2018-10-28 10:07:53 +00:00
unsigned int in_streams , unsigned int out_streams ) : role_ ( role ) , in_streams_ ( in_streams ) , out_streams_ ( out_streams )
2018-03-02 16:40:13 +00:00
{
2020-02-19 23:07:03 +00:00
Dll_Pll_Conf_Fpga trk_params_fpga = Dll_Pll_Conf_Fpga ( ) ;
2018-03-02 16:40:13 +00:00
DLOG ( INFO ) < < " role " < < role ;
2020-02-19 23:07:03 +00:00
trk_params_fpga . SetFromConfiguration ( configuration , role ) ;
2019-03-28 11:30:57 +00:00
2020-07-09 22:37:55 +00:00
auto vector_length = static_cast < int32_t > ( std : : round ( trk_params_fpga . fs_in / ( GPS_L1_CA_CODE_RATE_CPS / GPS_L1_CA_CODE_LENGTH_CHIPS ) ) ) ;
2020-02-19 23:07:03 +00:00
trk_params_fpga . vector_length = vector_length ;
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: GPS L1 C/A. extend_correlation_symbols must be bigger than 1. Coherent integration has been set to 1 symbol (1 ms) " < < TEXT_RESET < < ' \n ' ;
2018-03-02 16:40:13 +00:00
}
2020-02-19 23:07:03 +00:00
else if ( trk_params_fpga . extend_correlation_symbols > GPS_CA_BIT_DURATION_MS )
2018-03-02 16:40:13 +00:00
{
2020-02-19 23:07:03 +00:00
trk_params_fpga . extend_correlation_symbols = GPS_CA_BIT_DURATION_MS ;
2020-07-07 16:53:50 +00:00
std : : cout < < TEXT_RED < < " WARNING: GPS L1 C/A. extend_correlation_symbols must be lower than 21. Coherent integration has been set to 20 symbols (20 ms) " < < TEXT_RESET < < ' \n ' ;
2018-05-03 08:38:21 +00:00
}
2020-02-19 23:07:03 +00:00
trk_params_fpga . track_pilot = configuration - > property ( role + " .track_pilot " , false ) ;
if ( trk_params_fpga . track_pilot )
2018-05-03 08:38:21 +00:00
{
2020-02-19 23:07:03 +00:00
trk_params_fpga . track_pilot = false ;
2020-07-07 16:53:50 +00:00
std : : cout < < TEXT_RED < < " WARNING: GPS L1 C/A does not have pilot signal. Data tracking has been enabled " < < TEXT_RESET < < ' \n ' ;
2018-05-03 08:38:21 +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-03 08:38:21 +00:00
{
2020-07-07 16:53:50 +00:00
std : : cout < < TEXT_RED < < " WARNING: GPS L1 C/A. PLL or DLL narrow tracking bandwidth is higher than wide tracking one " < < TEXT_RESET < < ' \n ' ;
2018-03-02 16:40:13 +00:00
}
2020-02-19 23:07:03 +00:00
trk_params_fpga . system = ' G ' ;
2019-07-14 12:09:12 +00:00
std : : array < char , 3 > sig_ { ' 1 ' , ' C ' , ' \0 ' } ;
2020-02-19 23:07:03 +00:00
std : : memcpy ( trk_params_fpga . signal , sig_ . data ( ) , 3 ) ;
2019-09-16 15:29:18 +00:00
2018-05-03 08:38:21 +00:00
// FPGA configuration parameters
2019-10-03 13:26:58 +00:00
// obtain the number of the first uio device corresponding to a HW accelerator in the FPGA
// that can be assigned to the tracking of the L1 signal
2020-02-19 23:07:03 +00:00
trk_params_fpga . dev_file_num = configuration - > property ( role + " .dev_file_num " , 3 ) ;
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
2020-02-19 23:07:03 +00:00
trk_params_fpga . num_prev_assigned_ch = 0 ;
2018-05-03 08:38:21 +00:00
2019-07-28 10:01:11 +00:00
// ################# PRE-COMPUTE ALL THE CODES #################
2019-02-27 13:37:07 +00:00
d_ca_codes = static_cast < int32_t * > ( volk_gnsssdr_malloc ( static_cast < int32_t > ( GPS_L1_CA_CODE_LENGTH_CHIPS * NUM_PRNs ) * sizeof ( int32_t ) , volk_gnsssdr_get_alignment ( ) ) ) ;
for ( uint32_t PRN = 1 ; PRN < = NUM_PRNs ; PRN + + )
2018-10-28 10:07:53 +00:00
{
2020-05-07 21:11:11 +00:00
gps_l1_ca_code_gen_int ( own : : span < int32_t > ( & d_ca_codes [ static_cast < int32_t > ( GPS_L1_CA_CODE_LENGTH_CHIPS ) * ( PRN - 1 ) ] , & d_ca_codes [ static_cast < int32_t > ( GPS_L1_CA_CODE_LENGTH_CHIPS ) * ( PRN ) ] ) , PRN , 0 ) ;
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
for ( uint32_t k = 0 ; k < GPS_L1_CA_CODE_LENGTH_CHIPS ; k + + )
{
2019-04-02 18:36:48 +00:00
int32_t tmp_value = d_ca_codes [ ( int32_t ( GPS_L1_CA_CODE_LENGTH_CHIPS ) ) * ( PRN - 1 ) + k ] ;
if ( tmp_value < 0 )
2019-04-02 16:46:37 +00:00
{
2019-04-02 18:36:48 +00:00
tmp_value = 0 ;
2019-04-02 16:46:37 +00:00
}
2019-04-02 18:36:48 +00:00
tmp_value = tmp_value | LOCAL_CODE_FPGA_ENABLE_WRITE_MEMORY ;
d_ca_codes [ ( int32_t ( GPS_L1_CA_CODE_LENGTH_CHIPS ) ) * ( PRN - 1 ) + k ] = tmp_value ;
2019-04-02 16:46:37 +00:00
}
2018-10-28 10:07:53 +00:00
}
2020-02-19 23:07:03 +00:00
trk_params_fpga . ca_codes = d_ca_codes ;
trk_params_fpga . code_length_chips = GPS_L1_CA_CODE_LENGTH_CHIPS ;
trk_params_fpga . code_samples_per_chip = 1 ; // 1 sample per chip
2019-06-28 08:54:19 +00:00
2020-02-19 23:07:03 +00:00
trk_params_fpga . extended_correlation_in_fpga = false ; // by default
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)
if ( trk_params_fpga . extend_correlation_symbols > 1 )
2019-07-19 09:55:53 +00:00
{
2020-02-19 23:07:03 +00:00
if ( trk_params_fpga . extend_correlation_symbols < = GPS_CA_BIT_DURATION_MS )
2019-07-19 09:55:53 +00:00
{
2020-02-19 23:07:03 +00:00
if ( ( GPS_CA_BIT_DURATION_MS % trk_params_fpga . extend_correlation_symbols ) = = 0 )
2019-07-19 09:55:53 +00:00
{
2020-02-19 23:07:03 +00:00
trk_params_fpga . extended_correlation_in_fpga = true ;
trk_params_fpga . fpga_integration_period = trk_params_fpga . extend_correlation_symbols ;
2019-07-19 09:55:53 +00:00
}
}
}
2019-06-28 08:54:19 +00:00
2020-02-19 23:07:03 +00:00
// ################# MAKE TRACKING GNU Radio object ###################
tracking_fpga_sc = dll_pll_veml_make_tracking_fpga ( trk_params_fpga ) ;
2018-03-02 16:40:13 +00:00
channel_ = 0 ;
DLOG ( INFO ) < < " tracking( " < < tracking_fpga_sc - > 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-03-02 16:40:13 +00:00
}
2019-03-02 23:15:20 +00:00
2018-03-02 16:40:13 +00:00
GpsL1CaDllPllTrackingFpga : : ~ GpsL1CaDllPllTrackingFpga ( )
2018-05-03 08:38:21 +00:00
{
2019-07-01 09:03:18 +00:00
volk_gnsssdr_free ( d_ca_codes ) ;
2018-05-03 08:38:21 +00:00
}
2018-03-02 16:40:13 +00:00
2019-03-02 23:15:20 +00:00
2018-03-02 16:40:13 +00:00
void GpsL1CaDllPllTrackingFpga : : start_tracking ( )
{
tracking_fpga_sc - > start_tracking ( ) ;
}
2019-03-02 23:15:20 +00:00
void GpsL1CaDllPllTrackingFpga : : stop_tracking ( )
{
2019-07-18 17:12:17 +00:00
tracking_fpga_sc - > stop_tracking ( ) ;
2019-03-02 23:15:20 +00:00
}
2018-03-02 16:40:13 +00:00
/*
* Set tracking channel unique ID
*/
void GpsL1CaDllPllTrackingFpga : : set_channel ( unsigned int channel )
{
channel_ = channel ;
tracking_fpga_sc - > set_channel ( channel ) ;
}
2019-03-02 23:15:20 +00:00
2018-03-02 16:40:13 +00:00
void GpsL1CaDllPllTrackingFpga : : set_gnss_synchro ( Gnss_Synchro * p_gnss_synchro )
{
tracking_fpga_sc - > set_gnss_synchro ( p_gnss_synchro ) ;
}
2019-03-02 23:15:20 +00:00
2018-03-02 16:40:13 +00:00
void GpsL1CaDllPllTrackingFpga : : connect ( gr : : top_block_sptr top_block )
{
2018-10-28 10:07:53 +00:00
if ( top_block )
{ /* top_block is not null */
} ;
2019-07-28 10:01:11 +00:00
// nothing to connect
2018-03-02 16:40:13 +00:00
}
void GpsL1CaDllPllTrackingFpga : : disconnect ( gr : : top_block_sptr top_block )
{
2018-10-28 10:07:53 +00:00
if ( top_block )
{ /* top_block is not null */
} ;
2019-07-28 10:01:11 +00:00
// nothing to disconnect
2018-03-02 16:40:13 +00:00
}
gr : : basic_block_sptr GpsL1CaDllPllTrackingFpga : : get_left_block ( )
{
return tracking_fpga_sc ;
}
gr : : basic_block_sptr GpsL1CaDllPllTrackingFpga : : get_right_block ( )
{
return tracking_fpga_sc ;
}