nmea 0.7.0

Simple NMEA 0183 parser
Documentation 
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

use crate::{parse::NmeaSentence, sentences::utils::parse_hms, Error, SentenceType};
use chrono::NaiveTime;
use nom::{character::complete::char, combinator::opt, number::complete::float, IResult};

#[cfg(feature = "serde")]
use serde::{Deserialize, Serialize};

/// GST - GPS Pseudorange Noise Statistics
/// ```text
///              1    2 3 4 5 6 7 8   9
///              |    | | | | | | |   |
/// $ --GST,hhmmss.ss,x,x,x,x,x,x,x*hh<CR><LF>
/// ```
/// Example: `$GPGST,182141.000,15.5,15.3,7.2,21.8,0.9,0.5,0.8*54`
///
/// 1. UTC time of associated GGA fix
/// 2. Total RMS standard deviation of ranges inputs to the navigation solution
/// 3. Standard deviation (meters) of semi-major axis of error ellipse
/// 4. Standard deviation (meters) of semi-minor axis of error ellipse
/// 5. Orientation of semi-major axis of error ellipse (true north degrees)
/// 6. Standard deviation (meters) of latitude error
/// 7. Standard deviation (meters) of longitude error
/// 8. Standard deviation (meters) of altitude error
/// 9. Checksum

#[cfg_attr(feature = "serde", derive(Serialize, Deserialize))]
#[cfg_attr(feature = "defmt-03", derive(defmt::Format))]
#[derive(Debug, PartialEq)]
pub struct GstData {
    #[cfg_attr(feature = "defmt-03", defmt(Debug2Format))]
    pub time: Option<NaiveTime>,
    pub rms_sd: Option<f32>,
    pub ellipse_semi_major_sd: Option<f32>,
    pub ellipse_semi_minor_sd: Option<f32>,
    pub err_ellipse_orientation: Option<f32>,
    pub lat_sd: Option<f32>,
    pub long_sd: Option<f32>,
    pub alt_sd: Option<f32>,
}

fn do_parse_gst(i: &str) -> IResult<&str, GstData> {
    let (i, time) = opt(parse_hms)(i)?;
    let (i, _) = char(',')(i)?;

    let (i, rms_sd) = opt(float)(i)?;
    let (i, _) = char(',')(i)?;

    let (i, ellipse_semi_major_sd) = opt(float)(i)?;
    let (i, _) = char(',')(i)?;

    let (i, ellipse_semi_minor_sd) = opt(float)(i)?;
    let (i, _) = char(',')(i)?;

    let (i, err_ellipse_orientation) = opt(float)(i)?;
    let (i, _) = char(',')(i)?;

    let (i, lat_sd) = opt(float)(i)?;
    let (i, _) = char(',')(i)?;

    let (i, long_sd) = opt(float)(i)?;
    let (i, _) = char(',')(i)?;

    let (i, alt_sd) = opt(float)(i)?;

    Ok((
        i,
        GstData {
            time,
            rms_sd,
            ellipse_semi_major_sd,
            ellipse_semi_minor_sd,
            err_ellipse_orientation,
            lat_sd,
            long_sd,
            alt_sd,
        },
    ))
}
pub fn parse_gst(sentence: NmeaSentence) -> Result<GstData, Error> {
    if sentence.message_id != SentenceType::GST {
        Err(Error::WrongSentenceHeader {
            expected: SentenceType::GST,
            found: sentence.message_id,
        })
    } else {
        Ok(do_parse_gst(sentence.data)?.1)
    }
}

#[cfg(test)]
mod tests {
    use super::*;
    use crate::{parse::parse_nmea_sentence, Error};

    fn run_parse_gst(line: &str) -> Result<GstData, Error> {
        let s = parse_nmea_sentence(line).expect("GST sentence initial parse failed");
        assert_eq!(s.checksum, s.calc_checksum());
        parse_gst(s)
    }

    #[test]
    fn test_parse_gst() {
        assert_eq!(
            GstData {
                time: NaiveTime::from_hms_micro_opt(18, 21, 41, 00),
                rms_sd: Some(15.5),
                ellipse_semi_major_sd: Some(15.3),
                ellipse_semi_minor_sd: Some(7.2),
                err_ellipse_orientation: Some(21.8),
                lat_sd: Some(0.9),
                long_sd: Some(0.5),
                alt_sd: Some(0.8),
            },
            run_parse_gst("$GPGST,182141.000,15.5,15.3,7.2,21.8,0.9,0.5,0.8*54").unwrap()
        );
        assert_eq!(
            GstData {
                time: None,
                rms_sd: None,
                ellipse_semi_major_sd: None,
                ellipse_semi_minor_sd: None,
                err_ellipse_orientation: None,
                lat_sd: None,
                long_sd: None,
                alt_sd: None,
            },
            run_parse_gst("$GPGST,,,,,,,,*57").unwrap()
        );
    }
}