2 * This file is part of the libsigrok project.
4 * Copyright (C) 2015-2016 Uwe Hermann <uwe@hermann-uwe.de>
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 2 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, write to the Free Software
18 * Foundation, Inc., 51 Franklin St, Fifth Floor, Boston, MA 02110-1301 USA
25 #define READ_TIMEOUT_MS 1000
27 static int send_cmd(const struct sr_dev_inst *sdi, const char *cmd,
28 char *replybuf, int replybufsize)
32 struct sr_serial_dev_inst *serial;
36 /* Send the command (blocking, with timeout). */
37 if ((ret = serial_write_blocking(serial, cmd,
38 strlen(cmd), serial_timeout(serial,
39 strlen(cmd)))) < (int)strlen(cmd)) {
40 sr_err("Unable to send command.");
44 /* Read the reply (blocking, with timeout). */
45 memset(replybuf, 0, replybufsize);
48 ret = serial_readline(serial, &bufptr, &len, READ_TIMEOUT_MS);
50 /* If we got 0 characters (possibly one \r or \n), retry once. */
53 ret = serial_readline(serial, &bufptr, &len, READ_TIMEOUT_MS);
56 if (g_str_has_prefix((const char *)&bufptr, "err ")) {
57 sr_err("Device replied with an error: '%s'.", bufptr);
64 SR_PRIV int reloadpro_set_current_limit(const struct sr_dev_inst *sdi,
71 if (current < 0 || current > 6) {
72 sr_err("The current limit must be 0-6 A (was %f A).", current);
76 /* Hardware expects current in mA, integer (0..6000). */
77 ma = (int)(current * 1000);
79 sr_err("Setting current limit to %f A (%d mA).", current, ma);
81 cmd = g_strdup_printf("set %d\n", ma);
82 if ((ret = send_cmd(sdi, cmd, (char *)&buf, sizeof(buf))) < 0) {
83 sr_err("Error sending current limit command: %d.", ret);
92 SR_PRIV int reloadpro_set_on_off(const struct sr_dev_inst *sdi, gboolean on)
98 cmd = (on) ? "on\n" : "off\n";
99 if ((ret = send_cmd(sdi, cmd, (char *)&buf, sizeof(buf))) < 0) {
100 sr_err("Error sending on/off command: %d.", ret);
107 SR_PRIV int reloadpro_get_current_limit(const struct sr_dev_inst *sdi,
113 if ((ret = send_cmd(sdi, "set\n", (char *)&buf, sizeof(buf))) < 0) {
114 sr_err("Error sending current limit query: %d.", ret);
118 /* Hardware sends current in mA, integer (0..6000). */
119 *current = g_ascii_strtod(buf + 4, NULL) / 1000;
124 SR_PRIV int reloadpro_get_voltage_current(const struct sr_dev_inst *sdi,
125 float *voltage, float *current)
131 if ((ret = send_cmd(sdi, "read\n", (char *)&buf, sizeof(buf))) < 0) {
132 sr_err("Error sending voltage/current query: %d.", ret);
136 /* Reply: "read <current> <voltage>". */
137 tokens = g_strsplit((const char *)&buf, " ", 3);
139 *voltage = g_ascii_strtod(tokens[2], NULL) / 1000;
141 *current = g_ascii_strtod(tokens[1], NULL) / 1000;
147 static void handle_packet(const struct sr_dev_inst *sdi)
149 float voltage, current;
150 struct sr_datafeed_packet packet;
151 struct sr_datafeed_analog analog;
152 struct sr_analog_encoding encoding;
153 struct sr_analog_meaning meaning;
154 struct sr_analog_spec spec;
155 struct dev_context *devc;
161 if (g_str_has_prefix((const char *)devc->buf, "overtemp")) {
162 sr_warn("Overtemperature condition!");
163 devc->otp_active = TRUE;
167 if (g_str_has_prefix((const char *)devc->buf, "undervolt")) {
168 sr_warn("Undervoltage condition!");
169 devc->uvc_active = TRUE;
173 if (!g_str_has_prefix((const char *)devc->buf, "read ")) {
174 sr_dbg("Unknown packet: '%s'.", devc->buf);
178 tokens = g_strsplit((const char *)devc->buf, " ", 3);
179 voltage = g_ascii_strtod(tokens[2], NULL) / 1000;
180 current = g_ascii_strtod(tokens[1], NULL) / 1000;
184 packet.type = SR_DF_FRAME_BEGIN;
185 packet.payload = NULL;
186 sr_session_send(sdi, &packet);
188 sr_analog_init(&analog, &encoding, &meaning, &spec, 4);
190 packet.type = SR_DF_ANALOG;
191 packet.payload = &analog;
192 analog.num_samples = 1;
195 l = g_slist_copy(sdi->channels);
196 l = g_slist_remove_link(l, g_slist_nth(l, 1));
197 meaning.channels = l;
198 meaning.mq = SR_MQ_VOLTAGE;
199 meaning.mqflags = SR_MQFLAG_DC;
200 meaning.unit = SR_UNIT_VOLT;
201 analog.data = &voltage;
202 sr_session_send(sdi, &packet);
206 l = g_slist_copy(sdi->channels);
207 l = g_slist_remove_link(l, g_slist_nth(l, 0));
208 meaning.channels = l;
209 meaning.mq = SR_MQ_CURRENT;
210 meaning.mqflags = SR_MQFLAG_DC;
211 meaning.unit = SR_UNIT_AMPERE;
212 analog.data = ¤t;
213 sr_session_send(sdi, &packet);
217 packet.type = SR_DF_FRAME_END;
218 packet.payload = NULL;
219 sr_session_send(sdi, &packet);
224 static void handle_new_data(const struct sr_dev_inst *sdi)
227 struct dev_context *devc;
228 struct sr_serial_dev_inst *serial;
233 /* Try to get as much data as the buffer can hold. */
234 len = RELOADPRO_BUFSIZE - devc->buflen;
235 len = serial_read_nonblocking(serial, devc->buf + devc->buflen, len);
237 return; /* No new bytes, nothing to do. */
239 sr_err("Serial port read error: %d.", len);
244 if (g_str_has_suffix((const char *)devc->buf, "\n")) {
246 memset(devc->buf, 0, RELOADPRO_BUFSIZE);
251 SR_PRIV int reloadpro_receive_data(int fd, int revents, void *cb_data)
253 struct sr_dev_inst *sdi;
254 struct dev_context *devc;
262 if (revents != G_IO_IN)
265 handle_new_data(sdi);
267 if (devc->limit_samples && (devc->num_samples >= devc->limit_samples)) {
268 sr_info("Requested number of samples reached.");
269 sdi->driver->dev_acquisition_stop(sdi);
273 if (devc->limit_msec) {
274 t = (g_get_monotonic_time() - devc->starttime) / 1000;
275 if (t > (int64_t)devc->limit_msec) {
276 sr_info("Requested time limit reached.");
277 sdi->driver->dev_acquisition_stop(sdi);