use rusty_modbus_types::{Address, FunctionCode, Quantity};
use crate::error::{DecodeError, EncodeError};
use crate::request::Encode;
#[derive(Debug, Clone, Copy, PartialEq, Eq)]
pub struct ReadCoilsRequest {
pub address: Address,
pub quantity: Quantity,
}
impl ReadCoilsRequest {
const MAX_QUANTITY: u16 = 2000;
pub fn decode(data: &[u8]) -> Result<Self, DecodeError> {
DecodeError::check_exact_len(data, 4)?;
let address = Address(u16::from_be_bytes([data[0], data[1]]));
let quantity = u16::from_be_bytes([data[2], data[3]]);
if quantity == 0 || quantity > Self::MAX_QUANTITY {
return Err(DecodeError::QuantityOutOfRange { quantity });
}
Ok(Self {
address,
quantity: Quantity(quantity),
})
}
}
impl Encode for ReadCoilsRequest {
fn encode_into(&self, buf: &mut [u8]) -> Result<usize, EncodeError> {
let len = self.encoded_len();
if buf.len() < len {
return Err(EncodeError::BufferTooSmall {
required: len,
available: buf.len(),
});
}
EncodeError::check_quantity(self.quantity.0, Self::MAX_QUANTITY)?;
EncodeError::check_pdu_len(len)?;
buf[0] = FunctionCode::ReadCoils.code();
buf[1..3].copy_from_slice(&self.address.0.to_be_bytes());
buf[3..5].copy_from_slice(&self.quantity.0.to_be_bytes());
Ok(len)
}
fn encoded_len(&self) -> usize {
5
}
}
#[derive(Debug, Clone, Copy, PartialEq, Eq)]
pub struct ReadDiscreteInputsRequest {
pub address: Address,
pub quantity: Quantity,
}
impl ReadDiscreteInputsRequest {
const MAX_QUANTITY: u16 = 2000;
pub fn decode(data: &[u8]) -> Result<Self, DecodeError> {
DecodeError::check_exact_len(data, 4)?;
let address = Address(u16::from_be_bytes([data[0], data[1]]));
let quantity = u16::from_be_bytes([data[2], data[3]]);
if quantity == 0 || quantity > Self::MAX_QUANTITY {
return Err(DecodeError::QuantityOutOfRange { quantity });
}
Ok(Self {
address,
quantity: Quantity(quantity),
})
}
}
impl Encode for ReadDiscreteInputsRequest {
fn encode_into(&self, buf: &mut [u8]) -> Result<usize, EncodeError> {
let len = self.encoded_len();
if buf.len() < len {
return Err(EncodeError::BufferTooSmall {
required: len,
available: buf.len(),
});
}
EncodeError::check_quantity(self.quantity.0, Self::MAX_QUANTITY)?;
EncodeError::check_pdu_len(len)?;
buf[0] = FunctionCode::ReadDiscreteInputs.code();
buf[1..3].copy_from_slice(&self.address.0.to_be_bytes());
buf[3..5].copy_from_slice(&self.quantity.0.to_be_bytes());
Ok(len)
}
fn encoded_len(&self) -> usize {
5
}
}