X-Git-Url: https://sigrok.org/gitweb/?a=blobdiff_plain;f=session_driver.c;h=9120ea14575b4f2e71fbfa3d0fcdfc28100b8467;hb=43cd4637285833706f8a404ca027bcf0ee75b9ae;hp=1bc430d522033bc6570551567e9d27370c17d6b5;hpb=b8c2f85f561a3e2738b621a0d42e0c066c1fcee9;p=libsigrok.git

diff --git a/session_driver.c b/session_driver.c
index 1bc430d5..9120ea14 100644
--- a/session_driver.c
+++ b/session_driver.c
@@ -1,7 +1,7 @@
 /*
- * This file is part of the sigrok project.
+ * This file is part of the libsigrok project.
  *
- * Copyright (C) 2011 Bert Vermeulen <bert@biot.com>
+ * Copyright (C) 2013 Bert Vermeulen <bert@biot.com>
  *
  * 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
@@ -23,87 +23,141 @@
 #include <unistd.h>
 #include <sys/time.h>
 #include <zip.h>
-#include <sigrok.h>
+#include "libsigrok.h"
+#include "libsigrok-internal.h"
+
+#define LOG_PREFIX "virtual-session"
 
 /* size of payloads sent across the session bus */
-#define CHUNKSIZE 4096
+/** @cond PRIVATE */
+#define CHUNKSIZE (512 * 1024)
+/** @endcond */
+
+SR_PRIV struct sr_dev_driver session_driver_info;
+static struct sr_dev_driver *di = &session_driver_info;
 
