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

add fc23

Browse Source
This commit is contained in:
maxlemo 2023-08-02 10:57:17 -04:00
parent 9f6b24e03f
commit 5991219763
2 changed files with 71 additions and 0 deletions
Show Stats Download Patch File Download Diff File Expand all files Collapse all files

52
nanomodbus.c
View File

@ -1716,6 +1716,58 @@ nmbs_error nmbs_write_file_record(nmbs_t* nmbs, uint16_t file_number, uint16_t r
return NMBS_ERROR_NONE;
}
nmbs_error nmbs_read_write_registers(nmbs_t* nmbs,
uint16_t read_address,
uint16_t read_quantity,
uint16_t* registers_out,
uint16_t write_address,
uint16_t write_quantity,
const uint16_t* registers)
{
if(read_quantity < 1 || read_quantity > 125)
return NMBS_ERROR_INVALID_ARGUMENT;
if((uint32_t)read_address + (uint32_t)read_quantity > ((uint32_t)0xFFFF) + 1)
return NMBS_ERROR_INVALID_ARGUMENT;
if(write_quantity < 1 || write_quantity > 0x007B)
return NMBS_ERROR_INVALID_ARGUMENT;
if((uint32_t)write_address + (uint32_t)write_quantity > ((uint32_t)0xFFFF) + 1)
return NMBS_ERROR_INVALID_ARGUMENT;
uint8_t registers_bytes = write_quantity * 2;
msg_state_req(nmbs, 23);
put_req_header(nmbs, 9 + registers_bytes);
put_2(nmbs, read_address);
put_2(nmbs, read_quantity);
put_2(nmbs, write_address);
put_2(nmbs, write_quantity);
put_1(nmbs, registers_bytes);
NMBS_DEBUG_PRINT("read a %d\tq %d ", read_address, read_quantity);
NMBS_DEBUG_PRINT("write a %d\tq %d\tb %d\t", write_address, write_quantity, registers_bytes);
NMBS_DEBUG_PRINT("regs ");
for(int i = 0; i < write_quantity; i++)
{
put_2(nmbs, registers[i]);
NMBS_DEBUG_PRINT("%d ", registers[i]);
}
nmbs_error err = send_msg(nmbs);
if(err != NMBS_ERROR_NONE)
return err;
if(!nmbs->msg.broadcast)
{
return recv_read_registers_res(nmbs, read_quantity, registers_out);
}
return NMBS_ERROR_NONE;
}
nmbs_error nmbs_send_raw_pdu(nmbs_t* nmbs, uint8_t fc, const uint8_t* data, uint16_t data_len) {
msg_state_req(nmbs, fc);

19
nanomodbus.h
View File

@ -391,6 +391,25 @@ nmbs_error nmbs_read_file_record(nmbs_t* nmbs, uint16_t file_number, uint16_t re
nmbs_error nmbs_write_file_record(nmbs_t* nmbs, uint16_t file_number, uint16_t record_number, const uint16_t* registers,
uint16_t count);
/** Send a FC 23 (0x17) Read Write multiple registers
* @param nmbs pointer to the nmbs_t instance
* @param read_address starting read address
* @param read_quantity quantity of registers to read
* @param registers_out array where the read registers will be stored
* @param write_address starting write address
* @param write_quantity quantity of registers to write
* @param registers array of registers values to write
*
* @return NMBS_ERROR_NONE if successful, other errors otherwise.
*/
nmbs_error nmbs_read_write_registers(nmbs_t* nmbs,
uint16_t read_address,
uint16_t read_quantity,
uint16_t* registers_out,
uint16_t write_address,
uint16_t write_quantity,
const uint16_t* registers);
/** Send a raw Modbus PDU.
* CRC on RTU will be calculated and sent by this function.
* @param nmbs pointer to the nmbs_t instance