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

//
// Copyright (C) 2018 Kubos Corporation
//
// Licensed under the Apache License, Version 2.0 (the "License")
// you may not use this file except in compliance with the License.
// You may obtain a copy of the License at
//
// http://www.apache.org/licenses/LICENSE-2.0
//
// Unless required by applicable law or agreed to in writing, software
// distributed under the License is distributed on an "AS IS" BASIS,
// WITHOUT WARRANTIES OR CONDITIONS OF ANY KIND, either express or implied.
// See the License for the specific language governing permissions and
// limitations under the License.
//

use super::*;

pub struct LogCmd {
    hdr: Header,
    port: u32,
    msg_id: u16,
    msg_type: u8,
    trigger: LogTrigger,
    period: f64,
    offset: f64,
    hold: bool,
}

impl LogCmd {
    pub fn new(
        port: u32,
        msg_id: u16,
        trigger: LogTrigger,
        period: f64,
        offset: f64,
        hold: bool,
    ) -> Self {
        LogCmd {
            hdr: Header::new(MessageID::Log, 32),
            port,
            msg_id,
            msg_type: 0,
            trigger,
            period,
            offset,
            hold,
        }
    }
}

impl Message for LogCmd {
    fn serialize(&self) -> Vec<u8> {
        let mut vec = vec![];

        //Add header
        vec.append(&mut self.hdr.serialize());

        // Add LOG message
        vec.write_u32::<LittleEndian>(self.port).unwrap();
        vec.write_u16::<LittleEndian>(self.msg_id).unwrap();
        vec.push(self.msg_type);
        vec.push(0x00); // Reserved byte
        vec.write_u32::<LittleEndian>(self.trigger as u32).unwrap();
        vec.write_f64::<LittleEndian>(self.period).unwrap();
        vec.write_f64::<LittleEndian>(self.offset).unwrap();
        vec.write_u32::<LittleEndian>(self.hold as u32).unwrap();

        vec
    }
}

#[derive(Copy, Clone, Debug, PartialEq)]
pub enum LogTrigger {
    OnChanged = 1,
    OnTime = 2,
    Once = 4,
}