X-Git-Url: https://sigrok.org/gitweb/?p=libsigrok.git;a=blobdiff_plain;f=output%2Fchronovu_la8.c;h=ad0b5d32fc2c1ccaf294fabdf7035cd977cecefe;hp=688e1b54bd3f521e962a6c97036294d431d7bc1c;hb=43cd4637285833706f8a404ca027bcf0ee75b9ae;hpb=5c3c1241d2e2b5d456865e876490492d76174257 diff --git a/output/chronovu_la8.c b/output/chronovu_la8.c index 688e1b54..ad0b5d32 100644 --- a/output/chronovu_la8.c +++ b/output/chronovu_la8.c @@ -1,7 +1,8 @@ /* - * This file is part of the sigrok project. + * This file is part of the libsigrok project. * * Copyright (C) 2011 Uwe Hermann + * Copyright (C) 2014 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 @@ -14,8 +15,7 @@ * 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 + * along with this program. If not, see . */ #include @@ -24,12 +24,15 @@ #include "libsigrok.h" #include "libsigrok-internal.h" +#define LOG_PREFIX "output/chronovu-la8" + struct context { - unsigned int num_enabled_probes; - unsigned int unitsize; - char *probelist[SR_MAX_NUM_PROBES + 1]; - uint64_t trigger_point; + unsigned int num_enabled_channels; + gboolean triggered; uint64_t samplerate; + uint64_t samplecount; + int *channel_index; + GString *pretrig_buf; }; /** @@ -39,19 +42,16 @@ struct context { * * @return 1 if the samplerate is supported/valid, 0 otherwise. */ -static int is_valid_samplerate(uint64_t samplerate) +static gboolean is_valid_samplerate(uint64_t samplerate) { unsigned int i; for (i = 0; i < 255; i++) { if (samplerate == (SR_MHZ(100) / (i + 1))) - return 1; + return TRUE; } - sr_warn("la8 out: %s: invalid samplerate (%" PRIu64 "Hz)", - __func__, samplerate); - - return 0; + return FALSE; } /** @@ -67,14 +67,8 @@ static int is_valid_samplerate(uint64_t samplerate) */ static uint8_t samplerate_to_divcount(uint64_t samplerate) { - if (samplerate == 0) { - sr_warn("la8 out: %s: samplerate was 0", __func__); - return 0xff; - } - - if (!is_valid_samplerate(samplerate)) { - sr_warn("la8 out: %s: can't get divcount, samplerate invalid", - __func__); + if (samplerate == 0 || !is_valid_samplerate(samplerate)) { + sr_warn("Invalid samplerate (%" PRIu64 "Hz)", samplerate); return 0xff; } @@ -84,154 +78,113 @@ static uint8_t samplerate_to_divcount(uint64_t samplerate) static int init(struct sr_output *o) { struct context *ctx; - struct sr_probe *probe; + struct sr_channel *ch; GSList *l; - uint64_t *samplerate; - - if (!o) { - sr_warn("la8 out: %s: o was NULL", __func__); - return SR_ERR_ARG; - } - - if (!o->sdi) { - sr_warn("la8 out: %s: o->sdi was NULL", __func__); - return SR_ERR_ARG; - } - if (!o->sdi->driver) { - sr_warn("la8 out: %s: o->sdi->driver was NULL", __func__); + if (!o || !o->sdi) return SR_ERR_ARG; - } - - if (!(ctx = g_try_malloc0(sizeof(struct context)))) { - sr_warn("la8 out: %s: ctx malloc failed", __func__); - return SR_ERR_MALLOC; - } + ctx = g_malloc0(sizeof(struct context)); o->internal = ctx; - /* Get the probe names and the unitsize. */ - for (l = o->sdi->probes; l; l = l->next) { - probe = l->data; - if (!probe->enabled) + for (l = o->sdi->channels; l; l = l->next) { + ch = l->data; + if (ch->type != SR_CHANNEL_LOGIC) + continue; + if (!ch->enabled) continue; - ctx->probelist[ctx->num_enabled_probes++] = probe->name; + ctx->num_enabled_channels++; } - ctx->probelist[ctx->num_enabled_probes] = 0; - ctx->unitsize = (ctx->num_enabled_probes + 7) / 8; - - if (sr_dev_has_hwcap(o->sdi, SR_HWCAP_SAMPLERATE)) { - o->sdi->driver->info_get(SR_DI_CUR_SAMPLERATE, - (const void **)&samplerate, o->sdi); - ctx->samplerate = *samplerate; - } else - ctx->samplerate = 0; + ctx->channel_index = g_malloc(sizeof(int) * ctx->num_enabled_channels); + ctx->pretrig_buf = g_string_sized_new(1024); return SR_OK; } -static int event(struct sr_output *o, int event_type, uint8_t **data_out, - uint64_t *length_out) +static int receive(struct sr_output *o, const struct sr_datafeed_packet *packet, + GString **out) { + const struct sr_datafeed_logic *logic; struct context *ctx; - uint8_t *outbuf; - - if (!o) { - sr_warn("la8 out: %s: o was NULL", __func__); - return SR_ERR_ARG; - } + GVariant *gvar; + uint64_t samplerate; + gchar c[4]; - if (!(ctx = o->internal)) { - sr_warn("la8 out: %s: o->internal was NULL", __func__); + *out = NULL; + if (!o || !o->sdi) return SR_ERR_ARG; - } - - if (!data_out) { - sr_warn("la8 out: %s: data_out was NULL", __func__); + if (!(ctx = o->internal)) return SR_ERR_ARG; - } - switch (event_type) { + switch (packet->type) { + case SR_DF_HEADER: + /* One byte for the 'divcount' value. */ + if (sr_config_get(o->sdi->driver, o->sdi, NULL, SR_CONF_SAMPLERATE, + &gvar) == SR_OK) { + samplerate = g_variant_get_uint64(gvar); + g_variant_unref(gvar); + } else + samplerate = 0; + c[0] = samplerate_to_divcount(samplerate); + *out = g_string_new_len(c, 1); + ctx->triggered = FALSE; + break; case SR_DF_TRIGGER: - sr_dbg("la8 out: %s: SR_DF_TRIGGER event", __func__); - /* Save the trigger point for later (SR_DF_END). */ - ctx->trigger_point = 0; /* TODO: Store _actual_ value. */ + /* Four bytes (little endian) for the trigger point. */ + c[0] = ctx->samplecount & 0xff; + c[1] = (ctx->samplecount >> 8) & 0xff; + c[2] = (ctx->samplecount >> 16) & 0xff; + c[3] = (ctx->samplecount >> 24) & 0xff; + *out = g_string_new_len(c, 4); + /* Flush the pre-trigger buffer. */ + if (ctx->pretrig_buf->len) + g_string_append_len(*out, ctx->pretrig_buf->str, + ctx->pretrig_buf->len); + ctx->triggered = TRUE; + break; + case SR_DF_LOGIC: + logic = packet->payload; + if (!ctx->triggered) + g_string_append_len(ctx->pretrig_buf, logic->data, logic->length); + else + *out = g_string_new_len(logic->data, logic->length); + ctx->samplecount += logic->length / logic->unitsize; break; case SR_DF_END: - sr_dbg("la8 out: %s: SR_DF_END event", __func__); - if (!(outbuf = g_try_malloc(4 + 1))) { - sr_warn("la8 out: %s: outbuf malloc failed", __func__); - return SR_ERR_MALLOC; + if (!ctx->triggered && ctx->pretrig_buf->len) { + /* We never got a trigger, submit an empty one. */ + *out = g_string_sized_new(ctx->pretrig_buf->len + 4); + g_string_append_len(*out, "\x00\x00\x00\x00", 4); + g_string_append_len(*out, ctx->pretrig_buf->str, ctx->pretrig_buf->len); } - - /* One byte for the 'divcount' value. */ - outbuf[0] = samplerate_to_divcount(ctx->samplerate); - // if (outbuf[0] == 0xff) { - // sr_warn("la8 out: %s: invalid divcount", __func__); - // return SR_ERR; - // } - - /* Four bytes (little endian) for the trigger point. */ - outbuf[1] = (ctx->trigger_point >> 0) & 0xff; - outbuf[2] = (ctx->trigger_point >> 8) & 0xff; - outbuf[3] = (ctx->trigger_point >> 16) & 0xff; - outbuf[4] = (ctx->trigger_point >> 24) & 0xff; - - *data_out = outbuf; - *length_out = 4 + 1; - g_free(o->internal); - o->internal = NULL; - break; - default: - sr_warn("la8 out: %s: unsupported event type: %d", __func__, - event_type); - *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 int cleanup(struct sr_output *o) { struct context *ctx; - uint8_t *outbuf; - if (!o) { - sr_warn("la8 out: %s: o was NULL", __func__); + if (!o || !o->sdi) return SR_ERR_ARG; - } - - if (!(ctx = o->internal)) { - sr_warn("la8 out: %s: o->internal was NULL", __func__); - return SR_ERR_ARG; - } - if (!data_in) { - sr_warn("la8 out: %s: data_in was NULL", __func__); - return SR_ERR_ARG; - } - - if (!(outbuf = g_try_malloc0(length_in))) { - sr_warn("la8 out: %s: outbuf malloc failed", __func__); - return SR_ERR_MALLOC; + if (o->internal) { + ctx = o->internal; + g_string_free(ctx->pretrig_buf, TRUE); + g_free(ctx->channel_index); + g_free(o->internal); + o->internal = NULL; } - memcpy(outbuf, data_in, length_in); - - *data_out = outbuf; - *length_out = length_in; - return SR_OK; } SR_PRIV struct sr_output_format output_chronovu_la8 = { .id = "chronovu-la8", .description = "ChronoVu LA8", - .df_type = SR_DF_LOGIC, .init = init, - .data = data, - .event = event, + .receive = receive, + .cleanup = cleanup, };