mirrors/gnss-sdr
1
0
Fork 0
mirror of https://github.com/gnss-sdr/gnss-sdr synced 2025-10-27 13:37:38 +00:00
Code Issues Releases Wiki Activity

Improve zero detection

Browse Source
This commit is contained in:
Carles Fernandez
2025-01-29 00:00:07 +01:00
parent 777a987b5f
commit 11a77ee918
1 changed files with 6 additions and 6 deletions
Download Patch File Download Diff File Expand all files Collapse all files

12
src/algorithms/tracking/libs/lock_detectors.cc
View File

@@ -59,13 +59,13 @@ float cn0_svn_estimator(const gr_complex* Prompt_buffer, int length, float coh_i
float Psig = 0.0; float Psig = 0.0;
float Ptot = 0.0; float Ptot = 0.0;
const float epsilon = std::numeric_limits<float>::epsilon(); const float epsilon = std::numeric_limits<float>::epsilon();
if (length == 0 || coh_integration_time_s <= epsilon) if (length == 0 || coh_integration_time_s < epsilon)
{ {
return -100.0; return -100.0;
} }
for (int i = 0; i < length; i++) for (int i = 0; i < length; i++)
{ {
Psig += std::abs(Prompt_buffer[i].real()); Psig += std::fabs(Prompt_buffer[i].real());
Ptot += Prompt_buffer[i].imag() * Prompt_buffer[i].imag() + Prompt_buffer[i].real() * Prompt_buffer[i].real(); Ptot += Prompt_buffer[i].imag() * Prompt_buffer[i].imag() + Prompt_buffer[i].real() * Prompt_buffer[i].real();
} }
Psig /= static_cast<float>(length); Psig /= static_cast<float>(length);
@@ -117,7 +117,7 @@ float cn0_m2m4_estimator(const gr_complex* Prompt_buffer, int length, float coh_
} }
for (int i = 0; i < length; i++) for (int i = 0; i < length; i++)
{ {
Psig += std::abs(Prompt_buffer[i].real()); Psig += std::fabs(Prompt_buffer[i].real());
aux = Prompt_buffer[i].imag() * Prompt_buffer[i].imag() + Prompt_buffer[i].real() * Prompt_buffer[i].real(); aux = Prompt_buffer[i].imag() * Prompt_buffer[i].imag() + Prompt_buffer[i].real() * Prompt_buffer[i].real();
m_2 += aux; m_2 += aux;
m_4 += (aux * aux); m_4 += (aux * aux);
@@ -131,7 +131,7 @@ float cn0_m2m4_estimator(const gr_complex* Prompt_buffer, int length, float coh_
if (std::isnan(aux)) if (std::isnan(aux))
{ {
denominator = m_2 - Psig; denominator = m_2 - Psig;
if (std::abs(denominator) <= epsilon) if (std::fabs(denominator) < epsilon)
{ {
return -100.0; return -100.0;
} }
@@ -140,14 +140,14 @@ float cn0_m2m4_estimator(const gr_complex* Prompt_buffer, int length, float coh_
else else
{ {
denominator = m_2 - aux; denominator = m_2 - aux;
if (std::abs(denominator) <= epsilon) if (std::fabs(denominator) < epsilon)
{ {
return -100.0; return -100.0;
} }
SNR_aux = aux / denominator; SNR_aux = aux / denominator;
} }
if (SNR_aux <= epsilon) if (std::fabs(SNR_aux) < epsilon)
{ {
return -100.0; return -100.0;
} }