mirrors/gnss-sdr
1
0
Fork 0
mirror of https://github.com/gnss-sdr/gnss-sdr synced 2025-10-30 06:52:58 +00:00
Code Issues Releases Wiki Activity

Code cleaning

Browse Source
This commit is contained in:
Carles Fernandez
2017-02-06 19:24:17 +01:00
parent f03d869def
commit dbe08ade8c
4 changed files with 659 additions and 657 deletions
Download Patch File Download Diff File Expand all files Collapse all files

6
src/algorithms/PVT/libs/galileo_e1_ls_pvt.cc
View File

@@ -164,7 +164,8 @@ bool galileo_e1_ls_pvt::get_PVT(std::map<int,Gnss_Synchro> gnss_pseudoranges_map
DLOG(INFO) << "satpos=" << satpos; DLOG(INFO) << "satpos=" << satpos;
DLOG(INFO) << "obs="<< obs; DLOG(INFO) << "obs="<< obs;
DLOG(INFO) << "W=" << W; DLOG(INFO) << "W=" << W;
try{ try
{
// check if this is the initial position computation // check if this is the initial position computation
if (d_rx_dt_s == 0) if (d_rx_dt_s == 0)
{ {
@@ -239,7 +240,8 @@ bool galileo_e1_ls_pvt::get_PVT(std::map<int,Gnss_Synchro> gnss_pseudoranges_map
// MOVING AVERAGE PVT // MOVING AVERAGE PVT
galileo_e1_ls_pvt::pos_averaging(flag_averaging); galileo_e1_ls_pvt::pos_averaging(flag_averaging);
}catch(const std::exception & e) }
catch(const std::exception & e)
{ {
d_rx_dt_s = 0; //reset rx time estimation d_rx_dt_s = 0; //reset rx time estimation
LOG(WARNING) << "Problem with the solver, invalid solution!" << e.what(); LOG(WARNING) << "Problem with the solver, invalid solution!" << e.what();

6
src/algorithms/PVT/libs/gps_l1_ca_ls_pvt.cc
View File

@@ -165,7 +165,8 @@ bool gps_l1_ca_ls_pvt::get_PVT(std::map<int,Gnss_Synchro> gnss_pseudoranges_map,
DLOG(INFO) << "obs=" << obs; DLOG(INFO) << "obs=" << obs;
DLOG(INFO) << "W=" << W; DLOG(INFO) << "W=" << W;
try{ try
{
// check if this is the initial position computation // check if this is the initial position computation
if (d_rx_dt_s == 0) if (d_rx_dt_s == 0)
{ {
@@ -241,7 +242,8 @@ bool gps_l1_ca_ls_pvt::get_PVT(std::map<int,Gnss_Synchro> gnss_pseudoranges_map,
// MOVING AVERAGE PVT // MOVING AVERAGE PVT
pos_averaging(flag_averaging); pos_averaging(flag_averaging);
}catch(const std::exception & e) }
catch(const std::exception & e)
{ {
d_rx_dt_s = 0; //reset rx time estimation d_rx_dt_s = 0; //reset rx time estimation
LOG(WARNING) << "Problem with the solver, invalid solution!" << e.what(); LOG(WARNING) << "Problem with the solver, invalid solution!" << e.what();

10
src/algorithms/PVT/libs/hybrid_ls_pvt.cc
View File

@@ -132,15 +132,12 @@ bool hybrid_ls_pvt::get_PVT(std::map<int,Gnss_Synchro> gnss_observables_map, dou
satpos(1, valid_obs) = galileo_ephemeris_iter->second.d_satpos_Y; satpos(1, valid_obs) = galileo_ephemeris_iter->second.d_satpos_Y;
satpos(2, valid_obs) = galileo_ephemeris_iter->second.d_satpos_Z; satpos(2, valid_obs) = galileo_ephemeris_iter->second.d_satpos_Z;
// 4- fill the observations vector with the corrected observables // 4- fill the observations vector with the corrected observables
obs.resize(valid_obs + 1, 1); obs.resize(valid_obs + 1, 1);
obs(valid_obs) = gnss_observables_iter->second.Pseudorange_m + SV_clock_bias_s * GALILEO_C_m_s - d_rx_dt_s * GALILEO_C_m_s; obs(valid_obs) = gnss_observables_iter->second.Pseudorange_m + SV_clock_bias_s * GALILEO_C_m_s - d_rx_dt_s * GALILEO_C_m_s;
d_visible_satellites_IDs[valid_obs] = galileo_ephemeris_iter->second.i_satellite_PRN; d_visible_satellites_IDs[valid_obs] = galileo_ephemeris_iter->second.i_satellite_PRN;
d_visible_satellites_CN0_dB[valid_obs] = gnss_observables_iter->second.CN0_dB_hz; d_visible_satellites_CN0_dB[valid_obs] = gnss_observables_iter->second.CN0_dB_hz;
Galileo_week_number = galileo_ephemeris_iter->second.WN_5; //for GST Galileo_week_number = galileo_ephemeris_iter->second.WN_5; //for GST
GST = galileo_ephemeris_iter->second.Galileo_System_Time(Galileo_week_number, hybrid_current_time); GST = galileo_ephemeris_iter->second.Galileo_System_Time(Galileo_week_number, hybrid_current_time);
@@ -153,7 +150,6 @@ bool hybrid_ls_pvt::get_PVT(std::map<int,Gnss_Synchro> gnss_observables_map, dou
valid_obs++; valid_obs++;
} }
else // the ephemeris are not available for this SV else // the ephemeris are not available for this SV
{ {
DLOG(INFO) << "No ephemeris data for SV " << gnss_observables_iter->second.PRN; DLOG(INFO) << "No ephemeris data for SV " << gnss_observables_iter->second.PRN;
@@ -288,7 +284,8 @@ bool hybrid_ls_pvt::get_PVT(std::map<int,Gnss_Synchro> gnss_observables_map, dou
DLOG(INFO) << "satpos=" << satpos; DLOG(INFO) << "satpos=" << satpos;
DLOG(INFO) << "obs=" << obs; DLOG(INFO) << "obs=" << obs;
DLOG(INFO) << "W=" << W; DLOG(INFO) << "W=" << W;
try{ try
{
// check if this is the initial position computation // check if this is the initial position computation
if (d_rx_dt_s == 0) if (d_rx_dt_s == 0)
{ {
@@ -374,7 +371,8 @@ bool hybrid_ls_pvt::get_PVT(std::map<int,Gnss_Synchro> gnss_observables_map, dou
// MOVING AVERAGE PVT // MOVING AVERAGE PVT
pos_averaging(flag_averaging); pos_averaging(flag_averaging);
}catch(const std::exception & e) }
catch(const std::exception & e)
{ {
d_rx_dt_s = 0; //reset rx time estimation d_rx_dt_s = 0; //reset rx time estimation
LOG(WARNING) << "Problem with the solver, invalid solution!" << e.what(); LOG(WARNING) << "Problem with the solver, invalid solution!" << e.what();

4
src/algorithms/PVT/libs/ls_pvt.cc
View File

@@ -164,7 +164,7 @@ double Ls_Pvt::lorentz(const arma::vec& x, const arma::vec& y)
{ {
// LORENTZ Calculates the Lorentz inner product of the two // LORENTZ Calculates the Lorentz inner product of the two
// 4 by 1 vectors x and y // 4 by 1 vectors x and y
// Based ob code by: // Based on code by:
// Kai Borre 04-22-95 // Kai Borre 04-22-95
// Copyright (c) by Kai Borre // Copyright (c) by Kai Borre
// $Revision: 1.0 $ $Date: 1997/09/26 $ // $Revision: 1.0 $ $Date: 1997/09/26 $
@@ -182,7 +182,7 @@ arma::vec Ls_Pvt::leastSquarePos(const arma::mat & satpos, const arma::vec & obs
* Inputs: * Inputs:
* satpos - Satellites positions in ECEF system: [X; Y; Z;] * satpos - Satellites positions in ECEF system: [X; Y; Z;]
* obs - Observations - the pseudorange measurements to each satellite * obs - Observations - the pseudorange measurements to each satellite
* w - weigths vector * w - weight vector
* *
* Returns: * Returns:
* pos - receiver position and receiver clock error * pos - receiver position and receiver clock error