/*
* This file is part of the libsigrok project.
*
- * Copyright (C) 2015 Uwe Hermann <uwe@hermann-uwe.de>
+ * Copyright (C) 2015-2016 Uwe Hermann <uwe@hermann-uwe.de>
*
* This program is free software; you can redistribute it and/or modify
* it under the terms of the GNU General Public License as published by
* GNU General Public License for more details.
*
* You should have received a copy of the GNU General Public License
- * along with this program; if not, write to the Free Software
- * Foundation, Inc., 51 Franklin St, Fifth Floor, Boston, MA 02110-1301 USA
+ * along with this program; if not, see <http://www.gnu.org/licenses/>.
*/
#include <config.h>
+#include <string.h>
#include "protocol.h"
-SR_PRIV int arachnid_labs_re_load_pro_receive_data(int fd, int revents, void *cb_data)
+#define READ_TIMEOUT_MS 1000
+
+static int send_cmd(const struct sr_dev_inst *sdi, const char *cmd,
+ char *replybuf, int replybufsize)
+{
+ char *bufptr;
+ int len, ret;
+ struct sr_serial_dev_inst *serial;
+
+ serial = sdi->conn;
+
+ /* Send the command (blocking, with timeout). */
+ if ((ret = serial_write_blocking(serial, cmd,
+ strlen(cmd), serial_timeout(serial,
+ strlen(cmd)))) < (int)strlen(cmd)) {
+ sr_err("Unable to send command.");
+ return SR_ERR;
+ }
+
+ /* Read the reply (blocking, with timeout). */
+ memset(replybuf, 0, replybufsize);
+ bufptr = replybuf;
+ len = replybufsize;
+ ret = serial_readline(serial, &bufptr, &len, READ_TIMEOUT_MS);
+
+ /* If we got 0 characters (possibly one \r or \n), retry once. */
+ if (len == 0) {
+ len = replybufsize;
+ ret = serial_readline(serial, &bufptr, &len, READ_TIMEOUT_MS);
+ }
+
+ if (g_str_has_prefix((const char *)&bufptr, "err ")) {
+ sr_err("Device replied with an error: '%s'.", bufptr);
+ return SR_ERR;
+ }
+
+ return ret;
+}
+
+SR_PRIV int reloadpro_set_current_limit(const struct sr_dev_inst *sdi,
+ float current)
+{
+ int ret, ma;
+ char buf[100];
+ char *cmd;
+
+ if (current < 0 || current > 6) {
+ sr_err("The current limit must be 0-6 A (was %f A).", current);
+ return SR_ERR_ARG;
+ }
+
+ /* Hardware expects current in mA, integer (0..6000). */
+ ma = (int)(current * 1000);
+
+ sr_err("Setting current limit to %f A (%d mA).", current, ma);
+
+ cmd = g_strdup_printf("set %d\n", ma);
+ if ((ret = send_cmd(sdi, cmd, (char *)&buf, sizeof(buf))) < 0) {
+ sr_err("Error sending current limit command: %d.", ret);
+ g_free(cmd);
+ return SR_ERR;
+ }
+ g_free(cmd);
+
+ return SR_OK;
+}
+
+SR_PRIV int reloadpro_set_on_off(const struct sr_dev_inst *sdi, gboolean on)
+{
+ int ret;
+ char buf[100];
+ const char *cmd;
+
+ cmd = (on) ? "on\n" : "off\n";
+ if ((ret = send_cmd(sdi, cmd, (char *)&buf, sizeof(buf))) < 0) {
+ sr_err("Error sending on/off command: %d.", ret);
+ return SR_ERR;
+ }
+
+ return SR_OK;
+}
+
+SR_PRIV int reloadpro_get_current_limit(const struct sr_dev_inst *sdi,
+ float *current)
+{
+ int ret;
+ char buf[100];
+
+ if ((ret = send_cmd(sdi, "set\n", (char *)&buf, sizeof(buf))) < 0) {
+ sr_err("Error sending current limit query: %d.", ret);
+ return SR_ERR;
+ }
+
+ /* Hardware sends current in mA, integer (0..6000). */
+ *current = g_ascii_strtod(buf + 4, NULL) / 1000;
+
+ return SR_OK;
+}
+
+SR_PRIV int reloadpro_get_voltage_current(const struct sr_dev_inst *sdi,
+ float *voltage, float *current)
+{
+ int ret;
+ char buf[100];
+ char **tokens;
+
+ if ((ret = send_cmd(sdi, "read\n", (char *)&buf, sizeof(buf))) < 0) {
+ sr_err("Error sending voltage/current query: %d.", ret);
+ return SR_ERR;
+ }
+
+ /* Reply: "read <current> <voltage>". */
+ tokens = g_strsplit((const char *)&buf, " ", 3);
+ if (voltage)
+ *voltage = g_ascii_strtod(tokens[2], NULL) / 1000;
+ if (current)
+ *current = g_ascii_strtod(tokens[1], NULL) / 1000;
+ g_strfreev(tokens);
+
+ return SR_OK;
+}
+
+static void handle_packet(const struct sr_dev_inst *sdi)
{
- const struct sr_dev_inst *sdi;
+ float voltage, current;
+ struct sr_datafeed_packet packet;
+ struct sr_datafeed_analog analog;
+ struct sr_analog_encoding encoding;
+ struct sr_analog_meaning meaning;
+ struct sr_analog_spec spec;
+ struct dev_context *devc;
+ char **tokens;
+ GSList *l;
+
+ devc = sdi->priv;
+
+ if (g_str_has_prefix((const char *)devc->buf, "overtemp")) {
+ sr_warn("Overtemperature condition!");
+ devc->otp_active = TRUE;
+ return;
+ }
+
+ if (g_str_has_prefix((const char *)devc->buf, "undervolt")) {
+ sr_warn("Undervoltage condition!");
+ devc->uvc_active = TRUE;
+ return;
+ }
+
+ if (!g_str_has_prefix((const char *)devc->buf, "read ")) {
+ sr_dbg("Unknown packet: '%s'.", devc->buf);
+ return;
+ }
+
+ tokens = g_strsplit((const char *)devc->buf, " ", 3);
+ voltage = g_ascii_strtod(tokens[2], NULL) / 1000;
+ current = g_ascii_strtod(tokens[1], NULL) / 1000;
+ g_strfreev(tokens);
+
+ /* Begin frame. */
+ packet.type = SR_DF_FRAME_BEGIN;
+ packet.payload = NULL;
+ sr_session_send(sdi, &packet);
+
+ sr_analog_init(&analog, &encoding, &meaning, &spec, 4);
+
+ packet.type = SR_DF_ANALOG;
+ packet.payload = &analog;
+ analog.num_samples = 1;
+
+ /* Voltage */
+ l = g_slist_copy(sdi->channels);
+ l = g_slist_remove_link(l, g_slist_nth(l, 1));
+ meaning.channels = l;
+ meaning.mq = SR_MQ_VOLTAGE;
+ meaning.mqflags = SR_MQFLAG_DC;
+ meaning.unit = SR_UNIT_VOLT;
+ analog.data = &voltage;
+ sr_session_send(sdi, &packet);
+ g_slist_free(l);
+
+ /* Current */
+ l = g_slist_copy(sdi->channels);
+ l = g_slist_remove_link(l, g_slist_nth(l, 0));
+ meaning.channels = l;
+ meaning.mq = SR_MQ_CURRENT;
+ meaning.mqflags = SR_MQFLAG_DC;
+ meaning.unit = SR_UNIT_AMPERE;
+ analog.data = ¤t;
+ sr_session_send(sdi, &packet);
+ g_slist_free(l);
+
+ /* End frame. */
+ packet.type = SR_DF_FRAME_END;
+ packet.payload = NULL;
+ sr_session_send(sdi, &packet);
+
+ sr_sw_limits_update_samples_read(&devc->limits, 1);
+}
+
+static void handle_new_data(const struct sr_dev_inst *sdi)
+{
+ int len;
+ struct dev_context *devc;
+ struct sr_serial_dev_inst *serial;
+
+ devc = sdi->priv;
+ serial = sdi->conn;
+
+ /* Try to get as much data as the buffer can hold. */
+ len = RELOADPRO_BUFSIZE - devc->buflen;
+ len = serial_read_nonblocking(serial, devc->buf + devc->buflen, len);
+ if (len == 0)
+ return; /* No new bytes, nothing to do. */
+ if (len < 0) {
+ sr_err("Serial port read error: %d.", len);
+ return;
+ }
+ devc->buflen += len;
+
+ if (g_str_has_suffix((const char *)devc->buf, "\n")) {
+ handle_packet(sdi);
+ memset(devc->buf, 0, RELOADPRO_BUFSIZE);
+ devc->buflen = 0;
+ }
+}
+
+SR_PRIV int reloadpro_receive_data(int fd, int revents, void *cb_data)
+{
+ struct sr_dev_inst *sdi;
struct dev_context *devc;
(void)fd;
- if (!(sdi = cb_data))
- return TRUE;
+ sdi = cb_data;
+ devc = sdi->priv;
- if (!(devc = sdi->priv))
+ if (revents != G_IO_IN)
return TRUE;
- if (revents == G_IO_IN) {
- }
+ handle_new_data(sdi);
+
+ if (sr_sw_limits_check(&devc->limits))
+ sdi->driver->dev_acquisition_stop(sdi);
return TRUE;
}
projects / libsigrok.git / blobdiff