Skip to content
Open
Show file tree
Hide file tree
Changes from all commits
Commits
File filter

Filter by extension

Filter by extension

Conversations
Failed to load comments.
Loading
Jump to
Jump to file
Failed to load files.
Loading
Diff view
Diff view
32 changes: 30 additions & 2 deletions src/modbus.c
Original file line number Diff line number Diff line change
Expand Up @@ -783,12 +783,32 @@ int modbus_reply(modbus_t *ctx,
const uint8_t *req,
int req_length,
modbus_mapping_t *mb_mapping)
{
uint8_t rsp[MAX_MESSAGE_LENGTH];
int rsp_length;

rsp_length = modbus_reply_construct(ctx, req, req_length, mb_mapping, rsp);
if (rsp_length > 0) {
return send_msg(ctx, rsp, rsp_length);
}
return rsp_length;
}

/* Analyses the request and constructs a response.

If an error occurs, this function constructs the response
accordingly.
*/
int modbus_reply_construct(modbus_t *ctx,
const uint8_t *req,
int req_length,
modbus_mapping_t *mb_mapping,
uint8_t *rsp)
{
unsigned int offset;
int slave;
int function;
uint16_t address;
uint8_t rsp[MAX_MESSAGE_LENGTH];
int rsp_length = 0;
sft_t sft;

Expand Down Expand Up @@ -1189,7 +1209,15 @@ int modbus_reply(modbus_t *ctx,
!(ctx->quirks & MODBUS_QUIRK_REPLY_TO_BROADCAST)) {
return 0;
}
return send_msg(ctx, rsp, rsp_length);
return rsp_length;
}

int modbus_reply_send(modbus_t *ctx, uint8_t *rsp, int rsp_length)
{
if (rsp_length > 0) {
return send_msg(ctx, rsp, rsp_length);
}
return rsp_length;
}

int modbus_reply_exception(modbus_t *ctx, const uint8_t *req, unsigned int exception_code)
Expand Down
4 changes: 4 additions & 0 deletions src/modbus.h
Original file line number Diff line number Diff line change
Expand Up @@ -275,6 +275,10 @@ MODBUS_API int modbus_reply(modbus_t *ctx,
int req_length,
modbus_mapping_t *mb_mapping);
MODBUS_API int
modbus_reply_construct(modbus_t *ctx, const uint8_t *req,
int req_length, modbus_mapping_t *mb_mapping, uint8_t *rsp);
MODBUS_API int modbus_reply_send(modbus_t *ctx, uint8_t *rsp, int rsp_length);
MODBUS_API int
modbus_reply_exception(modbus_t *ctx, const uint8_t *req, unsigned int exception_code);
MODBUS_API int modbus_enable_quirks(modbus_t *ctx, unsigned int quirks_mask);
MODBUS_API int modbus_disable_quirks(modbus_t *ctx, unsigned int quirks_mask);
Expand Down