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

use crate::types::date::Date;
use crate::types::latitude::Latitude;
use crate::types::longitude::Longitude;
use crate::types::position_mode::PositionMode;
use crate::types::time::Time;
use crate::types::{IntegerFloat, Status};

#[derive(Clone, Default, Debug)]
pub struct RMC {
    pub time: Time,
    pub status: Status,
    pub latitude: Latitude,
    pub longitude: Longitude,
    pub speed: IntegerFloat<i32, u16>,
    pub course: IntegerFloat<u16, u8>,
    pub date: Date,
    pub heading: Option<IntegerFloat<u16, u8>>,
    pub position_mode: PositionMode,
}

impl From<&[u8]> for RMC {
    fn from(bytes: &[u8]) -> Self {
        if bytes.iter().fold(0, |sum, &b| sum + (b == b',') as usize) < 11 {
            return Self::default();
        }
        let mut fields = bytes.split(|&b| b == b',');
        let time = Time::from(fields.next().unwrap());
        let status = Status::from(fields.next().unwrap());
        let mut latitude = Latitude::from(fields.next().unwrap());
        if fields.next().unwrap() == b"S" {
            latitude.0 = -latitude.0;
        }
        let mut longitude = Longitude::from(fields.next().unwrap());
        if fields.next().unwrap() == b"W" {
            longitude.0 = -longitude.0;
        }
        let speed: IntegerFloat<i32, u16> = fields.next().unwrap().into();
        let course: IntegerFloat<u16, u8> = fields.next().unwrap().into();
        let date: Date = fields.next().unwrap().into();
        let mut heading: Option<IntegerFloat<u16, u8>> = None;
        let field = fields.next().unwrap();
        let mvew = fields.next().unwrap();
        if field.len() > 0 {
            let mut value: IntegerFloat<u16, u8> = field.into();
            if mvew == b"W" {
                value.integer += 180;
            }
            heading = Some(value);
        }
        let position_mode = PositionMode::from(fields.next().unwrap());
        Self { time, status, latitude, longitude, speed, course, date, heading, position_mode }
    }
}

mod test {
    #[test]
    fn test_rmc() {
        use super::RMC;

        let bytes = b"083559.00,A,4717.11437,N,00833.91522,E,0.004,77.52,091202,,,A,V*57";
        let rmc = RMC::from(&bytes[..]);
        assert_eq!("08:35:59.00", format!("{:?}", rmc.time));
        assert_eq!(r#"N47°17'11"437"#, format!("{:?}", rmc.latitude));
        assert_eq!(r#"E008°33'91"522"#, format!("{:?}", rmc.longitude));
        assert_eq!("0.4#3", format!("{:?}", rmc.speed));
        assert_eq!("77.52#2", format!("{:?}", rmc.course));
        assert_eq!("021209", format!("{:?}", rmc.date));
        assert_eq!("Autonomous", format!("{:?}", rmc.position_mode));

        let bytes = b"083559.00,,,,,,,,,,,,";
        RMC::from(&bytes[..]);
    }
}