iso14229-1 0.1.0

//! request of Service 3D

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

#[derive(Debug, Clone, Eq, PartialEq)]
pub struct WriteMemByAddr {
    pub mem_loc: MemoryLocation,
    pub data: Vec<u8>,
}

impl WriteMemByAddr {
    #[inline]
    pub fn new(
        alfi: AddressAndLengthFormatIdentifier,
        mem_addr: u128,
        mem_size: u128,
        data: Vec<u8>,
    ) -> Result<Self, Error> {
        if data.len() != mem_size as usize {
            return Err(Error::InvalidParam(
                "the length of data must be equal to mem_size and the mem_size must rather than 0"
                    .to_string(),
            ));
        }

        Ok(Self {
            mem_loc: MemoryLocation::new(alfi, mem_addr, mem_size)?,
            data,
        })
    }

    #[inline]
    pub fn memory_location(&self) -> &MemoryLocation {
        &self.mem_loc
    }

    #[inline]
    pub fn data_record(&self) -> &Vec<u8> {
        &self.data
    }
}

impl From<WriteMemByAddr> for Vec<u8> {
    fn from(mut v: WriteMemByAddr) -> Self {
        let mut result: Vec<_> = v.mem_loc.into();
        result.append(&mut v.data);

        result
    }
}

impl RequestData for WriteMemByAddr {
    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(_) => Err(Error::SubFunctionError(Service::WriteMemByAddr)),
            None => {
                utils::data_length_check(data.len(), 5, false)?;

                Ok(Request {
                    service: Service::WriteMemByAddr,
                    sub_func: None,
                    data: data.to_vec(),
                })
            }
        }
    }
}

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

        let data = &req.data;
        let mut offset = 0;
        let mem_loc = MemoryLocation::from_slice(data)?;
        offset += mem_loc.len();
        let data = data[offset..].to_vec();

        Ok(Self { mem_loc, data })
    }
}