[libsigrok.git] / src / hardware / arachnid-labs-re-load-pro / protocol.c

/*
 * This file is part of the libsigrok project.
 *
 * 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
 * the Free Software Foundation; either version 2 of the License, or
 * (at your option) any later version.
 *
 * This program is distributed in the hope that it will be useful,
 * but WITHOUT ANY WARRANTY; without even the implied warranty of
 * MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE.  See the
 * 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, see <http://www.gnu.org/licenses/>.
 */

#include <config.h>
#include <math.h>
#include <string.h>
#include "protocol.h"

#define READ_TIMEOUT_MS 500

static int send_cmd(const struct sr_dev_inst *sdi, const char *cmd,
		char *replybuf, int replybufsize)
{
	char *bufptr;
	int len, ret;
	struct dev_context *devc;
	struct sr_serial_dev_inst *serial;

	devc = sdi->priv;
	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;
	}

	if (!devc->acquisition_running) {
		/* 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_limit)
{
	struct dev_context *devc;
	int ret, ma;
	char buf[100];
	char *cmd;

	devc = sdi->priv;

	if (current_limit < 0 || current_limit > 6) {
		sr_err("The current limit must be 0-6 A (was %f A).", current_limit);
		return SR_ERR_ARG;
	}

	/* Hardware expects current limit in mA, integer (0..6000). */
	ma = (int)round(current_limit * 1000);

	cmd = g_strdup_printf("set %d\n", ma);
	g_mutex_lock(&devc->acquisition_mutex);
	ret = send_cmd(sdi, cmd, (char *)&buf, sizeof(buf));
	g_mutex_unlock(&devc->acquisition_mutex);
	g_free(cmd);

	if (ret < 0) {
		sr_err("Error sending current limit command: %d.", ret);
		return SR_ERR;
	}
	return SR_OK;
}

SR_PRIV int reloadpro_set_on_off(const struct sr_dev_inst *sdi, gboolean on)
{
	struct dev_context *devc;
	int ret;
	char buf[100];
	const char *cmd;

	devc = sdi->priv;

	cmd = (on) ? "on\n" : "off\n";
	g_mutex_lock(&devc->acquisition_mutex);
	ret = send_cmd(sdi, cmd, (char *)&buf, sizeof(buf));
	g_mutex_unlock(&devc->acquisition_mutex);

	if (ret < 0) {
		sr_err("Error sending on/off command: %d.", ret);
		return SR_ERR;
	}
	return SR_OK;
}

SR_PRIV int reloadpro_set_under_voltage_threshold(const struct sr_dev_inst *sdi,
					float voltage)
{
	struct dev_context *devc;
	int ret, mv;
	char buf[100];
	char *cmd;

	devc = sdi->priv;

	if (voltage < 0 || voltage > 60) {
		sr_err("The under voltage threshold must be 0-60 V (was %f V).",
			voltage);
		return SR_ERR_ARG;
	}

	/* Hardware expects voltage in mV, integer (0..60000). */
	mv = (int)round(voltage * 1000);

	sr_spew("Setting under voltage threshold to %f V (%d mV).", voltage, mv);

	cmd = g_strdup_printf("uvlo %d\n", mv);
	g_mutex_lock(&devc->acquisition_mutex);
	ret = send_cmd(sdi, cmd, (char *)&buf, sizeof(buf));
	g_mutex_unlock(&devc->acquisition_mutex);
	g_free(cmd);

	if (ret < 0) {
		sr_err("Error sending under voltage threshold command: %d.", ret);
		return SR_ERR;
	}
	return SR_OK;
}

