X-Git-Url: https://sigrok.org/gitweb/?a=blobdiff_plain;f=input%2Fbinary.c;h=8348ea82dd9870a6aa223c6fcc804dc5fe4ad0c2;hb=a2e464604ca19c1a41b8e94625971eb3818c9090;hp=16081776a77ff264cbbf0b1c7201317702f902b8;hpb=45c59c8bdd01954f9214fe7b869d92c55415d109;p=libsigrok.git diff --git a/input/binary.c b/input/binary.c index 16081776..8348ea82 100644 --- a/input/binary.c +++ b/input/binary.c @@ -29,6 +29,10 @@ #define CHUNKSIZE (512 * 1024) #define DEFAULT_NUM_PROBES 8 +struct context { + uint64_t samplerate; +}; + static int format_match(const char *filename) { /* suppress compiler warning */ @@ -40,24 +44,45 @@ static int format_match(const char *filename) static int init(struct sr_input *in) { + struct sr_probe *probe; int num_probes, i; char name[SR_MAX_PROBENAME_LEN + 1]; + char *param; + struct context *ctx; - 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; + if (!(ctx = g_try_malloc0(sizeof(*ctx)))) { + sr_err("binary in: %s: ctx malloc failed", __func__); + return SR_ERR_MALLOC; + } + + 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) { + if (sr_parse_sizestring(param, &ctx->samplerate) != SR_OK) + return SR_ERR; + } } /* Create a virtual device. */ - in->vdev = sr_dev_new(NULL, 0); + in->sdi = sr_dev_inst_new(0, SR_ST_ACTIVE, NULL, NULL, NULL); + 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->vdev, name); + if (!(probe = sr_probe_new(i, SR_PROBE_LOGIC, TRUE, name))) + return SR_ERR; + in->sdi->probes = g_slist_append(in->sdi->probes, probe); } return SR_OK; @@ -71,25 +96,28 @@ static int loadfile(struct sr_input *in, const char *filename) 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->vdev->probes); + num_probes = g_slist_length(in->sdi->probes); /* send header */ header.feed_version = 1; gettimeofday(&header.starttime, NULL); packet.type = SR_DF_HEADER; packet.payload = &header; - sr_session_send(in->vdev, &packet); + sr_session_send(in->sdi, &packet); /* Send metadata about the SR_DF_LOGIC packets to come. */ packet.type = SR_DF_META_LOGIC; packet.payload = &meta; - meta.samplerate = 0; + meta.samplerate = ctx->samplerate; meta.num_probes = num_probes; - sr_session_send(in->vdev, &packet); + sr_session_send(in->sdi, &packet); /* chop up the input file into chunks and feed it into the session bus */ packet.type = SR_DF_LOGIC; @@ -98,13 +126,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_send(in->vdev, &packet); + sr_session_send(in->sdi, &packet); } close(fd); /* end of stream */ packet.type = SR_DF_END; - sr_session_send(in->vdev, &packet); + sr_session_send(in->sdi, &packet); + + g_free(ctx); + in->internal = NULL; return SR_OK; }