X-Git-Url: https://sigrok.org/gitweb/?a=blobdiff_plain;f=output%2Fvcd.c;h=9b753f21ea62e5788bfee1a0a975332163978257;hb=6f64ebb22306d1436becd9da4fb3761c99462810;hp=49d2d195a409e5da702de6d2b00729ff9a1c4348;hpb=2b6363b433683dfc9bedb678dfe854a56b776d4d;p=libsigrok.git diff --git a/output/vcd.c b/output/vcd.c index 49d2d195..9b753f21 100644 --- a/output/vcd.c +++ b/output/vcd.c @@ -29,56 +29,54 @@ #define LOG_PREFIX "output/vcd" struct context { - int num_enabled_probes; - GArray *probeindices; + int num_enabled_channels; + GArray *channelindices; GString *header; uint8_t *prevsample; int period; uint64_t samplerate; uint64_t samplecount; - unsigned int unitsize; }; -static const char *vcd_header_comment = "\ -$comment\n Acquisition with %d/%d probes at %s\n$end\n"; +static const char *const vcd_header_comment = + "$comment\n Acquisition with %d/%d channels at %s\n$end\n"; static int init(struct sr_output *o) { struct context *ctx; - struct sr_probe *probe; + struct sr_channel *ch; GSList *l; GVariant *gvar; - int num_probes, i; + int num_channels, i; char *samplerate_s, *frequency_s, *timestamp; time_t t; - if (!(ctx = g_try_malloc0(sizeof(struct context)))) { + if (!(ctx = g_malloc0(sizeof(struct context)))) { sr_err("%s: ctx malloc failed", __func__); return SR_ERR_MALLOC; } o->internal = ctx; - ctx->num_enabled_probes = 0; - ctx->probeindices = g_array_new(FALSE, FALSE, sizeof(int)); + ctx->num_enabled_channels = 0; + ctx->channelindices = g_array_new(FALSE, FALSE, sizeof(int)); - for (l = o->sdi->probes; l; l = l->next) { - probe = l->data; - if (probe->type != SR_PROBE_LOGIC) + for (l = o->sdi->channels; l; l = l->next) { + ch = l->data; + if (ch->type != SR_CHANNEL_LOGIC) continue; - if (!probe->enabled) + if (!ch->enabled) continue; - ctx->probeindices = g_array_append_val( - ctx->probeindices, probe->index); - ctx->num_enabled_probes++; + ctx->channelindices = g_array_append_val( + ctx->channelindices, ch->index); + ctx->num_enabled_channels++; } - if (ctx->num_enabled_probes > 94) { - sr_err("VCD only supports 94 probes."); + if (ctx->num_enabled_channels > 94) { + sr_err("VCD only supports 94 channels."); return SR_ERR; } - ctx->unitsize = (ctx->num_enabled_probes + 7) / 8; ctx->header = g_string_sized_new(512); - num_probes = g_slist_length(o->sdi->probes); + num_channels = g_slist_length(o->sdi->channels); /* timestamp */ t = time(NULL); @@ -101,7 +99,7 @@ static int init(struct sr_output *o) return SR_ERR; } g_string_append_printf(ctx->header, vcd_header_comment, - ctx->num_enabled_probes, num_probes, samplerate_s); + ctx->num_enabled_channels, num_channels, samplerate_s); g_free(samplerate_s); } @@ -125,25 +123,18 @@ static int init(struct sr_output *o) g_string_append_printf(ctx->header, "$scope module %s $end\n", PACKAGE); /* Wires / channels */ - for (i = 0, l = o->sdi->probes; l; l = l->next, i++) { - probe = l->data; - if (probe->type != SR_PROBE_LOGIC) + for (i = 0, l = o->sdi->channels; l; l = l->next, i++) { + ch = l->data; + if (ch->type != SR_CHANNEL_LOGIC) continue; - if (!probe->enabled) + if (!ch->enabled) continue; g_string_append_printf(ctx->header, "$var wire 1 %c %s $end\n", - (char)('!' + i), probe->name); + (char)('!' + i), ch->name); } g_string_append(ctx->header, "$upscope $end\n" - "$enddefinitions $end\n$dumpvars\n"); - - if (!(ctx->prevsample = g_try_malloc0(ctx->unitsize))) { - g_string_free(ctx->header, TRUE); - g_free(ctx); - sr_err("%s: ctx->prevsample malloc failed", __func__); - return SR_ERR_MALLOC; - } + "$enddefinitions $end\n"); return SR_OK; } @@ -162,15 +153,9 @@ static int receive(struct sr_output *o, const struct sr_dev_inst *sdi, *out = NULL; if (!o || !o->internal) - return SR_ERR_ARG; + return SR_ERR_BUG; ctx = o->internal; - if (packet->type == SR_DF_END) { - *out = g_string_new("$dumpoff\n$end\n"); - return SR_OK; - } else if (packet->type != SR_DF_LOGIC) - return SR_OK; - if (ctx->header) { /* The header is still here, this must be the first packet. */ *out = ctx->header; @@ -180,13 +165,32 @@ static int receive(struct sr_output *o, const struct sr_dev_inst *sdi, *out = g_string_sized_new(512); } + if (packet->type != SR_DF_LOGIC) { + if (packet->type == SR_DF_END) + /* Write final timestamp as length indicator. */ + g_string_append_printf(*out, "#%.0f\n", + (double)ctx->samplecount / + ctx->samplerate * ctx->period); + return SR_OK; + } + logic = packet->payload; + + if (!ctx->prevsample) { + /* Can't allocate this until we know the stream's unitsize. */ + if (!(ctx->prevsample = g_malloc0(logic->unitsize))) { + g_free(ctx); + sr_err("%s: ctx->prevsample malloc failed", __func__); + return SR_ERR_MALLOC; + } + } + for (i = 0; i <= logic->length - logic->unitsize; i += logic->unitsize) { sample = logic->data + i; timestamp_written = FALSE; - for (p = 0; p < ctx->num_enabled_probes; p++) { - index = g_array_index(ctx->probeindices, int, p); + for (p = 0; p < ctx->num_enabled_channels; p++) { + index = g_array_index(ctx->channelindices, int, p); curbit = ((unsigned)sample[index / 8] >> (index % 8)) & 1; @@ -215,7 +219,7 @@ static int receive(struct sr_output *o, const struct sr_dev_inst *sdi, g_string_append_c(*out, '\n'); ctx->samplecount++; - memcpy(ctx->prevsample, sample, ctx->unitsize); + memcpy(ctx->prevsample, sample, logic->unitsize); } return SR_OK; @@ -229,6 +233,8 @@ static int cleanup(struct sr_output *o) return SR_ERR_ARG; ctx = o->internal; + g_free(ctx->prevsample); + g_array_free(ctx->channelindices, TRUE); g_free(ctx); return SR_OK;