2017-04-12 15:04:51 +00:00
|
|
|
/*!
|
|
|
|
* \file true_observables_reader.cc
|
|
|
|
* \brief Helper file for unit testing
|
|
|
|
* \author Javier Arribas, 2017. jarribas(at)cttc.es
|
|
|
|
*
|
|
|
|
* -------------------------------------------------------------------------
|
|
|
|
*
|
2018-05-13 20:49:11 +00:00
|
|
|
* Copyright (C) 2010-2018 (see AUTHORS file for a list of contributors)
|
2017-04-12 15:04:51 +00:00
|
|
|
*
|
|
|
|
* GNSS-SDR is a software defined Global Navigation
|
|
|
|
* Satellite Systems receiver
|
|
|
|
*
|
|
|
|
* This file is part of GNSS-SDR.
|
|
|
|
*
|
|
|
|
* GNSS-SDR is free software: you can redistribute it and/or modify
|
|
|
|
* it under the terms of the GNU General Public License as published by
|
|
|
|
* the Free Software Foundation, either version 3 of the License, or
|
|
|
|
* (at your option) any later version.
|
|
|
|
*
|
|
|
|
* GNSS-SDR is distributed in the hope that it will be useful,
|
|
|
|
* but WITHOUT ANY WARRANTY; without even the implied warranty of
|
|
|
|
* MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE. See the
|
|
|
|
* GNU General Public License for more details.
|
|
|
|
*
|
|
|
|
* You should have received a copy of the GNU General Public License
|
2018-05-13 20:49:11 +00:00
|
|
|
* along with GNSS-SDR. If not, see <https://www.gnu.org/licenses/>.
|
2017-04-12 15:04:51 +00:00
|
|
|
*
|
|
|
|
* -------------------------------------------------------------------------
|
|
|
|
*/
|
|
|
|
|
|
|
|
#include "true_observables_reader.h"
|
2019-02-10 20:55:51 +00:00
|
|
|
#include <exception>
|
2018-02-25 21:49:06 +00:00
|
|
|
#include <iostream>
|
2018-12-03 18:01:47 +00:00
|
|
|
#include <utility>
|
2017-04-12 15:04:51 +00:00
|
|
|
|
|
|
|
bool true_observables_reader::read_binary_obs()
|
|
|
|
{
|
|
|
|
try
|
2018-03-03 01:03:39 +00:00
|
|
|
{
|
|
|
|
for (int i = 0; i < 12; i++)
|
2017-10-28 22:44:38 +00:00
|
|
|
{
|
|
|
|
d_dump_file.read(reinterpret_cast<char *>(&gps_time_sec[i]), sizeof(double));
|
2018-07-26 17:21:53 +00:00
|
|
|
d_dump_file.read(reinterpret_cast<char *>(&doppler_l1_hz[i]), sizeof(double));
|
2017-10-28 22:44:38 +00:00
|
|
|
d_dump_file.read(reinterpret_cast<char *>(&acc_carrier_phase_l1_cycles[i]), sizeof(double));
|
|
|
|
d_dump_file.read(reinterpret_cast<char *>(&dist_m[i]), sizeof(double));
|
|
|
|
d_dump_file.read(reinterpret_cast<char *>(&true_dist_m[i]), sizeof(double));
|
|
|
|
d_dump_file.read(reinterpret_cast<char *>(&carrier_phase_l1_cycles[i]), sizeof(double));
|
|
|
|
d_dump_file.read(reinterpret_cast<char *>(&prn[i]), sizeof(double));
|
|
|
|
}
|
2018-03-03 01:03:39 +00:00
|
|
|
}
|
2017-04-12 15:04:51 +00:00
|
|
|
catch (const std::ifstream::failure &e)
|
2018-03-03 01:03:39 +00:00
|
|
|
{
|
2017-04-12 15:04:51 +00:00
|
|
|
return false;
|
2018-03-03 01:03:39 +00:00
|
|
|
}
|
2017-04-12 15:04:51 +00:00
|
|
|
return true;
|
|
|
|
}
|
|
|
|
|
2017-08-19 10:45:19 +00:00
|
|
|
|
2017-04-12 15:04:51 +00:00
|
|
|
bool true_observables_reader::restart()
|
|
|
|
{
|
|
|
|
if (d_dump_file.is_open())
|
|
|
|
{
|
|
|
|
d_dump_file.clear();
|
|
|
|
d_dump_file.seekg(0, std::ios::beg);
|
|
|
|
return true;
|
|
|
|
}
|
2018-12-03 21:08:19 +00:00
|
|
|
return false;
|
2017-04-12 15:04:51 +00:00
|
|
|
}
|
|
|
|
|
2017-08-19 10:45:19 +00:00
|
|
|
|
2018-08-10 19:16:10 +00:00
|
|
|
int64_t true_observables_reader::num_epochs()
|
2017-04-12 15:04:51 +00:00
|
|
|
{
|
|
|
|
std::ifstream::pos_type size;
|
2018-03-03 01:03:39 +00:00
|
|
|
int number_of_vars_in_epoch = 6 * 12;
|
2017-04-12 15:04:51 +00:00
|
|
|
int epoch_size_bytes = sizeof(double) * number_of_vars_in_epoch;
|
2018-03-03 01:03:39 +00:00
|
|
|
std::ifstream tmpfile(d_dump_filename.c_str(), std::ios::binary | std::ios::ate);
|
2017-04-12 15:04:51 +00:00
|
|
|
if (tmpfile.is_open())
|
|
|
|
{
|
|
|
|
size = tmpfile.tellg();
|
2018-08-10 19:16:10 +00:00
|
|
|
int64_t nepoch = size / epoch_size_bytes;
|
2017-04-12 15:04:51 +00:00
|
|
|
return nepoch;
|
|
|
|
}
|
2018-12-03 21:08:19 +00:00
|
|
|
return 0;
|
2017-04-12 15:04:51 +00:00
|
|
|
}
|
|
|
|
|
2017-08-19 10:45:19 +00:00
|
|
|
|
2017-04-12 15:04:51 +00:00
|
|
|
bool true_observables_reader::open_obs_file(std::string out_file)
|
|
|
|
{
|
|
|
|
if (d_dump_file.is_open() == false)
|
|
|
|
{
|
|
|
|
try
|
2018-03-03 01:03:39 +00:00
|
|
|
{
|
2018-12-03 18:01:47 +00:00
|
|
|
d_dump_filename = std::move(out_file);
|
2018-03-03 01:03:39 +00:00
|
|
|
d_dump_file.exceptions(std::ifstream::failbit | std::ifstream::badbit);
|
2017-04-12 15:04:51 +00:00
|
|
|
d_dump_file.open(d_dump_filename.c_str(), std::ios::in | std::ios::binary);
|
|
|
|
std::cout << "True observables Log file opened: " << d_dump_filename.c_str() << std::endl;
|
|
|
|
return true;
|
2018-03-03 01:03:39 +00:00
|
|
|
}
|
|
|
|
catch (const std::ifstream::failure &e)
|
|
|
|
{
|
2019-02-10 20:55:51 +00:00
|
|
|
std::cout << "Problem opening true Observables Log file: " << d_dump_filename << std::endl;
|
2017-04-12 15:04:51 +00:00
|
|
|
return false;
|
2018-03-03 01:03:39 +00:00
|
|
|
}
|
2017-04-12 15:04:51 +00:00
|
|
|
}
|
|
|
|
else
|
|
|
|
{
|
|
|
|
return false;
|
|
|
|
}
|
|
|
|
}
|
|
|
|
|
2017-08-19 10:45:19 +00:00
|
|
|
|
2017-04-12 15:04:51 +00:00
|
|
|
true_observables_reader::~true_observables_reader()
|
|
|
|
{
|
2019-02-10 20:55:51 +00:00
|
|
|
try
|
|
|
|
{
|
|
|
|
if (d_dump_file.is_open() == true)
|
|
|
|
{
|
|
|
|
d_dump_file.close();
|
|
|
|
}
|
|
|
|
}
|
|
|
|
catch (const std::ifstream::failure &e)
|
|
|
|
{
|
|
|
|
std::cerr << "Problem closing true Observables dump Log file: " << d_dump_filename << '\n';
|
|
|
|
}
|
|
|
|
catch (const std::exception &e)
|
2017-04-12 15:04:51 +00:00
|
|
|
{
|
2019-02-10 20:55:51 +00:00
|
|
|
std::cerr << e.what() << '\n';
|
2017-04-12 15:04:51 +00:00
|
|
|
}
|
|
|
|
}
|