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 std::marker::PhantomData;
use autd3_driver::{Drive, TxDatagram};
use crate::{
geometry::{Geometry, Transducer},
interface::DatagramBody,
};
use anyhow::Result;
pub struct GainProps<T: Transducer> {
pub built: bool,
pub phase_sent: bool,
pub duty_sent: bool,
pub drives: Vec<Drive>,
_t: PhantomData<T>,
}
impl<T: Transducer> GainProps<T> {
pub fn new() -> Self {
Self {
built: false,
phase_sent: false,
duty_sent: false,
drives: vec![],
_t: PhantomData,
}
}
pub fn init(&mut self, geometry: &Geometry<T>) {
self.drives.clear();
self.drives = geometry
.transducers()
.map(|tr| Drive {
phase: 0.0,
amp: 0.0,
cycle: tr.cycle(),
})
.collect();
}
pub fn pack_head(&mut self, tx: &mut TxDatagram) {
T::pack_head(tx);
}
pub fn pack_body(&mut self, tx: &mut TxDatagram) -> Result<()> {
T::pack_body(&mut self.phase_sent, &mut self.duty_sent, &self.drives, tx)
}
}
impl<T: Transducer> Default for GainProps<T> {
fn default() -> Self {
Self::new()
}
}
pub trait IGain<T: Transducer> {
fn calc(&mut self, geometry: &Geometry<T>) -> Result<()>;
}
pub trait Gain<T: Transducer>: IGain<T> + DatagramBody<T> {
fn build(&mut self, geometry: &Geometry<T>) -> Result<()>;
fn rebuild(&mut self, geometry: &Geometry<T>) -> Result<()>;
fn drives(&self) -> &[Drive];
fn take_drives(self) -> Vec<Drive>;
fn built(&self) -> bool;
}