X-Git-Url: https://sigrok.org/gitweb/?a=blobdiff_plain;f=input%2Fbinary.c;h=3209c038922989c797a20ea030d222167b8184d5;hb=c506a6a688877793752d23e43d692c49d0f52dd2;hp=9a87d3e2cf929dd0e340543fd04cfe232e2dabc5;hpb=bb7ef79377ae617e1275373e0b631beb7f909d73;p=libsigrok.git diff --git a/input/binary.c b/input/binary.c index 9a87d3e2..3209c038 100644 --- a/input/binary.c +++ b/input/binary.c @@ -23,12 +23,16 @@ #include #include #include -#include "sigrok.h" -#include "sigrok-internal.h" +#include "libsigrok.h" +#include "libsigrok-internal.h" #define CHUNKSIZE (512 * 1024) #define DEFAULT_NUM_PROBES 8 +struct context { + int samplerate; +}; + static int format_match(const char *filename) { /* suppress compiler warning */ @@ -42,17 +46,37 @@ static int init(struct sr_input *in) { int num_probes, i; char name[SR_MAX_PROBENAME_LEN + 1]; + char *param; + struct context *ctx; + + if (!(ctx = g_try_malloc0(sizeof(*ctx)))) { + sr_err("binary in: %s: ctx malloc failed", __func__); + return SR_ERR_MALLOC; + } - if (in->param && in->param[0]) { - num_probes = strtoul(in->param, NULL, 10); - if (num_probes < 1) - return SR_ERR; - } else { - num_probes = DEFAULT_NUM_PROBES; + num_probes = DEFAULT_NUM_PROBES; + ctx->samplerate = 0; + + if(in->param) { + param = g_hash_table_lookup(in->param, "numprobes"); + if (param) { + num_probes = strtoul(param, NULL, 10); + if (num_probes < 1) + return SR_ERR; + } + + param = g_hash_table_lookup(in->param, "samplerate"); + if (param) { + ctx->samplerate = strtoul(param, NULL, 10); + if (ctx->samplerate < 1) { + return SR_ERR; + } + } } /* Create a virtual device. */ in->vdev = sr_dev_new(NULL, 0); + in->internal = ctx; for (i = 0; i < num_probes; i++) { snprintf(name, SR_MAX_PROBENAME_LEN, "%d", i); @@ -67,9 +91,13 @@ static int loadfile(struct sr_input *in, const char *filename) { struct sr_datafeed_header header; struct sr_datafeed_packet packet; + struct sr_datafeed_meta_logic meta; struct sr_datafeed_logic logic; unsigned char buffer[CHUNKSIZE]; int fd, size, num_probes; + struct context *ctx; + + ctx = in->internal; if ((fd = open(filename, O_RDONLY)) == -1) return SR_ERR; @@ -78,12 +106,17 @@ static int loadfile(struct sr_input *in, const char *filename) /* send header */ header.feed_version = 1; - header.num_logic_probes = num_probes; - header.samplerate = 0; gettimeofday(&header.starttime, NULL); packet.type = SR_DF_HEADER; packet.payload = &header; - sr_session_bus(in->vdev, &packet); + sr_session_send(in->vdev, &packet); + + /* Send metadata about the SR_DF_LOGIC packets to come. */ + packet.type = SR_DF_META_LOGIC; + packet.payload = &meta; + meta.samplerate = ctx->samplerate; + meta.num_probes = num_probes; + sr_session_send(in->vdev, &packet); /* chop up the input file into chunks and feed it into the session bus */ packet.type = SR_DF_LOGIC; @@ -92,13 +125,16 @@ static int loadfile(struct sr_input *in, const char *filename) logic.data = buffer; while ((size = read(fd, buffer, CHUNKSIZE)) > 0) { logic.length = size; - sr_session_bus(in->vdev, &packet); + sr_session_send(in->vdev, &packet); } close(fd); /* end of stream */ packet.type = SR_DF_END; - sr_session_bus(in->vdev, &packet); + sr_session_send(in->vdev, &packet); + + g_free(ctx); + in->internal = NULL; return SR_OK; }