GithubStar/neuron
1
0
Fork 0
mirror of https://github.com/emqx/neuron.git synced 2026-10-18 05:36:19 +08:00
Code Issues Packages Projects Releases Wiki Activity

modbus: write coil using 0x05

Browse Source
This commit is contained in:
fengzero
2022-07-18 09:51:56 +00:00
parent 07614e544b
commit e4b2eaadeb
2 changed files with 18 additions and 6 deletions
Download Patch File Download Diff File Expand all files Collapse all files
plugins/modbus/modbus_stack.c
+9 -6
View File
@@ -85,6 +85,7 @@ int modbus_stack_recv(modbus_stack_t *stack, neu_protocol_unpack_buf_t *buf)
break;
}
case MODBUS_WRITE_S_COIL:
case MODBUS_WRITE_M_HOLD_REG:
case MODBUS_WRITE_M_COIL: {
struct modbus_address address = { 0 };
@@ -98,7 +99,6 @@ int modbus_stack_recv(modbus_stack_t *stack, neu_protocol_unpack_buf_t *buf)
stack->write_resp(stack->ctx, write_req, 0);
break;
}
case MODBUS_WRITE_S_COIL:
case MODBUS_WRITE_S_HOLD_REG:
default:
break;
@@ -157,15 +157,18 @@ int modbus_stack_write(modbus_stack_t *stack, void *req, uint8_t slave_id,
neu_protocol_pack_buf_init(&pbuf, buf, sizeof(buf));
modbus_data_wrap(&pbuf, n_byte, bytes);
modbus_address_wrap(&pbuf, start_address, n_reg);
switch (area) {
case MODBUS_AREA_COIL:
modbus_code_wrap(&pbuf, slave_id, MODBUS_WRITE_M_COIL);
if (*bytes > 0) {
modbus_address_wrap(&pbuf, start_address, 0xff00);
} else {
modbus_address_wrap(&pbuf, start_address, 0);
}
modbus_code_wrap(&pbuf, slave_id, MODBUS_WRITE_S_COIL);
break;
case MODBUS_AREA_HOLD_REGISTER:
modbus_data_wrap(&pbuf, n_byte, bytes);
modbus_address_wrap(&pbuf, start_address, n_reg);
modbus_code_wrap(&pbuf, slave_id, MODBUS_WRITE_M_HOLD_REG);
break;
default:
simulator/modbus_s.c
+9
View File
@@ -125,6 +125,7 @@ ssize_t modbus_s_rtu_req(uint8_t *req, uint16_t req_len, uint8_t *res,
crc = (uint16_t *) (res_value + len);
break;
case MODBUS_WRITE_S_COIL:
case MODBUS_WRITE_M_COIL:
case MODBUS_WRITE_M_HOLD_REG:
modbus_write(&tcp_registers[code->slave_id - 1], code->function,
@@ -200,6 +201,7 @@ ssize_t modbus_s_tcp_req(uint8_t *req, uint16_t req_len, uint8_t *res,
res_data->n_byte = len;
res_header->len += sizeof(struct modbus_data) + len;
break;
case MODBUS_WRITE_S_COIL:
case MODBUS_WRITE_M_COIL:
case MODBUS_WRITE_M_HOLD_REG:
nlog_info(
@@ -290,6 +292,13 @@ static void modbus_write(struct modbus_register *reg, uint8_t function,
{
pthread_mutex_lock(&reg->mutex);
switch (function) {
case MODBUS_WRITE_S_COIL:
if (address->n_reg > 0) {
reg->coil[ntohs(address->start_address)].value = 1;
} else {
reg->coil[ntohs(address->start_address)].value = 0;
}
break;
case MODBUS_WRITE_M_COIL:
for (int i = 0; i < ntohs(address->n_reg); i++) {
uint8_t x = (value[ntohs(address->n_reg) / 8] >> (i % 8)) & 0x1;