mirror of
https://github.com/openembedded/meta-openembedded.git
synced 2026-07-16 16:27:27 +00:00
libmodbus: patch CVE-2024-10918
Pick commit mentioning the bug and two follow-up commits mentioning the first commit. Tested by running the test-suite (test starter scripts were copied from scarthgap version which has them working). Signed-off-by: Peter Marko <peter.marko@siemens.com> Signed-off-by: Armin Kuster <akuster808@gmail.com>
This commit is contained in:
committed by
Armin Kuster
parent
7e18b3fc77
commit
d5fb81cbfb
@@ -8,7 +8,12 @@ SECTION = "libs"
|
|||||||
LICENSE = "LGPL-2.1-or-later"
|
LICENSE = "LGPL-2.1-or-later"
|
||||||
LIC_FILES_CHKSUM = "file://COPYING.LESSER;md5=4fbd65380cdd255951079008b364516c"
|
LIC_FILES_CHKSUM = "file://COPYING.LESSER;md5=4fbd65380cdd255951079008b364516c"
|
||||||
|
|
||||||
SRC_URI = "http://libmodbus.org/releases/${BP}.tar.gz"
|
SRC_URI = " \
|
||||||
|
http://libmodbus.org/releases/${BP}.tar.gz \
|
||||||
|
file://CVE-2024-10918-01.patch \
|
||||||
|
file://CVE-2024-10918-02.patch \
|
||||||
|
file://CVE-2024-10918-03.patch \
|
||||||
|
"
|
||||||
|
|
||||||
PACKAGECONFIG ??= ""
|
PACKAGECONFIG ??= ""
|
||||||
PACKAGECONFIG[documentation] = "--with-documentation,--without-documentation,asciidoc-native xmlto-native"
|
PACKAGECONFIG[documentation] = "--with-documentation,--without-documentation,asciidoc-native xmlto-native"
|
||||||
|
|||||||
@@ -0,0 +1,159 @@
|
|||||||
|
From df79a02feb253c0a9a009bcdbb21e47581315111 Mon Sep 17 00:00:00 2001
|
||||||
|
From: =?UTF-8?q?St=C3=A9phane=20Raimbault?= <stephane.raimbault@gmail.com>
|
||||||
|
Date: Fri, 18 Oct 2024 10:47:14 +0200
|
||||||
|
Subject: [PATCH] Check length passed to modbus_reply (write_bit)
|
||||||
|
|
||||||
|
The modbus_reply function is designed to receive arguments
|
||||||
|
from modbus_receive. This patch avoid a wrong use of memcpy if
|
||||||
|
the user chooses to inject a bad length argument.
|
||||||
|
|
||||||
|
Thank you Nozomi Networks Labs Advisory for the report.
|
||||||
|
|
||||||
|
CVE: CVE-2024-10918
|
||||||
|
Upstream-Status: Backport [https://github.com/stephane/libmodbus/commit/df79a02feb253c0a9a009bcdbb21e47581315111]
|
||||||
|
Signed-off-by: Peter Marko <peter.marko@siemens.com>
|
||||||
|
---
|
||||||
|
src/modbus.c | 42 ++++++++++++++++++++++++++--------------
|
||||||
|
tests/unit-test-client.c | 9 +++++++--
|
||||||
|
tests/unit-test-server.c | 16 ++++++++++++---
|
||||||
|
tests/unit-test.h.in | 1 +
|
||||||
|
4 files changed, 49 insertions(+), 19 deletions(-)
|
||||||
|
|
||||||
|
diff --git a/src/modbus.c b/src/modbus.c
|
||||||
|
index 5a9b867..33086ec 100644
|
||||||
|
--- a/src/modbus.c
|
||||||
|
+++ b/src/modbus.c
|
||||||
|
@@ -802,20 +802,33 @@ int modbus_reply(modbus_t *ctx, const uint8_t *req,
|
||||||
|
ctx, &sft, MODBUS_EXCEPTION_ILLEGAL_DATA_ADDRESS, rsp, FALSE,
|
||||||
|
"Illegal data address 0x%0X in write_bit\n",
|
||||||
|
address);
|
||||||
|
+ break;
|
||||||
|
+ }
|
||||||
|
+
|
||||||
|
+ /* This check is only done here to ensure using memcpy is safe. */
|
||||||
|
+ rsp_length = compute_response_length_from_request(ctx, (uint8_t *) req);
|
||||||
|
+ if (rsp_length != req_length) {
|
||||||
|
+ /* Bad use of modbus_reply */
|
||||||
|
+ rsp_length = response_exception(ctx,
|
||||||
|
+ &sft,
|
||||||
|
+ MODBUS_EXCEPTION_ILLEGAL_DATA_VALUE,
|
||||||
|
+ rsp,
|
||||||
|
+ FALSE,
|
||||||
|
+ "Invalid request length (%d)\n",
|
||||||
|
+ req_length);
|
||||||
|
+ break;
|
||||||
|
+ }
|
||||||
|
+
|
||||||
|
+ int data = (req[offset + 3] << 8) + req[offset + 4];
|
||||||
|
+ if (data == 0xFF00 || data == 0x0) {
|
||||||
|
+ mb_mapping->tab_bits[mapping_address] = data ? ON : OFF;
|
||||||
|
+ memcpy(rsp, req, rsp_length);
|
||||||
|
} else {
|
||||||
|
- int data = (req[offset + 3] << 8) + req[offset + 4];
|
||||||
|
-
|
||||||
|
- if (data == 0xFF00 || data == 0x0) {
|
||||||
|
- mb_mapping->tab_bits[mapping_address] = data ? ON : OFF;
|
||||||
|
- memcpy(rsp, req, req_length);
|
||||||
|
- rsp_length = req_length;
|
||||||
|
- } else {
|
||||||
|
- rsp_length = response_exception(
|
||||||
|
- ctx, &sft,
|
||||||
|
- MODBUS_EXCEPTION_ILLEGAL_DATA_VALUE, rsp, FALSE,
|
||||||
|
- "Illegal data value 0x%0X in write_bit request at address %0X\n",
|
||||||
|
- data, address);
|
||||||
|
- }
|
||||||
|
+ rsp_length = response_exception(
|
||||||
|
+ ctx, &sft,
|
||||||
|
+ MODBUS_EXCEPTION_ILLEGAL_DATA_VALUE, rsp, FALSE,
|
||||||
|
+ "Illegal data value 0x%0X in write_bit request at address %0X\n",
|
||||||
|
+ data, address);
|
||||||
|
}
|
||||||
|
}
|
||||||
|
break;
|
||||||
|
@@ -1687,7 +1700,8 @@ int modbus_set_byte_timeout(modbus_t *ctx, uint32_t to_sec, uint32_t to_usec)
|
||||||
|
return 0;
|
||||||
|
}
|
||||||
|
|
||||||
|
-/* Get the timeout interval used by the server to wait for an indication from a client */
|
||||||
|
+/* Get the timeout interval used by the server to wait for an indication from a client
|
||||||
|
+ */
|
||||||
|
int modbus_get_indication_timeout(modbus_t *ctx, uint32_t *to_sec, uint32_t *to_usec)
|
||||||
|
{
|
||||||
|
if (ctx == NULL) {
|
||||||
|
diff --git a/tests/unit-test-client.c b/tests/unit-test-client.c
|
||||||
|
index a441766..50859f8 100644
|
||||||
|
--- a/tests/unit-test-client.c
|
||||||
|
+++ b/tests/unit-test-client.c
|
||||||
|
@@ -362,12 +362,12 @@ int main(int argc, char *argv[])
|
||||||
|
ASSERT_TRUE(rc == -1 && errno == EMBXILADD, "");
|
||||||
|
|
||||||
|
rc = modbus_write_bits(ctx, 0, 1, tab_rp_bits);
|
||||||
|
- printf("* modbus_write_coils (0): ");
|
||||||
|
+ printf("* modbus_write_bits (0): ");
|
||||||
|
ASSERT_TRUE(rc == -1 && errno == EMBXILADD, "");
|
||||||
|
|
||||||
|
rc = modbus_write_bits(ctx, UT_BITS_ADDRESS + UT_BITS_NB,
|
||||||
|
UT_BITS_NB, tab_rp_bits);
|
||||||
|
- printf("* modbus_write_coils (max): ");
|
||||||
|
+ printf("* modbus_write_bits (max): ");
|
||||||
|
ASSERT_TRUE(rc == -1 && errno == EMBXILADD, "");
|
||||||
|
|
||||||
|
rc = modbus_write_register(ctx, 0, tab_rp_registers[0]);
|
||||||
|
@@ -445,6 +445,11 @@ int main(int argc, char *argv[])
|
||||||
|
printf("* modbus_write_registers: ");
|
||||||
|
ASSERT_TRUE(rc == -1 && errno == EMBMDATA, "");
|
||||||
|
|
||||||
|
+
|
||||||
|
+ /** BAD USE OF REPLY FUNCTION **/
|
||||||
|
+ rc = modbus_write_bit(ctx, UT_BITS_ADDRESS_INVALID_REQUEST_LENGTH, ON);
|
||||||
|
+ printf("* modbus_write_bit (triggers invalid reply): ");
|
||||||
|
+ ASSERT_TRUE(rc == -1 && errno == EMBXILVAL, "");
|
||||||
|
/** SLAVE REPLY **/
|
||||||
|
old_slave = modbus_get_slave(ctx);
|
||||||
|
|
||||||
|
diff --git a/tests/unit-test-server.c b/tests/unit-test-server.c
|
||||||
|
index 561d64d..8e28124 100644
|
||||||
|
--- a/tests/unit-test-server.c
|
||||||
|
+++ b/tests/unit-test-server.c
|
||||||
|
@@ -123,9 +123,8 @@ int main(int argc, char*argv[])
|
||||||
|
break;
|
||||||
|
}
|
||||||
|
|
||||||
|
- /* Special server behavior to test client */
|
||||||
|
- if (query[header_length] == 0x03) {
|
||||||
|
- /* Read holding registers */
|
||||||
|
+ /** Special server behavior to test client **/
|
||||||
|
+ if (query[header_length] == MODBUS_FC_READ_HOLDING_REGISTERS) {
|
||||||
|
|
||||||
|
if (MODBUS_GET_INT16_FROM_INT8(query, header_length + 3)
|
||||||
|
== UT_REGISTERS_NB_SPECIAL) {
|
||||||
|
@@ -178,6 +177,17 @@ int main(int argc, char*argv[])
|
||||||
|
}
|
||||||
|
continue;
|
||||||
|
}
|
||||||
|
+
|
||||||
|
+ } else if (query[header_length] == MODBUS_FC_WRITE_SINGLE_COIL) {
|
||||||
|
+ if (MODBUS_GET_INT16_FROM_INT8(query, header_length + 1) ==
|
||||||
|
+ UT_BITS_ADDRESS_INVALID_REQUEST_LENGTH) {
|
||||||
|
+ // The valid length is lengths of header + checkum + FC + address + value
|
||||||
|
+ // (max 12)
|
||||||
|
+ rc = 34;
|
||||||
|
+ printf("Special modbus_write_bit detected. Inject a wrong rc value (%d) "
|
||||||
|
+ "in modbus_reply\n",
|
||||||
|
+ rc);
|
||||||
|
+ }
|
||||||
|
}
|
||||||
|
|
||||||
|
rc = modbus_reply(ctx, query, rc, mb_mapping);
|
||||||
|
diff --git a/tests/unit-test.h.in b/tests/unit-test.h.in
|
||||||
|
index 5e379bb..21d09e3 100644
|
||||||
|
--- a/tests/unit-test.h.in
|
||||||
|
+++ b/tests/unit-test.h.in
|
||||||
|
@@ -28,6 +28,7 @@
|
||||||
|
const uint16_t UT_BITS_ADDRESS = 0x130;
|
||||||
|
const uint16_t UT_BITS_NB = 0x25;
|
||||||
|
const uint8_t UT_BITS_TAB[] = { 0xCD, 0x6B, 0xB2, 0x0E, 0x1B };
|
||||||
|
+const uint16_t UT_BITS_ADDRESS_INVALID_REQUEST_LENGTH = UT_BITS_ADDRESS + 2;
|
||||||
|
|
||||||
|
const uint16_t UT_INPUT_BITS_ADDRESS = 0x1C4;
|
||||||
|
const uint16_t UT_INPUT_BITS_NB = 0x16;
|
||||||
@@ -0,0 +1,113 @@
|
|||||||
|
From d8a971e04d52be16bf405b51d934a30b8aa3f2c3 Mon Sep 17 00:00:00 2001
|
||||||
|
From: =?UTF-8?q?St=C3=A9phane=20Raimbault?= <stephane.raimbault@gmail.com>
|
||||||
|
Date: Sun, 20 Oct 2024 18:02:22 +0200
|
||||||
|
Subject: [PATCH] Check length passed to modbus_reply (write_register)
|
||||||
|
|
||||||
|
Related to df79a02feb253c.
|
||||||
|
|
||||||
|
CVE: CVE-2024-10918
|
||||||
|
Upstream-Status: Backport [https://github.com/stephane/libmodbus/commit/d8a971e04d52be16bf405b51d934a30b8aa3f2c3]
|
||||||
|
Signed-off-by: Peter Marko <peter.marko@siemens.com>
|
||||||
|
---
|
||||||
|
src/modbus.c | 38 ++++++++++++++++++++++++++------------
|
||||||
|
tests/unit-test-client.c | 4 ++++
|
||||||
|
tests/unit-test-server.c | 13 +++++++++++--
|
||||||
|
3 files changed, 41 insertions(+), 14 deletions(-)
|
||||||
|
|
||||||
|
diff --git a/src/modbus.c b/src/modbus.c
|
||||||
|
index 33086ec..fe192a7 100644
|
||||||
|
--- a/src/modbus.c
|
||||||
|
+++ b/src/modbus.c
|
||||||
|
@@ -809,13 +809,14 @@ int modbus_reply(modbus_t *ctx, const uint8_t *req,
|
||||||
|
rsp_length = compute_response_length_from_request(ctx, (uint8_t *) req);
|
||||||
|
if (rsp_length != req_length) {
|
||||||
|
/* Bad use of modbus_reply */
|
||||||
|
- rsp_length = response_exception(ctx,
|
||||||
|
- &sft,
|
||||||
|
- MODBUS_EXCEPTION_ILLEGAL_DATA_VALUE,
|
||||||
|
- rsp,
|
||||||
|
- FALSE,
|
||||||
|
- "Invalid request length (%d)\n",
|
||||||
|
- req_length);
|
||||||
|
+ rsp_length =
|
||||||
|
+ response_exception(ctx,
|
||||||
|
+ &sft,
|
||||||
|
+ MODBUS_EXCEPTION_ILLEGAL_DATA_VALUE,
|
||||||
|
+ rsp,
|
||||||
|
+ FALSE,
|
||||||
|
+ "Invalid request length used in modbus_reply (%d)\n",
|
||||||
|
+ req_length);
|
||||||
|
break;
|
||||||
|
}
|
||||||
|
|
||||||
|
@@ -841,13 +842,26 @@ int modbus_reply(modbus_t *ctx, const uint8_t *req,
|
||||||
|
MODBUS_EXCEPTION_ILLEGAL_DATA_ADDRESS, rsp, FALSE,
|
||||||
|
"Illegal data address 0x%0X in write_register\n",
|
||||||
|
address);
|
||||||
|
- } else {
|
||||||
|
- int data = (req[offset + 3] << 8) + req[offset + 4];
|
||||||
|
+ break;
|
||||||
|
+ }
|
||||||
|
|
||||||
|
- mb_mapping->tab_registers[mapping_address] = data;
|
||||||
|
- memcpy(rsp, req, req_length);
|
||||||
|
- rsp_length = req_length;
|
||||||
|
+ rsp_length = compute_response_length_from_request(ctx, (uint8_t *) req);
|
||||||
|
+ if (rsp_length != req_length) {
|
||||||
|
+ /* Bad use of modbus_reply */
|
||||||
|
+ rsp_length =
|
||||||
|
+ response_exception(ctx,
|
||||||
|
+ &sft,
|
||||||
|
+ MODBUS_EXCEPTION_ILLEGAL_DATA_VALUE,
|
||||||
|
+ rsp,
|
||||||
|
+ FALSE,
|
||||||
|
+ "Invalid request length used in modbus_reply (%d)\n",
|
||||||
|
+ req_length);
|
||||||
|
+ break;
|
||||||
|
}
|
||||||
|
+ int data = (req[offset + 3] << 8) + req[offset + 4];
|
||||||
|
+
|
||||||
|
+ mb_mapping->tab_registers[mapping_address] = data;
|
||||||
|
+ memcpy(rsp, req, rsp_length);
|
||||||
|
}
|
||||||
|
break;
|
||||||
|
case MODBUS_FC_WRITE_MULTIPLE_COILS: {
|
||||||
|
diff --git a/tests/unit-test-client.c b/tests/unit-test-client.c
|
||||||
|
index 50859f8..84d5840 100644
|
||||||
|
--- a/tests/unit-test-client.c
|
||||||
|
+++ b/tests/unit-test-client.c
|
||||||
|
@@ -450,6 +450,10 @@ int main(int argc, char *argv[])
|
||||||
|
rc = modbus_write_bit(ctx, UT_BITS_ADDRESS_INVALID_REQUEST_LENGTH, ON);
|
||||||
|
printf("* modbus_write_bit (triggers invalid reply): ");
|
||||||
|
ASSERT_TRUE(rc == -1 && errno == EMBXILVAL, "");
|
||||||
|
+
|
||||||
|
+ rc = modbus_write_register(ctx, UT_REGISTERS_ADDRESS_SPECIAL, 0x42);
|
||||||
|
+ printf("* modbus_write_register (triggers invalid reply): ");
|
||||||
|
+ ASSERT_TRUE(rc == -1 && errno == EMBXILVAL, "");
|
||||||
|
/** SLAVE REPLY **/
|
||||||
|
old_slave = modbus_get_slave(ctx);
|
||||||
|
|
||||||
|
diff --git a/tests/unit-test-server.c b/tests/unit-test-server.c
|
||||||
|
index 8e28124..fc7ceb3 100644
|
||||||
|
--- a/tests/unit-test-server.c
|
||||||
|
+++ b/tests/unit-test-server.c
|
||||||
|
@@ -184,8 +184,17 @@ int main(int argc, char*argv[])
|
||||||
|
// The valid length is lengths of header + checkum + FC + address + value
|
||||||
|
// (max 12)
|
||||||
|
rc = 34;
|
||||||
|
- printf("Special modbus_write_bit detected. Inject a wrong rc value (%d) "
|
||||||
|
- "in modbus_reply\n",
|
||||||
|
+ printf(
|
||||||
|
+ "Special modbus_write_bit detected. Inject a wrong length value (%d) "
|
||||||
|
+ "in modbus_reply\n",
|
||||||
|
+ rc);
|
||||||
|
+ }
|
||||||
|
+ } else if (query[header_length] == MODBUS_FC_WRITE_SINGLE_REGISTER) {
|
||||||
|
+ if (MODBUS_GET_INT16_FROM_INT8(query, header_length + 1) ==
|
||||||
|
+ UT_REGISTERS_ADDRESS_SPECIAL) {
|
||||||
|
+ rc = 45;
|
||||||
|
+ printf("Special modbus_write_register detected. Inject a wrong length "
|
||||||
|
+ "value (%d) in modbus_reply\n",
|
||||||
|
rc);
|
||||||
|
}
|
||||||
|
}
|
||||||
@@ -0,0 +1,240 @@
|
|||||||
|
From 81bf713cf029bfa5b5da87b945c1e8817b4398f9 Mon Sep 17 00:00:00 2001
|
||||||
|
From: =?UTF-8?q?St=C3=A9phane=20Raimbault?= <stephane.raimbault@gmail.com>
|
||||||
|
Date: Mon, 21 Oct 2024 17:32:39 +0200
|
||||||
|
Subject: [PATCH] Fix request length check in modbus_reply in RTU
|
||||||
|
|
||||||
|
- rename internal *_prepare_response_tid to *_get_response_tid
|
||||||
|
- change signature, don't need req length anymore
|
||||||
|
- remove misleading modification of req_length
|
||||||
|
- check of req length before use in memcpy for mask write register
|
||||||
|
|
||||||
|
Related to df79a02feb253c0a9a009bcdbb21e47581315111
|
||||||
|
|
||||||
|
CVE: CVE-2024-10918
|
||||||
|
Upstream-Status: Backport [https://github.com/stephane/libmodbus/commit/81bf713cf029bfa5b5da87b945c1e8817b4398f9]
|
||||||
|
Signed-off-by: Peter Marko <peter.marko@siemens.com>
|
||||||
|
---
|
||||||
|
src/modbus-private.h | 2 +-
|
||||||
|
src/modbus-rtu.c | 5 ++--
|
||||||
|
src/modbus-tcp.c | 7 ++---
|
||||||
|
src/modbus.c | 71 ++++++++++++++++++++++++++++----------------
|
||||||
|
4 files changed, 52 insertions(+), 33 deletions(-)
|
||||||
|
|
||||||
|
diff --git a/src/modbus-private.h b/src/modbus-private.h
|
||||||
|
index 6cd3424..ea83187 100644
|
||||||
|
--- a/src/modbus-private.h
|
||||||
|
+++ b/src/modbus-private.h
|
||||||
|
@@ -73,7 +73,7 @@ typedef struct _modbus_backend {
|
||||||
|
int (*build_request_basis) (modbus_t *ctx, int function, int addr,
|
||||||
|
int nb, uint8_t *req);
|
||||||
|
int (*build_response_basis) (sft_t *sft, uint8_t *rsp);
|
||||||
|
- int (*prepare_response_tid) (const uint8_t *req, int *req_length);
|
||||||
|
+ int (*get_response_tid)(const uint8_t *req);
|
||||||
|
int (*send_msg_pre) (uint8_t *req, int req_length);
|
||||||
|
ssize_t (*send) (modbus_t *ctx, const uint8_t *req, int req_length);
|
||||||
|
int (*receive) (modbus_t *ctx, uint8_t *req);
|
||||||
|
diff --git a/src/modbus-rtu.c b/src/modbus-rtu.c
|
||||||
|
index b774923..8b5ee08 100644
|
||||||
|
--- a/src/modbus-rtu.c
|
||||||
|
+++ b/src/modbus-rtu.c
|
||||||
|
@@ -145,9 +145,8 @@ static uint16_t crc16(uint8_t *buffer, uint16_t buffer_length)
|
||||||
|
return (crc_hi << 8 | crc_lo);
|
||||||
|
}
|
||||||
|
|
||||||
|
-static int _modbus_rtu_prepare_response_tid(const uint8_t *req, int *req_length)
|
||||||
|
+static int _modbus_rtu_get_response_tid(const uint8_t *req)
|
||||||
|
{
|
||||||
|
- (*req_length) -= _MODBUS_RTU_CHECKSUM_LENGTH;
|
||||||
|
/* No TID */
|
||||||
|
return 0;
|
||||||
|
}
|
||||||
|
@@ -1204,7 +1203,7 @@ const modbus_backend_t _modbus_rtu_backend = {
|
||||||
|
_modbus_set_slave,
|
||||||
|
_modbus_rtu_build_request_basis,
|
||||||
|
_modbus_rtu_build_response_basis,
|
||||||
|
- _modbus_rtu_prepare_response_tid,
|
||||||
|
+ _modbus_rtu_get_response_tid,
|
||||||
|
_modbus_rtu_send_msg_pre,
|
||||||
|
_modbus_rtu_send,
|
||||||
|
_modbus_rtu_receive,
|
||||||
|
diff --git a/src/modbus-tcp.c b/src/modbus-tcp.c
|
||||||
|
index f8ef4e8..4ee82a7 100644
|
||||||
|
--- a/src/modbus-tcp.c
|
||||||
|
+++ b/src/modbus-tcp.c
|
||||||
|
@@ -146,8 +146,7 @@ static int _modbus_tcp_build_response_basis(sft_t *sft, uint8_t *rsp)
|
||||||
|
return _MODBUS_TCP_PRESET_RSP_LENGTH;
|
||||||
|
}
|
||||||
|
|
||||||
|
-
|
||||||
|
-static int _modbus_tcp_prepare_response_tid(const uint8_t *req, int *req_length)
|
||||||
|
+static int _modbus_tcp_get_response_tid(const uint8_t *req)
|
||||||
|
{
|
||||||
|
return (req[0] << 8) + req[1];
|
||||||
|
}
|
||||||
|
@@ -752,7 +751,7 @@ const modbus_backend_t _modbus_tcp_backend = {
|
||||||
|
_modbus_set_slave,
|
||||||
|
_modbus_tcp_build_request_basis,
|
||||||
|
_modbus_tcp_build_response_basis,
|
||||||
|
- _modbus_tcp_prepare_response_tid,
|
||||||
|
+ _modbus_tcp_get_response_tid,
|
||||||
|
_modbus_tcp_send_msg_pre,
|
||||||
|
_modbus_tcp_send,
|
||||||
|
_modbus_tcp_receive,
|
||||||
|
@@ -775,7 +774,7 @@ const modbus_backend_t _modbus_tcp_pi_backend = {
|
||||||
|
_modbus_set_slave,
|
||||||
|
_modbus_tcp_build_request_basis,
|
||||||
|
_modbus_tcp_build_response_basis,
|
||||||
|
- _modbus_tcp_prepare_response_tid,
|
||||||
|
+ _modbus_tcp_get_response_tid,
|
||||||
|
_modbus_tcp_send_msg_pre,
|
||||||
|
_modbus_tcp_send,
|
||||||
|
_modbus_tcp_receive,
|
||||||
|
diff --git a/src/modbus.c b/src/modbus.c
|
||||||
|
index fe192a7..e3737bb 100644
|
||||||
|
--- a/src/modbus.c
|
||||||
|
+++ b/src/modbus.c
|
||||||
|
@@ -125,7 +125,7 @@ int modbus_flush(modbus_t *ctx)
|
||||||
|
return rc;
|
||||||
|
}
|
||||||
|
|
||||||
|
-/* Computes the length of the expected response */
|
||||||
|
+/* Computes the length of the expected response including checksum */
|
||||||
|
static unsigned int compute_response_length_from_request(modbus_t *ctx, uint8_t *req)
|
||||||
|
{
|
||||||
|
int length;
|
||||||
|
@@ -366,8 +366,7 @@ int _modbus_receive_msg(modbus_t *ctx, uint8_t *msg, msg_type_t msg_type)
|
||||||
|
length_to_read = ctx->backend->header_length + 1;
|
||||||
|
|
||||||
|
if (msg_type == MSG_INDICATION) {
|
||||||
|
- /* Wait for a message, we don't know when the message will be
|
||||||
|
- * received */
|
||||||
|
+ /* Wait for a message, we don't know when the message will be received */
|
||||||
|
if (ctx->indication_timeout.tv_sec == 0 && ctx->indication_timeout.tv_usec == 0) {
|
||||||
|
/* By default, the indication timeout isn't set */
|
||||||
|
p_tv = NULL;
|
||||||
|
@@ -725,7 +724,7 @@ int modbus_reply(modbus_t *ctx, const uint8_t *req,
|
||||||
|
|
||||||
|
sft.slave = slave;
|
||||||
|
sft.function = function;
|
||||||
|
- sft.t_id = ctx->backend->prepare_response_tid(req, &req_length);
|
||||||
|
+ sft.t_id = ctx->backend->get_response_tid(req);
|
||||||
|
|
||||||
|
/* Data are flushed on illegal number of values errors. */
|
||||||
|
switch (function) {
|
||||||
|
@@ -800,7 +799,7 @@ int modbus_reply(modbus_t *ctx, const uint8_t *req,
|
||||||
|
if (mapping_address < 0 || mapping_address >= mb_mapping->nb_bits) {
|
||||||
|
rsp_length = response_exception(
|
||||||
|
ctx, &sft, MODBUS_EXCEPTION_ILLEGAL_DATA_ADDRESS, rsp, FALSE,
|
||||||
|
- "Illegal data address 0x%0X in write_bit\n",
|
||||||
|
+ "Illegal data address 0x%0X in write bit\n",
|
||||||
|
address);
|
||||||
|
break;
|
||||||
|
}
|
||||||
|
@@ -809,20 +808,26 @@ int modbus_reply(modbus_t *ctx, const uint8_t *req,
|
||||||
|
rsp_length = compute_response_length_from_request(ctx, (uint8_t *) req);
|
||||||
|
if (rsp_length != req_length) {
|
||||||
|
/* Bad use of modbus_reply */
|
||||||
|
- rsp_length =
|
||||||
|
- response_exception(ctx,
|
||||||
|
- &sft,
|
||||||
|
- MODBUS_EXCEPTION_ILLEGAL_DATA_VALUE,
|
||||||
|
- rsp,
|
||||||
|
- FALSE,
|
||||||
|
- "Invalid request length used in modbus_reply (%d)\n",
|
||||||
|
- req_length);
|
||||||
|
+ rsp_length = response_exception(
|
||||||
|
+ ctx,
|
||||||
|
+ &sft,
|
||||||
|
+ MODBUS_EXCEPTION_ILLEGAL_DATA_VALUE,
|
||||||
|
+ rsp,
|
||||||
|
+ FALSE,
|
||||||
|
+ "Invalid request length in modbus_reply to write bit (%d)\n",
|
||||||
|
+ req_length);
|
||||||
|
break;
|
||||||
|
}
|
||||||
|
|
||||||
|
+ /* Don't copy the CRC, if any, it will be computed later (even if identical to the
|
||||||
|
+ * request) */
|
||||||
|
+ rsp_length -= ctx->backend->checksum_length;
|
||||||
|
+
|
||||||
|
int data = (req[offset + 3] << 8) + req[offset + 4];
|
||||||
|
if (data == 0xFF00 || data == 0x0) {
|
||||||
|
+ /* Apply the change to mapping */
|
||||||
|
mb_mapping->tab_bits[mapping_address] = data ? ON : OFF;
|
||||||
|
+ /* Prepare response */
|
||||||
|
memcpy(rsp, req, rsp_length);
|
||||||
|
} else {
|
||||||
|
rsp_length = response_exception(
|
||||||
|
@@ -848,19 +853,21 @@ int modbus_reply(modbus_t *ctx, const uint8_t *req,
|
||||||
|
rsp_length = compute_response_length_from_request(ctx, (uint8_t *) req);
|
||||||
|
if (rsp_length != req_length) {
|
||||||
|
/* Bad use of modbus_reply */
|
||||||
|
- rsp_length =
|
||||||
|
- response_exception(ctx,
|
||||||
|
- &sft,
|
||||||
|
- MODBUS_EXCEPTION_ILLEGAL_DATA_VALUE,
|
||||||
|
- rsp,
|
||||||
|
- FALSE,
|
||||||
|
- "Invalid request length used in modbus_reply (%d)\n",
|
||||||
|
- req_length);
|
||||||
|
+ rsp_length = response_exception(
|
||||||
|
+ ctx,
|
||||||
|
+ &sft,
|
||||||
|
+ MODBUS_EXCEPTION_ILLEGAL_DATA_VALUE,
|
||||||
|
+ rsp,
|
||||||
|
+ FALSE,
|
||||||
|
+ "Invalid request length in modbus_reply to write register (%d)\n",
|
||||||
|
+ req_length);
|
||||||
|
break;
|
||||||
|
}
|
||||||
|
int data = (req[offset + 3] << 8) + req[offset + 4];
|
||||||
|
|
||||||
|
mb_mapping->tab_registers[mapping_address] = data;
|
||||||
|
+
|
||||||
|
+ rsp_length -= ctx->backend->checksum_length;
|
||||||
|
memcpy(rsp, req, rsp_length);
|
||||||
|
}
|
||||||
|
break;
|
||||||
|
@@ -966,8 +973,23 @@ int modbus_reply(modbus_t *ctx, const uint8_t *req,
|
||||||
|
|
||||||
|
data = (data & and) | (or & (~and));
|
||||||
|
mb_mapping->tab_registers[mapping_address] = data;
|
||||||
|
- memcpy(rsp, req, req_length);
|
||||||
|
- rsp_length = req_length;
|
||||||
|
+
|
||||||
|
+ rsp_length = compute_response_length_from_request(ctx, (uint8_t *) req);
|
||||||
|
+ if (rsp_length != req_length) {
|
||||||
|
+ /* Bad use of modbus_reply */
|
||||||
|
+ rsp_length = response_exception(ctx,
|
||||||
|
+ &sft,
|
||||||
|
+ MODBUS_EXCEPTION_ILLEGAL_DATA_VALUE,
|
||||||
|
+ rsp,
|
||||||
|
+ FALSE,
|
||||||
|
+ "Invalid request length in modbus_reply "
|
||||||
|
+ "to mask write register (%d)\n",
|
||||||
|
+ req_length);
|
||||||
|
+ break;
|
||||||
|
+ }
|
||||||
|
+
|
||||||
|
+ rsp_length -= ctx->backend->checksum_length;
|
||||||
|
+ memcpy(rsp, req, rsp_length);
|
||||||
|
}
|
||||||
|
}
|
||||||
|
break;
|
||||||
|
@@ -1037,7 +1059,6 @@ int modbus_reply_exception(modbus_t *ctx, const uint8_t *req,
|
||||||
|
int function;
|
||||||
|
uint8_t rsp[MAX_MESSAGE_LENGTH];
|
||||||
|
int rsp_length;
|
||||||
|
- int dummy_length = 99;
|
||||||
|
sft_t sft;
|
||||||
|
|
||||||
|
if (ctx == NULL) {
|
||||||
|
@@ -1051,7 +1072,7 @@ int modbus_reply_exception(modbus_t *ctx, const uint8_t *req,
|
||||||
|
|
||||||
|
sft.slave = slave;
|
||||||
|
sft.function = function + 0x80;
|
||||||
|
- sft.t_id = ctx->backend->prepare_response_tid(req, &dummy_length);
|
||||||
|
+ sft.t_id = ctx->backend->get_response_tid(req);
|
||||||
|
rsp_length = ctx->backend->build_response_basis(&sft, rsp);
|
||||||
|
|
||||||
|
/* Positive exception code */
|
||||||
Reference in New Issue
Block a user