use mbrtu::{ModbusRequest, ModbusResponse};
pub fn print_request(addr: u8, request: ModbusRequest) {
match request {
ModbusRequest::ReadHoldingRegisters(m) => {
println!(
"addr={addr} ReadHoldingRegisters starting_address={} quantity={}",
m.starting_address, m.quantity
);
}
ModbusRequest::ReadCoils(m) => {
println!(
"addr={addr} ReadCoils starting_address={} quantity={}",
m.starting_address, m.quantity
);
}
ModbusRequest::WriteSingleRegister(m) => {
println!(
"addr={addr} WriteSingleRegister address={} value={}",
m.address, m.value
);
}
other => println!("addr={addr} <unhandled request: {other:?}>"),
}
}
pub fn print_response(addr: u8, response: &ModbusResponse) {
match response {
ModbusResponse::ReadHoldingRegisters(m) => {
print!("addr={addr} ReadHoldingRegisters registers=[");
for (i, reg) in m.registers.iter().take(usize::from(m.count)).enumerate() {
if i > 0 {
print!(", ");
}
print!("{reg:#06x}");
}
println!("]");
}
ModbusResponse::ReadCoils(m) => {
print!("addr={addr} ReadCoils bits=[");
for i in 0..usize::from(m.byte_count) * 8 {
print!("{}", i32::from(m.get(i) == Some(true)));
}
println!("]");
}
ModbusResponse::WriteSingleRegister(m) => {
println!(
"addr={addr} WriteSingleRegister address={} value={}",
m.address, m.value
);
}
ModbusResponse::Exception(e) => {
println!(
"addr={addr} Exception function_code={:#04x} exception_code={:?}",
e.function_code, e.exception_code
);
}
other => println!("addr={addr} <unhandled response: {other:?}>"),
}
}