mirrors/gnss-sdr
1
0
Fork 0
mirror of https://github.com/gnss-sdr/gnss-sdr synced 2024-12-14 12:10:34 +00:00
Code Issues Releases Wiki Activity

Fix encoding of fine phase range rate

Browse Source
This commit is contained in:
Carles Fernandez 2016-05-04 12:35:09 +02:00
parent 95f75d407e
commit 2494a3dc0f
1 changed files with 9 additions and 12 deletions
Show Stats Download Patch File Download Diff File Expand all files Collapse all files

21
src/core/system_parameters/rtcm.cc
View File

@ -3835,11 +3835,11 @@ int Rtcm::set_DF399(const Gnss_Synchro & gnss_synchro)
lambda = GPS_C_m_s / 1.207140e9; // Galileo_E1b_FREQ_HZ; lambda = GPS_C_m_s / 1.207140e9; // Galileo_E1b_FREQ_HZ;
} }
double rough_phase_range_ms = std::round(- gnss_synchro.Carrier_Doppler_hz * lambda ); double rough_phase_range_rate_ms = std::round(- gnss_synchro.Carrier_Doppler_hz * lambda );
//std::cout << rough_phase_range_ms << std::endl; if(rough_phase_range_rate_ms < - 8191) rough_phase_range_rate_ms = -8192;
if(rough_phase_range_ms < - 8191) rough_phase_range_ms = -8191; if(rough_phase_range_rate_ms > 8191) rough_phase_range_rate_ms = -8192;
if(rough_phase_range_ms > 8191) rough_phase_range_ms = 8191;
DF399 = std::bitset<14>(static_cast<int>(rough_phase_range_ms)); DF399 = std::bitset<14>(static_cast<int>(rough_phase_range_rate_ms));
return 0; return 0;
} }
@ -3853,13 +3853,9 @@ int Rtcm::set_DF400(const Gnss_Synchro & gnss_synchro)
psrng_s = gnss_synchro.Pseudorange_m - rough_range_m; psrng_s = gnss_synchro.Pseudorange_m - rough_range_m;
if(psrng_s == 0.0) if(std::fabs(psrng_s) > 292.7)
{ {
fine_pseudorange = - 16384; fine_pseudorange = -16384; // 4000h: invalid value
}
else if(std::fabs(psrng_s) > 292.7)
{
fine_pseudorange = - 16384;
} }
else else
{ {
@ -3983,7 +3979,8 @@ int Rtcm::set_DF404(const Gnss_Synchro & gnss_synchro)
lambda = GPS_C_m_s / 1.207140e9; // Galileo_E1b_FREQ_HZ; lambda = GPS_C_m_s / 1.207140e9; // Galileo_E1b_FREQ_HZ;
} }
double phrr = std::round(- gnss_synchro.Carrier_Doppler_hz * lambda); double rough_phase_range_rate = std::round(- gnss_synchro.Carrier_Doppler_hz * lambda );
double phrr = (- gnss_synchro.Carrier_Doppler_hz * lambda - rough_phase_range_rate);
if(phrr == 0.0) if(phrr == 0.0)
{ {