iso14229-1 0.1.0

A ISO 14229-1 protocol.
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

//! request of Service 31

use crate::{
    error::Error,
    request::{Request, SubFunction},
    utils, Configuration, RequestData, RoutineCtrlType, RoutineId, Service,
};

#[derive(Debug, Clone, Eq, PartialEq)]
pub struct RoutineCtrl {
    pub routine_id: RoutineId,
    pub option_record: Vec<u8>,
}

impl From<RoutineCtrl> for Vec<u8> {
    fn from(mut v: RoutineCtrl) -> Self {
        let routine_id: u16 = v.routine_id.into();
        let mut result = routine_id.to_be_bytes().to_vec();
        result.append(&mut v.option_record);

        result
    }
}

impl RequestData for RoutineCtrl {
    fn new_request<T: AsRef<[u8]>>(
        data: T,
        sub_func: Option<u8>,
        _: &Configuration,
    ) -> Result<Request, Error> {
        let data = data.as_ref();
        match sub_func {
            Some(sub_func) => {
                let (suppress_positive, sub_func) = utils::peel_suppress_positive(sub_func);
                let _ = RoutineCtrlType::try_from(sub_func)?;

                utils::data_length_check(data.len(), 2, false)?;

                Ok(Request {
                    service: Service::RoutineCtrl,
                    sub_func: Some(SubFunction::new(sub_func, suppress_positive)),
                    data: data.to_vec(),
                })
            }
            None => Err(Error::SubFunctionError(Service::RoutineCtrl)),
        }
    }
}

impl TryFrom<(&Request, &Configuration)> for RoutineCtrl {
    type Error = Error;
    fn try_from((req, _): (&Request, &Configuration)) -> Result<RoutineCtrl, Error> {
        let service = req.service();
        if service != Service::RoutineCtrl || req.sub_func.is_none() {
            return Err(Error::ServiceError(service));
        }

        // let sub_func: RoutineCtrlType = request.sub_function().unwrap().function()?;

        let data = &req.data;
        let mut offset = 0;
        let routine_id = u16::from_be_bytes([data[offset], data[offset + 1]]);
        offset += 2;
        let routine_id = RoutineId::from(routine_id);

        Ok(Self {
            routine_id,
            option_record: data[offset..].to_vec(),
        })
    }
}