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
use core::ops::{Add, Sub};
#[cfg(feature = "fugit")]
mod fgt;
mod primitives;
pub trait InfraMonotonic: Sized {
type Instant: Ord
+ Copy
+ Add<Self::Duration, Output = Self::Instant>
+ Sub<Self::Duration, Output = Self::Instant>
+ Sub<Self::Instant, Output = Self::Duration>;
type Duration: PartialOrd
+ Copy
+ Add<Self::Duration, Output = Self::Duration>
+ core::fmt::Debug;
const ZERO_INSTANT: Self::Instant;
const ZERO_DURATION: Self::Duration;
fn checked_sub(a: Self::Instant, b: Self::Instant) -> Option<Self::Duration>;
fn create_span(freq: u32, p: u32, t: u32) -> Span<Self::Duration>;
}
#[derive(Debug)]
pub struct Span<Dur> {
low: Dur,
high: Dur,
}
#[derive(Debug)]
pub struct PulseSpans<Mono: InfraMonotonic> {
pub(crate) spans: [Span<Mono::Duration>; 8],
}
impl<Mono> PulseSpans<Mono>
where
Mono: InfraMonotonic,
{
pub fn new(freq: u32, pulse: &[u32; 8], tolerance: &[u32; 8]) -> Self {
PulseSpans {
spans: [
Mono::create_span(freq, pulse[0], tolerance[0]),
Mono::create_span(freq, pulse[1], tolerance[1]),
Mono::create_span(freq, pulse[2], tolerance[2]),
Mono::create_span(freq, pulse[3], tolerance[3]),
Mono::create_span(freq, pulse[4], tolerance[4]),
Mono::create_span(freq, pulse[5], tolerance[5]),
Mono::create_span(freq, pulse[6], tolerance[6]),
Mono::create_span(freq, pulse[7], tolerance[7]),
],
}
}
pub fn get<P: From<usize>>(&self, pl: Mono::Duration) -> Option<P> {
self.spans
.iter()
.position(|v| v.contains(pl))
.map(Into::into)
}
pub fn check_overlaps(&self) -> bool {
for i in 0..self.spans.len() {
for j in 0..self.spans.len() {
if i == j {
continue;
}
if self.spans[i].overlaps(&self.spans[j]) {
return true;
}
}
}
false
}
}
impl<Dur> Span<Dur>
where
Dur: PartialOrd + Copy,
{
fn contains(&self, other: Dur) -> bool {
self.low <= other && other <= self.high
}
fn overlaps(&self, other: &Span<Dur>) -> bool {
self.contains(other.low) || self.contains(other.high)
}
}