1
0
mirror of https://github.com/gnss-sdr/gnss-sdr synced 2024-10-30 06:36:21 +00:00
gnss-sdr/src/utils/rinex2assist/main.cc

434 lines
19 KiB
C++
Raw Normal View History

2018-10-16 15:25:42 +00:00
/*!
* \file main.cc
* \brief converts navigation RINEX files into XML files for Assisted GNSS.
* \author Carles Fernandez-Prades, 2018. cfernandez(at)cttc.cat
*
*
2020-07-28 14:57:15 +00:00
* -----------------------------------------------------------------------------
2018-10-16 15:25:42 +00:00
*
* GNSS-SDR is a Global Navigation Satellite System software-defined receiver.
2018-10-16 15:25:42 +00:00
* 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
2018-10-16 15:25:42 +00:00
*
2020-07-28 14:57:15 +00:00
* -----------------------------------------------------------------------------
2018-10-16 15:25:42 +00:00
*/
2019-03-04 07:12:50 +00:00
#include "galileo_ephemeris.h" // IWYU pragma: keep
#include "galileo_iono.h"
#include "galileo_utc_model.h"
#include "gps_ephemeris.h"
#include "gps_iono.h"
#include "gps_utc_model.h"
2018-10-16 15:25:42 +00:00
#include <boost/archive/xml_oarchive.hpp>
#include <boost/iostreams/copy.hpp>
#include <boost/iostreams/filter/gzip.hpp>
#include <boost/iostreams/filtering_streambuf.hpp>
#include <boost/serialization/map.hpp>
#include <gflags/gflags.h>
#include <gpstk/Rinex3NavData.hpp>
#include <gpstk/Rinex3NavHeader.hpp>
#include <gpstk/Rinex3NavStream.hpp>
2019-03-04 07:12:50 +00:00
#include <cstddef> // for size_t
2018-12-10 21:59:10 +00:00
#include <cstdlib>
#include <iostream>
#if GFLAGS_OLD_NAMESPACE
namespace gflags
{
using namespace google;
}
#endif
2018-10-16 15:25:42 +00:00
int main(int argc, char** argv)
{
const std::string intro_help(
std::string("\n rinex2assist converts navigation RINEX files into XML files for Assisted GNSS\n") +
"Copyright (C) 2018 (see AUTHORS file for a list of contributors)\n" +
"This program comes with ABSOLUTELY NO WARRANTY;\n" +
"See COPYING file to see a copy of the General Public License.\n \n" +
"Usage: \n" +
" rinex2assist <RINEX Nav file input>");
2018-10-16 15:25:42 +00:00
gflags::SetUsageMessage(intro_help);
2018-10-16 15:25:42 +00:00
google::SetVersionString("1.0");
gflags::ParseCommandLineFlags(&argc, &argv, true);
2018-10-16 15:25:42 +00:00
if ((argc != 2))
2018-10-16 15:25:42 +00:00
{
std::cerr << "Usage:\n";
2018-10-16 15:25:42 +00:00
std::cerr << " " << argv[0]
<< " <RINEX Nav file input>"
<< '\n';
gflags::ShutDownCommandLineFlags();
2018-10-16 15:25:42 +00:00
return 1;
}
std::string xml_filename;
// Uncompress if RINEX file is gzipped
std::string rinex_filename(argv[1]);
std::string input_filename = rinex_filename;
std::size_t found = rinex_filename.find_last_of('.');
if (found != std::string::npos)
{
if (rinex_filename.size() >= found + 3)
{
if ((rinex_filename.substr(found + 1, found + 3) == "gz"))
{
std::ifstream file(rinex_filename, std::ios_base::in | std::ios_base::binary);
if (file.fail())
{
std::cerr << "Could not open file " << rinex_filename << '\n';
return 1;
}
boost::iostreams::filtering_streambuf<boost::iostreams::input> in;
try
{
in.push(boost::iostreams::gzip_decompressor());
}
catch (const boost::exception& e)
{
std::cerr << "Could not decompress file " << rinex_filename << '\n';
return 1;
}
in.push(file);
std::string rinex_filename_unzipped = rinex_filename.substr(0, found);
std::ofstream output_file(rinex_filename_unzipped.c_str(), std::ios_base::out | std::ios_base::binary | std::ios_base::trunc);
if (file.fail())
{
std::cerr << "Could not create file " << rinex_filename_unzipped << '\n';
return 1;
}
boost::iostreams::copy(in, output_file);
input_filename = rinex_filename_unzipped;
}
}
if (rinex_filename.size() >= found + 2)
{
if ((rinex_filename.substr(found + 1, found + 2) == "Z"))
{
std::ifstream file(rinex_filename, std::ios_base::in | std::ios_base::binary);
if (file.fail())
2018-11-26 11:04:34 +00:00
{
std::cerr << "Could not open file" << rinex_filename << '\n';
return 1;
}
file.close();
std::string uncompress_executable(UNCOMPRESS_EXECUTABLE);
if (!uncompress_executable.empty())
{
// option k is not always available, so we save a copy of the original file
std::string argum = std::string("/bin/cp " + rinex_filename + " " + rinex_filename + ".aux");
int s1 = std::system(argum.c_str());
std::string argum2 = std::string(uncompress_executable + " -f " + rinex_filename);
int s2 = std::system(argum2.c_str());
std::string argum3 = std::string("/bin/mv " + rinex_filename + +".aux" + " " + rinex_filename);
int s3 = std::system(argum3.c_str());
input_filename = rinex_filename.substr(0, found);
if ((s1 != 0) or (s2 != 0) or (s3 != 0))
{
std::cerr << "Failure uncompressing file.\n";
return 1;
}
}
else
{
std::cerr << "uncompress program not found.\n";
2018-11-26 11:04:34 +00:00
return 1;
}
}
}
}
2018-10-16 15:25:42 +00:00
std::map<int, Gps_Ephemeris> eph_map;
std::map<int, Galileo_Ephemeris> eph_gal_map;
Gps_Utc_Model gps_utc_model;
Gps_Iono gps_iono;
Galileo_Utc_Model gal_utc_model;
Galileo_Iono gal_iono;
2018-10-16 15:25:42 +00:00
int i = 0;
int j = 0;
try
{
// Read nav file
gpstk::Rinex3NavStream rnffs(input_filename.c_str()); // Open navigation data file
2018-10-16 15:25:42 +00:00
gpstk::Rinex3NavData rne;
gpstk::Rinex3NavHeader hdr;
// Read header
2018-10-16 15:25:42 +00:00
rnffs >> hdr;
// Check that it really is a RINEX navigation file
if (hdr.fileType.substr(0, 1) != "N")
2018-10-16 15:25:42 +00:00
{
std::cerr << "This is not a valid RINEX navigation file, or file not found.\n";
std::cerr << "No XML file will be created.\n";
2018-10-16 15:25:42 +00:00
return 1;
}
// Collect UTC parameters from RINEX header
if (hdr.fileSys == "G: (GPS)" || hdr.fileSys == "MIXED")
{
gps_utc_model.valid = (hdr.valid > 2147483648) ? true : false;
gps_utc_model.d_A1 = hdr.mapTimeCorr["GPUT"].A0;
gps_utc_model.d_A0 = hdr.mapTimeCorr["GPUT"].A1;
gps_utc_model.d_t_OT = hdr.mapTimeCorr["GPUT"].refSOW;
gps_utc_model.i_WN_T = hdr.mapTimeCorr["GPUT"].refWeek;
gps_utc_model.d_DeltaT_LS = hdr.leapSeconds;
gps_utc_model.i_WN_LSF = hdr.leapWeek;
gps_utc_model.i_DN = hdr.leapDay;
gps_utc_model.d_DeltaT_LSF = hdr.leapDelta;
// Collect iono parameters from RINEX header
gps_iono.valid = (hdr.mapIonoCorr["GPSA"].param[0] == 0) ? false : true;
gps_iono.d_alpha0 = hdr.mapIonoCorr["GPSA"].param[0];
gps_iono.d_alpha1 = hdr.mapIonoCorr["GPSA"].param[1];
gps_iono.d_alpha2 = hdr.mapIonoCorr["GPSA"].param[2];
gps_iono.d_alpha3 = hdr.mapIonoCorr["GPSA"].param[3];
gps_iono.d_beta0 = hdr.mapIonoCorr["GPSB"].param[0];
gps_iono.d_beta1 = hdr.mapIonoCorr["GPSB"].param[1];
gps_iono.d_beta2 = hdr.mapIonoCorr["GPSB"].param[2];
gps_iono.d_beta3 = hdr.mapIonoCorr["GPSB"].param[3];
}
if (hdr.fileSys == "E: (GAL)" || hdr.fileSys == "MIXED")
{
gal_utc_model.A0_6 = hdr.mapTimeCorr["GAUT"].A0;
gal_utc_model.A1_6 = hdr.mapTimeCorr["GAUT"].A1;
gal_utc_model.Delta_tLS_6 = hdr.leapSeconds;
gal_utc_model.t0t_6 = hdr.mapTimeCorr["GAUT"].refSOW;
gal_utc_model.WNot_6 = hdr.mapTimeCorr["GAUT"].refWeek;
gal_utc_model.WN_LSF_6 = hdr.leapWeek;
gal_utc_model.DN_6 = hdr.leapDay;
gal_utc_model.Delta_tLSF_6 = hdr.leapDelta;
2018-10-19 11:48:21 +00:00
gal_utc_model.flag_utc_model = (hdr.mapTimeCorr["GAUT"].A0 == 0.0);
gal_iono.ai0_5 = hdr.mapIonoCorr["GAL"].param[0];
gal_iono.ai1_5 = hdr.mapIonoCorr["GAL"].param[1];
gal_iono.ai2_5 = hdr.mapIonoCorr["GAL"].param[2];
gal_iono.Region1_flag_5 = false;
gal_iono.Region2_flag_5 = false;
gal_iono.Region3_flag_5 = false;
gal_iono.Region4_flag_5 = false;
gal_iono.Region5_flag_5 = false;
gal_iono.TOW_5 = 0.0;
gal_iono.WN_5 = 0.0;
}
// Read navigation data
2018-10-16 15:25:42 +00:00
while (rnffs >> rne)
{
if (rne.satSys == "G" or rne.satSys.empty())
2018-10-16 15:25:42 +00:00
{
// Fill GPS ephemeris object
2018-10-16 15:25:42 +00:00
Gps_Ephemeris eph;
eph.i_satellite_PRN = rne.PRNID;
eph.d_TOW = rne.xmitTime;
eph.d_IODE_SF2 = rne.IODE;
eph.d_IODE_SF3 = rne.IODE;
eph.d_Crs = rne.Crs;
eph.d_Delta_n = rne.dn;
eph.d_M_0 = rne.M0;
eph.d_Cuc = rne.Cuc;
eph.d_e_eccentricity = rne.ecc;
eph.d_Cus = rne.Cus;
eph.d_sqrt_A = rne.Ahalf;
eph.d_Toe = rne.Toe;
eph.d_Toc = rne.Toc;
eph.d_Cic = rne.Cic;
eph.d_OMEGA0 = rne.OMEGA0;
eph.d_Cis = rne.Cis;
eph.d_i_0 = rne.i0;
eph.d_Crc = rne.Crc;
eph.d_OMEGA = rne.w;
eph.d_OMEGA_DOT = rne.OMEGAdot;
eph.d_IDOT = rne.idot;
eph.i_code_on_L2 = rne.codeflgs; //
2018-10-16 15:25:42 +00:00
eph.i_GPS_week = rne.weeknum;
eph.b_L2_P_data_flag = rne.L2Pdata;
eph.i_SV_accuracy = rne.accuracy;
eph.i_SV_health = rne.health;
eph.d_TGD = rne.Tgd;
eph.d_IODC = rne.IODC;
eph.i_AODO = 0; //
eph.b_fit_interval_flag = (rne.fitint > 4) ? true : false;
2018-10-16 15:25:42 +00:00
eph.d_spare1 = 0.0;
eph.d_spare2 = 0.0;
eph.d_A_f0 = rne.af0;
eph.d_A_f1 = rne.af1;
eph.d_A_f2 = rne.af2;
eph.b_integrity_status_flag = false; //
eph.b_alert_flag = false; //
eph.b_antispoofing_flag = false; //
2018-10-16 15:25:42 +00:00
eph_map[i] = eph;
i++;
}
if (rne.satSys == "E")
2018-10-16 15:25:42 +00:00
{
// Fill Galileo ephemeris object
2018-10-16 15:25:42 +00:00
Galileo_Ephemeris eph;
eph.i_satellite_PRN = rne.PRNID;
eph.M0_1 = rne.M0;
eph.e_1 = rne.ecc;
eph.A_1 = rne.Ahalf;
eph.OMEGA_0_2 = rne.OMEGA0;
eph.i_0_2 = rne.i0;
eph.omega_2 = rne.w;
eph.OMEGA_dot_3 = rne.OMEGAdot;
eph.delta_n_3 = rne.dn;
2018-10-16 15:25:42 +00:00
eph.iDot_2 = rne.idot;
eph.C_uc_3 = rne.Cuc;
eph.C_us_3 = rne.Cus;
eph.C_rc_3 = rne.Crc;
eph.C_rs_3 = rne.Crs;
eph.C_ic_4 = rne.Cic;
eph.C_is_4 = rne.Cis;
eph.t0e_1 = rne.Toe;
eph.t0c_4 = rne.Toc;
eph.af0_4 = rne.af0;
eph.af1_4 = rne.af1;
eph.af2_4 = rne.af2;
2018-11-26 14:03:12 +00:00
eph.WN_5 = rne.weeknum;
2018-10-16 15:25:42 +00:00
eph_gal_map[j] = eph;
j++;
}
}
}
catch (std::exception& e)
{
std::cerr << "Error reading the RINEX file: " << e.what() << '\n';
std::cerr << "No XML file will be created.\n";
gflags::ShutDownCommandLineFlags();
2018-10-16 15:25:42 +00:00
return 1;
}
if (i == 0 and j == 0)
{
std::cerr << "No navigation data found in the RINEX file. No XML file will be created.\n";
gflags::ShutDownCommandLineFlags();
2018-10-16 15:25:42 +00:00
return 1;
}
// Write XML ephemeris
2018-10-16 15:25:42 +00:00
if (i != 0)
{
std::ofstream ofs;
if (xml_filename.empty())
{
2018-10-19 11:48:21 +00:00
xml_filename = "gps_ephemeris.xml";
2018-10-16 15:25:42 +00:00
}
try
{
ofs.open(xml_filename.c_str(), std::ofstream::trunc | std::ofstream::out);
boost::archive::xml_oarchive xml(ofs);
xml << boost::serialization::make_nvp("GNSS-SDR_ephemeris_map", eph_map);
}
catch (std::exception& e)
{
std::cerr << "Problem creating the XML file " << xml_filename << ": " << e.what() << '\n';
gflags::ShutDownCommandLineFlags();
2018-10-16 15:25:42 +00:00
return 1;
}
std::cout << "Generated file: " << xml_filename << '\n';
2018-10-16 15:25:42 +00:00
}
if (j != 0)
{
std::ofstream ofs2;
2018-10-19 11:48:21 +00:00
xml_filename = "gal_ephemeris.xml";
2018-10-16 15:25:42 +00:00
try
{
ofs2.open(xml_filename.c_str(), std::ofstream::trunc | std::ofstream::out);
boost::archive::xml_oarchive xml(ofs2);
2018-10-19 11:48:21 +00:00
xml << boost::serialization::make_nvp("GNSS-SDR_gal_ephemeris_map", eph_gal_map);
2018-10-16 15:25:42 +00:00
}
catch (std::exception& e)
{
std::cerr << "Problem creating the XML file " << xml_filename << ": " << e.what() << '\n';
gflags::ShutDownCommandLineFlags();
return 1;
}
std::cout << "Generated file: " << xml_filename << '\n';
}
// Write XML UTC
if (gps_utc_model.valid)
{
std::ofstream ofs3;
2018-10-19 11:48:21 +00:00
xml_filename = "gps_utc_model.xml";
try
{
ofs3.open(xml_filename.c_str(), std::ofstream::trunc | std::ofstream::out);
boost::archive::xml_oarchive xml(ofs3);
2018-10-19 11:48:21 +00:00
xml << boost::serialization::make_nvp("GNSS-SDR_utc_model", gps_utc_model);
}
catch (std::exception& e)
{
std::cerr << "Problem creating the XML file " << xml_filename << ": " << e.what() << '\n';
gflags::ShutDownCommandLineFlags();
2018-10-16 15:25:42 +00:00
return 1;
}
std::cout << "Generated file: " << xml_filename << '\n';
2018-10-16 15:25:42 +00:00
}
// Write XML iono
if (gps_iono.valid)
{
std::ofstream ofs4;
xml_filename = "gps_iono.xml";
try
{
ofs4.open(xml_filename.c_str(), std::ofstream::trunc | std::ofstream::out);
boost::archive::xml_oarchive xml(ofs4);
2018-10-19 11:48:21 +00:00
xml << boost::serialization::make_nvp("GNSS-SDR_iono_model", gps_iono);
}
catch (std::exception& e)
{
std::cerr << "Problem creating the XML file " << xml_filename << ": " << e.what() << '\n';
gflags::ShutDownCommandLineFlags();
return 1;
}
std::cout << "Generated file: " << xml_filename << '\n';
}
if (gal_utc_model.A0_6 != 0)
{
std::ofstream ofs5;
2018-10-19 11:48:21 +00:00
xml_filename = "gal_utc_model.xml";
try
{
ofs5.open(xml_filename.c_str(), std::ofstream::trunc | std::ofstream::out);
boost::archive::xml_oarchive xml(ofs5);
2018-10-19 11:48:21 +00:00
xml << boost::serialization::make_nvp("GNSS-SDR_gal_utc_model", gal_utc_model);
}
catch (std::exception& e)
{
std::cerr << "Problem creating the XML file " << xml_filename << ": " << e.what() << '\n';
gflags::ShutDownCommandLineFlags();
return 1;
}
std::cout << "Generated file: " << xml_filename << '\n';
}
if (gal_iono.ai0_5 != 0)
{
std::ofstream ofs7;
xml_filename = "gal_iono.xml";
try
{
ofs7.open(xml_filename.c_str(), std::ofstream::trunc | std::ofstream::out);
boost::archive::xml_oarchive xml(ofs7);
2018-10-19 11:48:21 +00:00
xml << boost::serialization::make_nvp("GNSS-SDR_gal_iono_model", gal_iono);
}
catch (std::exception& e)
{
std::cerr << "Problem creating the XML file " << xml_filename << ": " << e.what() << '\n';
gflags::ShutDownCommandLineFlags();
return 1;
}
std::cout << "Generated file: " << xml_filename << '\n';
}
gflags::ShutDownCommandLineFlags();
2018-10-16 15:25:42 +00:00
return 0;
}