SR_PRIV int reloadpro_get_current_limit(const struct sr_dev_inst *sdi,
					float *current_limit)
{
	struct dev_context *devc;
	int ret;
	char buf[100];
	gint64 end_time;

	devc = sdi->priv;

	g_mutex_lock(&devc->acquisition_mutex);
	if ((ret = send_cmd(sdi, "set\n", (char *)&buf, sizeof(buf))) < 0) {
		sr_err("Error sending current limit query: %d.", ret);
		return SR_ERR;
	}

	if (devc->acquisition_running) {
		end_time = g_get_monotonic_time () + 5 * G_TIME_SPAN_SECOND;
		if (!g_cond_wait_until(&devc->current_limit_cond,
				&devc->acquisition_mutex, end_time)) {
			// timeout has passed.
			g_mutex_unlock(&devc->acquisition_mutex);
			return SR_ERR;
		}
	} else {
		/* Hardware sends current limit in mA, integer (0..6000). */
		devc->current_limit = g_ascii_strtod(buf + 4, NULL) / 1000;
	}
	g_mutex_unlock(&devc->acquisition_mutex);

	if (current_limit)
		*current_limit = devc->current_limit;

	return SR_OK;
}

SR_PRIV int reloadpro_get_under_voltage_threshold(const struct sr_dev_inst *sdi,
					float *uvc_threshold)
{
	struct dev_context *devc;
	int ret;
	char buf[100];
	gint64 end_time;

	devc = sdi->priv;

	g_mutex_lock(&devc->acquisition_mutex);
	if ((ret = send_cmd(sdi, "uvlo\n", (char *)&buf, sizeof(buf))) < 0) {
		sr_err("Error sending under voltage threshold query: %d.", ret);
		return SR_ERR;
	}

	if (devc->acquisition_running) {
		end_time = g_get_monotonic_time () + 5 * G_TIME_SPAN_SECOND;
		if (!g_cond_wait_until(&devc->uvc_threshold_cond,
				&devc->acquisition_mutex, end_time)) {
			// timeout has passed.
			g_mutex_unlock(&devc->acquisition_mutex);
			return SR_ERR;
		}
	} else {
		/* Hardware sends voltage in mV, integer (0..60000). */
		devc->uvc_threshold = g_ascii_strtod(buf + 5, NULL) / 1000;
	}
	g_mutex_unlock(&devc->acquisition_mutex);

	if (uvc_threshold)
		*uvc_threshold = devc->uvc_threshold;

	return SR_OK;
}

SR_PRIV int reloadpro_get_voltage_current(const struct sr_dev_inst *sdi,
		float *voltage, float *current)
{
	struct dev_context *devc;
	int ret;
	char buf[100];
	char **tokens;
	gint64 end_time;

	devc = sdi->priv;

	g_mutex_lock(&devc->acquisition_mutex);
	if ((ret = send_cmd(sdi, "read\n", (char *)&buf, sizeof(buf))) < 0) {
		sr_err("Error sending voltage/current query: %d.", ret);
		return SR_ERR;
	}

	if (devc->acquisition_running) {
		end_time = g_get_monotonic_time () + 5 * G_TIME_SPAN_SECOND;
		if (!g_cond_wait_until(&devc->voltage_cond,
				&devc->acquisition_mutex, end_time)) {
			// timeout has passed.
			g_mutex_unlock(&devc->acquisition_mutex);
			return SR_ERR;
		}
	} else {
		/* Reply: "read <current> <voltage>". */
		tokens = g_strsplit((const char *)&buf, " ", 3);
		devc->voltage = g_ascii_strtod(tokens[2], NULL) / 1000;
		devc->current = g_ascii_strtod(tokens[1], NULL) / 1000;
		g_strfreev(tokens);
	}
	g_mutex_unlock(&devc->acquisition_mutex);

	if (voltage)
		*voltage = devc->voltage;
	if (current)
		*current = devc->current;

	return SR_OK;
}

static int send_config_update_key(const struct sr_dev_inst *sdi,
		uint32_t key, GVariant *var)
{
	struct sr_config *cfg;
	struct sr_datafeed_packet packet;
	struct sr_datafeed_meta meta;
	int ret;

	cfg = sr_config_new(key, var);
	if (!cfg)
		return SR_ERR;

	memset(&meta, 0, sizeof(meta));

	packet.type = SR_DF_META;
	packet.payload = &meta;

	meta.config = g_slist_append(meta.config, cfg);

	ret = sr_session_send(sdi, &packet);
	sr_config_free(cfg);

	return ret;
}

