1
2
3
4
5
6
7
8
9
10
11
12
13
14
15
16
17
18
19
20
21
22
23
24
25
26
27
28
29
30
31
32
33
34
35
36
37
38
39
40
41
42
43
44
45
46
47
48
49
50
51
52
53
54
55
56
57
58
59
60
61
62
63
64
65
66
67
68
69
70
71
72
73
74
75
76
77
78
79
80
81
82
83
84
85
86
87
88
89
90
91
92
93
94
95
96
97
98
99
100
101
102
103
104
105
//! Interpolate between two position points.
use crate::point::Point;
use crate::source::Source;
use crate::Error;
/// Structure that handles the interpolation.
#[derive(Debug)]
pub struct Interpolator {
index: usize,
source: Box<dyn Source>,
points: Vec<Point>,
}
impl Interpolator {
/// Creates a new interpolator for a given source.
///
/// # Examples
///
/// ```
/// use pos::interpolate::Interpolator;
/// use pos::sbet;
/// let reader = sbet::Reader::from_path("data/2-points.sbet").unwrap();
/// let interpolator = Interpolator::new(Box::new(reader)).unwrap();
/// ```
pub fn new(mut source: Box<dyn Source>) -> Result<Interpolator, Error> {
let mut points = Vec::with_capacity(2);
for _ in 0..2 {
points.push(match source.source()? {
Some(point) => point,
None => {
return Err(Error::OnePoint.into());
}
});
}
Ok(Interpolator {
points,
source,
index: 1,
})
}
/// Interpolate a new point for the given time.
///
/// # Examples
///
/// ```
/// use pos::interpolate::Interpolator;
/// use pos::sbet;
/// let reader = sbet::Reader::from_path("data/2-points.sbet").unwrap();
/// let mut interpolator = Interpolator::new(Box::new(reader)).unwrap();
/// let point = interpolator.interpolate(1.516310048360710e5).unwrap();
/// ```
pub fn interpolate(&mut self, time: f64) -> Result<Point, Error> {
loop {
assert!(self.index != 0 && self.index != self.points.len());
if time < self.points[self.index - 1].time {
if self.index == 1 {
return Err(Error::TimeBelowMinimum(time).into());
} else {
self.index -= 1;
}
} else if time > self.points[self.index].time {
if self.index < self.points.len() - 1 {
self.index += 1;
} else {
match self.source.source()? {
Some(point) => {
self.points.push(point);
self.index += 1;
}
None => {
return Err(Error::TimeAboveMaximum(time).into());
}
}
}
} else {
break;
}
}
Ok(self.points[self.index - 1].interpolate(&self.points[self.index], time))
}
}
#[cfg(test)]
mod tests {
use super::*;
use crate::sbet;
#[test]
fn interp_sbet() {
let mut interpolator = Interpolator::new(Box::new(
sbet::Reader::from_path(
"data/2-point\
s.sbet",
)
.unwrap(),
))
.unwrap();
let time = 1.516310048360710e5;
let point = interpolator.interpolate(time).unwrap();
assert_eq!(time, point.time);
assert!(interpolator.interpolate(0.0).is_err());
}
}