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)
63 static int modbus_serial_rtu_source_add(struct sr_session *session, void *priv,
64 int events, int timeout, sr_receive_data_callback cb, void *cb_data)
66 struct modbus_serial_rtu *modbus = priv;
67 struct sr_serial_dev_inst *serial = modbus->serial;
69 return serial_source_add(session, serial, events, timeout, cb, cb_data);
72 static int modbus_serial_rtu_source_remove(struct sr_session *session,
75 struct modbus_serial_rtu *modbus = priv;
76 struct sr_serial_dev_inst *serial = modbus->serial;
78 return serial_source_remove(session, serial);
81 static int modbus_serial_rtu_send(void *priv,
82 const uint8_t *buffer, int buffer_size)
85 struct modbus_serial_rtu *modbus = priv;
86 struct sr_serial_dev_inst *serial = modbus->serial;
87 uint8_t slave_addr = modbus->slave_addr;
90 result = serial_write_blocking(serial, &slave_addr, sizeof(slave_addr), 0);
94 result = serial_write_blocking(serial, buffer, buffer_size, 0);
98 crc = sr_crc16(SR_CRC16_DEFAULT_INIT, &slave_addr, sizeof(slave_addr));
99 crc = sr_crc16(crc, buffer, buffer_size);
101 result = serial_write_blocking(serial, &crc, sizeof(crc), 0);
108 static int modbus_serial_rtu_read_begin(void *priv, uint8_t *function_code)
110 struct modbus_serial_rtu *modbus = priv;
114 ret = serial_read_blocking(modbus->serial, &slave_addr, 1, 500);
115 if (ret != 1 || slave_addr != modbus->slave_addr)
118 ret = serial_read_blocking(modbus->serial, function_code, 1, 100);
122 modbus->crc = sr_crc16(SR_CRC16_DEFAULT_INIT, &slave_addr, sizeof(slave_addr));
123 modbus->crc = sr_crc16(modbus->crc, function_code, 1);
128 static int modbus_serial_rtu_read_data(void *priv, uint8_t *buf, int maxlen)
130 struct modbus_serial_rtu *modbus = priv;
133 ret = serial_read_nonblocking(modbus->serial, buf, maxlen);
136 modbus->crc = sr_crc16(modbus->crc, buf, ret);
140 static int modbus_serial_rtu_read_end(void *priv)
142 struct modbus_serial_rtu *modbus = priv;
146 ret = serial_read_blocking(modbus->serial, &crc, sizeof(crc), 100);
150 if (crc != modbus->crc) {
151 sr_err("CRC error (0x%04X vs 0x%04X).", crc, modbus->crc);
158 static int modbus_serial_rtu_close(void *priv)
160 struct modbus_serial_rtu *modbus = priv;
162 return serial_close(modbus->serial);
165 static void modbus_serial_rtu_free(void *priv)
167 struct modbus_serial_rtu *modbus = priv;
169 sr_serial_dev_inst_free(modbus->serial);
172 SR_PRIV const struct sr_modbus_dev_inst modbus_serial_rtu_dev = {
173 .name = "serial_rtu",
175 .priv_size = sizeof(struct modbus_serial_rtu),
177 .dev_inst_new = modbus_serial_rtu_dev_inst_new,
178 .open = modbus_serial_rtu_open,
179 .source_add = modbus_serial_rtu_source_add,
180 .source_remove = modbus_serial_rtu_source_remove,
181 .send = modbus_serial_rtu_send,
182 .read_begin = modbus_serial_rtu_read_begin,
183 .read_data = modbus_serial_rtu_read_data,
184 .read_end = modbus_serial_rtu_read_end,
185 .close = modbus_serial_rtu_close,
186 .free = modbus_serial_rtu_free,