Skip to content
Merged
Show file tree
Hide file tree
Changes from all commits
Commits
File filter

Filter by extension

Filter by extension

Conversations
Failed to load comments.
Loading
Jump to
Jump to file
Failed to load files.
Loading
Diff view
Diff view
6 changes: 5 additions & 1 deletion console_backend/src/connection.rs
Original file line number Diff line number Diff line change
Expand Up @@ -122,7 +122,11 @@ fn conn_manager_thd(
continue;
}
};
let (messages, stop_token) = Messages::from_reader(reader);
let (messages, stop_token) = if conn.realtime_delay() == RealtimeDelay::On {
Messages::with_realtime_delay(reader)
} else {
Messages::new(reader)
};
let msg_sender = MsgSender::new(writer);
shared_state.set_connection(
ConnectionState::Connected {
Expand Down
87 changes: 2 additions & 85 deletions console_backend/src/main_tab.rs
Original file line number Diff line number Diff line change
@@ -1,15 +1,13 @@
use std::{
path::PathBuf,
result::Result,
thread::sleep,
time::{Duration, Instant},
};

use capnp::message::Builder;
use chrono::Local;
use crossbeam::channel::Receiver;
use log::{debug, error};
use sbp::{time::GpsTime, Sbp};
use log::error;
use sbp::Sbp;

use crate::client_sender::BoxedClientSender;
use crate::constants::{
Expand Down Expand Up @@ -88,8 +86,6 @@ pub struct MainTab {
last_sbp_logging: bool,
last_sbp_logging_format: SbpLogging,
sbp_logger: Option<SbpLogger>,
last_gps_update: Instant,
last_gps_time: Option<GpsTime>,
client_sender: BoxedClientSender,
shared_state: SharedState,
}
Expand All @@ -102,40 +98,11 @@ impl MainTab {
last_sbp_logging: false,
last_sbp_logging_format: SbpLogging::SBP_JSON,
sbp_logger: None,
last_gps_time: None,
last_gps_update: Instant::now(),
client_sender,
shared_state,
}
}

/// Calculate time since last epoch began and sleep for previous epoch time difference.
///
/// # Parameters
/// - `gps_time`: The GpsTime corresponding to a message.
pub fn realtime_delay<T>(&mut self, gps_time: Option<Result<GpsTime, T>>) {
if let Some(Ok(g_time)) = gps_time {
if let Some(l_time) = self.last_gps_time {
if l_time < g_time {
let diff = g_time - l_time;
let elapsed = self.last_gps_update.elapsed();
if diff > elapsed {
let sleep_duration = diff - elapsed;
debug!(
"Realtime delay encounterred. Sleeping for {:?}.",
sleep_duration
);
sleep(sleep_duration);
}
self.last_gps_update = Instant::now();
self.last_gps_time = Some(g_time);
}
} else {
self.last_gps_time = Some(g_time);
}
}
}

/// Initialize Baseline and Solution Position and Velocity Loggers.
///
/// # Generates:
Expand Down Expand Up @@ -294,59 +261,9 @@ mod tests {
use std::{
fs::File,
io::{sink, BufRead, BufReader},
time::Duration,
};
use tempfile::TempDir;

struct GpsTimeTests {
pub good_week: i16,
pub early_gps_tow_good: f64,
pub later_gps_tow_good: f64,
}
impl GpsTimeTests {
fn new() -> GpsTimeTests {
let good_week: i16 = 2000;
let early_gps_tow_good: f64 = 5432.0;
let later_gps_tow_good: f64 = 5433.0;
GpsTimeTests {
good_week,
early_gps_tow_good,
later_gps_tow_good,
}
}
}

#[test]
fn realtime_delay_full_test() {
let shared_state = SharedState::new();
let client_send = TestSender::boxed();
let gps_s = GpsTimeTests::new();
let mut main = MainTab::new(shared_state, client_send);
let early_gps_time_good = GpsTime::new(gps_s.good_week, gps_s.early_gps_tow_good).unwrap();
let later_gps_time_good = GpsTime::new(gps_s.good_week, gps_s.later_gps_tow_good);
main.last_gps_time = Some(early_gps_time_good);
let now = Instant::now();
main.last_gps_update = Instant::now();
main.realtime_delay(Some(later_gps_time_good));
assert!(
now.elapsed()
> Duration::from_secs_f64(gps_s.later_gps_tow_good - gps_s.early_gps_tow_good)
);
}

#[test]
fn realtime_delay_no_last_test() {
let shared_state = SharedState::new();
let client_send = TestSender::boxed();
let gps_s = GpsTimeTests::new();
let mut main = MainTab::new(shared_state, client_send);
let later_gps_time_good = GpsTime::new(gps_s.good_week, gps_s.later_gps_tow_good);
let now = Instant::now();
main.last_gps_update = Instant::now();
main.realtime_delay(Some(later_gps_time_good));
assert!(now.elapsed() < Duration::from_millis(5));
}

#[test]
fn csv_logging_test() {
let tmp_dir = TempDir::new().unwrap();
Expand Down
Loading