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
use num::Float;
use super::Approximation;
pub trait Threshold {
type Value;
type Velocity;
fn evaluate(&mut self, approximation: &Approximation<Self::Value, Self::Velocity>) -> bool;
}
pub struct And<A, B>(pub A, pub B)
where
A: Threshold,
B: Threshold<Value = A::Value>;
impl<A, B> Threshold for And<A, B>
where
A: Threshold,
B: Threshold<Value = A::Value, Velocity = A::Velocity>,
{
type Value = A::Value;
type Velocity = A::Velocity;
fn evaluate(&mut self, approximation: &Approximation<Self::Value, Self::Velocity>) -> bool {
self.0.evaluate(approximation) && self.1.evaluate(approximation)
}
}
pub struct DisplacementThreshold<T>
where
T: Float,
{
pub target: T,
pub sensitivity: T,
}
impl<T> Threshold for DisplacementThreshold<T>
where
T: Float,
{
type Value = T;
type Velocity = T;
fn evaluate(&mut self, approximation: &Approximation<Self::Value, Self::Velocity>) -> bool {
let displacement = approximation.value.sub(self.target);
displacement.abs() <= self.sensitivity
}
}
pub struct VelocityThreshold<T>(pub T);
impl<T> Threshold for VelocityThreshold<T>
where
T: Float,
{
type Value = T;
type Velocity = T;
fn evaluate(&mut self, approximation: &Approximation<Self::Value, Self::Velocity>) -> bool {
approximation.velocity.abs() <= self.0
}
}