added realtime parameter

This commit is contained in:
Simon Wörner
2017-04-03 18:03:59 +02:00
parent c8914f364c
commit b49df99659
2 changed files with 36 additions and 10 deletions

View File

@@ -1,7 +1,6 @@
extern crate libc; extern crate libc;
use std::time::Duration; use std::time::Duration;
use libc::{c_int, c_long, time_t, timespec};
const CLOCK_MONOTONIC: i32 = 1; const CLOCK_MONOTONIC: i32 = 1;
@@ -15,9 +14,9 @@ fn clock_nanosleep(_clk_id: libc::c_int, _flags: libc::c_int, rqtp: *const libc:
unsafe { libc::nanosleep(rqtp as *const _, rmtp as *mut _) } unsafe { libc::nanosleep(rqtp as *const _, rmtp as *mut _) }
} }
pub fn sleep(duration: Duration) -> Result<Duration, c_int> { pub fn sleep(duration: Duration) -> Result<Duration, libc::c_int> {
let ts = duration_to_timespec(duration); let ts = duration_to_timespec(duration);
let mut remain = timespec { let mut remain = libc::timespec {
tv_sec: 0, tv_sec: 0,
tv_nsec: 0, tv_nsec: 0,
}; };
@@ -30,13 +29,28 @@ pub fn sleep(duration: Duration) -> Result<Duration, c_int> {
} }
} }
fn duration_to_timespec(duration: Duration) -> timespec { fn duration_to_timespec(duration: Duration) -> libc::timespec {
timespec { libc::timespec {
tv_sec: duration.as_secs() as time_t, tv_sec: duration.as_secs() as libc::time_t,
tv_nsec: duration.subsec_nanos() as c_long, tv_nsec: duration.subsec_nanos() as libc::c_long,
} }
} }
fn timespec_to_duration(timespec: timespec) -> Duration { fn timespec_to_duration(timespec: libc::timespec) -> Duration {
Duration::new(timespec.tv_sec as u64, timespec.tv_nsec as u32) Duration::new(timespec.tv_sec as u64, timespec.tv_nsec as u32)
} }
#[cfg(target_os = "linux")]
pub fn set_scheduler(policy: i32, priority: i32) -> libc::c_int {
let pid: libc::pid_t = 0;
let param = libc::sched_param {
sched_priority: priority
};
unsafe { libc::sched_setscheduler(pid as libc::pid_t, policy as libc::c_int, &param) }
}
#[cfg(target_os = "linux")]
pub fn set_priority(priority: i32) -> libc::c_int {
set_scheduler(libc::SCHED_RR, priority)
}

View File

@@ -8,8 +8,8 @@ use std::fs::File;
use std::path::Path; use std::path::Path;
use std::time::Duration; use std::time::Duration;
use argparse::{ArgumentParser, Print, Store}; use argparse::{ArgumentParser, Print, Store, StoreTrue};
use sleep::sleep; use sleep::{set_priority, sleep};
use time::precise_time_ns; use time::precise_time_ns;
fn duration_from_ns(duration_ns: u64) -> Duration { fn duration_from_ns(duration_ns: u64) -> Duration {
@@ -79,6 +79,7 @@ fn main() {
let mut max: u64 = 100_000_000; let mut max: u64 = 100_000_000;
let mut step: u64 = 1_000_000; let mut step: u64 = 1_000_000;
let mut count: u64 = 100; let mut count: u64 = 100;
let mut realtime: bool = false;
let mut output: String = "".to_string(); let mut output: String = "".to_string();
let mut file: Option<File> = None; let mut file: Option<File> = None;
@@ -97,6 +98,9 @@ fn main() {
ap.refer(&mut count) ap.refer(&mut count)
.add_option(&["--loop"], Store, .add_option(&["--loop"], Store,
"Count of measurements per period"); "Count of measurements per period");
ap.refer(&mut realtime)
.add_option(&["--rt"], StoreTrue,
"Output file");
ap.refer(&mut output) ap.refer(&mut output)
.add_option(&["-o", "--out"], Store, .add_option(&["-o", "--out"], Store,
"Output file"); "Output file");
@@ -105,6 +109,14 @@ fn main() {
ap.parse_args_or_exit(); ap.parse_args_or_exit();
} }
if realtime {
let ret = set_priority(99);
if ret != 0 {
panic!("Set realtime priority failed.");
}
}
if output != "" { if output != "" {
file = Some(File::create(Path::new(output.as_str())) file = Some(File::create(Path::new(output.as_str()))
.expect(format!("Open file '{}' failed", output).as_str())); .expect(format!("Open file '{}' failed", output).as_str()));