2 * This file is part of the libsigrok project.
4 * Copyright (C) 2015 Aurelien Jacobs <aurel@gnuage.org>
6 * This program is free software: you can redistribute it and/or modify
7 * it under the terms of the GNU General Public License as published by
8 * the Free Software Foundation, either version 3 of the License, or
9 * (at your option) any later version.
11 * This program is distributed in the hope that it will be useful,
12 * but WITHOUT ANY WARRANTY; without even the implied warranty of
13 * MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE. See the
14 * GNU General Public License for more details.
16 * You should have received a copy of the GNU General Public License
17 * along with this program. If not, see <http://www.gnu.org/licenses/>.
24 #include <libsigrok/libsigrok.h>
25 #include "libsigrok-internal.h"
27 #define LOG_PREFIX "modbus_serial"
29 #ifdef HAVE_SERIAL_COMM
31 #define BUFFER_SIZE 1024
33 struct modbus_serial_rtu {
34 struct sr_serial_dev_inst *serial;
39 static int modbus_serial_rtu_dev_inst_new(void *priv, const char *resource,
40 char **params, const char *serialcomm, int modbusaddr)
42 struct modbus_serial_rtu *modbus = priv;
46 modbus->serial = sr_serial_dev_inst_new(resource, serialcomm);
47 modbus->slave_addr = modbusaddr;
52 static int modbus_serial_rtu_open(void *priv)
54 struct modbus_serial_rtu *modbus = priv;
55 struct sr_serial_dev_inst *serial = modbus->serial;
57 if (serial_open(serial, SERIAL_RDWR) != SR_OK)
60 if (serial_flush(serial) != SR_OK)
66 static int modbus_serial_rtu_source_add(struct sr_session *session, void *priv,
67 int events, int timeout, sr_receive_data_callback cb, void *cb_data)
69 struct modbus_serial_rtu *modbus = priv;
70 struct sr_serial_dev_inst *serial = modbus->serial;
72 return serial_source_add(session, serial, events, timeout, cb, cb_data);
75 static int modbus_serial_rtu_source_remove(struct sr_session *session,
78 struct modbus_serial_rtu *modbus = priv;
79 struct sr_serial_dev_inst *serial = modbus->serial;
81 return serial_source_remove(session, serial);
84 static int modbus_serial_rtu_send(void *priv,
85 const uint8_t *buffer, int buffer_size)
88 struct modbus_serial_rtu *modbus = priv;
89 struct sr_serial_dev_inst *serial = modbus->serial;
90 uint8_t slave_addr = modbus->slave_addr;
93 result = serial_write_blocking(serial, &slave_addr, sizeof(slave_addr), 0);
97 result = serial_write_blocking(serial, buffer, buffer_size, 0);
101 crc = sr_crc16(SR_CRC16_DEFAULT_INIT, &slave_addr, sizeof(slave_addr));
102 crc = sr_crc16(crc, buffer, buffer_size);
104 result = serial_write_blocking(serial, &crc, sizeof(crc), 0);
111 static int modbus_serial_rtu_read_begin(void *priv, uint8_t *function_code)
113 struct modbus_serial_rtu *modbus = priv;
117 ret = serial_read_blocking(modbus->serial, &slave_addr, 1, 500);
118 if (ret != 1 || slave_addr != modbus->slave_addr)
121 ret = serial_read_blocking(modbus->serial, function_code, 1, 100);
125 modbus->crc = sr_crc16(SR_CRC16_DEFAULT_INIT, &slave_addr, sizeof(slave_addr));
126 modbus->crc = sr_crc16(modbus->crc, function_code, 1);
131 static int modbus_serial_rtu_read_data(void *priv, uint8_t *buf, int maxlen)
133 struct modbus_serial_rtu *modbus = priv;
136 ret = serial_read_nonblocking(modbus->serial, buf, maxlen);
139 modbus->crc = sr_crc16(modbus->crc, buf, ret);
143 static int modbus_serial_rtu_read_end(void *priv)
145 struct modbus_serial_rtu *modbus = priv;
149 ret = serial_read_blocking(modbus->serial, &crc, sizeof(crc), 100);
153 if (crc != modbus->crc) {
154 sr_err("CRC error (0x%04X vs 0x%04X).", crc, modbus->crc);
161 static int modbus_serial_rtu_close(void *priv)
163 struct modbus_serial_rtu *modbus = priv;
165 return serial_close(modbus->serial);
168 static void modbus_serial_rtu_free(void *priv)
170 struct modbus_serial_rtu *modbus = priv;
172 sr_serial_dev_inst_free(modbus->serial);
175 SR_PRIV const struct sr_modbus_dev_inst modbus_serial_rtu_dev = {
176 .name = "serial_rtu",
178 .priv_size = sizeof(struct modbus_serial_rtu),
180 .dev_inst_new = modbus_serial_rtu_dev_inst_new,
181 .open = modbus_serial_rtu_open,
182 .source_add = modbus_serial_rtu_source_add,
183 .source_remove = modbus_serial_rtu_source_remove,
184 .send = modbus_serial_rtu_send,
185 .read_begin = modbus_serial_rtu_read_begin,
186 .read_data = modbus_serial_rtu_read_data,
187 .read_end = modbus_serial_rtu_read_end,
188 .close = modbus_serial_rtu_close,
189 .free = modbus_serial_rtu_free,