judsonupchurch/nanoMODBUS
1
0
Fork 0
Code Issues Pull Requests Actions Packages Projects Releases Wiki Activity

Merge remote-tracking branch 'arhiv6/file_record'

Browse Source
This commit is contained in:
Valerio De Benedetto 2023-07-13 09:04:27 +02:00
commit bd302660b6
1 changed files with 13 additions and 12 deletions
Show Stats Download Patch File Download Diff File Expand all files Collapse all files

25
nanomodbus.c
View File

@ -1180,9 +1180,6 @@ static nmbs_error handle_read_file_record(nmbs_t* nmbs) {
if (request_size < 0x07 || request_size > 0xF5)
return send_exception_msg(nmbs, NMBS_EXCEPTION_ILLEGAL_DATA_VALUE);
put_res_header(nmbs, response_data_size);
put_1(nmbs, response_data_size);
for (uint8_t i = 0; i < subreq_count; i++) {
if (subreq[i].reference_type != 0x06)
return send_exception_msg(nmbs, NMBS_EXCEPTION_ILLEGAL_DATA_ADDRESS);
@ -1195,13 +1192,18 @@ static nmbs_error handle_read_file_record(nmbs_t* nmbs) {
NMBS_DEBUG_PRINT("a %d\tr %d\tl %d\t fread ", subreq[i].file_number, subreq[i].record_number,
subreq[i].record_length);
}
uint16_t subreq_data_size = subreq[i].record_length * 2;
put_1(nmbs, subreq_data_size + 1);
put_1(nmbs, 0x06); // add Reference Type const
uint16_t* subreq_data = (uint16_t*) get_n(nmbs, subreq[i].record_length * 2);
put_res_header(nmbs, response_data_size);
put_1(nmbs, response_data_size);
if (nmbs->callbacks.read_file_record) {
for (uint8_t i = 0; i < subreq_count; i++) {
uint16_t subreq_data_size = subreq[i].record_length * 2;
put_1(nmbs, subreq_data_size + 1);
put_1(nmbs, 0x06); // add Reference Type const
uint16_t* subreq_data = (uint16_t*) get_n(nmbs, subreq_data_size);
if (nmbs->callbacks.read_file_record) {
err = nmbs->callbacks.read_file_record(subreq[i].file_number, subreq[i].record_number, subreq_data,
subreq[i].record_length, nmbs->msg.unit_id, nmbs->platform.arg);
if (err != NMBS_ERROR_NONE) {
@ -1212,12 +1214,11 @@ static nmbs_error handle_read_file_record(nmbs_t* nmbs) {
}
swap_regs(subreq_data, subreq[i].record_length);
//get_regs(nmbs, subreq[i].record_length);
}
else {
return send_exception_msg(nmbs, NMBS_EXCEPTION_ILLEGAL_FUNCTION);
}
}
else {
return send_exception_msg(nmbs, NMBS_EXCEPTION_ILLEGAL_FUNCTION);
}
if (!nmbs->msg.broadcast) {
err = send_msg(nmbs);