static void handle_packet(const struct sr_dev_inst *sdi)
{
	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;
		send_config_update_key(sdi, SR_CONF_OVER_TEMPERATURE_PROTECTION_ACTIVE,
			g_variant_new_boolean(TRUE));
		return;
	}

	if (g_str_has_prefix((const char *)devc->buf, "undervolt")) {
		sr_warn("Undervoltage condition!");
		devc->uvc_active = TRUE;
		send_config_update_key(sdi, SR_CONF_UNDER_VOLTAGE_CONDITION_ACTIVE,
			g_variant_new_boolean(TRUE));
		return;
	}

	if (g_str_has_prefix((const char *)devc->buf, "err ")) {
		sr_err("Device replied with an error: '%s'.", devc->buf);
		return;
	}

	if (g_str_has_prefix((const char *)devc->buf, "set ")) {
		tokens = g_strsplit((const char *)devc->buf, " ", 2);
		devc->current_limit = g_ascii_strtod(tokens[1], NULL) / 1000;
		g_strfreev(tokens);
		g_cond_signal(&devc->current_limit_cond);
		send_config_update_key(sdi, SR_CONF_CURRENT_LIMIT,
			g_variant_new_double(devc->current_limit));
		return;
	}

	if (g_str_has_prefix((const char *)devc->buf, "uvlo ")) {
		tokens = g_strsplit((const char *)devc->buf, " ", 2);
		devc->uvc_threshold = g_ascii_strtod(tokens[1], NULL) / 1000;
		g_strfreev(tokens);
		g_cond_signal(&devc->uvc_threshold_cond);
		if (devc->uvc_threshold == .0) {
			send_config_update_key(sdi, SR_CONF_UNDER_VOLTAGE_CONDITION,
				g_variant_new_boolean(FALSE));
		} else {
			send_config_update_key(sdi, SR_CONF_UNDER_VOLTAGE_CONDITION,
				g_variant_new_boolean(TRUE));
			send_config_update_key(sdi,
				SR_CONF_UNDER_VOLTAGE_CONDITION_THRESHOLD,
				g_variant_new_double(devc->uvc_threshold));
		}
		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);
	devc->voltage = g_ascii_strtod(tokens[2], NULL) / 1000;
	devc->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;
	encoding.digits = 3;
	analog.data = &devc->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;
	encoding.digits = 3;
	analog.data = &devc->current;
	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;
	char *buf;

	devc = sdi->priv;
	serial = sdi->conn;

	len = RELOADPRO_BUFSIZE - devc->buflen;
	buf = devc->buf;
	g_mutex_lock(&devc->acquisition_mutex);
	if (serial_readline(serial, &buf, &len, 250) != SR_OK) {
		g_mutex_unlock(&devc->acquisition_mutex);
		return;
	}

	if (len == 0) {
		g_mutex_unlock(&devc->acquisition_mutex);
		return; /* No new bytes, nothing to do. */
	}
	if (len < 0) {
		sr_err("Serial port read error: %d.", len);
		g_mutex_unlock(&devc->acquisition_mutex);
		return;
	}
	devc->buflen += len;

	handle_packet(sdi);
	g_mutex_unlock(&devc->acquisition_mutex);
	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;

	sdi = cb_data;
	devc = sdi->priv;

	if (revents != G_IO_IN)
		return TRUE;

	handle_new_data(sdi);

	if (sr_sw_limits_check(&devc->limits))
		sr_dev_acquisition_stop(sdi);

	return TRUE;
}
Commit	Line	Data
6e8d31d4 UH	1	/*
	2	* This file is part of the libsigrok project.
	3	*
803db07a	4	* Copyright (C) 2015-2016 Uwe Hermann <uwe@hermann-uwe.de>
6e8d31d4 UH	5	*
	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.
	10	*
	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.
	15	*
	16	* You should have received a copy of the GNU General Public License
2ea1fdf1	17	* along with this program; if not, see <http://www.gnu.org/licenses/>.
6e8d31d4 UH	18	*/
	19
	20	#include <config.h>
