/* * This file is part of the libsigrok project. * * Copyright (C) 2010 Uwe Hermann * Copyright (C) 2013 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 * the Free Software Foundation; either version 2 of the License, or * (at your option) any later version. * * This program is distributed in the hope that it will be useful, * but WITHOUT ANY WARRANTY; without even the implied warranty of * MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE. See the * GNU General Public License for more details. * * You should have received a copy of the GNU General Public License * along with this program; if not, write to the Free Software * Foundation, Inc., 51 Franklin St, Fifth Floor, Boston, MA 02110-1301 USA */ #include #include #include #include "config.h" /* Needed for PACKAGE and others. */ #include "libsigrok.h" #include "libsigrok-internal.h" #define LOG_PREFIX "output/vcd" struct context { int num_enabled_channels; GArray *channelindices; GString *header; uint8_t *prevsample; int period; uint64_t samplerate; uint64_t samplecount; }; 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_channel *ch; GSList *l; GVariant *gvar; int num_channels, i; char *samplerate_s, *frequency_s, *timestamp; time_t t; if (!(ctx = g_malloc0(sizeof(struct context)))) { sr_err("%s: ctx malloc failed", __func__); return SR_ERR_MALLOC; } o->internal = ctx; ctx->num_enabled_channels = 0; ctx->channelindices = g_array_new(FALSE, FALSE, sizeof(int)); for (l = o->sdi->channels; l; l = l->next) { ch = l->data; if (ch->type != SR_CHANNEL_LOGIC) continue; if (!ch->enabled) continue; ctx->channelindices = g_array_append_val( ctx->channelindices, ch->index); ctx->num_enabled_channels++; } if (ctx->num_enabled_channels > 94) { sr_err("VCD only supports 94 channels."); return SR_ERR; } ctx->header = g_string_sized_new(512); num_channels = g_slist_length(o->sdi->channels); /* timestamp */ t = time(NULL); timestamp = g_strdup(ctime(&t)); timestamp[strlen(timestamp)-1] = 0; g_string_printf(ctx->header, "$date %s $end\n", timestamp); g_free(timestamp); /* generator */ g_string_append_printf(ctx->header, "$version %s %s $end\n", PACKAGE, PACKAGE_VERSION); if (sr_config_get(o->sdi->driver, o->sdi, NULL, SR_CONF_SAMPLERATE, &gvar) == SR_OK) { ctx->samplerate = g_variant_get_uint64(gvar); g_variant_unref(gvar); if (!((samplerate_s = sr_samplerate_string(ctx->samplerate)))) { g_string_free(ctx->header, TRUE); g_free(ctx); return SR_ERR; } g_string_append_printf(ctx->header, vcd_header_comment, ctx->num_enabled_channels, num_channels, samplerate_s); g_free(samplerate_s); } /* timescale */ /* VCD can only handle 1/10/100 (s - fs), so scale up first */ if (ctx->samplerate > SR_MHZ(1)) ctx->period = SR_GHZ(1); else if (ctx->samplerate > SR_KHZ(1)) ctx->period = SR_MHZ(1); else ctx->period = SR_KHZ(1); if (!(frequency_s = sr_period_string(ctx->period))) { g_string_free(ctx->header, TRUE); g_free(ctx); return SR_ERR; } g_string_append_printf(ctx->header, "$timescale %s $end\n", frequency_s); g_free(frequency_s); /* scope */ g_string_append_printf(ctx->header, "$scope module %s $end\n", PACKAGE); /* Wires / channels */ for (i = 0, l = o->sdi->channels; l; l = l->next, i++) { ch = l->data; if (ch->type != SR_CHANNEL_LOGIC) continue; if (!ch->enabled) continue; g_string_append_printf(ctx->header, "$var wire 1 %c %s $end\n", (char)('!' + i), ch->name); } g_string_append(ctx->header, "$upscope $end\n" "$enddefinitions $end\n"); return SR_OK; } static int receive(struct sr_output *o, const struct sr_dev_inst *sdi, const struct sr_datafeed_packet *packet, GString **out) { const struct sr_datafeed_logic *logic; struct context *ctx; unsigned int i; int p, curbit, prevbit, index; uint8_t *sample; gboolean timestamp_written; (void)sdi; *out = NULL; if (!o || !o->internal) return SR_ERR_BUG; ctx = o->internal; if (ctx->header) { /* The header is still here, this must be the first packet. */ *out = ctx->header; ctx->header = NULL; ctx->samplecount = 0; } else { *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_channels; p++) { index = g_array_index(ctx->channelindices, int, p); curbit = ((unsigned)sample[index / 8] >> (index % 8)) & 1; prevbit = ((unsigned)ctx->prevsample[index / 8] >> (index % 8)) & 1; /* VCD only contains deltas/changes of signals. */ if (prevbit == curbit && ctx->samplecount > 0) continue; /* Output timestamp of subsequent signal changes. */ if (!timestamp_written) g_string_append_printf(*out, "#%.0f", (double)ctx->samplecount / ctx->samplerate * ctx->period); /* Output which signal changed to which value. */ g_string_append_c(*out, ' '); g_string_append_c(*out, '0' + curbit); g_string_append_c(*out, '!' + p); timestamp_written = TRUE; } if (timestamp_written) g_string_append_c(*out, '\n'); ctx->samplecount++; memcpy(ctx->prevsample, sample, logic->unitsize); } return SR_OK; } static int cleanup(struct sr_output *o) { struct context *ctx; if (!o || !o->internal) return SR_ERR_ARG; ctx = o->internal; g_free(ctx->prevsample); g_array_free(ctx->channelindices, TRUE); g_free(ctx); return SR_OK; } struct sr_output_format output_vcd = { .id = "vcd", .description = "Value Change Dump (VCD)", .init = init, .receive = receive, .cleanup = cleanup, };