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
117
118
119
120
121
122
123
124
125
126
127
128
129
130
131
132
133
use crate::NslDuplexCommsResult;
use comms_service::CommsServiceError;
use nsl_duplex_d2::{serial_connection, DuplexD2, File};
use std::sync::{Arc, Mutex};
use std::thread;
use std::time::Duration;
pub const DEFAULT_PING_FREQ: u64 = 10;
pub struct DuplexComms {
pub radio: DuplexD2,
downlink_counter: u16,
pub ping_freq: u64,
}
impl DuplexComms {
pub fn new(path: &str, ping_freq: u64) -> Self {
let serial_conn = serial_connection(path);
let radio = DuplexD2::new(serial_conn);
DuplexComms {
radio,
downlink_counter: 0,
ping_freq,
}
}
pub fn read(&self) -> NslDuplexCommsResult<Vec<u8>> {
let count = self.radio.get_uploaded_file_count()?;
if count > 0 {
let file = self.radio.get_uploaded_file()?;
Ok(file.body)
} else {
bail!(CommsServiceError::NoReadData);
}
}
pub fn write(&mut self, data: &[u8]) -> NslDuplexCommsResult<()> {
let file_name = format!("udp{:03}", self.downlink_counter);
self.downlink_counter += 1;
let file = File::new(&file_name, &data);
match self.radio.put_download_file(&file) {
Ok(true) => Ok(()),
Ok(false) => {
warn!("Failed to downlink file");
bail!("Failed to downlink file")
}
Err(e) => {
warn!("Duplex write failed {:?}", e);
bail!(e.to_string())
}
}
}
pub fn download_ping(&mut self) -> NslDuplexCommsResult<()> {
let count = self.radio.get_download_file_count()?;
if count == 0 {
let file = File::new("ping", &[]);
self.radio.put_download_file(&file)?;
}
Ok(())
}
}
pub fn ping_loop(radio: Arc<Mutex<DuplexComms>>) -> NslDuplexCommsResult<()> {
let ping_freq = radio
.lock()
.and_then(|radio| Ok(radio.ping_freq))
.unwrap_or(DEFAULT_PING_FREQ);
loop {
if let Ok(mut radio) = radio.lock() {
match radio.download_ping() {
Ok(_) => {}
Err(e) => {
warn!("Failed to send ping to radio {}", e);
}
}
}
thread::sleep(Duration::from_secs(ping_freq));
}
}
pub fn read(radio: &Arc<Mutex<DuplexComms>>) -> NslDuplexCommsResult<Vec<u8>> {
if let Ok(radio) = radio.lock() {
radio.read()
} else {
warn!("Failed to lock radio");
panic!("Failed to lock radio");
}
}
pub fn write(radio: &Arc<Mutex<DuplexComms>>, data: &[u8]) -> NslDuplexCommsResult<()> {
if let Ok(mut radio) = radio.lock() {
radio.write(data)
} else {
warn!("Failed to lock radio");
panic!("Failed to lock radio");
}
}