2017-08-25 09:42:02 +00:00
|
|
|
/*!
|
|
|
|
* \file nma_printer_test.cc
|
|
|
|
* \brief Implements Unit Tests for the Nmea_Printer class.
|
|
|
|
* \author Carles Fernandez-Prades, 2017. cfernandez(at)cttc.es
|
|
|
|
*
|
2020-07-28 14:57:15 +00:00
|
|
|
* -----------------------------------------------------------------------------
|
2017-08-25 09:42:02 +00:00
|
|
|
*
|
2020-07-28 14:57:15 +00:00
|
|
|
* Copyright (C) 2010-2020 (see AUTHORS file for a list of contributors)
|
2017-08-25 09:42:02 +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
|
2017-08-25 09:42:02 +00:00
|
|
|
*
|
2020-07-28 14:57:15 +00:00
|
|
|
* -----------------------------------------------------------------------------
|
2017-08-25 09:42:02 +00:00
|
|
|
*/
|
|
|
|
|
|
|
|
|
2018-12-09 21:00:09 +00:00
|
|
|
#include "nmea_printer.h"
|
2019-03-04 07:12:50 +00:00
|
|
|
#include "rtklib_rtkpos.h"
|
2019-03-06 17:58:57 +00:00
|
|
|
#include "rtklib_solver.h"
|
2017-08-25 09:42:02 +00:00
|
|
|
#include <fstream>
|
|
|
|
#include <string>
|
|
|
|
|
2020-11-22 10:05:16 +00:00
|
|
|
// clang-format off
|
2019-07-14 00:28:28 +00:00
|
|
|
#if HAS_STD_FILESYSTEM
|
|
|
|
#include <system_error>
|
|
|
|
namespace errorlib = std;
|
|
|
|
#if HAS_STD_FILESYSTEM_EXPERIMENTAL
|
|
|
|
#include <experimental/filesystem>
|
|
|
|
namespace fs = std::experimental::filesystem;
|
|
|
|
#else
|
|
|
|
#include <filesystem>
|
|
|
|
namespace fs = std::filesystem;
|
|
|
|
#endif
|
|
|
|
#else
|
|
|
|
#include <boost/filesystem/operations.hpp> // for create_directories, exists
|
|
|
|
#include <boost/filesystem/path.hpp> // for path, operator<<
|
|
|
|
#include <boost/filesystem/path_traits.hpp> // for filesystem
|
|
|
|
#include <boost/system/error_code.hpp> // for error_code
|
|
|
|
namespace fs = boost::filesystem;
|
|
|
|
namespace errorlib = boost::system;
|
|
|
|
#endif
|
2020-11-22 10:05:16 +00:00
|
|
|
// clang-format on
|
2017-08-25 09:42:02 +00:00
|
|
|
|
2018-05-19 16:00:40 +00:00
|
|
|
class NmeaPrinterTest : public ::testing::Test
|
2017-08-25 09:42:02 +00:00
|
|
|
{
|
2018-05-19 16:00:40 +00:00
|
|
|
protected:
|
|
|
|
NmeaPrinterTest()
|
|
|
|
{
|
|
|
|
this->conf();
|
|
|
|
}
|
2019-02-11 20:13:02 +00:00
|
|
|
~NmeaPrinterTest() = default;
|
2018-05-19 16:00:40 +00:00
|
|
|
void conf();
|
2018-05-07 07:13:45 +00:00
|
|
|
rtk_t rtk;
|
2018-05-19 16:00:40 +00:00
|
|
|
};
|
|
|
|
|
|
|
|
void NmeaPrinterTest::conf()
|
|
|
|
{
|
|
|
|
snrmask_t snrmask = {{}, {{}, {}}};
|
|
|
|
int positioning_mode = 0; // Single
|
|
|
|
int number_of_frequencies = 1;
|
|
|
|
double elevation_mask = 5;
|
|
|
|
int navigation_system = 1; // GPS
|
|
|
|
int integer_ambiguity_resolution_gps = 0;
|
|
|
|
int integer_ambiguity_resolution_glo = 0;
|
|
|
|
int integer_ambiguity_resolution_bds = 0;
|
|
|
|
int outage_reset_ambiguity = 5;
|
|
|
|
int min_lock_to_fix_ambiguity = 0;
|
|
|
|
int iono_model = 0;
|
|
|
|
int trop_model = 0;
|
|
|
|
int dynamics_model = 0;
|
|
|
|
int earth_tide = 0;
|
|
|
|
int number_filter_iter = 1;
|
|
|
|
double code_phase_error_ratio_l1 = 100.0;
|
|
|
|
double code_phase_error_ratio_l2 = 100.0;
|
|
|
|
double code_phase_error_ratio_l5 = 100.0;
|
|
|
|
double carrier_phase_error_factor_a = 0.003;
|
|
|
|
double carrier_phase_error_factor_b = 0.003;
|
|
|
|
double bias_0 = 30.0;
|
|
|
|
double iono_0 = 0.03;
|
|
|
|
double trop_0 = 0.3;
|
|
|
|
double sigma_bias = 1e-4;
|
|
|
|
double sigma_iono = 1e-3;
|
|
|
|
double sigma_trop = 1e-4;
|
|
|
|
double sigma_acch = 1e-1;
|
|
|
|
double sigma_accv = 1e-2;
|
|
|
|
double sigma_pos = 0.0;
|
|
|
|
double min_ratio_to_fix_ambiguity = 3.0;
|
|
|
|
double min_elevation_to_fix_ambiguity = 0.0;
|
|
|
|
double slip_threshold = 0.05;
|
|
|
|
double threshold_reject_innovation = 30.0;
|
|
|
|
double threshold_reject_gdop = 30.0;
|
|
|
|
int sat_PCV = 0;
|
|
|
|
int rec_PCV = 0;
|
|
|
|
int phwindup = 0;
|
|
|
|
int reject_GPS_IIA = 0;
|
|
|
|
int raim_fde = 0;
|
|
|
|
|
2018-05-19 19:35:06 +00:00
|
|
|
prcopt_t rtklib_configuration_options = {
|
2018-05-19 16:00:40 +00:00
|
|
|
positioning_mode, /* positioning mode (PMODE_XXX) see src/algorithms/libs/rtklib/rtklib.h */
|
|
|
|
0, /* solution type (0:forward,1:backward,2:combined) */
|
|
|
|
number_of_frequencies, /* number of frequencies (1:L1, 2:L1+L2, 3:L1+L2+L5)*/
|
|
|
|
navigation_system, /* navigation system */
|
|
|
|
elevation_mask * D2R, /* elevation mask angle (degrees) */
|
|
|
|
snrmask, /* snrmask_t snrmask SNR mask */
|
|
|
|
0, /* satellite ephemeris/clock (EPHOPT_XXX) */
|
|
|
|
integer_ambiguity_resolution_gps, /* AR mode (0:off,1:continuous,2:instantaneous,3:fix and hold,4:ppp-ar) */
|
|
|
|
integer_ambiguity_resolution_glo, /* GLONASS AR mode (0:off,1:on,2:auto cal,3:ext cal) */
|
|
|
|
integer_ambiguity_resolution_bds, /* BeiDou AR mode (0:off,1:on) */
|
|
|
|
outage_reset_ambiguity, /* obs outage count to reset bias */
|
|
|
|
min_lock_to_fix_ambiguity, /* min lock count to fix ambiguity */
|
|
|
|
10, /* min fix count to hold ambiguity */
|
|
|
|
1, /* max iteration to resolve ambiguity */
|
|
|
|
iono_model, /* ionosphere option (IONOOPT_XXX) */
|
|
|
|
trop_model, /* troposphere option (TROPOPT_XXX) */
|
|
|
|
dynamics_model, /* dynamics model (0:none, 1:velocity, 2:accel) */
|
|
|
|
earth_tide, /* earth tide correction (0:off,1:solid,2:solid+otl+pole) */
|
|
|
|
number_filter_iter, /* number of filter iteration */
|
|
|
|
0, /* code smoothing window size (0:none) */
|
|
|
|
0, /* interpolate reference obs (for post mission) */
|
|
|
|
0, /* sbssat_t sbssat SBAS correction options */
|
|
|
|
0, /* sbsion_t sbsion[MAXBAND+1] SBAS satellite selection (0:all) */
|
|
|
|
0, /* rover position for fixed mode */
|
|
|
|
0, /* base position for relative mode */
|
|
|
|
/* 0:pos in prcopt, 1:average of single pos, */
|
|
|
|
/* 2:read from file, 3:rinex header, 4:rtcm pos */
|
|
|
|
{code_phase_error_ratio_l1, code_phase_error_ratio_l2, code_phase_error_ratio_l5}, /* eratio[NFREQ] code/phase error ratio */
|
|
|
|
{100.0, carrier_phase_error_factor_a, carrier_phase_error_factor_b, 0.0, 1.0}, /* err[5]: measurement error factor [0]:reserved, [1-3]:error factor a/b/c of phase (m) , [4]:doppler frequency (hz) */
|
|
|
|
{bias_0, iono_0, trop_0}, /* std[3]: initial-state std [0]bias,[1]iono [2]trop*/
|
|
|
|
{sigma_bias, sigma_iono, sigma_trop, sigma_acch, sigma_accv, sigma_pos}, /* prn[6] process-noise std */
|
|
|
|
5e-12, /* sclkstab: satellite clock stability (sec/sec) */
|
|
|
|
{min_ratio_to_fix_ambiguity, 0.9999, 0.25, 0.1, 0.05, 0.0, 0.0, 0.0}, /* thresar[8]: AR validation threshold */
|
|
|
|
min_elevation_to_fix_ambiguity, /* elevation mask of AR for rising satellite (deg) */
|
|
|
|
0.0, /* elevation mask to hold ambiguity (deg) */
|
|
|
|
slip_threshold, /* slip threshold of geometry-free phase (m) */
|
|
|
|
30.0, /* max difference of time (sec) */
|
|
|
|
threshold_reject_innovation, /* reject threshold of innovation (m) */
|
|
|
|
threshold_reject_gdop, /* reject threshold of gdop */
|
|
|
|
{}, /* double baseline[2] baseline length constraint {const,sigma} (m) */
|
|
|
|
{}, /* double ru[3] rover position for fixed mode {x,y,z} (ecef) (m) */
|
|
|
|
{}, /* double rb[3] base position for relative mode {x,y,z} (ecef) (m) */
|
|
|
|
{"", ""}, /* char anttype[2][MAXANT] antenna types {rover,base} */
|
|
|
|
{{}, {}}, /* double antdel[2][3] antenna delta {{rov_e,rov_n,rov_u},{ref_e,ref_n,ref_u}} */
|
|
|
|
{}, /* pcv_t pcvr[2] receiver antenna parameters {rov,base} */
|
|
|
|
{}, /* unsigned char exsats[MAXSAT] excluded satellites (1:excluded, 2:included) */
|
|
|
|
0, /* max averaging epoches */
|
|
|
|
0, /* initialize by restart */
|
|
|
|
1, /* output single by dgps/float/fix/ppp outage */
|
|
|
|
{"", ""}, /* char rnxopt[2][256] rinex options {rover,base} */
|
|
|
|
{sat_PCV, rec_PCV, phwindup, reject_GPS_IIA, raim_fde}, /* posopt[6] positioning options [0]: satellite and receiver antenna PCV model; [1]: interpolate antenna parameters; [2]: apply phase wind-up correction for PPP modes; [3]: exclude measurements of GPS Block IIA satellites satellite [4]: RAIM FDE (fault detection and exclusion) [5]: handle day-boundary clock jump */
|
|
|
|
0, /* solution sync mode (0:off,1:on) */
|
|
|
|
{{}, {}}, /* odisp[2][6*11] ocean tide loading parameters {rov,base} */
|
|
|
|
{{}, {{}, {}}, {{}, {}}, {}, {}}, /* exterr_t exterr extended receiver error model */
|
|
|
|
0, /* disable L2-AR */
|
|
|
|
{} /* char pppopt[256] ppp option "-GAP_RESION=" default gap to reset iono parameters (ep) */
|
|
|
|
};
|
|
|
|
|
2018-05-07 07:13:45 +00:00
|
|
|
rtkinit(&rtk, &rtklib_configuration_options);
|
2018-05-19 16:00:40 +00:00
|
|
|
}
|
|
|
|
|
|
|
|
|
|
|
|
TEST_F(NmeaPrinterTest, PrintLine)
|
|
|
|
{
|
|
|
|
std::string filename("nmea_test.nmea");
|
2020-07-19 07:39:32 +00:00
|
|
|
std::shared_ptr<Rtklib_Solver> pvt_solution = std::make_shared<Rtklib_Solver>(rtk, 12, "filename", false, false);
|
2017-08-25 09:42:02 +00:00
|
|
|
|
|
|
|
boost::posix_time::ptime pt(boost::gregorian::date(1994, boost::date_time::Nov, 19),
|
2018-11-07 19:33:34 +00:00
|
|
|
boost::posix_time::hours(22) + boost::posix_time::minutes(54) + boost::posix_time::seconds(46));
|
|
|
|
std::time_t tim = (pt - boost::posix_time::ptime(boost::gregorian::date(1970, 1, 1))).total_seconds();
|
|
|
|
gtime_t gtime;
|
|
|
|
gtime.time = tim;
|
|
|
|
gtime.sec = 0.0;
|
|
|
|
|
2019-08-18 23:29:04 +00:00
|
|
|
pvt_solution->pvt_sol.rr[0] = -2282104.0; // 49.27416667;
|
|
|
|
pvt_solution->pvt_sol.rr[1] = -3489369.0; // -123.18533333;
|
2018-11-07 19:33:34 +00:00
|
|
|
pvt_solution->pvt_sol.rr[2] = 4810507.0; // 0
|
|
|
|
pvt_solution->pvt_sol.rr[3] = 0.0;
|
|
|
|
pvt_solution->pvt_sol.rr[4] = 0.0;
|
|
|
|
pvt_solution->pvt_sol.rr[5] = 0.0;
|
|
|
|
pvt_solution->pvt_sol.stat = 1; // SOLQ_FIX
|
|
|
|
pvt_solution->pvt_sol.time = gtime;
|
2017-08-25 09:42:02 +00:00
|
|
|
|
2018-10-27 22:42:28 +00:00
|
|
|
bool flag_nmea_output_file = true;
|
2018-03-03 01:03:39 +00:00
|
|
|
ASSERT_NO_THROW({
|
2018-10-27 22:42:28 +00:00
|
|
|
std::shared_ptr<Nmea_Printer> nmea_printer = std::make_shared<Nmea_Printer>(filename, flag_nmea_output_file, false, "");
|
2020-06-18 09:49:28 +00:00
|
|
|
nmea_printer->Print_Nmea_Line(pvt_solution.get(), false);
|
2018-03-03 01:03:39 +00:00
|
|
|
}) << "Failure printing NMEA messages.";
|
2017-08-25 09:42:02 +00:00
|
|
|
|
|
|
|
std::ifstream test_file(filename);
|
|
|
|
std::string line;
|
|
|
|
std::string GPRMC("$GPRMC");
|
2018-03-03 01:03:39 +00:00
|
|
|
if (test_file.is_open())
|
2017-08-25 09:42:02 +00:00
|
|
|
{
|
2018-03-03 01:03:39 +00:00
|
|
|
while (getline(test_file, line))
|
2017-08-25 09:42:02 +00:00
|
|
|
{
|
|
|
|
std::size_t found = line.find(GPRMC);
|
|
|
|
if (found != std::string::npos)
|
|
|
|
{
|
2018-11-07 19:33:34 +00:00
|
|
|
EXPECT_EQ(line, "$GPRMC,225436.00,A,4916.4497617,N,12311.1202744,W,0.00,0.00,191194,0.0,E,D*21\r");
|
2017-08-25 09:42:02 +00:00
|
|
|
}
|
|
|
|
}
|
|
|
|
test_file.close();
|
|
|
|
}
|
2019-07-14 00:28:28 +00:00
|
|
|
errorlib::error_code ec;
|
|
|
|
EXPECT_EQ(true, fs::remove(fs::path(filename), ec)) << "Failure deleting a temporary file.";
|
2017-08-25 09:42:02 +00:00
|
|
|
}
|