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
use super::Operation;
use crate::{CPUControlFlags, DriverError, TxDatagram};
use anyhow::Result;
#[derive(Default)]
pub struct ModDelay {
sent: bool,
delays: Vec<u16>,
}
impl ModDelay {
pub fn new(delays: Vec<u16>) -> Self {
Self {
sent: false,
delays,
}
}
}
impl Operation for ModDelay {
fn pack(&mut self, tx: &mut TxDatagram) -> Result<()> {
if self.is_finished() {
return Ok(());
}
if self.delays.len() != tx.num_transducers() {
return Err(DriverError::NumberOfTransducerMismatch {
a: tx.num_transducers(),
b: self.delays.len(),
}
.into());
}
tx.header_mut()
.cpu_flag
.set(CPUControlFlags::WRITE_BODY, true);
tx.header_mut()
.cpu_flag
.set(CPUControlFlags::MOD_DELAY, true);
tx.num_bodies = tx.num_devices();
tx.body_raw_mut().clone_from_slice(&self.delays);
self.sent = true;
Ok(())
}
fn init(&mut self) {
self.sent = false;
}
fn is_finished(&self) -> bool {
self.sent
}
}