1
0
mirror of https://github.com/gnss-sdr/gnss-sdr synced 2025-01-10 01:10:34 +00:00

mod: vtl_engine_get_geodetic

This commit is contained in:
M.A. Gomez 2024-01-19 17:22:50 +01:00
parent ed44787340
commit 0995d0bf30
No known key found for this signature in database
GPG Key ID: AC5DD510219ECB4F
4 changed files with 99 additions and 103 deletions

View File

@ -2197,8 +2197,7 @@ bool Rtklib_Solver::get_PVT(const std::map<int, Gnss_Synchro> &gnss_observables_
}
// VTL (optional) MULTIPLEXED FILE RECORDING - Record results to file
//if (enable_vtl == true)
// if (enable_vtl == true)
try
{
double tmp_double;
@ -2275,14 +2274,15 @@ bool Rtklib_Solver::get_PVT(const std::map<int, Gnss_Synchro> &gnss_observables_
tmp_double = a_var_vec_m[2];
d_vtl_dump_file.write(reinterpret_cast<char *>(&tmp_double), sizeof(double));
// GEO user position Latitude [deg]
tmp_double = this->get_latitude();
// GEO user position Latitude [rad]
vector<double> geo_vec_m = vtl_engine.get_geodetic_rad_m();
tmp_double = geo_vec_m[0];
d_vtl_dump_file.write(reinterpret_cast<char *>(&tmp_double), sizeof(double));
// GEO user position Longitude [deg]
tmp_double = this->get_longitude();
// GEO user position Longitude [rad]
tmp_double = geo_vec_m[1];
d_vtl_dump_file.write(reinterpret_cast<char *>(&tmp_double), sizeof(double));
// GEO user position Height [m]
tmp_double = this->get_height();
tmp_double = geo_vec_m[2];
d_vtl_dump_file.write(reinterpret_cast<char *>(&tmp_double), sizeof(double));
// NUMBER OF VALID SATS

View File

@ -19,5 +19,4 @@
Vtl_Conf::Vtl_Conf()
{
}

View File

@ -15,6 +15,7 @@
*/
#include "vtl_engine.h"
#include "rtklib_rtkcmn.h"
#include "iostream"
#include <fstream>
@ -442,19 +443,17 @@ std::vector<double> Vtl_Engine::get_accel_var_ecef_m_s2()
return temp;
}
double Vtl_Engine::get_latitude()
std::vector<double> Vtl_Engine::get_geodetic_rad_m()
{
return -1.0;
}
std::array<double, 3> temp_ecef = {kf_x[0], kf_x[1], kf_x[2]};
std::array<double, 3> temp_geo = {42, 42, 42};
double Vtl_Engine::get_longitude()
{
return -1.0;
}
ecef2pos(temp_ecef.data(), temp_geo.data());
double Vtl_Engine::get_height()
{
return -1.0;
std::vector<double> dest;
dest.insert(dest.begin(), std::begin(temp_geo), std::end(temp_geo));
return dest;
}
double Vtl_Engine::get_user_clock_offset_s()

View File

@ -53,9 +53,7 @@ public:
std::vector<double> get_position_var_ecef_m(); // get_position_var_ecef_m
std::vector<double> get_velocity_var_ecef_m_s(); // get_velocity_var_ecef_m_s
std::vector<double> get_accel_var_ecef_m_s2(); // get_accel_var_ecef_m_s2
double get_latitude(); // get_latitude
double get_longitude(); // get_longitude
double get_height(); // get_height
std::vector<double> get_geodetic_rad_m(); // get_geodetic_rad_m
double get_user_clock_offset_s(); // get_user_clock_offset_s;
double get_user_clock_offset_drift_s_s(); // get_user_clock_offset_drift_s/s;