]> sigrok.org Git - libsigrok.git/blobdiff - output/vcd.c
GPL headers: Use correct project name.
[libsigrok.git] / output / vcd.c
index f937ef7fd1223d8480754d69c8f2be872caf0857..48bd4bb11148c86a3d085eb8ed544fe1f1755f81 100644 (file)
@@ -1,8 +1,8 @@
 /*
- * This file is part of the sigrok project.
+ * This file is part of the libsigrok project.
  *
  * Copyright (C) 2010 Uwe Hermann <uwe@hermann-uwe.de>
- * Copyright (C) 2010-2012 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
@@ -37,8 +37,8 @@
 
 struct context {
        int num_enabled_probes;
-       int unitsize;
        char *probelist[SR_MAX_NUM_PROBES + 1];
+       int probeindices[SR_MAX_NUM_PROBES + 1];
        int *prevbits;
        GString *header;
        uint64_t prevsample;
@@ -54,7 +54,7 @@ static int init(struct sr_output *o)
        struct context *ctx;
        struct sr_probe *probe;
        GSList *l;
-       uint64_t *samplerate;
+       GVariant *gvar;
        int num_probes, i;
        char *samplerate_s, *frequency_s, *timestamp;
        time_t t;
@@ -71,7 +71,9 @@ static int init(struct sr_output *o)
                probe = l->data;
                if (!probe->enabled)
                        continue;
-               ctx->probelist[ctx->num_enabled_probes++] = probe->name;
+               ctx->probelist[ctx->num_enabled_probes] = probe->name;
+               ctx->probeindices[ctx->num_enabled_probes] = probe->index;
+               ctx->num_enabled_probes++;
        }
        if (ctx->num_enabled_probes > 94) {
                sr_err("VCD only supports 94 probes.");
@@ -79,7 +81,6 @@ static int init(struct sr_output *o)
        }
 
        ctx->probelist[ctx->num_enabled_probes] = 0;
-       ctx->unitsize = (ctx->num_enabled_probes + 7) / 8;
        ctx->header = g_string_sized_new(512);
        num_probes = g_slist_length(o->sdi->probes);
 
@@ -94,18 +95,19 @@ static int init(struct sr_output *o)
        g_string_append_printf(ctx->header, "$version %s %s $end\n",
                        PACKAGE, PACKAGE_VERSION);
 
-       if (o->sdi->driver && sr_dev_has_hwcap(o->sdi, SR_CONF_SAMPLERATE)) {
-               o->sdi->driver->info_get(SR_DI_CUR_SAMPLERATE,
-                               (const void **)&samplerate, o->sdi);
-               ctx->samplerate = *samplerate;
+       if (o->sdi->driver && sr_dev_has_option(o->sdi, SR_CONF_SAMPLERATE)) {
+               o->sdi->driver->config_get(SR_CONF_SAMPLERATE, &gvar, o->sdi);
+               ctx->samplerate = g_variant_get_uint64(gvar);
                if (!((samplerate_s = sr_samplerate_string(ctx->samplerate)))) {
                        g_string_free(ctx->header, TRUE);
                        g_free(ctx);
+                       g_variant_unref(gvar);
                        return SR_ERR;
                }
                g_string_append_printf(ctx->header, vcd_header_comment,
                                 ctx->num_enabled_probes, num_probes, samplerate_s);
                g_free(samplerate_s);
+               g_variant_unref(gvar);
        }
 
        /* timescale */
@@ -146,71 +148,64 @@ static int init(struct sr_output *o)
        return SR_OK;
 }
 
