X-Git-Url: https://sigrok.org/gitweb/?p=sigrok-cli.git;a=blobdiff_plain;f=session.c;h=acfbdaab529367fa19127dcf3dea241360103d19;hp=12033dcc8316a9b8f362d3c751ea3745b883f513;hb=667d4a18657b4a2b4ea77c97f4206a18dfcf86ad;hpb=30364883abef6a52180fc6244d79788298729137

diff --git a/session.c b/session.c
index 12033dc..acfbdaa 100644
--- a/session.c
+++ b/session.c
@@ -17,19 +17,16 @@
  * along with this program.  If not, see <http://www.gnu.org/licenses/>.
  */
 
+#include "sigrok-cli.h"
 #include "config.h"
 #include <glib.h>
 #include <glib/gstdio.h>
-#include <libsigrok/libsigrok.h>
-#ifdef HAVE_SRD
-#include <libsigrokdecode/libsigrokdecode.h> /* First, so we avoid a _POSIX_C_SOURCE warning. */
-#endif
-#include "sigrok-cli.h"
+#include <string.h>
+#include <stdlib.h>
 
 static struct sr_output_format *output_format = NULL;
 static int default_output_format = FALSE;
 static char *output_format_param = NULL;
-static GByteArray *savebuf;
 static uint64_t limit_samples = 0;
 static uint64_t limit_frames = 0;
 
@@ -47,26 +44,6 @@ extern gchar *opt_triggers;
 extern struct srd_session *srd_sess;
 #endif
 
