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
106
107
108
109
110
111
112
113
114
115
116
use std::collections::VecDeque;
use super::sliding_window::View;
use crate::Echo;
#[derive(Clone)]
pub struct ReFlex {
view: Box<dyn View>,
window_len: usize,
last_val: f64,
last_m: f64,
q_vals: VecDeque<f64>,
out: f64,
}
impl std::fmt::Debug for ReFlex {
fn fmt(&self, fmt: &mut std::fmt::Formatter<'_>) -> Result<(), std::fmt::Error> {
write!(fmt, "ReFlex(window_len: {}, last_val: {}, last_m: {}, q_vals: {:?}, out: {})",
self.window_len, self.last_val, self.last_m, self.q_vals, self.out)
}
}
impl ReFlex {
pub fn new(view: Box<dyn View>, window_len: usize) -> Box<Self> {
Box::new(ReFlex {
view,
window_len,
last_val: 0.0,
last_m: 0.0,
q_vals: VecDeque::new(),
out: 0.0,
})
}
pub fn new_final(window_len: usize) -> Box<Self> {
Self::new(Echo::new(), window_len)
}
}
impl View for ReFlex {
fn update(&mut self, val: f64) {
self.view.update(val);
let val = self.view.last();
if self.q_vals.len() == 0 {
self.last_val = val;
}
if self.q_vals.len() >= self.window_len {
self.q_vals.pop_front();
}
let a1 = 8.88442402435 / self.window_len as f64;
let b1 = 2.0 * a1 * (4.44221201218 / self.window_len as f64).cos();
let c3 = -a1 * a1;
let c1 = 1.0 - b1 - c3;
let l = self.q_vals.len();
let mut filt: f64 = 0.0;
if l == 0 {
filt = c1 * (val + self.last_val) / 2.0;
} else if l == 1 {
let filt1 = self.q_vals.get(l - 1).unwrap();
filt = c1 * (val + self.last_val) / 2.0 + b1 * filt1;
} else if l > 1 {
let filt2 = self.q_vals.get(l - 2).unwrap();
let filt1 = self.q_vals.get(l - 1).unwrap();
filt = c1 * (val + self.last_val) / 2.0 + b1 * filt1 + c3 * filt2;
}
self.last_val = val;
self.q_vals.push_back(filt);
let slope = (self.q_vals.get(0).unwrap() - filt) / self.window_len as f64;
let mut d_sum: f64 = 0.0;
for i in 0..self.q_vals.len() {
let index = self.q_vals.len() - 1 - i;
d_sum += (filt + i as f64 * slope) - *self.q_vals.get(index).unwrap();
}
d_sum /= self.window_len as f64;
let ms0 = 0.04 * d_sum.powi(2) + 0.96 * self.last_m;
self.last_m = ms0;
if ms0 > 0.0 {
self.out = d_sum / ms0.sqrt();
}
}
fn last(&self) -> f64 {
return self.out;
}
}
#[cfg(test)]
mod tests {
use super::*;
use crate::plot::plot_values;
use crate::test_data::TEST_DATA;
#[test]
fn re_flex_plot() {
let mut rf = ReFlex::new_final(16);
let mut out: Vec<f64> = Vec::new();
for v in &TEST_DATA {
rf.update(*v);
out.push(rf.last());
}
let filename = "img/re_flex.png";
plot_values(out, filename).unwrap();
}
}