diff --git a/src/algorithms/observables/gnuradio_blocks/hybrid_observables_gs.cc b/src/algorithms/observables/gnuradio_blocks/hybrid_observables_gs.cc index 4fbcbb9be..b3e4e9621 100644 --- a/src/algorithms/observables/gnuradio_blocks/hybrid_observables_gs.cc +++ b/src/algorithms/observables/gnuradio_blocks/hybrid_observables_gs.cc @@ -119,6 +119,7 @@ hybrid_observables_gs::hybrid_observables_gs(const Obs_Conf &conf_) : gr::block( } d_T_rx_TOW_ms = 0U; d_T_rx_step_ms = conf_.observable_interval_ms; + d_T_rx_step_s = static_cast(d_T_rx_step_ms) / 1000.0; d_T_rx_TOW_set = false; d_T_status_report_timer_ms = 0; d_Rx_clock_buffer.set_capacity(std::min(std::max(200U / d_T_rx_step_ms, 3U), 10U)); @@ -371,7 +372,7 @@ bool hybrid_observables_gs::interp_trk_obs(Gnss_Synchro &interpolated_obs, uint3 if (nearest_element != -1 and nearest_element != static_cast(d_gnss_synchro_history->size(ch))) { - if ((static_cast(old_abs_diff) / static_cast(d_gnss_synchro_history->get(ch, nearest_element).fs)) < static_cast(d_T_rx_step_ms) / 1000.0) + if ((static_cast(old_abs_diff) / static_cast(d_gnss_synchro_history->get(ch, nearest_element).fs)) < d_T_rx_step_s) { int32_t neighbor_element; if (rx_clock > d_gnss_synchro_history->get(ch, nearest_element).Tracking_sample_counter) diff --git a/src/algorithms/observables/gnuradio_blocks/hybrid_observables_gs.h b/src/algorithms/observables/gnuradio_blocks/hybrid_observables_gs.h index 2f3551cd3..ff174312e 100644 --- a/src/algorithms/observables/gnuradio_blocks/hybrid_observables_gs.h +++ b/src/algorithms/observables/gnuradio_blocks/hybrid_observables_gs.h @@ -110,6 +110,7 @@ private: std::ofstream d_dump_file; double d_smooth_filter_M; + double d_T_rx_step_s; uint32_t d_T_rx_TOW_ms; uint32_t d_T_rx_step_ms;