9edda1d2	21	#include <math.h>
803db07a	22	#include <string.h>
6e8d31d4 UH	23	#include "protocol.h"
6e8d31d4 UH	24
b3e715e5	25	#define READ_TIMEOUT_MS 500
803db07a UH	26
	27	static int send_cmd(const struct sr_dev_inst sdi, const char cmd,
	28	char *replybuf, int replybufsize)
	29	{
	30	char *bufptr;
	31	int len, ret;
a2172899	32	struct dev_context *devc;
803db07a UH	33	struct sr_serial_dev_inst *serial;
803db07a UH	34
a2172899	35	devc = sdi->priv;
803db07a UH	36	serial = sdi->conn;
	37
	38	/* Send the command (blocking, with timeout). */
	39	if ((ret = serial_write_blocking(serial, cmd,
	40	strlen(cmd), serial_timeout(serial,
	41	strlen(cmd)))) < (int)strlen(cmd)) {
	42	sr_err("Unable to send command.");
	43	return SR_ERR;
	44	}
	45
a2172899 FS	46	if (!devc->acquisition_running) {
	47	/* Read the reply (blocking, with timeout). */
	48	memset(replybuf, 0, replybufsize);
	49	bufptr = replybuf;
803db07a UH	50	len = replybufsize;
803db07a UH	51	ret = serial_readline(serial, &bufptr, &len, READ_TIMEOUT_MS);
803db07a	52
a2172899 FS	53	/* If we got 0 characters (possibly one \r or \n), retry once. */
	54	if (len == 0) {
	55	len = replybufsize;
	56	ret = serial_readline(serial, &bufptr, &len, READ_TIMEOUT_MS);
	57	}
	58
	59	if (g_str_has_prefix((const char *)&bufptr, "err ")) {
	60	sr_err("Device replied with an error: '%s'.", bufptr);
	61	return SR_ERR;
	62	}
803db07a UH	63	}
	64
	65	return ret;
	66	}
	67
	68	SR_PRIV int reloadpro_set_current_limit(const struct sr_dev_inst *sdi,
b3e715e5	69	float current_limit)
803db07a	70	{
b3e715e5	71	struct dev_context *devc;
803db07a UH	72	int ret, ma;
	73	char buf[100];
	74	char *cmd;
	75
b3e715e5 FS	76	devc = sdi->priv;
	77
	78	if (current_limit < 0 \|\| current_limit > 6) {
	79	sr_err("The current limit must be 0-6 A (was %f A).", current_limit);
803db07a UH	80	return SR_ERR_ARG;
	81	}
	82
b3e715e5 FS	83	/* Hardware expects current limit in mA, integer (0..6000). */
b3e715e5 FS	84	ma = (int)round(current_limit * 1000);
803db07a UH	85
803db07a UH	86	cmd = g_strdup_printf("set %d\n", ma);
b3e715e5 FS	87	g_mutex_lock(&devc->acquisition_mutex);
	88	ret = send_cmd(sdi, cmd, (char *)&buf, sizeof(buf));
	89	g_mutex_unlock(&devc->acquisition_mutex);
	90	g_free(cmd);
	91
	92	if (ret < 0) {
803db07a	93	sr_err("Error sending current limit command: %d.", ret);
803db07a UH	94	return SR_ERR;
803db07a UH	95	}
803db07a UH	96	return SR_OK;
	97	}
	98
8501448c UH	99	SR_PRIV int reloadpro_set_on_off(const struct sr_dev_inst *sdi, gboolean on)
8501448c UH	100	{
b3e715e5	101	struct dev_context *devc;
8501448c UH	102	int ret;
	103	char buf[100];
	104	const char *cmd;
	105
b3e715e5 FS	106	devc = sdi->priv;
b3e715e5 FS	107
8501448c	108	cmd = (on) ? "on\n" : "off\n";
b3e715e5 FS	109	g_mutex_lock(&devc->acquisition_mutex);
	110	ret = send_cmd(sdi, cmd, (char *)&buf, sizeof(buf));
	111	g_mutex_unlock(&devc->acquisition_mutex);
	112
	113	if (ret < 0) {
8501448c UH	114	sr_err("Error sending on/off command: %d.", ret);
	115	return SR_ERR;
	116	}
8501448c UH	117	return SR_OK;
	118	}
	119
