|
@@ -4,12 +4,12 @@
|
|
|
* SPDX-License-Identifier: BSD-3-Clause
|
|
|
*/
|
|
|
|
|
|
-#include <stdio.h>
|
|
|
-#include <unistd.h>
|
|
|
-#include <string.h>
|
|
|
-#include <stdlib.h>
|
|
|
#include <errno.h>
|
|
|
#include <modbus.h>
|
|
|
+#include <stdio.h>
|
|
|
+#include <stdlib.h>
|
|
|
+#include <string.h>
|
|
|
+#include <unistd.h>
|
|
|
|
|
|
#include "unit-test.h"
|
|
|
|
|
@@ -22,31 +22,37 @@ enum {
|
|
|
};
|
|
|
|
|
|
int test_server(modbus_t *ctx, int use_backend);
|
|
|
-int send_crafted_request(modbus_t *ctx, int function,
|
|
|
- uint8_t *req, int req_size,
|
|
|
- uint16_t max_value, uint16_t bytes,
|
|
|
- int backend_length, int backend_offset);
|
|
|
+int send_crafted_request(modbus_t *ctx,
|
|
|
+ int function,
|
|
|
+ uint8_t *req,
|
|
|
+ int req_size,
|
|
|
+ uint16_t max_value,
|
|
|
+ uint16_t bytes,
|
|
|
+ int backend_length,
|
|
|
+ int backend_offset);
|
|
|
int equal_dword(uint16_t *tab_reg, const uint32_t value);
|
|
|
int is_memory_equal(const void *s1, const void *s2, size_t size);
|
|
|
|
|
|
-#define BUG_REPORT(_cond, _format, _args ...) \
|
|
|
- printf("\nLine %d: assertion error for '%s': " _format "\n", __LINE__, # _cond, ## _args)
|
|
|
+#define BUG_REPORT(_cond, _format, _args...) \
|
|
|
+ printf("\nLine %d: assertion error for '%s': " _format "\n", __LINE__, #_cond, ##_args)
|
|
|
|
|
|
-#define ASSERT_TRUE(_cond, _format, __args...) { \
|
|
|
- if (_cond) { \
|
|
|
- printf("OK\n"); \
|
|
|
- } else { \
|
|
|
- BUG_REPORT(_cond, _format, ## __args); \
|
|
|
- goto close; \
|
|
|
- } \
|
|
|
-};
|
|
|
+#define ASSERT_TRUE(_cond, _format, __args...) \
|
|
|
+ { \
|
|
|
+ if (_cond) { \
|
|
|
+ printf("OK\n"); \
|
|
|
+ } else { \
|
|
|
+ BUG_REPORT(_cond, _format, ##__args); \
|
|
|
+ goto close; \
|
|
|
+ } \
|
|
|
+ };
|
|
|
|
|
|
int is_memory_equal(const void *s1, const void *s2, size_t size)
|
|
|
{
|
|
|
return (memcmp(s1, s2, size) == 0);
|
|
|
}
|
|
|
|
|
|
-int equal_dword(uint16_t *tab_reg, const uint32_t value) {
|
|
|
+int equal_dword(uint16_t *tab_reg, const uint32_t value)
|
|
|
+{
|
|
|
return ((tab_reg[0] == (value >> 16)) && (tab_reg[1] == (value & 0xFFFF)));
|
|
|
}
|
|
|
|
|
@@ -80,7 +86,8 @@ int main(int argc, char *argv[])
|
|
|
} else if (strcmp(argv[1], "rtu") == 0) {
|
|
|
use_backend = RTU;
|
|
|
} else {
|
|
|
- printf("Usage:\n %s [tcp|tcppi|rtu] - Modbus client for unit testing\n\n", argv[0]);
|
|
|
+ printf("Usage:\n %s [tcp|tcppi|rtu] - Modbus client for unit testing\n\n",
|
|
|
+ argv[0]);
|
|
|
exit(1);
|
|
|
}
|
|
|
} else {
|
|
@@ -100,9 +107,8 @@ int main(int argc, char *argv[])
|
|
|
return -1;
|
|
|
}
|
|
|
modbus_set_debug(ctx, TRUE);
|
|
|
- modbus_set_error_recovery(ctx,
|
|
|
- MODBUS_ERROR_RECOVERY_LINK |
|
|
|
- MODBUS_ERROR_RECOVERY_PROTOCOL);
|
|
|
+ modbus_set_error_recovery(
|
|
|
+ ctx, MODBUS_ERROR_RECOVERY_LINK | MODBUS_ERROR_RECOVERY_PROTOCOL);
|
|
|
|
|
|
if (use_backend == RTU) {
|
|
|
modbus_set_slave(ctx, SERVER_ID);
|
|
@@ -121,8 +127,8 @@ int main(int argc, char *argv[])
|
|
|
memset(tab_rp_bits, 0, nb_points * sizeof(uint8_t));
|
|
|
|
|
|
/* Allocate and initialize the memory to store the registers */
|
|
|
- nb_points = (UT_REGISTERS_NB > UT_INPUT_REGISTERS_NB) ?
|
|
|
- UT_REGISTERS_NB : UT_INPUT_REGISTERS_NB;
|
|
|
+ nb_points = (UT_REGISTERS_NB > UT_INPUT_REGISTERS_NB) ? UT_REGISTERS_NB
|
|
|
+ : UT_INPUT_REGISTERS_NB;
|
|
|
tab_rp_registers = (uint16_t *) malloc(nb_points * sizeof(uint16_t));
|
|
|
memset(tab_rp_registers, 0, nb_points * sizeof(uint16_t));
|
|
|
|
|
@@ -131,7 +137,8 @@ int main(int argc, char *argv[])
|
|
|
printf("1/1 No response timeout modification on connect: ");
|
|
|
modbus_get_response_timeout(ctx, &new_response_to_sec, &new_response_to_usec);
|
|
|
ASSERT_TRUE(old_response_to_sec == new_response_to_sec &&
|
|
|
- old_response_to_usec == new_response_to_usec, "");
|
|
|
+ old_response_to_usec == new_response_to_usec,
|
|
|
+ "");
|
|
|
|
|
|
printf("\nTEST WRITE/READ:\n");
|
|
|
|
|
@@ -145,8 +152,7 @@ int main(int argc, char *argv[])
|
|
|
rc = modbus_read_bits(ctx, UT_BITS_ADDRESS, 1, tab_rp_bits);
|
|
|
printf("2/2 modbus_read_bits: ");
|
|
|
ASSERT_TRUE(rc == 1, "FAILED (nb points %d)\n", rc);
|
|
|
- ASSERT_TRUE(tab_rp_bits[0] == ON, "FAILED (%0X != %0X)\n",
|
|
|
- tab_rp_bits[0], ON);
|
|
|
+ ASSERT_TRUE(tab_rp_bits[0] == ON, "FAILED (%0X != %0X)\n", tab_rp_bits[0], ON);
|
|
|
|
|
|
/* End single */
|
|
|
|
|
@@ -169,9 +175,9 @@ int main(int argc, char *argv[])
|
|
|
while (nb_points > 0) {
|
|
|
int nb_bits = (nb_points > 8) ? 8 : nb_points;
|
|
|
|
|
|
- value = modbus_get_byte_from_bits(tab_rp_bits, i*8, nb_bits);
|
|
|
- ASSERT_TRUE(value == UT_BITS_TAB[i], "FAILED (%0X != %0X)\n",
|
|
|
- value, UT_BITS_TAB[i]);
|
|
|
+ value = modbus_get_byte_from_bits(tab_rp_bits, i * 8, nb_bits);
|
|
|
+ ASSERT_TRUE(
|
|
|
+ value == UT_BITS_TAB[i], "FAILED (%0X != %0X)\n", value, UT_BITS_TAB[i]);
|
|
|
|
|
|
nb_points -= nb_bits;
|
|
|
i++;
|
|
@@ -180,8 +186,8 @@ int main(int argc, char *argv[])
|
|
|
/* End of multiple bits */
|
|
|
|
|
|
/** DISCRETE INPUTS **/
|
|
|
- rc = modbus_read_input_bits(ctx, UT_INPUT_BITS_ADDRESS,
|
|
|
- UT_INPUT_BITS_NB, tab_rp_bits);
|
|
|
+ rc =
|
|
|
+ modbus_read_input_bits(ctx, UT_INPUT_BITS_ADDRESS, UT_INPUT_BITS_NB, tab_rp_bits);
|
|
|
printf("1/1 modbus_read_input_bits: ");
|
|
|
ASSERT_TRUE(rc == UT_INPUT_BITS_NB, "FAILED (nb points %d)\n", rc);
|
|
|
|
|
@@ -189,9 +195,11 @@ int main(int argc, char *argv[])
|
|
|
nb_points = UT_INPUT_BITS_NB;
|
|
|
while (nb_points > 0) {
|
|
|
int nb_bits = (nb_points > 8) ? 8 : nb_points;
|
|
|
- value = modbus_get_byte_from_bits(tab_rp_bits, i*8, nb_bits);
|
|
|
- ASSERT_TRUE(value == UT_INPUT_BITS_TAB[i], "FAILED (%0X != %0X)\n",
|
|
|
- value, UT_INPUT_BITS_TAB[i]);
|
|
|
+ value = modbus_get_byte_from_bits(tab_rp_bits, i * 8, nb_bits);
|
|
|
+ ASSERT_TRUE(value == UT_INPUT_BITS_TAB[i],
|
|
|
+ "FAILED (%0X != %0X)\n",
|
|
|
+ value,
|
|
|
+ UT_INPUT_BITS_TAB[i]);
|
|
|
|
|
|
nb_points -= nb_bits;
|
|
|
i++;
|
|
@@ -205,39 +213,39 @@ int main(int argc, char *argv[])
|
|
|
printf("1/2 modbus_write_register: ");
|
|
|
ASSERT_TRUE(rc == 1, "");
|
|
|
|
|
|
- rc = modbus_read_registers(ctx, UT_REGISTERS_ADDRESS,
|
|
|
- 1, tab_rp_registers);
|
|
|
+ rc = modbus_read_registers(ctx, UT_REGISTERS_ADDRESS, 1, tab_rp_registers);
|
|
|
printf("2/2 modbus_read_registers: ");
|
|
|
ASSERT_TRUE(rc == 1, "FAILED (nb points %d)\n", rc);
|
|
|
- ASSERT_TRUE(tab_rp_registers[0] == 0x1234, "FAILED (%0X != %0X)\n",
|
|
|
- tab_rp_registers[0], 0x1234);
|
|
|
+ ASSERT_TRUE(tab_rp_registers[0] == 0x1234,
|
|
|
+ "FAILED (%0X != %0X)\n",
|
|
|
+ tab_rp_registers[0],
|
|
|
+ 0x1234);
|
|
|
/* End of single register */
|
|
|
|
|
|
/* Many registers */
|
|
|
- rc = modbus_write_registers(ctx, UT_REGISTERS_ADDRESS,
|
|
|
- UT_REGISTERS_NB, UT_REGISTERS_TAB);
|
|
|
+ rc = modbus_write_registers(
|
|
|
+ ctx, UT_REGISTERS_ADDRESS, UT_REGISTERS_NB, UT_REGISTERS_TAB);
|
|
|
printf("1/5 modbus_write_registers: ");
|
|
|
ASSERT_TRUE(rc == UT_REGISTERS_NB, "");
|
|
|
|
|
|
- rc = modbus_read_registers(ctx, UT_REGISTERS_ADDRESS,
|
|
|
- UT_REGISTERS_NB, tab_rp_registers);
|
|
|
+ rc = modbus_read_registers(
|
|
|
+ ctx, UT_REGISTERS_ADDRESS, UT_REGISTERS_NB, tab_rp_registers);
|
|
|
printf("2/5 modbus_read_registers: ");
|
|
|
ASSERT_TRUE(rc == UT_REGISTERS_NB, "FAILED (nb points %d)\n", rc);
|
|
|
|
|
|
- for (i=0; i < UT_REGISTERS_NB; i++) {
|
|
|
+ for (i = 0; i < UT_REGISTERS_NB; i++) {
|
|
|
ASSERT_TRUE(tab_rp_registers[i] == UT_REGISTERS_TAB[i],
|
|
|
"FAILED (%0X != %0X)\n",
|
|
|
- tab_rp_registers[i], UT_REGISTERS_TAB[i]);
|
|
|
+ tab_rp_registers[i],
|
|
|
+ UT_REGISTERS_TAB[i]);
|
|
|
}
|
|
|
|
|
|
- rc = modbus_read_registers(ctx, UT_REGISTERS_ADDRESS,
|
|
|
- 0, tab_rp_registers);
|
|
|
+ rc = modbus_read_registers(ctx, UT_REGISTERS_ADDRESS, 0, tab_rp_registers);
|
|
|
printf("3/5 modbus_read_registers (0): ");
|
|
|
ASSERT_TRUE(rc == -1, "FAILED (nb_points %d)\n", rc);
|
|
|
|
|
|
- nb_points = (UT_REGISTERS_NB >
|
|
|
- UT_INPUT_REGISTERS_NB) ?
|
|
|
- UT_REGISTERS_NB : UT_INPUT_REGISTERS_NB;
|
|
|
+ nb_points = (UT_REGISTERS_NB > UT_INPUT_REGISTERS_NB) ? UT_REGISTERS_NB
|
|
|
+ : UT_INPUT_REGISTERS_NB;
|
|
|
memset(tab_rp_registers, 0, nb_points * sizeof(uint16_t));
|
|
|
|
|
|
/* Write registers to zero from tab_rp_registers and store read registers
|
|
@@ -251,32 +259,32 @@ int main(int argc, char *argv[])
|
|
|
UT_REGISTERS_NB,
|
|
|
tab_rp_registers);
|
|
|
printf("4/5 modbus_write_and_read_registers: ");
|
|
|
- ASSERT_TRUE(rc == UT_REGISTERS_NB, "FAILED (nb points %d != %d)\n",
|
|
|
- rc, UT_REGISTERS_NB);
|
|
|
+ ASSERT_TRUE(
|
|
|
+ rc == UT_REGISTERS_NB, "FAILED (nb points %d != %d)\n", rc, UT_REGISTERS_NB);
|
|
|
|
|
|
ASSERT_TRUE(tab_rp_registers[0] == UT_REGISTERS_TAB[0],
|
|
|
"FAILED (%0X != %0X)\n",
|
|
|
- tab_rp_registers[0], UT_REGISTERS_TAB[0]);
|
|
|
+ tab_rp_registers[0],
|
|
|
+ UT_REGISTERS_TAB[0]);
|
|
|
|
|
|
- for (i=1; i < UT_REGISTERS_NB; i++) {
|
|
|
- ASSERT_TRUE(tab_rp_registers[i] == 0, "FAILED (%0X != %0X)\n",
|
|
|
- tab_rp_registers[i], 0);
|
|
|
+ for (i = 1; i < UT_REGISTERS_NB; i++) {
|
|
|
+ ASSERT_TRUE(
|
|
|
+ tab_rp_registers[i] == 0, "FAILED (%0X != %0X)\n", tab_rp_registers[i], 0);
|
|
|
}
|
|
|
|
|
|
/* End of many registers */
|
|
|
|
|
|
-
|
|
|
/** INPUT REGISTERS **/
|
|
|
- rc = modbus_read_input_registers(ctx, UT_INPUT_REGISTERS_ADDRESS,
|
|
|
- UT_INPUT_REGISTERS_NB,
|
|
|
- tab_rp_registers);
|
|
|
+ rc = modbus_read_input_registers(
|
|
|
+ ctx, UT_INPUT_REGISTERS_ADDRESS, UT_INPUT_REGISTERS_NB, tab_rp_registers);
|
|
|
printf("1/1 modbus_read_input_registers: ");
|
|
|
ASSERT_TRUE(rc == UT_INPUT_REGISTERS_NB, "FAILED (nb points %d)\n", rc);
|
|
|
|
|
|
- for (i=0; i < UT_INPUT_REGISTERS_NB; i++) {
|
|
|
+ for (i = 0; i < UT_INPUT_REGISTERS_NB; i++) {
|
|
|
ASSERT_TRUE(tab_rp_registers[i] == UT_INPUT_REGISTERS_TAB[i],
|
|
|
"FAILED (%0X != %0X)\n",
|
|
|
- tab_rp_registers[i], UT_INPUT_REGISTERS_TAB[i]);
|
|
|
+ tab_rp_registers[i],
|
|
|
+ UT_INPUT_REGISTERS_TAB[i]);
|
|
|
}
|
|
|
|
|
|
/* MASKS */
|
|
@@ -285,33 +293,36 @@ int main(int argc, char *argv[])
|
|
|
rc = modbus_mask_write_register(ctx, UT_REGISTERS_ADDRESS, 0xF2, 0x25);
|
|
|
ASSERT_TRUE(rc != -1, "FAILED (%x == -1)\n", rc);
|
|
|
rc = modbus_read_registers(ctx, UT_REGISTERS_ADDRESS, 1, tab_rp_registers);
|
|
|
- ASSERT_TRUE(tab_rp_registers[0] == 0x17,
|
|
|
- "FAILED (%0X != %0X)\n",
|
|
|
- tab_rp_registers[0], 0x17);
|
|
|
+ ASSERT_TRUE(
|
|
|
+ tab_rp_registers[0] == 0x17, "FAILED (%0X != %0X)\n", tab_rp_registers[0], 0x17);
|
|
|
|
|
|
printf("\nTEST FLOATS\n");
|
|
|
/** FLOAT **/
|
|
|
printf("1/4 Set/get float ABCD: ");
|
|
|
modbus_set_float_abcd(UT_REAL, tab_rp_registers);
|
|
|
- ASSERT_TRUE(is_memory_equal(tab_rp_registers, UT_IREAL_ABCD_SET, 4), "FAILED Set float ABCD");
|
|
|
+ ASSERT_TRUE(is_memory_equal(tab_rp_registers, UT_IREAL_ABCD_SET, 4),
|
|
|
+ "FAILED Set float ABCD");
|
|
|
real = modbus_get_float_abcd(UT_IREAL_ABCD_GET);
|
|
|
ASSERT_TRUE(real == UT_REAL, "FAILED (%f != %f)\n", real, UT_REAL);
|
|
|
|
|
|
printf("2/4 Set/get float DCBA: ");
|
|
|
modbus_set_float_dcba(UT_REAL, tab_rp_registers);
|
|
|
- ASSERT_TRUE(is_memory_equal(tab_rp_registers, UT_IREAL_DCBA_SET, 4), "FAILED Set float DCBA");
|
|
|
+ ASSERT_TRUE(is_memory_equal(tab_rp_registers, UT_IREAL_DCBA_SET, 4),
|
|
|
+ "FAILED Set float DCBA");
|
|
|
real = modbus_get_float_dcba(UT_IREAL_DCBA_GET);
|
|
|
ASSERT_TRUE(real == UT_REAL, "FAILED (%f != %f)\n", real, UT_REAL);
|
|
|
|
|
|
printf("3/4 Set/get float BADC: ");
|
|
|
modbus_set_float_badc(UT_REAL, tab_rp_registers);
|
|
|
- ASSERT_TRUE(is_memory_equal(tab_rp_registers, UT_IREAL_BADC_SET, 4), "FAILED Set float BADC");
|
|
|
+ ASSERT_TRUE(is_memory_equal(tab_rp_registers, UT_IREAL_BADC_SET, 4),
|
|
|
+ "FAILED Set float BADC");
|
|
|
real = modbus_get_float_badc(UT_IREAL_BADC_GET);
|
|
|
ASSERT_TRUE(real == UT_REAL, "FAILED (%f != %f)\n", real, UT_REAL);
|
|
|
|
|
|
printf("4/4 Set/get float CDAB: ");
|
|
|
modbus_set_float_cdab(UT_REAL, tab_rp_registers);
|
|
|
- ASSERT_TRUE(is_memory_equal(tab_rp_registers, UT_IREAL_CDAB_SET, 4), "FAILED Set float CDAB");
|
|
|
+ ASSERT_TRUE(is_memory_equal(tab_rp_registers, UT_IREAL_CDAB_SET, 4),
|
|
|
+ "FAILED Set float CDAB");
|
|
|
real = modbus_get_float_cdab(UT_IREAL_CDAB_GET);
|
|
|
ASSERT_TRUE(real == UT_REAL, "FAILED (%f != %f)\n", real, UT_REAL);
|
|
|
|
|
@@ -335,8 +346,8 @@ int main(int argc, char *argv[])
|
|
|
printf("* modbus_read_input_bits (0): ");
|
|
|
ASSERT_TRUE(rc == -1 && errno == EMBXILADD, "");
|
|
|
|
|
|
- rc = modbus_read_input_bits(ctx, UT_INPUT_BITS_ADDRESS,
|
|
|
- UT_INPUT_BITS_NB + 1, tab_rp_bits);
|
|
|
+ rc = modbus_read_input_bits(
|
|
|
+ ctx, UT_INPUT_BITS_ADDRESS, UT_INPUT_BITS_NB + 1, tab_rp_bits);
|
|
|
printf("* modbus_read_input_bits (max): ");
|
|
|
ASSERT_TRUE(rc == -1 && errno == EMBXILADD, "");
|
|
|
|
|
@@ -344,8 +355,8 @@ int main(int argc, char *argv[])
|
|
|
printf("* modbus_read_registers (0): ");
|
|
|
ASSERT_TRUE(rc == -1 && errno == EMBXILADD, "");
|
|
|
|
|
|
- rc = modbus_read_registers(ctx, UT_REGISTERS_ADDRESS,
|
|
|
- UT_REGISTERS_NB_MAX + 1, tab_rp_registers);
|
|
|
+ rc = modbus_read_registers(
|
|
|
+ ctx, UT_REGISTERS_ADDRESS, UT_REGISTERS_NB_MAX + 1, tab_rp_registers);
|
|
|
printf("* modbus_read_registers (max): ");
|
|
|
ASSERT_TRUE(rc == -1 && errno == EMBXILADD, "");
|
|
|
|
|
@@ -353,9 +364,8 @@ int main(int argc, char *argv[])
|
|
|
printf("* modbus_read_input_registers (0): ");
|
|
|
ASSERT_TRUE(rc == -1 && errno == EMBXILADD, "");
|
|
|
|
|
|
- rc = modbus_read_input_registers(ctx, UT_INPUT_REGISTERS_ADDRESS,
|
|
|
- UT_INPUT_REGISTERS_NB + 1,
|
|
|
- tab_rp_registers);
|
|
|
+ rc = modbus_read_input_registers(
|
|
|
+ ctx, UT_INPUT_REGISTERS_ADDRESS, UT_INPUT_REGISTERS_NB + 1, tab_rp_registers);
|
|
|
printf("* modbus_read_input_registers (max): ");
|
|
|
ASSERT_TRUE(rc == -1 && errno == EMBXILADD, "");
|
|
|
|
|
@@ -371,8 +381,7 @@ int main(int argc, char *argv[])
|
|
|
printf("* modbus_write_coils (0): ");
|
|
|
ASSERT_TRUE(rc == -1 && errno == EMBXILADD, "");
|
|
|
|
|
|
- rc = modbus_write_bits(ctx, UT_BITS_ADDRESS + UT_BITS_NB,
|
|
|
- UT_BITS_NB, tab_rp_bits);
|
|
|
+ rc = modbus_write_bits(ctx, UT_BITS_ADDRESS + UT_BITS_NB, UT_BITS_NB, tab_rp_bits);
|
|
|
printf("* modbus_write_coils (max): ");
|
|
|
ASSERT_TRUE(rc == -1 && errno == EMBXILADD, "");
|
|
|
|
|
@@ -380,8 +389,8 @@ int main(int argc, char *argv[])
|
|
|
printf("* modbus_write_register (0): ");
|
|
|
ASSERT_TRUE(rc == -1 && errno == EMBXILADD, "");
|
|
|
|
|
|
- rc = modbus_write_register(ctx, UT_REGISTERS_ADDRESS + UT_REGISTERS_NB_MAX,
|
|
|
- tab_rp_registers[0]);
|
|
|
+ rc = modbus_write_register(
|
|
|
+ ctx, UT_REGISTERS_ADDRESS + UT_REGISTERS_NB_MAX, tab_rp_registers[0]);
|
|
|
printf("* modbus_write_register (max): ");
|
|
|
ASSERT_TRUE(rc == -1 && errno == EMBXILADD, "");
|
|
|
|
|
@@ -389,8 +398,10 @@ int main(int argc, char *argv[])
|
|
|
printf("* modbus_write_registers (0): ");
|
|
|
ASSERT_TRUE(rc == -1 && errno == EMBXILADD, "");
|
|
|
|
|
|
- rc = modbus_write_registers(ctx, UT_REGISTERS_ADDRESS + UT_REGISTERS_NB_MAX,
|
|
|
- UT_REGISTERS_NB, tab_rp_registers);
|
|
|
+ rc = modbus_write_registers(ctx,
|
|
|
+ UT_REGISTERS_ADDRESS + UT_REGISTERS_NB_MAX,
|
|
|
+ UT_REGISTERS_NB,
|
|
|
+ tab_rp_registers);
|
|
|
printf("* modbus_write_registers (max): ");
|
|
|
ASSERT_TRUE(rc == -1 && errno == EMBXILADD, "");
|
|
|
|
|
@@ -398,56 +409,54 @@ int main(int argc, char *argv[])
|
|
|
printf("* modbus_mask_write_registers (0): ");
|
|
|
ASSERT_TRUE(rc == -1 && errno == EMBXILADD, "");
|
|
|
|
|
|
- rc = modbus_mask_write_register(ctx, UT_REGISTERS_ADDRESS + UT_REGISTERS_NB_MAX,
|
|
|
- 0xF2, 0x25);
|
|
|
+ rc = modbus_mask_write_register(
|
|
|
+ ctx, UT_REGISTERS_ADDRESS + UT_REGISTERS_NB_MAX, 0xF2, 0x25);
|
|
|
printf("* modbus_mask_write_registers (max): ");
|
|
|
ASSERT_TRUE(rc == -1 && errno == EMBXILADD, "");
|
|
|
|
|
|
- rc = modbus_write_and_read_registers(ctx, 0, 1, tab_rp_registers, 0, 1, tab_rp_registers);
|
|
|
+ rc = modbus_write_and_read_registers(
|
|
|
+ ctx, 0, 1, tab_rp_registers, 0, 1, tab_rp_registers);
|
|
|
printf("* modbus_write_and_read_registers (0): ");
|
|
|
ASSERT_TRUE(rc == -1 && errno == EMBXILADD, "");
|
|
|
|
|
|
rc = modbus_write_and_read_registers(ctx,
|
|
|
UT_REGISTERS_ADDRESS + UT_REGISTERS_NB_MAX,
|
|
|
- UT_REGISTERS_NB, tab_rp_registers,
|
|
|
+ UT_REGISTERS_NB,
|
|
|
+ tab_rp_registers,
|
|
|
UT_REGISTERS_ADDRESS + UT_REGISTERS_NB_MAX,
|
|
|
- UT_REGISTERS_NB, tab_rp_registers);
|
|
|
+ UT_REGISTERS_NB,
|
|
|
+ tab_rp_registers);
|
|
|
printf("* modbus_write_and_read_registers (max): ");
|
|
|
ASSERT_TRUE(rc == -1 && errno == EMBXILADD, "");
|
|
|
|
|
|
/** TOO MANY DATA **/
|
|
|
printf("\nTEST TOO MANY DATA ERROR:\n");
|
|
|
|
|
|
- rc = modbus_read_bits(ctx, UT_BITS_ADDRESS,
|
|
|
- MODBUS_MAX_READ_BITS + 1, tab_rp_bits);
|
|
|
+ rc = modbus_read_bits(ctx, UT_BITS_ADDRESS, MODBUS_MAX_READ_BITS + 1, tab_rp_bits);
|
|
|
printf("* modbus_read_bits: ");
|
|
|
ASSERT_TRUE(rc == -1 && errno == EMBMDATA, "");
|
|
|
|
|
|
- rc = modbus_read_input_bits(ctx, UT_INPUT_BITS_ADDRESS,
|
|
|
- MODBUS_MAX_READ_BITS + 1, tab_rp_bits);
|
|
|
+ rc = modbus_read_input_bits(
|
|
|
+ ctx, UT_INPUT_BITS_ADDRESS, MODBUS_MAX_READ_BITS + 1, tab_rp_bits);
|
|
|
printf("* modbus_read_input_bits: ");
|
|
|
ASSERT_TRUE(rc == -1 && errno == EMBMDATA, "");
|
|
|
|
|
|
- rc = modbus_read_registers(ctx, UT_REGISTERS_ADDRESS,
|
|
|
- MODBUS_MAX_READ_REGISTERS + 1,
|
|
|
- tab_rp_registers);
|
|
|
+ rc = modbus_read_registers(
|
|
|
+ ctx, UT_REGISTERS_ADDRESS, MODBUS_MAX_READ_REGISTERS + 1, tab_rp_registers);
|
|
|
printf("* modbus_read_registers: ");
|
|
|
ASSERT_TRUE(rc == -1 && errno == EMBMDATA, "");
|
|
|
|
|
|
- rc = modbus_read_input_registers(ctx, UT_INPUT_REGISTERS_ADDRESS,
|
|
|
- MODBUS_MAX_READ_REGISTERS + 1,
|
|
|
- tab_rp_registers);
|
|
|
+ rc = modbus_read_input_registers(
|
|
|
+ ctx, UT_INPUT_REGISTERS_ADDRESS, MODBUS_MAX_READ_REGISTERS + 1, tab_rp_registers);
|
|
|
printf("* modbus_read_input_registers: ");
|
|
|
ASSERT_TRUE(rc == -1 && errno == EMBMDATA, "");
|
|
|
|
|
|
- rc = modbus_write_bits(ctx, UT_BITS_ADDRESS,
|
|
|
- MODBUS_MAX_WRITE_BITS + 1, tab_rp_bits);
|
|
|
+ rc = modbus_write_bits(ctx, UT_BITS_ADDRESS, MODBUS_MAX_WRITE_BITS + 1, tab_rp_bits);
|
|
|
printf("* modbus_write_bits: ");
|
|
|
ASSERT_TRUE(rc == -1 && errno == EMBMDATA, "");
|
|
|
|
|
|
- rc = modbus_write_registers(ctx, UT_REGISTERS_ADDRESS,
|
|
|
- MODBUS_MAX_WRITE_REGISTERS + 1,
|
|
|
- tab_rp_registers);
|
|
|
+ rc = modbus_write_registers(
|
|
|
+ ctx, UT_REGISTERS_ADDRESS, MODBUS_MAX_WRITE_REGISTERS + 1, tab_rp_registers);
|
|
|
printf("* modbus_write_registers: ");
|
|
|
ASSERT_TRUE(rc == -1 && errno == EMBMDATA, "");
|
|
|
|
|
@@ -473,15 +482,15 @@ int main(int argc, char *argv[])
|
|
|
|
|
|
printf("\nTEST SLAVE REPLY:\n");
|
|
|
modbus_set_slave(ctx, INVALID_SERVER_ID);
|
|
|
- rc = modbus_read_registers(ctx, UT_REGISTERS_ADDRESS,
|
|
|
- UT_REGISTERS_NB, tab_rp_registers);
|
|
|
+ rc = modbus_read_registers(
|
|
|
+ ctx, UT_REGISTERS_ADDRESS, UT_REGISTERS_NB, tab_rp_registers);
|
|
|
if (use_backend == RTU) {
|
|
|
const int RAW_REQ_LENGTH = 6;
|
|
|
- uint8_t raw_req[] = { INVALID_SERVER_ID, 0x03, 0x00, 0x01, 0x01, 0x01 };
|
|
|
+ uint8_t raw_req[] = {INVALID_SERVER_ID, 0x03, 0x00, 0x01, 0x01, 0x01};
|
|
|
/* Too many points */
|
|
|
- uint8_t raw_invalid_req[] = { INVALID_SERVER_ID, 0x03, 0x00, 0x01, 0xFF, 0xFF };
|
|
|
+ uint8_t raw_invalid_req[] = {INVALID_SERVER_ID, 0x03, 0x00, 0x01, 0xFF, 0xFF};
|
|
|
const int RAW_RSP_LENGTH = 7;
|
|
|
- uint8_t raw_rsp[] = { INVALID_SERVER_ID, 0x03, 0x04, 0, 0, 0, 0 };
|
|
|
+ uint8_t raw_rsp[] = {INVALID_SERVER_ID, 0x03, 0x04, 0, 0, 0, 0};
|
|
|
uint8_t rsp[MODBUS_RTU_MAX_ADU_LENGTH];
|
|
|
|
|
|
/* No response in RTU mode */
|
|
@@ -491,7 +500,6 @@ int main(int argc, char *argv[])
|
|
|
/* The slave raises a timeout on a confirmation to ignore because if an
|
|
|
* indication for another slave is received, a confirmation must follow */
|
|
|
|
|
|
-
|
|
|
/* Send a pair of indication/confirmation to the slave with a different
|
|
|
* slave ID to simulate a communication on a RS485 bus. At first, the
|
|
|
* slave will see the indication message then the confirmation, and it must
|
|
@@ -515,8 +523,8 @@ int main(int argc, char *argv[])
|
|
|
rc = modbus_set_slave(ctx, MODBUS_BROADCAST_ADDRESS);
|
|
|
ASSERT_TRUE(rc == 0, "Invalid broadcast address");
|
|
|
|
|
|
- rc = modbus_read_registers(ctx, UT_REGISTERS_ADDRESS,
|
|
|
- UT_REGISTERS_NB, tab_rp_registers);
|
|
|
+ rc = modbus_read_registers(
|
|
|
+ ctx, UT_REGISTERS_ADDRESS, UT_REGISTERS_NB, tab_rp_registers);
|
|
|
printf("2/3 No reply after a broadcast query: ");
|
|
|
ASSERT_TRUE(rc == -1 && errno == ETIMEDOUT, "");
|
|
|
} else {
|
|
@@ -527,8 +535,8 @@ int main(int argc, char *argv[])
|
|
|
rc = modbus_set_slave(ctx, MODBUS_BROADCAST_ADDRESS);
|
|
|
ASSERT_TRUE(rc == 0, "Invalid broacast address");
|
|
|
|
|
|
- rc = modbus_read_registers(ctx, UT_REGISTERS_ADDRESS,
|
|
|
- UT_REGISTERS_NB, tab_rp_registers);
|
|
|
+ rc = modbus_read_registers(
|
|
|
+ ctx, UT_REGISTERS_ADDRESS, UT_REGISTERS_NB, tab_rp_registers);
|
|
|
printf("2/3 Reply after a query with unit id == 0: ");
|
|
|
ASSERT_TRUE(rc == UT_REGISTERS_NB, "");
|
|
|
}
|
|
@@ -537,8 +545,8 @@ int main(int argc, char *argv[])
|
|
|
modbus_set_slave(ctx, old_slave);
|
|
|
|
|
|
printf("3/3 Response with an invalid TID or slave: ");
|
|
|
- rc = modbus_read_registers(ctx, UT_REGISTERS_ADDRESS_INVALID_TID_OR_SLAVE,
|
|
|
- 1, tab_rp_registers);
|
|
|
+ rc = modbus_read_registers(
|
|
|
+ ctx, UT_REGISTERS_ADDRESS_INVALID_TID_OR_SLAVE, 1, tab_rp_registers);
|
|
|
ASSERT_TRUE(rc == -1, "");
|
|
|
|
|
|
printf("1/2 Report slave ID truncated: \n");
|
|
@@ -546,10 +554,11 @@ int main(int argc, char *argv[])
|
|
|
tab_rp_bits[NB_REPORT_SLAVE_ID - 1] = 42;
|
|
|
rc = modbus_report_slave_id(ctx, NB_REPORT_SLAVE_ID - 1, tab_rp_bits);
|
|
|
/* Return the size required (response size) but respects the defined limit */
|
|
|
- ASSERT_TRUE(rc == NB_REPORT_SLAVE_ID &&
|
|
|
- tab_rp_bits[NB_REPORT_SLAVE_ID - 1] == 42,
|
|
|
+ ASSERT_TRUE(rc == NB_REPORT_SLAVE_ID && tab_rp_bits[NB_REPORT_SLAVE_ID - 1] == 42,
|
|
|
"Return is rc %d (%d) and marker is %d (42)",
|
|
|
- rc, NB_REPORT_SLAVE_ID, tab_rp_bits[NB_REPORT_SLAVE_ID - 1]);
|
|
|
+ rc,
|
|
|
+ NB_REPORT_SLAVE_ID,
|
|
|
+ tab_rp_bits[NB_REPORT_SLAVE_ID - 1]);
|
|
|
|
|
|
printf("2/2 Report slave ID: \n");
|
|
|
/* tab_rp_bits is used to store bytes */
|
|
@@ -565,7 +574,7 @@ int main(int argc, char *argv[])
|
|
|
/* Print additional data as string */
|
|
|
if (rc > 2) {
|
|
|
printf("Additional data: ");
|
|
|
- for (i=2; i < rc; i++) {
|
|
|
+ for (i = 2; i < rc; i++) {
|
|
|
printf("%c", tab_rp_bits[i]);
|
|
|
}
|
|
|
printf("\n");
|
|
@@ -588,8 +597,8 @@ int main(int argc, char *argv[])
|
|
|
ASSERT_TRUE(rc == -1 && errno == EINVAL, "");
|
|
|
|
|
|
modbus_set_response_timeout(ctx, 0, 1);
|
|
|
- rc = modbus_read_registers(ctx, UT_REGISTERS_ADDRESS,
|
|
|
- UT_REGISTERS_NB, tab_rp_registers);
|
|
|
+ rc = modbus_read_registers(
|
|
|
+ ctx, UT_REGISTERS_ADDRESS, UT_REGISTERS_NB, tab_rp_registers);
|
|
|
printf("4/6 1us response timeout: ");
|
|
|
if (rc == -1 && errno == ETIMEDOUT) {
|
|
|
printf("OK\n");
|
|
@@ -607,8 +616,8 @@ int main(int argc, char *argv[])
|
|
|
/* Trigger a special behaviour on server to wait for 0.5 second before
|
|
|
* replying whereas allowed timeout is 0.2 second */
|
|
|
modbus_set_response_timeout(ctx, 0, 200000);
|
|
|
- rc = modbus_read_registers(ctx, UT_REGISTERS_ADDRESS_SLEEP_500_MS,
|
|
|
- 1, tab_rp_registers);
|
|
|
+ rc = modbus_read_registers(
|
|
|
+ ctx, UT_REGISTERS_ADDRESS_SLEEP_500_MS, 1, tab_rp_registers);
|
|
|
printf("5/6 Too short response timeout (0.2s < 0.5s): ");
|
|
|
ASSERT_TRUE(rc == -1 && errno == ETIMEDOUT, "");
|
|
|
|
|
@@ -617,22 +626,21 @@ int main(int argc, char *argv[])
|
|
|
modbus_flush(ctx);
|
|
|
|
|
|
modbus_set_response_timeout(ctx, 0, 600000);
|
|
|
- rc = modbus_read_registers(ctx, UT_REGISTERS_ADDRESS_SLEEP_500_MS,
|
|
|
- 1, tab_rp_registers);
|
|
|
+ rc = modbus_read_registers(
|
|
|
+ ctx, UT_REGISTERS_ADDRESS_SLEEP_500_MS, 1, tab_rp_registers);
|
|
|
printf("6/6 Adequate response timeout (0.6s > 0.5s): ");
|
|
|
ASSERT_TRUE(rc == 1, "");
|
|
|
|
|
|
/* Disable the byte timeout.
|
|
|
The full response must be available in the 600ms interval */
|
|
|
modbus_set_byte_timeout(ctx, 0, 0);
|
|
|
- rc = modbus_read_registers(ctx, UT_REGISTERS_ADDRESS_SLEEP_500_MS,
|
|
|
- 1, tab_rp_registers);
|
|
|
+ rc = modbus_read_registers(
|
|
|
+ ctx, UT_REGISTERS_ADDRESS_SLEEP_500_MS, 1, tab_rp_registers);
|
|
|
printf("7/7 Disable byte timeout: ");
|
|
|
ASSERT_TRUE(rc == 1, "");
|
|
|
|
|
|
/* Restore original response timeout */
|
|
|
- modbus_set_response_timeout(ctx, old_response_to_sec,
|
|
|
- old_response_to_usec);
|
|
|
+ modbus_set_response_timeout(ctx, old_response_to_sec, old_response_to_usec);
|
|
|
|
|
|
if (use_backend == TCP) {
|
|
|
/* The test server is only able to test byte timeouts with the TCP
|
|
@@ -640,8 +648,8 @@ int main(int argc, char *argv[])
|
|
|
|
|
|
/* Timeout of 3ms between bytes */
|
|
|
modbus_set_byte_timeout(ctx, 0, 3000);
|
|
|
- rc = modbus_read_registers(ctx, UT_REGISTERS_ADDRESS_BYTE_SLEEP_5_MS,
|
|
|
- 1, tab_rp_registers);
|
|
|
+ rc = modbus_read_registers(
|
|
|
+ ctx, UT_REGISTERS_ADDRESS_BYTE_SLEEP_5_MS, 1, tab_rp_registers);
|
|
|
printf("1/2 Too small byte timeout (3ms < 5ms): ");
|
|
|
ASSERT_TRUE(rc == -1 && errno == ETIMEDOUT, "");
|
|
|
|
|
@@ -651,8 +659,8 @@ int main(int argc, char *argv[])
|
|
|
|
|
|
/* Timeout of 7ms between bytes */
|
|
|
modbus_set_byte_timeout(ctx, 0, 7000);
|
|
|
- rc = modbus_read_registers(ctx, UT_REGISTERS_ADDRESS_BYTE_SLEEP_5_MS,
|
|
|
- 1, tab_rp_registers);
|
|
|
+ rc = modbus_read_registers(
|
|
|
+ ctx, UT_REGISTERS_ADDRESS_BYTE_SLEEP_5_MS, 1, tab_rp_registers);
|
|
|
printf("2/2 Adapted byte timeout (7ms > 5ms): ");
|
|
|
ASSERT_TRUE(rc == 1, "");
|
|
|
}
|
|
@@ -664,19 +672,19 @@ int main(int argc, char *argv[])
|
|
|
printf("\nTEST BAD RESPONSE ERROR:\n");
|
|
|
|
|
|
/* Allocate only the required space */
|
|
|
- tab_rp_registers_bad = (uint16_t *) malloc(
|
|
|
- UT_REGISTERS_NB_SPECIAL * sizeof(uint16_t));
|
|
|
+ tab_rp_registers_bad =
|
|
|
+ (uint16_t *) malloc(UT_REGISTERS_NB_SPECIAL * sizeof(uint16_t));
|
|
|
|
|
|
- rc = modbus_read_registers(ctx, UT_REGISTERS_ADDRESS,
|
|
|
- UT_REGISTERS_NB_SPECIAL, tab_rp_registers_bad);
|
|
|
+ rc = modbus_read_registers(
|
|
|
+ ctx, UT_REGISTERS_ADDRESS, UT_REGISTERS_NB_SPECIAL, tab_rp_registers_bad);
|
|
|
printf("* modbus_read_registers: ");
|
|
|
ASSERT_TRUE(rc == -1 && errno == EMBBADDATA, "");
|
|
|
free(tab_rp_registers_bad);
|
|
|
|
|
|
/** MANUAL EXCEPTION **/
|
|
|
printf("\nTEST MANUAL EXCEPTION:\n");
|
|
|
- rc = modbus_read_registers(ctx, UT_REGISTERS_ADDRESS_SPECIAL,
|
|
|
- UT_REGISTERS_NB, tab_rp_registers);
|
|
|
+ rc = modbus_read_registers(
|
|
|
+ ctx, UT_REGISTERS_ADDRESS_SPECIAL, UT_REGISTERS_NB, tab_rp_registers);
|
|
|
|
|
|
printf("* modbus_read_registers at special address: ");
|
|
|
ASSERT_TRUE(rc == -1 && errno == EMBXSBUSY, "");
|
|
@@ -722,63 +730,65 @@ int test_server(modbus_t *ctx, int use_backend)
|
|
|
/* Read requests */
|
|
|
const int READ_RAW_REQ_LEN = 6;
|
|
|
const int slave = (use_backend == RTU) ? SERVER_ID : MODBUS_TCP_SLAVE;
|
|
|
- uint8_t read_raw_req[] = {
|
|
|
- slave,
|
|
|
- /* function, address, 5 values */
|
|
|
- MODBUS_FC_READ_HOLDING_REGISTERS,
|
|
|
- UT_REGISTERS_ADDRESS >> 8, UT_REGISTERS_ADDRESS & 0xFF,
|
|
|
- 0x0, 0x05
|
|
|
- };
|
|
|
+ uint8_t read_raw_req[] = {slave,
|
|
|
+ /* function, address, 5 values */
|
|
|
+ MODBUS_FC_READ_HOLDING_REGISTERS,
|
|
|
+ UT_REGISTERS_ADDRESS >> 8,
|
|
|
+ UT_REGISTERS_ADDRESS & 0xFF,
|
|
|
+ 0x0,
|
|
|
+ 0x05};
|
|
|
/* Write and read registers request */
|
|
|
const int RW_RAW_REQ_LEN = 13;
|
|
|
- uint8_t rw_raw_req[] = {
|
|
|
- slave,
|
|
|
- /* function, addr to read, nb to read */
|
|
|
- MODBUS_FC_WRITE_AND_READ_REGISTERS,
|
|
|
- /* Read */
|
|
|
- UT_REGISTERS_ADDRESS >> 8, UT_REGISTERS_ADDRESS & 0xFF,
|
|
|
- (MODBUS_MAX_WR_READ_REGISTERS + 1) >> 8,
|
|
|
- (MODBUS_MAX_WR_READ_REGISTERS + 1) & 0xFF,
|
|
|
- /* Write */
|
|
|
- 0, 0,
|
|
|
- 0, 1,
|
|
|
- /* Write byte count */
|
|
|
- 1 * 2,
|
|
|
- /* One data to write... */
|
|
|
- 0x12, 0x34
|
|
|
- };
|
|
|
+ uint8_t rw_raw_req[] = {slave,
|
|
|
+ /* function, addr to read, nb to read */
|
|
|
+ MODBUS_FC_WRITE_AND_READ_REGISTERS,
|
|
|
+ /* Read */
|
|
|
+ UT_REGISTERS_ADDRESS >> 8,
|
|
|
+ UT_REGISTERS_ADDRESS & 0xFF,
|
|
|
+ (MODBUS_MAX_WR_READ_REGISTERS + 1) >> 8,
|
|
|
+ (MODBUS_MAX_WR_READ_REGISTERS + 1) & 0xFF,
|
|
|
+ /* Write */
|
|
|
+ 0,
|
|
|
+ 0,
|
|
|
+ 0,
|
|
|
+ 1,
|
|
|
+ /* Write byte count */
|
|
|
+ 1 * 2,
|
|
|
+ /* One data to write... */
|
|
|
+ 0x12,
|
|
|
+ 0x34};
|
|
|
const int WRITE_RAW_REQ_LEN = 13;
|
|
|
- uint8_t write_raw_req[] = {
|
|
|
- slave,
|
|
|
- /* function will be set in the loop */
|
|
|
- MODBUS_FC_WRITE_MULTIPLE_REGISTERS,
|
|
|
- /* Address */
|
|
|
- UT_REGISTERS_ADDRESS >> 8, UT_REGISTERS_ADDRESS & 0xFF,
|
|
|
- /* 3 values, 6 bytes */
|
|
|
- 0x00, 0x03, 0x06,
|
|
|
- /* Dummy data to write */
|
|
|
- 0x02, 0x2B, 0x00, 0x01, 0x00, 0x64
|
|
|
- };
|
|
|
+ uint8_t write_raw_req[] = {slave,
|
|
|
+ /* function will be set in the loop */
|
|
|
+ MODBUS_FC_WRITE_MULTIPLE_REGISTERS,
|
|
|
+ /* Address */
|
|
|
+ UT_REGISTERS_ADDRESS >> 8,
|
|
|
+ UT_REGISTERS_ADDRESS & 0xFF,
|
|
|
+ /* 3 values, 6 bytes */
|
|
|
+ 0x00,
|
|
|
+ 0x03,
|
|
|
+ 0x06,
|
|
|
+ /* Dummy data to write */
|
|
|
+ 0x02,
|
|
|
+ 0x2B,
|
|
|
+ 0x00,
|
|
|
+ 0x01,
|
|
|
+ 0x00,
|
|
|
+ 0x64};
|
|
|
const int INVALID_FC = 0x42;
|
|
|
const int INVALID_FC_REQ_LEN = 6;
|
|
|
- uint8_t invalid_fc_raw_req[] = {
|
|
|
- slave, 0x42, 0x00, 0x00, 0x00, 0x00
|
|
|
- };
|
|
|
+ uint8_t invalid_fc_raw_req[] = {slave, 0x42, 0x00, 0x00, 0x00, 0x00};
|
|
|
|
|
|
int req_length;
|
|
|
uint8_t rsp[MODBUS_TCP_MAX_ADU_LENGTH];
|
|
|
- int tab_read_function[] = {
|
|
|
- MODBUS_FC_READ_COILS,
|
|
|
- MODBUS_FC_READ_DISCRETE_INPUTS,
|
|
|
- MODBUS_FC_READ_HOLDING_REGISTERS,
|
|
|
- MODBUS_FC_READ_INPUT_REGISTERS
|
|
|
- };
|
|
|
- int tab_read_nb_max[] = {
|
|
|
- MODBUS_MAX_READ_BITS + 1,
|
|
|
- MODBUS_MAX_READ_BITS + 1,
|
|
|
- MODBUS_MAX_READ_REGISTERS + 1,
|
|
|
- MODBUS_MAX_READ_REGISTERS + 1
|
|
|
- };
|
|
|
+ int tab_read_function[] = {MODBUS_FC_READ_COILS,
|
|
|
+ MODBUS_FC_READ_DISCRETE_INPUTS,
|
|
|
+ MODBUS_FC_READ_HOLDING_REGISTERS,
|
|
|
+ MODBUS_FC_READ_INPUT_REGISTERS};
|
|
|
+ int tab_read_nb_max[] = {MODBUS_MAX_READ_BITS + 1,
|
|
|
+ MODBUS_MAX_READ_BITS + 1,
|
|
|
+ MODBUS_MAX_READ_REGISTERS + 1,
|
|
|
+ MODBUS_MAX_READ_REGISTERS + 1};
|
|
|
int backend_length;
|
|
|
int backend_offset;
|
|
|
|
|
@@ -820,58 +830,84 @@ int test_server(modbus_t *ctx, int use_backend)
|
|
|
|
|
|
/* Try to read more values than a response could hold for all data
|
|
|
types. */
|
|
|
- for (i=0; i<4; i++) {
|
|
|
- rc = send_crafted_request(ctx, tab_read_function[i],
|
|
|
- read_raw_req, READ_RAW_REQ_LEN,
|
|
|
- tab_read_nb_max[i], 0,
|
|
|
- backend_length, backend_offset);
|
|
|
+ for (i = 0; i < 4; i++) {
|
|
|
+ rc = send_crafted_request(ctx,
|
|
|
+ tab_read_function[i],
|
|
|
+ read_raw_req,
|
|
|
+ READ_RAW_REQ_LEN,
|
|
|
+ tab_read_nb_max[i],
|
|
|
+ 0,
|
|
|
+ backend_length,
|
|
|
+ backend_offset);
|
|
|
if (rc == -1)
|
|
|
goto close;
|
|
|
}
|
|
|
|
|
|
- rc = send_crafted_request(ctx, MODBUS_FC_WRITE_AND_READ_REGISTERS,
|
|
|
- rw_raw_req, RW_RAW_REQ_LEN,
|
|
|
- MODBUS_MAX_WR_READ_REGISTERS + 1, 0,
|
|
|
- backend_length, backend_offset);
|
|
|
+ rc = send_crafted_request(ctx,
|
|
|
+ MODBUS_FC_WRITE_AND_READ_REGISTERS,
|
|
|
+ rw_raw_req,
|
|
|
+ RW_RAW_REQ_LEN,
|
|
|
+ MODBUS_MAX_WR_READ_REGISTERS + 1,
|
|
|
+ 0,
|
|
|
+ backend_length,
|
|
|
+ backend_offset);
|
|
|
if (rc == -1)
|
|
|
goto close;
|
|
|
|
|
|
- rc = send_crafted_request(ctx, MODBUS_FC_WRITE_MULTIPLE_REGISTERS,
|
|
|
- write_raw_req, WRITE_RAW_REQ_LEN,
|
|
|
- MODBUS_MAX_WRITE_REGISTERS + 1, 6,
|
|
|
- backend_length, backend_offset);
|
|
|
+ rc = send_crafted_request(ctx,
|
|
|
+ MODBUS_FC_WRITE_MULTIPLE_REGISTERS,
|
|
|
+ write_raw_req,
|
|
|
+ WRITE_RAW_REQ_LEN,
|
|
|
+ MODBUS_MAX_WRITE_REGISTERS + 1,
|
|
|
+ 6,
|
|
|
+ backend_length,
|
|
|
+ backend_offset);
|
|
|
if (rc == -1)
|
|
|
goto close;
|
|
|
|
|
|
- rc = send_crafted_request(ctx, MODBUS_FC_WRITE_MULTIPLE_COILS,
|
|
|
- write_raw_req, WRITE_RAW_REQ_LEN,
|
|
|
- MODBUS_MAX_WRITE_BITS + 1, 6,
|
|
|
- backend_length, backend_offset);
|
|
|
+ rc = send_crafted_request(ctx,
|
|
|
+ MODBUS_FC_WRITE_MULTIPLE_COILS,
|
|
|
+ write_raw_req,
|
|
|
+ WRITE_RAW_REQ_LEN,
|
|
|
+ MODBUS_MAX_WRITE_BITS + 1,
|
|
|
+ 6,
|
|
|
+ backend_length,
|
|
|
+ backend_offset);
|
|
|
if (rc == -1)
|
|
|
goto close;
|
|
|
|
|
|
/* Modbus write multiple registers with large number of values but a set a
|
|
|
small number of bytes in requests (not nb * 2 as usual). */
|
|
|
- rc = send_crafted_request(ctx, MODBUS_FC_WRITE_MULTIPLE_REGISTERS,
|
|
|
- write_raw_req, WRITE_RAW_REQ_LEN,
|
|
|
- MODBUS_MAX_WRITE_REGISTERS, 6,
|
|
|
- backend_length, backend_offset);
|
|
|
+ rc = send_crafted_request(ctx,
|
|
|
+ MODBUS_FC_WRITE_MULTIPLE_REGISTERS,
|
|
|
+ write_raw_req,
|
|
|
+ WRITE_RAW_REQ_LEN,
|
|
|
+ MODBUS_MAX_WRITE_REGISTERS,
|
|
|
+ 6,
|
|
|
+ backend_length,
|
|
|
+ backend_offset);
|
|
|
if (rc == -1)
|
|
|
goto close;
|
|
|
|
|
|
- rc = send_crafted_request(ctx, MODBUS_FC_WRITE_MULTIPLE_COILS,
|
|
|
- write_raw_req, WRITE_RAW_REQ_LEN,
|
|
|
- MODBUS_MAX_WRITE_BITS, 6,
|
|
|
- backend_length, backend_offset);
|
|
|
+ rc = send_crafted_request(ctx,
|
|
|
+ MODBUS_FC_WRITE_MULTIPLE_COILS,
|
|
|
+ write_raw_req,
|
|
|
+ WRITE_RAW_REQ_LEN,
|
|
|
+ MODBUS_MAX_WRITE_BITS,
|
|
|
+ 6,
|
|
|
+ backend_length,
|
|
|
+ backend_offset);
|
|
|
if (rc == -1)
|
|
|
goto close;
|
|
|
|
|
|
/* Test invalid function code */
|
|
|
- modbus_send_raw_request(ctx, invalid_fc_raw_req, INVALID_FC_REQ_LEN * sizeof(uint8_t));
|
|
|
+ modbus_send_raw_request(
|
|
|
+ ctx, invalid_fc_raw_req, INVALID_FC_REQ_LEN * sizeof(uint8_t));
|
|
|
rc = modbus_receive_confirmation(ctx, rsp);
|
|
|
printf("Return an exception on unknown function code: ");
|
|
|
ASSERT_TRUE(rc == (backend_length + EXCEPTION_RC) &&
|
|
|
- rsp[backend_offset] == (0x80 + INVALID_FC), "")
|
|
|
+ rsp[backend_offset] == (0x80 + INVALID_FC),
|
|
|
+ "")
|
|
|
|
|
|
modbus_set_response_timeout(ctx, old_response_to_sec, old_response_to_usec);
|
|
|
return 0;
|
|
@@ -880,16 +916,19 @@ close:
|
|
|
return -1;
|
|
|
}
|
|
|
|
|
|
-
|
|
|
-int send_crafted_request(modbus_t *ctx, int function,
|
|
|
- uint8_t *req, int req_len,
|
|
|
- uint16_t max_value, uint16_t bytes,
|
|
|
- int backend_length, int backend_offset)
|
|
|
+int send_crafted_request(modbus_t *ctx,
|
|
|
+ int function,
|
|
|
+ uint8_t *req,
|
|
|
+ int req_len,
|
|
|
+ uint16_t max_value,
|
|
|
+ uint16_t bytes,
|
|
|
+ int backend_length,
|
|
|
+ int backend_offset)
|
|
|
{
|
|
|
uint8_t rsp[MODBUS_TCP_MAX_ADU_LENGTH];
|
|
|
int j;
|
|
|
|
|
|
- for (j=0; j<2; j++) {
|
|
|
+ for (j = 0; j < 2; j++) {
|
|
|
int rc;
|
|
|
|
|
|
req[1] = function;
|
|
@@ -913,15 +952,19 @@ int send_crafted_request(modbus_t *ctx, int function,
|
|
|
|
|
|
modbus_send_raw_request(ctx, req, req_len * sizeof(uint8_t));
|
|
|
if (j == 0) {
|
|
|
- printf("* try function 0x%X: %s 0 values: ", function, bytes ? "write": "read");
|
|
|
+ printf(
|
|
|
+ "* try function 0x%X: %s 0 values: ", function, bytes ? "write" : "read");
|
|
|
} else {
|
|
|
- printf("* try function 0x%X: %s %d values: ", function, bytes ? "write": "read",
|
|
|
+ printf("* try function 0x%X: %s %d values: ",
|
|
|
+ function,
|
|
|
+ bytes ? "write" : "read",
|
|
|
max_value);
|
|
|
}
|
|
|
rc = modbus_receive_confirmation(ctx, rsp);
|
|
|
ASSERT_TRUE(rc == (backend_length + EXCEPTION_RC) &&
|
|
|
- rsp[backend_offset] == (0x80 + function) &&
|
|
|
- rsp[backend_offset + 1] == MODBUS_EXCEPTION_ILLEGAL_DATA_VALUE, "");
|
|
|
+ rsp[backend_offset] == (0x80 + function) &&
|
|
|
+ rsp[backend_offset + 1] == MODBUS_EXCEPTION_ILLEGAL_DATA_VALUE,
|
|
|
+ "");
|
|
|
}
|
|
|
return 0;
|
|
|
close:
|