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
use super::*;
#[derive(Clone, Debug, PartialEq)]
pub struct DtmData {
pub source: NavigationSystem,
pub datum_id: Option<String>,
pub datum_sub_id: Option<String>,
pub lat_offset: Option<f64>,
pub lon_offset: Option<f64>,
pub alt_offset: Option<f64>,
pub ref_datum_id: Option<String>,
}
pub(crate) fn handle(
sentence: &str,
nav_system: NavigationSystem,
) -> Result<ParsedMessage, ParseError> {
let split: Vec<&str> = sentence.split(',').collect();
Ok(ParsedMessage::Dtm(DtmData {
source: nav_system,
datum_id: pick_string_field(&split, 1),
datum_sub_id: pick_string_field(&split, 2),
lat_offset: parse_latitude_m_m(split.get(3).unwrap_or(&""), split.get(4).unwrap_or(&""))?,
lon_offset: parse_longitude_m_m(split.get(5).unwrap_or(&""), split.get(6).unwrap_or(&""))?,
alt_offset: pick_number_field(&split, 7)?,
ref_datum_id: pick_string_field(&split, 8),
}))
}
#[cfg(test)]
mod test {
use super::*;
#[test]
fn test_parse_cpdtm() {
match NmeaParser::new().parse_sentence("$GPDTM,999,,0.002,S,0.005,E,005.8,W84*1A") {
Ok(ps) => match ps {
ParsedMessage::Dtm(dtm) => {
assert_eq!(dtm.source, NavigationSystem::Gps);
assert_eq!(dtm.datum_id, Some("999".into()));
assert_eq!(dtm.datum_sub_id, None);
assert::close(dtm.lat_offset.unwrap_or(0.0), -0.000033, 0.000001);
assert::close(dtm.lon_offset.unwrap_or(0.0), 0.000083, 0.000001);
assert_eq!(dtm.alt_offset, Some(5.8));
assert_eq!(dtm.ref_datum_id, Some("W84".into()));
}
ParsedMessage::Incomplete => {
assert!(false);
}
_ => {
assert!(false);
}
},
Err(e) => {
assert_eq!(e.to_string(), "OK");
}
}
}
}