3d70d777 FS	120	SR_PRIV int reloadpro_set_under_voltage_threshold(const struct sr_dev_inst *sdi,
	121	float voltage)
	122	{
b3e715e5	123	struct dev_context *devc;
3d70d777 FS	124	int ret, mv;
	125	char buf[100];
	126	char *cmd;
	127
b3e715e5 FS	128	devc = sdi->priv;
b3e715e5 FS	129
3d70d777 FS	130	if (voltage < 0 \|\| voltage > 60) {
	131	sr_err("The under voltage threshold must be 0-60 V (was %f V).",
	132	voltage);
	133	return SR_ERR_ARG;
	134	}
	135
	136	/* Hardware expects voltage in mV, integer (0..60000). */
	137	mv = (int)round(voltage * 1000);
	138
	139	sr_spew("Setting under voltage threshold to %f V (%d mV).", voltage, mv);
	140
	141	cmd = g_strdup_printf("uvlo %d\n", mv);
b3e715e5 FS	142	g_mutex_lock(&devc->acquisition_mutex);
	143	ret = send_cmd(sdi, cmd, (char *)&buf, sizeof(buf));
	144	g_mutex_unlock(&devc->acquisition_mutex);
	145	g_free(cmd);
	146
	147	if (ret < 0) {
3d70d777	148	sr_err("Error sending under voltage threshold command: %d.", ret);
3d70d777 FS	149	return SR_ERR;
3d70d777 FS	150	}
3d70d777 FS	151	return SR_OK;
	152	}
	153
803db07a	154	SR_PRIV int reloadpro_get_current_limit(const struct sr_dev_inst *sdi,
b3e715e5	155	float *current_limit)
803db07a	156	{
b3e715e5	157	struct dev_context *devc;
803db07a UH	158	int ret;
803db07a UH	159	char buf[100];
b3e715e5	160	gint64 end_time;
a2172899 FS	161
a2172899 FS	162	devc = sdi->priv;
803db07a	163
b3e715e5	164	g_mutex_lock(&devc->acquisition_mutex);
803db07a UH	165	if ((ret = send_cmd(sdi, "set\n", (char *)&buf, sizeof(buf))) < 0) {
	166	sr_err("Error sending current limit query: %d.", ret);
	167	return SR_ERR;
	168	}
	169
b3e715e5 FS	170	if (devc->acquisition_running) {
	171	end_time = g_get_monotonic_time () + 5 * G_TIME_SPAN_SECOND;
	172	if (!g_cond_wait_until(&devc->current_limit_cond,
	173	&devc->acquisition_mutex, end_time)) {
	174	// timeout has passed.
	175	g_mutex_unlock(&devc->acquisition_mutex);
	176	return SR_ERR;
	177	}
	178	} else {
	179	/* Hardware sends current limit in mA, integer (0..6000). */
	180	devc->current_limit = g_ascii_strtod(buf + 4, NULL) / 1000;
a2172899	181	}
b3e715e5 FS	182	g_mutex_unlock(&devc->acquisition_mutex);
	183
	184	if (current_limit)
	185	*current_limit = devc->current_limit;
803db07a UH	186
	187	return SR_OK;
	188	}
	189
