mirror of
https://github.com/gnss-sdr/gnss-sdr
synced 2025-05-07 18:04:13 +00:00
53 lines
1.6 KiB
C++
53 lines
1.6 KiB
C++
/*!
|
|
* \file vtl_data.c
|
|
* \brief Class that exchange information to and from the Vector Tracking Loop (VTL) Kalman filter engine
|
|
* \author Javier Arribas, 2022. jarribas(at)cttc.es
|
|
*
|
|
* -----------------------------------------------------------------------------
|
|
*
|
|
* GNSS-SDR is a Global Navigation Satellite System software-defined receiver.
|
|
* This file is part of GNSS-SDR.
|
|
*
|
|
* Copyright (C) 2010-2022 (see AUTHORS file for a list of contributors)
|
|
* SPDX-License-Identifier: GPL-3.0-or-later
|
|
*
|
|
* -----------------------------------------------------------------------------
|
|
*/
|
|
|
|
|
|
#include "vtl_data.h"
|
|
|
|
Vtl_Data::Vtl_Data()
|
|
{
|
|
epoch_tow_s = 0;
|
|
sample_counter = 0;
|
|
}
|
|
|
|
void Vtl_Data::init_storage(int n_sats)
|
|
{
|
|
sat_p = arma::mat(n_sats, 3);
|
|
sat_v = arma::mat(n_sats, 3);
|
|
sat_dts = arma::mat(n_sats, 2);
|
|
sat_var = arma::vec(n_sats);
|
|
sat_health_flag = arma::vec(n_sats);
|
|
pr_m = arma::vec(n_sats);
|
|
doppler_hz = arma::vec(n_sats);
|
|
carrier_phase_rads = arma::vec(n_sats);
|
|
epoch_tow_s = 0;
|
|
sample_counter = 0;
|
|
}
|
|
|
|
void Vtl_Data::debug_print()
|
|
{
|
|
std::cout << "vtl_data debug print at RX TOW: " << epoch_tow_s << ", TRK sample counter: " << sample_counter << "\n";
|
|
sat_p.print("VTL Sat Positions");
|
|
sat_v.print("VTL Sat Velocities");
|
|
sat_dts.print("VTL Sat clocks");
|
|
sat_var.print("VTL Sat clock variances");
|
|
sat_health_flag.print("VTL Sat health");
|
|
|
|
pr_m.print("Satellite Code pseudoranges [m]");
|
|
doppler_hz.print("satellite Carrier Dopplers [Hz]");
|
|
carrier_phase_rads.print("satellite accumulated carrier phases [rads]");
|
|
}
|