-
-static GArray *get_enabled_logic_probes(const struct sr_dev_inst *sdi)
-{
-	struct sr_probe *probe;
-	GArray *probes;
-	GSList *l;
-
-	probes = g_array_new(FALSE, FALSE, sizeof(int));
-	for (l = sdi->probes; l; l = l->next) {
-		probe = l->data;
-		if (probe->type != SR_PROBE_LOGIC)
-			continue;
-		if (probe->enabled != TRUE)
-			continue;
-		g_array_append_val(probes, probe->index);
-	}
-
-	return probes;
-}
-
 static int set_limit_time(const struct sr_dev_inst *sdi)
 {
 	GVariant *gvar;
@@ -168,17 +145,20 @@ void datafeed_in(const struct sr_dev_inst *sdi,
 	const struct sr_datafeed_logic *logic;
 	const struct sr_datafeed_analog *analog;
 	struct sr_config *src;
+	struct sr_channel *ch;
 	static struct sr_output *o = NULL;
-	static GArray *logic_probelist = NULL;
-	static uint64_t received_samples = 0;
-	static int unitsize = 0;
+	static uint64_t rcvd_samples_logic = 0;
+	static uint64_t rcvd_samples_analog = 0;
+	static uint64_t samplerate = 0;
 	static int triggered = 0;
 	static FILE *outfile = NULL;
 	GSList *l;
 	GString *out;
-	int sample_size, ret;
-	uint64_t samplerate, output_len, filter_out_len, end_sample;
-	uint8_t *output_buf, *filter_out;
+	GVariant *gvar;
+	uint64_t end_sample;
+	uint64_t input_len;
+	int i;
+	char **channels;
 
 	(void) cb_data;
 
@@ -186,7 +166,6 @@ void datafeed_in(const struct sr_dev_inst *sdi,
 	if (packet->type != SR_DF_HEADER && o == NULL)
 		return;
 
-	sample_size = -1;
 	switch (packet->type) {
 	case SR_DF_HEADER:
 		g_debug("cli: Received SR_DF_HEADER");
@@ -209,30 +188,24 @@ void datafeed_in(const struct sr_dev_inst *sdi,
 		outfile = stdout;
 		if (opt_output_file) {
 			if (default_output_format) {
-				/* output file is in session format, so we'll
-				 * keep a copy of everything as it comes in
-				 * and save from there after the session. */
 				outfile = NULL;
-				savebuf = g_byte_array_new();
 			} else {
 				/* saving to a file in whatever format was set
 				 * with --format, so all we need is a filehandle */
 				outfile = g_fopen(opt_output_file, "wb");
 			}
 		}
+		rcvd_samples_logic = rcvd_samples_analog = 0;
 
-		/* Prepare for logic data. */
-		logic_probelist = get_enabled_logic_probes(sdi);
-		/* How many bytes we need to store the packed samples. */
-		unitsize = (logic_probelist->len + 7) / 8;
+		if (sr_config_get(sdi->driver, sdi, NULL, SR_CONF_SAMPLERATE,
+				&gvar) == SR_OK) {
+			samplerate = g_variant_get_uint64(gvar);
+			g_variant_unref(gvar);
+		}
 
 #ifdef HAVE_SRD
-		GVariant *gvar;
-		if (opt_pds && logic_probelist->len) {
-			if (sr_config_get(sdi->driver, sdi, NULL, SR_CONF_SAMPLERATE,
-					&gvar) == SR_OK) {
-				samplerate = g_variant_get_uint64(gvar);
-				g_variant_unref(gvar);
+		if (opt_pds) {
+			if (samplerate) {
 				if (srd_session_metadata_set(srd_sess, SRD_CONF_SAMPLERATE,
 						g_variant_new_uint64(samplerate)) != SRD_OK) {
 					g_critical("Failed to configure decode session.");
@@ -278,16 +251,12 @@ void datafeed_in(const struct sr_dev_inst *sdi,
 
 	case SR_DF_TRIGGER:
 		g_debug("cli: received SR_DF_TRIGGER");
-		if (o->format->event)
-			o->format->event(o, SR_DF_TRIGGER, &output_buf,
-					 &output_len);
 		triggered = 1;
 		break;
 
 	case SR_DF_LOGIC:
 		logic = packet->payload;
 		g_message("cli: received SR_DF_LOGIC, %"PRIu64" bytes", logic->length);
-		sample_size = logic->unitsize;
 		if (logic->length == 0)
 			break;
 
@@ -295,51 +264,42 @@ void datafeed_in(const struct sr_dev_inst *sdi,
 		if (opt_wait_trigger && !triggered)
 			break;
 
-		if (limit_samples && received_samples >= limit_samples)
-			break;
-
-		ret = sr_filter_probes(sample_size, unitsize, logic_probelist,
-				logic->data, logic->length,
-				&filter_out, &filter_out_len);
-		if (ret != SR_OK)
+		if (limit_samples && rcvd_samples_logic >= limit_samples)
 			break;
 
-		/*
-		 * What comes out of the filter is guaranteed to be packed into the
-		 * minimum size needed to support the number of samples at this sample
-		 * size. however, the driver may have submitted too much. Cut off
-		 * the buffer of the last packet according to the sample limit.
-		 */
-		if (limit_samples && (received_samples + logic->length / sample_size >
-				limit_samples * sample_size))
-			filter_out_len = limit_samples * sample_size - received_samples;
+		end_sample = rcvd_samples_logic + logic->length / logic->unitsize;
+		/* Cut off last packet according to the sample limit. */
+		if (limit_samples && end_sample > limit_samples)
+			end_sample = limit_samples;
+		input_len = (end_sample - rcvd_samples_logic) * logic->unitsize;
 
 		if (opt_output_file && default_output_format) {
 			/* Saving to a session file. */
-			g_byte_array_append(savebuf, filter_out, filter_out_len);
+			if (rcvd_samples_logic == 0) {
+				/* First packet with logic data, init session file. */
+				channels = g_malloc(sizeof(char *) * g_slist_length(sdi->channels));
+				for (i = 0, l = sdi->channels; l; l = l->next) {
+					ch = l->data;
+					if (ch->enabled && ch->type == SR_CHANNEL_LOGIC)
+						channels[i++] = ch->name;
+				}
+				channels[i] = NULL;
+				sr_session_save_init(opt_output_file, samplerate,
+						channels);
+				g_free(channels);
+			}
+			save_chunk_logic(logic->data, input_len, logic->unitsize);
 		} else {
 			if (opt_pds) {
 #ifdef HAVE_SRD
-				end_sample = received_samples + filter_out_len / unitsize;
-				if (srd_session_send(srd_sess, received_samples, end_sample,
-						(uint8_t*)filter_out, filter_out_len) != SRD_OK)
+				if (srd_session_send(srd_sess, rcvd_samples_logic, end_sample,
+						logic->data, input_len) != SRD_OK)
 					sr_session_stop();
 #endif
-			} else {
-				output_len = 0;
-				if (o->format->data && packet->type == o->format->df_type)
-					o->format->data(o, filter_out, filter_out_len,
-							&output_buf, &output_len);
-				if (output_len) {
-					fwrite(output_buf, 1, output_len, outfile);
-					fflush(outfile);
-					g_free(output_buf);
-				}
 			}
 		}
-		g_free(filter_out);
 
-		received_samples += logic->length / sample_size;
+		rcvd_samples_logic = end_sample;
 		break;
 
 	case SR_DF_ANALOG:
@@ -348,47 +308,18 @@ void datafeed_in(const struct sr_dev_inst *sdi,
 		if (analog->num_samples == 0)
 			break;
 
-		if (limit_samples && received_samples >= limit_samples)
+		if (limit_samples && rcvd_samples_analog >= limit_samples)
 			break;
 
-		if (o->format->data && packet->type == o->format->df_type) {
-			o->format->data(o, (const uint8_t *)analog->data,
-					analog->num_samples * sizeof(float),
-					&output_buf, &output_len);
-			if (output_buf) {
-				fwrite(output_buf, 1, output_len, outfile);
-				fflush(outfile);
-				g_free(output_buf);
-			}
-		}
-
-		received_samples += analog->num_samples;
+		rcvd_samples_analog += analog->num_samples;
 		break;
 
 	case SR_DF_FRAME_BEGIN:
 		g_debug("cli: received SR_DF_FRAME_BEGIN");
-		if (o->format->event) {
-			o->format->event(o, SR_DF_FRAME_BEGIN, &output_buf,
-					 &output_len);
-			if (output_buf) {
-				fwrite(output_buf, 1, output_len, outfile);
-				fflush(outfile);
-				g_free(output_buf);
-			}
-		}
 		break;
 
 	case SR_DF_FRAME_END:
 		g_debug("cli: received SR_DF_FRAME_END");
-		if (o->format->event) {
-			o->format->event(o, SR_DF_FRAME_END, &output_buf,
-					 &output_len);
-			if (output_buf) {
-				fwrite(output_buf, 1, output_len, outfile);
-				fflush(outfile);
-				g_free(output_buf);
-			}
-		}
 		break;
 
 	default:
@@ -404,30 +335,10 @@ void datafeed_in(const struct sr_dev_inst *sdi,
 	}
 
 	/* SR_DF_END needs to be handled after the output module's receive()
-	 * is called, so it can properly clean up that module etc. */
+	 * is called, so it can properly clean up that module. */
 	if (packet->type == SR_DF_END) {
 		g_debug("cli: Received SR_DF_END");
 
-		if (o->format->event) {
-			o->format->event(o, SR_DF_END, &output_buf, &output_len);
-			if (output_buf) {
-				if (outfile)
-					fwrite(output_buf, 1, output_len, outfile);
-				g_free(output_buf);
-				output_len = 0;
-			}
-		}
-
-		if (limit_samples && received_samples < limit_samples)
-			g_warning("Device only sent %" PRIu64 " samples.",
-			       received_samples);
-
-		if (opt_continuous)
-			g_warning("Device stopped after %" PRIu64 " samples.",
-			       received_samples);
-
-		g_array_free(logic_probelist, TRUE);
-
 		if (o->format->cleanup)
 			o->format->cleanup(o);
 		g_free(o);
@@ -436,93 +347,126 @@ void datafeed_in(const struct sr_dev_inst *sdi,
 		if (outfile && outfile != stdout)
 			fclose(outfile);
 
-		if (opt_output_file && default_output_format && savebuf->len) {
-			if (sr_session_save(opt_output_file, sdi, savebuf->data,
-					unitsize, savebuf->len / unitsize) != SR_OK)
-				g_critical("Failed to save session.");
-			g_byte_array_free(savebuf, TRUE);
+		if (opt_output_file && default_output_format)
+			/* Flush whatever is left out to the session file. */
+			save_chunk_logic(NULL, 0, 0);
+
+		if (limit_samples) {
+			if (rcvd_samples_logic > 0 && rcvd_samples_logic < limit_samples)
+				g_warning("Device only sent %" PRIu64 " samples.",
+					   rcvd_samples_logic);
+			else if (rcvd_samples_analog > 0 && rcvd_samples_analog < limit_samples)
+				g_warning("Device only sent %" PRIu64 " samples.",
+					   rcvd_samples_analog);
 		}
 	}
 
 }
 
-int set_dev_options(struct sr_dev_inst *sdi, GHashTable *args)
+int opt_to_gvar(char *key, char *value, struct sr_config *src)
 {
 	const struct sr_config_info *srci;
-	struct sr_probe_group *pg;
-	GHashTableIter iter;
-	gpointer key, value;
-	int ret;
-	double tmp_double;
+	double tmp_double, dlow, dhigh;
 	uint64_t tmp_u64, p, q, low, high;
+	GVariant *rational[2], *range[2];
 	gboolean tmp_bool;
-	GVariant *val, *rational[2], *range[2];
+	int ret;
 
-	g_hash_table_iter_init(&iter, args);
-	while (g_hash_table_iter_next(&iter, &key, &value)) {
-		if (!(srci = sr_config_info_name_get(key))) {
-			g_critical("Unknown device option '%s'.", (char *) key);
-			return SR_ERR;
-		}
+	if (!(srci = sr_config_info_name_get(key))) {
+		g_critical("Unknown device option '%s'.", (char *) key);
+		return -1;
+	}
+	src->key = srci->key;
 
-		if ((value == NULL) &&
-			(srci->datatype != SR_T_BOOL)) {
-			g_critical("Option '%s' needs a value.", (char *)key);
-			return SR_ERR;
-		}
-		val = NULL;
-		switch (srci->datatype) {
-		case SR_T_UINT64:
-			ret = sr_parse_sizestring(value, &tmp_u64);
-			if (ret != SR_OK)
-				break;
-			val = g_variant_new_uint64(tmp_u64);
-			break;
-		case SR_T_CHAR:
-			val = g_variant_new_string(value);
-			break;
-		case SR_T_BOOL:
-			if (!value)
-				tmp_bool = TRUE;
-			else
-				tmp_bool = sr_parse_boolstring(value);
-			val = g_variant_new_boolean(tmp_bool);
+	if ((value == NULL) &&
+		(srci->datatype != SR_T_BOOL)) {
+		g_critical("Option '%s' needs a value.", (char *)key);
+		return -1;
+	}
+
+	ret = 0;
+	switch (srci->datatype) {
+	case SR_T_UINT64:
+		ret = sr_parse_sizestring(value, &tmp_u64);
+		if (ret != 0)
 			break;
-		case SR_T_FLOAT:
-			tmp_double = strtof(value, NULL);
-			val = g_variant_new_double(tmp_double);
+		src->data = g_variant_new_uint64(tmp_u64);
+		break;
+	case SR_T_INT32:
+		ret = sr_parse_sizestring(value, &tmp_u64);
+		if (ret != 0)
 			break;
-		case SR_T_RATIONAL_PERIOD:
-			if ((ret = sr_parse_period(value, &p, &q)) != SR_OK)
-				break;
-			rational[0] = g_variant_new_uint64(p);
-			rational[1] = g_variant_new_uint64(q);
-			val = g_variant_new_tuple(rational, 2);
+		src->data = g_variant_new_int32(tmp_u64);
+		break;
+	case SR_T_CHAR:
+		src->data = g_variant_new_string(value);
+		break;
+	case SR_T_BOOL:
+		if (!value)
+			tmp_bool = TRUE;
+		else
+			tmp_bool = sr_parse_boolstring(value);
+		src->data = g_variant_new_boolean(tmp_bool);
+		break;
+	case SR_T_FLOAT:
+		tmp_double = strtof(value, NULL);
+		src->data = g_variant_new_double(tmp_double);
+		break;
+	case SR_T_RATIONAL_PERIOD:
+		if ((ret = sr_parse_period(value, &p, &q)) != SR_OK)
 			break;
-		case SR_T_RATIONAL_VOLT:
-			if ((ret = sr_parse_voltage(value, &p, &q)) != SR_OK)
-				break;
-			rational[0] = g_variant_new_uint64(p);
-			rational[1] = g_variant_new_uint64(q);
-			val = g_variant_new_tuple(rational, 2);
+		rational[0] = g_variant_new_uint64(p);
+		rational[1] = g_variant_new_uint64(q);
+		src->data = g_variant_new_tuple(rational, 2);
+		break;
+	case SR_T_RATIONAL_VOLT:
+		if ((ret = sr_parse_voltage(value, &p, &q)) != SR_OK)
 			break;
-		case SR_T_UINT64_RANGE:
-			if (sscanf(value, "%"PRIu64"-%"PRIu64, &low, &high) != 2) {
-				ret = SR_ERR;
-				break;
-			} else {
-				range[0] = g_variant_new_uint64(low);
-				range[1] = g_variant_new_uint64(high);
-				val = g_variant_new_tuple(range, 2);
-			}
+		rational[0] = g_variant_new_uint64(p);
+		rational[1] = g_variant_new_uint64(q);
+		src->data = g_variant_new_tuple(rational, 2);
+		break;
+	case SR_T_UINT64_RANGE:
+		if (sscanf(value, "%"PRIu64"-%"PRIu64, &low, &high) != 2) {
+			ret = -1;
 			break;
-		default:
-			ret = SR_ERR;
+		} else {
+			range[0] = g_variant_new_uint64(low);
+			range[1] = g_variant_new_uint64(high);
+			src->data = g_variant_new_tuple(range, 2);
 		}
-		if (val) {
-			pg = select_probe_group(sdi);
-			ret = sr_config_set(sdi, pg, srci->key, val);
+		break;
+	case SR_T_DOUBLE_RANGE:
+		if (sscanf(value, "%lf-%lf", &dlow, &dhigh) != 2) {
+			ret = -1;
+			break;
+		} else {
+			range[0] = g_variant_new_double(dlow);
+			range[1] = g_variant_new_double(dhigh);
+			src->data = g_variant_new_tuple(range, 2);
 		}
+		break;
+	default:
+		ret = -1;
+	}
+
+	return ret;
+}
+
+int set_dev_options(struct sr_dev_inst *sdi, GHashTable *args)
+{
+	struct sr_config src;
+	struct sr_channel_group *cg;
+	GHashTableIter iter;
+	gpointer key, value;
+	int ret;
+
+	g_hash_table_iter_init(&iter, args);
+	while (g_hash_table_iter_next(&iter, &key, &value)) {
+		if ((ret = opt_to_gvar(key, value, &src)) != 0)
+			return ret;
+		cg = select_channel_group(sdi);
+		ret = sr_config_set(sdi, cg, src.key, src.data);
 		if (ret != SR_OK) {
 			g_critical("Failed to set device option '%s'.", (char *)key);
 			return ret;
@@ -538,7 +482,8 @@ void run_session(void)
 	GHashTable *devargs;
 	GVariant *gvar;
 	struct sr_dev_inst *sdi;
-	int max_probes, i;
+	uint64_t min_samples, max_samples;
+	int max_channels, i;
 	char **triggerlist;
 
 	devices = device_scan();
@@ -574,8 +519,8 @@ void run_session(void)
 		}
 	}
 
-	if (select_probes(sdi) != SR_OK) {
-		g_critical("Failed to set probes.");
+	if (select_channels(sdi) != SR_OK) {
+		g_critical("Failed to set channels.");
 		sr_session_destroy();
 		return;
 	}
@@ -585,8 +530,8 @@ void run_session(void)
 			sr_session_destroy();
 			return;
 		}
-		max_probes = g_slist_length(sdi->probes);
-		for (i = 0; i < max_probes; i++) {
+		max_channels = g_slist_length(sdi->channels);
+		for (i = 0; i < max_channels; i++) {
 			if (triggerlist[i]) {
 				sr_dev_trigger_set(sdi, i, triggerlist[i]);
 				g_free(triggerlist[i]);
@@ -616,6 +561,21 @@ void run_session(void)
 			sr_session_destroy();
 			return;
 		}
+		if (sr_config_list(sdi->driver, sdi, NULL,
+				SR_CONF_LIMIT_SAMPLES, &gvar) == SR_OK) {
+			/* The device has no compression, or compression is turned
+			 * off, and publishes its sample memory size. */
+			g_variant_get(gvar, "(tt)", &min_samples, &max_samples);
+			g_variant_unref(gvar);
+			if (limit_samples < min_samples) {
+				g_critical("The device stores at least %"PRIu64
+						" samples with the current settings.", min_samples);
+			}
+			if (limit_samples > max_samples) {
+				g_critical("The device can store only %"PRIu64
+						" samples with the current settings.", max_samples);
+			}
+		}
 		gvar = g_variant_new_uint64(limit_samples);
 		if (sr_config_set(sdi, NULL, SR_CONF_LIMIT_SAMPLES, gvar) != SR_OK) {
 			g_critical("Failed to configure sample limit.");
@@ -658,3 +618,32 @@ void run_session(void)
 
 }
 
+void save_chunk_logic(uint8_t *data, uint64_t data_len, int unitsize)
+{
+	static uint8_t *buf = NULL;
+	static int buf_len = 0;
+	static int last_unitsize = 0;
+	int max;
+
+	if (!buf)
+		buf = g_malloc(SAVE_CHUNK_SIZE);
+
+	if (buf_len + data_len > SAVE_CHUNK_SIZE) {
+		max = (SAVE_CHUNK_SIZE - buf_len) / unitsize * unitsize;
+		memcpy(buf + buf_len, data, max);
+		sr_session_append(opt_output_file, buf, unitsize,
+				(buf_len + max) / unitsize);
+		memcpy(buf, data + max, data_len - max);
+		buf_len = data_len - max;
+	} else if (data_len == 0 && last_unitsize != 0) {
+		/* End of data, flush the buffer out. */
+		sr_session_append(opt_output_file, buf, last_unitsize,
+				buf_len / last_unitsize);
+	} else {
+		/* Buffer chunk. */
+		memcpy(buf + buf_len, data, data_len);
+		buf_len += data_len;
+	}
+	last_unitsize = unitsize;
+
+}