From 8fc65aa2cf61c540df9002fd9f33bfc7de34cd4c Mon Sep 17 00:00:00 2001 From: Valerio De Benedetto Date: Tue, 26 Apr 2022 00:05:13 +0200 Subject: [PATCH] Fixed wrong size field in MBAP header --- nanomodbus.c | 4 ++-- 1 file changed, 2 insertions(+), 2 deletions(-) diff --git a/nanomodbus.c b/nanomodbus.c index 1c327b5..3f996e8 100644 --- a/nanomodbus.c +++ b/nanomodbus.c @@ -475,7 +475,7 @@ static nmbs_error handle_read_discrete(nmbs_t* nmbs, nmbs_error (*callback)(uint if (!nmbs->msg.broadcast) { uint8_t discrete_bytes = (quantity / 8) + 1; - send_res_header(nmbs, discrete_bytes); + send_res_header(nmbs, 1 + discrete_bytes); put_1(nmbs, discrete_bytes); @@ -536,7 +536,7 @@ static nmbs_error handle_read_registers(nmbs_t* nmbs, nmbs_error (*callback)(uin if (!nmbs->msg.broadcast) { uint8_t regs_bytes = quantity * 2; - send_res_header(nmbs, regs_bytes); + send_res_header(nmbs, 1 + regs_bytes); put_1(nmbs, regs_bytes);