-struct session_vdevice {
+struct session_vdev {
+	char *sessionfile;
 	char *capturefile;
 	struct zip *archive;
 	struct zip_file *capfile;
+	int bytes_read;
 	uint64_t samplerate;
 	int unitsize;
-	int num_probes;
+	int num_channels;
+	int cur_chunk;
+	gboolean finished;
 };
 
-static char *sessionfile = NULL;
-static GSList *device_instances = NULL;
-static int capabilities[] = {
-	SR_HWCAP_CAPTUREFILE,
-	SR_HWCAP_CAPTURE_UNITSIZE,
-	0,
+static const int hwcaps[] = {
+	SR_CONF_CAPTUREFILE,
+	SR_CONF_CAPTURE_UNITSIZE,
+	SR_CONF_SAMPLERATE,
 };
 
-
-static struct session_vdevice *get_vdevice_by_index(int device_index)
+static int receive_data(int fd, int revents, void *cb_data)
 {
-	struct sr_device_instance *sdi;
-	struct session_vdevice *vdevice;
-
-	if (!(sdi = sr_get_device_instance(device_instances, device_index)))
-		return NULL;
-
-	vdevice = sdi->priv;
-
-	return vdevice;
-}
-
-static int feed_chunk(int fd, int revents, void *user_data)
-{
-	struct sr_device_instance *sdi;
-	struct session_vdevice *vdevice;
+	struct sr_dev_inst *sdi;
+	struct session_vdev *vdev;
 	struct sr_datafeed_packet packet;
-	GSList *l;
-	void *buf;
+	struct sr_datafeed_logic logic;
+	struct zip_stat zs;
 	int ret, got_data;
+	char capturefile[16];
+	void *buf;
 
-	/* avoid compiler warning */
-	fd = fd;
-	revents = revents;
-
-	g_debug("session_driver: feed chunk");
+	(void)fd;
+	(void)revents;
 
+	sdi = cb_data;
 	got_data = FALSE;
-	for (l = device_instances; l; l = l->next) {
-		sdi = l->data;
-		vdevice = sdi->priv;
-		if (!vdevice)
-			/* already done with this instance */
-			continue;
-
-		buf = g_malloc(CHUNKSIZE);
-		ret = zip_fread(vdevice->capfile, buf, CHUNKSIZE);
+	vdev = sdi->priv;
+	if (!vdev->finished) {
+		if (!vdev->capfile) {
+			/* No capture file opened yet, or finished with the last
+			 * chunked one. */
+			if (vdev->cur_chunk == 0) {
+				/* capturefile is always the unchunked base name. */
+				if (zip_stat(vdev->archive, vdev->capturefile, 0, &zs) != -1) {
+					/* No chunks, just a single capture file. */
+					vdev->cur_chunk = 0;
+					if (!(vdev->capfile = zip_fopen(vdev->archive,
+							vdev->capturefile, 0)))
+						return FALSE;
+						sr_dbg("Opened %s.", vdev->capturefile);
+				} else {
+					/* Try as first chunk filename. */
+					snprintf(capturefile, 15, "%s-1", vdev->capturefile);
+					if (zip_stat(vdev->archive, capturefile, 0, &zs) != -1) {
+						vdev->cur_chunk = 1;
+						if (!(vdev->capfile = zip_fopen(vdev->archive,
+								capturefile, 0)))
+							return FALSE;
+						sr_dbg("Opened %s.", capturefile);
+					} else {
+						sr_err("No capture file '%s' in " "session file '%s'.",
+								vdev->capturefile, vdev->sessionfile);
+						return FALSE;
+					}
+				}
+			} else {
+				/* Capture data is chunked, advance to the next chunk. */
+				vdev->cur_chunk++;
+				snprintf(capturefile, 15, "%s-%d", vdev->capturefile,
+						vdev->cur_chunk);
+				if (zip_stat(vdev->archive, capturefile, 0, &zs) != -1) {
+					if (!(vdev->capfile = zip_fopen(vdev->archive,
+							capturefile, 0)))
+						return FALSE;
+					sr_dbg("Opened %s.", capturefile);
+				} else {
+					/* We got all the chunks, finish up. */
+					vdev->finished = TRUE;
+					return TRUE;
+				}
+			}
+		}
+
+		if (!(buf = g_try_malloc(CHUNKSIZE))) {
+			sr_err("%s: buf malloc failed", __func__);
+			return FALSE;
+		}
+
+		ret = zip_fread(vdev->capfile, buf,
+				CHUNKSIZE / vdev->unitsize * vdev->unitsize);
 		if (ret > 0) {
+			if (ret % vdev->unitsize != 0)
+				sr_warn("Read size %d not a multiple of the"
+					" unit size %d.", ret, vdev->unitsize);
 			got_data = TRUE;
 			packet.type = SR_DF_LOGIC;
-			packet.length = ret;
-			packet.unitsize = vdevice->unitsize;
-			packet.payload = buf;
-			session_bus(user_data, &packet);
+			packet.payload = &logic;
+			logic.length = ret;
+			logic.unitsize = vdev->unitsize;
+			logic.data = buf;
+			vdev->bytes_read += ret;
+			sr_session_send(sdi, &packet);
 		} else {
 			/* done with this capture file */
-			zip_fclose(vdevice->capfile);
-			g_free(vdevice->capturefile);
-			g_free(vdevice);
-			sdi->priv = NULL;
+			zip_fclose(vdev->capfile);
+			vdev->capfile = NULL;
+			if (vdev->cur_chunk == 0) {
+				/* It was the only file. */
+				vdev->finished = TRUE;
+			} else {
+				/* There might be more chunks, so don't fall through
+				 * to the SR_DF_END here. */
+				g_free(buf);
+				return TRUE;
+			}
 		}
+		g_free(buf);
 	}
 
 	if (!got_data) {
 		packet.type = SR_DF_END;
-		packet.length = 0;
-		session_bus(user_data, &packet);
+		sr_session_send(sdi, &packet);
+		sr_session_source_remove(sdi->session, -1);
 	}
 
 	return TRUE;
@@ -111,178 +165,173 @@ static int feed_chunk(int fd, int revents, void *user_data)
 
 /* driver callbacks */
 
-static int hw_init(char *deviceinfo)
+static int init(struct sr_context *sr_ctx)
 {
-
-	sessionfile = g_strdup(deviceinfo);
-
-	return 0;
+	return std_init(sr_ctx, di, LOG_PREFIX);
 }
 
-static void hw_cleanup(void)
+static int dev_clear(void)
 {
+	struct drv_context *drvc;
 	GSList *l;
 
-	for (l = device_instances; l; l = l->next)
-		sr_device_instance_free(l->data);
-
-	g_free(sessionfile);
+	drvc = di->priv;
+	for (l = drvc->instances; l; l = l->next)
+		sr_dev_inst_free(l->data);
+	g_slist_free(drvc->instances);
+	drvc->instances = NULL;
 
+	return SR_OK;
 }
 
-static int hw_opendev(int device_index)
+static int dev_open(struct sr_dev_inst *sdi)
 {
-	struct sr_device_instance *sdi;
+	struct drv_context *drvc;
+	struct session_vdev *vdev;
 
-	sdi = sr_device_instance_new(device_index, SR_ST_INITIALIZING,
-		NULL, NULL, NULL);
-	if (!sdi)
-		return SR_ERR;
-	sdi->priv = g_malloc0(sizeof(struct session_vdevice));
-	if (!sdi->priv)
-		return SR_ERR;
-	device_instances = g_slist_append(device_instances, sdi);
+	drvc = di->priv;
+	vdev = g_malloc0(sizeof(struct session_vdev));
+	sdi->priv = vdev;
+	drvc->instances = g_slist_append(drvc->instances, sdi);
 
 	return SR_OK;
 }
 
-static void *hw_get_device_info(int device_index, int device_info_id)
+static int dev_close(struct sr_dev_inst *sdi)
 {
-	struct session_vdevice *vdevice;
-	void *info;
-
-	if (device_info_id != SR_DI_CUR_SAMPLERATE)
-		return NULL;
-
-	if (!(vdevice = get_vdevice_by_index(device_index)))
-		return NULL;
+	const struct session_vdev *const vdev = sdi->priv;
+	g_free(vdev->sessionfile);
+	g_free(vdev->capturefile);
 
-	info = &vdevice->samplerate;
+	g_free(sdi->priv);
+	sdi->priv = NULL;
 
-	return info;
+	return SR_OK;
 }
 
-static int hw_get_status(int device_index)
+static int config_get(int id, GVariant **data, const struct sr_dev_inst *sdi,
+		const struct sr_channel_group *cg)
 {
+	struct session_vdev *vdev;
 
-	/* avoid compiler warning */
-	device_index = device_index;
-
-	if (devices)
-		return SR_OK;
-	else
-		return SR_ERR;
-}
+	(void)cg;
 
-static int *hw_get_capabilities(void)
-{
+	switch (id) {
+	case SR_CONF_SAMPLERATE:
+		if (sdi) {
+			vdev = sdi->priv;
+			*data = g_variant_new_uint64(vdev->samplerate);
+		} else
+			return SR_ERR;
+		break;
+	default:
+		return SR_ERR_NA;
+	}
 
-	return capabilities;
+	return SR_OK;
 }
 
-static int hw_set_configuration(int device_index, int capability, void *value)
+static int config_set(int id, GVariant *data, const struct sr_dev_inst *sdi,
+		const struct sr_channel_group *cg)
 {
-	struct session_vdevice *vdevice;
-	uint64_t *tmp_u64;
+	struct session_vdev *vdev;
 
-	if (!(vdevice = get_vdevice_by_index(device_index)))
-		return SR_ERR;
+	(void)cg;
+
+	vdev = sdi->priv;
 
-	switch (capability) {
-	case SR_HWCAP_SAMPLERATE:
-		tmp_u64 = value;
-		vdevice->samplerate = *tmp_u64;
+	switch (id) {
+	case SR_CONF_SAMPLERATE:
+		vdev->samplerate = g_variant_get_uint64(data);
+		sr_info("Setting samplerate to %" PRIu64 ".", vdev->samplerate);
 		break;
-	case SR_HWCAP_CAPTUREFILE:
-		vdevice->capturefile = g_strdup(value);
+	case SR_CONF_SESSIONFILE:
+		g_free(vdev->sessionfile);
+		vdev->sessionfile = g_strdup(g_variant_get_string(data, NULL));
+		sr_info("Setting sessionfile to '%s'.", vdev->sessionfile);
 		break;
-	case SR_HWCAP_CAPTURE_UNITSIZE:
-		tmp_u64 = value;
-		vdevice->unitsize = *tmp_u64;
+	case SR_CONF_CAPTUREFILE:
+		g_free(vdev->capturefile);
+		vdev->capturefile = g_strdup(g_variant_get_string(data, NULL));
+		sr_info("Setting capturefile to '%s'.", vdev->capturefile);
 		break;
-	case SR_HWCAP_CAPTURE_NUM_PROBES:
-		tmp_u64 = value;
-		vdevice->num_probes = *tmp_u64;
+	case SR_CONF_CAPTURE_UNITSIZE:
+		vdev->unitsize = g_variant_get_uint64(data);
+		break;
+	case SR_CONF_NUM_LOGIC_CHANNELS:
+		vdev->num_channels = g_variant_get_uint64(data);
 		break;
 	default:
-		return SR_ERR;
+		return SR_ERR_NA;
 	}
 
 	return SR_OK;
 }
 
-static int hw_start_acquisition(int device_index, gpointer session_device_id)
+static int config_list(int key, GVariant **data, const struct sr_dev_inst *sdi,
+		const struct sr_channel_group *cg)
 {
-	struct zip_stat zs;
-	struct session_vdevice *vdevice;
-	struct sr_datafeed_header *header;
-	struct sr_datafeed_packet *packet;
-	int err;
+	(void)sdi;
+	(void)cg;
 
-	/* avoid compiler warning */
-	session_device_id = session_device_id;
+	switch (key) {
+	case SR_CONF_DEVICE_OPTIONS:
+		*data = g_variant_new_fixed_array(G_VARIANT_TYPE_INT32,
+				hwcaps, ARRAY_SIZE(hwcaps), sizeof(int32_t));
+		break;
+	default:
+		return SR_ERR_NA;
+	}
 
-	if (!(vdevice = get_vdevice_by_index(device_index)))
-		return SR_ERR;
+	return SR_OK;
+}
 
-	g_message("session_driver: opening archive %s file %s",
-			sessionfile, vdevice->capturefile);
+static int dev_acquisition_start(const struct sr_dev_inst *sdi, void *cb_data)
+{
+	struct session_vdev *vdev;
+	int ret;
 
-	if (!(vdevice->archive = zip_open(sessionfile, 0, &err))) {
-		g_warning("Failed to open session file '%s': zip error %d\n",
-				sessionfile, err);
-		return SR_ERR;
-	}
+	(void)cb_data;
 
-	if (zip_stat(vdevice->archive, vdevice->capturefile, 0, &zs) == -1) {
-		g_warning("Failed to check capture file '%s' in session file '%s'.",
-				vdevice->capturefile, sessionfile);
-		return SR_ERR;
-	}
+	vdev = sdi->priv;
+	vdev->bytes_read = 0;
+	vdev->cur_chunk = 0;
+	vdev->finished = FALSE;
 
-	if (!(vdevice->capfile = zip_fopen(vdevice->archive, vdevice->capturefile, 0))) {
-		g_warning("Failed to open capture file '%s' in session file '%s'.",
-				vdevice->capturefile, sessionfile);
+	sr_info("Opening archive %s file %s", vdev->sessionfile,
+		vdev->capturefile);
+
+	if (!(vdev->archive = zip_open(vdev->sessionfile, 0, &ret))) {
+		sr_err("Failed to open session file '%s': "
+		       "zip error %d.", vdev->sessionfile, ret);
 		return SR_ERR;
 	}
 
-	/* freewheeling source */
-	session_source_add(-1, 0, 0, feed_chunk, session_device_id);
-
 	/* Send header packet to the session bus. */
-	packet = g_malloc(sizeof(struct sr_datafeed_packet));
-	header = g_malloc(sizeof(struct sr_datafeed_header));
-	if (!packet || !header)
-		return SR_ERR;
-	packet->type = SR_DF_HEADER;
-	packet->length = sizeof(struct sr_datafeed_header);
-	packet->payload = (unsigned char *)header;
-	header->feed_version = 1;
-	gettimeofday(&header->starttime, NULL);
-	header->samplerate = 0;
-	header->protocol_id = SR_PROTO_RAW;
-	header->num_logic_probes = vdevice->num_probes;
-	header->num_analog_probes = 0;
-	session_bus(session_device_id, packet);
-	g_free(header);
-	g_free(packet);
+	std_session_send_df_header(sdi, LOG_PREFIX);
+
+	/* freewheeling source */
+	sr_session_source_add(sdi->session, -1, 0, 0, receive_data, (void *)sdi);
 
 	return SR_OK;
 }
 
-
-struct sr_device_plugin session_driver = {
-	"session",
-	"Session-emulating driver",
-	1,
-	hw_init,
-	hw_cleanup,
-	hw_opendev,
-	NULL,
-	hw_get_device_info,
-	hw_get_status,
-	hw_get_capabilities,
-	hw_set_configuration,
-	hw_start_acquisition,
-	NULL
+/** @private */
+SR_PRIV struct sr_dev_driver session_driver = {
+	.name = "virtual-session",
+	.longname = "Session-emulating driver",
+	.api_version = 1,
+	.init = init,
+	.cleanup = dev_clear,
+	.scan = NULL,
+	.dev_list = NULL,
+	.dev_clear = dev_clear,
+	.config_get = config_get,
+	.config_set = config_set,
+	.config_list = config_list,
+	.dev_open = dev_open,
+	.dev_close = dev_close,
+	.dev_acquisition_start = dev_acquisition_start,
+	.dev_acquisition_stop = NULL,
+	.priv = NULL,
 };