uds-rs 0.3.0

A asynchronous library implementing UDS protocol over CAN used for automotive diagnostic, standardized by ISO 14229-1:2013.
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

//! # Implementation of WriteDataByIdentifier 0x2E service
//!
//! This module provides following methods for UdsClient:
//!
//! [UdsClient::write_data_by_identifier]
//!

use crate::DataFormat;
use crate::uds::uds_definitions::SEND_RECEIVE_SID_OFFSET;
use crate::uds::{EcuResponseResult, UdsClient, UdsError, UdsResponse};

const WRITE_DATA_BY_IDENTIFIER_SID: u8 = 0x2E;

#[derive(Debug, PartialEq)]
pub struct WriteDataByIdentifierResponse {
    pub data_identifier: u16,
}
impl UdsClient {
    pub async fn write_data_by_identifier(
        &self,
        data_identifier: u16,
        data_record: &[u8],
    ) -> EcuResponseResult {
        let request = compose_write_data_by_identifier_request(data_identifier, data_record);
        let raw_response = self.send_and_receive(&request).await?;
        parse_write_data_by_identifier_response(&raw_response)
    }
}

fn compose_write_data_by_identifier_request(data_identifier: u16, data_record: &[u8]) -> Vec<u8> {
    let mut ret = vec![
        WRITE_DATA_BY_IDENTIFIER_SID,
        (data_identifier >> 8) as u8,
        data_identifier as u8,
    ];
    ret.extend_from_slice(data_record);
    ret
}

fn parse_write_data_by_identifier_response(raw_response: &[u8]) -> EcuResponseResult {
    let mut response_iter = raw_response.iter();
    let sid = *response_iter.next().ok_or(UdsError::ResponseEmpty)?;
    if sid != WRITE_DATA_BY_IDENTIFIER_SID + SEND_RECEIVE_SID_OFFSET {
        return Err(UdsError::SidMismatch {
            expected: WRITE_DATA_BY_IDENTIFIER_SID + SEND_RECEIVE_SID_OFFSET,
            received: sid,
            raw_message: raw_response.to_vec(),
        });
    }
    let msb = *response_iter.next().ok_or(UdsError::InvalidLength {
        raw_message: raw_response.to_vec(),
    })?;
    let lsb = *response_iter.next().ok_or(UdsError::InvalidLength {
        raw_message: raw_response.to_vec(),
    })?;
    let data_identifier = ((msb as u16) << 8) + lsb as u16;
    let response =
        UdsResponse::WriteDataByIdentifier(DataFormat::Parsed(WriteDataByIdentifierResponse {
            data_identifier,
        }));
    Ok(response)
}