3d70d777	190	SR_PRIV int reloadpro_get_under_voltage_threshold(const struct sr_dev_inst *sdi,
b3e715e5	191	float *uvc_threshold)
3d70d777	192	{
b3e715e5	193	struct dev_context *devc;
3d70d777 FS	194	int ret;
3d70d777 FS	195	char buf[100];
b3e715e5	196	gint64 end_time;
3d70d777 FS	197
	198	devc = sdi->priv;
	199
b3e715e5	200	g_mutex_lock(&devc->acquisition_mutex);
3d70d777 FS	201	if ((ret = send_cmd(sdi, "uvlo\n", (char *)&buf, sizeof(buf))) < 0) {
	202	sr_err("Error sending under voltage threshold query: %d.", ret);
	203	return SR_ERR;
	204	}
	205
b3e715e5 FS	206	if (devc->acquisition_running) {
	207	end_time = g_get_monotonic_time () + 5 * G_TIME_SPAN_SECOND;
	208	if (!g_cond_wait_until(&devc->uvc_threshold_cond,
	209	&devc->acquisition_mutex, end_time)) {
	210	// timeout has passed.
	211	g_mutex_unlock(&devc->acquisition_mutex);
	212	return SR_ERR;
	213	}
	214	} else {
3d70d777	215	/* Hardware sends voltage in mV, integer (0..60000). */
b3e715e5	216	devc->uvc_threshold = g_ascii_strtod(buf + 5, NULL) / 1000;
3d70d777	217	}
b3e715e5 FS	218	g_mutex_unlock(&devc->acquisition_mutex);
	219
	220	if (uvc_threshold)
	221	*uvc_threshold = devc->uvc_threshold;
3d70d777 FS	222
	223	return SR_OK;
	224	}
	225
803db07a UH	226	SR_PRIV int reloadpro_get_voltage_current(const struct sr_dev_inst *sdi,
	227	float voltage, float current)
	228	{
b3e715e5	229	struct dev_context *devc;
803db07a UH	230	int ret;
	231	char buf[100];
	232	char **tokens;
b3e715e5	233	gint64 end_time;
a2172899 FS	234
a2172899 FS	235	devc = sdi->priv;
803db07a	236
b3e715e5	237	g_mutex_lock(&devc->acquisition_mutex);
803db07a UH	238	if ((ret = send_cmd(sdi, "read\n", (char *)&buf, sizeof(buf))) < 0) {
	239	sr_err("Error sending voltage/current query: %d.", ret);
	240	return SR_ERR;
	241	}
	242
b3e715e5 FS	243	if (devc->acquisition_running) {
	244	end_time = g_get_monotonic_time () + 5 * G_TIME_SPAN_SECOND;
	245	if (!g_cond_wait_until(&devc->voltage_cond,
	246	&devc->acquisition_mutex, end_time)) {
	247	// timeout has passed.
	248	g_mutex_unlock(&devc->acquisition_mutex);
	249	return SR_ERR;
	250	}
	251	} else {
a2172899 FS	252	/* Reply: "read <current> <voltage>". */
a2172899 FS	253	tokens = g_strsplit((const char *)&buf, " ", 3);
b3e715e5 FS	254	devc->voltage = g_ascii_strtod(tokens[2], NULL) / 1000;
b3e715e5 FS	255	devc->current = g_ascii_strtod(tokens[1], NULL) / 1000;
a2172899 FS	256	g_strfreev(tokens);
a2172899 FS	257	}
b3e715e5 FS	258	g_mutex_unlock(&devc->acquisition_mutex);
	259
	260	if (voltage)
	261	*voltage = devc->voltage;
	262	if (current)
	263	*current = devc->current;
803db07a UH	264
	265	return SR_OK;
	266	}
	267
2472271e FS	268	static int send_config_update_key(const struct sr_dev_inst *sdi,
	269	uint32_t key, GVariant *var)
	270	{
	271	struct sr_config *cfg;
	272	struct sr_datafeed_packet packet;
	273	struct sr_datafeed_meta meta;
	274	int ret;
	275
	276	cfg = sr_config_new(key, var);
	277	if (!cfg)
	278	return SR_ERR;
	279
	280	memset(&meta, 0, sizeof(meta));
	281
	282	packet.type = SR_DF_META;
	283	packet.payload = &meta;
	284
	285	meta.config = g_slist_append(meta.config, cfg);
	286
	287	ret = sr_session_send(sdi, &packet);
	288	sr_config_free(cfg);
	289
	290	return ret;
	291	}
	292
