X-Git-Url: https://sigrok.org/gitweb/?a=blobdiff_plain;f=session_driver.c;h=0efd304de2bce9fbc72d93cdfccc4987d35263a0;hb=82b904b173f1443c4d6bdebdf1a7f0dda01c4982;hp=bbd5a61572bfa3da3b25df3af52360988d2fccfd;hpb=7d6588743503514c9de5c4fc8a511e9b0bdad7e6;p=libsigrok.git diff --git a/session_driver.c b/session_driver.c index bbd5a615..0efd304d 100644 --- a/session_driver.c +++ b/session_driver.c @@ -1,7 +1,7 @@ /* * This file is part of the sigrok project. * - * Copyright (C) 2011 Bert Vermeulen + * Copyright (C) 2013 Bert Vermeulen * * 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,284 +23,251 @@ #include #include #include -#include +#include "libsigrok.h" +#include "libsigrok-internal.h" + +/* Message logging helpers with driver-specific prefix string. */ +#define DRIVER_LOG_DOMAIN "virtual-session: " +#define sr_log(l, s, args...) sr_log(l, DRIVER_LOG_DOMAIN s, ## args) +#define sr_spew(s, args...) sr_spew(DRIVER_LOG_DOMAIN s, ## args) +#define sr_dbg(s, args...) sr_dbg(DRIVER_LOG_DOMAIN s, ## args) +#define sr_info(s, args...) sr_info(DRIVER_LOG_DOMAIN s, ## args) +#define sr_warn(s, args...) sr_warn(DRIVER_LOG_DOMAIN s, ## args) +#define sr_err(s, args...) sr_err(DRIVER_LOG_DOMAIN s, ## args) /* size of payloads sent across the session bus */ -#define CHUNKSIZE 4096 +/** @cond PRIVATE */ +#define CHUNKSIZE (512 * 1024) +/** @endcond */ -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; }; -static char *sessionfile = NULL; -static GSList *device_instances = NULL; -static int capabilities[] = { - SR_HWCAP_CAPTUREFILE, - SR_HWCAP_CAPTURE_UNITSIZE, +static GSList *dev_insts = NULL; +static const int hwcaps[] = { + SR_CONF_CAPTUREFILE, + SR_CONF_CAPTURE_UNITSIZE, 0, }; - -static struct session_vdevice *get_vdevice_by_index(int device_index) -{ - 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) +static int receive_data(int fd, int revents, void *cb_data) { - struct sr_device_instance *sdi; - struct session_vdevice *vdevice; + struct sr_dev_inst *sdi; + struct session_vdev *vdev; struct sr_datafeed_packet packet; + struct sr_datafeed_logic logic; GSList *l; void *buf; int ret, got_data; - /* avoid compiler warning */ - fd = fd; - revents = revents; + (void)fd; + (void)revents; - g_debug("session_driver: feed chunk"); + sr_dbg("Feed chunk."); got_data = FALSE; - for (l = device_instances; l; l = l->next) { + for (l = dev_insts; l; l = l->next) { sdi = l->data; - vdevice = sdi->priv; - if (!vdevice) + vdev = sdi->priv; + if (!vdev) /* already done with this instance */ continue; - buf = g_malloc(CHUNKSIZE); - ret = zip_fread(vdevice->capfile, buf, CHUNKSIZE); + if (!(buf = g_try_malloc(CHUNKSIZE))) { + sr_err("%s: buf malloc failed", __func__); + return FALSE; + } + + ret = zip_fread(vdev->capfile, buf, CHUNKSIZE); if (ret > 0) { 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(cb_data, &packet); } else { /* done with this capture file */ - zip_fclose(vdevice->capfile); - g_free(vdevice->capturefile); - g_free(vdevice); + zip_fclose(vdev->capfile); + g_free(vdev->capturefile); + g_free(vdev); sdi->priv = NULL; } } if (!got_data) { packet.type = SR_DF_END; - packet.length = 0; - session_bus(user_data, &packet); + sr_session_send(cb_data, &packet); + sr_session_source_remove(-1); } return TRUE; } /* driver callbacks */ +static int hw_cleanup(void); -static int hw_init(char *deviceinfo) +static int hw_init(struct sr_context *sr_ctx) { + (void)sr_ctx; - sessionfile = g_strdup(deviceinfo); - - return 0; + return SR_OK; } -static void hw_cleanup(void) +static int hw_cleanup(void) { GSList *l; - for (l = device_instances; l; l = l->next) - sr_device_instance_free(l->data); - - g_free(sessionfile); - -} - -static int hw_opendev(int device_index) -{ - struct sr_device_instance *sdi; - - 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); + for (l = dev_insts; l; l = l->next) + sr_dev_inst_free(l->data); + g_slist_free(dev_insts); + dev_insts = NULL; return SR_OK; } -static void hw_closedev(int device_index) +static int hw_dev_open(struct sr_dev_inst *sdi) { + if (!(sdi->priv = g_try_malloc0(sizeof(struct session_vdev)))) { + sr_err("%s: sdi->priv malloc failed", __func__); + return SR_ERR_MALLOC; + } - /* avoid compiler warning */ - device_index = device_index; + dev_insts = g_slist_append(dev_insts, sdi); + return SR_OK; } -static void *hw_get_device_info(int device_index, int device_info_id) +static int config_get(int id, GVariant **data, const struct sr_dev_inst *sdi) { - struct session_vdevice *vdevice; - void *info; - - if (!(vdevice = get_vdevice_by_index(device_index))) - return NULL; - - info = &vdevice->samplerate; + struct session_vdev *vdev; + + 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_ARG; + } - return info; + return SR_OK; } -static int hw_get_status(int device_index) +static int config_set(int id, GVariant *data, const struct sr_dev_inst *sdi) { + struct session_vdev *vdev; - /* avoid compiler warning */ - device_index = device_index; + vdev = sdi->priv; - if (devices) - return SR_OK; - else + switch (id) { + case SR_CONF_SAMPLERATE: + vdev->samplerate = g_variant_get_uint64(data); + sr_info("Setting samplerate to %" PRIu64 ".", vdev->samplerate); + break; + case SR_CONF_SESSIONFILE: + vdev->sessionfile = g_strdup(g_variant_get_string(data, NULL)); + sr_info("Setting sessionfile to '%s'.", vdev->sessionfile); + break; + case SR_CONF_CAPTUREFILE: + vdev->capturefile = g_strdup(g_variant_get_string(data, NULL)); + sr_info("Setting capturefile to '%s'.", vdev->capturefile); + break; + case SR_CONF_CAPTURE_UNITSIZE: + vdev->unitsize = g_variant_get_uint64(data); + break; + case SR_CONF_CAPTURE_NUM_PROBES: + vdev->num_probes = g_variant_get_uint64(data); + break; + default: + sr_err("Unknown capability: %d.", id); return SR_ERR; -} - -static int *hw_get_capabilities(void) -{ + } - return capabilities; + return SR_OK; } -static int hw_set_configuration(int device_index, int capability, void *value) +static int config_list(int key, GVariant **data, const struct sr_dev_inst *sdi) { - struct session_vdevice *vdevice; - uint64_t *tmp_u64; - if (!(vdevice = get_vdevice_by_index(device_index))) - return SR_ERR; + (void)sdi; - switch (capability) { - case SR_HWCAP_SAMPLERATE: - tmp_u64 = value; - vdevice->samplerate = *tmp_u64; - break; - case SR_HWCAP_CAPTUREFILE: - vdevice->capturefile = g_strdup(value); - break; - case SR_HWCAP_CAPTURE_UNITSIZE: - tmp_u64 = value; - vdevice->unitsize = *tmp_u64; - break; - case SR_HWCAP_CAPTURE_NUM_PROBES: - tmp_u64 = value; - vdevice->num_probes = *tmp_u64; + 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; + return SR_ERR_ARG; } return SR_OK; } -static int hw_start_acquisition(int device_index, gpointer session_device_id) +static int hw_dev_acquisition_start(const struct sr_dev_inst *sdi, + void *cb_data) { struct zip_stat zs; - struct session_vdevice *vdevice; - struct sr_datafeed_header *header; - struct sr_datafeed_packet *packet; - int err; + struct session_vdev *vdev; + int ret; - /* avoid compiler warning */ - session_device_id = session_device_id; + vdev = sdi->priv; - if (!(vdevice = get_vdevice_by_index(device_index))) - return SR_ERR; - - g_message("session_driver: opening archive %s file %s", - sessionfile, vdevice->capturefile); + sr_info("Opening archive %s file %s", vdev->sessionfile, + vdev->capturefile); - if (!(vdevice->archive = zip_open(sessionfile, 0, &err))) { - g_warning("Failed to open session file '%s': zip error %d\n", - sessionfile, err); + if (!(vdev->archive = zip_open(vdev->sessionfile, 0, &ret))) { + sr_err("Failed to open session file '%s': " + "zip error %d\n", vdev->sessionfile, ret); return SR_ERR; } - 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); + if (zip_stat(vdev->archive, vdev->capturefile, 0, &zs) == -1) { + sr_err("Failed to check capture file '%s' in " + "session file '%s'.", vdev->capturefile, vdev->sessionfile); return SR_ERR; } - 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); + if (!(vdev->capfile = zip_fopen(vdev->archive, vdev->capturefile, 0))) { + sr_err("Failed to open capture file '%s' in " + "session file '%s'.", vdev->capturefile, vdev->sessionfile); 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); - - return SR_OK; -} - -static void hw_stop_acquisition(int device_index, gpointer session_device_id) -{ - struct session_vdevice *vdevice; - - /* avoid compiler warning */ - session_device_id = session_device_id; + std_session_send_df_header(cb_data, DRIVER_LOG_DOMAIN); -// vdevice = get_vdevice_by_index(device_index); -// zip_fclose(vdevice->capfile); -// zip_close(vdevice->archive); + /* freewheeling source */ + sr_session_source_add(-1, 0, 0, receive_data, cb_data); + return SR_OK; } - -struct sr_device_plugin session_driver = { - "session", - "Session-emulating driver", - 1, - hw_init, - hw_cleanup, - hw_opendev, - hw_closedev, - hw_get_device_info, - hw_get_status, - hw_get_capabilities, - hw_set_configuration, - hw_start_acquisition, - hw_stop_acquisition, +/** @private */ +SR_PRIV struct sr_dev_driver session_driver = { + .name = "virtual-session", + .longname = "Session-emulating driver", + .api_version = 1, + .init = hw_init, + .cleanup = hw_cleanup, + .config_get = config_get, + .config_set = config_set, + .config_list = config_list, + .dev_open = hw_dev_open, + .dev_close = NULL, + .dev_acquisition_start = hw_dev_acquisition_start, + .dev_acquisition_stop = NULL, };