-static int event(struct sr_output *o, int event_type, uint8_t **data_out,
-                uint64_t *length_out)
-{
-       uint8_t *outbuf;
-
-       switch (event_type) {
-       case SR_DF_END:
-               outbuf = (uint8_t *)g_strdup("$dumpoff\n$end\n");
-               *data_out = outbuf;
-               *length_out = strlen((const char *)outbuf);
-               g_free(o->internal);
-               o->internal = NULL;
-               break;
-       default:
-               *data_out = NULL;
-               *length_out = 0;
-               break;
-       }
-
-       return SR_OK;
-}
-
-static int data(struct sr_output *o, const uint8_t *data_in,
-               uint64_t length_in, uint8_t **data_out, uint64_t *length_out)
+static GString *receive(struct sr_output *o, const struct sr_dev_inst *sdi,
+               const struct sr_datafeed_packet *packet)
 {
+       const struct sr_datafeed_logic *logic;
        struct context *ctx;
+       GString *text;
        unsigned int i;
-       int p, curbit, prevbit;
+       int p, curbit, prevbit, index;
        uint64_t sample;
        static uint64_t samplecount = 0;
-       GString *out;
-       int first_sample = 0;
+       gboolean first_sample;
 
+       (void)sdi;
+
+       if (!o || !o->internal)
+               return NULL;
        ctx = o->internal;
-       out = g_string_sized_new(512);
+
+       if (packet->type == SR_DF_END) {
+               text = g_string_sized_new(16);
+               g_string_printf(text, "$dumpoff\n$end\n");
+               return text;
+       } else if (packet->type != SR_DF_LOGIC)
+               return NULL;
 
        if (ctx->header) {
                /* The header is still here, this must be the first packet. */
-               g_string_append(out, ctx->header->str);
-               g_string_free(ctx->header, TRUE);
+               text = ctx->header;
                ctx->header = NULL;
-               first_sample = 1;
+               first_sample = TRUE;
+       } else {
+               text = g_string_sized_new(512);
+               first_sample = FALSE;
        }
 
-       for (i = 0; i <= length_in - ctx->unitsize; i += ctx->unitsize) {
+       logic = packet->payload;
+       for (i = 0; i <= logic->length - logic->unitsize; i += logic->unitsize) {
                samplecount++;
 
-               memcpy(&sample, data_in + i, ctx->unitsize);
+               memcpy(&sample, logic->data + i, logic->unitsize);
 
                if (first_sample) {
                        /* First packet. We neg to make sure sample is stored. */
                        ctx->prevsample = ~sample;
-                       first_sample = 0;
+                       first_sample = FALSE;
                }
 
                for (p = 0; p < ctx->num_enabled_probes; p++) {
-                       curbit = (sample & ((uint64_t) (1 << p))) >> p;
-                       prevbit = (ctx->prevsample & ((uint64_t) (1 << p))) >> p;
+                       index = ctx->probeindices[p];
+                       curbit = (sample & (((uint64_t) 1) << index)) >> index;
+                       prevbit = (ctx->prevsample & (((uint64_t) 1) << index)) >> index;
 
                        /* VCD only contains deltas/changes of signals. */
                        if (prevbit == curbit)
                                continue;
 
                        /* Output which signal changed to which value. */
-                       g_string_append_printf(out, "#%" PRIu64 "\n%i%c\n",
+                       g_string_append_printf(text, "#%" PRIu64 "\n%i%c\n",
                                        (uint64_t)(((float)samplecount / ctx->samplerate)
                                        * ctx->period), curbit, (char)('!' + p));
                }
@@ -218,9 +213,18 @@ static int data(struct sr_output *o, const uint8_t *data_in,
                ctx->prevsample = sample;
        }
 
-       *data_out = (uint8_t *)out->str;
-       *length_out = out->len;
-       g_string_free(out, FALSE);
+       return text;
+}
+
+static int cleanup(struct sr_output *o)
+{
+       struct context *ctx;
+
+       if (!o || !o->internal)
+               return SR_ERR_ARG;
+
+       ctx = o->internal;
+       g_free(ctx);
 
        return SR_OK;
 }
@@ -230,6 +234,6 @@ struct sr_output_format output_vcd = {
        .description = "Value Change Dump (VCD)",
        .df_type = SR_DF_LOGIC,
        .init = init,
-       .data = data,
-       .event = event,
+       .recv = receive,
+       .cleanup = cleanup,
 };