803db07a	293	static void handle_packet(const struct sr_dev_inst *sdi)
6e8d31d4	294	{
803db07a	295	struct sr_datafeed_packet packet;
6e68da51 UH	296	struct sr_datafeed_analog analog;
	297	struct sr_analog_encoding encoding;
	298	struct sr_analog_meaning meaning;
	299	struct sr_analog_spec spec;
6e8d31d4	300	struct dev_context *devc;
803db07a UH	301	char **tokens;
	302	GSList *l;
	303
	304	devc = sdi->priv;
	305
	306	if (g_str_has_prefix((const char *)devc->buf, "overtemp")) {
2217be1d	307	sr_warn("Overtemperature condition!");
803db07a	308	devc->otp_active = TRUE;
2472271e FS	309	send_config_update_key(sdi, SR_CONF_OVER_TEMPERATURE_PROTECTION_ACTIVE,
2472271e FS	310	g_variant_new_boolean(TRUE));
803db07a UH	311	return;
	312	}
	313
2217be1d UH	314	if (g_str_has_prefix((const char *)devc->buf, "undervolt")) {
	315	sr_warn("Undervoltage condition!");
	316	devc->uvc_active = TRUE;
2472271e FS	317	send_config_update_key(sdi, SR_CONF_UNDER_VOLTAGE_CONDITION_ACTIVE,
	318	g_variant_new_boolean(TRUE));
	319	return;
	320	}
	321
	322	if (g_str_has_prefix((const char *)devc->buf, "err ")) {
	323	sr_err("Device replied with an error: '%s'.", devc->buf);
	324	return;
	325	}
	326
	327	if (g_str_has_prefix((const char *)devc->buf, "set ")) {
	328	tokens = g_strsplit((const char *)devc->buf, " ", 2);
b3e715e5	329	devc->current_limit = g_ascii_strtod(tokens[1], NULL) / 1000;
2472271e	330	g_strfreev(tokens);
b3e715e5	331	g_cond_signal(&devc->current_limit_cond);
2472271e	332	send_config_update_key(sdi, SR_CONF_CURRENT_LIMIT,
b3e715e5	333	g_variant_new_double(devc->current_limit));
2217be1d UH	334	return;
	335	}
	336
3d70d777 FS	337	if (g_str_has_prefix((const char *)devc->buf, "uvlo ")) {
3d70d777 FS	338	tokens = g_strsplit((const char *)devc->buf, " ", 2);
b3e715e5	339	devc->uvc_threshold = g_ascii_strtod(tokens[1], NULL) / 1000;
3d70d777	340	g_strfreev(tokens);
b3e715e5 FS	341	g_cond_signal(&devc->uvc_threshold_cond);
b3e715e5 FS	342	if (devc->uvc_threshold == .0) {
3d70d777 FS	343	send_config_update_key(sdi, SR_CONF_UNDER_VOLTAGE_CONDITION,
	344	g_variant_new_boolean(FALSE));
	345	} else {
	346	send_config_update_key(sdi, SR_CONF_UNDER_VOLTAGE_CONDITION,
	347	g_variant_new_boolean(TRUE));
	348	send_config_update_key(sdi,
	349	SR_CONF_UNDER_VOLTAGE_CONDITION_THRESHOLD,
b3e715e5	350	g_variant_new_double(devc->uvc_threshold));
3d70d777 FS	351	}
	352	return;
	353	}
	354
803db07a UH	355	if (!g_str_has_prefix((const char *)devc->buf, "read ")) {
	356	sr_dbg("Unknown packet: '%s'.", devc->buf);
	357	return;
	358	}
	359
	360	tokens = g_strsplit((const char *)devc->buf, " ", 3);
b3e715e5 FS	361	devc->voltage = g_ascii_strtod(tokens[2], NULL) / 1000;
b3e715e5 FS	362	devc->current = g_ascii_strtod(tokens[1], NULL) / 1000;
803db07a UH	363	g_strfreev(tokens);
803db07a UH	364
803db07a UH	365	/* Begin frame. */
803db07a UH	366	packet.type = SR_DF_FRAME_BEGIN;
6e68da51	367	packet.payload = NULL;
803db07a UH	368	sr_session_send(sdi, &packet);
803db07a UH	369
6e68da51 UH	370	sr_analog_init(&analog, &encoding, &meaning, &spec, 4);
	371
	372	packet.type = SR_DF_ANALOG;
803db07a UH	373	packet.payload = &analog;
	374	analog.num_samples = 1;
	375
	376	/* Voltage */
	377	l = g_slist_copy(sdi->channels);
	378	l = g_slist_remove_link(l, g_slist_nth(l, 1));
6e68da51 UH	379	meaning.channels = l;
	380	meaning.mq = SR_MQ_VOLTAGE;
	381	meaning.mqflags = SR_MQFLAG_DC;
	382	meaning.unit = SR_UNIT_VOLT;
d7e348f4	383	encoding.digits = 3;
b3e715e5	384	analog.data = &devc->voltage;
803db07a UH	385	sr_session_send(sdi, &packet);
	386	g_slist_free(l);
	387
	388	/* Current */
	389	l = g_slist_copy(sdi->channels);
	390	l = g_slist_remove_link(l, g_slist_nth(l, 0));
6e68da51 UH	391	meaning.channels = l;
	392	meaning.mq = SR_MQ_CURRENT;
	393	meaning.mqflags = SR_MQFLAG_DC;
	394	meaning.unit = SR_UNIT_AMPERE;
d7e348f4	395	encoding.digits = 3;
b3e715e5	396	analog.data = &devc->current;
803db07a UH	397	sr_session_send(sdi, &packet);
	398	g_slist_free(l);
	399
	400	/* End frame. */
	401	packet.type = SR_DF_FRAME_END;
6e68da51	402	packet.payload = NULL;
803db07a UH	403	sr_session_send(sdi, &packet);
803db07a UH	404
014c7f93	405	sr_sw_limits_update_samples_read(&devc->limits, 1);
803db07a UH	406	}
	407
	408	static void handle_new_data(const struct sr_dev_inst *sdi)
	409	{
	410	int len;
	411	struct dev_context *devc;
	412	struct sr_serial_dev_inst *serial;
a2172899	413	char *buf;
803db07a UH	414
	415	devc = sdi->priv;
	416	serial = sdi->conn;
	417
803db07a	418	len = RELOADPRO_BUFSIZE - devc->buflen;
a2172899	419	buf = devc->buf;
b3e715e5	420	g_mutex_lock(&devc->acquisition_mutex);
a2172899	421	if (serial_readline(serial, &buf, &len, 250) != SR_OK) {
b3e715e5	422	g_mutex_unlock(&devc->acquisition_mutex);
a2172899 FS	423	return;
	424	}
	425
b3e715e5 FS	426	if (len == 0) {
b3e715e5 FS	427	g_mutex_unlock(&devc->acquisition_mutex);
803db07a	428	return; /* No new bytes, nothing to do. */
b3e715e5	429	}
803db07a UH	430	if (len < 0) {
803db07a UH	431	sr_err("Serial port read error: %d.", len);
b3e715e5	432	g_mutex_unlock(&devc->acquisition_mutex);
803db07a UH	433	return;
	434	}
	435	devc->buflen += len;
	436
a2172899	437	handle_packet(sdi);
b3e715e5	438	g_mutex_unlock(&devc->acquisition_mutex);
a2172899 FS	439	memset(devc->buf, 0, RELOADPRO_BUFSIZE);
a2172899 FS	440	devc->buflen = 0;
803db07a UH	441	}
	442
	443	SR_PRIV int reloadpro_receive_data(int fd, int revents, void *cb_data)
	444	{
	445	struct sr_dev_inst *sdi;
	446	struct dev_context *devc;
6e8d31d4 UH	447
	448	(void)fd;
	449
803db07a UH	450	sdi = cb_data;
	451	devc = sdi->priv;
	452
	453	if (revents != G_IO_IN)
6e8d31d4 UH	454	return TRUE;
6e8d31d4 UH	455
803db07a UH	456	handle_new_data(sdi);
803db07a UH	457
014c7f93	458	if (sr_sw_limits_check(&devc->limits))
d2f7c417	459	sr_dev_acquisition_stop(sdi);
6e8d31d4 UH	460
	461	return TRUE;
	462	}