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
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

//! request of Service 87

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

#[derive(Debug, Clone, Eq, PartialEq)]
pub enum LinkCtrl {
    VerifyModeTransitionWithFixedParameter(LinkCtrlMode), // 0x01
    VerifyModeTransitionWithSpecificParameter(utils::U24), // 0x02
    TransitionMode,
    VehicleManufacturerSpecific(Vec<u8>),
    SystemSupplierSpecific(Vec<u8>),
}

impl From<LinkCtrl> for Vec<u8> {
    fn from(v: LinkCtrl) -> Self {
        let mut result = Vec::new();

        match v {
            LinkCtrl::VerifyModeTransitionWithFixedParameter(v) => {
                result.push(v.into());
            }
            LinkCtrl::VerifyModeTransitionWithSpecificParameter(v) => {
                result.append(&mut v.into());
            }
            LinkCtrl::TransitionMode => {}
            LinkCtrl::VehicleManufacturerSpecific(mut v) => {
                result.append(&mut v);
            }
            LinkCtrl::SystemSupplierSpecific(mut v) => {
                result.append(&mut v);
            }
        }

        result
    }
}

impl RequestData for LinkCtrl {
    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 data_len = data.len();
                match LinkCtrlType::try_from(sub_func)? {
                    LinkCtrlType::VerifyModeTransitionWithFixedParameter => {
                        utils::data_length_check(data_len, 1, true)?
                    }
                    LinkCtrlType::VerifyModeTransitionWithSpecificParameter => {
                        utils::data_length_check(data_len, 3, true)?
                    }
                    LinkCtrlType::TransitionMode => utils::data_length_check(data_len, 0, true)?,
                    LinkCtrlType::VehicleManufacturerSpecific(_) => {}
                    LinkCtrlType::SystemSupplierSpecific(_) => {}
                    LinkCtrlType::Reserved(_) => {}
                }

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

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

        let sub_func: LinkCtrlType = req.sub_function().unwrap().function()?;
        let data = &req.data;
        let offset = 0;
        match sub_func {
            LinkCtrlType::VerifyModeTransitionWithFixedParameter => Ok(
                Self::VerifyModeTransitionWithFixedParameter(LinkCtrlMode::try_from(data[offset])?),
            ),
            LinkCtrlType::VerifyModeTransitionWithSpecificParameter => {
                Ok(Self::VerifyModeTransitionWithSpecificParameter(
                    utils::U24::from_be_bytes([data[offset], data[offset + 1], data[offset + 2]]),
                ))
            }
            LinkCtrlType::TransitionMode => Ok(Self::TransitionMode),
            LinkCtrlType::VehicleManufacturerSpecific(_) => {
                Ok(Self::VehicleManufacturerSpecific(data[offset..].to_vec()))
            }
            LinkCtrlType::SystemSupplierSpecific(_) => {
                Ok(Self::SystemSupplierSpecific(data[offset..].to_vec()))
            }
            LinkCtrlType::Reserved(_) => Ok(Self::SystemSupplierSpecific(data[offset..].to_vec())),
        }
    }
}