X-Git-Url: https://sigrok.org/gitweb/?a=blobdiff_plain;f=input%2Fbinary.c;h=3209c038922989c797a20ea030d222167b8184d5;hb=c506a6a688877793752d23e43d692c49d0f52dd2;hp=4ea77b23d44a5ca32c94ebf7362651feea1d7953;hpb=031685005b022b98b5b1604cc6226c0cc2b959f8;p=libsigrok.git diff --git a/input/binary.c b/input/binary.c index 4ea77b23..3209c038 100644 --- a/input/binary.c +++ b/input/binary.c @@ -1,7 +1,7 @@ /* * This file is part of the sigrok project. * - * Copyright (C) 2010 Bert Vermeulen + * Copyright (C) 2010-2012 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,11 +23,16 @@ #include #include #include -#include "sigrok.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 */ @@ -41,22 +46,42 @@ 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->vdevice = sr_dev_new(NULL, 0); + 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); /* TODO: Check return value. */ - sr_dev_probe_add(in->vdevice, name); + sr_dev_probe_add(in->vdev, name); } return SR_OK; @@ -66,23 +91,32 @@ 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; - num_probes = g_slist_length(in->vdevice->probes); + num_probes = g_slist_length(in->vdev->probes); /* 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->vdevice, &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; @@ -91,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->vdevice, &packet); + sr_session_send(in->vdev, &packet); } close(fd); /* end of stream */ packet.type = SR_DF_END; - sr_session_bus(in->vdevice, &packet); + sr_session_send(in->vdev, &packet); + + g_free(ctx); + in->internal = NULL; return SR_OK; }